diff --git a/ros2/src/udp_teleop/udp_teleop/arm_control.py b/ros2/src/udp_teleop/udp_teleop/arm_control.py index 744b935..89884a3 100644 --- a/ros2/src/udp_teleop/udp_teleop/arm_control.py +++ b/ros2/src/udp_teleop/udp_teleop/arm_control.py @@ -128,7 +128,7 @@ class ArmJointState: def to_udp_message(self) -> bytes: """转换为 UDP 消息""" return ( - f"JXB:{self.height}:{self.j2}:{self.j3}:{self.j4}:" + f"JXB:{self.height + 290}:{self.j2}:{self.j3}:{self.j4}:" f"{self.j5}:{self.j6}:0:0:EZHY\n" ).encode("utf-8") diff --git a/ros2/src/udp_teleop/udp_teleop/keyboard_control.py b/ros2/src/udp_teleop/udp_teleop/keyboard_control.py index 6229345..a2c12c8 100644 --- a/ros2/src/udp_teleop/udp_teleop/keyboard_control.py +++ b/ros2/src/udp_teleop/udp_teleop/keyboard_control.py @@ -310,7 +310,7 @@ class KeyboardUdpControlNode(Node): def build_arm_cmd(self): joints = self.arm_joints return ( - f"JXB:{self.arm_height}:" + f"JXB:{self.arm_height + 290}:" f"{joints[0]}:{joints[1]}:{joints[2]}:" f"{joints[3]}:{joints[4]}:0:0:EZHY\n" ).encode()