Stewart并联机构姿态奇异与无奇异姿态运动规划

李保坤，郭永存，曹 毅

(1. 安徽理工大学机械工程学院，安徽 淮南 232001； 2. 江南大学机械工程学院，江苏 无锡 214122)

Stewart并联机构姿态奇异与无奇异姿态运动规划

李保坤1, 2，郭永存1，曹 毅2

(1. 安徽理工大学机械工程学院，安徽 淮南 232001； 2. 江南大学机械工程学院，江苏 无锡 214122)

以单位四元数为姿态参数，研究Stewart并联机构位于给定位置的姿态奇异并进一步探讨机构的无奇异姿态运动规划方法。基于机构的雅可比矩阵，构建机构给定位置的以单位四元数表征的姿态奇异轨迹的一般符号解析表达式。利用四元代数理论构建刚体姿态运动学方程和时间最优姿态轨迹方程；通过分析机构姿态奇异轨迹分布并利用刚体运动的时间最优姿态轨迹方程，研究机构无奇异时间最优的姿态运动的规划方法。研究成果进一步丰富了Stewart并联机构的奇异规避理论。

并联机构；姿态奇异；无奇异；姿态运动规划

六自由度Stewart并联机构由于刚度大、承载能力强以及运动精度高等特点，已被广泛应用于运动模拟器、医疗器械、工业机器人、微纳操作、力/力矩传感器、空间探测、并联机床等多个高精技术领域[1]。奇异位形严重影响并联机构的运动及力传递性能，对于并联机构来说，若机构处于奇异状态，机构将严重失稳并导致机构失控甚至被损坏。因此，并联机构应位于远离奇异位形的区域工作。得到机构的奇异轨迹是奇异规避研究的基础[2]。文献[3]利用平面几何中的Ceva定理研究三角平台型Stewart并联机构的奇异位形。文献[4]研究了Stewart并联机构姿态固定时的位置奇异轨迹在三维空间内的结构特性。文献[5]以单位四元数为姿态参数，给出了Stewart并联机构奇异轨迹的三维图形描述。文献[6]给出了Stewart机构的奇异轨迹，并进一步给出无奇异工作空间的确定方法。

对于并联机构来说，规避机构的奇异位形的一个重要方法便是通过增加冗余驱动来实现[7-9]，但对于具有六自由度的Stewart机构，采用冗余驱动无疑会带来机构控制的复杂性，并且会进一步限制机构的工作空间。文献[10]通过研究并联机构构型分岔特性，提出了一种利用扰动函数来规避并联机构转向点奇异的方法。文献[11-13]提出利用运动规划的方法避开机构的奇异位形。

由文献[14-15]可知，六自由度并联机器人机构动平台的任务空间对应于刚体运动变换群SE(3)，相当于三维姿态变换群和三维欧式空间的半直积，即：SE(3)=SO(3)⊗R3。由于对机构位于整个位形参数空间内实施运动规划具有很大的难度，而位于R3上的位置运动规划研究已较为成熟，故本文主要对Stewart并联机构位于SO(3)上的姿态运动规划进行研究。

基于机构的雅可比矩阵，得出机构位于SO(3)上的姿态奇异轨迹，并给出其三维图形描述。基于机构姿态奇异的轨迹描述，研究机构时间最优的无奇异姿态运动规划。

1 机构的三维姿态奇异轨迹描述

六自由度Stewart并联机构的结构简图如图1所示，其动定平台为两个非相似型的半对称正六边形B1B2…B6，C1C2…C6(i=1，2，…，6)，并通过六根相同的球副-移动副-球副(或万向铰)支链(BiCi)相连。Bi和Ci分别为动定平台的六个顶点，Aj(j=1，3，5)为定平台六边形长边的交点。

P、O、βm、βb、Rm、Rb的含义分别如下：

P为机构动平台几何中心点；O为机构定平台几何中心点；βm为动平台上边B4B5对应中心角，0°≤βm≤120°；βb为定平台上边C1C2对应中心角，0°≤βb≤120°；Rm为动平台外接圆半径；Rb为定平台外接圆半径。

