第二章：动力学基础——牛顿-欧拉方程、拉格朗日方程、机器人动力学模型辨识基础

各位同学，欢迎来到动力学这一章。说实话，很多做机器人控制的工程师，一听到「动力学」三个字就头大。我当年刚入行时也一样，觉得运动学够用了，干嘛还要动力学？直到有一次，我调试一个六轴机械臂的力控抓取，发现运动学算得再准，末端执行器一碰到物体就抖得跟筛子似的……嗯，从那以后，我老老实实把动力学补上了。

动力学说白了，就是研究「力与运动的关系」。你给电机一个力矩，关节到底怎么动？反过来，你希望关节按某个轨迹动，需要算多大的力矩？这就是动力学要回答的两个核心问题。今天咱们就聊三个重点：牛顿-欧拉方程、拉格朗日方程，以及怎么在实际中把动力学模型「辨识」出来。

2.1 牛顿-欧拉方程：从单刚体到多连杆

先讲最直观的方法——牛顿-欧拉。这个方法的核心思想其实很简单：对每个连杆，分别做平动和转动的受力分析。

对于单个刚体，牛顿方程和欧拉方程分别是：

牛顿方程：F = m * a
欧拉方程：τ = I * α + ω × (I * ω)

这里F是合力，m是质量，a是质心加速度。τ是合力矩，I是惯性张量，α是角加速度，ω是角速度。注意那个叉乘项ω × (I * ω)，这是科里奥利力和离心力的来源。我在项目中遇到过有人忽略这一项，结果高速运动时力矩计算差了30%以上，电机直接过载报警。

对于多连杆机器人，我们需要从基座开始，逐级向外递推。先算每个连杆的速度、加速度，再算每个连杆受到的力和力矩，最后反向递推得到关节驱动力矩。这个过程叫「牛顿-欧拉递推算法」，计算效率很高，适合实时控制。

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

如果你觉得牛顿-欧拉法太「暴力」，那拉格朗日方程就是另一种思路——从能量角度出发。你想想看，一个机械臂在运动，它的动能和势能一直在变化。拉格朗日函数L = T - V，其中T是总动能，V是总势能。然后动力学方程就是：

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

这里q是关节角度，q̇是关节角速度，τ是广义力（也就是关节力矩）。

这个方法的好处是：你不需要去分析每个连杆上的约束力，只需要写出整个系统的能量表达式。对于自由度不多的机器人，手算拉格朗日方程还挺方便的。我记得有一次做SCARA机器人的动力学建模，用牛顿-欧拉法推导了整整两页纸，换成拉格朗日法，半页就搞定了。

但要注意，拉格朗日法推导出来的方程形式是：

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

其中M是惯性矩阵，C是科里奥利力和离心力矩阵，G是重力项。这个形式非常经典，也是后面做控制的基础。

2.3 机器人动力学模型辨识基础

好，理论讲完了，问题来了：你推导出来的M、C、G矩阵里，有质量、质心位置、惯性张量等参数。这些参数你从CAD模型里能拿到吗？能，但往往不准。为什么？因为电机转子、减速器、线缆这些「隐藏质量」很难精确建模。我曾经遇到过一台机器人，CAD模型算出来的质量比实际轻了15%，结果力矩前馈一直偏小，轨迹跟踪误差肉眼可见。

所以，我们需要做「动力学模型辨识」。说白了，就是通过实验数据，把模型里的未知参数「拟合」出来。

基本步骤是这样的：

1. 激励轨迹设计：让机器人跑一组充分激励的轨迹，比如傅里叶级数轨迹，确保所有关节都动起来，且速度、加速度变化丰富。
2. 数据采集：记录关节角度、角速度、角加速度，以及对应的关节力矩（通常通过电流传感器换算）。
3. 参数线性化：把动力学方程写成Y(q, q̇, q̈) * θ = τ的形式。Y是观测矩阵，θ是待辨识的参数向量（质量、质心、惯量等）。
4. 最小二乘求解：用采集到的多组数据，求解θ = (Y^T * Y)^{-1} * Y^T * τ。

另外，辨识出来的参数还需要做「验证」。让机器人跑一条新的轨迹，用辨识出的模型预测力矩，跟实际力矩对比。如果误差在5%以内，基本就合格了。如果误差很大，别急着调参数，先检查一下数据采集有没有问题——我遇到过传感器噪声太大、采样不同步的情况，折腾了两天才发现是线缆接触不良。

2.4 知识体系总览

为了让大家对本章内容有个整体印象，我画了一张图，把动力学建模的两种方法和辨识流程串起来：

从这张图可以看得很清楚：牛顿-欧拉法和拉格朗日法虽然推导路径不同，但最终都指向同一个目标——建立机器人的动力学模型。而辨识环节，就是把理论模型和实际机器人「对齐」的关键一步。

2.5 小结

这一章的内容，说白了就是三件事：

• 牛顿-欧拉法：递推计算，适合实时控制，但推导过程比较繁琐。
• 拉格朗日法：能量视角，物理意义清晰，适合控制律设计。
• 模型辨识：把理论参数变成实际可用的参数，是理论到工程的桥梁。

我个人建议，初学者先用手推导一个两连杆的拉格朗日方程，感受一下M、C、G矩阵是怎么来的。然后再用牛顿-欧拉法写一个递推程序，对比两种方法的结果。等你把这两种方法都玩熟了，再去做辨识，就会觉得水到渠成。

嗯，动力学这部分确实有点烧脑，但它是力矩控制的根基。下一章我们会聊轨迹平滑策略，到时候你会发现，动力学模型越准，轨迹跟踪效果越好。所以，这一章的内容值得多花点时间消化。

可可精品资料库