工业机器人技术基础课件(最全)

NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—1—汇川技术2016年12月工业机器人技术基础（2）NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—2—目录1机器人位姿变换2机器人运动学3机器人坐标系4机器人动力学5机器人性能指标NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—3—在分析机器人时会牵涉诸多坐标系，一些是操作者不须关心的，另外一些却是和工艺相关的。常见的坐标系有：关节坐标系基座坐标系工具坐标系用户坐标系1机器人坐标系NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—4—关节坐标系主要描述各关节相对于标定零点的绝对位置，旋转轴常用°表示，线性轴的常用mm描述。作用：单轴点动：单轴示教机器人，常用于调试时验证关节的旋转方向、软限位；解除机器人奇异位置，当机器人出现奇异报警时，只能在关节坐标系下通过单轴点动解除奇异报警；轴正负极限报警：只能在关节坐标系下通过单轴点动解除正负超限报警；关节坐标系下的坐标值均为机器人关节的绝对位置，方便用户调试点位时观察机器人的绝对位置，避免机器人出现极限位置或奇异位置关节坐标系1机器人坐标系NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—5—工业机器人基础知识直角坐标系，包括很多种，但我们常常狭隘的将基座坐标系称为直角坐标系。直角坐标系的Z轴即第一轴的Z轴，X轴为回零后的正前方，Y轴由右手定则确定。原点随着df参数的大小上下变动。直角坐标系下，用户可控制机器人末端沿坐标系任一方向移动或旋转，常用于现场点位示教。直角坐标系机器人末端右手定则直角坐标系:1机器人坐标系NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—6—工业机器人基础知识（2）直角坐标系由于轨迹为空间插补，所以会遇到指定的位置和姿态不能到达，即奇异现象。常见的奇异有：a）4、6轴共线附件，即5轴角度0附件。b）2、3、5轴关节坐标系原点接近共线，即已经到达工作范围边界。c）5轴关节坐标系原点在Z轴正上方附近。右图就处于a）的奇异状态，直角下示教会报警。直角坐标系1机器人坐标系NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—7—工业机器人坐标系关节坐标系基坐标系两者关系？？？机器人系统1机器人坐标系NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—8—yxxyz工业机器人坐标系xyzz用户坐标系（工件坐标系）:用于描述各个物体或工位的方位的需要。用户常常在自己关心的平面建立自己的坐标系，以方便示教。作用：方便示教；基于用户坐标系的点位，方便生产线复制，减少调试工作量；离线仿真软件提取的基于定义坐标系轨迹控制点，可直接用于实际程序中，只需定义匹配的用户坐标系1机器人坐标系NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—9—工业机器人坐标系工具坐标系:在未加工具参数时，工具坐标系在机器人末端的法兰盘上，但方向与基座坐标系不同。如右上图所示。安装工具后，需加入工具参数，可以看作在机器人末端连杆的延长，此时工具坐标系为表示新的工况需向末端延长，形成新的坐标系。如右下图所示。在示教时，也可以沿着工具坐标系的X、Y、Z轴平行的方向平移，也可以末端不动绕工具坐标系的X、Y、Z轴转动。工具坐标系无工具参数1机器人坐标系NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—10—工业机器人坐标系工具坐标系:建立工具坐标系方法：直接输入法三点法（工具末端对一固定点示教三个不同姿态的点）五点法（工具末端对一固定点示教五个不同姿态的点）工具坐标系三点法五点法1机器人坐标系NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—11—zyxApppp点的位置描述机器人点的位置描述：在选定的直角坐标系{A},空间任一点P的位置可用3×1的位置矢量AP表示2机器人位姿变换NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—12—1zyxppppwcbappppzyx1如用四个数组成(4×1)列阵表示三维空间直角坐标系{A}中点p，则列阵[pxpypz1]T称为三维空间点p的齐次坐标。齐次坐标：2机器人位姿变换NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—13—TTT010000100001ZYXi、j、k分别是直角坐标系中x、y、Z坐标轴的单位向量。若用齐次坐标来描述x、y、z轴的方向，则(4×1)列阵[abco]T中第四个元素为零，且a2+b2+c2=1，则表示某轴(某矢量)的方向；(4x1)列阵[abcw]T中第四个元素不为零，则表示空间某点的位置。坐标轴方向的描述：2机器人位姿变换NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—14—动坐标系位姿的描述就是对动坐标系原点位置的描述以及对动坐标系各坐标轴方向的描述：机器人的一个连杆可以看成一个刚体。若给定了刚体上某一点的位置和该刚体在空间的姿态，则这个刚体在空间上是完全确定的。TTToaaaaoooooonnnnzyxzyxzyx刚体Q在固定坐标系OXYZ中的位置可用齐次坐标形式的一个(4×1)列阵表示为：1ooozyxp刚体的姿态可由动坐标系的坐标轴方向来表示。令n、o、a分别为X′、y′、z′坐标轴的单位方向矢量，每个单位方向矢量在固定坐标系上的分量为动坐标系各坐标轴的方向余弦，用齐次坐标形式的(4×1)列阵分别表示为：动坐标系姿态的描述：2机器人位姿变换NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—15—1000][ozzzoyyyoxxxzaonyaonxaonpaonT刚体的位姿可用下面(4×4)矩阵来描述：对刚体Q位姿的描述就是对固连于刚体Q`的坐标系O`X`Y`Z`位姿的描述。2机器人位姿变换NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—16—运动学：机器人运动学的研究对象是机器人各关节位置和机器人末端位姿之间的关系机器人运动学包含两个基本问题：1.已知机器人各关节的位置，求机器人末端的位姿；2.已知机器人末端的位姿，求机器人各关节的位置.3机器人运动学NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—17—工业机器人基础知识为什么要研究运动学：机器人的运动无非有两种：PTP(点到点)及CP(连续运动)3机器人运动学NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—18—工业机器人基础知识运动学的实用方式：位置反馈3机器人运动学NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—19—关节坐标系D-H参数：两个关节轴线沿公垂线的距离an，称为连杆长度；另一个是垂直于an的平面内两个轴线的夹角αn，称为连杆扭角，这两个参数为连杆的尺寸参数；是沿关节n轴线两个公垂线的距离，称为dn，θn是垂直于关节n轴线的平面内两个公垂线的夹角。3机器人运动学NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—20—用一个变换矩阵An来综合表示连杆坐标系之间的矩阵变换：0011112......inninTAAAA建立了各连杆坐标系后，n-1系与n系间的变换关系可以用坐标系的平移、旋转来实现。从n-1系到n系的变换，可先令以n-1系绕Zn-1轴旋转θn角，再沿Zn-1轴平移dn，然后沿Xn轴平移an，最后绕Xn轴旋转αn角，使得n-1系n系重合。上述四次变换时应注意到坐标系在每次旋转或平移后发生了变动，后一次变换都是相对于动系进行的，因此在运算中变换算子应该右乘。3机器人运动学NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—21—工业机器人基础知识关节iαnaidiθi1000θ12-90a1dfθ230a20θ3490a30θ45-900d4θ56900d5θ6100010006zzzzyyyyxxxxnnpaonpaonpaonpRT6自由度机器人运动学D-H参数表：3机器人运动学NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—22—工业机器人基础知识逆运动学计算：如何选取某个解3机器人运动学NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—23—工业机器人基础知识逆动学应注意的问题：奇异性奇异性：造成机器人运动能力缺失（缺少自由度）的特性。工具坐标系常见的奇异有：a）4、6轴共线附件，即5轴角度0附件。b）2、3、5轴关节坐标系原点接近共线，即已经到达工作范围边界。c）5轴关节坐标系原点在Z轴正上方附近。3机器人运动学NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—24—定义：动力学(dynamics)是研究作用于物体的力和物体运动之间的一般关系，它包括两个基本问题1).已知作用在机器人各关节的力，求该关节对应的运动轨迹，即求加速度，速度和位置；2).已知机器人关节当前的加速度，速度和位置，求此时关节上的受力大小。动力学标准方程：fqGqsignFqFqqqCqqCqqBsv)()(),()()(21简单讲，动力学是解决机器人各关节受力大小和它运动之间的关系已知运动的特性能够求出对应的力的大小，反之，已知受力的大小，可以计算出机器人的运动特性。4机器人动力学NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—25—工业机器人基础知识动力学——应用1).机器人最优控制：优化性能指标和动态性能、调整伺服增益*；2).机器人的优化设计：算出实现预定运动所需的力/力矩，选择合适的伺服及电机*；3).机器人碰撞检测：比较实际电流和计算的预定电流之差，判定撞击是否发生*；4).机器人零力控制：机器人顺应外力作用运动，其仿佛处于一个不受重力和摩擦力的环境（ing）；5).机器人的仿真：根据连杆质量、负载、传动特征的动态性能仿真,较之运动学仿真更接近真实情况*。4机器人动力学NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—26—工业机器人基础知识动力学模型的计算：动力学的计算有很多方法，如Lagrange、Newton-Euler、Gauss、Kane、Screw、Roberson-Wittenburg。其中以Lagrange、Newton-Euler最为常用。第一关节动力学方程第二关节动力学方程4机器人动力学NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—27—工业机器人基础知识动力学——动力学的部署将经（正向，逆向？）动力学计算出的力矩，以前馈的方式，加入到伺服的电流控制环路4机器人动力学NeverStopImproving变频器|PLC|HMI|伺服驱动器|电机|大传动|新能源—28—工业机器人基础知识动力学——动力学控制器的评价指标控制性