模块五机器人的控制系统PPT学习教案.pptx

《模块五机器人的控制系统PPT学习教案.pptx》由会员分享，可在线阅读，更多相关《模块五机器人的控制系统PPT学习教案.pptx（163页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、会计学1模块模块(m kui)五机器人的控制系统五机器人的控制系统第一页，共163页。模块五机器人的控制系统机器人控制系统(knzhxtn)概述1机器人控制系统的分类(fnli)与组成2机器人控制系统的结构(jigu)与位置控制3机器人的力控制4机器人控制的示教再现4第1页/共163页第二页，共163页。本模块主要介绍机器人的控制系统，内容包括机器人控制系统的特点、机器人控制系统的基本功能和控制方式、机器人控制系统的分类与组成、机器人控制系统的结构与位置控制、机器人控制的示教方式、关节运动的指令(zhlng)生成、控制软件与机器 人 示 教 实 例、MOTOMANUP6机器人控制系统。单元提要

2、第2页/共163页第三页，共163页。学习完本模块的内容后，学生应能够了解(lioji)机器人控制系统的特点，掌握机器人控制系统的控制功能与基本单元；掌握控制系统的种类、分类，能够运用这些知识解释机器人控制系统的技术内容，能够解读机器人的控制框图；了解(lioji)机器人控制系统的结构；熟悉机器人控制的示教方式；能够读懂控制机器人示教实例；具有实际操作MOTOMAN UP6机器人示教控制系统的能力。学习要求第3页/共163页第四页，共163页。学习(xux)单元一机器人的控制系统概述第4页/共163页第五页，共163页。多数机器人的结构是一个空间开链结构，各个关节的运动是相互独立的，为了实现机

3、器人末端执行器的运动，需要多关节协调(xitio)运动，因此，机器人控制系统与普通的控制系统比较，要复杂一些。具体来讲，机器人控制系统主要具有以下特点。(1)机器人控制系统是一个多变量控制系统，即使简单的工业机器人也有35个自由度，比较复杂的机器人有十几个自由度，甚至几十个自由度，每个自由度一般包含一个伺服机构，多个独立的伺服系统必须有机地协调(xitio)起来。例如，机器人的手部运动是所有关节的合成运动，要使手部按照一定的轨迹运动，就必须控制各关节协调(xitio)运动，包括运动轨迹、动作时序等多方面的协调(xitio)。一、机器人控制系统(kn zh x tn)的特点第5页/共163页第六

4、页，共163页。(2)运动描述复杂，机器人的控制与机构运动学及动力学密切相关。描述机器人状态和运动的数学模型是一个非线性模型，随着状态的变化，其参数也在变化，各变量之间还存在耦合。因此，仅仅考虑位置闭环是不够的，还要考虑速度闭环，甚至加速度闭环。在控制过程(guchng)中，根据给定的任务，应当选择不同的基准坐标系，并做适当的坐标变换，求解机器人运动学正问题和逆问题。此外，还要考虑各关节之间惯性力、哥氏力等的耦合作用和重力负载的影响，因此，系统中还经常采用一些控制策略，如重力补偿、前馈、解耦或自适应控制等。一、机器人控制系统(kn zh x tn)的特点第6页/共163页第七页，共163页。(

5、3)具有较高的重复定位精度，系统刚性好。除直角坐标机器人外，机器人关节上的位置检测元件不能安装在末端执行器上，而应安装在各自(gz)的驱动轴上，构成位置半闭环系统。但机器人的重复定位精度较高，一般为0.1mm。此外，由于机器人运行时要求运动平稳，不受外力干扰，为此系统应具有较好的刚性。(4)信息运算量大。机器人的动作住往可以通过不同的方式和路径来完成，因此存在一个最优的问题，较高级的机器人可以采用人工智能的方法，用计算机建立起庞大的信息库，借助信息库进行控制、决策管理和操作。根据传感器和模式识别的方法获得对象及环境的工况，按照给定的指标要求，自动选择最佳的控制规律。一、机器人控制系统(kn z

6、h x tn)的特点第7页/共163页第八页，共163页。(5)需采用加（减）速控制。过大的加（减）速度会影响机器人运动的平稳性，甚至使机器人发生抖动，因此在机器人起动或停止时采取加（减）速控制策略。通常采用匀加（减）速运动指令来实现。此外，机器人不允许有位置超调，否则将可能与工件发生碰撞。因此，要求控制系统位置无超调，动态响应尽量快。一、机器人控制系统(kn zh x tn)的特点第8页/共163页第九页，共163页。(6)工业机器人还有一种特有的控制方式示教再现控制方式。当要工业机器人完成某作业时，可预先移动工业机器人的手臂来示教该作业顺序、位置及其他信息，在此过程中把相关的作业信息存储在

