3. 动力学基础：拉格朗日方程，牛顿-欧拉递推，惯性矩阵与科里奥利力

好，咱们进入动力学部分了。说实话，很多做轨迹规划的工程师，一听到「动力学」三个字就头大。我当年也一样，觉得能跑通运动学就够了，干嘛还要折腾力？

直到有一次，我做一个高速搬运的项目。运动学算得好好的，轨迹也平滑，结果一跑起来，机器人末端抖得跟筛糠似的。嗯，从那以后我明白了——没有动力学，轨迹规划就是空中楼阁。

这一章，咱们就啃下这块硬骨头。我会用最直白的方式，把拉格朗日方程、牛顿-欧拉递推、惯性矩阵和科里奥利力讲清楚。

3.1 为什么要学动力学？

说白了，运动学只告诉你「关节转多少度，末端到哪」。但动力学回答的是：「要产生这个运动，电机需要出多大的力？」

你想想看，如果不知道力矩需求，你怎么选电机？怎么避免关节过载？怎么在高速运动时保证精度？

我个人习惯把动力学分成两大流派：

• 拉格朗日法：从能量角度出发，适合推导整个系统的动力学方程
• 牛顿-欧拉法：从力和力矩的平衡出发，适合实时计算

两者本质等价，但应用场景不同。咱们一个一个来。

3.2 拉格朗日方程：从能量看世界

拉格朗日方程的形式很简单：

τ = d/dt (∂L/∂q̇) - ∂L/∂q

其中 L = T - V，也就是动能减去势能。q 是广义坐标，τ 是广义力。

看着有点抽象对吧？我刚开始学的时候也懵。后来在项目里推导一个二连杆的动力学，才真正理解了它的妙处。

举个例子：一个单摆，质量 m，杆长 l。

• 动能 T = ½ m l² θ̇²
• 势能 V = m g l (1 - cosθ)
• 拉格朗日量 L = T - V

代入方程，得到：

m l² θ̈ + m g l sinθ = τ

这就是单摆的动力学方程。简单吧？

3.3 牛顿-欧拉递推：适合实时计算

如果说拉格朗日法是「全局视角」，那牛顿-欧拉法就是「局部视角」。它从每个连杆的力和力矩平衡出发，递推计算。

算法分两步：

1. 正向递推：从基座到末端，计算每个连杆的速度、加速度
2. 反向递推：从末端到基座，计算每个关节的力和力矩

我曾经在一个六轴机器人项目里，用牛顿-欧拉法做实时力矩前馈控制。效果非常好，轨迹跟踪误差直接降了一个数量级。

伪代码大概长这样：

# 正向递推：计算速度和加速度
for i = 1 to n:
    ω[i] = ω[i-1] + q̇[i] * z[i-1]
    α[i] = α[i-1] + q̈[i] * z[i-1] + ω[i-1] × (q̇[i] * z[i-1])
    a[i] = a[i-1] + α[i] × r[i] + ω[i] × (ω[i] × r[i])

# 反向递推：计算力和力矩
for i = n down to 1:
    F[i] = m[i] * a[i]
    N[i] = I[i] * α[i] + ω[i] × (I[i] * ω[i])
    f[i] = F[i] + f[i+1]
    n[i] = N[i] + n[i+1] + r[i] × f[i]
    τ[i] = n[i] · z[i-1]

3.4 惯性矩阵与科里奥利力

现在咱们聊聊动力学方程里的两个关键角色。

标准的机器人动力学方程可以写成：

M(q) q̈ + C(q, q̇) q̇ + G(q) = τ

其中：

• M(q)：惯性矩阵，描述质量分布
• C(q, q̇)：科里奥利力和离心力矩阵
• G(q)：重力项

惯性矩阵

说白了，惯性矩阵就是「转动惯量」的推广。对于单关节，它就是 J·q̈。对于多关节，它是一个对称正定矩阵，描述了每个关节加速度对其他关节力矩的影响。

我记得有一次调试一个SCARA机器人，发现末端在高速运动时，第二个关节的力矩异常大。一查，原来是惯性矩阵里的耦合项在作怪。后来加了前馈补偿，问题就解决了。

科里奥利力

这个名词听着吓人，其实很简单。你想想看，当你转动一个关节时，另一个关节的运动会产生一个「虚拟力」，这就是科里奥利力。

举个例子：你坐在旋转木马上，伸手去够一个东西。你的手臂运动会受到一个侧向的力——这就是科里奥利力在起作用。

在机器人里，科里奥利力与速度的平方成正比。所以速度越快，影响越大。高速轨迹规划时，这个项不能忽略。

3.5 知识体系总览

下面这张图，是我自己总结的动力学知识框架。每次做项目前，我都会对照着梳理一遍思路。

3.6 实战中的避坑指南

最后，分享几个我踩过的坑：

• 惯性矩阵一定要对称正定：如果发现不对称，检查是不是坐标系搞错了
• 科里奥利力在低速时可以忽略：但速度超过某个阈值（我一般取0.5 rad/s），就必须考虑
• 重力补偿是基础：很多控制问题，加上重力补偿就解决了一半
• 参数辨识很重要：理论算出来的惯性参数往往不准，最好用实验数据拟合

好了，动力学基础就讲到这里。这些概念虽然抽象，但只要你动手推导一遍，再结合项目实践，很快就能掌握。记住，动力学不是理论，是工具——用好了，你的轨迹规划就能上一个台阶。