机器人技术基础全ppt课件.ppt

《机器人技术基础全ppt课件.ppt》由会员分享，可在线阅读，更多相关《机器人技术基础全ppt课件.ppt（203页珍藏版）》请在三一办公上搜索。

1、机器人技术基础,第二章 位姿描述和齐次变换要求：熟练掌握描述刚体位姿描述的齐次变换方法,刚体位姿描述和齐次变换预备知识旋转矩阵坐标变换齐次坐标,欧拉角与 RPY 角齐次变换和齐次变换矩阵的运算例子,目录,第二章 位姿描述和齐次变换,要求：熟练掌握描述刚体位姿描述的齐次变换方法,2.1 刚体位姿描述 (Location Representing),机器人的操作，就其本义来说，意味着由某种机构在空间移动零件和工具。这自然有必要表示零件、工具以及机构本身的位置和方位。为了规定和运算表示位置和方位的数学量，我们必需规定坐标系，并掌握它们的表达式的常用形式。我们采取这样的思想，即某处存在一通用的坐标系统

2、，我们讨论的每一个物体均可参考此参考坐标系。描述是用来规定操作器系统所涉及的各物体的特性，这些物体指零件，工具或操作器本身。在本节我们讨论位置、方位的描述。,一、位置的描述 (Representing Position),其中Ap为31的列矢量，上标A代表参考坐标系A。,采用位置矢量表示空间中一点,p,A,p,A,？,刚体的位置、姿势可由其上的任一点(称作基准点，通常可选作物体的质心)和过该点的坐标系相对于参考坐标系的相对关系来确定。我们在物体上附一坐标系，然后再给出这一坐标系相对于参考系的描述。,二、方位的描述(Representing Rotation),或,B,A,表示刚体 B 相对于

3、A的方位,B与物体固结， A 为参考系。用坐标系B的三个单位主矢量相对于坐标系A的方向余弦组成的33矩阵,x,A,y,z,x,x,y,z,x,B,B,A,如图，绕X轴旋转900,900,绕X轴旋转,Rotation Matrices in 3D,绕Z轴旋转,绕Y轴旋转,绕X轴旋转,注意：,为单位矢量,33旋转矩阵有9个元素，6个约束条件，3个独立变量,是正交矩阵，且满足,称为旋转矩阵，上标A代表参考坐标系A，下标B代表被描述的坐标系B。,旋转矩阵的逆等于其转置矩阵,旋转矩阵的性质,为了完全描述刚体B在空间的位姿(位置和姿态)、通常将物体B与某一坐标系B相固接。B的坐标原点一般选在物体B的特征点

4、上，如质心、或对称中心等。相对参考系A，由位置矢量 和旋转矩阵 分别描述坐标系B的原点位置和坐标轴的方位。因此，刚体B的位姿可由坐标系B来描述，即,三、位姿的描述（位置姿态）,四、手爪坐标系,z-轴: 接近矢量(approaching object direction)y-轴: 方位矢量(along the orientation of the line connecting two fingers),x-轴: 法向矢量 n=oa,手爪的方位:,手爪的位姿:,求,A,B,1. 坐标平移,2.2 坐标变换,在机器人学的许多问题中，涉及到以不同坐标系表示同一量。下面讨论从一个坐标系的描述到另个坐标

5、系的描述之间的变换关系。,2. 坐标旋转,同一点p在两个坐标系A和B中的描述具有以下变换关系：,刚体位姿描述 (Location Representing),机器人的操作，就其本义来说，意味着由某种机构在空间移动零件和工具。这自然由必要表示零件、工具以及机构本身的位置和方位。为了规定和运算表示位置和方位的数学量，我们必需规定坐标系并提出它们的表达式的习惯形式。我们采取这样的思想，即某处存在一通用的坐标系统，我们讨论的每一个物体均可参考此参考坐标系。,刚体的位置、姿势可由其上的任一点(称作基准点，通常可选作物体的质心)和过该点的坐标系相对于参考坐标系的相对关系来确定。我们在物体上附一坐标系，然后

