第5章机器人控制资料

《第5章机器人控制资料》由会员分享，可在线阅读，更多相关《第5章机器人控制资料（59页珍藏版）》请在金锄头文库上搜索。

1、第5章 工业机器人控制,5.1 工业机器人控制系统的特点 5.2 运动控制中的基本概念 5.3 工业机器人控制系统的主要功能 5.4 工业机器人的控制方式 5.5 工业机器人的运动控制技术,5.1 工业机器人控制系统的特点,运动控制是物体在空间、时间中的位置、速度、加速度和力的控制技术。 机器人是运动控制的典型代表。 工业机器人与传统机械有着很大的差异，主要表现： 速度高 精度高 控制范围广（一般速度控制比要求在1：10000以上。） 传统的、有效的单自由度机构的控制技术已远远不能满足机器人这样的特别对象。新的运动控制思想即在这种背景之下被提出。,5.1 工业机器人控制系统的特点,不仅高速运动

2、中突然停止时的位置精度要求高，而且还要求高精度地跟踪时变的速度与空间轨迹，对加速度和力也要进行高精度的控制。 机构多为开式串联结构，因此刚性差且具有多个固有振动频带。与1kHz以上的单体机械和300Hz左右的机床相比，关节式多自由度机器人的机构共振频率多在530Hz范围内，航天机器人仅在1Hz以下并伴有强烈的高频过渡振荡现象。 负载以及各构件对各个回转轴的转动惯量，随机器人的位形而变，其变化幅度很大，一般可达48倍。 摩擦、传动间隙、检测精度等对机器人的高速、高精度的运动制约严重。,机器人控制上的特殊要求,5.1 工业机器人控制系统的特点,机器人的结构是一个空间开链机构, 需要多关节的运动协调

3、。 因此, 其控制系统与普通的控制系统相比要复杂得多,具体有如下特点: (1) 机器人的控制与机构运动学及动力学密切相关。 经常要求正向运动学和反向运动学的解, 还要考虑惯性力、 外力(包括重力)、哥氏力及向心力的影响。 (2) 简单机器人至少要有35个自由度, 比较复杂的机器人有十几个甚至几十个自由度。 每个自由度包含一个伺服机构, 它们必须协调 组成一个多变量控制系统。 (3) 机器人的协调控制以及“智能”, 只能由计算机来完成。 因此, 机器人控制系统必须是一个计算机控制系统。 (4) 描述机器人状态和运动的数学模型是一个非线性模型, 随着状态的变化,参数也在变化, 变量间存在耦合。因此

4、还要利用速度甚至加速度闭环。 (5) 机器人的动作往往可以通过不同的方式和路径来完成, 因此存在一个“最优”的问题。 根据传感器和模式识别的方法获得的工况, 自动选择最佳的控制规律。,精度、分辨率与位置重复精度 位置与轨迹 点位(PTP)与连续(CP)控制 多轴协调控制 TP方式工业机器人的基本控制思想,5.2 运动控制中的基本概念,精度常常容易和分辨率、位置重复精度相混淆。 实际是三个不同的概念。,精度、分辨率与位置重复精度,机器人的分辨率是由系统设计参数所决定，并受到位置反馈检测单元性能的影响。 分辨率又分为编程分辨率与控制分辨率。 当编程分辨率与控制分辨率相等时，系统性能达到最高。上述两

5、个分辨率统称系统分辨率。,分辨率,编程分辨率是指程序中可以设定的最小距离单位，又称基准分辨率。 例如：当电机旋转0.1度，机器人腕点(手臂尖端点)移动的直线距离为0.01mm时，其基准分辨率为001mm。,编程分辨率,控制分辨率是位置反馈回路能够检测到的最小位移量 例如：若每周(转)1000个脉冲的增量方式的光码盘与电机同轴安装的话，则电机每旋转0.36度(360度1000rpm)，光码盘就发出一个脉冲，因此，0.36度以下的角度变化无法检测，该系统的控制分辨率为0.36度。,控制分辨率,机器人的最终精度主要依存于机械误差、控制算法与系统分辨率。,精 度,机械误差主要产生于传动误差、关节间隙与