7、内存中，在执行任务时，依靠工业机器人的动作再现功能，可重复进行该作业。此外，从操作的角度来看，要求控制系统具有良好的人机界面，尽量降低对操作者的要求。因此，多数情况要求控制器的设计人员不仅要完成底层(dcn)伺服控制器的设计，还要完成规划算法的编程。总之，工业机器人控制系统是一个与运动学和动力学密切相关的、紧耦合的、非线性的多变量控制系统。随着实际工作情况的不同，可以采用各种不同的控制方式。一、机器人控制系统(kn zh x tn)的特点第9页/共163页第十页，共163页。一、机器人控制系统(kn zh x tn)的特点第10页/共163页第十一页，共163页。机器人控制系统是机器人的主要组

8、成部分，用于控制操作机来完成特定的工作任务，其基本功能有示教再现功能、坐标设置功能、与外围设备的联系功能、位置伺服功能。(1)示教-再现功能。机器人控制系统可实现离线编程、在线示教及间接示教等功能，在线示教又包括示教盒示教和导引示教两种情况。在示教过程中，可存储作业顺序、运动(yndng)路径、运动(yndng)方式、运动(yndng)速度及与生产工艺有关的信息，在再现过程中，能控制机器人按照示教的加工信息执行特定的作业。二、机器人控制系统(kn zh x tn)的功能第11页/共163页第十二页，共163页。(2)坐标设置功能。一般的工业机器人控制器设置有关节坐标、绝对坐标、工具坐标及用户坐

9、标4种坐标系，用户可根据作业要求选用不同的坐标系并进行坐标系之间的转换。(3)与外围设备的联系功能。机器人控制器设置有输入/输出接口、通信接口、网络接口和同步接口，并具有示教盒、操作面板及显示屏等人机接口。此外，还具有多种传感器接口，如视觉、触觉、接近觉、听觉、力觉（力矩）传感器等多种传感器接口。(4)位置伺服功能。机器人控制系统(knzhxtn)可实现多轴联动、运动控制、速度和加速度控制、力控制及动态补偿等功能。在运动过程中，还可以实现状态监测、故障诊断下的安全保护和故障自诊断等功能。二、机器人控制系统(kn zh x tn)的功能第12页/共163页第十三页，共163页。1.点到点控制方式

10、点到点控制方式点到点控制方式用于实现点的位置控制，其运动是由一个给定点到另一个给定点，而点与点之间的轨迹却无关紧要。因此(ync)，这种控制方式的特点是只控制工业机器人末端执行器在作业空间中某些规定的离散点上的位姿。控制时只要求工业机器人快速、准确地实现相邻各点之间的运动，而对达到目标点的运动轨迹则不做任何标记，如自动插件机，在贴片机上安插元件、点焊、搬运、装配等作业。这种控制方式的主要技术指标是定位精度和运动所需的时间，控制方式比较简单，但要达到较高的定位精度则较难。三、机器人的控制(kngzh)方式第13页/共163页第十四页，共163页。2.连续轨迹控制方式连续轨迹控制方式连续轨迹控制方

11、式用于指定点与点之间的运动轨迹所要求的曲线，如直线或圆弧。这种控制方式的特点是连续地控制工业机器人末端执行器在作业空间中的位姿，使其严格按照预先设定的轨迹和速度在一定的精度要求内运动，速度可控，轨迹光滑，运动平稳，以完成作业任务。工业机器人各关节连续、同步地进行相应的运动，其末端执行器可形成连续的轨迹。这种控制方式的主要技术指标是机器人末端执行器的轨迹跟踪精度及平稳性。在用机器人进行弧焊、喷漆、切割等作业时，应选用连续轨迹控制方式。三、机器人的控制(kngzh)方式第14页/共163页第十五页，共163页。3.速度控制方式速度控制方式 三、机器人的控制(kngzh)方式第15页/共163页第十

12、六页，共163页。4.力（力矩）控制方式力（力矩）控制方式在进行抓放操作、去毛刺、研磨和组装等作业时，除了要求准确定位之外，还要求使用特定的力或力矩传感器对末端执行器施加在对象上的力进行控制。这种控制方式的原理与位置伺服控制原理基本相同，但输入量和输出量不是位置信号，而是力（力矩）信号，因此系统中必须有力（力矩）传感器。三、机器人的控制(kngzh)方式第16页/共163页第十七页，共163页。5.智能控制方式智能控制方式在不确定或未知条件下作业，机器人需要通过传感器获得周围环境的信息，根据自己内部的知识库做出决策，进而对各执行机构进行控制，自主完成给定任务。若采用智能控制技术，机器人会具有较

