SO-101
课程总览/第 05 章 · 到位判断
EN
第 05 章运动学约 20 分钟

到位判断

配套页面:控制台的「到位判断」页签

10 个小节 4 张图 2 段代码 复现容差实测
三种判据复现出来的轨迹

1. 复现其实只做两件事#

记录下来的东西是一串帧:每 1/30 秒一条,每条含六个关节角 + TCP 位姿 + 夹爪开合。

复现就是循环做两件事:

text
取第 i 帧  →  下发六个关节目标  →  决定什么时候发第 i+1 帧  →  …

TCP 位姿也会被记录,但它用于「末端位姿到位」判据;真正下发的目标是关节角。

第二种事就是"到位判断"。它不改变定位精度,只决定节奏——而这直接决定了复现要跑多久、轨迹还原得多准。

2. 三种判据#

判据 拿什么判断"可以发下一帧了" 参数 特点
按固定时间 不做判断,到点就发 下发间隔(ms,默认 33) 最快;手臂跟不上时会"抹平"转角
末端位姿到位 实测 TCP 位置 + pitch/roll + 夹爪 位置 mm、姿态角 °、夹爪 最准;也最慢
关节角到位 实测六个关节角 关节角 °、夹爪 中等;但关节误差 ≠ 末端误差

三者的执行链路是同一个循环,区别只在"等待条件"。

3. 怎么用这个页面做一次对比#

这一页的用法,本质是同一条记录跑几遍,只改判据,然后比三样东西:用时、两条线贴不贴合、路径长。

操作顺序

上图就是这一页的全部控件,编号是操作顺序。下面按这个顺序走一遍。

第一步:定起点#

  1. 先扶住/托住手臂 → 点「示教」→ 确认后力矩才卸除 → 用手把手臂摆到想要的起点
  2. 点 记录锚点 → 六个关节角被存下来
  3. 再点一次 完成示教,恢复力矩

仿真里没有"用手拖",直接先用其它页把手臂摆好,再点「记录锚点」即可。

第二步:走一遍要复现的动作#

  1. 「动作记录」卡 → 点 记录动作 - 真机会再次卸力,并自动进入示教
  2. 用手带着机械臂把整段动作走完(慢一点,别甩)
  3. 点 结束记录 - 三维视图里会出现一条橙色虚线,那就是刚才 TCP 走过的路

第三步:回到起点#

点 回到锚点,等提示变成"当前就在锚点上(偏差 X°)"。复现必须从锚点起步,否则第一帧会"瞬移"。

锚点可能是在软限位外记下的(示教时手能把关节推出去几度)。回锚点不受软限位限制,会原样回到那个姿态,不会停在限位边界上;急停、工作空间和速度限制仍然生效。

第四步:选判据,跑一次#

  1. 「到位判断」卡里选方式 - 位姿 / 关节两种方式各自有独立的容差,互不影响
  2. 点 开始复现
  3. 复现过程中三维视图会画出绿色实线——实际走过的轨迹

第五步:看三个指标#

看什么 在哪看 说明
用时 复现卡的进度文案(112 / 359 帧) 判据越严,时间越长
两条线贴不贴合 三维视图,从上往下看最清楚 橙 = 应该走的路,绿 = 实际走的路
路径长 「查看数据」→ 摘要 绿线明显短于橙线 = 在抄近路
查看数据

摘要里的路径长是判断"有没有抄近路"最直接的数:记录的 292 mm,关节 8° 那次只走了 228 mm。

第六步:换一种判据再跑#

先点「清空实际轨迹」,否则上一轮的绿线还在,新旧会叠在一起看不清。然后重复第四步。

想中途换判据?先「停止」,改完再「从停止处继续」或「从头重跑」。 「从停止处继续」不要求回到锚点,适合在同一个位置对比两种判据的剩余段。

4. 容差到底在量什么#

末端位姿到位

参数 量的是 默认
位置容差 (mm) 实测 TCP 与记录帧 TCP 的空间距离 5 mm
姿态角容差 (°) pitch、roll 各自的差 3°
夹爪容差 夹爪开度(0–100)的差 3

