A7 左臂 + G20 左手杯子抓取

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

安装

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

验证状态

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

S
Description
A7 左臂 + G20 左手杯子视觉抓取、触觉收紧、抬升与放置返回完整流程
Readme 37 MiB
Languages
Python 99.5%
Shell 0.3%
C++ 0.2%