Files

77 lines
4.5 KiB
Markdown
Raw Permalink Blame History

This file contains ambiguous Unicode characters
This file contains Unicode characters that might be confused with other characters. If you think that this is intentional, you can safely ignore this warning. Use the Escape button to reveal them.
# A7 左臂 + G20 左手杯子抓取
完整真机流程:准备空手 → 回零和示教观察位 → 新 RGB-D 配准 → 视觉接近 → HUG 合指与触觉收紧 → 5 mm 试抬 → 补足累计约 30 mm。可选将杯子搬到桌面圆圈,人工确认落桌后松手;也可原位放回并返回零位。
默认使用新RGB-D配准与图像特征直接视觉伺服,**不依赖掌心标签定位,也不要求粘贴掌心Tag**。目录名沿用历史命名;旧标签入口不是当前默认流程。
控制器IP固定为 **192.168.10.21**。在线控制器网页:**[http://192.168.10.21:8000/](http://192.168.10.21:8000/)**,用于现场操作使能等控制功能;ROSBridge端口为 **9090**,供脚本通信使用。主机需接入可访问控制器的网络,无需修改控制器IP。
## 标定与首次部署
相机安装变化、换工位,或没有本工位已独立验证的相机外参时,先完成手眼标定,再执行抓取:
- **标定项目**:[a7-handeye-calibration](https://gitea.robotquan.com/liyang/a7-handeye-calibration)
- **完整教程**:[拍板、左右臂只读采点、求解、独立验证与部署](https://gitea.robotquan.com/liyang/a7-handeye-calibration/src/branch/main/WORKFLOW.md)
标定通过后,先备份,再将本轮camera.json放到本项目的 `config/camera_extrinsics_current.json`;具体命令见教程第8节。外参应为共同 `base_link` 下的 `T_base_cam_opencv`。右臂求得的相机外参可用于共享基座,但右臂触点偏移不能用于左手。不要直接套用仓库中原工位的外参。
手眼标定提供相机—基座坐标关系;接近阶段仍使用新视觉反馈与实测局部运动映射,不恢复掌心Tag定位。手部角度标定、模型装配及示教路线是另外的配置,不能由手眼标定替代。
灵巧手SN由CAN身份查询返回(属性0xC0)。默认按G20/LHT20型号与所需左右手标识校验,不绑定某一台设备SN;本项目左手抓取只接受左手,并继续记录实际SN、检查同轮及返回来源的设备一致性。共用SN校验函数支持left/right,但不代表整套抓取已支持右臂右手,也不允许左右手共用角度标定表。
## 安装
运行环境为 Ubuntu 24.04 x86_64、系统 Python 3.12、ROS 2 Jazzy、Intel RealSense D405。机械臂使用官方 SDK 1.0.5 与原生 MoveJ,G20 左手使用 SocketCAN。官方 SDK 下载来源、D405 驱动、USB-CAN/SocketCAN 配置及检查步骤见 [环境配置](docs/INSTALL.md)。
~~~bash
bash scripts/setup.sh
bash run.sh check
~~~
## 使用
先显示计划,不连接设备:
~~~bash
bash run.sh cup
~~~
现场摆好杯子、确认空手与路线通畅,由操作者完成机械臂使能;CAN 已配置、下位机和相机可用后,明确执行:
~~~bash
bash run.sh cup --execute
~~~
可选完整流程:
~~~bash
# 抓取、抬升、搬到圆圈,输入 y 确认落桌后松手
bash run.sh cup --place-at-circle --execute
# 圆圈松手后沿记录返回零位
bash run.sh cup --place-at-circle --return-after-circle --execute
# 原位放回,输入 y 确认落桌后松手并返回
bash run.sh cup --place-open-return --execute
~~~
默认额外接近 10 mm、累计抬升 30 mm;通过 --extra-approach-mm 和 --height-mm 调整。原 run_grasp_cycle.sh 是抓取入口;run_complete_grasp.sh 是专用松手返回入口,两者用途不同。
停止与返回命令见 [操作流程](docs/WORKFLOW.md)。失败不自动解停、使能、清错或重发。当前设备状态必须重新实读,历史模板和示教数据不代表当前停位。
## 目录
| 目录 | 内容 |
| --- | --- |
| dual_tag_cup_servo/tools | 完整编排、视觉定位、跟踪、合指、触觉、抬升与返回 |
| runtime/arm | SDK、关节控制、观察位示教与拇指配合 |
| runtime/hug | 几何、IK、手部读取、相机辅助和机器人模型 |
| assets/cup_reference | 杯子 HUG 模板、实测局部映射及参考图像 |
| config | 当前外参与环境配置示例 |
| scripts | 环境安装和离线检查 |
| docs | 环境、操作、验证与文件来源清单 |
当轮记录写入 dual_tag_cup_servo/runs、dual_tag_cup_servo/workflows 和 runtime/arm/out,默认不提交。详细逐帧记录保存在文件中,终端只显示阶段与结果。
## 验证状态
已提供默认杯子流程的离线检查。最近记录的抓取尝试在手部故障后终止,尚不能据此认定整套流程稳定成功;故障详情及验证范围见 [验证记录](docs/VALIDATION.md)。