Files
a7l20-cup-grasp/README.md
T

4.5 KiB
Raw Blame History

A7 左臂 + G20 左手杯子抓取

完整真机流程:准备空手 → 回零和示教观察位 → 新 RGB-D 配准 → 视觉接近 → HUG 合指与触觉收紧 → 5 mm 试抬 → 补足累计约 30 mm。可选将杯子搬到桌面圆圈,人工确认落桌后松手;也可原位放回并返回零位。

默认使用新RGB-D配准与图像特征直接视觉伺服,不依赖掌心标签定位,也不要求粘贴掌心Tag。目录名沿用历史命名;旧标签入口不是当前默认流程。

控制器IP固定为 192.168.10.21。在线控制器网页:http://192.168.10.21:8000/,用于现场操作使能等控制功能;ROSBridge端口为 9090,供脚本通信使用。主机需接入可访问控制器的网络,无需修改控制器IP。

标定与首次部署

相机安装变化、换工位,或没有本工位已独立验证的相机外参时,先完成手眼标定,再执行抓取:

标定通过后,先备份,再将本轮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 配置及检查步骤见 环境配置。

bash scripts/setup.sh
bash run.sh check

使用

先显示计划,不连接设备:

bash run.sh cup

现场摆好杯子、确认空手与路线通畅,由操作者完成机械臂使能;CAN 已配置、下位机和相机可用后,明确执行:

bash run.sh cup --execute

可选完整流程:

# 抓取、抬升、搬到圆圈,输入 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 是专用松手返回入口,两者用途不同。

停止与返回命令见 操作流程。失败不自动解停、使能、清错或重发。当前设备状态必须重新实读,历史模板和示教数据不代表当前停位。

目录

目录 内容
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,默认不提交。详细逐帧记录保存在文件中,终端只显示阶段与结果。

验证状态

已提供默认杯子流程的离线检查。最近记录的抓取尝试在手部故障后终止,尚不能据此认定整套流程稳定成功;故障详情及验证范围见 验证记录。