13、强的环境适应性及自学习能力。智能控制方法与人工神经网络、模糊算法、遗传算法、专家系统等人工智能的发展密切相关。三、机器人的控制(kngzh)方式第17页/共163页第十八页，共163页。学习单元二机器人控制系统的分类(fn li)与组成第18页/共163页第十九页，共163页。一、机器人控制系统(kn zh x tn)的分类图图5-1 5-1 机器人控制系统的分类机器人控制系统的分类第19页/共163页第二十页，共163页。图图5-2 5-2 机器人控制系统组成框图机器人控制系统组成框图 二、机器人控制系统(kn zh x tn)的组成第20页/共163页第二十一页，共163页。(1)控制(k

14、ngzh)计算机。控制(kngzh)计算机是控制(kngzh)系统的调度指挥机构，一般为微型机，微处理器分为32位、64位等，如奔腾系列CPU等。(2)示教编程器。示教机器人的工作轨迹、参数设定和所有人机交互操作拥有自己独立的CPU及存储单元，与主计算机之间以串行通信方式实现信息交互。(3)操作面板。操作面板由各种操作按键、状态指示灯构成，只完成基本功能操作。(4)磁盘存储。机器人主要用存储机器人工作程序的外围存储器来存储程序。二、机器人控制系统(kn zh x tn)的组成第21页/共163页第二十二页，共163页。(10)通信接口。通信接口用于实现机器人和其他设备的信息交换(jiohun)

15、，一般有串行接口、并行接口等。(11)网络接口。网络接口包括Ethernet接口和Fieldbus接口。Ethernet接口。Ethernet接口可通过以太网实现数台或单台机器人的直接PC通信，数据传输速率高达10Mb/s，可直接在PC上用Windows库函数进行应用程序编程，支持TCP/IP通信协议，通过Ethernet接口将数据及程序装入各个机器人控制器中。Fieldbus接口。Fieldbus接口支持多种流行的现场总线规格，如Devicenet、ABRemoteI/O、Interbuss、profibusDP、MNET等。二、机器人控制系统(kn zh x tn)的组成第22页/共163

16、页第二十三页，共163页。(5)数字量和模拟量输入/输出。数字量和模拟量输入/输出指各种状态和控制命令的输入或输出。(6)打印机接口。打印机接口用于记录(jl)需要输出的各种信息。(7)传感器接口。传感器接口用于信息的自动检测，实现机器人柔顺控制，一般为力觉、触觉和视觉传感器。(8)轴控制器。轴控制器用于完成机器人各关节位置、速度和加速度控制。(9)辅助设备控制。辅助设备控制用于和机器人配合的辅助设备控制，如手爪变位器等。二、机器人控制系统(kn zh x tn)的组成第23页/共163页第二十四页，共163页。学习单元三机器人控制系统(kn zh x tn)的结构与位置控制第24页/共163

17、页第二十五页，共163页。2.集中控制方式集中控制方式集中控制方式用一台计算机实现全部(qunb)控制功能，结构简单，成本低；但实时性差，难以扩展。在早期的机器人中常采用这种结构，其构成框图如图5-3所示。一、机器人控制系统(kn zh x tn)的结构图图5-3 5-3 集中控制方式的构成框图集中控制方式的构成框图第25页/共163页第二十六页，共163页。在基于计算机的集中控制系统(knzhxtn)中，充分利用了计算机资源开放性的特点，可以实现很好的开放性，多种控制卡、传感器设备等都可以通过标准PCI插槽或标准串口、并口集成到控制系统(knzhxtn)中。集中式控制系统(knzhxtn)的

18、优点为：硬件成本较低，便于信息的采集和分析，易于实现系统的最优控制，整体性与协调性较好。其缺点为：系统控制缺乏灵活性，控制危险容易集中，一旦出现故障，其影响面广，后果严重；由于工业机器人的实时性要求很高，当系统进行大量数据计算时，会降低系统实时性，系统对多任务的响应能力也会与系统的实时性相冲突；系统连线复杂，会降低系统的可靠性。一、机器人控制系统(kn zh x tn)的结构第26页/共163页第二十七页，共163页。2.主从控制方式主从控制方式主从控制方式采用主、从两级处理器实现系统的全部控制功能。主CPU实现管理、坐标变换、轨迹生成和系统自诊断等，从CPU实现所有关节的动作控制。其构成框图

19、如图5-4所示。主从控制方式系统实时性较好，适于高精度、高速度控制，但其系统扩展性较差，维修困难。一、机器人控制系统(kn zh x tn)的结构第27页/共163页第二十八页，共163页。图图5-4 5-4 主从控制方式的构成框图主从控制方式的构成框图 一、机器人控制系统(kn zh x tn)的结构第28页/共163页第二十九页，共163页。3.分布控制方式分布控制方式分布(fnb)控制方式按系统的性质和方式将系统控制分成几个模块，每一个模块各有不同的控制任务和控制策略，各模式之间可以是主从关系，也可以是平等关系。这种方式实时性好，易于实现高速、高精度控制，易于扩展，可实现智能控制，是目前

