a

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()