机器人学基础机器人运动学.pptx

《机器人学基础机器人运动学.pptx》由会员分享，可在线阅读，更多相关《机器人学基础机器人运动学.pptx（67页珍藏版）》请在得力文库 - 分享文档赚钱的网站上搜索。

1、In manipulator robotics,there are two kinematics tasks:Direct(also forward)kinematics Given are joint relations(rotations,translations)for the robot arm.Task:What is the orientation and position of the end effector?Inverse kinematics Given is desired end effector position and orientation.Task:What a

2、re the joint rotations and orientations to achieve this?1 3.0 Introduction to Robot Kinematics3.0 Introduction to Robot Kinematics第1页/共67页Example of Direct KinematicsDefine position of end effector and the joint variable，According to geometry：The general vector form2 3.0 Introduction to Robot Kinema

3、tics第2页/共67页式中同样，如果用向量表示上述关系式，其一般可表示为Example of Inverse Kinematics3 3.0 Introduction to Robot Kinematics第3页/共67页机器人到达给定的手爪位置 P有两个姿态满足要求，即图中的 也是其解。此时 和 变成为另外的值，即逆运动学的解不是惟一的。将运动学公式 两边微分即可得到机器人手爪的速度和关节速度的关系，再进一步进行微分将得到加速度之间的关系，处理这些关系也是机器人的运动学问题。Example of Inverse Kinematics4 3.0 Introduction to Robot K

4、inematics第4页/共67页53.1 Representation of Kinematics Equation of Robot Manipulator3.1 Representation of Kinematics Equation of ManipulatorMechanics of a manipulator can be represented as a kinematics chain of rigid bodies(links)connected by revolute or prismatic joints.One end of the chain is constrai

5、ned to a base,while an end effector is mounted to the other end of the chain.The resulting motion is obtained by composition of the elementary motions of each link with respect to the previous one.第5页/共67页6 机械手是一系列由关节连接起来的连杆构成的。为机械手的每一连杆建立一个坐标系，并用齐次变换来描述这些坐标系间的相对位置和姿态。A矩阵：一个描述两连杆间坐标系相对关系的齐次变换，如；各 A

6、矩阵的乘积称为 T 矩阵。例如：A1，A2，A3 T1=A1 T2=A1A2 T3=A1A2A3 3.1 Representation of Kinematics Equation of Robot Manipulator3.1 Representation of Kinematics Equation of Manipulator第6页/共67页7T矩阵：A矩阵的乘积。对于六连杆机械手，有下列T矩阵：一个六连杆机械手可具有六个自由度，每个连杆含有一个自由度，并能在其运动范围内任意定位与定向。3.1 Representation of Kinematics Equation of Manipu

7、lator3.1 Representation of Kinematics Equation of Robot Manipulator第7页/共67页83.1 Representation of Kinematics Equation of Robot Manipulator 运动姿态和方向角运动姿态和方向角Motion Direction原点由矢量p表示。approach vector a：z向矢量orientation vector o：y向矢量normal vector n：x向矢量，Forming a right-hand frame：n=o a or a=n o3.1 Represe

8、ntation of Kinematics Equation of Manipulator第8页/共67页9因此，变换T6具有下列元素（同式2.35）。六连杆机械手的T 矩阵（T6）可由指定其16个元素的数值来决定。在这16个元素中，只有12个元素具有实际含义。3.1 Representation of Kinematics Equation of Manipulator第9页/共67页10Euler angle to represent motion pose机械手的运动姿态往往由一个绕轴x，y 和 z 的旋转序列来规定。这种转角的序列，称为欧拉（Euler）角。欧拉角:用一个绕 z 轴旋转

9、角，再绕新的 y 轴 y旋转角，最后绕新的 z 轴z旋转角来描述任 何可能的姿态。欧拉变换Euler可由连乘三个旋转矩阵来求得，即 （3.3）3.1 Representation of Kinematics Equation of Manipulator第10页/共67页11Roll,Pitch,Yaw to represent motion pose 另一种常用的旋转集合是横滚（roll）、俯仰（pitch）和偏转（yaw）。3.1 Representation of Kinematics Equation of Manipulator第11页/共67页12 对于旋转次序，规定：式中，RPY

10、表示横滚、俯仰和偏转三旋转的组合变换。也就是说，先绕 x 轴旋转角，再绕 y 轴旋转角，最后绕 z 轴旋角。3.1 Representation of Kinematics Equation of Manipulator第12页/共67页133.1 Representation of Kinetic Equation of Robot Manipulator 运动位置和坐标运动位置和坐标 一旦机械手的运动姿态由某个姿态变换规定之后，它在基系中的位置就能够由左乘一个对应于矢量 p的平移变换来确定（参式2.20）：3.1 Representation of Kinematics Equation

