diff --git a/robomaster_pi/conn_odom.py b/robomaster_pi/conn_odom.py index 89526d7fd7c989109ce0ac89f1e4c6109ac3f353..f7c54d79f8f3c937b80787506125f0ed10bb318b 100644 --- a/robomaster_pi/conn_odom.py +++ b/robomaster_pi/conn_odom.py @@ -30,6 +30,7 @@ def quaternion_from_euler(ai, aj, ak): return q def publish_odometry(self, position_info): + print("ok") x, y, z = position_info q = quaternion_from_euler(0, 0, -z* math.pi/180) msg = Odometry()