为分析并得到机构的奇异轨迹方程，在机构动平台上建立固连坐标系P-xyz，在定平台上建立固定参考系O-XYZ。将动平台中心点P作为动平台运动的位置参考点，设点P在固定参考系O-XYZ中的位置矢量记为P=[X，Y，Z]T；记动平台各铰点Bi在动坐标系P-xyz中的位置矢量为bi(i=1， 2， …， 6)，记Bi在固定坐标系O-XYZ中的位置矢量为Bi(i=1， 2， …， 6)；定平台各个铰点Ci在固定参考系O-XYZ中的位置矢量记为Ci(i=1， 2， …， 6)。

定义机构的初始姿态，其满足如下条件：

① 给定机构动平台参考点P的位置；② 动定坐标系的相应坐标轴相互平行。

(1)

由坐标变换原理不难得到Bi与bi满足Bi=Rbi+P

(2)

将式(1)带入机构奇异位形判别矩阵

(3)

若令式(3)所示矩阵的行列式等于零，即可得到机构奇异位形关于位姿参数的解析表达式

F(A，B)=0

式中：A表示机构动平台的位置参数，B表示机构动平台的姿态参数。

(4)

当给定机构的构型参数Rm=1、Rb=2、βm=75°、βb=105°，机构位于给定位置(0， 0， 4)时关于姿态参数(q1，q2，q3)的姿态奇异轨迹在笛卡尔坐标系中的三维图形化描述如图2所示。

2 无奇异姿态运动规划

2.1 姿态运动轨迹的四元数描述

单位四元数描述刚体的旋转变换也可表示成如下形式

(5)

其共轭四元数可表示成

(6)

故

(7)

式中：ε∈[0，1]，角速度在时间区间[t，t+.Δt]被假定为为常值ω(t+εΔt)，当Δt趋向于零时，便可得到四元数增量的精确值

(8)

将整个时间区间[0，T]分成N个间隔Δti

(i， i+1=1， 2， …， N)

在ti+1时刻的单位四元数，将通过如式(5)所示的无限小变换四元数以及在ti时刻的数值确定

Q(ti+1)=ΔQ(ti)∘Q(ti)=

εi∈[0， 1] (9)

若刚体在t=T0时刻从单位四元数Q0开始进行旋转运动，则近似有

Q(ti+1)=ΔQ(ti)∘Q(ti)=

(10)

上式可用图3说明。

2.2 时间最优姿态运动的四元数描述

如图4所示，若使刚体由姿态Λ变换到N，除经M作用的旋转外，亦可经变换Σ∘P实现。但是，不难发现，由于弧长P与弧长Σ之和一定大于弧长M，也即刚体经姿态变换Σ∘P所转过的角度要大于姿态变换M所转过的角度。因此，若使刚体从姿态Λ快速变换到N，M所对应的姿态变换应是最短姿态变换路径，由于

N=M∘Λ

(11)

M可根据下式求解

M=N∘Λ-1

(12)

若由式(12)计算得

(13)

不难得到刚体从姿态Λ变换到N时，相对于固定坐标系的姿态轨迹为

Q(t)=M(t)∘Λ

(14)

将上述得到的姿态轨迹表达式(14)离散化处理。将时间区间[0，T]分成N个间隔Δti，在每个等分内的角速度可以看成是定值，则有

Q(ti+1)=M(ti+1)∘M(ti)∘…∘M(t1)∘Λ

(15)

其中，

(i=0， 1， 2， …) (16)

式中：t0=0，εi∈[0， 1]。若刚体从起始0时刻的姿态Λ快速旋转到最终姿态N，由式(15)和式(16)可计算出刚体时间最优的姿态运动在ti+1时刻的姿态Q(ti+1)，如图5所示。利用欧拉公式，式(15)亦可写成形如式(10)所示的指数积形式

Q(ti+1)=M(ti+1)∘Λ0=

(17)

若刚体起始姿态Λ=(λ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)，由四元数运算法则可知，姿态变换轨迹一般情况下应是一条曲线，当且仅当λ与μ共线或其中一个为0时，姿态轨迹为一条连接起始姿态点(λ1，λ2，λ3)到目标姿态点(ν1，ν2，ν3)的直线。

