2.6 KiB
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。