1. 双差速小车:从玩具到工业机器人的核心秘密
如果你玩过乐高机器人或者自己组装过小车,大概率接触过一种最简单的结构:左右两边各装一个轮子,每个轮子由一个独立的电机驱动。这种结构,就是我们今天要深入聊的双差速小车模型。别看它结构简单,从家里的扫地机器人,到仓库里跑来跑去搬运货物的AGV(自动导引运输车),再到餐厅里的送餐机器人,它的身影无处不在。为什么这种设计如此受欢迎?核心原因就两个字:灵活。它既能像汽车一样直行,又能像坦克一样原地旋转,甚至能走出任意曲率的弧线,几乎能到达平面上任何你想去的位置。
我刚开始接触机器人时,也觉得这玩意儿太“基础”了,不就是两个轮子转嘛。但真正上手做项目,想让小车沿着一条直线稳稳地走,或者精准地旋转90度时,才发现里面大有学问。为什么我给了电机同样的指令,小车却跑偏了?为什么我想让它转个弯,它却画起了弧线?这些问题背后,都指向了双差速模型的两个核心理论支柱:运动学和动力学。
运动学关心的是“几何关系”:给定了左右轮子转多快,我的机器人整体会怎么运动(位置、朝向、速度)?反过来,我想让机器人以某个速度和角度运动,左右轮子应该转多快?这就是运动学的正解和逆解问题。而动力学则更深入一层,关心“力和运动”的关系:我的电机究竟要出多大的力(扭矩),才能让轮子克服摩擦力、惯性,达到我想要的转速?这决定了我们电机的选型和控制器的设计。
所以,这篇文章的目的很明确:我们不只停留在书本上的公式。我会带你一起,把这些看似枯燥的公式,变成实实在在的代码,再通过一个模拟场景,看看它们是如何指挥一个“虚拟机器人”完成任务的。你会发现,理论不再是纸上谈兵,而是你手中调试机器人、解决实际问题的有力工具。无论你是机器人专业的学生,还是刚入行的工程师,相信这篇从理论推导到代码实践,再到仿真验证的全程解析,都能让你对双差速小车有一个透彻的理解。
2. 运动学:搞懂机器人“怎么走”的几何语言
运动学就像是机器人的“GPS导航算法”,它不关心为什么能走,只关心根据轮子的转动,机器人会走到哪里。对于双差速模型,运动学模型是我们进行一切控制的基础,必须首先吃透。
2.1 运动学正解:从轮子速度推算整车运动
让我们先来拆解一下双差速小车的几何结构。想象一下,你的机器人底盘中间有一条虚拟的“轴线”,连接着左右两个轮子的中心点,这个距离就是轴距(L)。每个轮子都有自己的半径(r)。当左轮以角速度 ω_L 旋转时,它的边缘线速度就是 v_L = r * ω_L。右轮同理,v_R = r * ω_R。
那么,整个机器人的运动状态怎么用这两个轮速来表示呢?这里我们需要引入一个关键概念:瞬时转动中心(ICR)。在任何瞬间,一个在平面上刚体运动的物体,都可以看作是在绕某个点做瞬时旋转。对于双差速小车,这个点就在两个驱动轮轴线的延长线上。具体位置取决于左右轮的速度差。
基于这个几何关系,我们可以推导出两个核心公式:
-
机器人的线速度(v):这是机器人质心(通常位于两轮轴线中点)前进的速度。很直观,它就是左右轮线速度的平均值。因为如果两轮速度一样,机器人直行,中点速度就是轮速;如果速度不同,中点速度也正好是平均速度。
v = (v_L + v_R) / 2 = r * (ω_L + ω_R) / 2 -
机器人的角速度(ω):这是机器人绕自身中心旋转的快慢。想象一下,如果右轮比左轮快,机器人就会向左转。速度差(v_R - v_L)越大,转得就越急。这个速度差需要除以轴距(L),才能得到旋转的角速度。
ω = (v_R - v_L) / L = r * (ω_R - ω_L) / L
我刚开始总记混角速度的公式,后来用一个生活类比就明白了:你和朋友并排推一个柜子,你俩用力大小不同,柜子就会一边前进一边打转。你俩的推力差,就相当于(v_R - v_L),柜子的宽度就是轴距(L)。推力差越大,柜子转得越快;柜子越宽,同样的推力差让它转得越慢。这个公式完美地描述了这种现象。
在代码里实现正解非常简单。我们定义一个函数,输入左右轮子的角速度和机器人的参数(轮半径、轴距),输出机器人的线速度和角速度。这个函数在机器人状态估计(比如用编码器数据推算位置)时至关重要。
// 运动学正解:由轮速计算机器人速度
Velocity forwardKinematics(const WheelSpeeds& wheel_speeds, const RobotParams& params) {
double v_left = params.wheel_radius * wheel_speeds.left;
double v_right = params.wheel_radius * wheel_speeds.right;
Velocity vel;
vel.linear = (v_left + v_right) / 2.0; // 线速度
vel.angular = (v_right - v_left) / params.axle_length; // 角速度
return vel;
}
2.2 运动学逆解:从整车指令反推轮子该转多快
正解是从底层传感器(编码器)数据理解机器人状态,而逆解则是我们控制机器人的直接工具。作为开发者,我们通常思考的是:“我要让机器人以0.5米/秒的速度直线前进”,或者“我要让机器人原地顺时针旋转,角速度1弧度/秒”。逆解模型就是回答“那么,左右电机应该分别设定为多少转速?”这个问题的。
从正解公式反推,我们可以得到逆解公式:
- 左轮线速度:
v_L = v - (L * ω) / 2 - 右轮线速度:
v_R = v + (L * ω) / 2
然后,再除以轮半径,就得到了角速度指令: ω_L = v_L / r, ω_R = v_R / r
这个公式非常优美。当你想让机器人直行(ω=0)时,公式简化为 v_L = v_R = v,左右轮速度相同。当你想让机器人原地旋转(v=0)时,公式变为 v_L = - (Lω)/2, v_R = (Lω)/2,左右轮速度大小相等、方向相反,完美实现原地转向。当
321



被折叠的 条评论
为什么被折叠?