6、再给出这一坐标系相对于参考系的描述。,5. 刚体位置、姿态的描述,或,表示刚体 B 相对于 A的方位,B与物体固结， A 为参考系。用坐标系B的三个单位主矢量相对于坐标系A的方向余弦组成的33矩阵,为了完全描述刚体B在空间的位姿(位置和姿态)、通常将物体B与某一坐标系B相固接。B的坐标原点一般选在物体B的特征点上，如质心、或对称中心等。相对参考系A，由位置矢量 和旋转矩阵 分别描述坐标系B的原点位置和坐标轴的方位。因此，刚体B的位姿可由坐标系B来描述，即,3. 一般变换,齐次变换矩阵也代表坐标平移与坐标旋转的复合将其分解成两个矩阵相乘的形式之后就可以看出这一点。,其中，I33是33阶单位矩阵，

7、等式右端第一个矩阵称为平移变换矩阵，常用Trans (ApBo)来表示；第二个矩阵标为旋转变换矩阵,常用Rot (k, )来表示.,齐次变换矩阵,1 移动变换,2. 转动变换,绕Z轴旋转,绕Y轴旋转,绕X轴旋转,3. 对坐标系的解释,作为坐标系解释变换,齐次坐标和齐次变换,Homogeneous coordinate,Homogeneous coordinate,Homogeneous Transformation,Orientation matrix,Vector of coordinate origin,相对运动坐标系，变换式“从左向右”写：,Rot(y, 90)Rot(z,90),相对固

8、定坐标系，变换式“从右向左”写：,Rot(z, 90)Rot(x,90),4. 相对变换,变换矩阵的左乘和右乘的运动解释是不同的：变换顺序“从右向左”，指明运动是相对固定坐标系而言的；变换顺序“从左向右”，指明运动是相对运动坐标系而言的。,从左向右,从右向左,Example: Displacement in an Absolute Frame,Displace (7, 3, 2) through a sequence of:1. Rot(z, 90)2. Rot(y, 90)3. Trans(4, -3, 7)Trans(4, -3, 7) Rot(y, 90) Rot(z, 90),齐次变换

9、矩阵T具有以下不同的物理解释：,1. 坐标系的描述 描述B相对于参考系A的位姿2. 坐标映射 表示同一点P在两个坐标系A和B中描述之间的映射关系 3. 运动算子 T表示在同一坐标系中，点P运动前后的算子关系。,例 2.2,变换矩阵相乘不满足交换率,给定变换:,求,求解方法:,直接求逆简化求解,6. 逆变换,给定变换:,求,求解方法:,直接求逆简化求解,给定:,求,6. 逆变换,坐标系B原点 在B中的描述：,框A下的点 映射到B中描述：,6. 逆变换,已知 表示B相对于A绕其z轴转30度，再沿x轴移动4, 沿y轴移动3。求 .,(例2.5, P.21),7. 变换矩阵相乘,给定齐次变换矩阵:,，

10、 分别表示C相对于A和B的描述 表示坐标系C从 映射为 的变换,8. 手爪坐标系,z-轴: 接近矢量(approaching object direction)y-轴: 方位矢量(along the orientation of the line connecting two fingers),x-轴: 法向矢量,手爪的方位:,手爪的位姿:,9. 变换方程,给定变换:,确定,建立变换方程,2) 计算,可以写出测头中心位置的测量运动方程:利用内外传感器数据，采用参数辨识方法，如最小二乘方法可求得:,测量方程,可测量,待求量,可控量,欧拉角与 RPY 角,回转,俯仰,偏转,一、RPY角：依次绕绕固

11、定轴x-y-z旋转,给定,计算,二、欧拉角：依次绕绕动坐标系z-y-z轴旋转,We specify the order of rotation of Euler angles as follows:,We can obtain the orientation matrix described by Euler angles, which is same with the,二、欧拉角：依次绕绕动坐标系z-y-z轴旋转,三、绕任意轴/角的转动,前面讨论了旋转矩阵的三种特殊情况，即绕x, y和z轴的旋转矩阵，现在讨论绕过原点的任意轴k旋转角的变换矩阵。,表示坐标系B相对参考系A方位,运用旋转矩阵的正

12、交性质：,化简整理后得到：,其中，k轴即a轴。,12. 等效转轴和等效转角,Matlab编程作业,2.8 (p30)2.9 (p31)，参考P35图3-6,求,机器人技术基础,第三章 操作臂运动学课程的基本要求: 熟练掌握机器人运动学正解的D-H矩阵方法，掌握运动学反解的基本原理。理解机器人运动的二个描述空间。背景知识机器人运动学机器人逆运动学关节空间与操作空间,3.1 连杆参数和连杆坐标系Denavit - Hartenberg Parameters,第三章 操作臂运动学,连杆的描述,n自由度机械臂-n个单自由度关节与n-1个零长度连杆组成的模型。只考虑具有单自由度关节的操作器。连杆编号由固

