4. 机械系统多体动力学建模

多体动力学模型是机械控制系统虚拟样机验证的“被控对象本体”。控制器再好，如果被控对象模型在关键频段、关键耦合路径上失真，验证结论就不可信。本节围绕刚体、约束、力元、驱动与负载五类建模要素展开，并给出面向控制验证的简化原则。

一、五类建模要素的职责划分

多体系统可统一写成“刚体 + 约束 + 力元 + 驱动 + 负载”的结构。刚体提供惯量属性（质量 m、质心位置、转动惯量张量 I），决定系统的惯性响应；约束限制刚体之间的相对运动自由度，决定运动学关系；力元描述不通过约束传递的相互作用（弹簧、阻尼、摩擦、接触、作动力）；驱动是施加在某个自由度上的运动或力输入；负载是外部反作用力矩/力，包括切削力、风阻、路面阻力、被搬运工件重力等。

建模时先明确坐标系约定：本文统一采用右手坐标系，重力沿 −Z 方向，关节转角以绕 +Z 轴逆时针为正。所有约束、驱动、负载的正负号都以此为准，避免后续控制器符号与模型不一致。

二、刚体建模：惯量参数从哪来

刚体建模的核心是质量、质心和转动惯量。对规则几何体可用解析公式，例如长 L、半径 r 的均质圆柱绕中心横轴转动惯量 I = m(3r² + L²)/12。对复杂零件，工程上常用两种途径：一是从 CAD 模型直接提取质量属性（前提是材料密度赋值正确）；二是用三线摆、扭摆等实验辨识。以某机械臂连杆为例，若 CAD 给出 m = 3.2 kg、质心距关节 0.18 m、绕关节轴 I = 0.052 kg·m²，则建模时直接填入这三个值即可，不必再手工估算。

需要提醒的是：转动惯量必须相对明确的参考点或参考轴。多体软件中通常要求给出相对质心的惯量张量，再由求解器通过平行轴定理转换到关节轴。若把相对关节轴的惯量误填为相对质心的值，会导致动力学响应明显偏差。

三、约束建模：自由度与冗余

约束决定系统的运动学拓扑。常见约束包括转动副（1 个转动自由度）、移动副（1 个移动自由度）、球铰（3 个转动自由度）、万向节（2 个转动自由度）和固定副（0 自由度）。建模时先数自由度：一个由 n 个刚体组成的空间系统有 6n 个自由度，每施加一个独立约束减少一个自由度。若约束数超过 6n，系统出现冗余约束，求解器可能报“过约束”或产生约束力奇异。

实际建模中，冗余约束常来自重复定义的配合。例如同一根轴两端各加一个转动副，若两轴心线不严格共线，就会引入过约束。处理办法是保留一个主约束，另一个改为球铰或直接删除，让系统在数值上可解。对控制验证而言，约束拓扑必须与真实机构一致，否则关节反力、耦合关系都会失真。

四、力元、驱动与负载

力元描述不通过约束传递的力。弹簧力 F = k(x − x₀)，阻尼力 F = c·ẋ，库仑摩擦 F = μN·sign(v)。建模时注意：弹簧和阻尼可以并联，也可以串联；接触力通常用罚函数法 F = k·δ + c·δ̇ 近似，其中 δ 为穿透量。罚刚度 k 取值过小会导致穿透明显，过大则引起数值刚性，一般取使最大穿透量小于几何尺寸 1% 的量级。

驱动分两类：运动驱动直接给定关节位移/速度/加速度时间函数，力/力矩驱动给定输入力矩。控制验证中，电机通常建模为力矩驱动，控制器输出力矩指令，经驱动器增益和限幅后作用于关节。负载则按工况等效：例如搬运工况下负载为工件重力与惯性力，切削工况下为切削力模型。负载的作用点、方向必须与真实工况一致。

五、面向控制验证的模型简化原则

控制验证关心的是闭环带宽内的动态特性，而不是全频段精确复现。简化原则可归纳为四条：

• 频段匹配：保留控制带宽 3～5 倍以内的主导模态，忽略远高于带宽的高频柔性模态。若控制器带宽约 20 Hz，则 100 Hz 以上的结构模态可暂不考虑。
• 集中质量替代：分布质量用有限个集中质量点近似，质量点数量以能复现前几阶模态为准。
• 摩擦与接触线性化：在控制验证阶段，库仑摩擦可先用等效粘性阻尼近似，待控制律稳定后再引入非线性摩擦复核。
• 负载等效：把复杂负载简化为作用在关键节点上的等效力和力矩，按最恶劣工况取值。

六、建模检查清单

完成上述建模与简化后，模型即可作为控制验证的被控对象。下一阶段的工作是把控制器接入该模型，形成闭环，观察跟踪误差、超调量和抗扰恢复时间等指标。