11、of Manipulator第13页/共67页14Description in Cylinder Coordinates 用柱面坐标来表示机械手手臂的位置，即表示其平移变换。这对应于沿 x 轴平移 r，再绕 z 轴旋转，最后沿 z 轴平移 z。如图3.4(a)所示。3.1 Representation of Kinematics Equation of Manipulator第14页/共67页15Description in Spherical Coordinates 用球面坐标表示手臂运动位置矢量的方法，对应于沿 z 轴平移 r，再绕 y 轴旋转角，最后绕 z 轴旋转 角，如图3.4(b)所

12、示，即为：3.1 Representation of Kinematics Equation of Manipulator第15页/共67页163.1 Representation of Kinetic Equation of Robot Manipulator 连杆变换矩阵及其乘积连杆变换矩阵及其乘积 广义连杆广义连杆 相邻坐标系间及其相应连杆可以用齐次变换矩阵来表示。要求解操作手所需要的变换矩阵，每个连杆都要用广义连杆来描述。在求得相应的广义变换矩阵之后，可对其加以修正，以适合每个具体的连杆。3.1 Representation of Kinematics Equation of Mani

13、pulator第16页/共67页17机器人机械手是由一系列连接在一起的连杆（杆件）构成的。需要用两个参数来描述一个连杆，即公共法线距离 所在平面内两轴的夹角 ；需要另外两个参数来表示相邻两杆的关系，即两连杆的相对位置 和两连杆法线的夹角 ，如图3.5所示。3.1 Representation of Kinematics Equation of Manipulator第17页/共67页183.1 Representation of Kinematics Equation of Manipulatorai-1:Link Length-mutual perpendicular unique exce

14、pt for parallel axis :Link Twist-measured in the right-hand sense about第18页/共67页193.1 Representation of Kinematics Equation of Manipulatordi:Link Offset-variable if joint i is prismatic(平动关节):Joint Angle-variable if joint i is revolute(转动关节)第19页/共67页20Denavit-Hartenberg Parameters4 D-H parameters3 f

15、ixed link parameters1 joint variablei and ai:describe the Link idi and i:describe the Links connection3.1 Representation of Kinematics Equation of Manipulator第20页/共67页213.1 Representation of Kinematics Equation of Manipulatory-vectors:complete right-hand frames第21页/共67页223.1 Representation of Kinema

16、tics Equation of Manipulator1.Normals 2.Origins3.Z-axes4.X-axes第22页/共67页233.1 Representation of Kinematics Equation of Manipulator第23页/共67页243.1 Representation of Kinematics Equation of ManipulatorExample-RRR Arm第24页/共67页253.1 Representation of Kinematics Equation of ManipulatorExample-RRR Armlinkdi

17、123=distance from zi to zi+1 along xi=distance from xi-1 to xi along zi=angle from zi to zi+1 about xi=angle from xi-1 to xi about zi第25页/共67页263.1 Representation of Kinematics Equation of ManipulatorExample-RRR Armlinkdi1000120L10230L203=distance from zi to zi+1 along xi=distance from xi-1 to xi al

18、ong zi=angle from zi to zi+1 about xi=angle from xi-1 to xi about zi第26页/共67页27Denavit-Hartenberg notation=distance from zi to zi+1 along xi=distance from xi-1 to xi along zi=angle from zi to zi+1 about xi=angle from xi-1 to xi about zi3.1 Representation of Kinematics Equation of Manipulator第27页/共67

19、页28(1)绕 轴旋转 角，使 轴转到与 同一平面内。(2)沿 轴平移一距离 ，把 移到与 同一直线上。(3)沿 xi 轴平移一距离 ai-1，使连杆 坐标系的原点与 连杆 i 的坐标系原点重合。(4)绕 xi 轴旋转 角，使 zi1 转到与 zi 同一直线上。3.1 Representation of Kinematics Equation of Manipulator第28页/共67页 T-Matrix and A-Matrix这种关系可由表示连杆相对位置的四个齐次变换来描述，并叫做 矩阵。此关系式为：(3.12)展开上式可得：（3.13）293.1 Representation of K