13、定基座开始：固定基座连杆0第一个运动体连杆1,通常为了能在三维空间定位末端执行器，最少要求有6个关节。,连杆坐标系 关节 1 是垂直于肩, 关节 2 经过肩水平线, 关节 3 是在肘部。关节 4, 5 & 6 是在手腕上，初始位置关节4 和关节6 共同沿着前臂,关节5 垂直于关节4 和关节6。,连杆坐标系,Specification of Base & Final link frames,Base frame,is fixed at the base.,Final frame,is fixed at the gripper.,首、末连杆,参数/变量: , a , d, ,基本思想：每个关节分配

14、一个坐标系。用D-H参数，描述框i相对于前一个框i-1的位姿需要4个参数,D-H参数,Z(i - 1),X(i -1),Y(i -1),( i - 1),a(i - 1 ),Z i,Y i,X i,a i,d i, i,1） ai-1 定义: ai-1 两个关节轴线公垂线的长度. 关节轴是围绕它发生旋转的有向空间直线，在图中是 Zi-1和 Zi 轴。,Zi - 1,Xi -1,Yi -1, i - 1,ai - 1,Z i,Y i,X i,a i,d i, i,可视化方法：想象一个圆柱面围绕轴Z(i-1) 扩展 当圆柱面刚刚触及轴 i 时，圆柱的半径等于a(i-1)。图示方法： 若已经定义了坐

15、标系, 公垂线通常是X(i-1) 轴.因此 a(i-1) 恰是沿着X(i-1)从框i-1 到框i 的位移如果连杆是移动关节, 那么 a(i-1) 是变量，而不是参数,连杆参数a(i-1) 的识别方法：,2) (i-1)定义: 使关节轴平行时，绕公垂线旋转的角度. 按右手规则确定正向旋转。绕X(i-1) 轴旋转使 Z(i-1) 指向Zi 轴的方向,3) di定义: 为了使公垂线a(i-1)和公垂线ai与Zi的交点对起，沿Zi 轴所需的位移。即，沿Zi 对准X(i-1) 和 Xi 轴.,4) i 为了对准X(i-1) 轴和Xi 轴，绕Zi 轴所需转动的角度,连杆的描述参数,为了运动学建模的目的，一

16、个连杆由两个数字来确定，这两个数字规定了空间这两个轴线的相对位置。连杆长度连杆扭转角(twist),n,连杆连接参数的描述,中间连杆两条连杆之间的偏置两条连杆之间的关节角,对于运动链两端，按习惯约定,首、末连杆,d1和d6以及1和6的确定方法如下。 若关节1是转动关节，则1是可变的，称为关节变量，规定1 0为连杆1的零位。习惯约定d10,若关节1是移动关节，则d1是可变的，称为关节变量，规定d1=0为连杆1的零位。习惯约定10。 上面的约定对于关节6同样适用。,连杆参数和关节变量,每个连杆由四个参数来描述， 描述连杆i-1本身的特征， 描述连杆i-1与连杆i之间的联系。对于旋转关节i仅 是关节

17、变量，其他三个参数固定不变；对于移动关节i，仅 是关节变量，其他三个参数因定不变。这种描述机构运动的方法首先是Denavit和Hartenberg提出来的，称为D-H方法。,一个6关节的机器人，用18个参数可以完全表示它的运动学中固定部分，而用6个关节变量描述运动学变动部分。,关节变量,连杆i-1几何特征,连杆参数和关节变量,i-1从zi-1到zi沿xi-1旋转的角度ai-1 从zi-1到zi沿xi-1测量的距离di从xi-1到xi沿zi测量的距离i从xi-1到xi沿zi旋转的角度,3.1连杆变换和运动学方程,连杆变换,连杆变换可以看成是坐标系i经以下四个子变换得到的：,用4个参数对准两个关节

