第5章 工业机器人控制

工业机器人技术TechnologyofIndustryRobots北京联合大学BeijingUnionUniversity章节安排2020年3月23日2第一章绪论第二章工业机器人机械系统设计第三章工业机器人运动学第四章工业机器人静力计算及动力学分析第五章工业机器人控制第六章工业机器人感觉系统第七章工业机器人轨迹规划与编程第八章工业机器人应用第五章工业机器人控制5.1机器人控制系统与控制方式5.2单关节机器人模型和控制5.3基于关节坐标的控制5.4基于作业空间的伺服控制5.5机器人末端操作器的力/力矩控制2020年3月23日35.1机器人控制系统与控制方式机器人控制的基本目的告诉机器人要做什么;机器人接受命令，并形成作业的控制策略;保证正确完成作业;通报作业完成情况。2020年3月23日4机器人的结构组成四大组成部分•执行机构•驱动单元•控制系统•智能系统2020年3月23日5执行机构执行机构是机器人完成工作任务的机械实体一般为“机械手臂+末端操作器”机械手臂manipulator：一般为由杆件机构和关节机构组成的空间开链机构常常进一步细分为机座腰部臂部肩和肘腕部末端操作器end-effector：按作业用途定（是机器人完成特定作业的关键装置）2020年3月23日6驱动单元包括驱动器、运动件和传动机构驱动器：电机（步进电机、伺服电机、DD电机）、气缸、液压缸、新型驱动器。传动机构：谐波传动、螺旋传动、链传动、带传动、绳传动、各种齿轮传动及液力传动。运动件：机器人本体上的各运动体。2020年3月23日7控制系统一般由控制计算机、驱动装置和伺服控制器（servocontroller）组成控制计算机：根据作业要求接受编程发出指令控制协调运动并根据环境信息协调运动伺服控制器：控制各关节的驱动器使其按一定的速度加速度和轨迹要求进行运动2020年3月23日8智能系统正在发展中智能机器人除运动机能外还有如下三种机能感知机能：获取外部环境信息以便进行自我行动决策和监视的机能，视觉传感器是当前发展的重点思维机能：求解问题的认识推理和判断机能——人工智能人—机通信机能：理解指示命令输出内部状态与人进行信息交换的机能2020年3月23日9机器人控制系统的特点典型的机器人有5至6个关节，每个关节由一个伺服系统控制，关节的运动要求各个伺服系统协同工作。机器人的工作任务是使末端执行器进行空间点位运动或轨迹运动。对于机器人的运动控制，需要进行复杂的坐标变换运算以及矩阵函数的逆运算。机器人数学模型是多变量、非线性和变参数的复杂模型，各变量之间还存在着耦合，因此机器人的控制中常使用前馈、补偿、解耦、自适应等复杂控制技术。较高级的机器人要求对环境条件、控制指令进行测定和分析，采用计算机建立庞大的信息库，用人工智能的方法进行控制、决策、管理和操作，按照给定的要求自动选择最佳控制规律。2020年3月23日1011机器人控制系统的功能(1)伺服控制功能：主要是指机器人的运动控制，实现机器人各关节的位置、速度、加速度等的控制。(2)运算功能：包括机器人运动学正问题和逆问题的运算；连续轨迹控制机器人的直角坐标轨迹插补和一些函数运算。在高速度、高精度的机器人控制系统当中，系统还要完成机器人动力学模型和复杂控制算法等运算功能。(3)系统的管理功能①方便的人机交互功能。②具有对外部环境(包括作业条件)的检测和感觉功能。⑤系统的监控与故障诊断功能。2020年3月23日1112机器人控制方法的分类根据不同的分类方法，机器人控制方式可以有不同的分类。下图是一种常用的分类方法。从总体上，机器人的控制方式可以分为动作控制方式和示教控制方式。按照被控对象来分，可以分为位置控制、速度控制、加速度控制、力控制、力矩控制、力和位置混合控制等等。无论是位置控制或速度控制，从伺服反馈信号的形式来看，又可以分为基于关节空间的伺服控制和基于作业空间(手部坐标)的伺服控制。2020年3月23日12132020年3月23日13142020年3月23日1415机器人控制系统的功能组成记忆功能：存储作业顺序、运动路径、运动方式、运动速度和与生产工艺有关的信息。示教功能：离线编程，在线示教，间接示教。在线示教包括示教盒和导引示教两种。与外围设备联系功能：输入和输出接口、通信接口、网络接口、同步接口。坐标设置功能：有关节、绝对、工具、用户自定义四种坐标系。人机接口：示教盒、操作面板、显示屏。传感器接口：位置检测、视觉、触觉、力觉等位置伺服功能：机器人多轴联动、运动控制、速度和加速度控制、动态补偿等。故障诊断安全保护功能：运行时系统状态监视、故障状态下的安全保护和故障自诊断。2020年3月23日1516机器人控制系统的组成（1）控制计算机控制系统的调度指挥机构。一般为微型机、微处理器有32位、64位等，如奔腾系列CPU以及其他类型CPU；（2）示教盒示教机器人的工作轨迹和参数设定，以及所有人机交互操作，拥有自己独立的CPU以及存储单元，与主计算机之间以串行通信方式实现信息交互；（3）操作面板由各种操作按键、状态指示灯构成，只完成基本功能操作；（4）硬盘和软盘存储存储机器人工作程序的外围存储器；（5）数字和模拟量输入输出各种状态和控制命令的输入或输出；（6）打印机接口记录需要输出的各种信息；（7）传感器接口用于信息的自动检测，实现机器人柔顺控制，一般为力觉、触觉和视觉传感器；（8）轴控制器完成机器人各关节位置、速度和加速度控制；（9）辅助设备控制用于和机器人配合的辅助设备控制，如手爪变位器等；（10）通信接口实现机器人和其他设备的信息交换，一般有串行接口、并行接口等；（11）网络接口。2020年3月23日1617机器人控制系统框图2020年3月23日1718机器人的轨迹控制机械手由初始点(位置和姿态)运动到终止点经过的空间曲线称为路径。轨迹规划方法一般是在机器人初始位置和目标位置之间用多项式函数来“内插”或“逼近”给定的路径，并产生一系列“控制设定点”。路径端点一般是在笛卡儿坐标中给出的。如果需要某些位置的关节坐标，则可调用运动学逆问题求解程序，进行必要的转换。在给定的两端点之间，常有多条可能的轨迹。而轨迹控制就是控制机器人手端沿着一定的目标轨迹运动。因此，目标轨迹的给定方法和如何控制机器人手臂使之高精度地跟踪目标轨迹的方法是轨迹控制的两个主要内容。给定目标轨迹的方式有示教再现方式和数控方式（离线编程）两种。2020年3月23日1819示教再现方式示教再现方式是在机器工作之前，让机器人手端沿目标轨迹移动，同时将位置及速度等数据存入机器人控制计算机中。在机器人工作时再现所示教的动作，使手端沿目标轨迹运动。示教时使机器人手臂运动的方法有两种：一种是用示教盒上的控制按钮发出各种运动指令；另一种是操作者直接用手抓住机器人手部，使其手端按目标轨迹运动。轨迹记忆再现的方式有点位控制(PTP)和连续路径控制(CP)。点位控制主要用于点焊作业、更换刀具或其他工具等情况。连续路径控制主要用于弧焊、喷漆等作业。2020年3月23日1920数控方式数控方式与数控机床的控制方式一样，是把目标轨迹用数值数据的形式给出。这些数据是根据工作任务的需要设置的。无论是采用示教再现方式还是用数值方式，都需要生成点与点之间的目标轨迹。此种目标轨迹要根据不同的情况要求生成。但是也要遵循一些共同的原则。例如，生成的目标轨迹应是实际上能实现的平滑的轨迹；要保证位置、速度及加速度的连续性。保证手端轨迹、速度及加速度的连续性，是通过各关节变量的连续性实现的。2020年3月23日2021位置和力控制系统结构具有力反馈的控制系统如图坐标变换关节伺服机械手位置机器人本体传感器策略坐标变换原运动指令新运动指令反作用变形环境位置+-+-力其工作过程为：机器人开始工作时，机器人手端(或安装在手臂端部的工具)按指令要求沿目标轨迹和给定速度运动。当手端与环境接触时，安装在机器人上的接触传感器或力传感器感觉到接触的发生。机器人控制程序按新的自然约束和人工约束来执行新的控制策略，即位置与力的混合控制。2020年3月23日215.2单关节机器人模型和控制机器人对关节驱动电机的主要要求归纳如下：①快速性。电动机从获得指令信号到完成指令所要求的工作状态的时间应短。②启动转矩惯量比大。③控制特性的连续性和直线性。④调速范围宽。能使用于1:1000至1:10000的调速范围。⑤体积小、质量小、轴向尺寸短。⑥能经受得起苛刻的运行条件，可进行十分频繁的正反向和加减速运行，并能在短时间内承受过载。222020年3月23日22驱动电动机机器人关节驱动电动机的功率范围一般为0.1~10kW。工业机器人驱动系统中所采用的电动机，可细分为以下几种：①交流伺服电动机。包括同步型交流伺服电动机等。②直流伺服电动机。包括小惯量永磁直流伺服电动机、印制绕组直流伺服电动机、大惯量永磁直流伺服电动机、空心杯电枢直流伺服电动机。③步进电动机。包括永磁感应步进电动机。232020年3月23日23直流电机的结构及其工作原理直流电机由永磁钢构成的定子、绕有线圈的转子、转向器及电刷等构成。当电流通过电刷和转向器流过线圈时产生转子磁场，这时转子成为一个电磁铁，在转子与定子之间产生吸引力或推斥力使转子旋转。由电刷和转向器来切换电流方向，使电机按同一方向旋转并带动负载做功。2020年3月23日24直流电机的特征启动转矩大、体积小、质量轻、转矩和转速容易控制及效率高等十分优良的特性。但是，由于有电刷和换向器，在其寿命、噪声等方面必然存在不足。为了克服这一缺点，开发研制出了无刷直流电机。在进行位置控制和速度控制时，需要使用转速传感器，实现位置、速度负反馈的闭环控制方式。2020年3月23日25直流电机的基本特性由图可知直流电机产生的转矩与电机电流成比例。当电机转速为零时电流为最大值，同时产生最大转矩（启动转矩），随着转速的升高，线圈的反电动势相应增大，电流逐渐减小，转矩也随之变小。2020年3月23日26直流电机的线性控制也可称为电阻控制方式。在电机与电源之间插入晶体三极管，这个晶体三极管相当于一个可变电阻器，也就相当于控制了加于电机上的电压，从而改变电机的转速和转矩。晶体管工作于不饱和区，基本上与低频功率放大器的电路结构相同2020年3月23日27直流电机的PWM控制晶体三极管作为一个开关，使加到电机上电压的ON与OFF的时间比（占空比，dutytatio）发生变化，从而控制电机电压的平均值。由于三极管工作于饱和状态，几乎不消耗功率，因此PWM控制方式比较经济。但由于电机供电电压处于开关状态，因此会有噪声、振动以及电刷、换向器损伤等问题。2020年3月23日28步进电机的分类PM型(PermanentMagnet)VR型(VariableReluctance)HB型（HyBrid）2020年3月23日29PM型步进电机的工作原理转子为圆筒形永磁钢，定子位于转子的外侧。定子线圈中流过电流时产生定子磁场。定子和转子磁场间相互作用，产生吸引力或排斥力从而使转子旋转。步距角为90°或45°。2020年3月23日30VR型步进电机的工作原理转子由齿轮状的低碳钢构成。转子在通电相定子磁场的作用下，旋转到磁阻为最小的位置。通常使用的步距角为0.9°、1.8°及3.6°等。2020年3月23日31HB型步进电机的工作原理是VR型和PM型的复合型步进电机，能获得与VR型相同的很小的步距角。因具有较大转矩而得到广泛应用2020年3月23日32步进电机的转矩特性2020年3月23日33步进电机驱动电路单极型驱动方式和双极型驱动方式两类。单极型驱动方式为标准驱动方式，电路构成较为简单。双极型驱动方式与单极型驱动方式相比，可以产生2倍的转矩，但驱动电路比较复杂。应根据控制对象的不同，适当选择不同的驱动方式。2020年3月23日34单极型驱动方式定子线圈中流过电流进行磁场切换时，线圈的中点与两端点之间，无