3. 机械多体系统建模

机械多体系统建模是虚拟样机中最基础、也最容易“埋雷”的一环。它要回答的核心问题是：一个由若干刚体通过运动副连接而成的机构，在给定驱动和约束下，各构件的位置、姿态、速度如何确定，系统还剩多少个独立运动。若这一层建错，后续的动力学求解、联合仿真接口都会失去意义。本节围绕刚体运动学描述、约束方程、拓扑结构、典型机构建模与自由度分析展开，并给出可操作的建模流程与判据。

一、刚体运动学：位姿描述与坐标约定

多体系统中每个刚体都需要一个位姿描述。平面机构常用三个广义坐标 q = [x, y, θ]ᵀ，空间刚体则用六个：质心位置 [x, y, z]ᵀ 与姿态（欧拉角或四元数）。姿态描述必须选定约定，例如采用 Z-Y-X 欧拉角时，旋转矩阵为 R = Rz(ψ)Ry(θ)Rx(φ)，全文与图示必须保持一致，否则约束方程的正负号会整体出错。

刚体上任意一点 P 的位置可写为 r_P = r_i + R_i · s_P，其中 r_i 是刚体参考点位置，s_P 是该点在体坐标系下的局部坐标。速度则通过雅可比矩阵建立：v_P = J_P(q) · q̇。雅可比矩阵把广义速度映射到笛卡尔速度，是后续约束、驱动和传感器建模的共同基础。建模时建议统一采用“全局坐标系描述位置、体坐标系描述局部几何”的约定，并在模型说明中显式记录。

二、约束方程：把运动副写成代数方程

运动副的本质是对相邻刚体相对运动的限制，数学上表现为约束方程 Φ(q, t) = 0。常见约束包括：

• 旋转副：两刚体上某点重合，Φ = r_i + R_i s_i − r_j − R_j s_j = 0（平面 2 个方程，空间 3 个）。
• 平移副：允许沿某轴相对移动，限制其余方向，平面 2 个、空间 5 个约束方程。
• 球副：仅约束位置重合，空间 3 个方程。
• 齿轮副/凸轮副：以传动比或轮廓接触条件表达，属于非定常或非线性约束。

约束方程对时间求导可得速度约束 Φ_q · q̇ = −Φ_t，其中 Φ_q 是约束雅可比矩阵。再求导得到加速度约束，用于动力学求解。建模时要注意：约束方程数量必须与运动副实际限制的自由度数一致，重复约束会导致雅可比矩阵秩亏，求解器报“冗余约束”或出现奇异。

三、拓扑结构：决定方程组织方式

多体系统的拓扑结构描述刚体与运动副的连接关系，常见类型有：

• 树状（开链）：无回路，如机械臂。可用递推方法高效求解，广义坐标数等于自由度数。
• 闭环：存在回路，如四杆机构、曲柄滑块。需引入闭环约束方程，自由度减少。
• 混合拓扑：既有开链又有闭环，如带闭链的并联机构或车辆悬架。

拓扑结构直接决定约束方程的规模与稀疏性。建模时应先画出拓扑图，标注每个刚体编号、运动副类型与连接点，再据此生成约束。下图给出一个典型曲柄滑块机构的拓扑与约束关系示意，可作为建模时的参照。

四、典型机构建模：以曲柄滑块为例

以平面曲柄滑块机构为例，设曲柄长 L₁ = 0.10 m，连杆长 L₂ = 0.30 m，曲柄以 ω = 10 rad/s 匀速转动。建模步骤如下：

1. 定义三个刚体：曲柄、连杆、滑块，各取质心为参考点，平面各 3 个广义坐标，共 9 个。
2. 建立旋转副 O（机架—曲柄）、旋转副 A（曲柄—连杆）、旋转副 B（连杆—滑块）、平移副（滑块—机架）。
3. 写出约束方程：O 处 2 个、A 处 2 个、B 处 2 个、滑块沿 x 移动且 y 向锁定 1 个，共 7 个。
4. 自由度 DOF = 9 − 7 = 2。若在曲柄上施加转动驱动（1 个驱动约束），则系统剩余 1 个自由度，运动完全确定。

求解时，给定曲柄转角 θ，由闭环约束可解出连杆摆角与滑块位移。例如当 θ = 90° 时，滑块位移 x_B = L₁cosθ + √(L₂² − (L₁sinθ)²) = 0 + √(0.09 − 0.01) ≈ 0.283 m。这类解析结果可用于校验仿真模型：若仿真输出的滑块位移与解析值偏差超过 1%，应检查约束方程或单位设置。

五、自由度分析：判断模型是否可解

自由度分析是建模的“体检”。对平面机构，DOF = 3n − 2p_L − p_H（n 为活动构件数，p_L 为低副数，p_H 为高副数）；对空间机构，DOF = 6n − Σc_i。但公式法只适用于简单机构，复杂闭环系统应通过约束雅可比矩阵的秩来判断：DOF = n_q − rank(Φ_q)。

完成上述步骤后，一个机械多体系统的运动学模型就具备了可求解、可校验、可扩展的基础。后续的动力学建模、联合仿真接口配置，都将在这一层之上展开。