18、的轴线,因为这些子变换都是相对于动坐标系描述的，按照“从左向右”的原则得到,连杆变换矩阵,（The Denavit-Hartenberg Matrix）,连杆变换矩阵,D-H参数矩阵,与齐次变换矩阵一样， D-H参数矩阵是从一个坐标系到下一个坐标系的变换。用一系列D-H参数矩阵相乘，最终的结果是从某个坐标系到初始坐标系的变换。,连杆变换依赖于四个参数，其中只有一个是变化的。以下用qi表示第i个关节变量,手臂变换运动学方程,手臂变换矩阵,Denavit-Hartenberg Link Parameter Table,表的用途:1) 描述机器人的变量和参数2) 通过变量的数值描述机器人的状态,i-

19、1从zi-1到zi沿xi-1旋转的角度ai-1从zi-1到zi沿xi-1测量的距离di从xi-1到xi沿zi测量的距离i从xi-1到xi沿zi旋转的角度,This is a translation by a0 followed by a rotation around the Z1 axis,This is a translation by a1 and then d2 followed by a rotation around the X1 and Z2 axis,例,(P. 51, 第3.1题),y3,x3,The Situation:You have a robotic arm that

20、 starts out aligned with the xo-axis.You tell the first link to move by 1 and the second link to move by 2.The Quest:What is the position of the end of the robotic arm?,1,2,两关节机器人,X2,X3,Y2,Y3,1,2,3,1,2,3,Example Problem: You are have a three link arm that starts out aligned in the x-axis. Each link

21、has lengths l1, l2, l3, respectively. You tell the first one to move by 1 , and so on as the diagram suggests. Find the Homogeneous matrix to get the position of the yellow dot in the X0Y0 frame.,X1,Y1,X0,Y0,The position of the yellow dot relative to the X3Y3 frame is (l1, 0). Multiplying H by that

22、position vector will give you the coordinates of the yellow point relative the the X0Y0 frame.,X2,X3,Y2,Y3,1,2,3,1,2,3,X1,Y1,X0,Y0,H = Rz(1 ) * Tx1(l1) * Rz(2 ) * Tx2(l2) * Rz(3 ),i.e. Rotating by 1 will put you in the X1Y1 frame. Translate in the along the X1 axis by l1. Rotating by 2 will put you

23、in the X2Y2 frame. and so on until you are in the X3Y3 frame.,Slight variation on the last solution: Make the yellow dot the origin of a new coordinate X4Y4 frame,X2,X3,Y2,Y3,1,2,3,1,2,3,X1,Y1,X0,Y0,X4,Y4,H = Rz(1 ) * Tx1(l1) * Rz(2 ) * Tx2(l2) * Rz(3 ) * Tx3(l3)This takes you from the X0Y0 frame to

24、 the X4Y4 frame.The position of the yellow dot relative to the X4Y4 frame is (0,0).,We are interested in two kinematics topicsForward Kinematics (angles to position)What you are given: The length of each link The angle of each jointWhat you can find: The position of any point (i.e. its (x, y, z) coo

25、rdinates)Inverse Kinematics (position to angles)What you are given:The length of each linkThe position of some point on the robotWhat you can find:The angles of each joint needed to obtain that position,3.4 PUMA560机器人运动学,PUMA560机器人关节空间运动,PUMA560连杆坐标系,则工具相对于工作站的位姿为,I n v e r s e K i n e m a t i c sFr

26、om Position to Angles,A Simple Example, 1,X,Y,S,Revolute and Prismatic Joints Combined,(x , y),Finding 1:,More Specifically:,arctan2() specifies that its in the first quadrant,Finding S:, 2, 1,(x , y),l2,l1,Inverse Kinematics of a Two Link Manipulator,Given:l1, l2 , x , yFind: 1, 2Redundancy:A uniqu

27、e solution to this problem does not exist. Notice, that using the “givens” two solutions are possible. Sometimes no solution is possible.,(x , y),l2,l1,The Geometric Solution,l1,l2, 2, 1,(x , y),Using the Law of Cosines:,Using the Law of Cosines:,Redundant since 2 could be in the first or fourth qua

28、drant.,Redundancy caused since 2 has two possible values,The Algebraic Solution,l1,l2, 2, 1,(x , y),Only Unknown,记：,有,We know what 2 is from the previous slide. We need to solve for 1 . Now we have two equations and two unknowns (sin 1 and cos 1 ),Substituting for c1 and simplifying many times,Notic

