← 返回知识档案
运动与坐标约 2 分钟阅读

差速轮式机器人里程计:从轮速估计位姿

用左右轮行程估计前进距离和转角,并认识打滑与累计误差。

☆ 登录后收藏 0 条评论 ↓

差速底盘用左右两侧轮子的速度差转弯。里程计利用编码器记录的轮子转动,估计机器人运动了多少。它适合提供连续的短时运动估计,但不能独自保证长期位置准确。

基本量

设左右轮在一小段时间内走过的距离分别为 ΔsL 和 ΔsR,轮距为 b。那么机器人中心前进距离和朝向变化可近似为:

Δs = (ΔsR + ΔsL) / 2
Δθ = (ΔsR - ΔsL) / b

若两轮距离相同,机器人近似直行;若两轮距离相反且绝对值相同,机器人近似原地旋转。

把这段运动加到上一时刻位姿 (x, y, θ),一个常见的小步长近似是使用中间朝向:

x_new = x + Δs × cos(θ + Δθ / 2)
y_new = y + Δs × sin(θ + Δθ / 2)
θ_new = θ + Δθ

这里默认平面运动、轮距已知、轮子与地面没有明显打滑。实际系统还要考虑编码器刻度、时间间隔和坐标约定。

为什么会漂移

轮径估错、左右轮不一致、地面打滑和编码器噪声,都会让每一步产生偏差。偏差不断累积,长距离后的估计可能明显偏离真实位置。因此常与其他传感器或定位方法结合。

一个验证实验

让机器人低速走固定距离,再原地转一圈;记录左右轮读数、计算结果和人工测量值。分别比较直行误差与旋转误差,通常比直接调复杂参数更容易找到轮径或轮距配置问题。

读完这篇了?

查看学习路径 →
登录以记录进度

DISCUSSION

评论讨论.

0 条

还没有评论,欢迎提出第一个问题。

END OF NOTE / 继续探索返回全部笔记 ↗