4. 动力学基础
在轨迹规划中，运动学只回答“末端要走到哪里、关节角如何变化”，而动力学回答的是“为了产生这样的运动，关节需要输出多大力矩”。如果忽略动力学，规划出的轨迹可能速度、加速度都连续，却在实际机器人上出现跟踪滞后、关节过流、机械臂抖动甚至失稳。因此，动力学约束是轨迹规划从“几何可行”走向“物理可行”的关键一步。
一、核心原理：从牛顿-欧拉到拉格朗日
刚体动力学描述的是力、力矩与运动之间的关系。对机器人而言，最常用的两条建模路线是牛顿-欧拉方程与拉格朗日方程。
牛顿-欧拉方程采用“逐杆递推”的思路：先由基座向末端做一次向外递推，计算每个连杆的速度、角速度、加速度和惯性力；再由末端向基座做一次向内递推，求出各关节需要平衡的力矩。它的物理意义直观，计算效率高，适合实时控制与逆动力学求解。
拉格朗日方程从能量角度出发，定义拉格朗日函数 L = K - P，其中 K 为系统动能，P 为势能，再通过
d/dt(∂L/∂q̇) - ∂L/∂q = τ得到关节力矩与广义坐标、速度、加速度之间的关系。拉格朗日方法形式统一、便于推导闭式表达式，尤其适合分析多自由度串联机器人的耦合特性。
二、刚体动力学与标准方程形式
对 n 自由度串联机器人，动力学方程通常写成如下标准形式：
M(q)q̈ + C(q, q̇)q̇ + G(q) + F(q̇) = τ + Jᵀ(q)F_ext其中：
q, q̇, q̈：关节位置、速度、加速度向量；M(q)：惯性矩阵，反映各关节加速时的等效惯量及耦合；C(q, q̇)q̇：科氏力与离心力项；G(q)：重力项；F(q̇)：摩擦项，常含库仑摩擦与粘性摩擦；τ：关节驱动力矩；Jᵀ(q)F_ext：末端或环境外力经雅可比转置映射到关节空间的等效力矩。
这一方程是轨迹规划中动力学约束的“母方程”。只要给定 q、q̇、q̈，就能算出所需关节力矩，从而判断轨迹是否超出执行器能力。
三、关节力矩与外力：约束如何落到轨迹上
实际机器人中，关节力矩受电机峰值转矩、连续转矩、减速器额定转矩和电流限制共同约束。轨迹规划必须保证整条轨迹上每个采样点的力矩都满足：
τ_min ≤ τ(t) ≤ τ_max
|τ(t)| ≤ τ_cont （连续工作区）
|τ(t)| ≤ τ_peak （短时峰值区）外力同样不可忽略。当末端与环境接触、抓取负载或发生碰撞时，外力通过雅可比转置进入关节空间，可能瞬间抬高某些关节的力矩需求。因此，在规划阶段应把负载质量、接触力和安全系数纳入动力学约束，而不是等控制器报警后再补救。
四、案例场景：两自由度机械臂的力矩校核
假设一台两自由度平面机械臂，连杆质量分别为 m1=2 kg、m2=1.5 kg，连杆长度 l1=0.4 m、l2=0.3 m，末端负载 m_load=1 kg。规划一条从 A 点到 B 点的五次多项式轨迹，采样周期 1 ms。校核流程如下：
- 由轨迹生成器得到每个采样点的
q、q̇、q̈； - 代入动力学方程计算
τ1(t)与τ2(t)； - 叠加末端负载经雅可比转置产生的等效力矩；
- 与关节 1、关节 2 的连续转矩和峰值转矩比较；
- 若超限，则降低最大加速度或延长轨迹时间，重新迭代。
常见现象是：空载时轨迹完全可行，加上 1 kg 负载后，靠近基座的关节 1 力矩峰值上升约 30%～50%，若仍按空载参数执行，就容易触发过流保护。
五、动力学约束的数学描述与工程清单
把动力学约束写入轨迹规划，通常表现为一组不等式约束：
τ(t) = M(q)q̈ + C(q,q̇)q̇ + G(q) + F(q̇) - Jᵀ(q)F_ext
s.t. τ_min ≤ τ(t) ≤ τ_max
|q̇(t)| ≤ q̇_max
|q̈(t)| ≤ q̈_max
|τ̇(t)| ≤ τ̇_max| 约束类型 | 数学表达 | 工程含义 | 典型处理方式 |
|---|---|---|---|
| 关节力矩上限 | τ ≤ τ_max | 电机/减速器能力边界 | 降低加速度、延长轨迹 |
| 关节力矩下限 | τ ≥ τ_min | 制动与反向驱动能力 | 限制减速度、增加缓冲段 |
| 力矩变化率 | |τ̇| ≤ τ̇_max | 避免冲击与电流突变 | 加加速度限制、平滑滤波 |
| 外力映射 | Jᵀ(q)F_ext | 负载与接触力影响 | 负载辨识、力前馈补偿 |
| 摩擦补偿 | F(q̇)=Fc·sgn(q̇)+Bq̇ | 低速爬行与死区 | 摩擦模型辨识、前馈补偿 |
六、常见误区与复盘
- 误区一：只看运动学，不看动力学。轨迹光滑不等于可执行，力矩超限往往发生在加减速切换点。
- 误区二：忽略外力与负载。末端负载、线缆拖拽、接触力都会通过雅可比转置放大到关节空间。
- 误区三：把峰值转矩当连续转矩用。短时峰值可以超，但持续超限会导致过热和寿命下降。
- 误区四：摩擦项被忽略。低速段摩擦影响显著，容易造成跟踪误差和爬行。
复盘时建议记录三类数据：轨迹各点的关节力矩曲线、力矩峰值出现的位置、以及超限后的修正策略。长期积累后，可以形成针对具体机型的“动力学约束模板”，在新轨迹规划时直接复用，显著缩短调试周期。