diff --git a/robomaster_pi/conn_vel.py b/robomaster_pi/conn_vel.py index 750af7fdae74f7ae7fb6de6d3b74dd5b27a7851b..1aa880d41b4c005c1e05fe1bbfca15e360ce441a 100644 --- a/robomaster_pi/conn_vel.py +++ b/robomaster_pi/conn_vel.py @@ -57,7 +57,7 @@ class vel_from_ros_node(Node): if(msg.angular.z == 0.0 and msg.linear.x == 0.0 and msg.linear.y == 0.0): self.my_ep_chassis.drive_speed(x = 0, y = 0, z = 0.5) else: - self.my_ep_chassis.drive_speed(x = msg.linear.x, y = -msg.linear.y, z = -msg.angular.z / (180 / math.pi)) + self.my_ep_chassis.drive_speed(x = msg.linear.x, y = -msg.linear.y, z = -msg.angular.z * (180 / math.pi)) def main(): ep_robot = robot.Robot()