20、流行的方式，其控制框图如图5-5所示。其主要思想是“分散控制，集中管理”，即系统对其总体目标和任务可以进行综合协调和分配，并通过子系统的协调工作来完成控制任务。整个系统在功能、逻辑和物理等方面都是分散的，所以DCS系统又称为集散控制系统或分散控制系统。在这种结构中，子系统由控制器、不同被控对象或设备构成，各个子系统之间通过网络等相互通信。分布(fnb)式控制结构提供了一个开放、实时、精确的机器人控制系统。分布(fnb)式系统中常采用两级控制方式。一、机器人控制系统(kn zh x tn)的结构第29页/共163页第三十页，共163页。图图5-5 5-5 分散控制方式的控制框图分散控制方式的控制

21、框图 一、机器人控制系统(kn zh x tn)的结构第30页/共163页第三十一页，共163页。两级分布式控制系统通常由上位机、下位机和网络组成。上位机可以进行不同的轨迹规划和算法控制，下位机用于进行插补细分、控制优化等。上位机和下位机通过通信总线相互协调工作。这里的通信总线可以是RS232、RS485、EEE488及USB总线等形式。现在，以太网和现场总线技术的发展为机器人提供了更快速、稳定、有效的通信服务，尤其是现场总线。现场总线应用于生产现场，在微机化测量控制设备之间实现双向多结点数字通信，从而形成了新型的网络集成式全分布控制系统现场总线控制系统(fieldbuscontrolsyst

22、em，FCS)。在工厂生产网络中，将可以通过现场总线连接(linji)的设备统称为现场设备/仪表。从系统论的角度来说，工业机器人作为工厂的生产设备之一，也可以归纳为现场设备。在机器人系统中引入现场总线技术后，更有利于机器人在工业生产环境中的集成。一、机器人控制系统(kn zh x tn)的结构第31页/共163页第三十二页，共163页。分布式控制系统的优点为：系统灵活性好，控制系统的危险性降低，采用多处理器的分散控制，有利于系统功能的并行执行，提高系统的处理效率，缩短响应时间；对于具有多自由度的工业机器人而言，集中控制对各个控制轴之间的耦合关系处理得很好，可以很简单地进行补偿。其缺点为：当轴的

23、数量增加(zngji)到使控制算法变得很复杂时，其控制性能会恶化；当系统中轴的数量或控制算法变得很复杂时，可能会导致系统的重新设计；分布式结构的每一个运动轴都由一个控制器处理，这意味着系统有较少的轴间耦合和较高的系统重构性。一、机器人控制系统(kn zh x tn)的结构第32页/共163页第三十三页，共163页。机器人控制柜用于安装各种控制单元，进行(jnxng)数据处理及存储，并执行程序，是机器人系统的大脑，如图5-6所示。1.ABB工业机器人控制柜系统工业机器人控制柜系统 二、机器人典型(dinxng)控制柜系统图图5-6 ABB5-6 ABB工业机器人控制柜工业机器人控制柜第33页/共

24、163页第三十四页，共163页。1 1）ABBABB工业机器人控制柜系统的特点工业机器人控制柜系统的特点(1)灵活性强。IRC5控制器由一个控制模块(mkui)和一个驱动模块(mkui)组成，可选增一个过程模块(mkui)以容纳定制设备和接口，如点焊、弧焊和胶合等。配备这3种模块(mkui)的灵活型控制器完全有能力控制一台6轴机器人外加伺服驱动工件定位器及类似设备。若需增加机器人的数量，只需为每台新增机器人增装一个驱动模块(mkui)，还可选择安装一个过程模块(mkui)，最多可控制4台机器人在MultiMove模式下作业。各模块(mkui)间只需要两根连接电缆，一根为安全信号传输电缆，另一根

25、为以太网连接电缆，供模块(mkui)间通信使用，模块(mkui)连接简单易行。二、机器人典型(dinxng)控制柜系统第34页/共163页第三十五页，共163页。二、机器人典型(dinxng)控制柜系统第35页/共163页第三十六页，共163页。(4)通信便利。完善的通信功能是ABB机器人控制系统的特点，其IRC5控制器的PCI扩展槽中可以安装几乎任何常见类型的现场总线板卡，包括满足ODVA标准，可使用众多第三方装置的单信道DeviceNet，支持最高速率为12Mb/s的双信道profibusDP及可使用铜线和光纤接口的双信道Interbus通信。二、机器人典型(dinxng)控制柜系统第36

