collab/igvc2018

git clone https://git.julia.blue/collab/igvc2018

rickyc106Clean up comments and call gps function469e5be

imu
1.4 KiB63 linesraw
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