stewart运动学分析

《stewart运动学分析》由会员分享，可在线阅读，更多相关《stewart运动学分析（6页珍藏版）》请在装配图网上搜索。

1、tewart型并联支撑机构运动学公式推导一、构型分析及坐标系建立静基座自动调平系统Stewart平台型并联支撑机构为双三角形机构，由一种活动上平台和一种固定的下平台所构成。上平台铰链点和基座平台铰链点的分布形式相似,但铰接点互相交错，六根支链分别用移动副和两个球铰链与上下平台连接。并联机构示意图如图所示。图1 Ser并联机构示意图支链与动平台铰接点为A1,A2,A3,支链与基座铰接点标记为B1，B2,B3。坐标系选在平台的三角几何中心,由右手螺旋法则拟定。动平台三角边长为a,定平台三角边长为b,动平台起始高度为h。根据设定的初始值,各支链与定平台、动平台铰接点的坐标如表一所示。支链编号与定平台

2、铰接点坐标与动平台铰接点坐标11(36b, -12b, 0 )1（-36a, -12a, h )（36b, -12b, 0 ）A2（33a, 0, h )3B（36b, 12b, 0 )(33a, 0, h )B2（36b, 12b, 0 ）(-36a, 12a, h ）3(33b, 0, 0 )A1(-36a, -12a, h ）6B(33b, 0, 0 )A3（-36a, 12a, h ）表一 铰接点坐标二、并联支撑机构正反解两个坐标系，和o，其中,o为固定坐标系。(1）将坐标系绕自身的x轴旋转；()将旋转后的坐标系绕固定坐标系的y轴旋转；(3)将第二步的坐标系绕固定坐标系的z轴旋转；旋转

3、矩阵分别为Rx=1000c-s0scRy=c0s010-s0cRz=c-s0sc0001按上述方式得到的总旋转变换矩阵为:Roo=RzRyRx=cccss-sccscscsss+ccssc-cs-scscc绕基坐标系旋转左乘，绕自身坐标系右乘设动平台的平移参数为(dx,dy,dz）,则坐标的齐次变换矩阵为：Too=cccss-sccsc+ss0scsss+ccssc-cs0-scscc00001对于与动平台铰接的各点Ai(=1，2，），点的齐次坐标为pAi,通过变换后的点相应标记为Ai,变换后的齐次坐标为pAi,则，pAi=ToopAi带入初始坐标后,得出变换后与动平台铰接的各点坐标值为：A1

4、xA1yA1z-36acc+12asc-css+hcsc+ss+dx-36asc-12asss+cc+hssc-cs+dy36as-12acs+hcc+dzA2xA2yA2z=33acc+hcsc+ss+dx33asc+hssc-cs+dy-33as+hcc+dzA3xA3yA3z=-36acc+12acss-sc+hcsc+ss+dx-36asc+12asss+cc+hssc-cs+dy36as+12acs+hcc+dz设六个驱动器的伸展长度为li(i=-6）,则与之相应的六个方程式表达为:l1=A1B1-A1B1=(A1x-B1x)2+(A1y-B1y)2+(A1z-B1z)2-l1l2=

5、A2B1-A2B1=(A2x-B1x)2+(A2y-B1y)2+(A2z-B1z)2-l2l3=A2B2-A2B2=(A2x-B2x)2+(A2y-B2y)2+(A2z-B2z)2-l3l4=A3B2-A3B2=(A3x-B2x)2+(A3y-B2y)2+(A3z-B2z)2-l4l5=A3B3-A3B3=(A3x-B3x)2+(A3y-B3y)2+(A3z-B3z)2-l5l6=A1B3-A1B3(A1x-B3x)2+(A1y-B3y)2+(A1z-B3z)2-l6由、dx、dy、dz通过上式推导得出li的过程，称为Stear平台的反解过程。Stewart平台的输入是六个驱动器的长度量，正解

6、就是有输入的驱动器长度，得出末端，即运动平台的姿态。相反，反解就是已知所要的最后姿态参数，得出驱动器的伸长量。在Stewart平台的运动分析中，反解好求，而正解难。与串联机器人的运动学分析相反。三、并联支撑机构速度/加速度分析设Si为沿驱动器i的单位矢量,li为驱动器i的长度，roB运动平台质心o到Bi点的位置矢量。o和vo分别是运动平台在惯性参照系中的角速度和线速度矢量，则运动平台上Bi点处的速度矢量为：vBi=oroB+vo矩阵形式为:vBi=-roBIovo式中表达矢量的反对称矩阵。对一种矢量x，有x=0-x3x2x30-x1-x2x10通过将运动平台上Bi点处的速度矢量vBi向驱动器方

7、向投影（即用单位矢量Si点乘Bi点的速度矢量vBi），可以得到驱动器的上下两部分沿驱动器方向的相对移动速度：上式推导过程（右手定则）：SioroB=-SiroBo=-SiroBo=(roBSi)oli=SivBi=SioroB+vo=roBSio+Sivo将上式写为矩阵形式为：li=（roBSi）TSiTovo， i1,2，,用一种广义速度矢量V来表达运动平台的角速度和线速度,即末端直角坐标速度:V=ovoT=xoyozovxovyovzoT用六维矢量q来表达六个驱动器的上下两部分沿驱动器方向的相对移动速度，即关节速度。联立成统一矩阵形式为:q=l1l6=（roB1S1）TS1T（roB6S6

8、）TS6Tovo=J*V式中6维矩阵J*称为末端直角坐标速度对关节速度的影响矩阵。上式给出了Stewart平台直角坐标速度对关节速度的变换关系。当给定某一时刻平台的位移参数以及在这个时刻平台的角速度及线速度,则可运用该式求得六个驱动器的运动速度,即Stear平台机构的速度反解方程。相反，机构的速度正解就是根据某一时刻的位移参数以及6个驱动器的运动速度求解该时刻平台的角速度及线速度，有：V=(J*)-1q=Jq矩阵J就是Swrt平台的雅克比矩阵。运动平台Bi处的加速度可通过平台质心的角加速度o和线加速度o得到:Bi=oroBi+o+o(oroBi)对li求导，得出：li=SiBi+(voBivo

9、Bi-li2)/li上式中,Bi为运动平台上Bi点处的加速度,将此项中的部分项展开，有：voBivoBi=oTvoT-roBiI-roBiIovo=VT-roBiroBiroBi-roBiIVli2=oTvoTroBiSiSi-SiTroBiIovo=VT-roBiSiSiTroBiroBiSiSiT-SiSiTroBiSiSiTV将上述两式相减,有：voBivoBi-li2=VTroBiSiSiTroBi-roBiSiSiTroBiSiSiT-SiSiTV上式推导过程：voBivoBi-li2=VT-roBiroBiroBi-roBiIV-VT-roBiSiSiTroBiroBiSiSiT-

10、SiSiTroBiSiSiTV =VT(-roBiroBiroBi-roBiI-roBiSiSiTroBiroBiSiSiT-SiSiTroBiSiSiT)V =VT-roBi(I-SiSiT)roBiroBi(I-SiSiT)-roBi(I-SiSiT)I-SiSiTV = VTroBiSiSiTroBi-roBiSiSiTroBiSiSiT-SiSiTV用单位矢量Si点乘方程右边最后一项,有:SiooroBi=oTroBiSio=VTroBiSi000V化简得到驱动器li的上下两部分沿驱动器方向的相对移动加速度，即关节加速度为：li=JiV+VTHiV式中,Ji为雅克比矩阵的第i行。Hi=1liroBiSiSiTroBi-roBiSiSiTroBiSiSiT-SiSiTSewart平台的加速度反解方程可写为：q=l1l6=JV+VTHV矩阵H称为加速度影响矩阵。Sear加速度正解方程：V=J-1q+qTH*q式中，H*=-JT(JH)J,符号表达矩阵的广义标量积,相称于把前面的矩阵当作一种常数，运算时用背面矩阵的每一种元素乘此前面的矩阵。例如，对于矩阵A和B，有：AB=Ab11Ab1nAbn1Abnn