机器人技术第3讲.ppt

1、2020/8/21,1,2-8 杆件坐标系的建立,1 手部姿态和位置的表示,手部姿态可用33矩阵表示：,图中， 定义为接近矢量， 定义为姿态矢量， 定义为法向矢量,手部的位置可以用从基准参考系原点指向手部中心的矢量 来表示,2020/8/21,2,2-8 杆件坐标系的建立,手部的位姿可以用4X4矩阵表示,2确定杆系的DH法 机器人运动学的重点是研究手部的位姿和运动，而手部位姿是与机器人各杆件的尺寸、运动副类型及杆间的相互关系直接相关连的，因此要研究手部相对于机座的几何关系，必须先分析两相邻杆件的相互关系，为此要先确定杆件坐标系。,2020/8/21,3,2-8 杆件坐标系的建立,任何一个连杆，

2、如图中的连杆n，两端有关节n和nl，该连杆可以用两个量来描述，一个是两个关节轴线沿公垂线的距离an，称作连杆长度，另一个是在垂直于an的平面内两个轴线的夹角 ，称之为连杆扭角。这两个参数为连杆本身的参数。,2确定杆系的DH法,2020/8/21,4,2-8 杆件坐标系的建立,考虑杆n与其相邻连杆n1的关系，它们通过关节n相连，其相对位置可用两个参数dn和 来确定，其中dn是沿关节n的轴线两个公垂线的距离， 是垂直于关节n轴线的平面内两个公垂线的夹角。这是表达相邻杆件相互关系的两个参数。,2确定杆系的DH法,2020/8/21,5,2-8 杆件坐标系的建立,建立杆件坐标系 按DenavitHar

3、tenberg的方法，n系的坐标原点设在关节n的轴线和关节n1的轴线的公垂线与关节nl的轴线相交之处，n系的Z轴与关节n1的轴线重合，X与上述公垂线重合，且方向从关节n指向关节nl。当关节是转动关节时， 成为关节变量，若关节为移动关节，dn成为关节变量。当n1系的Xn1轴与n系的X轴平行且方向相同时，定义 。,简言之，按DH法确定杆件坐标系，可取坐标系n的Z轴与关节n l的轴线重合， X轴取为相邻Z轴的公垂线，Y轴则按右手系确定。,2020/8/21,6,2-8 杆件坐标系的建立,3杆件坐标系之间的变换矩阵 在用DH法建立了各杆件坐标系后，n-1系与n系间的变换关系可以用坐标系的平移、旋转来实

4、现。考虑从n-1系到n系的变换，可先令n-1系绕Zn1轴旋转 角，再沿Zn1轴平移dn，然后沿Xn轴移动an，最后绕Xn轴旋转 角，使n-1系与n系重合。用变换矩阵表示，则有,2020/8/21,7,2-8 杆件坐标系的建立,（240）,在很多机器人设计时， 或90度，dn0或an0，从而可以简化矩阵计算和控制,2020/8/21,8,2-9 正向运动学,正向运动学主要解决机器人运动方程的建立及手部位姿的求解问题。,机器人机构可以认为是一系列杆件由关节连接起来，我们把描述一个杆件与下一个杆件之间关系的齐次变换阵记为A阵，A1描述第一个杆系相对于固定系的位姿，A2描述第二个杆系相对于第一个杆系的

5、位姿，而第二个杆系相对于固定系的位姿可用A1A2表示，令其等于T2，即T2A1A2，第三个杆系对固定系有T3A1A2A3，如此类推，对六杆机器人，有T6A1A2A3A4A5A6，这里T6表示了手部的位姿，而方程（241）表示了从固定系到手部的各坐标系之间的变换矩阵与手部位姿的关系，我们称之为机器人的运动方程,2020/8/21,9,2-9 正向运动学,(2-41),(2-42),2020/8/21,10,2-9 正向运动学,1斯坦福机器人的运动方程 斯坦福机器人是6自由度RRPRRR型机器人，其外形如下图所示，首先建立各杆件坐标系，注意各系Z轴沿转动轴线的方向，X轴沿公垂线方向，n系的原点设在