6、联杆机构的挠性。 传动误差是由轮齿误差、螺距误差等; 关节间隙是关节处轴承间隙、谐波齿隙等; 连杆的挠性，随机器人的位形、负载的变化而变化。,精度机械误差,控制算法误差，主要指能否得到直接解的算法和算法在计算机内的运算字长所造成的“bit”(比特)误差。 因为16位以上CPU可达到82位以上浮点运算，所以“bit”误差与机构误差相比，基本可以忽略不计。,精度控制算法误差,分辨率的系统误差可取1/2基准分辨率。 理由是基准分辨率以下的变位我们既无法编程又无法检测，故误差的平均值可取1/2基准分辨率。 机器人的精度1/2基准分辨率十机构误差。 如果做到使机构的综合误差达到1/2基准分辨率，则精度分

7、辨率。,精度系统分辨率,位置重复精度是关于精度的统计数据。 位置重复精度不受负载变化的影响； 通常用位置重复精度这一指标作为示教再现方式工业机器人水平的重要精度指标。,位置重复精度,位置重复精度,位置重复精度=0.1mm,精度与位置重复精度的关系,机型与精度等的关系,直角坐标形机器人,其直线距离可表示为：,精度可以很高,设回转轴分辨率为时，则腕点分辨率为r 例如：回转轴的位置检测单元采用6000P周的增量方式光码盘与电机同轴联接，水平腕最长为1m的话，则腕点位置分辨率是最坏的情况，,圆柱坐标形机器人,其分辨率不定，随r的变化而变化,例如：3个1000P周增量式光码盘，一个装在与螺距为10mm的

8、滚珠丝杠同轴驱动伸缩臂的电机轴上，2个安装在通过1：22速比的减速器驱动2个旋转轴的电机上，腕的臂长为500mm。此时，3个轴的分辨率分别为：,极坐标机器人,手腕长度的变化，将造成3个轴中的2个轴分辨率的下降,伸缩轴：10/1000=0.01mm 旋转轴：(1/22)x(360/1000)x500x/180=0.14mm,机器人的精度将由各个回转关节的误差之和来决定 关节形机器人精度最差。 由于它占地面积最小，而动作范围最大，空间速度快，灵活，通用性好等优点，而成为机器人发展的主流。,多关节机器人,机器人的精度将由各个回转关节的误差之和来决定,1个脉冲正好对应各个动作轴的位置分辨率，因此，1个

9、脉冲与对应动作轴的最小位移量是等价的。 例如：当某个回转轴的分辨率为0.05度时，3.05度则可用3.05/0.0561个脉冲来表示。如果是8bit CPU，则计算机内部的表现为：00llll0l。 如果是16bit CPU的计算机控制系统，则可以表示21665536个位置 例如：在分辨率为01mm时，这个值最大表示65536mm或土32768mm的位移量，这就是位置(或称位移)脉冲与分辨率的关系。,位置与轨迹,分辨率越高，曲线精度越好。 分辨率越高，对计算机的要求也就越高。 例如：如果分辨率为0.1mm，对6自由度机器人来讲，要完成1000mm弧长的空间曲线，则至少需要以下内存容量： 6自由

10、度2B(字节)10000点120kB 曲线再稍微复杂一点，计算机容量就不够了。因此，有必要在计算机控制系统的体系结构与控制算法上想办法解决。,位置与轨迹,点位(PTP)与连续(CP)控制,过去是数控机床中的技术用语，而现在用其表达机器人的控制功能，含意是不大相同的，主要区别在于： 1) 机器人中的“PTP”可以是1-5各种动作,而数控机床是指图310中的那样的动作，即直线插补运动(也是两点之间的最短距离的控制运动)。 2) 数控机床中的CP控制，一般是“全路径指定”的控制方式，而机器人中的CP控制通常是“多点指定” 控制方式。,点位(PTP)与连续(CP)控制,点位(PTP)与连续(CP)控制

11、,分时控制,同时控制,多轴协调控制,5.3 工业机器人控制系统的主要功能,1. 示教再现功能 2. 运动控制功能,5.3.1 示教再现控制 1. 示教及记忆方式 1) 示教的方式 示教的方式总的可分为集中示教方式和分离示教方式。 集中示教方式就是指同时对位置、速度、操作顺序等进行的示教方式。 分离示教方式是指在示教位置之后, 再一边动作, 一边分别示教位置、 速度、 操作顺序等的示教方式。 ,示教方式中经常会遇到一些数据的编辑问题, 其编辑机能有如图5.1所示的几种方法。 在图中, 要连接A与B两点时, 可以这样来做: (a) 直接连接; (b) 先在A与B之间指定一点x, 然后用圆弧连接;

