stewart运动学分析.docx

Stewart 型并联支撑机构运动学公式推导一、构型分析及坐标系建立静基座自动调平系统 Stewart 平台型并联支撑机构为双三角形机构,由一个活动上平台和一个固定的下平台所组成。上平台铰链点和基座平台铰链点的分布形式相同,但铰接点相互交错,六根支链分别用移动副和两个球铰链与上下平台连接。并联机构示意图如图 1所示。图1Stewart 并联机构示意图支链与动平台铰接点为,, 支链与基座铰接点标记为, , 。坐标系选在平台的三角几何中心,由右手螺旋法则确定。动平台三角边长为,定平台三角边长为 b, 动平台起始高度为 h。根据设定的初始值,各支链与定平台、动平台铰接点的坐标如表一所示。支链编号与定平台铰接点坐标与动平台铰接点坐标 1B 1() A 1() 2B 1() A 2() 3B 2() A 2() 4B 2() A 3() 5B 3() A 1() 6B 3() A 3() 表一铰接点坐标二、并联支撑机构正反解两个坐标系, o和,其中, o为固定坐标系。(1)将坐标系 o绕自身的 x轴旋转γ; (2)将旋转后的坐标系绕固定坐标系的 y轴旋转β; (3)将第二步的坐标系绕固定坐标系的 z轴旋转α; 旋转矩阵分别为按上述方式得到的总旋转变换矩阵为: 设动平台的平移参数为( ,,),则坐标的齐次变换矩阵为: 对于与动平台铰接的各点(i=1,2,3), 点的齐次坐标为, 经过变换后的点对应标记为,变换后的齐次坐标为,则, 带入初始坐标后,得出变换后与动平台铰接的各点坐标值为: === 设六个驱动器的伸展长度为(i=1--6), 则与之相应的六个方程式表示为: ====== 由经过上式推导得出的过程,称为 Stewart 平台的反解过程。三、并联支撑机构速度/ 加速度分析设为沿驱动器 i的单位矢量,为驱动器 i的长度,运动平台质心到点的位置矢量。和分别是运动平台在惯性参考系中的角速度和线速度矢量,则运动平台上点处的速度矢量为: 矩阵形式为: 式中^表示矢量的反对称矩阵。对一个矢量 x,有通过将运动平台上点处的速度矢量向驱动器方向投影(即用单位矢量点乘点的速度矢量),可以得到驱动器 i的上下两部分沿驱动器方向的相对移动速度: 上式推导过程(右手定则): 绕基坐标系旋转左乘,绕自身坐标系右乘 Stewart 平台的输入是六个驱动器的长度量,正解就是有输入的驱动器长度,得出末端,即运动平台的姿态。相反,反解就是已知所要的最终姿态参数,得出驱动器的伸长量。在 Stewart 平台的运动分析中,反解好求,而正解难。与串联机器人的运动学分析相反。将上式写为矩阵形式为: ,i=1,2, …,6 用一个广义速度矢量 V来表示运动平台的角速度和线速度,即末端直角坐标速度: 用六维矢量来表示六个驱动器的上下两部分沿驱动器方向的相对移动速度, 即关节速度。联立成统一矩