1. 联合仿真入门
机械臂是一个典型的“机电控”强耦合系统：控制器输出关节力矩或位置指令，驱动器与减速器把它变成真实运动，而连杆质量、惯量、科氏力、离心力与重力又反过来影响运动状态。若只在单一软件里做控制仿真，往往会把机械本体简化成理想模型；若只做多体动力学仿真，又难以验证真实控制器的采样、滤波、限幅与通信延迟。联合仿真（Co-simulation）正是为解决这一矛盾而出现的工程方法。
一、什么是机械臂动力学与控制联合仿真
联合仿真是指把两个或多个原本独立求解的仿真模型，通过约定的数据交换接口在时间轴上同步推进，使它们共同构成一个闭环系统。在机械臂场景中，通常一侧是多体动力学求解器（如 Adams、RecurDyn、Simscape Multibody、MuJoCo），负责计算连杆在重力、接触力、驱动力矩作用下的加速度、速度与位姿；另一侧是控制系统仿真环境（如 MATLAB/Simulink、Simulink Real-Time、Python 控制脚本），负责轨迹规划、逆运动学、PID 或计算力矩控制、状态机与安全逻辑。
两者之间交换的核心变量通常包括：控制器发给动力学模型的关节力矩 τ 或目标位置 qref；动力学模型回传给控制器的关节位置 q、速度 q̇，有时还包括末端位姿、接触力或电机电流。交换按固定步长或可变步长进行，动力学侧步长常取 0.1～1 ms，控制侧可与之相同或成整数倍关系。
二、为什么必须做联合仿真
联合仿真的价值可以归纳为四点。第一，保留真实动力学：机械臂在高速运动时科氏力与离心力不可忽略，例如一台 6 自由度机械臂在关节速度 2 rad/s 时，耦合项可能占到总力矩的 20%～40%，纯控制仿真若忽略这些项，控制器增益会被高估。第二，验证真实控制器行为：采样周期、零阶保持、滤波器相位滞后、力矩饱和都会影响稳定性，联合仿真能在不接触实机的情况下暴露这些问题。第三，降低试错成本：在实机上调试计算力矩控制器时，参数不当可能导致剧烈抖动甚至撞机，联合仿真可安全地反复迭代。第四，支持硬件在环过渡：联合仿真模型可直接作为 HIL 测试的被控对象，缩短从仿真到实机的迁移路径。
三、典型工具链与接口方式
工程中常见的组合有三类。其一是 Adams + MATLAB/Simulink：Adams 导出被控对象为 S-Function 或 FMU，Simulink 侧搭建控制器，适合需要高保真接触与柔性体的场景。其二是 Simscape Multibody + Simulink：同一环境内建模，接口简单，适合快速原型与教学。其三是 MuJoCo / PyBullet + Python 控制器：轻量、开源、易脚本化，适合算法研究与强化学习。接口标准方面，FMI/FMU 是跨工具通用方案，S-Function 是 MATLAB 生态内方案，共享内存或 TCP 则用于实时性要求更高的场合。
| 工具链 | 动力学侧 | 控制侧 | 接口 | 适用场景 |
|---|---|---|---|---|
| 方案 A | Adams | Simulink | S-Function / FMU | 高保真接触、柔性体 |
| 方案 B | Simscape Multibody | Simulink | 原生物理连接 | 快速原型、教学 |
| 方案 C | MuJoCo / PyBullet | Python | API 调用 | 算法研究、强化学习 |
四、整体学习路线
本课程按“建模—控制—联调—验证”的主线推进。第一阶段建立机械臂动力学模型，理解 DH 参数、质量惯量与关节约束；第二阶段在 Simulink 或 Python 中实现轨迹规划与控制器；第三阶段打通联合仿真接口，处理步长匹配、单位统一与代数环；第四阶段加入摩擦、间隙、噪声等非理想因素，观察控制性能退化；第五阶段做参数扫描与结果判读，形成可复现的仿真报告。每一阶段都以“能跑通、能看懂曲线、能解释差异”为验收标准。
五、一个最小可运行示例的预期形态
以 2 自由度平面机械臂为例，连杆长度 l₁ = l₂ = 0.4 m，质量 m₁ = m₂ = 1.5 kg，质心位于连杆中点，重力沿 -y 方向，g = 9.81 m/s²。控制器采用计算力矩法：τ = M(q)(q̈_d + K_d ė + K_p e) + C(q,q̇)q̇ + G(q)，其中 K_p = diag(100,100)，K_d = diag(20,20)。期望轨迹为 q₁ 从 0 到 1.0 rad、q₂ 从 0 到 -0.8 rad 的五次多项式，运动时间 2 s。联合仿真步长取 1 ms，动力学侧用 Simscape Multibody，控制侧用 Simulink。运行后应观察三个量：关节跟踪误差是否在 0.01 rad 以内、力矩是否超过 30 N·m、速度曲线是否平滑无高频振荡。若误差收敛但力矩饱和，说明增益偏大或轨迹过快；若误差持续存在，优先检查重力项符号与质心位置定义。