26、页/共163页第三十七页，共163页。（1）主电源开关。主电源开关是机器人系统的总开关。（2）紧急停止按钮。在任何模式下，按下紧急停止按钮，机器人立即停止动作。要使机器人重新动作，必须使紧急停止按钮恢复至原来位置。（3）电动机上电/失电按钮。电动机上电/失电按钮表示机器人电动机的工作状态。当按键灯常亮时，表示上电状态，机器人的电动机被激活，准备好执行程序；当按键灯快闪时，表示机器人未同步（未标定(biodn)或计数器未更新），但电动机已激活；当按键灯慢闪时，表示至少有一种安全停止生效，电动机未激活。2 2）ABBABB工业机器人的控制柜按键工业机器人的控制柜按键 二、机器人典型(dinxng)

27、控制柜系统第37页/共163页第三十八页，共163页。（4）模式选择(xunz)按钮。ABB工业机器人模式选择(xunz)按钮一般分为两位选择(xunz)开关和三位选择(xunz)开关，如图5-7所示。图图5-7 ABB5-7 ABB工业机器人模式选择按钮工业机器人模式选择按钮AA自动模式；自动模式；BB手动差速模式；手动差速模式；CC手动全速模式手动全速模式 二、机器人典型(dinxng)控制柜系统第38页/共163页第三十九页，共163页。其用于在与实际(shj)情况相近的情况下调试程序。机器人只能以低速、手动控制(kngzh)运行，必须按住使能器才能激活电动机。机器人运行时使用，在此状态

28、(zhungti)下，操纵摇杆不能使用。手动全速模式手动差速模式自动模式。二、机器人典型控制柜系统第39页/共163页第四十页，共163页。KUKA机器人被广泛应用于汽车制造、造船、冶金、娱乐等领域(lny)。机器人配套的设备有KRC2控制器柜、KCP控制盘，如图5-8所示。2.KUKA机器人控制柜系统机器人控制柜系统图图5-8 KUKA5-8 KUKA工业机器人控制柜工业机器人控制柜 二、机器人典型(dinxng)控制柜系统第40页/共163页第四十一页，共163页。二、机器人典型(dinxng)控制柜系统第41页/共163页第四十二页，共163页。(1)采用标准的工业控制计算机处理器。(2

29、)基于Windows平台的操作系统，可在线选择多种语言。(3)支持多种标准工业控制总线，包括Interbus、Profibus、Devicenet、Canbus、Controlnet、EtherNet、RemoteI/O等，其中，Devicenet、Ethernet为标准配置。(4)配有标准的ISA、PCI插槽，方便扩展，可直接插入各种标准调制解调器接入高速Internet，实现远程监控和诊断。(5)采用高级语言编程，程序可方便、快速地进行备份及恢复。(6)集成了标准的控制软件功能包，可适应(shyng)各种应用。二、机器人典型(dinxng)控制柜系统第42页/共163页第四十三页，共163