20、inematics Equation of Manipulator第29页/共67页30Using A-Matrix to represent T-Matrix机械手的末端装置即为连杆6的坐标系，它与连杆 坐标系的关系可由 表示为：可得连杆变换通式为：3.1 Representation of Kinematics Equation of Manipulator第30页/共67页313.2 Solving Kinematical Equation of RobotManipulator 机械手运动学方程的求解大多数机器人程序设计语言使用某个笛卡儿坐标系来指定机械手的末端位置。这一指定可用于求解

21、机械手最后一个连杆的姿态 。不过，在机械手能够被驱动至这个姿态之前，必须知道与这个位置有关的所有关节的位置。求解运动方程时，我们从 开始求解关节位置。使 的符号表达式的各元素等于 T6 的一般形式，并据此确定 。其它五个关节参数不可能从T6 求得，因为所求得的运动方程过于复杂而无法求解它们。我们可以由上节讨论的其它T 矩阵来求解它们。一旦求得 之后，可由 左乘 的一般形式，得：(3.18)式中，左边为 和 各元的函数。此式可用来求解其它各关节变量，如 等。3.2 Solving Kinematics Equation第31页/共67页3.2 Solving Kinematics Equatio

22、n 不断地用的逆矩阵左乘式(3.17)，可得下列4个矩阵方程式：(3.19)(3.20)(3.21)(3.22)上列各方程的左式为 和前 个关节变量的函数。可用这些方程来确定各关节的位置。32 3.2 Solving Kinematics Equation第32页/共67页33 欧拉变换解欧拉变换解基本隐式方程的解 令由式(3.4)和(3.23)得到：3.2 Solving Kinematics Equation3.2 Solving Kinematics Equation第33页/共67页34令矩阵方程两边各对应元素一一相等，可得到9个隐式方程如下：3.2 Solving Kinematic

23、s Equation第34页/共67页35 但这些解答是不确定的：（1）当由余弦函数求角度时，不仅此角度的符号是不确定的，并且所求角度的准确度也与该角度本身相关。（2）在求解 和 时，再次用到反余弦函数，且除式的分母为 。当 接近于0时，总会产生不准确。（3）当 或 时，和 的求解公式无定义。3.2 Solving Kinematics Equation第35页/共67页36 在求解时，总是采用双变量反正切函数atan2来确定角度。atan2提供二个自变量，即纵坐标和横坐标，见图3.8。当-，由atan2反求角度时，同时检查y和x的符号来确定其所在象限。这一函数也能检验什么时候x或y为0，并反

24、求出正确的角度。atan2的精确程度对其整个定义域都是一样的。3.2 Solving Kinematics Equation用双变量反正切函数(two-argument arc tangent function)确定角度第36页/共67页37用显式方程求各角度用显式方程求各角度 要求得方程式的解，采用另一种通常能够导致显式解答的方法。用未知逆变换依次左乘已知方程，对于欧拉变换有：式(3.37)的左式为已知变换的函数，而右式各元素或者为0，或者为常数。3.2 Solving Kinematics Equation第37页/共67页38 对方程求解，整理之后确定其等价欧拉角：如果已知一个表示任意旋

25、转的齐次变换，那么就能够确定其等价欧拉角。Solution of the Euler Transformation 3.2 Solving Kinematics Equation第38页/共67页39 滚、仰、偏变换解 直接从显式方程来求解用滚动、俯仰和偏转表示的变换方程。推导计算可得RPY变换各角如下：3.2 Solving Kinematics Equation第39页/共67页40球面变换解把求解滚、仰和偏变换方程的技术用于球面坐标表示的运动方程。可推导出球面变换的解为：3.2 Solving Kinematics Equation第40页/共67页413.3 Kinematic Equ

26、ation of PUMA 560 PUMA 560 机器人运动方程 PUMA 560 运动分析（表示）PUMA 560是属于关节式机器人，6个关节都是转动关节。前3个关节确定手腕参考点的位置，后3个关节确定手腕的方位。各连杆坐标系如图3.9所示。相应的连杆参数列于表3.1。3.3 Kinematics Equation of PUMA 560第41页/共67页42 3.3 Kinematics Equation of PUMA 560第42页/共67页43 PUMA560每个关节均有角度零位与正负方向限位开关，机器人的回转机体实现机器人机体绕z0轴的回转（角1），它由固定底座和回转工作台组成