12、(c) 用指定半径的圆弧连接; (d) 用平行移动的方式连接。,图 5.1 示教数据的编辑机能,当对PTP(点位控制方式)控制的工业机器人示教时, 可以分步编制程序,且能进行编辑、修改等工作。但是在作曲线运动而且位置精度要求较高时,示教点数一多,示教时间就会拉长, 且在每一个示教点都要停止和启动, 因而很难进行速度的控制。,图 5.2CP控制示教举例,对需要控制连续轨迹的喷漆、电弧焊等工业机器人进行连续轨迹控制的示教时, 示教操作一旦开始, 就不能中途停止, 必须不中断地进行到完, 且在示教途中很难进行局部修正. 在CP(连续轨迹控制方式)控制的示教中, 由于CP控制的示教是多轴同时动作, 因

13、此与PTP控制不同,它几乎必须在点与点之间的连线上移动, 故有如图5.2所示的两种方法。,2) 记忆的方式 工业机器人的记忆方式随着示教方式的不同而不同。又由于记忆内容的不同, 故其所用的记忆装置也不完全相同。通常, 工业机器人操作过程的复杂程序取决于记忆装置的容量。容量越大, 其记忆的点数就越多, 操作的动作就越多, 工作任务就越复杂。 ,2. 示教编程方式 1) 手把手示教编程 手把手示教编程方式主要用于喷漆、弧焊等要求实现连续轨迹控制的工业机器人示教编程中。具体的方法是人工利用示教手柄引导末端执行器经过所要求的位置,同时由传感器检测出工业机器人各关节处的坐标值,并由控制系统记录、存储下这

14、些数据信息。实际工作当中, 工业机器人的控制系统重复再现示教过的轨迹和操作技能。 手把手示教编程也能实现点位控制,与CP控制不同的是, 它只记录各轨迹程序移动的两端点位置, 轨迹的运动速度则按各轨迹程序段对应的功能数据输入。,2) 示教盒示教编程 示教盒示教编程方式是人工利用示教盒上所具有的各种功能的按钮来驱动工业机器人的各关节轴, 按作业所需要的顺序单轴运动或多关节协调运动, 从而完成位置和功能的示教编程。 示教盒通常是一个带有微处理器的、可随意移动的小键盘, 内部ROM中固化有键盘扫描和分析程序。其功能键一般具有回零、示教方式、自动方式和参数方式等。 示教编程控制由于其编程方便、装置简单等

15、优点,在工业机器人的初期得到较多的应用。同时, 又由于其编程精度不高、 程序修改困难、示教人员要熟练等缺点的限制,促使人们又开发了许多新的控制方式和装置, 以使工业机器人能更好更快地完成作业任务。,5.2.2 工业机器人的运动控制 工业机器人的运动控制是指工业机器人的末端执行器从一点移动到另一点的过程中, 对其位置、速度和加速度的控制。 由于工业机器人末端操作器的位置和姿态是由各关节的运动引起的,因此,对其运动控制实际上是通过控制关节运动实现的。 工业机器人关节运动控制一般可分为两步进行。第一步是关节运动伺服指令的生成, 即指将末端执行器在工作空间的位置和姿态的运动转化为由关节变量表示的时间序

16、列或表示为关节变量随时间变化的函数。这一步一般可离线完成。第二步是关节运动的伺服控制,即跟踪执行第一步所生成的关节变量伺服指令。 这一步是在线完成的。,5.4 工业机器人的控制方式,5.4.1 点位控制方式(PTP) 这种控制方式的特点是只控制工业机器人末端执行器在作业空间中某些规定的离散点上的位姿。控制时只要求工业机器人快速、 准确地实现相邻各点之间的运动,而对达到目标点的运动轨迹则不作任何规定。这种控制方式的主要技术指标是定位精度和运动所需的时间。由于其控制方式易于实现、定位精度要求不高的特点, 因而常被应用在上下料、搬运、点焊和在电路板上安插元件等只要求目标点处保持末端执行器位姿准确的作业中。一般来说, 这种方式比较简单, 但是, 要达到23m的定位精度是相当困难的。,5.4.2 连续轨迹控制方式(CP) 这种控制方式的特点是连续地控制工业机器人末端执行器在作业空间中的位姿, 要求其严格按照预定的轨迹和速度在一定的精度范围内运动, 而且速度可控, 轨