fix: 修正 UP/DOWN 与 J5 角度的对应关系

问题:
- 之前错误地将 J5=81 (张开) 标记为 UP
- 实际上 J5=-100 (闭合) 才是 UP(夹爪朝上)

正确对应关系:
- UP: J5=-100 (闭合), z4=-100, 工作范围 z ∈ [-190, 110]mm
- DOWN: J5=81 (张开), z4=55, 工作范围 z ∈ [-345, -55]mm

修复内容:
- 重命名常量:Z4_OPEN/Z4_CLOSED → Z4_UP/Z4_DOWN
- 更新 resolve_z4_from_j5(): J5 < 0 → UP
- 更新 vision_grasp 相机旋转逻辑:J5 < 0 → 正向
- 更新文档说明

现在 UP/DOWN 语义正确且一致!
This commit is contained in:
2026-06-16 20:01:24 +08:00
parent aa7cd87151
commit 197de7908a
4 changed files with 23 additions and 184 deletions

View File

@@ -24,8 +24,8 @@ CRAIC 项目的 ROS 2 机械臂控制和视觉抓取系统。
- 关节空间和笛卡尔空间运动控制
- 完整的逆运动学和正运动学
- **自动 z4 适配**:根据目标 z 坐标自动选择夹爪状态
- `z > -55mm`: J5=-100(闭合)z4=-100mm,工作范围 z ∈ [-190, 110]mm
- `z ≤ -55mm`: J5=81(张开)z4=55mm,工作范围 z ∈ [-345, -55]mm
- `z > -55mm`: UPJ5=-100z4=-100,工作范围 z ∈ [-190, 110]mm
- `z ≤ -55mm`: DOWNJ5=81z4=55,工作范围 z ∈ [-345, -55]mm
- UDP 通信(与 ESP32
- 状态发布10Hz
@@ -39,8 +39,8 @@ CRAIC 项目的 ROS 2 机械臂控制和视觉抓取系统。
- 释放流程:移动 → 释放 → 回收
**相机旋转说明**
- J5 >张开/UP相机正向`(xc, yc, zc) = (x_img, -y_img, z)`
- J5 <闭合/DOWN相机旋转 180°`(xc, yc, zc) = (-x_img, y_img, z)`
- J5 <闭合/UP相机正向`(xc, yc, zc) = (x_img, -y_img, z)`
- J5 >张开/DOWN相机旋转 180°`(xc, yc, zc) = (-x_img, y_img, z)`
## 🚀 快速开始