30、页。(7）配有6D运动控制鼠标，方便运动轨迹的示教。(8)具有断电自动重启功能，不需要重新进入程序。(9)具有示波器功能，可方便进行错误诊断和系统优化。(10)可直接外接显示器、鼠标和键盘，方便程序的读/写。(11)可随时进行系统的更新。(12)配有大容量硬盘，对程序指令基本无限制(xinzh)，并可长期存储相关操作和系统日志。(13)可方便进行联网，易于监控和管理。(14)拆卸方便，易于维护。二、机器人典型(dinxng)控制柜系统第43页/共163页第四十四页，共163页。如图5-9所示，OTC机器人控制柜系统在FD11控制柜的前面配备电源开关及操作面板，连接(linji)示教编程器。其主

31、要包括断路器、示教编程器、操作面板(操作盒)等。3.OTC机器人控制柜系统机器人控制柜系统图图5-9 OTC5-9 OTC机器人机器人FD11FD11控制柜控制柜 二、机器人典型(dinxng)控制柜系统第44页/共163页第四十五页，共163页。图图5-11 5-11 操作面板操作面板AA运转准备按钮；运转准备按钮；BB起动按钮；起动按钮；CC停止按钮；停止按钮；DD模式转换开关；模式转换开关；EE紧急停止按钮紧急停止按钮 二、机器人典型(dinxng)控制柜系统第45页/共163页第四十六页，共163页。（1）断路器。断路器用于控制装置的电源开与关。（2）示教编程器。示教编程器上装有按键和

32、按钮，以便执行示教、文件操作、各种条件设定等。（3）操作面板。操作面板(操作盒)上装有执行最低限度的操作所需的按钮，以便执行运转准备投入、自动运行(ynxng)的起动和停止、紧急停止、示教/再生模式的切换等，如图5-10和图5-11所示。图图5-10 5-10 操作面板操作面板AA运转准备按钮；运转准备按钮；BB起动按钮；起动按钮；CC停止按钮；停止按钮；DD模式转换开关；模式转换开关；EE紧急停止按钮紧急停止按钮 二、机器人典型(dinxng)控制柜系统第46页/共163页第四十七页，共163页。运转准备按钮：使其进入运转准备投入的状态。一旦进入投入状态，移动机器人的准备就完成了。起动按钮：

33、在再生模式下起动指定的作业程序。停止按钮：在再生模式下停止起动指定的作业程序。模式转换开关：切换(qihun)模式，可切换(qihun)到示教再生模式，此开关与示教器的TP选择开关组合使用。紧急停止按钮：按下此按钮，机器人紧急停止。不论按操作盒或示教器上的哪一个，都使机器人紧急停止。若要解除紧急停止，可向右旋转按钮（按钮回归原位）。二、机器人典型(dinxng)控制柜系统第47页/共163页第四十八页，共163页。主电源开关位于FS100控制柜的面板上。4.MOTOMAN FS100MOTOMAN FS100控制柜控制柜 二、机器人典型(dinxng)控制柜系统第48页/共163页第四十九页，

34、共163页。工业机器人位置控制的目的就是要使机器人各关节实现预先所规划的运动，最终保证工业机器人末端执行器沿预定的轨迹运行。对于机器人的位置控制，可将关节位置给定值与当前值相比较得到的误差(wch)作为位置控制器的输入量，经过位置控制器的运算后，将输出作为关节速度控制的给定值，如图5-12所示。三、机器人的位置(wi zhi)控制图图5-12 5-12 机器人位置控制示意图机器人位置控制示意图第49页/共163页第五十页，共163页。因此，工业机器人每个关节的控制系统都是闭环控制系统。此外，对于工业机器人的位置控制，位置检测元件是必不可少的。关节位置控制器常采用PID算法，也可采用模糊控制算法

35、等智能方法。三、机器人的位置(wi zhi)控制第50页/共163页第五十一页，共163页。位置控制分为点位控制和连续轨迹控制两类。点位控制的特点是仅控制在离散点上机器人末端的位置和姿态，要求尽快且无超调地实现机器人在相邻点之间的运动，但对相邻点之间的运动轨迹一般不做具体规定。点位控制的主要技术指标是定位精度和完成运动所需要的时间。连续轨迹控制的特点是连续控制机器人末端的位置和姿态轨迹。一般要求速度可控、运动轨迹光滑且运动平稳。连续轨迹控制的技术指标是轨迹精度和平稳性。三、机器人的位置(wi zhi)控制第51页/共163页第五十二页，共163页。三、机器人的位置(wi zhi)控制第52页/

36、共163页第五十三页，共163页。速度控制通常用于对目标跟踪的任务中，机器人的关节速度控制框图如图5-13所示。对于(duy)机器人末端笛卡儿空间的位置、速度控制，其基本原理与关节空间的位置和速度控制类似。图图5-13 5-13 机器人的关节速度控制框图机器人的关节速度控制框图三、机器人的位置(wi zhi)控制第53页/共163页第五十四页，共163页。工业机器人的结构多为串接的连杆形式，其动态特性为具有高度的非线性。但在其控制系统设计中，通常把机器人的每个关节当作一个独立(dl)的伺服机构来考虑。这是因为工业机器人运动速度不快（通常小于1.5m/s），由速度变化引起的非线性作用可以忽略。另

37、外，由于交流伺服电动机都安装有减速器，其减速比往往接近100，那么当负载变化时，折算到电动机轴上的负载变化值则很小（除以速度比的平方），所以可以忽略负载变化的影响，而且各关节之间的耦合作用也因减速器的存在而极大地削弱了。因此，工业机器人系统就变成了一个由多关节组成的各自独立(dl)的线性系统。应用中的工业机器人几乎都采用反馈控制，利用各关节传感器得到的反馈信息，计算所需的力矩，发出相应的力矩指令，以实现所要求的运动。三、机器人的位置(wi zhi)控制第54页/共163页第五十五页，共163页。单关节控制器是指不考虑关节之间的相互影响，只根据一个关节独立设置的控制器。在单关节控制器中，机器人的

38、机械惯性影响常常被作为扰动项考虑。把机器人看作刚体结构，图5-14给出了单关节电动机的负载(fzi)模型。下面研究负载(fzi)转角s与电动机的电枢电压U之间的传递函数。1.单关节位置控制单关节位置控制1)1)单关节位置控制的基本原理单关节位置控制的基本原理三、机器人的位置(wi zhi)控制第55页/共163页第五十六页，共163页。图图5-14 5-14 单关节电动机的负载模型单关节电动机的负载模型JaJa单关节驱动电动机转动惯量；单关节驱动电动机转动惯量；T Tm m直流伺服电动机输出转矩；直流伺服电动机输出转矩；J Jm m单关节夹手负载在传动端的转动惯量；单关节夹手负载在传动端的转动