29、e this is the law of cosines and can be replaced by x2+ y2,例如， PUMA 560存在8种运动反解,3.6 腕部三轴相交时的封闭解,对于6个自由度的机器人而言运动学反解非常复杂，一般没有封闭解。 6个自由度的机器人具有封闭反解的两个充分条件(Pieper准则)(1)三个相邻关节轴交于一点；(PUMA、Stanford),或(2)三个相邻关节轴相互平行；(ASEA，MINIMOVER) 对于如PUMA560机器人，满足条件(1) ，运动学方程可分解为： (1)腕部位置的反解(2)手腕方位的反解,3.7运动学反解的有关问题,运动学方程的一

30、般形式：n6, 6个未知数，12个方程，其中6个为独立方程，存在以下问题：解是否存在？是否唯一？是否可以写成封闭解形式？如何求解？,一、解的存在性和工作空间,理论上，可达工作空间为一个圆环，其内外半径分别为l1l2和l1l2；灵活工作空间：若l1l2 ，原点；若l1l2 ，空集。实际上，还需要考虑关节角的限制，以及结构参数等。,例如，平面2R机械手,工作空间(Workspace)：不同关节转角所达到的末端执行器的所有形位的集合。是反解存在的区域（操作空间中）。灵活(工作)空间(Dextrous Workspace)：机器人手爪能以任意方位到达的目标集合。可达(工作)空间(Reachable W

31、orkspace)：机器人手爪至少能以一个方位到达的目标集合。,工作空间,讨论,（1）关节角取值范围对工作空间的影响；（2）操作臂的自由度对工作空间的影响；（3）末端执行器或工具坐标系对工作空间的影响；,反解的唯一性和最优解,机器人操作臂运动学反解的数目决定于关节数目、连杆参数和关节变量的活动范围。一般而言，非零连杆参数愈多，运动学反解的数目愈多，例如PUMA 560。最优解：如何从多重解中选择一个最优解？最优准则？寻求方法？在避免碰撞的前提下，通常按“最短行程”准则。使每个关节的移动量为最小。对于典型工业机器人应遵循“多移动小关节、少移动大关节”的原则。,例如， PUMA 560存在8种运动

32、反解,三、求解方法,几何解解析解(analytical solution, closure solution) 封闭解法计算速度快，效率高数值求解(numerical solution )在多重解情况下，难以算出所有的解,关节空间n个自由度的操作臂的末端位姿由n个关节变量所决定，这n个关节变量统称为n维关节矢量，记为q，所有的关节矢量q构成的空间称为关节空间。操作空间：末端抓手的位置和方位在直角坐标空间中的描述；,3.8 关节空间和操作空间,关节空间和操作空间,操作空间 末端手爪的位姿x是在直角坐标空间中描述的，即用操作空间来表示。其中位置用直角坐标表示，而方位用齐次坐标或者欧拉角、RPY角方

33、法表示。运动学方程 可以看成是由关节空间向操作空间的映射；而运动学反解是由其映象求其关节空间中的原象。,关节空间,操作空间,运动学正解,运动学反解,二种描述空间,单个地看，不同的关节非常简单。 它们的运动容易理解和可视化。在左边的例子中，一个棱柱关节和旋转关节用来移动简单的机械手末端操纵装置。在同一时刻，只有一个关节运动，以便你能容易地看见是由用棱柱型关节 (黄色元件沿着红色元件的线性运动) 和旋转关节 (红色元件相对基座回转运动)提供的独立的运动。当它们共同地工作的时候 , 这二个简单的关节能产生更复杂的运动, 如例子所示在操作空间的运动。,关节空间运动,操作空间运动,作业：3.9,各驱动器

34、的位置统称为驱动矢量S驱动空间：驱动矢量S所构成的空间,x0,z0,z1,x1,z2,x2,y2,y0,y1,z3,x3,z4,x4,z5,x5,z6,x6,作业 3.9,机器人技术基础,第四章 机器人雅可比矩阵 (Manipulator Jacobian)课程的基本要求: 掌握运动和力雅可比矩阵的物理含义及基本的求解方法,4.1 雅可比矩阵的定义,回顾：基本概念,刚体位姿描述和齐次变换齐次坐标,欧拉角与 RPY 角齐次变换和齐次变换矩阵的运算操作臂运动学连杆参数、连杆坐标系连杆变换和运动学方程机器人关节空间与操作空间,关节角位置和操作臂末端的直角坐标位置,关节空间,操作空间,运动学正解,运动

