机 器 人 技 术 基 础第二章 位姿描述和齐次变换要求：熟练掌握描述刚体位姿描述的齐次变换方法刚体位姿描述和齐次变换预备知识旋转矩阵坐标变换齐次坐标,欧拉角与 RPY 角齐次变换和齐次变换矩阵的运算例子目录第二章 位姿描述和齐次变换要求：熟练掌握描述刚体位姿描述的齐次变换方法2.1 刚体位姿描述刚体位姿描述 (Location Representing)机器人的操作，就其本义来说，意味着由某种机构在空间移动零件和工具。这自然有必要表示零件、工具以及机构本身的位置和方位。为了规定和运算表示位置和方位的数学量，我们必需规定坐标系，并掌握它们的表达式的常用形式。我们采取这样的思想，即某处存在一通用的坐标系统，我们讨论的每一个物体均可参考此参考坐标系。描述是用来规定操作器系统所涉及的各物体的特性，这些物体指零件，工具或操作器本身。在本节我们讨论位置、方位的描述。一、位置的描述一、位置的描述 (Representing Position)其中Ap为31的列矢量，上标A代表参考坐标系A。采用位置矢量表示空间中一点 p Ap A？ 刚体的位置、姿势可由其上的任一点(称作基准点，通常可选作物体的质心)和过该点的坐标系相对于参考坐标系的相对关系来确定。我们在物体上附一坐标系，然后再给出这一坐标系相对于参考系的描述。二、方位的描述二、方位的描述(Representing Rotation)或BA表示刚体 B 相对于 A的方位B与物体固结， A 为参考系。用坐标系B的三个单位主矢量相对于坐标系A的方向余弦组成的33矩阵xAyzxxyzxBBA如图，绕X轴旋转900900绕X轴旋转Rotation Matrices in 3D绕Z轴旋转绕Y轴旋转绕X轴旋转注意：为单位矢量33旋转矩阵有9个元素，6个约束条件，3个独立变量是正交矩阵，且满足 称为旋转矩阵，上标A代表参考坐标系A，下标B代表被描述的坐标系B。旋转矩阵的逆等于其转置矩阵旋转矩阵的性质旋转矩阵的性质 为了完全描述刚体B在空间的位姿(位置和姿态)、通常将物体B与某一坐标系B相固接。B的坐标原点一般选在物体B的特征点上，如质心、或对称中心等。相对参考系A，由位置矢量 和旋转矩阵 分别描述坐标系B的原点位置和坐标轴的方位。因此，刚体B的位姿可由坐标系B来描述，即三、位姿的描述（位置姿态）三、位姿的描述（位置姿态）四、手爪坐标系四、手爪坐标系z-z-轴轴轴轴: : 接近矢量接近矢量接近矢量接近矢量( (a approaching object direction)pproaching object direction)y-y-轴轴轴轴: : 方位矢量方位矢量方位矢量方位矢量( (along the along the o orientation of the line connecting two fingers)rientation of the line connecting two fingers) x-x-轴轴轴轴: : 法向矢量法向矢量法向矢量法向矢量 n=o a手爪的方位手爪的方位手爪的方位手爪的方位: :手爪的位姿手爪的位姿手爪的位姿手爪的位姿: :求AB1. 坐标平移2.2 坐标变换坐标变换在机器人学的许多问题中，涉及到以不同坐标系表示同一量。下面讨论从一个坐标系的描述到另个坐标系的描述之间的变换关系。2. 坐标旋转同一点p在两个坐标系A和B中的描述具有以下变换关系：刚体位姿描述刚体位姿描述 (Location Representing)机器人的操作，就其本义来说，意味着由某种机构在空间移动零件和工具。这自然由必要表示零件、工具以及机构本身的位置和方位。为了规定和运算表示位置和方位的数学量，我们必需规定坐标系并提出它们的表达式的习惯形式。我们采取这样的思想，即某处存在一通用的坐标系统，我们讨论的每一个物体均可参考此参考坐标系。 刚体的位置、姿势可由其上的任一点(称作基准点，通常可选作物体的质心)和过该点的坐标系相对于参考坐标系的相对关系来确定。我们在物体上附一坐标系，然后再给出这一坐标系相对于参考系的描述。5. 刚体位置、姿态的描述刚体位置、姿态的描述或BA表示刚体 B 相对于 A的方位B与物体固结， A 为参考系。用坐标系B的三个单位主矢量相对于坐标系A的方向余弦组成的33矩阵 A B 为了完全描述刚体B在空间的位姿(位置和姿态)、通常将物体B与某一坐标系B相固接。B的坐标原点一般选在物体B的特征点上，如质心、或对称中心等。相对参考系A，由位置矢量 和旋转矩阵 分别描述坐标系B的原点位置和坐标轴的方位。因此，刚体B的位姿可由坐标系B来描述，即3. 一般变换 齐次变换矩阵也代表坐标平移与坐标旋转的复合齐次变换矩阵也代表坐标平移与坐标旋转的复合将其分解成两个矩阵相乘的形式之后就可以看出这一点。将其分解成两个矩阵相乘的形式之后就可以看出这一点。其中，其中，I33是是33阶单位矩阵，等式右端第一个矩阵称为平阶单位矩阵，等式右端第一个矩阵称为平移变换矩阵，常用移变换矩阵，常用Trans (ApBo)来表示；第二个矩阵标为旋来表示；第二个矩阵标为旋转变换矩阵转变换矩阵,常用常用Rot (k, )来表示来表示.齐次变换矩阵齐次变换矩阵1 移动变换移动变换2. 转动变换转动变换绕Z轴旋转绕Y轴旋转绕X轴旋转3. 对坐标系的解释对坐标系的解释作为坐标系解释变换齐次坐标和齐次变换齐次坐标和齐次变换HomogeneoHomogeneous us coordinatecoordinateHomogeneoHomogeneous us coordinatecoordinateHomogeneoHomogeneous us TransformatiTransformationonOrientation matrixVector of coordinate origin相对运动坐标系，变换式“从左向右”写：Rot(y, 90)Rot(z,90)相对固定坐标系，变换式“从右向左”写：Rot(z, 90)Rot(x,90)4. 相对变换相对变换变换矩阵的左乘和右乘的运动解释是不同的：变换顺序“从右向左”，指明运动是相对固定坐标系而言的；变换顺序“从左向右”，指明运动是相对运动坐标系而言的。从左向右从右向左Example: Displacement in an Absolute FrameDisplace (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) 齐次变换矩阵T具有以下不同的物理解释：1. 坐标系的描述 描述B相对于参考系A的位姿2. 坐标映射 表示同一点P在两个坐标系A和B中描述之间的映射关系 3. 运动算子 T表示在同一坐标系中，点P运动前后的算子关系。Ap2=T Ap1例例例例 2.42.4例例例例 2.22.2变换矩阵相乘不满足交换率变换矩阵相乘不满足交换率给定变换给定变换给定变换给定变换: :求求求求 求解方法求解方法求解方法求解方法: :1)1)直接求逆直接求逆直接求逆直接求逆2)2)简化求解简化求解简化求解简化求解6. 逆变换逆变换给定变换给定变换给定变换给定变换: :求求求求 求解方法求解方法求解方法求解方法: :1)1)直接求逆直接求逆直接求逆直接求逆2)2)简化求解简化求解简化求解简化求解给定给定给定给定: :求求求求 6. 逆变换逆变换坐标系B原点 在B中的描述：框A下的点 映射到B中描述：6. 逆变换逆变换已知 表示B相对于A绕其z轴转30度，再沿x轴移动4, 沿y轴移动3。求 .(例2.5, P.21)7. 变换矩阵相乘变换矩阵相乘给定齐次变换矩阵给定齐次变换矩阵给定齐次变换矩阵给定齐次变换矩阵: : ， 分别表示C相对于A和B的描述 表示坐标系C从 映射为 的变换8. 手爪坐标系手爪坐标系z-z-轴轴轴轴: : 接近矢量接近矢量接近矢量接近矢量( (a approaching object direction)pproaching object direction)y-y-轴轴轴轴: : 方位矢量方位矢量方位矢量方位矢量( (along the along the o orientation of the line connecting two fingers)rientation of the line connecting two fingers) x-x-轴轴轴轴: : 法向矢量法向矢量法向矢量法向矢量手爪的方位手爪的方位手爪的方位手爪的方位: :手爪的位姿手爪的位姿手爪的位姿手爪的位姿: : 9. 变换方程变换方程给定变换给定变换给定变换给定变换: :确定确定确定确定 1)1)建立变换方程建立变换方程建立变换方程建立变换方程2)2) 计算计算计算计算可以写出测头中心位置的测量运动方程:利用内外传感器数据，采用参数辨识方法，如最小二乘方法可求得:测量方程可测量待求量可控量欧拉角与 RPY 角回转俯仰偏转一、RPY角：依次绕绕固定轴x-y-z旋转给定给定给定给定计算计算计算计算二、欧拉角：依次绕绕动坐标系z-y-z轴旋转We specify the order of rotation We specify the order of rotation of Euler angles as follows:of Euler angles as follows:We can obtain the orientation matrix described by We can obtain the orientation matrix described by Euler Euler anglesangles, which is same with the , which is same with the 二、欧拉角：依次绕绕动坐标系z-y-z轴旋转三、绕任意轴三、绕任意轴/角的转动角的转动前面讨论了旋转矩阵的三种特殊情况，即绕x, y和z轴的旋转矩阵，现在讨论绕过原点的任意轴k旋转角的变换矩阵。表示坐标系B相对参考系A方位运用旋转矩阵的正交性质：化简整理后得到：其中，k轴即a轴。12. 等效转轴和等效转角Matlab编程作业编程作业2.8 (p30)2.9 (p31)，参考P35图3-6 求机器人技术基础 第三章 操作臂运动学课程的基本要求: 熟练掌握机器人运动学正解的D-H矩阵方法，掌握运动学反解的基本原理。理解机器人运动的二个描述空间。背景知识机器人运动学机器人逆运动学关节空间与操作空间3.1 连杆参数和连杆坐标系Denavit - Hartenberg Parameters第三章 操作臂运动学连杆的描述n自由度机械臂-n个单自由度关节与n-1个零长度连杆组成的模型。只考虑具有单自由度关节的操作器。连杆编号由固定基座开始：固定基座连杆0第一个运动体连杆1通常为了能在三维空间定位末端执行器，最少要求有6个关节。连杆坐标系 关节 1 是垂直于肩, 关节 2 经过肩水平线, 关节 3 是在肘部。关节 4, 5 & 6 是在手腕上，初始位置关节4 和关节6 共同沿着前臂,关节5 垂直于关节4 和关节6。连杆坐标系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 Specification of Base & Final link frames Base frame Base frame is fixed at the base. is fixed at the base. Final frame Final frame is fixed at the gripper. is fixed at the gripper. 首、末连杆参数/变量: , a , d, 基本思想：每个关节分配一个坐标系。用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 - 1Xi -1Yi -1 i - 1ai - 1Z i Y i X i a i d i i 可视化方法：想象一个圆柱面围绕轴Z(i-1) 扩展 当圆柱面刚刚触及轴 i 时，圆柱的半径等于a(i-1)。图示方法： 若已经定义了坐标系, 公垂线通常是X(i-1) 轴.因此 a(i-1) 恰是沿着X(i-1)从框i-1 到框i 的位移如果连杆是移动关节, 那么 a(i-1) 是变量，而不是参数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 连杆参数连杆参数a(i-1) 的的识别方法：识别方法：2) (i-1)定义: 使关节轴平行时，绕公垂线旋转的角度. 按右手规则确定正向旋转。绕X(i-1) 轴旋转使 Z(i-1) 指向Zi 轴的方向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 3) di定义: 为了使公垂线a(i-1)和公垂线ai与Zi的交点对起，沿Zi 轴所需的位移。即，沿Zi 对准X(i-1) 和 Xi 轴. 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 4) i 为了对准X(i-1) 轴和Xi 轴，绕Zi 轴所需转动的角度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 连杆的描述参数为了运动学建模的目的，一个连杆由两个数字来确定，这两个数字规定了空间这两个轴线的相对位置。连杆长度连杆长度连杆长度连杆长度连杆扭转角连杆扭转角连杆扭转角连杆扭转角(twist)(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仅 是关节变量，其他三个参数固定不变；对于移动关节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个参数对准两个关节的轴线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 因为这些子变换都是相对于动坐标系描述的，按照“从左向右”的原则得到连杆变换矩阵（The Denavit-Hartenberg Matrix）连杆变换矩阵D-H参数矩阵参数矩阵与齐次变换矩阵一样， D-H参数矩阵是从一个坐标系到下一个坐标系的变换。用一系列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 连杆变换依赖于四个参数，其中只有一个是变化的。以下用qi表示第i个关节变量手臂变换运动学方程手臂变换运动学方程手臂变换矩阵Z0X0Y0Z1X2Y1Z2X1Y2d2a0a1Denavit-Hartenberg Link Parameter Table表的用途:1) 描述机器人的变量和参数2) 通过变量的数值描述机器人的状态i-1从zi-1到zi沿xi-1旋转的角度ai-1从zi-1到zi沿xi-1测量的距离di从xi-1到xi沿zi测量的距离i从xi-1到xi沿zi旋转的角度Z0X0Y0Z1X2Y1Z2X1Y2d2a0a1This is a translation by a0 followed by a rotation around the Z1 axisThis is a translation by a1 and then d2 followed by a rotation around the X1 and Z2 axisZ0X0Y0Z1X2Y1Z2X1Y2d2a0a1例例例例(P. 51, (P. 51, 第第第第3.13.1题题题题) )i10002900300y3x3The Situation:You have a robotic arm that 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两关节机器人X2X3Y2Y3 1 2 3123 Example Problem: You are have a three link arm that starts out aligned in the x-axis. Each link 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.X1Y1X0Y0The position of the yellow dot relative to the X3Y3 frame is (l1, 0). Multiplying H by that position vector will give you the coordinates of the yellow point relative the the X0Y0 frame. X2X3Y2Y3 1 2 3123X1Y1X0Y0H = 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 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 X2X3Y2Y3 1 2 3123X1Y1X0Y0X4Y4H = Rz( 1 ) * Tx1(l1) * Rz( 2 ) * Tx2(l2) * Rz( 3 ) * Tx3(l3)This takes you from the X0Y0 frame to 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) coordinates)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 position3.4 PUMA560机器人运动学PUMA560机器人关节空间运动PUMA560连杆坐标系则工具相对于工作站的位姿为I n v e r s e K i n e m a t i c sFrom Position to Angles A Simple Example 1XYSRevolute and Prismatic Joints Combined(x , y)Finding 1:More Specifically:arctan2() specifies that its in the first quadrantFinding S: 2 1(x , y)l2l1Inverse Kinematics of a Two Link ManipulatorGiven:l1, l2 , x , yFind: 1, 2Redundancy:A unique solution to this problem does not exist. Notice, that using the “givens” two solutions are possible. Sometimes no solution is possible.(x , y)l2l1l2l1The Geometric Solutionl1l2 2 1 (x , y)Using the Law of Cosines:Using the Law of Cosines:Redundant since 2 could be in the first or fourth quadrant.Redundancy caused since 2 has two possible valuesThe Algebraic Solutionl1l2 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 timesNotice 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运动学反解的有关问题运动学反解的有关问题运动学方程的一般形式：n6, 6个未知数，12个方程，其中6个为独立方程，存在以下问题：解是否存在？是否唯一？是否可以写成封闭解形式？如何求解？一、解的存在性和工作空间理论上，可达工作空间为一个圆环，其内外半径分别为l1l2和l1l2；灵活工作空间：若l1l2 ，原点；若l1l2 ，空集。实际上，还需要考虑关节角的限制，以及结构参数等。例如，平面2R机械手工作空间(Workspace)：不同关节转角所达到的末端执行器的所有形位的集合。是反解存在的区域（操作空间中）。灵活(工作)空间(Dextrous Workspace)：机器人手爪能以任意方位到达的目标集合。可达(工作)空间(Reachable Workspace)：机器人手爪至少能以一个方位到达的目标集合。工作空间讨论（1）关节角取值范围对工作空间的影响；（2）操作臂的自由度对工作空间的影响；（3）末端执行器或工具坐标系对工作空间的影响；反解的唯一性和最优解机器人操作臂运动学反解的数目决定于关节数目、连杆参数和关节变量的活动范围。一般而言，非零连杆参数愈多，运动学反解的数目愈多，例如PUMA 560。最优解：如何从多重解中选择一个最优解？最优准则？寻求方法？在避免碰撞的前提下，通常按“最短行程”准则。使每个关节的移动量为最小。对于典型工业机器人应遵循“多移动小关节、少移动大关节”的原则。例如， PUMA 560存在8种运动反解三、求解方法几何解解析解(analytical solution, closure solution) 封闭解法计算速度快，效率高数值求解(numerical solution )在多重解情况下，难以算出所有的解关节空间n个自由度的操作臂的末端位姿由n个关节变量所决定，这n个关节变量统称为n维关节矢量，记为q，所有的关节矢量q构成的空间称为关节空间。操作空间：末端抓手的位置和方位在直角坐标空间中的描述；3.8 关节空间和操作空间关节空间和操作空间操作空间 末端手爪的位姿x是在直角坐标空间中描述的，即用操作空间来表示。其中位置用直角坐标表示，而方位用齐次坐标或者欧拉角、RPY角方法表示。运动学方程 可以看成是由关节空间向操作空间的映射；而运动学反解是由其映象求其关节空间中的原象。关节空间操作空间运动学正解运动学正解运动学反解运动学反解二种描述空间单个地看，不同的关节非常简单。 它们的运动容易理解和可视化。在左边的例子中，一个棱柱关节和旋转关节用来移动简单的机械手末端操纵装置。在同一时刻，只有一个关节运动，以便你能容易地看见是由用棱柱型关节 (黄色元件沿着红色元件的线性运动) 和旋转关节 (红色元件相对基座回转运动)提供的独立的运动。当它们共同地工作的时候 , 这二个简单的关节能产生更复杂的运动, 如例子所示在操作空间的运动。关节空间运动操作空间运动作业：作业：3.9各驱动器的位置统称为驱动矢量S驱动空间：驱动矢量S所构成的空间x0z0z1x1z2x2y2y0y1z3x3z4x4z5x5z6x6作业 3.9机器人技术基础第四章 机器人雅可比矩阵 (Manipulator Jacobian)课程的基本要求: 掌握运动和力雅可比矩阵的物理含义及基本的求解方法4.1 雅可比矩阵的定义雅可比矩阵的定义回顾：基本概念刚体位姿描述和齐次变换齐次坐标,欧拉角与 RPY 角齐次变换和齐次变换矩阵的运算操作臂运动学连杆参数、连杆坐标系连杆变换和运动学方程机器人关节空间与操作空间关节角位置和操作臂末端的直角坐标位置关节空间操作空间运动学正解运动学正解运动学反解运动学反解关节角速度和操作臂末端的直角坐标速度关节空间操作空间运动学正解运动学正解运动学反解运动学反解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(q) 到 f6(q) 是非线性的，则 是q的函数，写成 ，式子两边同除以时间的微分，上式中，66的偏导数矩阵J(q)叫做雅可比矩阵。其中雅可比矩阵雅可比矩阵机器人关节数*雅可比矩阵的行数取决于机器人的类型雅可比矩阵在机器人中的应用可以把雅可比矩阵看作是关节的速度 变换到操作速度V的变换矩阵在任何特定时刻，q具有某一特定值，J(q)就是一个线性变换。在每一新的时刻，q已改变，线性变换也因之改变，所以雅可比矩阵是一个时变的线性变换矩阵。在机器人学领域内，通常谈到的雅可比矩阵是把关节角速度和操作臂末端的直角坐标速度联系在一起的。必须注意到，对于任何给定的操作臂的结构和外形，关节速度是和操作臂末端的直角坐标速度成线性关系，但这只是一个瞬间关系。(x,y)21xyl1l2例4.1将平面2R机械手的运动学方程两端分别对时间t求导,则得其雅可比矩阵为平面2R机械手的运动学方程为对于关节空间的某些形位q，操作臂的雅可比矩阵的秩减少、这些形位称为操作臂的奇异形位：操作臂的雅可比矩阵的秩减少的形位（数学上）操作臂在操作空间的自由度将减少（物理上）(singular configuration)(x,y)21xyl1l2例4.1可利用雅可比矩阵的行列式判别奇异形位当290或2 0时,机械手的雅可比行列式为0矩阵的秩为1，因而处于奇异状态。从几何上看机械手完全伸直(2 0)或完全缩回(2 180)时，机械手末端丧失了径向自由度仅能沿切向运动，在奇异形位时，机械手在操作空间的自由度将减少。例4.2 如图所示为了实现平面2R机械手末端沿x0轴以l m/s的速度运动，求相应的关节速度 解：由 可以看出，只要机械手的雅可比J(q)是满秩的方阵,相应的关节速度即可解出对于平面2R机械手，运动学方程为平面2R机械手的速度反解例4.2 如图所示为了实现平面2R机械手末端沿x0轴以l m/s的速度运动，求相应的关节速度 解：雅可比J(q)为于是得到与末端速度 相应的关节速度反解为逆雅可比可为讨论：机械手接近奇异形位时，关节速度将趋于无穷大。当20； 2180时，机械手在水平位置，例：物理仿真中的雅可比矩阵约束函数C(x), 单位圆上的质点位置约束为一般情况下，采用位姿矢量q聚合表达n个粒子的位置。在3D空间，矢量长度为3n。考虑位置约束C是一个关于位姿矢量q的未知函数，则速度约束 矩阵 被称作C的雅可比矩阵，记作J。为了进行物理仿真，求微分 ，根据力学关系，建立微分约束方程，基于物理仿真。例子2：立体视觉雅可比矩阵 两只CCD摄像机任意的安装在机器人手腕上，形成手眼机器人立体视觉系统。 Xc,Yc,Zc为摄像机坐标系， x,y为图像坐标系， CO为摄像机焦距 f Xw,Yw,Zw为世界坐标系，则 根据上述透视投影关系,得到以 世界坐标系表示的P点坐标与其 投影点p的坐标(x,y)的关系：scene pointscene pointoptical centeroptical centerimage planeimage planeyxXcYcCOpP(Xc, Yc, Zc)ZcXwYwZwW摄像机成像模型 对上式两边求导，得： 为世界坐标系到图像坐标系的雅可比映射矩阵，它是摄像机内外参数的函数。进一步，经过立体视觉摄像机定标，得到： 其中， = ，k代表摄像机1，2。上式为手眼机器人跟踪系统的视觉伺服控制方程。 如果物体在世界坐标系下的速度 已知，根据采样时间步长t，前一帧图像位置x(k)，根据上式可以估计下一帧图像位置x(k+1)，则可通过控制摄像机位姿，可以实现对目标的跟踪。4.2 微分运动与广义速度微分运动与广义速度4.2 微分运动与广义速度 刚体或坐标系的微分运动包含微分移动矢量d和微分转动矢量。前者由沿三个坐标轴的微分移动组成；后者又绕三个坐标轴的微分转动组成，即 将两者合并为6维列矢量D，称为刚体或坐标系的微分运动矢量： 相应地，刚体或坐标系的广义速度V是由线速度v, 组成的6维矢量： d 微分运动D和广义速度V是相对于参考坐标系而言的。例如，相对于坐标系T而言，用 ， 表示。 d若相对于基坐标系的微分运动为D，则相对于坐标系T的微分运动 为Tpnoa注意：D的微分位移和旋转应看作通过基坐标系的原点的矢量。 合并写为对于任何三维矢量p=px，py，pzT，其反对称矩阵S(p)定义为S(p)是一个叉积算子，易证 S(p) = p , S(p) = (p )T 微分位移的变换简写为 式中, R=n,o,a 是旋转矩阵。 相应地，广义速度V 的坐标变换为 任意两坐标系A,B之间广义速度的坐标变换为4.3 雅可比矩阵的构造法雅可比矩阵J(q)既可看成是从关节空间向操作空间速度传递的线性关系，也可看成是微分运动转换的线性关系，即对n个关节的机器人，J 的每一列代表相应的关节速度对于手爪线速度和角速度的传递比。因此，可将雅可比矩阵分块为4.3 雅可比矩阵的构造法关节速度线速度角速度关节1速度引起手爪的线速度下面采用构造性的方法直接构造出各项Jti和JaiWhitney基于运动坐标系的概念提出求机器人雅可比的矢量积方法。如图所示,末端手爪的线速度v和角速度与关节速度 有关（1）对于移动关节 i ,（2）对于转动关节 i ,标量矢量矢量积方法其中， 表示手爪坐标原点相对坐标系i的位置矢量在基坐标系o 中的表示。zi是坐标系i的z轴单位向量(在基坐标系o表示的)。用矢量积方法计算J(q) 由于PUMA 560的6个关节都是转动关节因此其雅可比具有下列形式：4.4 PUMA560的雅可比矩阵4.5 力雅可比机器人与外界环境相互作用时，在接触的地方要产生力f和力矩n，统称为末端广义(操作)力矢量。记为例如，操作臂提取重物时承受的外载作用力和力矩；抓手对被抓物体的作用力和力矩；多足步行机构与地面的作用力和力矩。在静止状态下，广义操作力矢量f应与各关节的驱动力(或力矩)相平衡。n个关节的驱动力(或力矩)组成的n维矢量称为关节力矢量预备知识操作器的静力利用虚功原理可以导出关节力矢量与相应的广义操作力矢量F之间的关系。令各关节的虚位移为qi，末端执行器相应的虚位移为D。所谓虚位移，是满足机械系统几何约束的无限小位移。各关节所作的虚功之和WTq与末端执行器所作的虚功WFTDfTd+nT应该相等(总的虚功为零)，即将 代入上式可得出操作臂的力静态平衡4.5 力雅可比式中，JT(q)称为操作臂的力雅可比。它表示在静态平衡状态下，操作力向关节力映射的线性关系。上式也表示操作臂的力雅可比就是它的(运动)雅可比的转置。因此可以看出操作臂的静力传递关系与速度传递关系紧密相关。具有对偶性。操作臂的力雅可比表示在静态平衡状态下，操作力向关节力映射的线性关系。根据线性代数的有关知识，零空间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)则表示操作力能平衡的所有关节力矢量的集合。在m维操作空间中存在着相似的对偶关系。R(J(q)是N(JT(q) 在操作空间的正交补。因此，不能由关节运动产生的这些操作运动的方向恰恰正是不需要关节力矩来平衡的操作力的方向。反之，若外力作用的方向是沿着末端执行器能够运动的方向，则外力完全可以由关节力(矩)来平衡。当雅可比J(q)退化时，操作臂处于奇异形位，零空间N(JT(q)不只包含0，因而外力可能承受在操作臂机构本身上。利用瞬时运动和静力的对偶关系，可以从瞬时运动关系推导出相应的静力关系。由式(4.18)可以导出两坐标系A和B之间广义操作力的坐标变换关系例：双连杆平面机器人 (p48, 55-56)：双连杆操作器4.5 雅可比的奇异性和灵巧度一、雅可比的奇异性操作臂的雅可比依赖于形位q，关节空间的奇异形位q定义为操作臂6n的雅可比的秩不是满秩的这些关节矢量q，即满足相应的操作空间中的点xx(q)为工作空间的奇异点。在奇异形位处，操作臂丧失一个或多个操作自由度。粗略地讲，机器人的奇异形位分为两类： (1)边界奇异形位； (2)内部奇异形位。二、速度反解机器人在执行某一特定任务时，所需抓手独立运动参数的数目m随任务的性质而异，最多为6，有些则小于6，例如弧焊、喷漆等有对称轴线，独立运动参数是5个；带球形测头的机器人需要3个独立运动参数；用于圆柱铣刀加工的需要4个独立运动参数。用于端铣刀的需要4个独立运动参数，用于平面作业的机器人需要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是方阵，且非奇异，求逆运算对于冗余度机器人，其雅可比的列数多于行数即nm。当J(q)是满秩的时，冗余度为dim(N(J(q) = nm 0其运动方程(4.2)的速度反解不唯一，解集合所包含的任意参数的数目等于冗余度dim(N(J(q) 。其通解可表示为式中， 是方程(4.2)的一特解; 是J(q)零空间的任意矢量，k是任意常数.冗余度机器人对于避免碰撞，避开奇异状态，增加操作臂的灵巧性，改善动态性能会带来好处。若 其中 是J的广义逆操作臂雅可比的奇异性定性地描述了操作臂的运动灵巧性和运动性能。为了定量分析操作臂的灵巧性和速度反解的精度，提出了许多度量指标。所有这些指标在概念上都与雅可比的奇异值有关。根据矩阵的奇异值分解理论，对操作臂在任意形位的雅可比J(q)进行奇异值分解，即式中， 为正交矩阵，而式中，1 2 m0为J的奇异值。三、雅可比矩阵的奇异值分解三、雅可比矩阵的奇异值分解1.条件数条件数四、灵巧性度量指标四、灵巧性度量指标最大奇异值最大奇异值最小奇异值最小奇异值2. 最小奇异值最小奇异值操作臂形位具有各向同性操作臂终端对于关节运动的响应越快。3可操作性可操作性(可操作度可操作度)小节小节计算雅克比计算雅克比速度映射速度映射力映射力映射作业： 4.4, 4.5, 4.154.7 刚度和变形刚度和变形机械臂在外力作用下发生变形，与操作臂刚度和作用力矢量有关。刚度是影响动态特性和定位精度的主要因素。主要来源：连杆变形、连杆支撑和关节驱动装置。机器人关节变形的一个直接影响是引起末端的静态变形误差。在机器人的自重和外部负载的作用下，各关节会发生相应的变形，而这种变形又会累积到机器人的末端。对串联机器人，这种作用尤为明显。对于绝大多数工业机器人，连杆臂的刚度足够大，机器人的弹性变形主要体现在组成关节的传动部件上。关节变形主要是由传动件产生，如谐波齿轮，齿轮箱，传动带，长转轴。连杆变形则主要是机械臂的结构刚度不足引起的。转子扭簧模型操作刚度建模操作刚度建模为操作柔度矩阵为操作刚度矩阵在关节处附加一个弹簧，其弹性系数为k。称k为关节刚度，称k的倒数c为关节柔度。 设各关节刚度为kqi，在外力F的作用下，末端的变形为X，各关节的弹性变形为dqi。模态分析结果4.8 误差标定和补偿误差标定和补偿要对机器人位姿和轨迹误差进行补偿，其基础是对机器人位姿误差进行分析研究，而位姿误差分析的关键之一就是建立位姿误差模型。2024/9/21196误差源分析误差源分析误差源：温度、振动、电压波动、空气湿度与污染、操作者干预等；几何参数误差、受力变形、热变形、摩擦力、振动等 。几何参数误差 ：占总误差80以上关节变量误差固定参数误差影响因素：杆件加工精度；装配误差；相邻轴线间的平行度和垂直度； 角度光学编码器的零位与名义模型中关节旋转零位不重合而产生的零位偏置误差。在机器人机构杆件上设置DH坐标系。机器人杆件DH坐标系D-H表示方法通常把各误差因素作为各相应变量的微小量，通过适当的参数变量处理，推导出机器人手部位姿误差模型。当相邻轴平行时，不符合“小误差模型”条件，手部的微小位姿误差不能由D-H参数微小误差进行建模。引入新的误差参数，建立误差模型。2024/9/21199 MDH修正模型：Puma560机器人的第二轴和三轴为平行轴，D-H模型不具备参数连续性，参数跳变造成误差模型不准确，增加了一个新的绕y轴的转向误差参数。 末端执行器中心位置：在法兰盘上安装一末端执行器（根据实验需要选择），只考虑末端中心位置坐标，则位置坐标方程为：采用微分变换得到机器人的误差标定模型为：2024/9/21202观测方程误差向量观测矢量机器人位姿误差建模当B的列线性独立时，x的最小二乘解为：为运动参数误差的近似解。