diff --git a/robomaster_pi/Odom.py b/robomaster_pi/Odom.py index 90119d176c718c67f470214288fa159295923f72..6067ab3056f432f931c9d4bbfb070750d4556273 100644 --- a/robomaster_pi/Odom.py +++ b/robomaster_pi/Odom.py @@ -15,9 +15,10 @@ class OdometryPublisher(Node): ep_robot.initialize(conn_type="rndis") ep_chassis = ep_robot.chassis - ep_chassis.sub_velocity(freq=50, callback=self.sub_velocity_handler) + ep_chassis.sub_attitude(freq=50, callback=self.sub_attitude_info_handler) ep_chassis.sub_position(freq=50, callback=self.sub_position_handler) + ep_chassis.sub_velocity(freq=50, callback=self.sub_velocity_handler) def sub_attitude_info_handler(self, attitude_info): @@ -26,8 +27,7 @@ class OdometryPublisher(Node): def sub_position_handler(self, position_info): self.x, self.y, self.z = position_info - self.publish_odometry() - self.publish_transform() + def sub_velocity_handler(self, velocity_info): a, b, c, x, y, z = velocity_info