行业应用深读

AGV 驱动轮里程计:轮径、编码器线数与航位推算误差

AGV 驱动轮里程计:轮径、编码器线数与航位推算误差

差速 AGV 用驱动轮编码器做航位推算。本文算出轮径 150 mm、减速比 20、1000 线时 5.89 μm 的分辨率,比较量化误差(10 m 处 0.24 mm)与 0.5% 轮径差(0.5 m)的悬殊,给出分辨率的合理区间和标定重点。

差速 AGV 的航位推算只用两只驱动轮的编码器:每个采样周期取左右轮的位移,由它们的差得到航向变化。选型时常有一个疑问:电机编码器线数是不是越高,里程计越准?先把误差按来源分开,答案是否定的。

AGV 沿直线行驶 10 m:两轮轮径相差 0.5% 时,推算轨迹(红)逐渐偏离真实直线(蓝),横向偏差按距离的平方增长,终点处 0.5 m;±1 计数的量化误差只有 0.24 mm
图1 AGV 沿直线行驶 10 m:两轮轮径相差 0.5% 时,推算轨迹(红)逐渐偏离真实直线(蓝),横向偏差按距离的平方增长,终点处 0.5 m;±1 计数的量化误差只有 0.24 mm

模型:转角误差怎样变成横向偏差

设左右轮位移增量为 Δs_L、Δs_R,轴距为 b,则

Δs = (Δs_R + Δs_L)/2,Δψ = (Δs_R − Δs_L)/b

其中 Δs 为车体前进量,Δψ 为航向变化。航向误差 ψ_err 在之后每前进 s,横向偏差就增加 ψ_err·s。两类误差的性质不同:

  • 有界误差:编码器量化。计数是累加量,不会丢失,每个轮子的累计位移误差始终不超过 ±1 个计数,航向误差有界,横向偏差只随距离线性增长。
  • 累积误差:两轮每转的行程不同,比如轮径差、轴距有效值偏差。航向误差本身随距离增长,横向偏差按距离平方增长。

量化误差:5.89 μm 的分辨率

算例:轮径 150 mm(周长 471.2 mm),减速比 20,1000 线电机编码器四倍频,则

每轮转计数 = 4000 × 20 = 80 000,每计数 = 471.2 mm ÷ 80 000 = 5.89 μm

两轮各有 ±1 个计数的偏差,轴距取 0.5 m,航向误差上界 Δψ = 2 × 5.89 μm ÷ 0.5 m = 2.36×10⁻⁵ rad(4.9″)。直行 10 m 后横向偏差上界为 2.36×10⁻⁵ × 10 m = 0.24 mm。

轮径差:二次增长

两轮直径相差 ε 时,若真实路径是直线,两轮实际滚过的路程相同,而按名义轮径推算,左右轮路程之差为 ε·s,所以

ψ(s) = ε·s/b,y(s) = ε·s²/(2b)

其中 y 为推算位置与真实路径的横向偏差。ε = 0.5%(150 mm 轮径上约 0.75 mm 的直径差,例如磨损不均)、b = 0.5 m 时,10 m 处 ψ = 0.1 rad(5.7°),y = 0.5 m。反过来,若按名义轮径控制两轮走相同的计数,真实路径就会弯成半径 b/ε = 100 m 的圆弧,偏差大小相同。b = 0.5 m 时 y = ε·s²:

ε \ s2 m5 m10 m20 m
0.1%4 mm25 mm100 mm400 mm
0.5%20 mm125 mm500 mm2000 mm

10 m 处各项误差的大小见图2。0.5% 的径差比量化误差大约 2100 倍;轴距有效值偏 1%,转 90° 后航向多出 0.9°,直行 10 m 偏 157 mm;两轮同时偏小 0.5% 不影响航向,只在行进方向上造成 50 mm 的距离误差。

