第四节：Stewart平台几何建模——上下平台铰点分布、杆长定义与尺寸参数
好，咱们进入正题。
上一节我们聊了Stewart平台的基本概念，说白了就是六个伸缩杆撑着一个动平台。但光知道这个还不够，你得把它的几何关系搞清楚。我当年第一次做这个的时候，就吃了不少亏——图纸上看着挺简单，一上手才发现铰点位置差一毫米，整个运动学就全乱套了。
4.1 上下平台的基本结构
Stewart平台由两个平台组成：
- 下平台（基座）——固定不动，通常安装在地面或机架上
- 上平台（动平台）——可以自由运动，六个自由度
每个平台上有六个铰点，分别连接六根伸缩杆的两端。铰点的分布方式，直接决定了平台的工作空间和受力特性。
核心要点：上下平台的铰点通常呈对称分布，但并不是简单的正六边形。实际工程中，我们会在正六边形的基础上引入一个「角度偏移」，目的是避免运动奇异点。
4.2 铰点分布——半径与角度偏移
先看下平台。假设下平台的六个铰点分布在一个半径为 \( R_b \) 的圆上。如果完全对称，相邻铰点之间的夹角就是60°。但实际设计中，我们通常会让铰点成对出现，每对之间有一个小角度偏移。
我习惯用下面这种方式定义：
// 下平台铰点角度（单位：度）
// 假设第一个铰点在0°位置
double theta_b[6] = {
0.0 + delta_b, // 铰点1
60.0 - delta_b, // 铰点2
120.0 + delta_b, // 铰点3
180.0 - delta_b, // 铰点4
240.0 + delta_b, // 铰点5
300.0 - delta_b // 铰点6
};这里的 delta_b 就是下平台的角度偏移量。上平台同理，只是半径 \( R_p \) 和偏移量 \( delta_p \) 不同。
我的经验：delta_b 和 delta_p 一般取5°~15°之间。太小了起不到避免奇异的作用，太大了又会让平台结构变得不对称。我常用的值是10°，效果比较均衡。
4.3 杆长定义
六根杆的长度，是连接上下平台对应铰点的空间距离。假设下平台第i个铰点的位置向量为 \( \mathbf{B}_i \)，上平台第i个铰点的位置向量为 \( \mathbf{P}_i \)，那么第i根杆的长度就是：
L_i = || P_i - B_i ||注意，这里的 \( \mathbf{P}_i \) 是上平台铰点在世界坐标系下的坐标，不是上平台局部坐标系下的坐标。两者之间需要通过旋转矩阵和平移向量进行转换。
说白了，杆长就是两个点之间的欧氏距离。但实际计算时，你得考虑上平台的姿态——它可能旋转了、平移了，所以 \( \mathbf{P}_i \) 是动态变化的。
4.4 平台尺寸参数
我们通常用以下几个参数来描述一个Stewart平台的几何尺寸：
| 参数 | 符号 | 说明 |
|---|---|---|
| 下平台半径 | \( R_b \) | 下平台铰点分布圆的半径 |
| 上平台半径 | \( R_p \) | 上平台铰点分布圆的半径 |
| 下平台角度偏移 | \( \delta_b \) | 下平台铰点对的半角偏移 |
| 上平台角度偏移 | \( \delta_p \) | 上平台铰点对的半角偏移 |
| 杆长范围 | \( L_{min}, L_{max} \) | 伸缩杆的最小和最大长度 |
| 初始杆长 | \( L_0 \) | 平台处于中位时的杆长 |
注意：我曾经遇到过一个坑——图纸上给的半径是铰点中心到平台中心的距离，但实际加工时，铰点本身有物理尺寸，会占用一部分空间。如果你直接用图纸半径去算运动学，结果往往偏大。建议在建模时预留2~5mm的余量。
4.5 几何建模的完整流程
嗯，到这里，我们可以把整个几何建模的步骤串起来了：
- 定义坐标系——下平台坐标系固定，上平台坐标系随动
- 计算铰点位置——根据半径和角度偏移，算出六个铰点的坐标
- 建立杆长方程——用两点间距离公式，写出每根杆的长度表达式
- 引入姿态参数——用旋转矩阵表示上平台的姿态，用平移向量表示位置
- 得到完整的正逆解模型——这就是后面几节要讲的内容
下面这张图，是我自己画的一个几何建模流程图，你可以对照着看：
4.6 一个具体的参数示例
光说理论太干，我给你一个实际用过的参数：
// 下平台参数
R_b = 0.5; // 单位：米
delta_b = 10.0; // 单位：度
// 上平台参数
R_p = 0.35; // 单位：米
delta_p = 8.0; // 单位：度
// 杆长参数
L_min = 0.6; // 最短杆长
L_max = 0.9; // 最长杆长
L_0 = 0.75; // 中位杆长这个参数配置，我曾在某款飞行模拟器上用过。上下平台半径比大约是1.43:1，角度偏移差2°，工作空间比较均衡。当然，具体参数要根据你的应用场景来调，没有万能公式。
一句话总结：几何建模就是把物理结构翻译成数学语言。半径、角度偏移、杆长，这三个参数搞清楚了，后面的正逆解算法就有了根基。
好了，这一节就到这里。下一节我们开始讲正解——给定杆长，怎么算出上平台的位置和姿态。那才是真正烧脑的部分。
公众号:蓝海资料掘金营，微信deep3321