4、空间力与力矩：力的分解与合成、力矩计算、力旋量（wrench）概念及其在并联机构中的应用
Stewart平台作为典型的六自由度并联机构，其动力学建模与力控制的核心在于对空间力与力矩的精确描述与运算。无论是求解驱动支腿的驱动力，还是设计基于力/位混合的柔顺控制器，都离不开对力旋量（Wrench）这一核心数学工具的深刻理解。本章将系统梳理空间力的分解与合成法则、力矩的计算方法，并重点引入力旋量的概念，结合Stewart平台的结构特点，阐明其在雅可比矩阵传递、支腿力分配以及整机动力学方程构建中的关键作用。
上图展示了Stewart平台中力旋量传递的核心逻辑：动平台受到的外力旋量 \(\mathbf{W} = [\mathbf{F}; \mathbf{M}]\) 通过6×6雅可比矩阵的转置 \(\mathbf{J}^T\) 映射为六个支腿的轴向力 \(\boldsymbol{\tau}\)。这一映射关系是平台力控制的理论基石，也是本章后续所有讨论的出发点。
4.1 空间力的分解与合成
4.1.1 核心原理：从三维力到六维力旋量
在三维空间中，作用于刚体上的任意力 \(\mathbf{F}\) 可以沿参考坐标系的三个正交轴分解为 \(F_x, F_y, F_z\)。然而，对于Stewart平台这类空间机构，仅描述力的三个分量是不够的——力作用点的位置差异会导致完全不同的刚体运动效果。因此，必须引入力旋量（Wrench）的概念，将力与力矩统一为一个六维向量：
W = [F_x, F_y, F_z, M_x, M_y, M_z]ᵀ其中，前三个分量是合力在惯性系下的投影，后三个分量是合力矩在惯性系下的投影。力的合成遵循矢量平行四边形法则，而力矩的合成则需考虑各力对参考点的矩的矢量和。
4.1.2 判断方法：力的平移定理与等效替换
当需要将作用于动平台上某一点 \(P\) 的力 \(\mathbf{F}\) 等效平移到参考点 \(O\)（通常取动平台质心）时，必须附加一个由力对参考点之矩产生的力矩：
M_O = r_OP × F其中 \(r_{OP}\) 是从 \(O\) 指向 \(P\) 的位置矢量。这一操作是力旋量合成的基础。在工程实践中，我们常将六个支腿的驱动力（沿支腿轴向）分别平移到动平台质心，再矢量叠加得到总的等效外力旋量。
| 力的描述方式 | 数学表达 | 物理意义 | 适用场景 |
|---|---|---|---|
| 纯力向量 | \(\mathbf{F} \in \mathbb{R}^3\) | 仅描述力的大小与方向 | 质点动力学、简单滑块机构 |
| 力偶矩 | \(\mathbf{M} \in \mathbb{R}^3\) | 描述纯转动效应 | 扭矩扳手、电机输出 |
| 力旋量 | \(\mathbf{W} \in \mathbb{R}^6\) | 力与力矩的统一体，与参考点相关 | 空间刚体动力学、并联机构 |
4.1.3 案例拆解：支腿力到平台力旋量的合成
设某Stewart平台动平台质心为 \(O\)，六条支腿与动平台的铰点分别为 \(A_1 \sim A_6\)，各支腿施加于动平台的轴向力为 \(f_i\)（沿支腿方向 \(\mathbf{s}_i\)）。则合力旋量为：
F = Σ f_i · s_i
M = Σ (r_OAi × f_i · s_i)其中 \(r_{OAi}\) 为质心到铰点 \(A_i\) 的矢量。实际计算中，我们通常先通过运动学求出雅可比矩阵 \(\mathbf{J}\)，然后直接利用 \(\mathbf{W} = \mathbf{J}^{-T} \boldsymbol{\tau}\) 完成从支腿力到平台力旋量的映射，避免逐项叉乘的繁琐。
4.2 力矩计算与力旋量在并联机构中的应用
4.2.1 核心原理：雅可比矩阵的力域映射
Stewart平台的雅可比矩阵 \(\mathbf{J}\) 建立了关节空间速度 \(\dot{\mathbf{q}}\)（六个支腿的伸缩速度）与操作空间速度 \(\dot{\mathbf{X}}\)（动平台的空间速度）之间的线性关系：\(\dot{\mathbf{X}} = \mathbf{J} \dot{\mathbf{q}}\)。根据虚功原理，力域中的映射关系为：
τ = Jᵀ · W这一关系表明：已知期望的平台外力旋量 \(\mathbf{W}\)，可以通过雅可比转置直接求解所需的六个支腿驱动力 \(\boldsymbol{\tau}\)。这是力控制中最核心的公式，也是阻抗控制、力/位混合控制的基础。
4.2.2 操作流程：基于力旋量的支腿力分配
- 确定期望力旋量：根据任务需求（如恒力打磨、装配插拔）确定动平台需要对外施加的力 \(\mathbf{F}_d\) 和力矩 \(\mathbf{M}_d\)。
- 计算当前雅可比：由当前位姿的运动学正解或反解求出6×6雅可比矩阵 \(\mathbf{J}\)。
- 求解支腿力：\(\boldsymbol{\tau} = \mathbf{J}^T \mathbf{W}_d\)。若 \(\mathbf{J}\) 接近奇异，需进行阻尼最小二乘处理。
- 底层力闭环：将计算出的 \(\tau_i\) 作为各支腿的力指令，由伺服驱动器执行。
4.2.3 案例拆解：六维力传感器反馈的力控制
某飞行模拟器Stewart平台需要模拟飞机着陆时的冲击力。系统在动平台底部安装六维力/力矩传感器，实时测量实际接触力旋量 \(\mathbf{W}_{meas}\)。控制器采用力误差的PID调节：
τ_cmd = Jᵀ · (W_d + K_p·(W_d - W_meas) + K_i·∫(W_d - W_meas)dt + K_d·d(W_d - W_meas)/dt)实测数据表明：在未加力闭环时，支腿力跟踪误差约15%；加入力旋量闭环后，稳态误差降至2%以内，动态响应时间从120ms缩短至45ms。但代价是系统对传感器噪声敏感，需在控制器中增加低通滤波（截止频率约20Hz）。
4.2.4 常见误区与总结复盘
- 误区一：将力旋量当作普通六维向量直接叠加，忽略参考点变化。不同参考点下的力旋量不能直接相加，需先统一参考点。
- 误区二：认为 \(\mathbf{J}^T\) 总是可逆。实际上 \(\mathbf{J}\) 奇异时 \(\mathbf{J}^T\) 同样奇异，力映射不唯一。
- 误区三：忽略支腿的惯性力和摩擦力。高速运动时，支腿自身的惯性力会叠加到驱动力上，需在动力学模型中补偿。
复盘要点：力旋量是连接操作空间力与关节空间力的桥梁。掌握 \(\mathbf{W} = \mathbf{J}^{-T}\boldsymbol{\tau}\) 与 \(\boldsymbol{\tau} = \mathbf{J}^T\mathbf{W}\) 的双向映射，是进行Stewart平台力控制的前提。实际工程中，建议结合六维力传感器进行闭环校正，并针对奇异位形设计保护策略。