27、。安装在轴中心的驱动电机经传动装置，可以实现工作台的回转。3.3 Kinematics Equation of PUMA 560第43页/共67页44 大臂、小臂的平衡由机器人中的平衡装置控制，在机器人的回转工作台上安装有大臂台座，将大臂下端关节支承在台座上，大臂的上端关节用于支承小臂。大臂臂体的下端安有直流伺服电机，可控制大臂上下摆动（角 2）。3.3 Kinematics Equation of PUMA 560第44页/共67页45 小臂支承于大臂臂体的上关节处，其驱动电机可带动小臂做上下俯仰（角3），以及小臂的回转（4）。3.3 Kinematics Equation of PUMA

28、560第45页/共67页46 机器人的腕部位于小臂臂体前端，通过伺服电动机传动，可实现腕部摆动（5）和转动（6）。3.3 Kinematics Equation of PUMA 560第46页/共67页47 3.3 Kinematics Equation of PUMA 560第47页/共67页48Using A-Matrix to represent T-Matrix机械手的末端装置即为连杆6的坐标系，它与连杆 坐标系的关系可由 表示为：可得连杆变换通式为：3.3 Kinematics Equation of PUMA 560第48页/共67页49 据连杆变换通式式(3.16)和表3.1所示

29、连杆参数，可求得各连杆变换矩阵如下：3.3 Kinematics Equation of PUMA 560第49页/共67页50 各连杆变换矩阵相乘，得PUMA 560的机械手变换的T 矩阵：即为关节变量 的函数。该矩阵描述了末端连杆坐标系6相对基坐标系0的位姿。3.3 Kinematics Equation of PUMA 560第50页/共67页51要求解此运动方程，需先计算某些中间结果4T6，3T6，1T3，1T6 等，见式（3.60）至（3.63）。于是，可求得机械手的T 变换矩阵：其中nx,ny,nz,ox,oy,oz,ax,ay,az,px,py,pz见式（3.64）3.3 Kin

30、ematics Equation of PUMA 560第51页/共67页52（3.64）3.3 Kinematics Equation of PUMA 560第52页/共67页53运动综合（求解）据式（3.59），可把PUMA 560的运动方程（3.64）写为：若末端连杆的位姿已经给定，即 为已知，则求关节变量 的值称为运动反解。用未知的连杆逆变换左乘方程(3.65)两边，把关节变量分离出来，从而求得 的解。3.3 Kinematics Equation of PUMA 560第53页/共67页541.求 用逆变换 左乘式(3.65)两边：3.3 Kinematics Equation of

31、 PUMA 560第54页/共67页551.求 利用三角代换：其中两边(2,4)项元素对应相等：3.3 Kinematics Equation of PUMA 560第55页/共67页56求 式中，正、负号对应于 的两个可能解。3.3 Kinematics Equation of PUMA 560第56页/共67页572.求 两边(1,4)项和(3,4)项元素对应相等：其中 3.3 Kinematics Equation of PUMA 560第57页/共67页58求 正、负号对应 的两种可能解。求 式中，3.3 Kinematics Equation of PUMA 560第58页/共67页

32、593.求 两边(1,4)项和(2,4)项元素对应相等：3.3 Kinematics Equation of PUMA 560第59页/共67页60求根据 解的四种可能组合可以得到相应的四种可能值 ，于是可得到 的四种可能解：式中，取与 相对应的值。3.3 Kinematics Equation of PUMA 560第60页/共67页614.求 两边(1,3)项和(3,3)项元素对应相等：3.3 Kinematics Equation of PUMA 560第61页/共67页625.求 两边(1,3)项和(3,3)项元素对应相等：3.3 Kinematics Equation of PUMA

33、 560第62页/共67页636.求 两边(3,1)项和(1,1)项元素对应相等：3.3 Kinematics Equation of PUMA 560第63页/共67页64For each solution pictured,there is another solution in which the last three joints flip“to an alternate configuration according to the formulas:Four solutions of the PUMA560 3.3 Kinematics Equation of PUMA 560第64

34、页/共67页65PUMA560的运动反解可能存在8种解。但是，由于结构的限制，例如各关节变量不能在全部360范围内运动，有些解不能实现。在机器人存在多种解的情况下，应选取其中最满意的一组解，以满足机器人的工作要求。Four solutions of the PUMA560 3.3 Kinematics Equation of PUMA 560第65页/共67页66 3.4 Summary 小结Representation of Kinematics Equation(Analysis)Motion Orientation of ManipulatorsEuler Angle-Motion PoseRoll,Pitch,Yaw-Motion PoseSolving Kinematics Equation(Synthesis)Solution of the Euler TransformationSolution of Roll,Pitch and Yaw Solution of Spherical Coordinate Transformation Motion Analysis and Synthesis of PUMA560 3.4 Summary第66页/共67页67感谢您的观看。第67页/共67页