3. 动力学建模
在双边遥操作系统中，时延补偿与稳定控制算法能否奏效，首先取决于动力学模型是否准确。若主从机械臂的惯量、科氏力、重力以及环境交互力描述失真，再精巧的控制器也会因模型失配而出现抖动、漂移甚至失稳。本节从拉格朗日方程出发，建立主从机械臂的通用动力学形式，并给出环境交互力的建模方法，为后续的时延补偿与无源控制奠定基础。
一、核心原理：从拉格朗日方程到机械臂动力学
拉格朗日方程以能量为出发点描述系统运动，避免了复杂的矢量受力分析。对于n自由度机械臂，定义拉格朗日函数 L = K - P，其中 K 为动能，P 为势能。广义坐标取关节角 q，则拉格朗日方程为：
d/dt(∂L/∂q̇) - ∂L/∂q = τ + Jᵀ(q)F_ext其中 τ 为关节驱动力矩，J(q) 为雅可比矩阵，F_ext 为末端与环境接触产生的外力。展开后可得机械臂的标准动力学方程：
M(q)q̈ + C(q,q̇)q̇ + G(q) = τ + Jᵀ(q)F_ext式中 M(q) 为对称正定的惯量矩阵，C(q,q̇) 为科氏力与离心力项，G(q) 为重力项。该方程具有两个对稳定性分析极为重要的性质：一是 Ṁ(q) - 2C(q,q̇) 为反对称矩阵，二是 M(q) 正定有界。这两条性质是无源性分析与能量整形控制的理论基石。
M_m ≠ M_s、G_m ≠ G_s。控制器设计时必须分别建模，不能简单用同一组参数近似。二、主从机械臂动力学建模
主臂由操作者施加人手力 F_h，从臂与环境接触产生交互力 F_e。设主臂关节角为 q_m，从臂关节角为 q_s，则双边系统的动力学可写为：
主臂：M_m(q_m)q̈_m + C_m(q_m,q̇_m)q̇_m + G_m(q_m) = τ_m + J_mᵀF_h
从臂：M_s(q_s)q̈_s + C_s(q_s,q̇_s)q̇_s + G_s(q_s) = τ_s - J_sᵀF_e注意从臂方程中环境力前为负号，表示环境力阻碍从臂运动。主从之间通过通信通道交换位置、速度或力信号，控制目标通常是使从臂跟踪主臂运动，同时将环境力反馈给操作者。若通信存在时延 T，则主臂在 t 时刻收到的力反馈实际来自 t-T 时刻的环境状态，这种非因果耦合正是失稳的根源之一。
建模时需重点关注三类参数：连杆质量与质心位置、关节摩擦与阻尼、以及驱动器的力矩常数。参数辨识误差会直接体现在 M、C、G 中，进而影响补偿精度。工程上常采用CAD模型初值加实验辨识修正的方式。
三、环境交互力建模
环境交互力 F_e 是遥操作区别于普通机器人控制的关键。常见模型包括：
- 弹簧-阻尼模型：
F_e = K_e(x - x_e) + B_e ẋ，适用于柔性接触与软组织操作。 - 刚性接触模型：当
x ≥ x_e时F_e = K_e(x - x_e)，否则为零，适用于硬质表面。 - 库仑摩擦模型：
F_e = μN·sgn(ẋ)，用于描述滑动接触中的摩擦阻力。 - 非线性环境：如切削、装配中的力-位移迟滞，需用分段函数或神经网络拟合。
环境参数 K_e、B_e 往往未知且时变。若控制器假设环境为纯刚性，而实际为柔性，则力反馈会出现明显偏差；反之，若按柔性设计却遇到刚性墙，则可能产生剧烈冲击。因此，环境建模通常与在线估计结合使用。
四、典型场景与参数示例
以一台二自由度主臂与二自由度从臂组成的遥操作装配系统为例，主臂连杆质量分别为 1.2 kg 和 0.8 kg，从臂为 2.0 kg 和 1.5 kg，环境为刚度 5000 N/m、阻尼 20 N·s/m 的柔性表面。建模参数可整理如下：
| 对象 | 参数 | 符号 | 典型值 | 建模要点 |
|---|---|---|---|---|
| 主臂 | 惯量矩阵 | M_m(q_m) | 对角占优，随位形变化 | 需辨识连杆质量与质心 |
| 主臂 | 重力项 | G_m(q_m) | 随关节角正弦变化 | 低速时主导，不可忽略 |
| 从臂 | 科氏力项 | C_s(q_s,q̇_s) | 高速运动时显著 | 与速度平方相关 |
| 环境 | 接触刚度 | K_e | 5000 N/m | 未知时变，需在线估计 |
| 环境 | 接触阻尼 | B_e | 20 N·s/m | 影响能量耗散 |
| 通信 | 往返时延 | T | 50～300 ms | 破坏无源性，需补偿 |
五、常见误区与复盘
误区一：忽略科氏力与离心力。在低速遥操作中，C(q,q̇)q̇ 数值较小，但当时延补偿引入速度反馈后，速度项被放大，忽略科氏力会导致模型失配和振荡。
误区二：把环境当作纯刚性。实际接触多为柔性，若按刚性建模，力反馈会出现高频冲击，操作者手感生硬，且容易激发不稳定模态。
误区三：主从使用同一组动力学参数。主从机械臂结构、负载、摩擦往往不同，必须分别辨识。否则位置跟踪误差会被误判为时延效应。
误区四：只建模不验证。建模后应通过自由运动、重力补偿、接触实验三步验证，确认 M、C、G 的预测力矩与实际力矩误差在可接受范围内。
复盘建议：先建立主从各自的拉格朗日模型，再单独标定环境刚度与阻尼，最后把时延作为独立环节接入。这样在调试时延补偿算法时，可以快速区分是模型误差还是时延导致的问题。若系统出现低频漂移，优先检查重力项；若出现高频抖动，优先检查惯量矩阵与接触刚度。
综上，拉格朗日方程为机械臂动力学提供了统一而严谨的推导框架，主从动力学分别描述了操作者与环境两侧的能量交换，环境交互力模型则决定了接触过程的真实感与稳定性边界。三者共同构成双边遥操作时延补偿与稳定控制的模型基础。