机器人论文申双全机电.docVIP

湛江师范学院 物理学院 08机电 申双全 2008994163 齐次变换矩阵对机器人的功用 论述目的：1、齐次变换矩阵的定义； 2、齐次变换矩阵的四大功能：变换、描述、表示运动和作为算子； 3、举例说明齐次变换矩阵在机器人学科中的应用。 摘? 要：机器人运动学是机器人学的一个重要分支，是实现机器人运动控制的基础。文中主要针对PuMA560机器人运动学正问题分析，以D—H坐标系理论为基础并建模，利用MATLAB/ROBOTICS工具，实现了简单的运动学动态仿真，有助于对机器人关节运动角度的深入理解，并为工程人员提供一种有效的分析手段。 关键词：机器人 运动学 仿真 MATLAB/ROBOTICS 机器人运动学分析 ?? a、机器人运动学概述 ? ?? 工业机器人运动学涉及到机器人手臂(机械手)相对于固定参考坐标系原点几何关系的分析研究，特别机器人手臂末端执行器位置和姿态与关节空间变量之间的关系。这里讨论机器人运动学的两个具有理论和实际意义的基本问题： ??? 1) 对一给定的工业机器人运动模型，己知杆件几何参数和关节角矢量θ1，θ2，．．．，θ，其中n自由度数，求机械手末端执行器相对于参考坐标系的位置和姿态。 ??? 2) 已知机器人关键的几何参数，给定机械手末端执行器相对于参考坐标系的期望位姿，机械手能否使其末端执行器达到这个预期的位姿。如能达到，机械手有几种不同的状态可满足同样的条件。 ? 第一个问题常称为运动学正问题(直接问题)，第一个问题常称为运动学逆问题(解臂形问题)。由于机器人手臂的独立变量是关节变量，而作业通常是在参考坐标系中说明的，因此要较频繁地用到运动学逆问题。表示两种问题关系地简单方框图如图1所示。机械手可用一个开环关节链来建模，此链由数个刚体(杆件)串连而成。开链的一端固接在基座上，另一端是自由的，安装着工具(末端执行器)，用以操纵物体，或完成装配作业。关键的相对运动导致杆件的运动，是手定位于所需的方位上。在很多机器人应用问题中，人们感兴趣的是机械手末端执行器相对于固定参考坐标系的空间描述。 ??? 由于机器人各杆件可相对于参考坐标系转动和平移，末端执行器的空间总位移是由杆件的角转动和直线平移形成的。于是，Denavit和Hartenberg提出了一直通用的办法，以矩阵代数来描述和表达机械手各杆件相对于固定参考系的空间几何学关系，称为D—H方法，连杆坐标系称为D—H坐标系。此方法用4×4齐次变换矩阵描述相邻两刚性杆件的空间关系，把运动学正问题简化位寻求把“手部坐标系”与“参考坐标系”联系起来的4×4等价齐次变换矩阵。这种齐次变换矩阵在推导机器人原点的动力学方程过程中也是很有用的。 各关节变量，不断地用逆矩阵左乘，可用来确定各关节的位置 ???? 图1? 机器人运动学正问题和逆问题 ???b、 ?机器人运动学正解 ??? 为了描述相邻杆件平移和转动的关系，提出一种位关节链中的每一杆件建立附加坐标系的矩阵方法。D-H方法是为每个关节处的杆件坐标系建立4×4齐次变换矩阵，表示它与前一个杆件坐标系的关系。这样，通过逐次变换，用“手部坐标”表示的末端执行器可被变换成用“基座坐标”表示，我们知道，这个运动学系统的惯性坐标系是建立在基座上的。 ??? 设六关节机器人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)的值，计算出机器人末端抓手的位姿方程，称为机器人的运动学正问题，或运动学正解。反之，为了使机器人所握工具相对参考系的位姿满足给定的要求，计算相应的关节变量，这一过程称为运动学反解。从工程应用角度而言，机器人的运动学反问题往往更实际意义，它是机器人运动规划和轨迹控制的基础。正向运动学的解是唯一的，即各个关节变量给定之后，操作臂末端抓手或工具的位姿是唯一确定的。然而运动学反问题往往具有多重解，也可能不存在解。此外，对于运