0 Comments

六自由度机械手的坐标建立及运动学分析

发布于:2019-10-17  |   作者:admin  |   已聚集:人围观

  第**卷第**期 20**年*月 机械工程学报 JOURNAL OF MECHANICAL ENGINEERING Vo l . ** N o . * *** 20** DOI:10.3901/JME.20**.**.*** 六自由度机械手的坐标建立及运动学分析 摘要:从运动学分析的基础上着手研究轨迹控制的问题,利用运动学逆解的方式分析复杂轨迹运动的可行 性和实用性。通过建立机械手的笛卡尔坐标系,推导出机械手的正、逆运动学矩阵方程,并研究了正、逆 运动学方程的解;在此基础上建立机械手的工作空间,并讨论其工作空间的灵活性和存在可能性。 因此本文的另一种方式对六自由度串联机械手的复杂运动控制问题进行研究,提出以机械手示教手柄引导 末端执行器对复杂运动轨迹进行预设计。然后通过记录程序进行复杂轨迹的再实现,再对记录程序进行预 修改,最终通过现有的程序进行设计编程完成复杂轨迹设计任务。并利用 MATLAB 对轨迹进行仿真,对比其 实际与计算的正确性。 最后本设计通过六自由度串联机械手实现平面文字轨迹,得出其设计的方式。即首先利用示教手柄实现轨 迹预设,记录预设轨迹程序,然后再对比程序初始化坐标进行手动编程。 关键词:六自由度机械手,笛卡尔坐标系,运动学方程,仿真,示教手柄 The coordinates of six degrees of freedom manipulator and kinematics analysis is established WU Yanchao JIN Yuanxun ZHAO Xin LI Daohai SONG Ping MENG Ya ABSTRACT:This article based on the analysis of kinematics to study the trajectory control problems, use of inverse kinematics of the complex mode of tracking movement of the feasibility and practicality. Through the establishment of the manipulator Cartesian coordinates, derived manipulator is the inverse kinematics matrix equation and the study is the inverse kinematics of the equation solution on the basis of this establishment manipulator working space. And discuss their work space The flexibility and the possibility exists. So in another way to the six degrees of freedom series manipulator motion control the complex issues of research, to handle the machinery Shoushi guide for the implementation of the end of the complex pre-designed trajectory. Then track record of the complicated procedure to achieve, and then record the pre-amended procedures.The eventual adoption of the existing procedures designed trajectory design of complex programming tasks. And using MATLAB simulation of the track, compared with its actual calculation is correct. The final design through six degrees of freedom series manipulator track to achieve flat text, draw their design approach. That is, first of all use of teaching handle achieve trajectory default the track record of default procedures, and then compared to manual procedures initialized coordinate programming. key words:Six degree-of-freedom manipulators,Cartesian coordinates, Equations of motion, Simulation, Demonstration handle 机械工程学报 第 49 卷第 6 期期 前言 基于六自由度串联机械手的复杂运动控制 的研究,期望通过一种使用的轨迹设计方 法,即利用六自由度串联机械手实现平面复 杂运动轨迹的设计,使其能在不同的工业生 产下完成预定的轨迹实现的准确性和实用 性,则该机械手将在实在加工工业中发挥更 重要的作用,并可完成许多人工条件无法完 成的任务,从而提高机械手的利用性。 另外,基于六自由度机械手轨迹设计中位置 逆解算法的研究,期望通过 MATLAB 仿真实 现六自由度机械手位置逆解的准确性,尤其 是在其逆解不唯一的情况下,配合 MATLAB 仿真数据进行对比,实现轨迹控制的最优 化,即满足轨迹设计要求和运动控制的 1 机械手轨迹设计中坐标系的建立 机器人通常是由一系列连杆和相应的运动 副组合而成的空间开式链,实现复杂的运 动,完成规定的操作。因此,机器人运动学 描述的第一步,自然是描述这些连杆之间以 及它们和操作对象(工件或工具)之间的相对 运动关系。假定这些连杆和运动副都是刚性 的,描述刚体的位置和姿态(简称位姿)的方 法是这样的:首先规定一个直角坐标系,相 对于该坐标系,点的位置可以用 3 维列向量 表示;刚体的方位可用 3×3 的旋转矩阵来 表示,而 4×4 的齐次变换矩阵则可将刚体 位置和姿态(位姿)的描述统一起来。 机器人的每个关节坐标系的建立可参照以 下的三原则: z n?1 轴沿着第 n 个关节的运动轴; xn 轴垂直于 z n?1 轴并指向离开 z n?1 轴的方 向; yn 轴的方向按右手定则确定。 机器人坐标系建立的方法常用的是 D-H 方 法,这种方法严格定义了每个关节的坐标 系,并对连杆和关节定义了 4 个参数,如图 下所示: 转动关节连杆四参数示意图 2 平面轨迹设计的正运动学分析 2.1 平面轨迹设计的正运动学分析原理 机器人运动学只涉及到物体的运动规律,不 考虑产生运动的力和力矩。机器人正运动学 所研究的内容是:给定机器人各关节的角度 或位移,求解计算机器人末端执行器相对于 参考坐标系的位置和姿态问题。 各连杆变换矩阵相乘,可得到机器人末端执 行器的位姿方程(正运动学方程)为 : 0T6 ? 0A1 1 A2 2 A3 3 A4 4 A5 5 A6 = ?nx ox ax px ? ??n y oy ay p y ? ? ???n0z oz 0 az 0 pz 1 ? ? ? (式 3-3) 其中: z 向矢量处于手爪入物体的方向上, ? 称之为接近矢量 a ,y 向矢量的方向从一个 指尖指向另一个指尖,处于规定手爪方向 ? 上,称为方向矢量 o ;最后一个矢量叫法线 ? ? ? 矢量 n ,它与矢量 o 和矢量 a 一起构成一个 右手矢量集合,并由矢量的叉乘所规定: ? ?? n ?o?a。 式 3-3 表示了 RBT 系列机器人变换矩阵 0T4 ,它描述了末端连杆坐标系{4}相对基坐 标系{0}的位姿,是机械手运动分析和综合 的基础。 2.2 正运动学分析步骤及计算 1、根据机器人坐标系的建立中得出的 A 矩 李道海等:六自由度机械手的坐标建立及运动学分析 阵,相乘后得到 T 矩阵,根据一一对应的关 系,写出机器人正解的运算公式,上一节中 已经对六自由度串联机械手的各个参数进 行了计算,因此这里公式不再一一列出。 2、根据所要设计的文字轨迹,求出各个分 量的值,其中以“西”的起笔为第一个输入 和输出参数进行求解 3、运行六自由度串联机器人控制系统软件, 点击“空间学计算”按钮,出现如图 3-14 所示界面,在“关节角度”中相应的位置输 入各个关节的变量值,点击“正解计算”按 钮,各个参数的值显示在“末端位姿”相应 的框内。 4、将计算的值和控制系统软件计算出的值 相比较,比较结果是否一致。 3.六自由度机械手轨迹设计中的 逆运动学分析 3.1 机械手逆运动学分析原理 机器人的运动学反解存在的区域称为机器 人的工作空间,求解机器人逆解的目的也在 于要求出机器人的工作空间。 工作空间是操作臂的末端能够到达的空间 范围,即末端能够到达的目标点集合。值得 指出的是,工作空间应该严格地区分为两 类: 灵活(工作)空间 指机器人手爪能够以任 意方位到达的目标点集合。因此,在灵活空 间的每个点上,手爪的指向可任意规定。 可达(工作)空间 指机器人手爪至少在一 个方位上能够到达的目标点集合。 机器人操作臂运动学反解的数目决定于关 节数目和连杆参数(对于旋转关节操作臂指 的是 ai , ai和di )和关节变量的活动范围。 在解运动学方程时,碰到的另一问题是解不 唯一(称为多重解)。在工作空间中任何点, 机械手能以任意方位到达,并且有两种可能 的形位,即运动学方程可能有两组解。 求解 RBT 系列机器人的过程如下:求解的 变量为?1,? 2 ,? 3 ,? 4 ,? 5 ,? 6 。 ?nx ox ax px ? ??ny o y ay p y ? ? T= ? ? ? nz 0 oz 0 az 0 pz 1 ? ? ? (各项公式见正解) 整理矩阵各项可得: px ? d6 ? ax ? c1 ? (d 4 s23 ? a3c23 ? a2c2 ) --------------(式 3-4) p y ? d 6 ? ay ? s1 ? (d 4 s23 ? a3c23 ? a2c2 ) --------------(式 3-5) pz ? d6 ? az ? d 4c23 ? a3s23 ? a2 s2 ? d1 -- --------------(式 3-6) 根据上述已知条件求出相应的变量 ?1,? 2 ,?3 ,? 4 ,?5 ,?6 注 : 其 中 S23 ? S2C3 ? S3C2 , C23 ? C2C3 ? S2 S3 3. 2 逆运动学分析步骤及计算 1、计算机器人运动学方程,根据一一对应 的关系,求解机器人逆解的运算公式,如果 有的变量有两个值应该全部保留: 2.根据以上计算出的机器人运动学方程,一 一对应的关系,将解出的机器人逆解的运算 公式填入表 将正运动学分析中的数据带入表 3-2 中,求 出各个分量的值,如果有两组分别填入; 表 3-2 六自由度串联机器人的逆运动学的 输入和输出参数 输 入 px 75 值 nx 0 py 0 ny ?1 pz 197 nz 0 机械工程学报 第 49 卷第 6 期期 ox 0 oy 0 oz 1 ax 1 ay 0 az 0 输 出 ?1 90 ? 2 ?90 ?3 0 值 ?4 0 ?5 0 ?6 0 3、运行六自由度串联机器人控制系统 软件,点击“空间学计算”按钮,出现如图 3-9 所示界面,在“末端位姿”中相应的位 置输入各个关节的变量值,点击“逆解计算” 按钮,逆解的值显示在“关节角度”中相应 的框内。 4 设计实现过程 根据上一章轨迹设计的过程,以机械手原始 位置(复位后的位置)作为平面轨迹实现的 起始点。然后利用末端牵引手柄进行牵引轨 迹,并记录轨迹设计过程中的中间点,完成 最终的轨迹路线。 完成上诉的过程后,进行程序处理,调出程 序进行中间点和环节的修改,保留程序检验 其中的参数,并进行逐条验证。 通过以上环节完成程序再编程后,进行 轨迹再现,即完成所需的设计工作。 5 总结 通过运动学逆解得到当被抓物体处于基坐 标系的某一点时,各关节所需要转过的角 度,运动学逆解可能存在多组解,并不是所 有的解都能满足机械手的结构限制,同时满 足机械手的结构限制的解也存在是否最优 的问题。常用的最优原则有距离最短原则和 时间最短原则。 1)距离最短原则:指到达目标的各关节变量 变化的绝对值之和最小。 2)时间最短原则:是指由机械手到达目标的 时间最少。 选择何种最优原则要视控制策略和实际需 要而定。 参考文献 [1]熊有伦,丁汉,刘恩沧.机器人学.机械工 业出版社,1993,10:70 一 71 [2]廖启征.空间机构(无球面副)位移分析的 酉交矩阵法.北京:北京航空航天大学研究生 院工学博士学位论文.1987 [3]C.H.苏,CW.拉德克利夫著。运动学与机 构设计。机械工业出版社。1983 [4]李庆扬,莫孜中,祁力群。非线性方程组 的数值解法。科学出版社,1987 [5]王德人,张连生,邓乃扬.非线性方程的 区间算法.上海:上海科学技术出版 社,1987,4 [6]邓健新.准确计算方法.北京:科学出版社, 1996,3 [7]陈公宁,沈嘉骥.计算方法.北京:高等教育 出版社,2002,7 [8]陈宏盛,刘雨.计算方法.国防科技大学出 版社,2001,7 [9]李刚俊,陈永.机器人的三维运动仿真[J]. 西南交通大学学报,2002, 37(3): 273-276. [10] John Craig. Robot and Automation Simulation: Past, Presentand Fu- ture[J]. RoboticsWorld, 1999, 17(6): 40. [11]何发昌,邵远.多功能机器人的原理及应 用.北京:高等教育出版社,1996

标签:
    神兽验证马:
点击我更换验证码