其中 Li 为 6 个缸长值， Pix , P , P 为上台面的 6 个动点的坐标值， Bix , Biy , Biz 为下台面 iy iz 6 个静点的初始坐标值。 这样就能够获得 6 个独立的显式方程，当已知机构的基本尺寸和上台面的位置和姿态 后，就可通过上式来求出 6 个缸的位移了。达到反解出杠长的目的。

  和姿态，分别为 x, y, z 方向上的转角值和平移量，求各个杠长，即各缸的位移，这就是平台

  在上平台建立一个坐标系中初始状态下，动坐标系 X Y Z 建立在上平台上的中心位 置，这样上下台面的 12 个点都对应一个初始坐标值[7]。当上台面改变时能够准确的通过平面与平 面上点的关系求出此时新点的坐标值 P 。

  跌代是个无限的过程，而实际计算过程中只能跌代有限次，为了节约计算时间，就要求 跌代的收敛速度快。牛顿跌代法的收敛速度较快。在实际的跌代中，只要前后两次跌代之差 的绝对值不超过允许的误差 ε ，即满足

  ∑ P 当作初始点，重复（10）~（13）直到满足求解精度为止。因为六自由度运动平台一

  般在中位附近运动，在算法上把正解的初始值设为运动平台的中位，保证了算法的收敛。在 实际过程中还可以把上次的平台状态记住， 当作此次运算的初始值， 这样跌代的次数还会进 一步减少。

  下面是试验中测得的几组数据六自由度正解实验数据组别号缸长mm50号缸长mm98号缸长mm08号缸长mm08号缸长mm83号缸长mm平移mm平移mm平移mm54试验所用的系统配置为cpu161g内存512m运行所花时间最少为008ms只跌代一次就得到满足精度的值最慢需要036ms跌代次实际过程中我们选定上一次纪录的姿态作为正解初始值这样基本上只需要1次就可以跌代出结果来运算时间上能控制在01ms内了完全能够完全满足工业上面所要求的控制要求了

  跌代法是一种重要的逐次逼近的求根方法， 它是利用某个固定的公式， 把选定的方程的 根的初值反复代入，以校正根的近视值，使之逐步精确化，最后得到满足精度要求的解。 牛顿跌代法是一种常用的跌代方法，其基本思想是把非线性方程 f ( x ) = 0 转化为某个 线性方程求解。 则函数 f ( x ) 在 x0 附近可以用一阶泰勒多项 设已知方程 f ( x ) = 0 的一个近似根为 x0 ， 式表示并化简的

  六自由度运动平台是一种重要的仿真实验设备，其应用场景范围十分普遍。因其结构相对比较简单、 高刚度、高精度和高负载能力等优点，六自由度运动平台已成为飞机、舰船、宇航和车载设 备进行动态可靠性研究的重要模拟试验装置。 这种系统普遍采用 Stewart 平台及其变形机构， 平台有上下两个平台和 6 个并联的、 可独立自由伸缩的杠杆组成， 伸缩杠和平台之间通过球 铰链联接，通过改变伸缩杠的长度能轻松实现上动台面的空间多自由度运行[1]。 对于并联机构的六自由度平台在运动过程中， 要保证运动的实时性和正确性， 就需要通 过对伸缩杠的精确控制来实现， 这就需要引入六自由度平台的实时位置正反解算法。 所谓六 自由度平台的位置反解， 是指由运动平台的空间姿态求六个伸缩杠的伸缩量。 而六自由度的 位置正解，是指有六个伸缩杠的伸缩量来求运动平台的空间姿态[2] 本课题是通过对 Stewart 型六自由度运动平台的研究，建立一种具有运动学正反解的 数学模型，通过计算机程序实现该数学模型，仿真并实际运行。

  个方向余旋。P 0 为初始点的坐标值，P 为上平台在 x, y, z 方向上的 3 个位移量。这样有空 间点的几何关系能够获得平台的位置反解计算方程

  算法实现后， 我们把它加入到控制六自由度平台运动的下位机控制程序中。 下位机是实 时操作系统 Vxworks 构成的，这样也保证了六自由度运动平台的实时和精确性。

  当六自由度运动平台的姿态为 x 向转角 0 度，平移 0mm；y 向转角 0 度，平移 0mm；z 向转角 0 度，平移 0mm 时，此时对应的 6 缸的长度都是 1039.576mm。这种情况就是六自 由度运动平台的初始状态。 下面是试验中获得的几组数据：

  如图 1， x, y, z 分别为空间的 3 个方向，对于与图中的 X , Y , Z 和 X , Y , Z ，在驱动器 的作用下改变伸缩杠的长度， 使上平台的位置和状态发生明显的变化。 若给定了上平台的空间位置

  正解方程可以由反解方程变化而来。只是由于正解方程用解析式表示起来过于麻烦， 所以这里我们通过向量或矩阵的方式来表示，那样无论是理解还是实现起来都要容易一些。 由式子（1），（2），（3）得

  由于并联机构结构的复杂性， 六自由度运动平台的位置正解难度比较大。 普通的解析法 虽然适合做理论上的研究，但是因实现难度太大，不适合工程上的应用，因而这里我们采用 数值解法来求解，从而求得缸长对应的上平台的位置和姿态，即 X，Y，Z 方向的转角值和 平移量[7]。 在这里我选择在数值解法中比较适用的牛顿跌代法来求解。

  因为正解的跌代算法运行起来比较的耗时， 如果把跌代精度设的过高， 那样跌代的次数 也会增加， 这对要求实时控制的六自由度运动平台肯定是不合适的， 所以我们把精度设置为

  10-5 （我们是为了表现其差别才把精度设高点，实际的精度还能更加进一步降低点），并在算 法上面也做了优化处理，这样运行时间会明显降低。 下面是试验中测得的几组数据

  对于一种机构的运动分析包括位置分析、 速度分析和加速度分析三部分， 位置分析是运 动学分析最基本的任务。 机构的位置分析是求解机构的输出和输入构件之间的位置关系。 对 于 Stewart 型六自由度平台就是六个输入杠的长度和作为输出的运动平台的姿态和位置之间 的关系[3]。 位置解有封闭解法和数值解法两种。 封闭解法通常是采用多种方法从约束方程组中消去 未知数，以得到单参数的多项式后再求解。封闭解法有许多的方法，包括矢量代数法、几何 法、矩阵法、螺旋代数法等等。其优点是在得到解析表达式后理论上还有很多应用，而且能 够得到全部解，其缺点是难度很大，没有通用性。而数值法一般会用跌代法、连续法等等方 式求方程组的代数值。 优点是可以比较迅速方便的得到机构的位置解， 缺点是一般得不到全 部的解，不适合做理论上的研究[4]。 本课题中六自由度运动平台的反解是通过封闭解法得到的，而正解采用的数值解法。

  上式中 P 0 为初始点坐标的一个 3*1 的行列式， 为包含 3 个角度变量的 3*3 余旋矩阵， T

  P 为包含 3 个位移变量的 3*1 的行列式，P 为新的空间坐标点的一个 3*1 的行列式 B 为下

  通过初等行变换求雅可比矩阵的逆矩阵，这样就完全转化为求矩阵的乘法和加减运算 （14）

  ∑ ( Pi Pi 0 ) ε （ ε 为所需要的精度），则可以把 ∑ Pi 当作所求的正解。否则把

  摘 要：本文研究了 Stewart 型六自由度平台的正解和反解。根据 Stewart 型六自由度平台 的结构的特点，为了达到高精度的实时控制，设计出具有算法简单、效率高，并具有易于编 程的正反解算法。本算法已经在 MATLAB 下仿真模拟过，并嵌入到实际平台上 VxWorks 系统下实际实现。本文介绍这一算法的实现思想。 关键词：Stewart 型六自由度平台；正解；反解；实时控制；VxWorks