arm_dev
a3a589b9e3
新建 handeye/ 专用文件夹（用户要求：专用文件夹 + 使用说明） - handeye/README.md：从小白视角讲清楚两种模式怎么选、板尺寸怎么量、 完整流程、出问题先看哪里。以前这些知识散在 docs/ 和代码注释里。 - 结构：calibrate.yaml（参数）/ poses/（采点输入）/ results/（结果输出）/ tmp/（临时，不进 git） - 文件用 git mv 迁移，历史保留 命名约定改为 <臂号>_<模式>.yaml - 如 89_eye_in_hand.yaml、91_eye_to_hand.yaml - 臂号 = Flexiv 序列号后两位；模式 = eye_in_hand | eye_to_hand - 换模式 = 改 site.yaml 里 paths.handeye_file 一行，不动代码 - 迁移只需改 site.yaml（4 个 launch + servo_node 都经 paths 读取，一行没改） 修复：三套互相矛盾的标定板尺寸（真实 bug） 同一个"板子多大"分散在三处，且值各不相同： handeye_calibrate.py 默认 9x6 / 0.025 handeye/calibrate.yaml 11x16 / 0.011 site.yaml + 结果文件头 8x11 / 0.015 ← 实测的真实板子 谁生效取决于覆盖顺序。症状是"标定流程跑得很顺、不报错，但结果明显不对"， 极难排查。已全部统一为 8x11 / 0.015，README 里写明换板必须三处同改。 修复：site.yaml 里五项稳定性配置从未生效 run_handeye.sh 一直在传 settle_qd_max / settle_stable_sec / settle_timeout_sec / pin_holds / pin_hold_sec，但 handeye_calibrate.py 从未声明这些参数 —— ROS 2 会静默忽略未声明的覆盖参数，所以"等机械臂停稳再拍照"这件事其实没实现， 实际只有一次固定 settle_sec。现已声明并实现： - _wait_settled()：用关节速度 |qd|_max 判定"真的停了"，比固定 sleep 可靠 （负载/姿态不同刹车距离差别很大；等太短会在臂还动时拍照导致角点抖动） - _pin_hold()：静止后再保持几拍，抑制到位后的微小回弹 新增：自动标定进度条 一条可视化进度条（[ 4/12] [████░░░░] 33.3%），无人值守的长流程能一眼看出还剩多久。 清理重复文件（内容逐字节比对确认后删除） - config/handeye_result.yaml 与 _89 逐字节相同 → 删 - config/handeye_poses.yaml 与 _89 逐字节相同 → 删 迁移后 src/arm_application/config/ 下已无 handeye 文件。 测试：224 passed（原 198，新增 26） 新增 src/arm_application/test/test_handeye_lib.py —— 手眼模块此前零测试。 关键用例是合成数据往返：用人为设定的 X_true 反推出每个视图的 (gripper→base, target→cam)，再让求解器还原。坐标链方向/求逆/转置 只要有一处写错就必然失败。 - 真值恢复（旋转+平移，atol 1e-6） - 单独验证平移精确（旋转对而平移错是最易漏的一类 bug） - 结果必须是 det=+1 的正交阵（排除镜像解） - 退化输入（全同位姿）不得悄悄给出"看起来能用"的结果 - 稳定性判据：窗口未满不判稳、丢帧后重新计数、抖动超阈不判稳 - 写盘再读回不漂移
Flexiv Rizon 视觉伺服（~/ros2）
独立工作空间：腕部 D405 眼在手上、手眼标定、YOLO 找工件、法兰悬停跟踪、DH 夹爪、入孔检测。
一份仓库即可跑完整跟踪与检测，不依赖 camera_test 或装配 HMI。
工作目录必须是 ASCII 路径（推荐克隆到 ~/ros2）。
| 项 | 值 |
|---|---|
| 配置 | config/site.yaml（从 example 复制，不进 git） |
| 操作 | scripts/ |
| 目录说明 | docs/WORKSPACE.md（每个文件夹做什么） |
| Conda | ros_flexiv |
| ROS | Humble |
克隆后
cd ~/ros2
cp config/site.example.yaml config/site.yaml
# 编辑 site.yaml：robot.sn / robots[].ip / camera.serial / paths.yolo_weights
# 权重文件放到 models/yolo/（二进制不在 git 里）
conda activate ros_flexiv
source scripts/env.sh
./scripts/build_all.sh
source scripts/env.sh
示教器：AUTO + Remote Ethernet，关掉 Flexiv Studio（RDK 独占）。
# 三个终端必须带同一个 --arm（89=左 91=右）
bash ~/ros2/scripts/run_real.sh --arm 89
bash ~/ros2/scripts/run_camera_d405.sh --arm 89 --preview
bash ~/ros2/scripts/run_visual_servo_rt.sh --arm 89 --control
改 site.yaml：锁高 / YOLO / 伺服 → 重启第三终端；分辨率 / 曝光 → 重启相机。
功能入口
| 功能 | 命令 |
|---|---|
| 实机 | scripts/run_real.sh --arm 89|91 |
| 腕部相机 | scripts/run_camera_d405.sh --arm … --preview |
| 顶视 D435 | scripts/run_camera_d435.sh --preview |
| 列出相机 | scripts/list_realsense.sh |
| 跟踪 | scripts/run_visual_servo_rt.sh --arm … [--control] |
| 回 home | scripts/go_home.sh --arm … |
| 手眼 | scripts/run_handeye.sh --arm … teach → merge → calibrate |
| PGEA / RGI 夹爪 | scripts/run_gripper.sh --arm 89|91 --cli … |
| 双爪 ROS | scripts/run_dual_gripper.sh |
| 入孔检测 | scripts/run_hole_detect.sh --arm … --preview |
| Orisys 触觉 | scripts/run_tactile.sh [--cli] |
| 看配置 | scripts/show_site_config.sh |
89 与 91 各有 手眼、相机序列号、锁高、named poses，禁止混用。
文档
| 文档 | 内容 |
|---|---|
| docs/WORKSPACE.md | 每个目录 / 脚本 / 包 |
| docs/QUICKSTART.md | 环境与第一次跑通 |
| docs/ARCHITECTURE.md | 进程与几何 |
| docs/SITE_CONFIG.md | site.yaml 字段 |
| docs/HANDEYE.md | 手眼标定 |
| docs/TRACKING.md | 视觉伺服 |
| docs/GRIPPER.md | PGEA + RGI |
| docs/HOLE_DETECT.md | 入孔检测 |
| docs/TACTILE.md | Orisys 视触觉 |
| docs/INTERFACES.md | ROS / 脚本接口 |
| docs/TRAJECTORIES.md | 轨迹回放 |
上传 git 时
- 要提交：
src/scripts/docs/config/site.example.yamlmodels/yolo/README.mdmodels/hole_insert/README.md - 不要提交：
config/site.yaml（含本机 IP/序列号）、build/install/log/、YOLO.pt/.onnx/.engine、thirdparty/vendor/ - 规则已写在
.gitignore
别人克隆后必须自己 cp site.example.yaml site.yaml 并重新手眼标定（不要直接用仓库里某台现场的 T_4x4 当真值）。