机器人论文申双全08机电

湛江师范学院 物理学院 08机电 申双全 2008994163齐次变换矩阵对机器人的功用论述目的：1、齐次变换矩阵的定义； 2、齐次变换矩阵的四大功能：变换、描述、表示运动和作为算子； 3、举例说明齐次变换矩阵在机器人学科中的应用。摘 要：机器人运动学是机器人学的一个重要分支，是实现机器人运动控制的基础。文中主要针对PuMA560机器人运动学正问题分析，以DH坐标系理论为基础并建模，利用MATLAB/ROBOTICS工具，实现了简单的运动学动态仿真，有助于对机器人关节运动角度的深入理解，并为工程人员提供一种有效的分析手段。关键词：机器人 运动学 仿真 MATLAB/ROBOTICS机器人运动学分析 a、机器人运动学概述 工业机器人运动学涉及到机器人手臂(机械手)相对于固定参考坐标系原点几何关系的分析研究，特别机器人手臂末端执行器位置和姿态与关节空间变量之间的关系。这里讨论机器人运动学的两个具有理论和实际意义的基本问题： 1) 对一给定的工业机器人运动模型，己知杆件几何参数和关节角矢量1，2，其中n自由度数，求机械手末端执行器相对于参考坐标系的位置和姿态。 2) 已知机器人关键的几何参数，给定机械手末端执行器相对于参考坐标系的期望位姿，机械手能否使其末端执行器达到这个预期的位姿。如能达到，机械手有几种不同的状态可满足同样的条件。 第一个问题常称为运动学正问题(直接问题)，第一个问题常称为运动学逆问题(解臂形问题)。由于机器人手臂的独立变量是关节变量，而作业通常是在参考坐标系中说明的，因此要较频繁地用到运动学逆问题。表示两种问题关系地简单方框图如图1所示。机械手可用一个开环关节链来建模，此链由数个刚体(杆件)串连而成。开链的一端固接在基座上，另一端是自由的，安装着工具(末端执行器)，用以操纵物体，或完成装配作业。关键的相对运动导致杆件的运动，是手定位于所需的方位上。在很多机器人应用问题中，人们感兴趣的是机械手末端执行器相对于固定参考坐标系的空间描述。 由于机器人各杆件可相对于参考坐标系转动和平移，末端执行器的空间总位移是由杆件的角转动和直线平移形成的。于是，Denavit和Hartenberg提出了一直通用的办法，以矩阵代数来描述和表达机械手各杆件相对于固定参考系的空间几何学关系，称为DH方法，连杆坐标系称为DH坐标系。此方法用44齐次变换矩阵描述相邻两刚性杆件的空间关系，把运动学正问题简化位寻求把“手部坐标系”与“参考坐标系”联系起来的44等价齐次变换矩阵。这种齐次变换矩阵在推导机器人原点的动力学方程过程中也是很有用的。各关节变量，不断地用逆矩阵左乘，可用来确定各关节的位置 图1 机器人运动学正问题和逆问题b、 机器人运动学正解 为了描述相邻杆件平移和转动的关系，提出一种位关节链中的每一杆件建立附加坐标系的矩阵方法。D-H方法是为每个关节处的杆件坐标系建立44齐次变换矩阵，表示它与前一个杆件坐标系的关系。这样，通过逐次变换，用“手部坐标”表示的末端执行器可被变换成用“基座坐标”表示，我们知道，这个运动学系统的惯性坐标系是建立在基座上的。 设六关节机器人PUMA560各轴的原点依次称为O1，O2，O6，各参数定义参看机器人连杆坐标系，如图2所示。 正向关节求解问题，即给出六个关节变量i (i =1，2，6)，求出手部位姿矢量n，o，a和p。用齐次变换矩阵A1描述第一杆相对于规定坐标系的位姿，a2描述第二杆相对于规定坐标系的位姿，因此，第二杆系相对于固定坐标系的位姿02t=A1A2。其中，a i代表D-H矩阵4 5： 式中，d i为沿杆i的轴线两个公垂线的距离；i为垂直于杆件i的轴线的平面内两个公垂线的夹角； i为两个关节轴线沿公垂线的距离； i为在垂直于的平面内的两个关节轴线的夹角。则机器人手部位姿方程为： 图2 机器人连杆坐标系 c、 机器人运动学反解 对于具有6个自由度机器人的操作臂而言，根据机器人各关节变量qi (i =1，2，6)的值，计算出机器人末端抓手的位姿方程，称为机器人的运动学正问题，或运动学正解。反之，为了使机器人所握工具相对参考系的位姿满足给定的要求，计算相应的关节变量，这一过程称为运动学反解。从工程应用角度而言，机器人的运动学反问题往往更实际意义，它是机器人运动规划和轨迹控制的基础。正向运动学的解是唯一的，即各个关节变量给定之后，操作臂末端抓手或工具的位姿是唯一确定的。然而运动学反问题往往具有多重解，也可能不存在解。此外，对于运动学反解问题而言，仅仅用某种方法求解是不够的，还需要通过计算机仿真验证。在实际应用中，发现传统反变换法在一些情况下会产生漏解，不能满足工程的实际需要。 求解运动方程时，我们从T6开始求解关节位置。现使T6的符号表达式的各元素等于T6的一般形式，并据此确定1，其他五个关节参数不可能从T6求得，因为所求得的运动方程过于复杂而无法求解它们。我们可以由其他矩阵来求解它们。一旦求得1之后，可由A1-1左乘T6的一般形式，得： A1-1 T6=1T 上式中，左边为1和 各元的函数，可用来求解其他各关节变量，如2，3等。不断地用逆矩阵左乘，可得到四个矩阵方程式，求解运动方程，即求得机械手各关节坐标，这对机械手的控制至关重要。根据我们知道机器人的机械手要运动到什么位置，而且我们需要获得各关节的坐标值，以便进行这一移动。基于MATLAB的多关节机器人运动学动态仿真 基于MATLAB的多关节机器人运动学动态仿真 A、 机器人运动学仿真 文献3上的PuMA560机器人参数如下表：机器人连杆 仿真前先输入PUMA560机器人的参数，并命名为“robot”，代码如下6： 连杆的前四个元素为，a，d，最后为0 (转动关节)或者1(移动关节) L1=1ink(一pi/2 0 pi/2 0 0 ) L2=link(0 0.4318 0 0.14909 0 ) L3=link(pi/2 0 pi/2 0 0 ) L4=link(-pi/2 0 0 0.43307 0 ) L5=1ink(pi/2 0 0 0 0 ) L6=1ink(0 0 0 0.05625 0) r=robot(Ll L2 L3 L4 L5 L6) 再利用命令drivebot (robot)，可以看到机器人的三维图形，按照预定轨迹进行仿真，假设从A点移动到B点，设qa=000000 机械手在B点相对于基坐标系的位姿用Tb表示，不妨设 Tb= -0.6533 0.2706 -0.7071 -0.6318： 0.457l -0.6036 -0.6533 0.0000： -0.6036 -0.7500 0.2706 0.1500： 0 0 0 1.0000 这样就可以用MATLAB/ROBOTICS工具箱中的ikine命令来求解。 qab=ikine (r，Tb) 1.5708 0.1500 0.2000 0.3927 0.7854 0.3927 取仿真时间为2s，采样时间为0.056s，可以画出各个关节的位置，速度和加速度的曲线，因篇幅所限这里只画出了第二关节的曲线如下B、 仿真结果分析 从机器人运动学仿真的结果看，各个关节的运动均为正常，各连杆没有运动错位的情况，从而验证了机器人连杆参数的合理性，再从图3可以看出第二关节在仿真时间内位置，速度和加速度曲线均为光滑曲线，有利于机器人运动的平稳性要求，其他关节的仿真也可以类似给出，这里省略。 图3 第二关节的运动轨迹曲线同时给出了机器人运动到B点的三维示意图总结 本文对PIJMA560多关节机器人的运动学正解和逆解问题进行了分析和讨论，并在MATLAB/ROBOTICS环境下编制了简单的程序语句进行了相应的运动学仿真，验证了机人参数的合理性，取得了良好的效果。图4 机器人运动到点的三维图参考文献 1 阎保定，郭跟成机器人三维图形仿真系统的设计J洛阳工学院学报，1997(12)：53-55 2 尹泽明，丁春利等精通LATLAB6M北京：清华大学出版社，2002，1-2 3 张铁，谢存禧机器人学M广州：华南理工大学出版社，2004，74-92 4 蒋新松机器人学导论M沈阳：辽宁科学技术出版社，1994，87-93 5 马香峰机器人结构学M北京：机械工业出版社，1991 20-21