collab/igvc2018
git clone https://git.julia.blue/collab/igvc2018
469e5be
imu
1# previous_min = 0 2# previous_max = 0 3 4# while(loop): 5# rospy.init_node('imu_listener', anonymous = True) 6# imu_sub = rospy.Subscriber("vn200_accel_gyro_compass", vn_200_accel_gyro_compass, sampling_callback) 7 8# global imu_msg 9 10# if imu_msg == None: 11# return 12 13# mag_x = imu_msg.compass.x 14# mag_y = imu_msg.compass.y 15# mag_z = imu_msg.compass.z 16 17# mag = [] 18 19# mag[0] = imu_msg.compass.x 20# mag[1] = imu_msg.compass.y 21# mag[2] = imu_msg.compass.z 22 23 24 25 26# for i in range(10000): 27# rospy.init_node('imu_listener', anonymous = True) 28# imu_sub = rospy.Subscriber("vn200_accel_gyro_compass", vn_200_accel_gyro_compass, sampling_callback) 29 30# global imu_msg 31 32# global mag_min 33# global mag_max 34 35# if imu_msg==None: 36# return 37 38# mag_x = imu_msg.compass.x 39# mag_y = imu_msg.compass.y 40# mag_z = imu_msg.compass.z 41 42# if mag_x < mag_x_previous_min: 43# mag_x_min = mag_x 44# elif mag_x > mag_x_previous_max: 45# mag_x_max = mag_x 46 47# if mag_y < mag_y_previous_min: 48# mag_y_min = mag_y 49# elif mag_y > mag_y_previous_max: 50# mag_y_max = mag_y 51 52# if mag_z < mag_z_previous_min: 53# mag_z_min = mag_z 54# elif mag_z > mag_z_previous_max: 55# mag_z_max = mag_z 56 57# mag_x_previous_min = mag_x_min 58# mag_y_previous_min = mag_y_min 59# mag_z_previous_min = mag_z_min 60 61# mag_x_previous_min = mag_x_max 62# mag_y_previous_min = mag_y_max 63# mag_z_previous_min = mag_z_max