35、学反解,关节角速度和操作臂末端的直角坐标速度,关节空间,操作空间,运动学正解,运动学反解,4.1 雅可比矩阵的定义(Jacobian matrix) 操作空间速度与关节空间速度之间的线性变换。,式中， 称为末端在操作空间的广义速度，简称为操作速度， 为关节速度； 是6n的偏导数矩阵，称为操作臂的雅可比矩阵。它的第i行第j列元素为 ，i=1,2,6; j=1,2,n。,假设矢量yRm为uRn的函数y= y(u),y相对于u的偏导数定义为,对于m=1,（标量对矢量的导数）,根据上述一般数学定义，对于6关节机器人： 设有6个各含6个独立变量的函数，简写为x=f(q)。 求微分， 注意，如果函数 f1

36、(q) 到 f6(q) 是非线性的，则 是q的函数，写成 ，式子两边同除以时间的微分，上式中，66的偏导数矩阵J(q)叫做雅可比矩阵。其中,雅可比矩阵,机器人关节数,*雅可比矩阵的行数取决于机器人的类型,雅可比矩阵在机器人中的应用,可以把雅可比矩阵看作是关节的速度 变换到操作速度V的变换矩阵在任何特定时刻，q具有某一特定值，J(q)就是一个线性变换。在每一新的时刻，q已改变，线性变换也因之改变，所以雅可比矩阵是一个时变的线性变换矩阵。在机器人学领域内，通常谈到的雅可比矩阵是把关节角速度和操作臂末端的直角坐标速度联系在一起的。必须注意到，对于任何给定的操作臂的结构和外形，关节速度是和操作臂末端的

37、直角坐标速度成线性关系，但这只是一个瞬间关系。,例4.1,将平面2R机械手的运动学方程两端分别对时间t求导,则得其雅可比矩阵为,平面2R机械手的运动学方程为,对于关节空间的某些形位q，操作臂的雅可比矩阵的秩减少、这些形位称为操作臂的奇异形位：操作臂的雅可比矩阵的秩减少的形位（数学上）操作臂在操作空间的自由度将减少（物理上）,(singular configuration),例4.1,可利用雅可比矩阵的行列式判别奇异形位,当290或2 0时,机械手的雅可比行列式为0矩阵的秩为1，因而处于奇异状态。从几何上看机械手完全伸直(2 0)或完全缩回(2 180)时，机械手末端丧失了径向自由度仅能沿切向运

38、动，在奇异形位时，机械手在操作空间的自由度将减少。,例4.2 如图所示为了实现平面2R机械手末端沿x0轴以l m/s的速度运动，求相应的关节速度,解：由 可以看出，只要机械手的雅可比J(q)是满秩的方阵,相应的关节速度即可解出对于平面2R机械手，运动学方程为,平面2R机械手的速度反解,例4.2 如图所示为了实现平面2R机械手末端沿x0轴以l m/s的速度运动，求相应的关节速度,解：雅可比J(q)为,于是得到与末端速度 相应的关节速度反解为,逆雅可比可为,讨论：机械手接近奇异形位时，关节速度将趋于无穷大。,当20； 2180时，机械手在水平位置，,例：物理仿真中的雅可比矩阵,约束函数C(x),

39、单位圆上的质点位置约束为一般情况下，采用位姿矢量q聚合表达n个粒子的位置。在3D空间，矢量长度为3n。考虑位置约束C是一个关于位姿矢量q的未知函数，则速度约束 矩阵 被称作C的雅可比矩阵，记作J。为了进行物理仿真，求微分 ，根据力学关系，建立微分约束方程，基于物理仿真。,例子2：立体视觉雅可比矩阵,两只CCD摄像机任意的安装在机器人手腕上，形成手眼机器人立体视觉系统。 Xc,Yc,Zc为摄像机坐标系， x,y为图像坐标系， CO为摄像机焦距 f Xw,Yw,Zw为世界坐标系，则 根据上述透视投影关系,得到以 世界坐标系表示的P点坐标与其 投影点p的坐标(x,y)的关系：,摄像机成像模型,对上式

