diff --git a/robomaster_pi/robot_ros_odom.py b/robomaster_pi/robot_ros_odom.py index bbf027200fc8b0979a6581fbea9109262d1cade8..7e7dd8f076c58149faf01a57ef7a21f711be7aca 100644 --- a/robomaster_pi/robot_ros_odom.py +++ b/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")