六由度并联机器人位姿控制分析和仿真.docVIP

六由度并联机器人位姿控制分析和仿真 　　摘 要：利用刚体空间六个自由度运动原理，以Stewart平台为例，介绍了并联机构正反解的基本原理。并针对并联机构更困难的正解问题，利用Matlab设计一个图形加数字坐标仿真程序，可以方便地求得并联机构符合实际客观条件的位置解，并直观地观察各杆件之间的空间关系。 　　关键词：正解；反解；坐标；位姿；仿真 　　引言 　　机器人从20世纪诞生以来，以迅速成为一门应用十分广泛的技术。机器人技术在工程中的应用日益广泛，即工业机器人。其中研究比较早，目前工程界应用比较成熟的是串联机器人。它是一种能够自动定位控制、多自由度、各大大小小的机械臂以串联的形式联接起来。这种典型的开环机构具有结构简单，成本低，控制简单，运动空间大等优点。但伴随着其结构特性的缺点则是承载能力有限、机构刚度差，各运动机构叠加误差大，运动惯性大。而在80年代以来随机计算机技术的发展，并联机器人的研究成为了新的热点。并联机器人与串联机器人正好可以形成互补，它的优点极为串联机器人的缺点，相应它的缺点则是串联机器人的优点，因此并联机器人在飞行模拟器，空间对接器、装配生产线等需要高精度，高稳定性，高速的场合应用越来越广泛。但串联机器人与并联机器人的基础理论基本一样，所以文章以六自由度并联机器人最典型的结构――Stewart平台简析六自由度机器手入手，在运动学的位置正反解。文章总结的内容中略去了有关机器人的数学基础知识和基础力学知识，假设已经具备一定的矢量代数，矩阵论，和工学力学知识，直接进入对机器人本身的运动进行了分析。并约定，一般黑色字体变量为矢量，非黑字体变量为标量。 　　1 六自由度并联机器人运动学 　　研究操作手的几何学要区分两个问题，即在同一系统下的运动学正问题和逆问题，所谓的正问题就是给定关节变量前提下，求机器人执行终端的位姿，这个求解过程就叫正解。而逆问题反过来，设定定机器人执行终端的位置，反求各关节变量，这个求解过程叫反解。 　　见图1a所示并联操作手，关于这个并联机构的反解其实是容易的，这里不再叙述，有兴趣者可参阅本文列出得参考文献。现在主要对其行运动学正问题分析，但在应用到如图1的并联机器人中时，他的正解运动学却并不那么简单。 　　在图1a中，考虑三角形AiSiBi，i=1～3，角标i表示第i对腿。当6个腿的长度固定，把平台M去掉，三角形AiSiBi只能绕AiBi轴旋转。这样，我们可以用一个长度为li的腿代替长度为qia和qib的一对腿，这条腿通过一个绕AiBi的转动关节和六角基座平台β相连接。结构简化后的结果如图2所示，它在运动学上的等价于图1a的原来结构。 　　图1 6自由度飞行器模拟器 　　a）基本结构 b）三角形活动平台、六角形固定平台 　　然后引入坐标系Fi，它的原点设在第i个腿和基座平台β连接的点口Oi处，并作如下约定： 　　对i=1，2，3， 　　Oi是连接旋转关节的中心的集合； 　　Xi的方向是从Ai指向Bi 　　Yi的选择是由Zi垂直于6边形固定平台指向上来确定的，也就是X与Y坐标向量的矢量积方向朝上。 　　之后来确定从六边形的中心O到移动平台的3个顶点S1，S2 和S3的位置矢量。 　　我们需要确定li和Oi。参考图2和图3，其中ai和bi表示Ai，和Bi相对O为原点基座坐标的矢量。对于i=1，2，3，有 　　因此ui是由Ai指向Bi的单位矢量。而且，原点Oi的位置由矢量oi确定，oi的表述如下： 　　（1） 　　进而，设si为在坐标系Fi（Oi，Xi，Yi，Zi）中Si的位置矢量，则 　　（2） 　　图2 等效简化机构 　　图3 一条腿与一对腿的等效 图4 坐标系F0与坐标系Fi的关系 　　现在，将一个坐标系空间F0定义为原点 O和X，Y，轴在六边形固定平面上，其上的 Xi和 Yi的关系如图4所示.当在坐标系F0中表达，si的形式如下 　　（2.3） 　　这里，[Ri]0是在坐标系F0中表达的从坐标系F0到坐标系Fi的旋转矩阵，给出如下 　　（2.4） 　　参考图（4）有 　　（2.5） 　　（2.6） 　　将式（4）～式（6）代入式（3）得到 　　（2.7） 　　这里，Oi由式（8）给出。 　　因为活动三角平台三个顶点之间的距离是固定的，所以位置矢量S1，S2，S3必须满足以下约束 　　（8a） （8b） （8c） 　　展开后，式（8a-c）取形式 　　（9a） 　　（9b） 　　（9c） 　　Di，Ei，Fi都是已知数据，i为1～5， 他们可以通过计算得到，经过整理后具体形式如下。 　　其中 ，是一个2*2反对称矩阵，这样三个方程已经 　　列好，并对应三个未知数？准1，？准2，？准3。方程数与未知数数量一致，