外参标定
深度引导要知道深度相机相对两只臂在哪。标定用机械臂自己当标定物,不需要人手和标定板,每只臂约一分半钟。
新套机支线支线第 2 站,共 2 站
把相机低头到标定刻度
展示时相机朝前看,这个角度下看不到手臂。标定时要让它低头,能看见手臂往前伸出:
- 工作刻度 1705:低头约 25°,视野罩住两臂前方观众伸手的区域。展示时用。
- 标定刻度 2087:低头约 59°,能看见手臂往前伸出。只在手眼标定时用。
uv run soarm-tools head-set --port <云台串口> \
--pan-id 7 --tilt-id 8 --tilt 2087
2087 是一号套机的标定刻度,相机低头约 59°。
让每只臂自己标定
控制台没有在运行时,直接执行:
uv run soarm-tools body-calib right
uv run soarm-tools body-calib left
演示正在常驻运行时,先把这只臂借出来,做完再还回去:
scripts/lab.sh lend right
uv run soarm-tools body-calib right
scripts/lab.sh restore
它把深度相机看到的手臂点云对到运动学骨架上,求出相机的位置,再把骨架投影回深度图做反向验证。验证不通过就不保存。
检查结果
看两处:
- 终端输出的相机位置应该在两臂之间的上方。一号套机在右臂基座系下是前 0.18 m、左 0.17 m、上 0.42 m。
- 打开
calibration/body_right/check_*.jpg,黄色骨架应该压在手臂上,指尖偏差两三厘米以内。
抬回工作刻度并换算外参
uv run soarm-tools head-set --port <云台串口> \
--pan-id 7 --tilt-id 8 --tilt 1705
uv run soarm-tools tilt-calib --pitch-down 25
tilt-calib 测量此刻地面的方向,与标定时的地面方向相比,得到相机转过的角度,把外参换算过来。它需要独占深度相机,执行时控制台不能在运行。--pitch-down 是此刻大致的低头角度,帮它在画面里认出地面。
之后云台不要再动。运行中控制台会持续核对地面方向,对不上就暂停深度引导。
估计腕部相机的安装偏角
腕部相机装在夹爪上方、斜着往下看,光轴比夹爪指向低十几到二十度。这个偏角要估出来,深度引导才能把相机而不是夹爪对准手。
不需要专门操作:进入深度引导模式(按 3)正常伸手互动,腕部相机和深度相机同时看到手时会自动积累样本,重启不丢。页面“外参标定”一栏显示每只臂的样本数。
每只臂攒够 20 对以上,点“用自动样本估计所选臂的安装偏角”。结果里的散布在 6° 以内可用。
| 一号套机的结果 | |
|---|---|
| 左臂 | 偏右 4.7°,偏下 14.9°(160 对一致的样本) |
| 右臂 | 样本不足,暂用偏右 3.5°、偏下 19.6° |
验证
回到首次启动的“深度引导”一步:把手伸到深度相机看得见、腕部相机看不见的位置,离得近的那只臂应该转过去并把手带进腕部画面。