关节角到位

参数 量的是 默认
关节角容差 (°) 六个关节各自与记录帧的差 3°
夹爪容差 同上 3

容差是"认为到位了"的门槛,不是精度指标。它和机械臂真实的定位精度是两回事—— 门槛设得比真实精度还小,只会让每一帧都等到超时。

5. 实测:同一段记录,六种配置#

一段 359 帧(12.0 s、TCP 走 292 mm)的记录,用六种配置各复现一次:

配置 复现用时 最大偏差 平均偏差 实际路径长
固定时间 33 ms 14.0 s 4.5 mm 0.11 mm 300 mm
固定时间 66 ms 24.0 s 4.2 mm 0.09 mm 300 mm
关节角 1° 17.7 s 3.1 mm 0.23 mm 287 mm
关节角 8° 7.1 s 12.0 mm 4.72 mm 228 mm
末端位姿 2 mm 21.2 s 0.85 mm 0.08 mm 287 mm
末端位姿 15 mm 10.2 s 4.7 mm 1.60 mm 280 mm

("偏差"= 实际轨迹上每一点到记录轨迹的最短距离;"路径长"= 实际走过的总和)

用时与偏差

从表里能读出四件事#

① 最快的最糙。 关节容差 8° 只用 7.1 s(比记录快 40%),代价是最大偏差 12 mm、路径长只有 228 mm——比记录的 292 mm 短了 22%。这不是"走得快",是抄近路:每个转角都被削掉一块。

② 最准的最慢。 位姿 2 mm 花了 21.2 s(记录的 1.8 倍),但最大偏差只有 0.85 mm。

③ 时间模式的误差集中在转角。 33 ms 的平均偏差只有 0.11 mm,看着很准,但最大 4.5 mm ——因为直线段手臂跟得上,一到急转弯就跟不上了,冲出去一点再回来。

④ 关节容差和末端误差不是一回事。 关节容差 1° 时最大偏差 3.1 mm;但同样的 1° 在手臂完全伸直的姿态下可能对应 5–6 mm。关节角的一个固定角度误差,换算成末端距离依赖当前姿态(雅可比),这就是"关节到位"和"位姿到位"最本质的区别。

互动实验

复现对比器

第 5 章实测数据

同一段 359 帧、12.0 s、TCP 走 292 mm 的记录,六种配置各复现一次。点一种配置,比较用时、最大偏差和实际路径长。

当前配置固定时间 33 ms
复现用时14.0 s记录基准 12.0 s
最大偏差4.5 mm越小越贴合
实际路径长300 mm记录基准 292 mm
数据来自第 5 章第 5 节的实测表;这里只做选择和对比,没有重新拟合。路径长短要结合偏差一起看:短得多的那条,通常是在抄近路。

6. 为什么"关节到位"会抄近路#

因为它只要求"六个关节各自接近目标",不关心手臂实际在哪。

举个极端的例子:手臂完全伸直时,肩部关节 1° 大约对应末端 5 mm。容差给 8°,等于允许每一帧都差 40 mm——手臂干脆"跳过"中间那些帧,直接奔向下一段的终点。于是圆角变成尖角,曲线变成折线(本文开头那张图,中间一格)。

这也是为什么要还原轨迹(涂胶、插接、贴面)必须用位姿判据,关节判据只适合 "动作大差不差就行"的场景。

7. 机械臂精度和频率怎么影响选择#

先看三类机械臂的差距#

最小可控角度 重复定位精度 典型容差设置
工业六轴(UR / Fanuc 一类) 约 0.001°(高减速比 + 绝对值编码器) ±0.02–0.1 mm 0.1 mm / 0.1°
Piper(轻量协作臂) 0.13° 亚毫米 0.5 mm / 0.5°
SO-101(本机) 0.088°(4096 计数/圈) 毫米级 1–5 mm / 1–3°

注意:最小转角好看,不代表精度高#

