机器人 / 系统课时

用轮距和轮速求解底盘速度

用轮距和轮速求解底盘速度

差速底盘通常通过左右轮电机获得车轮角速度,但机器人导航和里程计需要的是车体中心的前进速度与偏航角速度。本篇使用轮半径、轮距和左右轮角速度建立运动学关系,通过 Python 算例求出底盘速度,并检查直行、转弯和原地旋转时的结果。

学习目标

  • 识别差速底盘的轮半径、轮距和左右轮角速度,统一单位及正方向。
  • 根据两侧轮速计算车体中心的线速度和角速度。
  • 使用 Python 验证计算结果,判断符号、单位和模型适用边界。

确定轮距、轮半径与速度方向

以双轮差速机器人为例,两个驱动轮分别位于车体左右两侧,共用一条横向轮轴。轮速不同会使机器人转弯,轮速相同则沿直线运动。计算前需要统一以下量:

符号 含义 单位
rr 驱动轮有效滚动半径 m
LL 左右驱动轮接地点中心之间的距离 m
ωL\omega_L 左轮角速度 rad/s
ωR\omega_R 右轮角速度 rad/s
vxv_x 车体中心沿前方的线速度 m/s
ωz\omega_z 车体绕竖直轴的角速度 rad/s

采用 ROS 2 常用的 base_link 坐标约定:X 轴向前、Y 轴向左、Z 轴向上。左右轮角速度都以驱动机器人前进为正;车体从上方观察逆时针左转时,ωz\omega_z 为正。

差速底盘轮距、轮半径、左右轮速度及车体坐标关系

轮距 LL 指两侧驱动轮接地点的横向中心间距,不是车体外壳宽度。轮半径 rr 使用有效滚动半径,实际项目中可通过行驶距离标定。若左右轮尺寸不同,应分别使用各自的半径,不能直接套用等半径公式。

从左右轮速度推导车体运动

先假设机器人在水平地面上运动,车轮纯滚动、不侧滑,左右驱动轮半径相同。车轮边缘沿前进方向的线速度等于轮半径乘角速度:

vL=rωL,vR=rωRv_L=r\omega_L,\qquad v_R=r\omega_R

车体中心位于两侧驱动轮中间,因此中心的前进线速度等于左右轮线速度的平均值:

vx=vR+vL2=r(ωR+ωL)2v_x=\frac{v_R+v_L}{2}=\frac{r(\omega_R+\omega_L)}{2}

转弯时,左右轮相对车体中心分别位于横向距离 L/2L/2 处。如果车体绕 Z 轴以 ωz\omega_z 旋转,则右轮线速度比中心高 ωzL/2\omega_zL/2,左轮低同样的量。两式相减可得:

ωz=vR−vLL=r(ωR−ωL)L\omega_z=\frac{v_R-v_L}{L}=\frac{r(\omega_R-\omega_L)}{L}

这两个公式共同构成差速底盘的正向运动学模型。计算结果可对应到 ROS 2 的 geometry_msgs/msg/Twist 消息中的 linear.x 和 angular.z,但由车轮测量值算出的速度应视为运动估计,而不是直接向电机发送的命令。

方向可以直接从轮速差判断:

  • ωR=ωL\omega_R=\omega_L:角速度为零,机器人直行或倒退。
  • ωR>ωL\omega_R>\omega_L:角速度为正,机器人左转。
  • ωR<ωL\omega_R<\omega_L:角速度为负,机器人右转。
  • ωR=−ωL\omega_R=-\omega_L:线速度为零,机器人绕车体中心原地旋转。

使用 Python 计算底盘线速度与角速度

假设驱动轮半径为 0.05 m,左右轮距为 0.30 m。当前左轮角速度为 6 rad/s,右轮角速度为 10 rad/s。右轮转得更快,预期机器人一边前进一边左转。

将以下代码保存为 diff_drive_forward.py,使用 Python 3 运行。示例只依赖标准语言功能,不需要安装额外的软件包。

python
r = 0.05
track = 0.30
omega_left = 6.0
omega_right = 10.0

# 统一将轮角速度转换成轮缘线速度
v_left = r * omega_left
v_right = r * omega_right

# 车体中心线速度取平均值,左转角速度为正
vx = (v_left + v_right) / 2.0
wz = (v_right - v_left) / track

print(f"vL={v_left:.3f} m/s, vR={v_right:.3f} m/s")
print(f"linear.x={vx:.3f} m/s")
print(f"angular.z={wz:.3f} rad/s")

# 直行时角速度为零,不存在有限的转弯半径
if abs(wz) > 1e-9:
    print(f"turn_radius={vx / wz:.3f} m")
else:
    print("turn_radius=infinite (straight)")

执行命令:

bash
python3 diff_drive_forward.py

预期输出:

text
vL=0.300 m/s, vR=0.500 m/s
linear.x=0.400 m/s
angular.z=0.667 rad/s
turn_radius=0.600 m

输出表明,左轮沿地面前进的速度为 0.30 m/s,右轮为 0.50 m/s,车体中心以 0.40 m/s 前进,同时以约 0.667 rad/s 左转。

转弯半径采用 R=vx/ωzR=v_x/\omega_z 计算,代表车体中心到瞬时旋转中心的有符号距离。本例为 0.60 m,瞬时旋转中心位于车体左侧。代码只在角速度非零时计算有限半径,避免直行时出现除零错误。

检查典型运动与输入单位

同样使用 r=0.05r=0.05 m、L=0.30L=0.30 m,可以用三组轮速判断实现是否正确:

左轮 rad/s 右轮 rad/s vxv_x m/s ωz\omega_z rad/s 运动结果
6 6 0.300 0 向前直行
-6 6 0 2.000 原地左转
10 6 0.400 -0.667 向右转弯

将代码中的 omega_left 和 omega_right 依次替换为表中的值,再运行并核对 linear.x 与 angular.z。表格数值按三位小数显示,浮点计算结果允许存在微小舍入差异。

真实底盘接入时,重点检查以下边界:

  1. 转速单位:公式要求 rad/s。如果电机接口提供 rpm,需要先使用 ω=rpm×2π/60\omega=\mathrm{rpm}\times 2\pi/60 转换。例如 60 rpm 对应约 6.283 rad/s。
  2. 编码器计数:若输入是脉冲计数,应先根据采样时间、减速比和每轮实际计数换算成轮角速度,不能直接把计数送入公式。
  3. 轮距标定:当机器人实测转弯角度持续偏离理论值时,应检查有效轮距和轮半径,而不是随意给计算出的角速度乘修正系数。
  4. 运动模型边界:公式假设无侧滑。地面湿滑、轮胎变形、碰撞或单侧车轮悬空时,计算值不一定等于真实车体速度,需要结合 IMU 等传感器进行估计。

对于理想平面差速运动,车体坐标系中的横向速度 linear.y 取 0。若系统持续估计出明显横向位移,应检查轮胎打滑、坐标变换或定位误差,不能通过正向运动学公式直接解释为底盘具备横向驱动能力。

实际验收时,先让左右轮以相同正角速度转动,确认 angular.z 接近零;再让右轮速度高于左轮,确认 angular.z 为正。只有在单位、轮序和正方向一致后,计算出的底盘速度才适合作为轮式里程计和运动控制的基础输入。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

用轮距和轮速求解底盘速度

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通