3、机械臂动力学基础：牛顿-欧拉递推、拉格朗日方程、动力学模型的标准形式（M、C、G、F）
机械臂动力学研究的是关节运动与驱动力/力矩之间的映射关系，是控制器设计、轨迹优化、仿真验证与参数辨识的理论基石。与运动学只描述几何关系不同，动力学必须考虑质量、惯量、科氏力、离心力、重力以及摩擦等物理效应。本章围绕三大核心内容展开：牛顿-欧拉递推算法（面向计算实现）、拉格朗日方程（面向模型解析）、以及动力学模型的标准形式（M、C、G、F），帮助学习者建立从物理直觉到数学表达、再到工程落地的完整知识链路。
3.1 牛顿-欧拉递推算法：从物理力到计算效率
牛顿-欧拉法是求解机械臂逆动力学的经典算法，其核心思想是将每个连杆视为刚体，利用牛顿第二定律（平动）和欧拉方程（转动）建立力与运动的关系。算法分为两个递推阶段：外推（从基座到末端，计算各连杆的角速度、角加速度、线加速度）和内推（从末端到基座，计算各关节所需的驱动力/力矩）。该方法的计算复杂度为O(n)，其中n为关节数，远优于直接求解拉格朗日方程时的O(n³)复杂度，因此非常适合实时控制场景。
核心原理与递推步骤
外推阶段从基座（惯性系）开始，依次向末端执行器方向递推。对于旋转关节i，其角速度、角加速度和线加速度的递推公式为：
ω_{i+1} = ω_i + q̇_{i+1} · z_{i+1}
α_{i+1} = α_i + q̈_{i+1} · z_{i+1} + ω_i × (q̇_{i+1} · z_{i+1})
a_{i+1} = a_i + α_{i+1} × r_{i+1} + ω_{i+1} × (ω_{i+1} × r_{i+1})其中z_{i+1}为关节轴单位向量，r_{i+1}为从关节i+1坐标系原点指向连杆质心的向量。内推阶段则从末端执行器开始，向基座方向计算每个连杆上的合力与合力矩，进而得到关节驱动力矩：
F_i = m_i · a_{ci}（牛顿方程）
N_i = I_i · α_i + ω_i × (I_i · ω_i)（欧拉方程）
τ_i = z_i^T · N_i（关节力矩投影）工程实现要点
- 坐标系约定：推荐使用改进D-H参数或标准D-H参数，确保递推过程中向量变换的一致性。
- 惯性张量：需将连杆惯性张量从质心坐标系变换到连杆坐标系，通常通过平行轴定理实现。
- 数值稳定性：递推过程中涉及大量叉乘与矩阵乘法，建议使用双精度浮点运算，并注意中间变量的尺度缩放。
3.2 拉格朗日方程：能量视角下的动力学建模
拉格朗日法从系统能量出发，定义拉格朗日函数L = K - P（动能减势能），通过变分原理推导出动力学方程。该方法不涉及约束力的计算，适合建立解析模型，尤其适用于理论分析和控制器设计。对于n自由度机械臂，拉格朗日方程可写为：
d/dt(∂L/∂q̇) - ∂L/∂q = τ其中q为广义坐标向量（关节角度），τ为广义力向量（关节力矩）。展开后得到与牛顿-欧拉法完全等价的动力学方程，但形式更为紧凑。
建模流程与案例拆解
以二连杆平面机械臂为例（杆长l₁、l₂，质量m₁、m₂，质心位于杆件中点），其动能表达式为：
K = ½m₁v_c1² + ½I₁ω₁² + ½m₂v_c2² + ½I₂ω₂²势能表达式为：
P = m₁g·h_c1 + m₂g·h_c2代入拉格朗日方程后，可得到包含惯性项、科氏力项和重力项的完整动力学方程。该解析表达式可直接用于设计计算力矩控制律，或用于验证数值算法的正确性。
| 对比维度 | 牛顿-欧拉法 | 拉格朗日法 |
|---|---|---|
| 理论基础 | 牛顿第二定律 + 欧拉方程 | 能量守恒 + 变分原理 |
| 计算复杂度 | O(n)，适合实时计算 | O(n³)，适合离线分析 |
| 输出形式 | 数值递推结果 | 解析表达式 |
| 工程适用性 | 实时控制、仿真 | 控制器设计、参数分析 |
| 对约束力的处理 | 隐含在递推中 | 自动消去 |
3.3 动力学模型的标准形式：M、C、G、F
无论采用哪种方法推导，n自由度机械臂的动力学方程最终都可以写成统一的标准形式：
M(q)q̈ + C(q,q̇)q̇ + G(q) + F(q̇) = τ其中：M(q)为n×n惯性矩阵，对称正定，反映关节加速度与力矩的惯性耦合；C(q,q̇)为科氏力和离心力矩阵，与关节速度的二次项相关；G(q)为重力项向量；F(q̇)为摩擦力项（包括库仑摩擦和粘性摩擦）；τ为关节驱动力矩向量。
各矩阵的物理意义与性质
- M(q)：惯性矩阵的元素M_ij表示关节j的加速度对关节i力矩的影响。其对称正定性保证了系统动能始终为正，也是许多控制律稳定性证明的基础。
- C(q,q̇)：科氏力项与关节速度的乘积相关，当机械臂高速运动时不可忽略。C矩阵的选取不唯一，但需满足Ṁ - 2C为反对称矩阵这一关键性质，该性质在Lyapunov稳定性分析中至关重要。
- G(q)：重力项仅与关节位置有关，在低速或静止状态下占主导。对于重载机械臂，重力补偿是控制器设计的第一优先级。
- F(q̇)：摩擦力模型通常简化为F(q̇) = F_v·q̇ + F_c·sign(q̇)，其中F_v为粘性摩擦系数，F_c为库仑摩擦系数。更精确的模型可考虑Stribeck效应。
实战场景：计算力矩控制中的标准形式应用
考虑一个六轴工业机械臂的轨迹跟踪控制任务。给定期望轨迹q_d(t)，计算力矩控制律设计为：
τ = M(q)·(q̈_d + K_d·ė + K_p·e) + C(q,q̇)q̇ + G(q) + F(q̇)其中e = q_d - q为跟踪误差，K_p和K_d为PD增益矩阵。该控制律的核心思想是利用动力学模型的前馈补偿，将非线性系统线性化为二阶线性系统。实际调试中，我们发现：
- 当机械臂低速运行时（<30°/s），科氏力项C的影响小于5%，可暂时忽略以简化计算。
- 重力项G的补偿误差直接影响稳态精度，建议通过离线辨识获得精确的质心参数。
- 摩擦力项F在过零速度附近存在突变，需采用连续摩擦模型（如双曲正切近似）避免控制抖振。
3.4 常见误区与总结复盘
在学习机械臂动力学过程中，初学者常陷入以下误区：
- 误区一：忽略科氏力项。在高速运动或大惯量变化场景下，科氏力可占驱动力矩的30%以上，忽略会导致明显的轨迹跟踪误差。
- 误区二：将M矩阵视为常数。M(q)随关节构型变化显著，尤其在末端负载变化时，必须实时更新。
- 误区三：摩擦模型过度简化。线性粘性摩擦模型在低速区误差较大，建议至少采用库仑+粘性组合模型。
- 误区四：忽视参数辨识。直接使用CAD模型中的理论参数往往与实际物理参数存在偏差，必须通过实验辨识校准。
总结：本章从三种视角建立了机械臂动力学的完整知识框架。牛顿-欧拉递推提供了高效的计算工具，拉格朗日方程提供了清晰的解析表达，而标准形式M、C、G、F则统一了模型接口，为控制器设计、仿真验证和参数辨识奠定了共同基础。在实际工程中，三者并非互斥——通常使用拉格朗日法建立解析模型，用牛顿-欧拉法实现实时计算，再以标准形式作为控制律设计的统一接口。掌握这些核心概念，是后续学习力控、阻抗控制和自适应控制的前提。