77 lines
4.5 KiB
Markdown
77 lines
4.5 KiB
Markdown
# 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)。
|