Files

2.4 KiB

操作流程

抓取

  1. 新读状态并准备 RGB-D;仅伸直四指,保留拇指行。
  2. 拇指双屈伸收至 20°/30°;原生 MoveJ 回零 15°/s,原抬臂路线 18°/s。原肩部两段内按反馈渐进展开拇指,6°/s 接入示教,12°/s 到观察位。
  3. 新采图重新配准手与杯,优化侧面 HUG 目标。默认额外接近 10 mm。
  4. 官方 SDK joint_follow 50 Hz 执行视觉批准的短段,每段最多 5 mm、关节峰值 1°/s;停稳后再采图更新。
  5. 四指先、拇指后闭合;至少两轮基础收紧,不满足试抬条件时追加至第 3/4 轮,每指每轮最多 8 步、累计 32 步。当前至少两指有接触且至少一指计数严格大于 9 才进入试抬;触觉上限 20。合指中的单指软件堵转 64 暂停该指,不将其认定为触觉达标。
  6. 5 mm 试抬成功后,按实读高度扣除余量,一条原生 MoveJ 补至累计约 30 mm,速度 1.5°/s。抬升中的故障 64 按三次刷新规则处理,持续存在则停止。
  7. 默认保持。指定圆圈模式则以本轮特征和局部映射继续视觉短段平移,下降后等待人工输入 y 才松手。

触觉计数不是牛顿;手部 FK 升高不是独立确认杯底离桌。视觉失效、反馈异常、真实限位、取消及停止保护沿用原流程。

返回与停止恢复

# 从最近有效抓取记录放回、人工确认、松手、返回;不带 execute 为计划
bash run.sh return
bash run.sh return --execute
# 主抬升已确认停止,现场明确允许后解除一次停止并下降返回
bash run.sh return --resume-stopped --execute
# 只松手返回:操作者已确认可安全释放,不自动下降
bash run.sh release-return --execute --resume-stopped

可用 --workflow 指定本轮 result.json。来源 hash、实读姿态与停止条件仍需匹配;不要把历史示教或模板当作本轮来源。返回中的松手后退出采用一条 MoveJ 回观察位,肩部反向对应段收拇指后继续回零。下降返回会等待 y,取消/EOF 保持握紧并结束。

圆圈独立续接使用 bash run.sh circle --workflow 本轮result.json --resume-stopped --execute,只适用于入口认可的真实来源。不要在同一设备上同时运行运动脚本。

Ctrl+C 交给当前子阶段执行停止并保存日志;等待停止结果后再决定下一步。无自动使能、清错、解停或动作重发。