1、1.4 机器人正向运动学,工业机器人的正向运动学是指已知各关节的类型、相邻关节之间的尺寸和相邻关节相对运动量的大小时,如何确定工业机器人末端操作器在固定坐标系中的位姿。,主要包括以下内容:1)相对杆件的坐标系的确定;2)建立各连杆的模型矩阵A;3)正运动学算法;,D-H表示法,学习目标:1.理解D-H法原理 2.学会用D-H法对机器人建模,学习重点:1.给关节指定参考坐标系 2.制定D-H参数表 3.利用参数表计算转移矩阵,背景简介:1955年,Denavit和Hartenberg(迪纳维特和哈坦伯格)提出了这一方法,后成为表示机器人以及对机器人建模的标准方法,应用广泛。,总体思想:首先给每个
2、关节指定坐标系,然后确定从一个关节到下一个关节进行变化的步骤,这体现在两个相邻参考坐标系之间的变化,将所有变化结合起来,就确定了末端关节与基座之间的总变化,从而建立运动学方程,进一步对其求解。,1.第一个关节指定为关节n,第二个关节为n+1,其余关节以此类推。,坐标系的确定,2.Z轴确定规则:如果关节是旋转的,Z轴位于按右手规则旋转的方向,转角 为关节变量。如果关节是滑动的,Z轴为沿直线运动的方向,连杆长度d为关节变量。关节n处Z轴下标为n-1。,3.X轴确定规则情况1:两关节Z轴既不平行也不相交取两Z轴公垂线方向作为X轴方向,命名规则同Z轴。,情况2:两关节Z轴平行此时,两Z轴之间有无数条公
3、垂线,可挑选与前一关节的公垂线共线的一条公垂线。,情况3:两关节Z轴相交取两条Z轴的叉积方向作为X轴。,4.Y轴确定原则取X轴、Z轴叉积方向作为Y轴方向。(右手)5.变量选择原则用n+1角表示Xn到Xn+1绕Zn轴的旋转角;dn+1表示从Xn到Xn+1沿Zn测量的距离;an+1表示关节偏移,an+1是从Zn到Zn+1沿Xn+1测量的距离;角表示关节扭转,n+1是从Zn到Zn+1绕Xn+1旋转的角度。通常情况下,只有和d是关节变量。,斯坦福机器人,斯坦福机器人开始的两个关节是旋转的,第三个关节是滑动的,最后三个腕关节全是旋转关节,例1:Stanford机器人运动学方程,A1,A2,A3,A4,A
4、5,A6,z1,x1,y1,O1,z2,x2,y2,O2,z3,y3,x3,O3,y4,z4,x4,O4,z5,y5,x5,O5,z6,x6,y6,O6,z0,y0,x0,O0,为右手坐标系原点Oi:Ai与Ai+1关节轴线的交点zi轴:与Ai+1关节轴重合,指向任意 xi轴:Zi和Zi-1构成的面的法线yi轴:按右手定则,ai沿 xi 轴,zi-1 轴与 xi 轴交点到Oi 的距离i 绕 xi 轴,由 zi-1 转向zidi 沿 zi-1 轴,zi-1 轴和 xi 交点至Oi 1 坐标 系原点的距离i 绕 zi-1 轴,由 xi-1转向 xi,关节1坐标系0,关节2坐标系1,关节3坐标系2,连
5、杆0,连杆1,连杆2,连杆3,连杆4,连杆5,关节4坐标系3,关节5坐标系4,关节6坐标系5,解:,例2、PUMA560运动学方程(六个自由度,全部是旋转关节),PUMA560机器人的连杆及关节编号,为右手坐标系,Yi轴:按右手定则 Zi轴:与Ai+1关节轴重合,指向任意 Xi轴:Zi和Zi-1构成的面的法线,或连杆i两端轴线Ai 与Ai+1的公垂线(即:Zi和Zi-1的公垂线)原点Oi:Ai与Ai+1关节轴线的交点,或Zi与Xi的交点,ai沿 xi 轴,zi-1 轴与 xi 轴交点到Oi 的距离i 绕 xi 轴,由 zi-1 转向zidi 沿 zi-1 轴,zi-1 轴和 xi 交点至Oi
6、1 坐标 系原点的距离i 绕 zi-1 轴,由 xi-1转向 xi,A1,A2,A3,A4,A5,A6,O1,O0,对下图所示简单机器人,根据D-H法,建立必要坐标系及参数表。,例 3,第一步:根据D-H法建立坐标系的规则建立坐标系,第二步:将做好的坐标系简化为我们熟悉的线图形式,第三步:根据建立好的坐标系,确定各参数,并写入D-H参数表,第四步:将参数代入A矩阵,可得到,第5步 求出总变化矩阵,依次写出从基坐标系到手爪坐标系之间相邻两坐标系的齐次变换矩阵,它们依次连乘的结果就是末端执行器(手爪)在基坐标系中的空间描述,即,上式称为运动方程。,综上:,正解,反解,1.5 机器人的逆运动学解,给定机器人终端位姿,求各关节变量,称求机器人运动学逆解。让我们通过下面这道例题来了解一下机器人逆运动学求解的一般步骤。前面例子最后方程为:,求逆运动学方程的解,根据第3行第4列元素对应相等可得到,依次用 左乘上面两个矩阵,得到:,根据1,4元素和2,4元素,可得到:,将上面两个方程两边平方相加,并利用和差化积公式得到,已知,于是可得到:,依次类推,分别在方程2.19两边左乘A1A4的逆,可得到,接下