6、n轴n1轴公垂线与n1轴交点处，O系的位置可任选，各杆参数见表21，各杆系见图217。现在根据各杆系的关系写出A阵。,2020/8/21,11,2020/8/21,12,2-5 正向运动学,2020/8/21,13,2-9 正向运动学,1系与0系为旋转关节，见图a,(2-43),2系与1系为旋转关节，杆长为d2，见图b,(2-44),2020/8/21,14,2-9 正向运动学,3系与2系为移动关节，移动行程为d3，见图c,(2-45),4系与3系为旋转关节，见图d,(2-46),2020/8/21,15,2-9 正向运动学,5系与4系为旋转关节，见图e,(2-47),6系与5系为旋转关节，见

7、图f,(2-48),A全部建立，要知道非相邻杆件之间的关系，就用相应的A阵连乘即可,2020/8/21,16,2-9 正向运动学,以上方程均为 和d的函数，当 和d给出后，即可计算出手部的位置 和方向 这些值就是手部位姿的解。这个求解过程就是正向求解 或直接求解,（2-49）,2020/8/21,17,2-9 正向运动学,肘状机器人的运动方程 6R肘状机器人的外形如图所示，按DH法建立杆系，可以直接写出各A阵,2020/8/21,18,2-9 正向运动学,(2-50),(2-51),2020/8/21,19,2-9 正向运动学,(2-52),(2-53),2020/8/21,20,2-9 正向

8、运动学,(2-54),(2-55),2020/8/21,21,2-9 正向运动学,反映手部与固定系关系的运动方程为：,(2-56),以上从固定系出发，通过杆件尺寸及相互位置关系，逐一确定各杆件位姿，最后求取手部位姿，这就是机器人的正向运动学求解,2020/8/21,22,2-10 反向运动学,已知 、d求出手部位姿，这一求解过程比较容易，将各变量代入运动方程即可得出。在机器人控制和轨迹规划中，问题正好相反，即已知手部要达到的空间位姿的情况下，如何求关节变量，以驱动各关节的马达，使手部的位姿得到满足，这就是逆运动学问题，也称间接位置求解问题。,1欧拉变换的解 已知欧拉变换方程：其反向求解就是已知

9、T中的各元素，求出,(2-57),以上方程最简单的办法就是两边展开，对应元素相等，即可求出欧拉角,2020/8/21,23,2-10 反向运动学,(2-58),(2-59),(2-60),(2-61),(2-62),(2-63),2020/8/21,24,2-10 反向运动学,(2-64),(2-65),(2-66),(2-67),(2-68),(2-69),(2-70),在机器人运动学中，不用反余弦而用反正切求关节角，因其可唯一确定,2020/8/21,25,2-10 反向运动学,对欧拉方程左乘,(2-71),上式左边为 和T的函数，只要找到右边等于0或常数的元素，令与左边对应项相等，即可得

10、出相应的解，对上式展开,(2-72),2020/8/21,26,2-10 反向运动学,取相应项相等，有,(2-73),(2-74),当ax、ay皆为零时，手部在x、y方向无分量，为向上或向下状态，此时令,(2-75),2020/8/21,27,2-10 反向运动学,(2-76),(2-77),(2-78),(2-79),(2-80),(2-81),2020/8/21,28,2-10 反向运动学,2 RPY变换的解 RPY变换方程为：,(2-82),(2-83),(2-84),2020/8/21,29,2-10 反向运动学,2 RPY变换的解,(2-85),(2-86),(2-87),2020/

11、8/21,30,2-10 反向运动学,3 Sph变换的解,对球坐标变换，有方程,(2-88),(2-89),(2-90),2020/8/21,31,2-10 反向运动学,3 Sph变换的解,(2-91),(2-92),2020/8/21,32,2-10 反向运动学,为了求r，对（290）左乘 展开后可得r,(2-93),这样就将 、 、r 全部求出,2020/8/21,33,2-10 反向运动学,斯坦福机器人的反向求解 斯坦福机器人的运动方程为：,(2-94),已知手部位姿T6及各杆件的结构参数a，d，求,(2-95),2020/8/21,34,2-10 反向运动学,斯坦福机器人的反向求解,(2-96),2020/8/21,35,2-10 反向运动学,斯坦福机器人的反向求解,(2-97),（297）变为,2020/8/