2.3 机构时间最优的无奇异姿态运动规划

Stewart并联机构动平台的三维姿态变换对应于刚体位于SO(3)上的姿态变换，因此，可将刚体时间最优姿态运动的姿态轨迹求解结果应用于该类型并联机器人机构的基于任务空间描述的时间最优姿态运动规划。但是，如前所述，该类型并联机器人机构存在复杂的奇异位形，而机构在运动过程中应规避奇异位形。若直接将内容2.1～2.2的刚体时间最优姿态运动轨迹求解结果应用于机构的时间最优姿态运动规划，则机构的姿态运动路径可能存在奇异点。因此，有必要基于机构位于SO(3)上的姿态奇异研究成果，结合上述刚体时间最优姿态轨迹求解方法，对机构实施时间最优的无奇异姿态运动规划。为便于阐述，现通过数值实例来说明具体操作方法。

若不考虑机构位于位置(0， 0， 4)的姿态奇异轨迹影响，由式(7)得到机构快速姿态变换对应的单位四元数为

机构动平台转过的角度为

将姿态轨迹曲线近似无限小等分成N等份，由式(11)得到动平台姿态轨迹

(1， 0， 0， 0)

(i=0， 1， …， N)

式中：单位方向矢量μj由式(5)得到。

姿态轨迹(q1，q2，q3)中始终有q2=0。得到机构时间最优的姿态运动轨迹Q如图6所示。

机构力雅可比矩阵的条件数可以定量描述矩阵求逆的精确度和稳定性，也是反映机构位于相应位形时的运动及力传递性能的一个重要指标，可反映机构远离奇异位形的程度。故此处用雅可比矩阵的条件数来描述机构的操作性能随姿态轨迹的变化情况。图7描述了机构雅可比矩阵条件数随图6所示姿态轨迹的变化趋势。

从图6与图7可以看出，若根据机构运动起始姿态和目标姿态直接求解时间最优的姿态运动轨迹，机构在运动过程中可能会通过奇异点，而并联机器人机构在实际工作过程中应避开奇异点，因此，有必要使机构在不发生奇异位形的情况下，对机构实施无奇异的姿态运动规划。

对应于动平台的姿态轨迹为

(1， 0， 0， 0)

(i=0， 1， …，N1)

(i=0， 1， …，N2)

重新规划的无奇异时间最优姿态运动轨迹如图8所示，图9描述了机构雅可比矩阵条件数大小随重新规划后的姿态轨迹的变化趋势。

3 结论

1) 以单位四元数为姿态参数，描述了Stewart并联机构位于给定位置的姿态奇异轨迹，对机构的位于给定位置时的奇异规避研究奠定了前期基础。

2) 基于四元代数运算法则，构建刚体姿态运动学方程，得到刚体运动的时间最优姿态轨迹方程。

3) 综合(1)和(2)研究内容得到Stewart并联机构基于任务空间描述的时间最优的无奇异姿态运动规划方法，其能够确保机构在不会出现奇异位形的条件下，以时间最优为目标运动到目标姿态。

4) 上述无奇异姿态运动规划很大程度上依赖于对机构姿态奇异轨迹分布情况的观察，作者下一步将集中于研究三维姿态空间内的自动搜寻并得到时间最优无奇异姿态运动规划方法。

[1] 黄真，赵永生，赵铁石. 高等空间机构学[M]. 北京： 高等教育出版社，2006：15-200.

[2] JIANG QIMI， GOSSELIN C M. Determination of the maximal singularity-free orientation workspace for the Gough-Stewart platform[J]. Mechanism and Machine Theory，2009，44(6)：1 281-1 293.

[3] PENDAR H，MAHNAMA M，ZOHOOR H.Singularity analysis of parallel manipulators using constraint plane method[J]. Mechanism and Machine Theory， 2011，1(46)： 33-43.

[4] 李保坤，曹毅，张秋菊，等. Stewart并联机构位置奇异研究[J]. 机械工程学报，2012，48(9)：33-4.