直行 10 m 后各项推算误差(对数轴):量化最小,轮径差、轴距偏差等系统项大二到三个数量级,径差标定到 ±5 mm 后残余约 5 mm
图2 直行 10 m 后各项推算误差(对数轴):量化最小,轮径差、轴距偏差等系统项大二到三个数量级,径差标定到 ±5 mm 后残余约 5 mm

分辨率的合理区间

分辨率的下限由低速测速决定,不由里程计决定。最低行驶速度取 50 mm/s,测速窗口 10 ms,窗口内走过的计数为 0.05 × 0.01 ÷ 5.89 μm = 85 个,速度分辨率约 1.2%。若要求不低于 2%(至少 50 个计数),每计数不大于 10 μm,即每轮转不少于 47 100 个计数,对应四倍频、减速比 20 的编码器约 590 线以上。取 1000 线时 1.2%,500 线时 2.4%(图3)。

上限没有意义:线数再增加,量化引起的横向误差从 0.24 mm 降到 0.02 mm,对比 0.5 m 的系统偏差毫无影响。若电机本来就用 17–23 位编码器,直接取用即可,不必为里程计专门提高。更低速度下改用测脉冲间隔的方法(M/T 法),可以在不增加线数的情况下提高速度分辨率。

线数与分辨率:线数每增加一倍,速度分辨率和量化横向误差各减半,1000 线时分别为 1.2% 和 0.24 mm
图3 线数与分辨率:线数每增加一倍,速度分辨率和量化横向误差各减半,1000 线时分别为 1.2% 和 0.24 mm

校准的重点

  • 轮径差:让 AGV 在不修正航向的条件下直行 10 m,测量实际路径相对直线的横向偏差 y,则 ε = 2·b·y/s²。起始航向误差会带来线性项,宜在多个距离点上做二次拟合。y 的测量误差为 ±5 mm 时,ε 的不确定度为 2 × 0.5 × 0.005 ÷ 100 = 0.005%。标定后在距离 s 上的残余偏差约为 ±5 mm × (s/10 m)²。
  • 轴距有效值:原地旋转若干圈,用外部基准(如固定靶标)测量实际转角,与推算转角比较得到修正系数。
  • 随时间的变化:聚氨酯轮的轮径随磨损、载荷和温度改变,应定期重标,或用陀螺仪给出航向并在线估计径差。
  • 打滑:编码器在电机侧,打滑和轮面蠕动看不见,需用地标或激光定位周期性修正。

工程要点

  • 先算误差来源的数量级:量化 0.24 mm,轮径差 0.5% 即 0.5 m,优化对象是后者。
  • 每计数 5–10 μm 的分辨率对里程计已足够,1000 线、5.89 μm/计数是合理起点。
  • 线数下限按最低速度下测速窗口内至少 50 个计数确定,约 590 线(减速比 20、四倍频)。
  • 用 10 m 直行测横向偏差标定径差:ε = 2·b·y/s²,±5 mm 的测量精度对应 0.005%。
  • 左右轮选用同批次、同磨损状态的轮子,并定期复核径差,0.1% 的差就有 100 mm 的 10 m 偏差。
  • 里程计只管短时间的相对位置,长距离靠陀螺仪或地标修正。

小结

驱动轮里程计的误差由系统项主导:量化有界,10 m 处只有 0.24 mm;轮径差使横向偏差按距离平方增长,0.5% 就是 0.5 m。编码器分辨率取到 5–10 μm/计数已经足够,高线数不会改善里程计,值得投入的是径差和轴距的标定,以及用陀螺仪或地标做定期修正。

延伸阅读:ENC7 编码器码盘生产厂家(中文主页) · 码盘技术文库


关于我们:晶正光电专注编码器码盘研发制造,玻璃、金属、PC 码盘均可按图定制。

官网:https://enc7.com

© 廊坊晶正光电技术有限公司 版权所有,未经书面许可不得转载、摘编。本文借助 AI 辅助创作。

Have a drawing? Get an engineer's review.

Send your outer diameter, bore, line count or bit count, substrate and readhead wavelength. Our engineers check manufacturability and reply with a quotation and sample lead time.

WhatsApp