diff --git a/ros2/src/udp_teleop/udp_teleop/vision_grasp.py b/ros2/src/udp_teleop/udp_teleop/vision_grasp.py index 53b59a2..6651209 100644 --- a/ros2/src/udp_teleop/udp_teleop/vision_grasp.py +++ b/ros2/src/udp_teleop/udp_teleop/vision_grasp.py @@ -286,8 +286,9 @@ class VisionGraspNode(Node): # 图像坐标到相机坐标系转换 # 相机水平安装,但会随 J5 状态旋转 180° - # J5 = -100 (闭合) → 夹爪朝上 (UP) - # J5 = 81 (张开) → 夹爪朝下 (DOWN) + # J5 = -100 (闭合) → 夹爪朝上 (UP) → 相机正向 + # J5 = 81 (张开) → 夹爪朝下 (DOWN) → 相机旋转 180° + if j5 < 0: # J5 闭合(UP):相机正向 # 图像 Y 向下 → 相机 -Y