[5] 程世利，吴洪涛，王超群，等. 平面平台型Stewart 并联机构的奇异性分析[J]. 机械工程学报，2011，47(9)：1-7.

[6] LI BAOKUN，CAO YI，ZHANG QIUJU，et al. Singularity representation and workspace determination of a special class of the Gough-Stewart platforms[J]. International Journal of Advanced Robotic Systems，2013，10(12)： 1-13.

[7] SAGLIA J， DAI J S， CALDWELL D G. Geometry and kinematic analysis of a redundantly actuated parallel mechanism that Eliminates Singularity and Improves Dexterity[J]. ASME， Journal of Mechanical Design， 2008， 130(12)： 124501-1-5.

[8] 杨建新，余跃庆. 平面三自由度冗余并联机构的驱动奇异性分析[J]. 中国机械工程，2006，17(6)：629-632.

[9] 张彦斐，宫金良，高峰. 冗余驱动消除并联机构位形奇异原理[J]. 中国机械工程，2006，17(5)：445-448.

[10] 王玉新，李雨桐，潘双夏. 一种规避并联机构转向点奇异问题的新方法[J]. 中国科学E辑：技术科学，2008，38(1)： 125-136.

[11] DASH A K， CHEN I， YEO S H， et al. Workspace generation and planning singularity-free path for parallel manipulators. Mechanism and Machine Theory， 2005， 40(7)： 776-805.

[12] ARAKELIAN V， BRIOT S， GLAZUNOV V. Improvement of functional performance of spatial parallel manipulators using mechanisms of variable structure[C]//Proceedings of the Twelfth World Congress in Mechanism and Machine Science IFToMM， Besancon， France， June 18-21， 2007： 159-164.

[13] 白志富，陈五一. 并联机构不同正解间无奇异转换问题探讨[J]. 机器人，2006，28(5)：463-469.

[14] 于靖军，刘辛军，丁希仑，等. 机器人机构学的数学基础[M]. 北京：机械工业出版社，2008.

[15] (英)SELIG J M. 机器人学的几何基础[M]. 杨向东，译. 北京：清华大学出版社，2008：8-150.

[16] MURRAY R M， LI Z， SASTRY S S. A Mathematical introduction to robotic manipulation[M]. Boca Raton： CRC Press， 1994：10-160.

[17] (苏)B. H. 勃拉涅茨，И. Π. 什梅列夫斯基. 四元数在刚体定位问题中的应用[M]. 梁振和，译. 汪朝群，校.北京：国防工业出版社，1977：7-150.

(责任编辑：李 丽)

关于本刊启用稿件在线处理系统的通知

为了加快稿件处理速度，缩短稿件出版周期，方便广大作者投稿及查询稿件处理情况，本刊已开通稿件在线处理系统(http://210.45.144.193/Jweb_aust/) ，请作者通过在线处理系统进行投稿、查稿。系统设有作者中心、专家中心、编辑中心和主编中心四部分，实现在线投稿、审稿、编辑一条龙处理。首次作者投稿请先注册，并记住注册的用户名和密码。注册登录后就可以向本刊投稿并查询稿件处理状态。请不要重复注册，否则可能导致您信息查询不完整。从即日起不再接受其它方式的投稿。

《安徽理工大学学报》编辑部

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 Mechanical Engineering, Anhui University of Science and Technology, Huainan Anhui 232001, China; 2. School of Mechanical Engineering, Jiangnan University, Wuxi Jiangsu 214122, China)

By using the unit quaternion as the orientation parameters, the orientation-singularity for a given position was 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 derived. 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 time optimal orientation motion planning of the mechanism was explored. The research achievement enriches the singularity-avoidance of the Stewart parallel mechanism.

parallel mechanism; orientation-singularity; singularity-free; orientation motion planning

2014-11-15

国家自然科学基金资助项目(50905075)；安徽省自然科学基金资助项目(1308085QE78)；安徽理工大学硕博基金资助项目

李保坤(1982-)，男，安徽舒城人，讲师，博士，主要从事于机构学与机器人技术研究。

TP242.2

A

1672-1098(2015)02-0013-07