《Stewart并联机构姿态奇异与无奇异姿态运动规划.doc》由会员分享，可在线阅读，更多相关《Stewart并联机构姿态奇异与无奇异姿态运动规划.doc（10页珍藏版）》请在三一文库上搜索。
1、Stewart并联机构姿态奇异与无奇异姿态运动规划- 收稿日期：2014-11-15 基金项目：国家自然科学基金资助项目（50905075）；安徽省自然科学基金资助项目（1308085QE78）；安徽理工大学硕博基金资助项目 Orientation-singularity Representation and Orientation Singularity-Free Motion Planning Analysis of the Stewart Parallel Mechanism LI Bao-kun1，2， GUO Yong-cun1， CAO Yi2 （1. School of Mech
2、anical Engineering， Anhui University of Science and Technology， Huainan Anhui 232001， China； 2. School of Mechanical Engineering， Jiangnan University， Wuxi Jiangsu 214122， China） Abstract：By using the unit quaternion as the orientation parameters， the orientation-singularity for a given position was
3、 studied and the method of the orientation-singularity-free motion planning was further explored. Based on the Jacobian matrix of the mechanism， a general symbolic analytical expression describing the orientation-singularity loci based on the quaternion representation for a given position was derive
4、d. The orientation kinematic equation and the time optimal orientation trajectory of a rigid body were constructed by using the quaternion algebra theory， respectively. After analyzing the orientation-singularity locus and using the time optimal orientation trajectory of a rigid body， the method of
5、time optimal orientation motion planning of the mechanism was explored. The research achievement enriches the singularity-avoidance of the Stewart parallel mechanism. Key words：parallel mechanism； orientation-singularity； singularity-free； orientation motion planning 六自由度Stewart并联机构由于刚度大、承载能力强以及运动精度
6、高等特点，已被广泛应用于运动模拟器、医疗器械、工业机器人、微纳操作、力/力矩传感器、空间探测、并联机床等多个高精技术领域1。奇异位形严重影响并联机构的运动及力传递性能，对于并联机构来说，若机构处于奇异状态，机构将严重失稳并导致机构失控甚至被损坏。因此，并联机构应位于远离奇异位形的区域工作。得到机构的奇异轨迹是奇异规避研究的基础2。文献3利用平面几何中的Ceva定理研究三角平台型Stewart并联机构的奇异位形。文献4研究了Stewart并联机构姿态固定时的位置奇异轨迹在三维空间内的结构特性。文献5以单位四元数为姿态参数，给出了Stewart并联机构奇异轨迹的三维图形描述。文献6给出了Stewa
7、rt机构的奇异轨迹，并进一步给出无奇异工作空间的确定方法。 对于并联机构来说，规避机构的奇异位形的一个重要方法便是通过增加冗余驱动来实现7-9，但对于具有六自由度的Stewart机构，采用冗余驱动无疑会带来机构控制的复杂性，并且会进一步限制机构的工作空间。文献10通过研究并联机构构型分岔特性，提出了一种利用扰动函数来规避并联机构转向点奇异的方法。文献11-13提出利用运动规划的方法避开机构的奇异位形。 由文献14-15可知，六自由度并联机器人机构动平台的任务空间对应于刚体运动变换群SE（3），相当于三维姿态变换群和三维欧式空间的半直积，即：SE（3）=SO（3）R3。由于对机构位于整个位形参数
8、空间内实施运动规划具有很大的难度，而位于R3上的位置运动规划研究已较为成熟，故本文主要对Stewart并联机构位于SO（3）上的姿态运动规划进行研究。 基于机构的雅可比矩阵，得出机构位于SO（3）上的姿态奇异轨迹，并给出其三维图形描述。基于机构姿态奇异的轨迹描述，研究机构时间最优的无奇异姿态运动规划。 1 机构的三维姿态奇异轨迹描述 六自由度Stewart并联机构的结构简图如图1所示，其动定平台为两个非相似型的半对称正六边形B1B2B6，C1C2C6 （i=1，2，6），并通过六根相同的球副-移动副-球副（或万向铰）支链（BiCi）相连。Bi和Ci分别为动定平台的六个顶点，Aj（j=1，3，5
9、）为定平台六边形长边的交点。 P、O、m、b、Rm、Rb的含义分别如下： P为机构动平台几何中心点；O为机构定平台几何中心点；m为动平台上边B4B5对应中心角，0m120；b为定平台上边 C1C2对应中心角，0b120；Rm为动平台外接圆半径；Rb为定平台外接圆半径。 图1 Stewart并联机构的结构简图 图2 机构位于给定位置的姿态奇异轨迹图2 无奇异姿态运动规划 21 姿态运动轨迹的四元数描述 单位四元数描述刚体的旋转变换也可表示成如下形式 图3 刚体姿态运动学方程的球面弧表示 22 时间最优姿态运动的四元数描述 图4 刚体时间最优姿态运动的球面描述 如图4所示，若使刚体由姿态变换到N，
10、除经M作用的旋转外，亦可经变换P实现。但是，不难发现，由于弧长P与弧长之和一定大于弧长M，也即刚体经姿态变换P所转过的角度要大于姿态变换M所转过的角度。因此，若使刚体从姿态快速变换到N，M所对应的姿态变换应是最短姿态变换路径，由于 若刚体起始姿态=（0， 1， 2， 3），目标姿态N=（0， 1， 2， 3），计算得到的姿态轨迹Q（t）=（q0，q1，q2，q3），若以四元数的矢量部分作为独立参数，可得到在三维笛卡尔坐标系中的姿态轨迹曲线qi（i=1， 2， 3），称该轨迹曲线即是刚体时间最优姿态运功的姿态轨迹曲线。该轨迹曲线的起始点为（1， 2， 3），终点为（1， 2， 3），由四元数运算
11、法则可知，姿态变换轨迹一般情况下应是一条曲线，当且仅当与共线或其中一个为0时，姿态轨迹为一条连接起始姿态点（1， 2， 3）到目标姿态点（1， 2， 3）的直线。 23 机构时间最优的无奇异姿态运动规划 Stewart并联机构动平台的三维姿态变换对应于刚体位于SO（3）上的姿态变换，因此，可将刚体时间最优姿态运动的姿态轨迹求解结果应用于该类型并联机器人机构的基于任务空间描述的时间最优姿态运动规划。但是，如前所述，该类型并联机器人机构存在复杂的奇异位形，而机构在运动过程中应规避奇异位形。若直接将内容2122的刚体时间最优姿态运动轨迹求解结果应用于机构的时间最优姿态运动规划，则机构的姿态运动路径可
12、能存在奇异点。因此，有必要基于机构位于SO（3）上的姿态奇异研究成果，结合上述刚体时间最优姿态轨迹求解方法，对机构实施时间最优的无奇异姿态运动规划。为便于阐述，现通过数值实例来说明具体操作方法。 数值实例 给定机构构型参数Rb=2、Rm=1、b=105、m=105，不考虑机构运动副运动范围限制，若机构动平台位于给定位置点（0， 0， 4），若要求机构动平台从起始姿态=（1， 0， 0， 0）经快速旋转作用到目标姿态N=（10/10， 0，-9/10， 3/10），对机构实施时间最优的姿态运动规划。 若不考虑机构位于位置（0， 0， 4）的姿态奇异轨迹影响，由式（7）得到机构快速姿态变换对应的单
13、位四元数为 M=-1=（2/2， 0，-1/2， 1/2） 机构动平台转过的角度为 =2arccos 0=2arccos （2/2）=/2 将姿态轨迹曲线近似无限小等分成N等份，由式（11）得到动平台姿态轨迹 Q（ti）=cos （i?2N）+sin（i?2N） （1， 0， 0， 0） （i=0， 1， ， N） 式中：单位方向矢量j由式（5）得到。 姿态轨迹（q1， q2， q3）中始终有q2=0。得到机构时间最优的姿态运动轨迹Q如图6所示。 图5 刚体姿态轨迹离散化的球面描述 机构力雅可比矩阵的条件数可以定量描述矩阵求逆的精确度和稳定性，也是反映机构位于相应位形时的运动及力传递性能的一个
14、重要指标，可反映机构远离奇异位形的程度。故此处用雅可比矩阵的条件数来描述机构的操作性能随姿态轨迹的变化情况。图7描述了机构雅可比矩阵条件数随图6所示姿态轨迹的变化趋势。 q2 图6 不考虑奇异时的机构时间最优姿态轨迹 q2 图7 不考虑奇异的机构雅可比矩阵条件数变化 从图6与图7可以看出，若根据机构运动起始姿态和目标姿态直接求解时间最优的姿态运动轨迹，机构在运动过程中可能会通过奇异点，而并联机器人机构在实际工作过程中应避开奇异点，因此，有必要使机构在不发生奇异位形的情况下，对机构实施无奇异的姿态运动规划。 综合机构姿态奇异轨迹分布情况，可将机构的姿态运动分为两步：第一步，机构从起始姿态=（1，
15、 0， 0， 0）快速旋转到Qmid=（2/2， 0，-1/2， 1/2）；第二步，机构从姿态Qmid快速作用到目标姿态N=（10/10， 0，-9/10， 3/10）。由式（7）得到这两步姿态变换对应的单位四元数分别为 M1=Qmid-1=（2/2， 0，-1/2， 1/2） M2=NQ-1mid=（20/20，3/10，10/20-92/20，32/20-10/20）机构动平台转过的角度分别为 1=2arccos （2/2）=/2 2=2arccos （20/20） 对应于动平台的姿态轨迹为 Q1=cos （i?12N1）+1sin （i?12N1） （1， 0， 0， 0） （i=0，
16、1， ， N1） Q2=cos（i?22N2）+2sin （i?22N2）（2/2， 0，-1/2， 1/2） （i=0， 1， ， N2） 重新规划的无奇异时间最优姿态运动轨迹如图8所示，图9描述了机构雅可比矩阵条件数大小随重新规划后的姿态轨迹的变化趋势。 q2 图8 机构旋转运动的无奇异时间最优姿态轨迹 q2 图9 雅可比矩阵条件数随时间变化 从图8与图9可以看出，重新规划的机构姿态运动轨迹不包含奇异点，该姿态运动轨迹是机构由起始姿态=（1， 0， 0， 0）经快速旋转作用到目标姿态N=（10/10， 0，-9/10， 3/10）的无奇异时间最优姿态运动轨迹。 3 结论 1） 以单位四元数为姿态参数，描述了Stewart并联机构位于给定位置的姿态奇异轨迹，对机构的位于给定位置时的奇异规避研究奠定了前期基础。 2） 基于四元代数运算法则，构建刚体姿态运动学方程，得到刚体运动的时间最优姿态轨迹方程。 3） 综合（1）和（2）研究内容得到Stewart并联机构基于任务空间描述的时间最优的无奇异姿态运动规划方法，其能够确保机构在不会出现奇异位形的条件下，以时间最优为目标运动到目标姿态。 4） 上述无奇异姿态运动规划很大程度上依赖于对机构姿态奇异轨迹分布情况的观察，作者下一步将集中于研究三维姿态空间内的自动搜寻并得到时间最优无奇异姿态运动规划方法。