到位判断
配套页面:控制台的「到位判断」页签
1. 复现其实只做两件事#
记录下来的东西是一串帧:每 1/30 秒一条,每条含六个关节角 + TCP 位姿 + 夹爪开合。
复现就是循环做两件事:
取第 i 帧 → 下发六个关节目标 → 决定什么时候发第 i+1 帧 → …
TCP 位姿也会被记录,但它用于「末端位姿到位」判据;真正下发的目标是关节角。
第二种事就是"到位判断"。它不改变定位精度,只决定节奏——而这直接决定了复现要跑多久、轨迹还原得多准。
2. 三种判据#
| 判据 | 拿什么判断"可以发下一帧了" | 参数 | 特点 |
|---|---|---|---|
| 按固定时间 | 不做判断,到点就发 | 下发间隔(ms,默认 33) | 最快;手臂跟不上时会"抹平"转角 |
| 末端位姿到位 | 实测 TCP 位置 + pitch/roll + 夹爪 | 位置 mm、姿态角 °、夹爪 | 最准;也最慢 |
| 关节角到位 | 实测六个关节角 | 关节角 °、夹爪 | 中等;但关节误差 ≠ 末端误差 |
三者的执行链路是同一个循环,区别只在"等待条件"。
3. 怎么用这个页面做一次对比#
这一页的用法,本质是同一条记录跑几遍,只改判据,然后比三样东西:用时、两条线贴不贴合、路径长。
上图就是这一页的全部控件,编号是操作顺序。下面按这个顺序走一遍。
第一步:定起点#
- 先扶住/托住手臂 → 点「示教」→ 确认后力矩才卸除 → 用手把手臂摆到想要的起点
- 点 记录锚点 → 六个关节角被存下来
- 再点一次 完成示教,恢复力矩
仿真里没有"用手拖",直接先用其它页把手臂摆好,再点「记录锚点」即可。
第二步:走一遍要复现的动作#
- 「动作记录」卡 → 点 记录动作 - 真机会再次卸力,并自动进入示教
- 用手带着机械臂把整段动作走完(慢一点,别甩)
- 点 结束记录 - 三维视图里会出现一条橙色虚线,那就是刚才 TCP 走过的路
第三步:回到起点#
点 回到锚点,等提示变成"当前就在锚点上(偏差 X°)"。复现必须从锚点起步,否则第一帧会"瞬移"。
锚点可能是在软限位外记下的(示教时手能把关节推出去几度)。回锚点不受软限位限制,会原样回到那个姿态,不会停在限位边界上;急停、工作空间和速度限制仍然生效。
第四步:选判据,跑一次#
- 「到位判断」卡里选方式 - 位姿 / 关节两种方式各自有独立的容差,互不影响
- 点 开始复现
- 复现过程中三维视图会画出绿色实线——实际走过的轨迹
第五步:看三个指标#
| 看什么 | 在哪看 | 说明 |
|---|---|---|
| 用时 | 复现卡的进度文案(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。关节角的一个固定角度误差,换算成末端距离依赖当前姿态(雅可比),这就是"关节到位"和"位姿到位"最本质的区别。
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 秒才放弃:
359 帧 × 3 s ≈ 18 分钟
而且"放弃"之后手臂其实也没到位——既没变准,又慢了几十倍。
结论:低精度机械臂优先用「按固定时间下发指令」#
| 机械臂 | 建议 |
|---|---|
| SO-101 这类低精度臂 | 首选「按固定时间」 |
| Piper 这类轻量协作臂 | 固定时间为主,必要时用位姿 1 mm |
| 工业臂 | 「末端位姿到位」有意义,值得为 0.1 mm 多等 |
为什么低精度臂首选固定时间:
- "到位"判据换来的精度会被机械误差吃掉。 位姿 2 mm 确实把最大偏差压到 0.85 mm,可这台臂本身重复定位就在毫米级——追到 1 mm 以内没有实际意义,却要多花 51% 的时间(14.0 s → 21.2 s)。
- 平均偏差本来就很小。 固定时间 33 ms 的平均偏差是 0.11 mm,属于最好的一档(66 ms 的 0.09 mm 略低,但综合速度更慢)。误差只集中在急转弯的瞬间,而低精度臂在那些瞬间本来也控制不好。
- 不会因为"永远到不了位"而卡死。 固定时间不依赖实测反馈,容差设多小都不会超时。
- 配合速度滑块更可控。 慢速 + 固定时间,轨迹平滑度和用时都更好预测。
需要更高还原度时,再退一步用「关节角到位 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