Files

5.0 KiB
Raw Permalink Blame History

D405杯子建模与仿真流程(2026-09-28)

查看:.venv/bin/python scripts/view_cup_workcell.py --camera overview;按F自由视角。 相机视角:.venv/bin/python scripts/view_cup_workcell.py --camera d405_sim。

输入是用户14:27左右在实时窗口按S保存的最后一帧,冻结在data/cup_model_20260928。实时脚本多次按S覆盖同目录四个文件,不自动累积多帧;本次输入已另存,后续S不会改变模型输入。

深度估计杯高252.2mm、底径70.6mm、上部径95.5mm;侧面拟合中位残差1.44mm不等于尺寸精度。杯身为轴对称分段锥台,杯盖及未观测背面为近似补全。杯子固定在桌面(运动学对象),没有编造质量/摩擦,不声明动力学抓取成功。

桌面仍75.5cm,柱前面至桌沿20.5cm。用真实深度桌面法向和高度对仿真相机进行平面配准:相对原暂定外参修正旋转1.392°、相机z约-12.83mm;XY/yaw仍沿用未经独立验证的手眼估计。这证明原显示场景不能直接当成完整实物标定,不自动改真机外参。杯子模型底部世界坐标约[.332675,-.106881,.755]m。

仿真D405输出:data/cup_sim_capture_20260928/{rgb.png,depth.png,camera.json}。其preview_scene.xml包含相机和杯子,查看器使用它。MuJoCo主点需使用负偏移并处理像素中心,已修正;从仿真深度和暗色连通域估计杯中心,与生成模型XY差约0.0033mm,这是理想合成深度验证,不是真机误差。

已执行:RGB-D → 暗色杯子感知 → HUG采样8个候选 → LEFT重定向保留3个 → A7离线预抓取IK。3个候选每个8种种子均未找到位置<2mm、姿态<2°的解,结果为pregrasp_not_validated;并非全局不可达。没有执行抓取或向真机发任何运动命令。报告data/cup_workcell/pipeline_report.json,HUG/重定向日志同目录。

桌板正常碰撞余量5mm,独立配置config/cup_workcell.json,不改真机门禁。起点贴桌不能立即满足5mm,先用有限桌板接触抬离检查:1个关节线性小步/80子区间连续检查通过,端点最差L6净空8.85mm。报告data/cup_workcell/escape_report.json。只证明固定手形的左臂+法兰+手相对桌板抬离,不包括自碰撞/杯子/另一臂认证。不能靠放宽为负余量来接受穿桌。

构建:scene/build_cup_workcell.py;相机:scripts/capture_workcell_rgbd.py;感知:scripts/perceive_workcell_cup.py;抬离:scripts/plan_workcell_escape.py;候选IK与采样检查:scripts/plan_cup_workcell.py。

2026-09-28 坐标/安装核验:控制器快照与模型 FK 左右臂位置差 <0.002mm,安装矩阵与已确认配置一致(矩阵最大差 8.2e-7);HUG 相机到世界变换数值一致。这些是软件一致性检查,不代表真实标定精度。发现旧重定向 left URDF 与实际 LEFT 装配的手指侧向/轴方向镜像不一致;新增 assets/retarget/l20_left_scene_with_tips.urdf、config/l20_left_scene_position.yml 与实际模型一致。HUG MANO 默认 right,需显式 --mirror-human-hand 生成左手候选;转换后指尖拟合误差8.7–9.6mm。原装配/法兰安装未改。修正后3候选×8种子仍未找到预抓取IK,未进入路径碰撞检查,不能归因为桌面碰撞,也未完成抓取。报告 data/cup_coordinate_audit_20260928/report.json。

重定向复现:PYTHONPATH= LD_LIBRARY_PATH= $RETARGET_PYTHON scripts/hug_to_l20.py --npz data/cup_sim_capture_20260928/hug_cup.npz --side left --top 3 --table-top .755 --config config/l20_left_scene_position.yml --mirror-human-hand。仅离线候选验证,原真机 RealArm 安装参数未迁移,不能直接执行。

抓取方向调整:scripts/search_cup_approach.py 搜索103种姿态,找到相对原候选 yaw=-90°、倾角=-60°、高度不变的可达解。接近前段桌面采样最小间隙8.845mm;scripts/check_cup_final_approach.py 验证末段70个笛卡尔点,终点桌面间隙15.193mm、手杯距离2.936mm。保存 data/cup_approach_search/{selected.json,approach_qpos.npy,approach_report.json}。只证明采样几何路径;末段允许接近杯子至接触,桌板仍保留5mm。

查看:.venv/bin/python scripts/view_cup_approach.py,鼠标自由转动、空格暂停、R重播。加 --dynamic 查看动力学试抓(成败看dynamic_report.json)。动力学独立场景使用假设杯质量0.25kg、摩擦1.0、理想机械臂关节跟踪和有限力手部驱动;杯子自由运动,不焊接到手上。第一次试抓推倒杯子,坐标原点升高不代表杯体离桌;判据已改成离桌间隙和持续手部接触。

用户移动杯子后重新采集 data/cup_moved_capture_20260928,沿用相机未移动假设下的既有外参,拟合新杯轴 [0.461146,-0.038847,0.755]m;相对原位 Δx=+128.47mm、Δy=+68.03mm。杯顶截断,沿用原尺寸,侧面拟合中位残差2.78mm。场景杯位置已更新,旧场景保存在backup/cup-moved-*。新方向 yaw=-90°/tilt=-30°/抓取高度偏移+40mm,最后接近通过,终点桌面间隙71.51mm、手杯间隙11.03mm。接近回放已更新。