SO-ARM 双臂演示上手线路

由 PlutoKeating 开发于 2026 年 11 月 21 日
GitHub 仓库

外参标定

深度引导要知道深度相机相对两只臂在哪。标定用机械臂自己当标定物,不需要人手和标定板,每只臂约一分半钟。

新套机支线支线第 2 站,共 2 站

把相机低头到标定刻度

展示时相机朝前看,这个角度下看不到手臂。标定时要让它低头,能看见手臂往前伸出:

云台俯仰示意:相机从工作姿态低头到约 59 度的标定姿态,视野罩住往前伸出的手臂25°59°
  • 工作刻度 1705:低头约 25°,视野罩住两臂前方观众伸手的区域。展示时用。
  • 标定刻度 2087:低头约 59°,能看见手臂往前伸出。只在手眼标定时用。
侧视图,一号套机的数值。相机装在两臂之间、基座前上方的立柱上;刻度每减小 11.4,相机抬头 1°。
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

它把深度相机看到的手臂点云对到运动学骨架上,求出相机的位置,再把骨架投影回深度图做反向验证。验证不通过就不保存。

检查结果

看两处:

抬回工作刻度并换算外参

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°

验证

回到首次启动的“深度引导”一步:把手伸到深度相机看得见、腕部相机看不见的位置,离得近的那只臂应该转过去并把手带进腕部画面。