SO-101 的编码器是 4096 计数/圈,360 ÷ 4096 ≈ 0.088°——比 Piper 的 0.13° 还细。但这只是"编码器能数到多细",不是"手臂能停多准"。真正决定精度的是:

  • 塑料齿轮的背隙:反向转几度才开始动
  • 3D 打印结构的刚度:末端一受力就变形
  • 没有重力补偿:上力、卸力都会下垂一点
  • 标定误差:中途位是人手扶着确认的

所以这台臂的重复定位是毫米级,而不是 0.088° 暗示的"丝级"。 0.088° 是分辨率,毫米级 才是精度——两者差着两个数量级。

控制频率的约束#

控制回路跑在 30 Hz,每 33 ms 才能看一眼当前状态:

  • 最小可分辨位移:速度 60 °/s 时,33 ms 内关节已经动了 2°。容差给到 1° 以下,判断结果会在两帧之间来回跳。
  • 检查延迟:即使容差合理,也要多等一个周期才能确认到位。

容差设太小的后果#

每一帧的等待有 3 秒超时。容差比机械精度还小,每一帧都会等满 3 秒才放弃:

text
359 帧 × 3 s ≈ 18 分钟

而且"放弃"之后手臂其实也没到位——既没变准,又慢了几十倍。

结论:低精度机械臂优先用「按固定时间下发指令」#

机械臂 建议
SO-101 这类低精度臂 首选「按固定时间」
Piper 这类轻量协作臂 固定时间为主,必要时用位姿 1 mm
工业臂 「末端位姿到位」有意义,值得为 0.1 mm 多等

为什么低精度臂首选固定时间:

  1. "到位"判据换来的精度会被机械误差吃掉。 位姿 2 mm 确实把最大偏差压到 0.85 mm,可这台臂本身重复定位就在毫米级——追到 1 mm 以内没有实际意义,却要多花 51% 的时间(14.0 s → 21.2 s)。
  2. 平均偏差本来就很小。 固定时间 33 ms 的平均偏差是 0.11 mm,属于最好的一档(66 ms 的 0.09 mm 略低,但综合速度更慢)。误差只集中在急转弯的瞬间,而低精度臂在那些瞬间本来也控制不好。
  3. 不会因为"永远到不了位"而卡死。 固定时间不依赖实测反馈,容差设多小都不会超时。
  4. 配合速度滑块更可控。 慢速 + 固定时间,轨迹平滑度和用时都更好预测。

需要更高还原度时,再退一步用「关节角到位 2–3°」,而不是死磕毫米级容差。

8. 怎么选#

场景 建议
低精度臂(SO-101)跑整段动作 固定时间 33–66 ms
只想看看动作对不对 固定时间 33–66 ms,最快
抓取、放置这类对轨迹不敏感的动作 关节角 3–5°
涂胶、插接、贴面运动(高精度臂) 末端位姿 2–5 mm、姿态 2–3°
真机第一次跑 先用固定时间 66 ms 看清全程,再换判据
复现时总是卡顿 容差太小,先放大再看

另外别忘了速度滑块:它限制的是目标推进的速率,和到位判断是两个独立的旋钮—— 一个管"走多快",一个管"什么时候算到"。

9. 常见误区#

说法 对不对 说明
"容差越小越准" ✗ 小于机械精度就没意义,还会因为超时慢到不可用
"编码器分辨率高就是精度高" ✗ SO-101 是 0.088°,但重复定位只有毫米级
"关节角到位就等于末端到位" ✗ 同样 1° 在不同姿态下对应的末端距离差好几倍
"固定时间模式没有精度" ≈ 平均偏差很小,误差集中在转角
"到位判断能提高定位精度" ✗ 它只决定何时发下一帧,不改变伺服本身的精度
"仿真里调好的参数可以直接上真机" ✗ 真机有间隙、下垂和噪声,容差要放宽 2–5 倍

参考#

  • 第 3 章:末端位姿 —— 位姿的五个分量、joint 与 line 路径
  • 第 4 章:FK 与 IK —— 为什么关节误差换算成末端误差依赖姿态
  • 实验数据:docs/data/arrive-experiment.json,出图脚本 scripts/make_arrive_figures.py