40、两边求导，得： 为世界坐标系到图像坐标系的雅可比映射矩阵，它是摄像机内外参数的函数。进一步，经过立体视觉摄像机定标，得到： 其中， = ，k代表摄像机1，2。上式为手眼机器人跟踪系统的视觉伺服控制方程。 如果物体在世界坐标系下的速度 已知，根据采样时间步长t，前一帧图像位置x(k)，根据上式可以估计下一帧图像位置x(k+1)，则可通过控制摄像机位姿，可以实现对目标的跟踪。,4.2 微分运动与广义速度,4.2 微分运动与广义速度 刚体或坐标系的微分运动包含微分移动矢量d和微分转动矢量。前者由沿三个坐标轴的微分移动组成；后者又绕三个坐标轴的微分转动组成，即 将两者合并为6维列矢量D，称为刚体或坐标

41、系的微分运动矢量： 相应地，刚体或坐标系的广义速度V是由线速度v, 组成的6维矢量：,微分运动D和广义速度V是相对于参考坐标系而言的。例如，相对于坐标系T而言，用 ， 表示。,d,若相对于基坐标系的微分运动为D，则相对于坐标系T的微分运动 为,T,p,n,o,a,注意：D的微分位移和旋转应看作通过基坐标系的原点的矢量。,合并写为,对于任何三维矢量p=px，py，pzT，其反对称矩阵S(p)定义为S(p)是一个叉积算子，易证 S(p) = p , S(p) = (p )T,微分位移的变换简写为 式中, R=n,o,a 是旋转矩阵。 相应地，广义速度V 的坐标变换为 任意两坐标系A,B之间广义速度

42、的坐标变换为,4.3 雅可比矩阵的构造法,雅可比矩阵J(q)既可看成是从关节空间向操作空间速度传递的线性关系，也可看成是微分运动转换的线性关系，即对n个关节的机器人，J 的每一列代表相应的关节速度对于手爪线速度和角速度的传递比。因此，可将雅可比矩阵分块为,4.3 雅可比矩阵的构造法,关节速度,线速度,角速度,关节1速度引起手爪的线速度,下面采用构造性的方法直接构造出各项Jti和Jai,Whitney基于运动坐标系的概念提出求机器人雅可比的矢量积方法。如图所示,末端手爪的线速度v和角速度与关节速度 有关（1）对于移动关节 i ,（2）对于转动关节 i ,标量,矢量,矢量积方法其中， 表示手爪坐标

43、原点相对坐标系i的位置矢量在基坐标系o 中的表示。zi是坐标系i的z轴单位向量(在基坐标系o表示的)。,用矢量积方法计算J(q) 由于PUMA 560的6个关节都是转动关节因此其雅可比具有下列形式：,4.4 PUMA560的雅可比矩阵,4.5 力雅可比,机器人与外界环境相互作用时，在接触的地方要产生力f和力矩n，统称为末端广义(操作)力矢量。记为例如，操作臂提取重物时承受的外载作用力和力矩；抓手对被抓物体的作用力和力矩；多足步行机构与地面的作用力和力矩。在静止状态下，广义操作力矢量f应与各关节的驱动力(或力矩)相平衡。n个关节的驱动力(或力矩)组成的n维矢量称为关节力矢量,预备知识操作器的静力

44、,利用虚功原理可以导出关节力矢量与相应的广义操作力矢量F之间的关系。令各关节的虚位移为qi，末端执行器相应的虚位移为D。所谓虚位移，是满足机械系统几何约束的无限小位移。各关节所作的虚功之和WTq与末端执行器所作的虚功WFTDfTd+nT应该相等(总的虚功为零)，即,将 代入上式可得出,操作臂的力静态平衡,4.5 力雅可比,式中，JT(q)称为操作臂的力雅可比。它表示在静态平衡状态下，操作力向关节力映射的线性关系。上式也表示操作臂的力雅可比就是它的(运动)雅可比的转置。因此可以看出操作臂的静力传递关系与速度传递关系紧密相关。具有对偶性。操作臂的力雅可比表示在静态平衡状态下，操作力向关节力映射的线

