3. 多体系统动力学建模基础
机器人机构本质上是一组通过关节连接的刚体集合，其运动与受力行为必须放在多体系统动力学的框架下描述。本节从多体系统的基本定义出发，逐层建立刚体、铰、约束、广义坐标与动力学方程之间的联系，并说明这些抽象概念在机器人机构中的具体对应关系，为后续的建模与求解打下统一的概念基础。
一、多体系统的定义与机器人机构的对应
多体系统（Multibody System）是指由若干刚体或柔性体通过运动副（铰）相互连接、并在外力或驱动作用下产生相对运动的力学系统。一个多体系统通常由三部分构成：物体（Body）、铰（Joint）和力元（Force Element）。物体提供惯性与几何属性，铰限制物体之间的相对运动自由度，力元则描述驱动、弹簧、阻尼、重力及接触等作用。
机器人机构与多体系统之间存在直接的对应关系。以典型的六自由度串联机械臂为例：连杆（Link）对应刚体，每个连杆具有质量、质心位置和惯性张量；转动关节（Revolute Joint）对应铰，每个关节约束掉五个相对自由度、只保留一个绕关节轴的转动自由度；关节电机提供的驱动力矩、重力以及末端负载则对应力元。基座固定在地面时，基座与大地之间可视为一个固定铰（0 自由度约束）。因此，机器人建模的第一步，就是把物理样机抽象成“刚体—铰—力元”的拓扑结构。
二、刚体、铰与约束
刚体是建模的基本单元，其内部任意两点距离保持不变。描述一个空间刚体需要六个自由度：三个平动、三个转动。刚体的惯性特性由质量 m、质心位置以及关于质心的 3×3 惯性张量 I 描述。在机器人中，连杆常被简化为刚体，但当连杆细长或高速运动时，柔性效应不可忽略，此时需引入柔性体建模。
铰定义两个刚体之间的相对运动方式。常见铰类型包括：转动铰（1 个转动自由度）、移动铰（1 个移动自由度）、圆柱铰（转动+移动）、球铰（3 个转动自由度）和固定铰（0 自由度）。铰的数目与类型决定了系统的总自由度。对于由 n 个刚体组成的系统，若没有任何约束，自由度为 6n；每引入一个铰，就减少相应的约束数。
约束是限制系统运动的代数或微分关系，可分为几何约束（完整约束）与运动约束（非完整约束）。机器人中绝大多数铰约束属于完整约束，可用位置层面的代数方程表示。约束方程的一般形式为：
Φ(q, t) = 0其中 q 为系统广义坐标向量，t 为时间。对时间求导可得速度约束与加速度约束，它们是后续建立动力学方程的关键。
三、广义坐标与自由度
广义坐标是能够唯一确定系统位形的独立参数集合。对于机器人机构，广义坐标的选取方式直接影响建模复杂度。常见选择有两类：
- 笛卡尔坐标法：每个刚体用 6 个坐标描述，约束方程数量多，但方程形式规整，便于程序化建模。
- 铰坐标法（相对坐标法）：直接用关节变量作为广义坐标，例如六轴机械臂取 q = [q₁, q₂, …, q₆]ᵀ，坐标数等于自由度数，方程数量少，物理意义直观。
系统的自由度数目等于广义坐标数减去独立约束方程数。对于串联机器人，若每个关节均为单自由度铰，则自由度数等于关节数。这一关系是判断机构是否欠驱动、冗余或过约束的重要依据。
四、动力学方程的基本形式
多体系统动力学方程有多种等价形式，最常用的是拉格朗日方程与含约束的牛顿—欧拉方程。对于无约束或已用独立广义坐标消去约束的系统，拉格朗日方程写作：
d/dt(∂L/∂q̇) − ∂L/∂q = Q
其中 L = T − V，T 为动能，V 为势能，Q 为广义力展开后可得机器人动力学中常见的标准形式：
M(q)q̈ + C(q, q̇)q̇ + G(q) = τ
M(q)：惯性矩阵（对称正定）
C(q, q̇)q̇：科氏力与离心力项
G(q)：重力项
τ：关节驱动力矩当系统存在完整约束时，常采用带拉格朗日乘子的方程形式：
M(q)q̈ + C(q, q̇)q̇ + G(q) = τ + Φ_qᵀ λ
Φ(q) = 0其中 Φ_q 为约束雅可比矩阵，λ 为拉格朗日乘子，其物理意义是约束力。这一形式在闭链机构、并联机器人和足式机器人建模中尤为重要。
五、概念与机器人机构的对应关系
为便于整体把握，下表给出多体系统基本概念与机器人机构要素的对应关系：
| 多体系统概念 | 机器人机构对应 | 典型数学描述 |
|---|---|---|
| 刚体 | 连杆、末端执行器 | m、质心、I |
| 铰 | 转动关节、移动关节 | 相对运动约束 |
| 约束 | 关节几何限制、闭链约束 | Φ(q, t) = 0 |
| 广义坐标 | 关节变量 q | q ∈ Rⁿ |
| 力元 | 电机力矩、重力、负载 | τ、G(q) |
| 动力学方程 | 关节空间动力学模型 | Mq̈ + Cq̇ + G = τ |
六、建模流程中的关键判断
在实际建模中，有几个判断直接影响结果的正确性。第一，刚体假设是否成立：若连杆的一阶固有频率远高于系统工作频带，刚体假设合理；否则需引入柔性体。第二，铰的建模精度：理想铰忽略摩擦与间隙，若关节摩擦显著或存在间隙，需在力元中补充摩擦模型或接触模型。第三，约束的处理方式：开链机器人通常用独立广义坐标即可，闭链或并联机构则必须保留约束方程与乘子。第四，重力方向与坐标系约定：建模前必须明确重力方向、关节正方向以及各连杆坐标系的定义，并在全文与图示中保持一致，否则惯性矩阵与重力项的符号容易出错。
以两连杆平面机械臂为例，取关节角 q₁、q₂ 为广义坐标，系统自由度为 2。其惯性矩阵 M(q) 为 2×2 对称正定矩阵，对角元包含两连杆的转动惯量与质量项，非对角元反映关节间的耦合。当 q₂ 变化时，M(q) 的非对角元随之改变，说明惯性耦合与位形有关。这一现象在串联机器人中普遍存在，也是机器人动力学比一般刚体系统更复杂的原因之一。