资源目录
压缩包内文档预览：(预览前20页/共65页)
编号：10278899
类型：共享资源
大小：6.28MB
格式：RAR
上传时间：2018-07-10
上传人：hon****an
认证信息
个人认证
丁**（实名认证）
江苏
IP属地：江苏
2.4
积分
- 关 键 词：
-
机器人
原理
控制
节制
技术
ppt
- 资源描述：
-
机器人原理及控制技术 9.3M PPT版,机器人,原理,控制,节制,技术,ppt
- 内容简介：
-
8.1 引言 8.2 目标物体的描述 8.3 任务的描述 8.4 视觉8.5 程序 8.6 传送带跟踪8.7 位置之间的运动 8.8 关节运动8.9 笛卡尔运动 8.10 本章小结,第八章 运动轨迹Chapter Motion Trajectories,本章是机器人运动控制的基础 ，它分为四个主要部分: 第一部分：利用齐次坐标变换构造任务 第二部分：基于时间坐标轨迹的运动控制描述 第三部分：关节坐标运动的描述 第四部分：笛卡儿运动控制描述,8.1 引言（Introduction）,任何刚性物体都能够用一个与该物体固定相联的坐标系来描述，给出该物体的图形表示及其坐标系统。只要说明该坐标系统的位置和方向，就足以在任何位置和方位上复现这个物体。 如图8.1中的销钉，它的轴位于z轴上，半径为0.5，长度为6。,8.2 目标物体的描述（Object Description）,利用齐次变换来描述一个任务。任务内容是抓取如图8.1所示的一些销钉，然后把它们插入一个装配部件的孔中( 见图8.2)。,图8.2 任务的描述,8.3 任务的描述（Task Description）,z,规定机械手末端执行器（手爪）的一系列位置Pn(见图8.3)，就能把这一任务描述为相应于这些编号位置的机械手运动和动作的序列。,图8.3 末端执行器的位置,MOVE P1 接近销钉MOVE P2 移动到销钉的位置GRASP 抓住销钉 MOVE P3 垂直提起销钉 MOVE P4 按一定角度接近孔眼MOVE P5 接触到孔眼时停止MOVE P6 调整销钉的位置MOVE P7 插入销钉RELEASE 松开销钉MOVE P8 离开,下面通过规定机械手的结构来确定任务结构。我们用三个变换的乘积描述机械手，从而任务描述中的位置就由下式取代 MOVE pn = MOVE Z T6 E (8.1) 其中 Z ： 表示机械手相对于任务坐标系的位置； T6： 表示机械手末端相对于机械手坐标的位置； E ： 表示末端执行器（手爪）相对于机械手末端坐标的位置。,按照上述描述，机械手的位置由Z来确定，任务的执行就是改变抓手的位置。现在利用下列符号来描述任务的变化: P 销钉在基坐标中的位置； H 带有两孔眼的金属块在基坐标中的位置； H HRi 金属块上第i个孔相对H坐标系的位置； P PG 抓取销钉的抓手相对于销钉的位置； P PA 抓手接近销钉； P PD 抓手提起销钉； HR PHA 销钉接近第i个孔眼； HR PCH 销钉接触孔眼； HR PAL 销钉开始插入； HR PN 插入后的销钉。,现在，任务可由一系列变换式来描述，由此解出机械手的控制输入T6 ，这些变换式如下: P1: Z T6 E = P PA 接近销钉 P2: Z T6 E = P PG 到达抓取销钉的位置 GRASP 抓取销钉 P3: Z T6 E = P PD PG 提起销钉 P4: Z T6 E = H HRi PHA PG 接近第i个孔眼 P5: Z T6 E = H HRi PCH PG 接触第i个孔眼 P6: Z T6 E = H HRi PAL PG 插入销钉 P7: Z T6 E = H HRi PN PG 插入完成 RELEASE 松开手爪 P8: ZT6E = H HRi PN PA 回到起始位置,任务位置变换图如图 8.4所示。 尽管这样表示可能显得复杂, 但是说明了任务的基本结构。而且每一个变换表示了一个独立的情况。,相应的P , H和Z坐标系如图8.5所示。 由图8.5可知，Z为机械手坐标系，它定位在肩关节上, 因此工作坐标系（基坐标系）位于机械手坐标的位置为 T6 pz = -50 由于机械手不能到达它自己的基座，所以我们把它放在基坐标系原点的后面，这样T6 px= 30 。使T6py = 0 ,并且保持两个坐标系的平行。,图8.5 任务坐标系P, H 和 Z,由图8.5可知:,(8.2),下面通过相对于机械手末端的变换来定义末端执行器, 我们沿着这样的表示习惯: 末端执行器的z轴指向执行任务的方向，而y轴表示手爪的开合方向，于是如图8.6所示的抓手就可描述为,图8.6 手爪变换,(8.3),我们已经在图8.1中描述了销钉，现在再看一下带有两个孔眼的金属块H。 H的正视图如图8.7所示，借助于变换矩阵HRi（i1、2，是孔眼的序号）来描述它的特征。,HR1 =,HR2 =,(8.4),(8.5),注意：式（8.4）和式（8.5）是分别沿H坐标的x轴旋转90再平移后得到。,最重要的变换是销钉插入一个孔眼(见图8.8)。销钉的z轴必须与孔眼的轴一致。由于销钉具有圆柱的对称性，x、y轴的方向就可任意了。 最后一个变换必须按照手爪在销钉上的部位来确定（见图8.9）。,(8.6),(8.7),现在我们通过示教方式利用机械手来确定前面的变换关系。将末端执行器放在销钉上面，处于它的抓取位置（图8.3中的P2），可得到下列变换式。,Z T6E = P PG （P2） (8.8) 上式可确定P P = Z T6 E PG-1 (8.9) 手爪返回到靠近销钉的位置P1，于是有 Z T6 E = P PA （P1） (8.10) 从而确定了PA PA = P-1 ZT6 E (8.11)关于P的起始点可这样确定：把手爪中的销钉提起，移到起始位置P3，于是有 Z T6 E = P PD PG （P3） (8.12)由上式确定了PD PD = P-1 Z T6 E PG-1 (8.13),金属块H的位置由下式确定Z T6 E = H HR1 PN PG （P7） （8.14）解出HH = Z T6 E（HR1 PN PG）-1 （8.15）销钉开始插入，PAL（见图5.10）由下式确定 Z T6 E = H HR1 PAL PG （P6） (8.16）从而 PAL =（H HR1）-1Z T6 E PG-1 （8.17）接触孔眼的销钉位置PCH以及接近触点的点PHA可确定为PCH =（HHR1）-1 Z T6 E PG-1 （P5） (8.18）PHA =（HHR1）-1 Z T6 E PG-1 （P4） （8.19）这样就定义所有的变换。,问题：式（8.17）（8.19）三个表达式完全相同，为什么能描述三个不同的工位点？,在求取任务执行过程中的销钉位置时，我们是把机械手放在销钉的上方，处于正确的抓取位置，然后求解变换式P。在实际系统中，我们还可以通过视觉获得销钉等物体的位置。假如有一个位置固定的摄像机，它能把销钉的方位表示为相对于它自身的坐标系的一个齐次变换, 比如说PC，那么销钉相对于基坐标的位置就可表示为 P = CAM PC (8.20) 其中CAM是一个变换，表示摄像机坐标系在基坐标中的位置。 在通过机械手确定P之后，CAM的值能通过摄取一幅图象来得到PC，从而解得 CAM = P PC-1 (8.21) 摄像机的输入通过READ读取得到， READ (CAMERA, PC) P: = CAM + PC 而P是要被确定的，我们用标识符来表示程序中的变换， “ + ”号表示矩阵相乘，“”号表示与逆阵相乘。,8.4 视觉（Vision）,现在可以利用求解T6的变换式(见图8.4)来确定任务程序中从P1到P8的每个位置。 为了把机械手移到P1, 要求 Z T6 E = P PA (8.22) 这就意味着 T6 = Z-1 P PA E-1 (8.23) 要到达P2则需 Z T6 E = P PG (8.24) 如此等等。,8.5 程序（Program）,在我们用变换表达式代替程序中P1P8的各个位置时，先定义两个变量COORD和TOOL, 它分别表示工作坐标系的一般表达式和抓手坐标系的一般表达式。然后, 把所有的位置表达式写成如下形式 T6 TOOL = COORD POS (8.25) 对于第一步运动, COORD和TOOL定义为 COORD: = -Z + P ; TOOL: = E ; 因而第一步运动就是 MOVE PA ; 现在的位置是相对于销钉来确定的, 在销钉被抓取之后, 我们把TOOL规定为 TOOL : = E PG 上式起到这样的作用: 把机械手的末端重新规定为销钉的末端, 插入两个销钉的程序就变为,TOOL : = E; 固定抓手FOR I : = 1, 2 DOBEGIN READ (CAMERA, PC) 销钉位置 P : = CAM + PC ; 建立P COORD : = -Z + P； 相对于销钉的位置 MOVE PA ; 接近 MOVE PG; 移至销钉上方 GRASP ; 抓取 TOOL : = E PC ; 抓手在销钉末端 MOVE PD ; 起始点,HT : = HRI; 孔眼的位置 COORD : = -Z+H+HT; 相对于孔眼的坐标 MOVE PHA ; 接近孔眼 MOVE PCH ; 接触孔眼 MOVE PAL ; 调整销钉 MOVE PN ; 插入销钉 RELEASE ; 松开销钉 COORD : = -Z+H+HT+PN； 相对于销钉的坐标 TOOL : = E MOVE PA 脱离销钉 END,当销钉放在传送带上执行任务时，需要建立一个传送带与工作坐标的变换CONV(S)，它是传送带位置S的函数。然后根据传送带的坐标变换CONV(S)和销钉相对传送带的位置CONVP来确定销钉在工作坐标系中的位置P P = CONV(S) CONVP （8.26） 这样，所有的位置都可描述为相对于传送带的齐次变换。 如果物体OBJ放在传送带上，就可以利用传送带变换写出它的变换表达式 Z T6 E = CONV(S) OBJ F G （8.27） 其中 CONV 某个标量S的函数, 描述传送带的位置; CONVOBJ 相对于传送带描述物体; OBJF 描述装配部件方向的特征; FG 利用装配部件特征描述末端执行器。,8.6 传送带跟踪（Conveyor tracking）,如果传送带上的物体停止在某个位置, 而末端执行器处于抓取位置, OBJ就可确定为 OBJ = CONV-1(S) Z T6 E (F G)-1 (8.28) 在任务执行过程中, T6 变成传送带变量的函数 T6 = Z-1 CONV(S) OBJ F G E-1 (8.29) 如果不断地对T6求值, 并转换成关节角度（解逆运动方程）, 同时机械手跟随这些角度, 那么机械手就会跟踪运动着的物体。如果传送带停止运动，机械手也会停止动作。这样, 执行任务的程序就可写成,TOOL : = E 固定抓手FOR I : = 1, 2 DO BEGIN READ(CAMERA,PC) ; 插入销钉位置 P : = -CONVS+CAM+P ; 建立P COORD : = -Z+CONVS+P ; 相对于销钉的坐标 MOVE PA; 接近 MOVE PC ; 在销钉上方 GRASP ; 抓取销钉 TOOL : = E PG ; 抓手在销钉末端 MOVE PD ; 起始位置,HT:=HRI ; 孔眼的位置COORD : = -Z+H+HT ; 相对于孔眼的坐标MOVE PHA ; 接近孔眼MOVE PCH ; 接触孔眼MOVE PAI ; 调整销钉MOVE PN : 插入RELEASE ; 松开销钉COORD : = -Z+H +HT+PN ; 相对于销钉的坐标TOOL: = E ; MOVE PA ; 离开销钉 END ;,机械手的任务位置可以表示为一般形式 T6 TOOL = COORD POS (8.30) 其中 T6 表示机械手六个关节的变换; TOOL 变换表达式，描述手爪端点，或运动受到控制的物体; COORD 变换表达式，表示工作坐标系; POS 其余的变换表达式，描述所期望的手爪端点或物体的位置； 为了到达所确定的机械手任务的任何位置, 机械手的一系列位置运动可由下列方程确定 T6 TOOL1 = COORD1 POS1 T6 TOOL2 = COORD2 POS2 (8.31) T6 TOOL3 = COORD3 POS3,8.7 位置之间的运动（Motion Between Positions）,虽然任务位置的序列确定了任务，但并没有说明机械手是如何从一个位置移动到另一个位置的。利用下一个坐标系统和抓手，另外再定义一个POS变换，就可以完成上述工作。在位置1有 1T6 TOOL1 = COORD1(s|t=0) 1POS1 （8.32） 下面利用终点位置TOOL2和COORD2再写一个变换表达式 1T6 TOOL2 = COORD2(s|t=0) 2POS1 （8.33） 由这两个方程我们能解得利用COORD2和TOOL2定义的对于位置1的变换 2POS1 2POS1 = COORD2-1(s|t=0) COORD1(s|t=0) 1POS1 TOOL1-1 TOOL2 （8.34） 于是，任何两点i和i +1之间的运动就是从 T6 = COORD2(s|t=0) 2POS1 TOOL2-1 （8.35） 到 T6 = COORD2(s|t=0) 2POS2TOOL2-1 （8.36） 的运动。 注意：在这些方程中，COORDi+1是运动坐标系统变量（S）的函数。,当然，要把机械手从一个位置移到下一个位置可以有许多方法。但是，每一个实际系统必须提供连续的位置和连续的速度。为了防止振荡和蠕动，还要求连续的加速度。 以从位置到位置的运动时间Ti为基准，我们可以画出直线坐标、角坐标或者关节坐标，作为时间的函数。图8.11是一个典型的坐标图。 由于并不需要在每一个中间点停留。可以先对这条轨迹进行线性近似，如图8.12所示。 但是，由于速度和加速度在所有的轨迹定义点上都是不连续的。因而我们并不能实现这样一条线性轨迹。,在从一段轨迹过渡到另一条轨迹时为了保证速度、位置和加速度的连续性，可以在区间 -tacc t 10 fstructural (8.99),8.9.3 求解计算周期（Solution Evaluation Period）,如图8.20所示，假定机械手由一个半径为R的连杆构成，它位于距运动物体R/2之处，该物体以恒定的速度沿y轴前进。,在这种情况下我们可以说明，
- 温馨提示:
1: 本站所有资源如无特殊说明，都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
2: 本站的文档不包含任何第三方提供的附件图纸等，如果需要附件，请联系上传者。文件的所有权益归上传用户所有。
3.本站RAR压缩包中若带图纸，网页内容里面会有图纸预览，若没有图纸预览就没有图纸。
4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
5. 人人文库网仅提供信息存储空间，仅对用户上传内容的表现方式做保护处理，对用户上传分享的文档内容本身不做任何修改或编辑，并不能对任何下载内容负责。
6. 下载文件中如有侵权或不适当内容，请与我们联系，我们立即纠正。
7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
人人文库网所有资源均是用户自行上传分享，仅供网友学习交流，未经上传用户书面授权，请勿作他用。
川公网安备: 51019002004831号