45、性关系。,根据线性代数的有关知识，零空间N(J(q)是值空间R(JT(q)在n维关节空间的正交补，即对于任何非零的 N(J(q)，则有 R(JT(q)；反之亦然。其物理含义是，在不产生操作速度的这些关节速度方向上，关节力矩不能被操作力所平衡。为了使操作臂保持静止不动，在零空间N(J(q)的关节力矢量必须为零。,当J(q)退化时(即秩亏)，操作臂处于奇异形位。J(q)的零空间N(J(q)表示不产生操作速度的关节速度的集合。静力映射的零空间N(JT(q)代表不需要任何关节驱动力(矩)而能承受的所有操作力的集合，末端操作力完全由机构本身承受。而值域空间R(JT(q)则表示操作力能平衡的所有关节力矢量

46、的集合。,在m维操作空间中存在着相似的对偶关系。R(J(q)是N(JT(q) 在操作空间的正交补。因此，不能由关节运动产生的这些操作运动的方向恰恰正是不需要关节力矩来平衡的操作力的方向。反之，若外力作用的方向是沿着末端执行器能够运动的方向，则外力完全可以由关节力(矩)来平衡。当雅可比J(q)退化时，操作臂处于奇异形位，零空间N(JT(q)不只包含0，因而外力可能承受在操作臂机构本身上。利用瞬时运动和静力的对偶关系，可以从瞬时运动关系推导出相应的静力关系。由式(4.18)可以导出两坐标系A和B之间广义操作力的坐标变换关系,例：双连杆平面机器人 (p48, 55-56)：双连杆操作器,4.5 雅可

47、比的奇异性和灵巧度,一、雅可比的奇异性操作臂的雅可比依赖于形位q，关节空间的奇异形位q定义为操作臂6n的雅可比的秩不是满秩的这些关节矢量q，即满足相应的操作空间中的点xx(q)为工作空间的奇异点。在奇异形位处，操作臂丧失一个或多个操作自由度。粗略地讲，机器人的奇异形位分为两类：,(1)边界奇异形位； (2)内部奇异形位。,二、速度反解机器人在执行某一特定任务时，所需抓手独立运动参数的数目m随任务的性质而异，最多为6，有些则小于6，例如弧焊、喷漆等有对称轴线，独立运动参数是5个；带球形测头的机器人需要3个独立运动参数；用于圆柱铣刀加工的需要4个独立运动参数。用于端铣刀的需要4个独立运动参数，用于

48、平面作业的机器人需要3个独立运动参数。独立运动参数的数目即为操作空间的维数m(1)当Mn，且J(q)是满秧时，机器人具有冗余自由度，冗余度定义为dim(N(J)(2)当Mn，且J(q)是满秩的，称为满自由度；(3)当Mn，机器人是欠自由度的。,对于满自由度的机器人，J(q)是方阵，一般情况下，根据操作速度 ，可以反解出相应的关节速度。只是在奇异形位时，逆雅可比J-1(q)不存在，速度反解可能不存在。并且，在奇异点附近J(q)矩阵是病态的，反解的关节速度矢量可能趋于无限大。操作臂的运动性能和动态性能变坏。实际上，若雅可比J(q)是满秩方阵时，操作臂运动方程的速度反解为,雅可比矩阵的秩若J是方阵，

49、且非奇异，求逆运算,对于冗余度机器人，其雅可比的列数多于行数即nm。当J(q)是满秩的时，冗余度为dim(N(J(q) = nm 0其运动方程(4.2)的速度反解不唯一，解集合所包含的任意参数的数目等于冗余度dim(N(J(q) 。其通解可表示为式中， 是方程(4.2)的一特解; 是J(q)零空间的任意矢量，k是任意常数.冗余度机器人对于避免碰撞，避开奇异状态，增加操作臂的灵巧性，改善动态性能会带来好处。,若,其中,是J的广义逆,操作臂雅可比的奇异性定性地描述了操作臂的运动灵巧性和运动性能。为了定量分析操作臂的灵巧性和速度反解的精度，提出了许多度量指标。所有这些指标在概念上都与雅可比的奇异值有

50、关。根据矩阵的奇异值分解理论，对操作臂在任意形位的雅可比J(q)进行奇异值分解，即式中， 为正交矩阵，而,式中，1 2 m0为J的奇异值。,三、雅可比矩阵的奇异值分解,1.条件数,四、灵巧性度量指标,最大奇异值,最小奇异值,2. 最小奇异值,操作臂形位具有各向同性,操作臂终端对于关节运动的响应越快。,3可操作性(可操作度),小节,计算雅克比速度映射力映射,作业： 4.4, 4.5, 4.15,4.7 刚度和变形,机械臂在外力作用下发生变形，与操作臂刚度和作用力矢量有关。刚度是影响动态特性和定位精度的主要因素。主要来源：连杆变形、连杆支撑和关节驱动装置。,机器人关节变形的一个直接影响是引起末端的