Files
a7l20-hug-sim/docs/cup_pregrasp_reference.md

2.6 KiB

杯身中段预抓取筛选

当前目标为杯高的一半:世界坐标 [0.461146,-0.038847,0.881096] m(桌高0.755m、杯高0.252192m)。目标指的是手内夹持中心,不是把手腕放在杯中心;手腕目标由手内中心 [0.079,-0.009,0.152] m 和姿态反算。

参考来源:

  • 本仓库 scripts/grasp_exec.py 的 close_fingers:逐指检测接触,接触后停止继续闭合并给少量挤压力。本轮试抓脚本此前没有复用这段逻辑。
  • MoveIt Grasps:区分抓取/预抓取的IK、碰撞筛选,以及接近、抬升、撤回规划。主要面向平行夹爪和吸盘,其过滤结构可参考,不能直接当作L20多指抓取质量证明。
  • GraspNet API:除碰撞外还检查夹持区域内是否有足够物体点,排除空抓。这里借鉴“无碰撞不等于能抓”的判断,不直接移植双指夹爪几何。
  • DexGraspNet:多指抓取优化包含力闭合、接触距离、物体穿透、自穿透和关节限制等项。本轮没有安装此框架,也没有实现或声称力闭合保证。

新增 scripts/cup_grasp_filter.py 是本项目L20专用的几何启发式:对固定杯逐指扫描闭合,要求拇指和至少两根其他手指的触点位于杯轴两侧(径向点积<-0.2),相关触点距杯身中段高度不超过5cm;桌面间隙>=5mm,离散闭合采样穿透不超过2mm。接触阈值1mm,这些是仿真筛选参数,不是经过标定的成功概率。手指触点和拒绝原因写入JSON。

scripts/search_cup_middle.py 按杯中段生成候选,筛选预抓取路径、完整接近段及闭合包围;scripts/test_cup_dynamic_grasp.py 用自由杯做动力学试抓,逐指接触停合,拇指+至少两指接触才允许抬升。质量判据仍需动力学验证,不能仅凭预筛选通过称抓取成功。

输出在 data/cup_middle_search/,与旧试抓隔离。运行:

.venv/bin/python scripts/search_cup_middle.py
CUP_TRIAL_DIR=data/cup_middle_search .venv/bin/python scripts/test_cup_dynamic_grasp.py

本轮验证:正例中段候选通过,杯子移开30cm的空抓被拒绝。候选yaw135°/tilt90°,闭合扫描最小桌距24.50mm;自由杯动力学尚未稳定提起。较大补偿推出杯子并拒绝抬升,保留原kp2/kd.08和0.08rad接触补偿用于继续调试。查看:.venv/bin/python scripts/view_cup_approach.py --middle --dynamic。