第二章 动力学模型入门

说实话，刚入行那会儿，我觉得动力学模型就是一堆吓人的公式。直到有一次，我调试的六轴机器人突然在高速运动时剧烈抖动——嗯，那时候我才真正意识到，不懂动力学，你连问题出在哪都找不到。

这一章，咱们就把动力学模型的底裤扒干净。别怕，我会用最接地气的方式讲清楚。

2.1 牛顿-欧拉方程：力与运动的"老熟人"

先说说牛顿-欧拉方程。说白了，它就是牛顿第二定律在旋转运动上的延伸。你想想看，一个物体平动时，F=ma；那它转动时呢？τ=Iα，就这么简单。

我个人习惯把牛顿-欧拉方程拆成两部分看：

• 牛顿方程：描述质心的平动，F = m·a
• 欧拉方程：描述绕质心的转动，τ = I·α + ω × (I·ω)

注意后面那个ω × (I·ω)，这就是科里奥利力和离心力的来源。我在项目中遇到过一台协作机器人，低速时好好的，一加速就抖。查了半天，就是没考虑这个耦合项。

2.2 拉格朗日方程：从能量角度看问题

拉格朗日方程，我个人觉得它更"优雅"。它不关心具体的力是怎么传的，只看系统的能量变化。

公式长这样：

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

其中L = T - V，就是动能减势能。你想想看，只要写出系统的动能和势能，剩下的就是求导。是不是比牛顿-欧拉那种"推来推去"省事多了？

不过，拉格朗日法也有坑。我曾经在写一个七自由度机械臂的动力学模型时，用拉格朗日法推导，结果符号搞反了，仿真直接飞了。后来我学乖了——先用数值方法验证一下符号对不对。

2.3 惯性矩阵：转动惯量的"升级版"

惯性矩阵，其实就是转动惯量在三维空间中的推广。单个关节的转动惯量是个标量，但到了多轴机器人，每个连杆的惯性分布就变成了一个3×3的矩阵。

为什么是矩阵？因为一个连杆绕不同轴的转动惯量不一样。比如一个长杆，绕长轴转很容易，绕垂直轴转就很费劲。这个差异，就是惯性矩阵要表达的。

符号	含义	典型值（kg·m²）
Ixx	绕x轴的转动惯量	0.01 ~ 0.5
Iyy	绕y轴的转动惯量	0.01 ~ 0.5
Izz	绕z轴的转动惯量	0.005 ~ 0.3
Ixy, Ixz, Iyz	惯性积（耦合项）	通常很小，但不可忽略

这里要注意，惯性矩阵是随关节角度变化的。你想想看，机械臂伸直时和蜷缩时，整体的惯性能一样吗？当然不一样。所以实时控制中，惯性矩阵必须在线更新。

2.4 科里奥利力与离心力：高速运动的"隐形杀手"

这两个力，说白了就是"运动耦合"的产物。科里奥利力是速度耦合，离心力是速度平方项。

公式上，它们长这样：

C(q, q̇) · q̇

其中C矩阵的每个元素都是q̇的线性函数。为什么说它们是"隐形杀手"？因为低速时它们几乎没影响，但速度一上来，它们会迅速增大。

我记得有一次调试一个高速码垛机器人，速度设到2m/s时，末端轨迹开始画圈。排查了三天，最后发现是科里奥利力项没补偿。加上之后，稳如老狗。

2.5 重力项：永远存在的"老对手"

重力项最简单，但也最容易被忽视。它就是每个连杆的重力在关节空间中的映射。

公式：

G(q) = ∂U/∂q

其中U是系统的总势能。对于平面机器人，重力项可能只在某些关节上出现；但对于空间机器人，每个关节都受重力影响。

我见过不少初学者，仿真时跑得挺好，一上实物就往下掉。为什么？因为仿真里重力是默认开启的，但实际控制代码里忘了加重力补偿。

2.6 知识体系总览

下面这张图，是我自己总结的动力学模型知识框架。你可以把它当作"地图"，随时回来对照。

这张图把动力学模型的脉络理清了。你从牛顿-欧拉或拉格朗日出发，最终都会落到那个标准方程上。说白了，四个项各司其职：惯性矩阵管加速度，科里奥利力和离心力管速度耦合，重力项管位置依赖。

嗯，这一章的内容就到这。记住，动力学模型不是背公式，而是理解每个项背后的物理意义。下次调试时遇到问题，回来翻翻这张图，思路会清晰很多。