39、惯量；B Bm m传动端的阻尼系数；传动端的阻尼系数；齿轮减速比；齿轮减速比；m m传动端角位移；传动端角位移；s s负载端角位移；负载端角位移；T Ti i负载端总转矩；负载端总转矩；J Ji i负载端总转动惯量；负载端总转动惯量；B Bi i负载端阻尼系数负载端阻尼系数三、机器人的位置(wi zhi)控制第56页/共163页第五十七页，共163页。三、机器人的位置(wi zhi)控制第57页/共163页第五十八页，共163页。三、机器人的位置(wi zhi)控制第58页/共163页第五十九页，共163页。三、机器人的位置(wi zhi)控制第59页/共163页第六十页，共163页。为了构成

40、对负载轴的角位移控制器，必须进行负载轴的角位移反馈，即用某一时刻t所需要的角位移d与实际角位移s之差所产生的电压来控制该系统。用光学编码器作为实际位置传感器，可以求取位置误差，误差电压为U(t)=K(d-s)（5-10）同时，令e(t）=d(t）-s(t)，s(t）=m(t)，对这3个表达式分别进行拉氏变换可得三、机器人的位置(wi zhi)控制第60页/共163页第六十一页，共163页。从理论上讲，式（5-9）表示的二阶系统是稳定的。要提高响应速度，可以调高系统的增益（如增大K）及电动机传动轴速度负反馈(fnku)，把某些阻尼引入系统中来，以加强反电动势的作用效果。要做到这一点，可以采用测速

41、发电机，或计算一定时间间隔内传动轴角位移的差值。单关节位置控制器如图5-15（a）所示。图5-15（b）所示为具有速度反馈(fnku)功能的位置控制系统，其中，Kt为测速发电机的传递系数，K1为速度反馈(fnku)信号放大器的增益。由于电动机电枢回路的反馈(fnku)电压已经由Kbm(t)增加为Kbm(t）+K1Ktm(t）=(Kb+K1Kt）m(t)，所以其对应的开环传递函数为三、机器人的位置(wi zhi)控制第61页/共163页第六十二页，共163页。三、机器人的位置(wi zhi)控制第62页/共163页第六十三页，共163页。图图5-15 5-15 单关节机械手位置控制器的结构单关节

42、机械手位置控制器的结构三、机器人的位置(wi zhi)控制第63页/共163页第六十四页，共163页。在图5-15（c）中，考虑了摩擦力矩、外负载力矩、重力矩及向心力的作用。以任一扰动作为干扰输入(shr)，可写出干扰的输出与传递函数。利用拉氏变换中的终值定理，即可求得因干扰引起的静态误差。图图5-15 5-15 单关节机械手位置控制器的结构单关节机械手位置控制器的结构三、机器人的位置(wi zhi)控制第64页/共163页第六十五页，共163页。2)2)带力矩闭环的关节位置控制带力矩闭环的关节位置控制带有力矩闭环的单关节位置控制系统是一个三闭环控制系统，由位置环、力矩环和速度(sd)环构成。

43、图图5-16 5-16 带有力矩闭环的单关节位置控制系统带有力矩闭环的单关节位置控制系统三、机器人的位置(wi zhi)控制第65页/共163页第六十六页，共163页。速度环为控制系统内环，作用是通过对电动机电压的控制使电动机表现出期望的速度特性，速度环的给定是力矩环偏差经过放大后的输出（电动机角速度d），速度环的反馈是关节(gunji)角速度m，d与m的偏差作为电动机电压驱动器的输入，经过放大后成为电压U，其中K表示转换常数（比例系数）。电动机在电压U的作用下，以角速度m旋转。1/(Ls+R)为电动机的电磁惯性环节，其中，L为电枢电感，R为电枢电阻，I为电枢电流。考虑到一般情况下，LR，故一

44、般可以忽略电感L的影响，环节1/(Ls+R)可用1/R代替。1/(Jeffs+B)是电动机的机电惯性环节，KC为电流力矩常数，即电动机力矩Tm与电枢电流I之间的系数。三、机器人的位置(wi zhi)控制第66页/共163页第六十七页，共163页。力矩环为控制系统内环，介于速度环和位置(wizhi)环之间，其作用是通过对电动机电压的控制使电动机表现出期望的力矩特性。力矩环的给定由两部分组成：一部分是位置(wizhi)环的位置(wizhi)调节器的输出，另一部分是前馈力矩Tf和期望力矩Td。力矩环的反馈是关节力矩Tj。Ktf是力矩前馈通道的比例系数，K1是力矩环的比例系数。给定力矩与反馈力矩Tj的

45、偏差经过比例系数K1的放大后，作为速度环的给定d。在关节到达期望位置(wizhi)后，若位置(wizhi)环调节器的输出为零，则关节力矩TjKtf（Tf+Td）。由于力矩环采用比例调节，因而稳态时关节力矩与期望力矩之间存在偏差。三、机器人的位置(wi zhi)控制第67页/共163页第六十八页，共163页。位置环为控制系统外环，用于控制关节达到期望的位置。位置环的给定是期望的关节位置d，反馈为关节位置m，d与m的偏差作为位置调节器的输入，经过位置调节器运算后形成的输出作为力矩环给定的一部分，位置调节器常采用PID或PI控制器，构成的位置闭环系统为无静差系统。三、机器人的位置(wi zhi)控制

46、第68页/共163页第六十九页，共163页。2.多关节位置控制多关节位置控制多关节位置控制是指考虑各关节之间的相互影响而对每一个关节分别设计的控制器。前述的单关节控制器是把机器人的其他关节锁住，工作过程中依次移动（转动）一个关节，这种工作方法显然效率很低，但若多个关节同时运动，则各个运动关节之间的力或力矩会产生相互作用，因而不能运用前述的单个关节的位置控制原理。要克服这种多关节之间的相互作用，必须添加补偿作用，即在多关节控制器中，机器人的机械惯性影响常常被作为前馈项考虑。多关节机器人的动力学方程为（5-15）三、机器人的位置(wi zhi)控制第69页/共163页第七十页，共163页。三、机器

47、人的位置(wi zhi)控制第70页/共163页第七十一页，共163页。图图5-17 5-17 多关节位置控制器设计原理图多关节位置控制器设计原理图三、机器人的位置(wi zhi)控制第71页/共163页第七十二页，共163页。式（5-15）中的第2项表示传动轴上的等效转动惯量为J的关节i传动装置的惯性力矩，已在单关节控制器中讨论过。第3项表示哥氏力及向心力的作用，这些力矩项也必须前馈输入关节I的控制器，以补偿各关节间的实际相互作用，如图5-17所示。式（5-15）中的第4项表示关节重量的影响，也可以由前馈项i来补偿，它是一个估计的力矩信号，可由下式计算：式中，为重力矩g的估计值。三、机器人的

48、位置(wi zhi)控制第72页/共163页第七十三页，共163页。三、机器人的位置(wi zhi)控制第73页/共163页第七十四页，共163页。学习(xux)单元四机器人的力控制第74页/共163页第七十五页，共163页。1.机器人的柔顺机器人的柔顺柔顺是指机器人的末端(mdun)能够对外力的变化做出相应的响应，表现为低刚度。如果末端(mdun)装置、工具或周围环境的刚性很高，那么机械手要执行与某个表面有接触的操作作业将会变得相当困难。这时，若机器人只用位置控制，往往不能满足要求。例如，机械手夹起鸡蛋，机械手用海绵擦洗玻璃。如果海绵的柔顺性很好，这一作业任务就可以成功进行。在机器人刚度很高

49、的情况下，机器人对外力的变化响应很弱，缺乏柔顺性。为了使机器人在工作中能较好地适应工作任务的要求，常常希望机器人具有柔性(compliance)。这样就需要使机器人成为柔性机器人系统。根据柔顺是否通过控制方法获得，可以将柔顺分为主动柔顺和被动柔顺。一、机器人的柔顺(rushn)和柔顺(rushn)控制种类第75页/共163页第七十六页，共163页。1)1)主动柔顺主动柔顺 一、机器人的柔顺和柔顺控制(kngzh)种类第76页/共163页第七十七页，共163页。机器人凭借辅助的柔顺机构与环境接触时能够对外部作用力产生自然顺从，称为被动柔顺(passivecompliance)，如图5-18（b）

50、所示。对于与图5-18（a）相同的任务(rnwu)，若不采用反馈控制，也可通过操作机终端机械结构的变形来适应操作过程中遇到的阻力。在图5-18（b）中，在柱销与操作机之间设有类似弹簧之类的机械结构。当柱销插入孔内而遇到阻力时，弹簧系统就会产生变形，使阻力减小，以使柱销轴与孔轴重合，保证柱销顺利地插入孔内。由于被动柔顺控制存在各种各样的缺点和不足，主动柔顺控制（力控制）逐渐成为主流的研究方向。2)2)被动柔顺被动柔顺 一、机器人的柔顺(rushn)和柔顺(rushn)控制种类第77页/共163页第七十八页，共163页。三、气动(q dn)执行元件图图5-18 5-18 主动柔顺与被动柔顺示意图主