a

robomaster_pi/robot_ros_odom.py

@@ -39,12 +39,7 @@ def quaternion_from_euler(ai, aj, ak):
     return q
 
 class Robomaster_odom(Node):
-    def __init__(self, ep_chassis):
-        super().__init__("robomaster_odom")
-        ep_chassis.sub_position(freq=10, callback=self.sub_position_handler)
-        print("sub")
     
-
     def sub_position_handler(position_info):
         print("handler")
         tf_broadcaster = TransformBroadcaster()
@@ -63,6 +58,13 @@ class Robomaster_odom(Node):
         tf_broadcaster.sendTransform(t)
         print("ok")
 
+    def __init__(self, ep_chassis):
+        super().__init__("robomaster_odom")
+        ep_chassis.sub_position(freq=10, callback=self.sub_position_handler)
+        print("sub")
+    
+    
+
 
 def main():
     print("jo")