第6讲机器人控制2.

第6讲机器人控制6.1机器人控制系统的特点6.2运动控制中的基本概念6.3机器人控制系统的主要功能6.4机器人的控制方式6.5机器人的运动控制技术6.1机器人控制系统的特点运动控制是物体在空间、时间中的位置、速度、加速度和力的控制技术。机器人是运动控制的典型代表。机器人与传统机械有着很大的差异，主要表现：速度高精度高控制范围广（一般速度控制比要求在1：10000以上。）传统的、有效的单自由度机构的控制技术已远远不能满足机器人这样的特别对象。新的运动控制思想即在这种背景之下被提出。6.1工业机器人控制系统的特点不仅高速运动中突然停止时的位置精度要求高，而且还要求高精度地跟踪时变的速度与空间轨迹，对加速度和力也要进行高精度的控制。机构多为开式串联结构，因此刚性差且具有多个固有振动频带。与1kHz以上的单体机械和300Hz左右的机床相比，关节式多自由度机器人的机构共振频率多在5—30Hz范围内，航天机器人仅在1Hz以下并伴有强烈的高频过渡振荡现象。负载以及各构件对各个回转轴的转动惯量，随机器人的位形而变，其变化幅度很大，一般可达4—8倍。摩擦、传动间隙、检测精度等对机器人的高速、高精度的运动制约严重。机器人控制上的特殊要求6.1机器人控制系统的特点机器人的结构是一个空间开链机构,需要多关节的运动协调。因此,其控制系统与普通的控制系统相比要复杂得多,具体有如下特点:(1)机器人的控制与机构运动学及动力学密切相关。经常要求正向运动学和反向运动学的解,还要考虑惯性力、外力(包括重力)、哥氏力及向心力的影响。(2)简单机器人至少要有3～5个自由度,比较复杂的机器人有十几个甚至几十个自由度。每个自由度包含一个伺服机构,它们必须协调组成一个多变量控制系统。(3)机器人的协调控制以及“智能”,只能由计算机来完成。因此,机器人控制系统必须是一个计算机控制系统。(4)描述机器人状态和运动的数学模型是一个非线性模型,随着状态的变化,参数也在变化,变量间存在耦合。因此还要利用速度甚至加速度闭环。(5)机器人的动作往往可以通过不同的方式和路径来完成,因此存在一个“最优”的问题。根据传感器和模式识别的方法获得的工况,自动选择最佳的控制规律。精度、分辨率与位置重复精度位置与轨迹点位(PTP)与连续(CP)控制多轴协调控制T／P方式工业机器人的基本控制思想6.2运动控制中的基本概念精度常常容易和分辨率、位置重复精度相混淆。实际是三个不同的概念。精度、分辨率与位置重复精度机器人的分辨率是由系统设计参数所决定，并受到位置反馈检测单元性能的影响。分辨率又分为编程分辨率与控制分辨率。当编程分辨率与控制分辨率相等时，系统性能达到最高。上述两个分辨率统称系统分辨率。分辨率编程分辨率是指程序中可以设定的最小距离单位，又称基准分辨率。例如：当电机旋转0.1度，机器人腕点(手臂尖端点)移动的直线距离为0.01mm时，其基准分辨率为0．01mm。编程分辨率控制分辨率是位置反馈回路能够检测到的最小位移量例如：若每周(转)1000个脉冲的增量方式的光码盘与电机同轴安装的话，则电机每旋转0.36度(360度／1000rpm)，光码盘就发出一个脉冲，因此，0.36度以下的角度变化无法检测，该系统的控制分辨率为0.36度。控制分辨率机器人的最终精度主要依存于机械误差、控制算法与系统分辨率。精度机械误差主要产生于传动误差、关节间隙与联杆机构的挠性。传动误差是由轮齿误差、螺距误差等;关节间隙是关节处轴承间隙、谐波齿隙等;连杆的挠性，随机器人的位形、负载的变化而变化。精度—机械误差控制算法误差，主要指能否得到直接解的算法和算法在计算机内的运算字长所造成的“bit”(比特)误差。因为16位以上CPU可达到82位以上浮点运算，所以“bit”误差与机构误差相比，基本可以忽略不计。精度—控制算法误差分辨率的系统误差可取1/2基准分辨率。理由是基准分辨率以下的变位我们既无法编程又无法检测，故误差的平均值可取1/2基准分辨率。机器人的精度＝1/2基准分辨率十机构误差。如果做到使机构的综合误差达到1/2基准分辨率，则精度＝分辨率。精度—系统分辨率位置重复精度是关于精度的统计数据。位置重复精度不受负载变化的影响；通常用位置重复精度这一指标作为示教／再现方式工业机器人水平的重要精度指标。位置重复精度位置重复精度R=0.1mm位置重复精度=±0.1mm精度与位置重复精度的关系机型与精度等的关系直角坐标形机器人其直线距离可表示为：222zyxL精度可以很高设回转轴分辨率为α时，则腕点分辨率为αr例如：回转轴的位置检测单元采用6000P／周的增量方式光码盘与电机同轴联接，水平腕最长为1m的话，则腕点位置分辨率是最坏的情况，圆柱坐标形机器人其分辨率不定，随r的变化而变化mmr05.1180/100006.006.06000/360例如：3个1000P／周增量式光码盘，一个装在与螺距为10mm的滚珠丝杠同轴驱动伸缩臂的电机轴上，2个安装在通过1：22速比的减速器驱动2个旋转轴的电机上，腕的臂长为500mm。此时，3个轴的分辨率分别为：极坐标机器人手腕长度的变化，将造成3个轴中的2个轴分辨率的下降伸缩轴：10/1000=0.01mm旋转轴：(1/22)x(360/1000)x500xπ/180=0.14mm机器人的精度将由各个回转关节的误差之和来决定关节形机器人精度最差。由于它占地面积最小，而动作范围最大，空间速度快，灵活，通用性好等优点，而成为机器人发展的主流。多关节机器人机器人的精度将由各个回转关节的误差之和来决定点位(PTP)与连续(CP)控制过去是数控机床中的技术用语，而现在用其表达机器人的控制功能，含意是不大相同的，主要区别在于：1)机器人中的“PTP”可以是1-5各种动作,而数控机床是指图3—10中的⑤那样的动作，即直线插补运动(也是两点之间的最短距离的控制运动)。2)数控机床中的CP控制，一般是“全路径指定”的控制方式，而机器人中的CP控制通常是“多点指定”控制方式。点位(PTP)与连续(CP)控制点位(PTP)与连续(CP)控制llNyxlyyyxxxiiii/2211分时控制同时控制多轴协调控制6.3工业机器人控制系统的主要功能1.2.运动控制功能6.3.11.1)示教的方式总的可分为集中示教方式和分离示教方式。集中示教方式就是指同时对位置、速度、操作顺序等进行的示教方式。分离示教方式是指在示教位置之后,再一边动作,一边分别示教位置、速度、操作顺序等的示教方式。示教方式中经常会遇到一些数据的编辑问题,其编辑机能有如图5.1所示的几种方法。在图中,要连接A与B两点时,可以这样来做:(a)直接连接;(b)先在A与B之间指定一点x,然后用圆弧连接;(c)用指定半径的圆弧连接;(d)用平行移动的方式连接。图5.1示教数据的编辑机能当对PTP(点位控制方式)控制的工业机器人示教时,可以分步编制程序,且能进行编辑、修改等工作。但是在作曲线运动而且位置精度要求较高时,示教点数一多,示教时间就会拉长,且在每一个示教点都要停止和启动,因而很难进行速度的控制。图5.2CP控制示教举例对需要控制连续轨迹的喷漆、电弧焊等工业机器人进行连续轨迹控制的示教时,示教操作一旦开始,就不能中途停止,必须不中断地进行到完,且在示教途中很难进行局部修正.在CP(连续轨迹控制方式)控制的示教中,由于CP控制的示教是多轴同时动作,因此与PTP控制不同,它几乎必须在点与点之间的连线上移动,故有如图5.2所示的两种方法。2)工业机器人的记忆方式随着示教方式的不同而不同。又由于记忆内容的不同,故其所用的记忆装置也不完全相同。通常,工业机器人操作过程的复杂程序取决于记忆装置的容量。容量越大,其记忆的点数就越多,操作的动作就越多,工作任务就越复杂。2.示教编程方式1)手把手示教编程方式主要用于喷漆、弧焊等要求实现连续轨迹控制的工业机器人示教编程中。具体的方法是人工利用示教手柄引导末端执行器经过所要求的位置,同时由传感器检测出工业机器人各关节处的坐标值,并由控制系统记录、存储下这些数据信息。实际工作当中,工业机器人的控制系统重复再现示教过的轨迹和操作技能。手把手示教编程也能实现点位控制,与CP控制不同的是,它只记录各轨迹程序移动的两端点位置,轨迹的运动速度则按各轨迹程序段对应的功能数据输入。2)示教盒示教编程方式是人工利用示教盒上所具有的各种功能的按钮来驱动工业机器人的各关节轴,按作业所需要的顺序单轴运动或多关节协调运动,从而完成位置和功能的示教编程。示教盒通常是一个带有微处理器的、可随意移动的小键盘,内部ROM中固化有键盘扫描和分析程序。其功能键一般具有回零、示教方式、自动方式和参数方式等。示教编程控制由于其编程方便、装置简单等优点,在工业机器人的初期得到较多的应用。同时,又由于其编程精度不高、程序修改困难、示教人员要熟练等缺点的限制,促使人们又开发了许多新的控制方式和装置,以使工业机器人能更好更快地完成作业任务。6.2.2工业机器人的运动控制是指工业机器人的末端执行器从一点移动到另一点的过程中,对其位置、速度和加速度的控制。由于工业机器人末端操作器的位置和姿态是由各关节的运动引起的,因此,对其运动控制实际上是通过控制关节运动实现的。工业机器人关节运动控制一般可分为两步进行。第一步是关节运动伺服指令的生成,即指将末端执行器在工作空间的位置和姿态的运动转化为由关节变量表示的时间序列或表示为关节变量随时间变化的函数。这一步一般可离线完成。第二步是关节运动的伺服控制,即跟踪执行第一步所生成的关节变量伺服指令。这一步是在线完成的。6.4工业机器人的控制方式6.4.1点位控制方式(PTP)这种控制方式的特点是只控制工业机器人末端执行器在作业空间中某些规定的离散点上的位姿。控制时只要求工业机器人快速、准确地实现相邻各点之间的运动,而对达到目标点的运动轨迹则不作任何规定。这种控制方式的主要技术指标是定位精度和运动所需的时间。由于其控制方式易于实现、定位精度要求不高的特点,因而常被应用在上下料、搬运、点焊和在电路板上安插元件等只要求目标点处保持末端执行器位姿准确的作业中。一般来说,这种方式比较简单,但是,要达到2～3μm的定位精度是相当困难的。6.4.2连续轨迹控制方式(CP)这种控制方式的特点是连续地控制工业机器人末端执行器在作业空间中的位姿,要求其严格按照预定的轨迹和速度在一定的精度范围内运动,而且速度可控,轨迹光滑，运动平稳,以完成作业任务。工业机器人各关节连续、同步地进行相应的运动,其末端执行器即可形成连续的轨迹。这种控制方式的主要技术指标是工业机器人末端执行器位姿的轨迹跟踪精度及平稳性。通常弧焊、喷漆、去毛边和检测作业机器人都采用这种控制方式。图5.3点位控制与连续轨迹控制(a)点位控制；(b)连续轨迹控制6.4.3力(力矩)在完成装配、抓放物体等工作时,除要准确定位之外,还要求使用适度的力或力矩进行工作,这时就要利用力(力矩)伺服方式。这种方式的控制原理与位置伺服控制原理基本相同,只不过输入量和反馈量不是位置信号,而是力(力矩)信号,因此系统中必须有力(力矩)传感器。有时也利用接近、滑动等传感功能进行自适应式控制。6.4.4机器人的智能控制是通过传感器获得周围环境的知识,并根据自身内部的知识库作出相应的决策。采用智能控制技术,使机器人具有了较强的环境适应性及自学习能力。智能控制技术的发展有赖于近年来人工神经网络、基因算法、遗传算法、专家系统等人工智能的迅速发展。6.5机器人的运动控制技术6.5.1机器人控制系统的分类非伺服型控制系统控制器驱动单元操作机外界作业对象与环境开关反馈控制器驱动单元操作机外界作业对象与环境机器人控制系统的分类伺服型控制系统控制器驱动单元操作机外界作业对象与环境内部传感器外部传感器控制器驱动单元操作机外界作业对象与环境内部传感器控制系统的组成控制系统的组成控制系统的组成6.