六自由度机械手.doc

0机器人技术基础结业论文机器人技术基础结业论文六自由度机械臂的运动设计姓姓名：彭小波名：彭小波学学号：号：11004020121班班级：级：110040201学学院：院：机械工程学院机械工程学院指导老师：王黎明指导老师：王黎明2013.120目目录录摘要摘要.1前言前言.11、位姿与指尖的空间位置之间的关系位姿与指尖的空间位置之间的关系.222、目标位姿预测分析、目标位姿预测分析.32211目标位姿预测目标位姿预测.32222运动规划运动规划.32233问题求解问题求解.33、受限目标到达及避障分析受限目标到达及避障分析.83.13.1避障方法避障方法.83.23.2问题求解问题求解.84、沿路线运动分析沿路线运动分析.104.14.1沿路线运动沿路线运动.104.2问题求解问题求解.105、误差分析、误差分析.115.15.1算法误差算法误差.115.25.2误差精度误差精度.116、结语、结语.12参考文献参考文献.131六自由度机械臂的运动设计摘要为了使六自由度机械臂完成特定的动作需要设计计算相应的指令序列.首先计算了机械臂位姿与指尖位置之间的关系公式然后针对机械臂的到达问题、沿曲线运动问题和避障问题分别提出目标位姿预测、曲线离散到达和受限目标到达三种解决方法其中涉及的关键算法是自适应搜索法该方法具有效率高、精度高、适用范围广的特点.在产生指令序列时采用贪心算法.通过以上方法得到的执行结果误差很小(018mm)同时搜索收敛速度也很快.关键词:机械臂运动规划自适应搜索位姿预测TheTrajectoryPlanningofa6-DOFManipulatorAbstractTomakethe62DOFmanipulatortofinishsomekindofjobsweneedtopreparetheinstructionsequencesto.FirstlythispapergivesthefunctionwhichdecidestherelationshipbetweentheposeofthemanipulatorandthepositionoftheFingertip.Andtheninordertosolvethethreejobs:theproblemofarrivingatsomepointtheproblemofmovingalongaspecialcurveandtheproblemofavoidingobstacleswedesignthrees:posespeculationdiscretelyarrivingandconstrainedarriving.Themainalgorithmisadaptivesearchwhichishighlyefficienthighlyaccurateanditcanbeusedinmanysituations.WhencalculatingtheinstructionsweusegreedyAlgorithm.Allofthisresultsinveryshorttimesearchingandverylittleerrors(0.8mm).Keywords:manipulatortrajectoryplanningadaptivesearchposespeculation前言前言：一个六自由度机械臂的运动设计，如何为机械臂输入正确的指令序列以使其完成相应的任务是本问题要求解的目标。由于该机械臂有六个自由度一个目标点(指尖到达的位置可能对应机械臂的多种位姿但机械臂的一个位姿只会对应一个目标点。因此问题的关键就是如何利用高效的方法求出一个可行位姿使得机械臂在该姿态下到达目标点。产生指令序列时只需要采用贪心法由初始位姿过渡到目标位姿即可。对于机械臂的其他动作可以将其转化为多个目标点的依次到达问题。在有障碍物时它对于从起始点搜索到目的点的影响就是要在搜索的过程中加入一系列的约束条件使得机械臂可以不和障碍物相碰。因此本文参考了“蔡自兴，机器人学M，清华大学出版社20009”、“丁学恭，机器人控制研究M，浙江大学出版社20069”、博士论文“基于视觉的六自由度机械臂控制技术研究”、“激光焊接的关节型机器人运动误差分析”、“6自由度机器人梯形速度控制直线插补算法研究”“六自由度机械臂的运动学分析”、“六自由度机械手运动控制”等对6自由度机械手臂的运动设计主要进行了1、位姿与指尖的空间位置之间的关系的研究，2、目标位姿的预测分析，3、受限目标到达及避障的分析，4、沿线路运动的分析，5、计算的误差分析等的研究说明，最终还对本次的所有项目做了总结。211、位姿与指尖的空间位置之间的关系、位姿与指尖的空间位置之间的关系机器人关于六个自由度的每一个组合(=123456)表示机械臂的一个位姿显然每个位姿确定顶端指尖的空间位置X:f()X.如图2对所给的机械臂在其各个关节点建立相应的笛卡尔坐标系。其中以A为原点建立的坐标系就是题中给出的坐标系1坐标系和2坐标系的原点都建立在B点3坐标系建在C点456坐标系的原点都重合地建立在D点每个坐标系的Z轴都和相应关节旋转轴所在直线重合。图1、机械臂示意图图2、机械臂各个关节处的笛卡尔坐标系各个连杆变换矩阵如下:3其中jTi表示从关节i坐标系转换到关节j坐标系的转换矩阵。各连杆变换矩阵相乘得到机械臂的变换矩阵为:0T6=0T1(1)1T2(2)2T3(3)3T4(4)4T5(5)5T6(6)所以第6个坐标系中的坐标(x6y6z61)T在以基座A为原点的坐标系的表示为：(x0y0z01)T=0T6(x6y6z61)T对E点其在第六个坐标系中的坐标为(00651)T容易得到E点在基座A为原点的坐标系中的坐标它与6无关。22、目标位姿预测分析目标位姿预测分析对于给定的可达目标点我们首先需要做的就是预测机械臂在到达目标点时的位姿即各个旋转轴的角度.2.12.1目标位姿预测目标位姿预测对目标位姿预测采用调整自适应的搜索法，由图中位置关系及各个旋转轴的连杆方式(平行连杆、垂直连杆)可知A、B、C、D四点肯定位于同一平面内.由于平行连杆G的作用使得E点有可能不在ABCD所在平面中。假设某时刻整个机械臂在平面xoy中的投影如图3:由图3可知1)由于DE长度相对其他部分来说比较短所以在机械臂到达目标位置时的“大致方向”与BD方向基本重合而BD方向是由平行连杆F确定的所以在进行粗调时首先将F旋转到目标方向。由OxOy可以确定。2)可以看出目标点到z轴的距离大致与D点到z轴的距离相当而D点到z轴的距离是由旋转轴C确定所以在进行粗调时可以先将旋转轴C的角度大致调正。图3、机械臂在平面xoy中的投影2.22.2运动规划运动规划由前面确定的目标位姿以及当前位姿求解由当前位姿向目标位姿过渡的方式时我们采用贪心算法.即每个旋转轴总是向着离目标角度以尽可能大的步长前进直至最终所有的旋转轴到达其目标角度.那么各个旋转轴的变化过程的增减幅度就是最终的指令序列。2.32.3问题求解问题求解机械臂初始状态为(0-9000-90)目标点为(20-200120)(见图4)根据目标位姿预测可得机械臂的最终状态为(-174.2-38.2-116.9-0.4-124.6)指尖距离目图5机械臂与目标点位置关系标点0.055mm.指令序列示意:-2.02.0-2.0-0.4-2.0-2.02.0-2.00.0-2.0-2.02.0-2.00.0-2.0-2.02.0-2.00.0-2.0-2.02.0-2.00.0-2.0.图4、机械臂与目标点位置关系433、受限目标到达及避障分析受限目标到达及避障分析3.13.1避障方法避障方法对于有障碍物的情况我们可以看作是在到达问题中含有约束的情形.考虑到障碍物形状大小情况繁多不可能一一列举只能具体问题具体分析.大致可分为三步:1)计算障碍物的空间形状求出几何方程对于形状不规则的可以进行合理的拟合；2)根据障碍物的空间几何方程计算什么位姿下机械臂与障碍物不接触以其作为约束；3)利用解决目标到达问题的目标位姿预测进行。搜索模拟机械臂的实际运动.注意在搜索过程中要加入机械臂与障碍物不能相碰的约束即受限的目标到达。机械臂在运动过程中必须满足两个条件才会执行该条指令:机械臂的此次运动离目标点的距离减小，机械臂没有与障碍物发生接触。3.23.2问题求解问题求解机械臂要深入到圆台内部完成相应焊接工作，如图5所示。若要整个机械臂都不碰壁那么:1)对于E点它要在工件内壁点焊四个小零件故它必须在圆台内对于E而言应有:图5、机械臂在圆台内作业2)对于D点存在两种情况:D在圆台内.此时线段CD与圆台上底面有交点其坐标(x1y1)为要使得CD连杆不会碰壁该交点必须在圆台上表面开口的圆内:st(x1-210)2+y12=180.线段DE与圆台上底面交点坐标(x2y2)为:要使得DE和圆台不相碰同理也必须满足:st(x2-210)2+y2287.38372故D在圆台外而且DE不会和圆台发生碰撞的条件是:综上所述机械臂不碰壁的条件是:或机械臂在圆台内移动时每改变一个旋转轴的角度都有可能会导致机械臂的某个部位碰壁所以每次移动都要判断是否碰壁然后决定是否移动.所以与前面的移动不同我们并不做位姿预测而选择直接进行向目标点移动.具体采用的是贪心算法每一条指令只改变其中一个旋转轴的角度该角度的改变满足:1)不会产生碰壁2)以尽可能大的幅度向目标点逼近。圆台内壁的四个点坐标为:1、(320-10420.7802)2、(12010651.5961)63、(190-12582.7563)4、(25588152.135)。按照1324顺时针顺序依次焊接各个点求得最终的指令序列。44、沿线路运动分析沿线路运动分析要求指尖沿着预先指定的一条空间曲线x=x(s)y=y(s)z=z(s)asb移动计算满足要求的指令序列。4.14.1沿路线运动沿路线运动对于空间曲线由于机械臂的移动本身是离散的所以不可能让机械臂指尖严格按照曲线的轨迹连续运动。可以将空间曲线划分为离散的点只要机械臂依次到达这些点就可以了。将s的取值区间ab划分为N段每一段是ds，机械臂依次到达(x(s0)y(s0)z(s0)(x(s0+ds)y(s0+ds)z(s0+ds)(x(s0+2ds)y(s0+2ds)z(s0+2ds)即可。其中ds的选取原则为:选取步长应以使得既能很好地逼近曲线同时在ds变化的程度足够引起指尖的移动。4.24.2问题求解问题求解如图6平面与圆台外壁的交线是一个封闭的弧线.起始位姿与的起始位姿相同.我们选取圆台上表面中心作为过渡目标点调整机械臂的位姿至(-90-2313-113180-12613)指尖到达上表面中心然后再移动至焊接起始点(52.5026.25)这时机械臂的位姿为(-90-74.6-1380-88.2).移动过程如图7所示。图6、平面与圆台外壁相交7图7、含大位姿预测过程注意上面提到的“移动”都只是设想中的移动是为了得到一个合理的大位姿使得机械臂伸展开方便在弧线上移动.当得到机械臂弧线上一点的位姿时那么我们就直接由初始状态向着这个位姿转变指尖会直接向弧线移动而不会先到圆台上方的正中心再移向弧线.在分解曲线至小段时为了使得划分小段的长度尽量均匀我们将曲线方程转换为参数方程:然后经测试取d为0.2度时比较合理即ds=900此时指尖的每次移动刚好可以用一条指令来完成如果再小的话指尖对位置的变化就不敏感了。机械臂的运动分为两部分:a)从起始点位姿(0-9000-90)到焊接点位姿(-90-74.6-1380-88.2。b)从焊接点位姿(-90-74.6-1380-88.2)开始焊接整个弧线的过程。55、误差分析、误差分析5.15.1算法误差算法误差由于i的取值是离散的精度为0.1那么指尖所能到达的范围也是离散的.对目标点而言指尖只能尽可能地靠近这之间肯定会存在误差这个误差是i取值的离散性引起在算法的执行过程中造成的，故将其称为算法误差。针对文中的三个问题误差统计结果见表1，从表可以看出误差范围在1毫米以内。表1、算法误差5.25.2精度误差精度误差i的精度为0.1根据精度的定义i的误差是小于0.05。考虑在一个确定的位姿下只改变其中一个旋转轴的角度让它增大或者减小一个不小于0.05的角度观察最终目标的变化情况。8由于在不同位姿下i的变化引起的指尖位置的变化幅度是不同的以例题中涉及的几个位姿为例如表2。由表1和表2可以看出算法的误差与机械臂的精度误差基本处于同一数量级。表2、分别改变i的大小增减0.05引起指尖的偏移情况66、结语、结语针对六自由度机械臂的到达问题、沿曲线运动问题和避障问题本文分别提出目标位姿预测、曲线离散到达和受限目标到达三种解决方法其中目标位姿预测是后面两种方法