工业机器人的控制.pptx

《工业机器人的控制.pptx》由会员分享，可在线阅读，更多相关《工业机器人的控制.pptx（159页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、会计学1工业机器人的控制工业机器人的控制4.1 工业机器人控制系统的特点工业机器人控制系统的特点 机器人的结构是一个空间开链机构,其各个关节的运动是独立的,为了实现末端点的运动轨迹,需要多关节的运动协调。因此,其控制系统与普通的控制系统相比要复杂得多,具体如下:(1)(1)机机器器人人的的控控制制与与机机构构运运动动学学及及动动力力学学密密切切相相关关。机器人手足的状态可以在各种坐标下进行描述,应当根据需要选择不同的参考坐标系,并做适当的坐标变换。经常要求正向运动学和反向运动学的解,除此之外还要考虑惯性力、外力(包括重力)、哥氏力及向心力的影响。第1页/共158页(2)(2)一一个个简简单单的

2、的机机器器人人至至少少要要有有3 35 5个个自自由由度度,比比较较复复杂杂的的机机器器人人有有十十几几个个甚甚至至几几十十个个自自由由度度。每个自由度一般包含一个伺服机构,它们必须协调起来,组成一个多变量控制系统。(3)把多个独立的伺服系统有机地协调起来,使其按照人的意志行动,甚至赋予机器人一定的“智能”,这个任务只能由计算机来完成。因此,机机器器人人控控制制系系统统必必须须是是一一个个计计算机控制系统。算机控制系统。同时,计算机软件担负着艰巨的任务。第2页/共158页(4)(4)描描述述机机器器人人状状态态和和运运动动的的数数学学模模型型是是一一个个非非线线性性模模型型,随着状态的不同和外

3、力的变化,其参数也在变化,各变量之间还存在耦合。因此,仅仅利用位置闭环是不够的,还要利用速度甚至加速度闭环。系统中经常使用重力补偿、前馈、解耦或自适应控制等方法。(5)(5)机机器器人人的的动动作作往往往往可可以以通通过过不不同同的的方方式式和和路路径径来来完完成成,因因此此存存在在一一个个“最最优优”的的问问题题。较高级的机器人可以用人工智能的方法,用计算机建立起庞大的信息库,借助信息库进行控制、决策、管理和操作。根据传感器和模式识别的方法获得对象及环境的工况,按照给定的指标要求,自动地选择最佳的控制规律。第3页/共158页4.2 工业机器人控制系统的主要功能工业机器人控制系统的主要功能 1

4、.1.示教再现功能示教再现功能2.运动控制功能运动控制功能 第4页/共158页示教再现控制示教再现控制1.1.示教及记忆方式示教及记忆方式1)1)示教的方式示教的方式示示教教的的方方式式总总的的可可分分为为集集中中示示教教方方式式和和分分离离示示教教方方式式。集中示教方式就是指同时对位置、速度、操作顺序等进行的示教方式。分离示教方式是指在示教位置之后,再一边动作,一边分别示教位置、速度、操作顺序等的示教方式。当对PTP(点位控制方式)控制的工业机器人示教时,可以分步编制程序,且能进行编辑、修改等工作。但是在作曲线运动而且位置精度要求较高时,示教点数一多,示教时间就会拉长,且在每一个示教点都要停

5、止和启动,因而很难进行速度的控制。第5页/共158页对需要控制连续轨迹的喷漆、电弧焊等工业机器人进行连续轨迹控制的示教时,示教操作一旦开始,就不能中途停止,必须不中断地进行到完,且在示教途中很难进行局部修正。示教方式中经常会遇到一些数据的编辑问题,其编辑机能有如图5.1所示的几种方法。在图中,要连接A与B两点时,可以这样来做:(a)直接连接;(b)先在A与B之间指定一点x,然后用圆弧连接;(c)用指定半径的圆弧连接;(d)用平行移动的方式连接。在CP(连续轨迹控制方式)控制的示教中,由于CP控制的示教是多轴同时动作,因此与PTP控制不同,它几乎必须在点与点之间的连线上移动,故有如图5.2所示的

6、两种方法。第6页/共158页图 5.1 示教数据的编辑机能 第7页/共158页图 5.2CP控制示教举例 第8页/共158页2)2)记忆的方式记忆的方式工业机器人的记忆方式随着示教方式的不同而不同。又由于记忆内容的不同,故其所用的记忆装置也不完全相同。通常,工业机器人操作过程的复杂程序取决于记忆装置的容量。容量越大,其记忆的点数就越多,操作的动作就越多,工作任务就越复杂。最初工业机器人使用的记忆装置大部分是磁鼓,随着科学技术的发展,慢慢地出现了磁线、磁芯等记忆装置。现在,计算机技术的发展带来了半导体记忆装置的出现,尤其是集成化程度高、容量大、高度可靠的随机存取存储器(RAM)和可编程只读存储器

7、(EPROM)等半导体的出现,使工业机器人的记忆容量大大增加,特别适合于复杂程度高的操作过程的记忆,并且其记忆容量可达无限。第9页/共158页2.2.示教编程方式示教编程方式1)手把手示教编程手把手示教编程方式主要用于喷漆、弧焊等要求实现连续轨迹控制的工业机器人示教编程中。具体的方法是人工利用示教手柄引导末端执行器经过所要求的位置,同时由传感器检测出工业机器人各关节处的坐标值,并由控制系统记录、存储下这些数据信息。实际工作当中,工业机器人的控制系统重复再现示教过的轨迹和操作技能。手把手示教编程也能实现点位控制,与CP控制不同的是,它只记录各轨迹程序移动的两端点位置,轨迹的运动速度则按各轨迹程序

8、段对应的功能数据输入。第10页/共158页2)示教盒示教编程示教盒示教编程方式是人工利用示教盒上所具有的各种功能的按钮来驱动工业机器人的各关节轴,按作业所需要的顺序单轴运动或多关节协调运动,从而完成位置和功能的示教编程。示教盒通常是一个带有微处理器的、可随意移动的小键盘,内部ROM中固化有键盘扫描和分析程序。其功能键一般具有回零、示教方式、自动方式和参数方式等。示教编程控制由于其编程方便、装置简单等优点,在工业机器人的初期得到较多的应用。同时,又由于其编程精度不高、程序修改困难、示教人员要熟练等缺点的限制,促使人们又开发了许多新的控制方式和装置,以使工业机器人能更好更快地完成作业任务。第11页

9、/共158页工业机器人的运动控制工业机器人的运动控制工业机器人的运动控制是指工业机器人的末端执行器从一点移动到另一点的过程中,对其位置、速度和加速度的控制。由于工业机器人末端操作器的位置和姿态是由各关节的运动引起的,因此,对其运动控制实际上是通过控制关节运动实现的。工工业业机机器器人人关关节节运运动动控控制制一一般般可可分分为为两两步步进进行行。第第一一步步是是关关节节运运动动伺伺服服指指令令的的生生成成,即指将末端执行器在工作空间的位置和姿态的运动转化为由关节变量表示的时间序列或表示为关节变量随时间变化的函数。这一步一般可离线完成。第第二二步步是是关关节节运运动动的的伺伺服服控控制制,即跟踪

10、执行第一步所生成的关节变量伺服指令。这一步是在线完成的。第12页/共158页2 2、主要控制变量、主要控制变量 任务轴任务轴R R0 0：描述工件位置的坐标系：描述工件位置的坐标系 X(t):X(t):X(t):X(t):末端执行器状态；末端执行器状态；(t):(t):关节变量；关节变量；C C C C(t)(t)：关节力矩矢量；：关节力矩矢量；T(t)T(t)T(t)T(t)：电机力矩矢量；电机力矩矢量；V V V V(t)(t)：电机电压矢量：电机电压矢量本质是对下列双向方程的控制本质是对下列双向方程的控制：第13页/共158页4.3 工业机器人的控制方式工业机器人的控制方式 点位控制方式

11、点位控制方式(PTP)(PTP)这种控制方式的特点是只控制工业机器人末端执行器在作业空间中某些规定的离散点上的位姿。控制时只要求工业机器人快速、准确地实现相邻各点之间的运动,而对达到目标点的运动轨迹则不作任何规定。这种控制方式的主要技术指标是定位精度和运动所需的时间。由于其控制方式易于实现、定位精度要求不高的特点,因而常被应用在上下料、搬运、点焊和在电路板上安插元件等只要求目标点处保持末端执行器位姿准确的作业中。一般来说,这种方式比较简单,但是,要达到23m的定位精度是相当困难的。第14页/共158页连续轨迹控制方式连续轨迹控制方式(CP)(CP)这种控制方式的特点是连续地控制工业机器人末端执

12、行器在作业空间中的位姿,要求其严格按照预定的轨迹和速度在一定的精度范围内运动,而且速度可控,轨迹光滑，运动平稳,以完成作业任务。工业机器人各关节连续、同步地进行相应的运动,其末端执行器即可形成连续的轨迹。这种控制方式的主要技术指标是工业机器人末端执行器位姿的轨迹跟踪精度及平稳性。通常弧焊、喷漆、去毛边和检测作业机器人都采用这种控制方式。第15页/共158页图 5.3 点位控制与连续轨迹控制(a)点位控制；(b)连续轨迹控制 第16页/共158页力力(力矩力矩)控制方式控制方式在完成装配、抓放物体等工作时,除要准确定位之外,还要求使用适度的力或力矩进行工作,这时就要利用力(力矩)伺服方式。这种方

13、式的控制原理与位置伺服控制原理基本相同,只不过输入量和反馈量不是位置信号,而是力(力矩)信号,因此系统中必须有力(力矩)传感器。有时也利用接近、滑动等传感功能进行自适应式控制。第17页/共158页智能控制方式智能控制方式机器人的智能控制是通过传感器获得周围环境的知识,并根据自身内部的知识库作出相应的决策。采用智能控制技术,使机器人具有了较强的环境适应性及自学习能力。智能控制技术的发展有赖于近年来人工神经网络、基因算法、遗传算法、专家系统等人工智能的迅速发展。第18页/共158页4.4 电动机的控制电动机的控制 电动机的控制电动机的控制1.1.机器人中电动机的控制特征机器人中电动机的控制特征电动

14、机的种类各种各样,根据各自的特点,工业界早就在家电、玩具、办公仪器设备、测量仪器甚至电气铁路这样一些广泛的领域内制定了各种不同的使用方法。在这些应用中,机器人中的电动机有其自身的特点。第19页/共158页表5.1列出了机床和机器人电动机在用途上的对比情况。用于生产线上的机器人,主要承担着零件供应、装配和搬运等工作,其控制目的是位置控制。因为机器人的动作基本上是腕部的运动,所以对电动机来说,主要是惯性负载,并且还存在有重力负载。有负载运动时,电动机的速度最慢;无负载运动时,电动机的速度最快。它们的比值大体上是110,有时可以达到1100。此外,从电动机的输出功率考虑,多数为十瓦(W)到数千瓦(k

15、W)的电动机。本节只考虑小型电动机的分类。第20页/共158页2.2.电动机的选用电动机的选用电动机根据输出形式分,可以分为旋转型和直线型(如果根据采用的电源分类,则如表5.2所列)。当考虑电动机在机器人中的应用时,应主要关注电动机的如下基本性能:(1)能实现启动、停止、连续的正反转运行,且具有良好的响应特性。(2)正转与反转时的特性相同,且运行特性稳定。(3)维修容易,而且不用保养。(4)具有良好的抗干扰能力,且相对于输出来说,体积小,重量轻。第21页/共158页3.3.机器人电动机的变换器机器人电动机的变换器对于直流电动机,变换器首先将其电压和电流控制到希望的数值;对于交流电动机,电力变换

16、器首先将其电压、电流和频率控制到希望的数值,然后对电动机的速度进行控制,进而对电动机的位置进行控制。图5.4所示为电动机的种类。第22页/共158页图 5.4 电动机的种类 第23页/共158页表5.2概括了在电动机控制中采用的电力变换器的分类和主要用途。除了电车和蓄电池叉动起重车等一些特殊应用外,一般来说,不用电池和蓄电池作为直流电源,而是采用对商用的交流电进行整流后得到的直流电。把交流电变换成直流电的过程,称为顺变换,这里采用的电力变换器,称为整流电路。一般来说,由于交流方面的正弦波形畸变会引起电压的变动和感应干扰,因此应采取措施,设法保持输入电流波形的正弦波形状。所以，它不同于通常的整流

17、电路,可称之为PWM变换器。第24页/共158页4.电动机控制系统的构成电动机控制系统的构成图5.5表示了用前面讲过的电动机和电力变换器组合成的电动机控制系统的一般构成。正如前面讲过的那样,通过电力变换器,将商用电源的电压、电流和频率进行交换,然后对电动机进行控制。电动机的输出量P(W)虽然用电量表示,但它是通过减速器和传动装置(连接器、齿轮、传送带等)传送至机械系统的。这里用速度l(rad/s)和力矩TL(Nm)表示机械动力,并用下式表示它与电动机输出量P(W)的关系:P=lTL(5.1)第25页/共158页该式为电气功率与机械功率的重要关系式,并且是以SI表示的。但是,通常情况下,转速的单

18、位用r/min,力矩的单位用kgm,当采用这种单位时,式(5.1)就变成了 P=1.026lTL(5.2)第26页/共158页图 5.5 电动机控制系统的构成 第27页/共158页机器人的位置控制机器人的位置控制 由于机器人系统具有高度非线性，且机械结构很复杂，因由于机器人系统具有高度非线性，且机械结构很复杂，因此在研究其动态模型时，做如下假设：此在研究其动态模型时，做如下假设：（1 1）机器人各连杆是理想刚体，所有关节都是理想的，不存在）机器人各连杆是理想刚体，所有关节都是理想的，不存在摩擦和间隙；摩擦和间隙；（2 2）相邻两连杆间只有一个自由度，或为旋转、或为平移。）相邻两连杆间只有一个自

19、由度，或为旋转、或为平移。第28页/共158页4.2 4.2 机器人的位置控制机器人的位置控制直流传动系统的建模直流传动系统的建模1 1、传递函数与等效方框图、传递函数与等效方框图 伺服电机的参数：伺服电机的参数：第29页/共158页4.2 4.2 机器人的位置控制机器人的位置控制直流传动系统的建模直流传动系统的建模1 1、传递函数与等效方框图、传递函数与等效方框图（1 1）磁场型控制电机）磁场型控制电机第30页/共158页4.2 4.2 机器人的位置控制机器人的位置控制直流传动系统的建模直流传动系统的建模1 1、传递函数与等效方框图、传递函数与等效方框图 LaplaceLaplace变换得：

20、变换得：第31页/共158页4.2 4.2 机器人的位置控制机器人的位置控制直流传动系统的建模直流传动系统的建模1 1、传递函数与等效方框图、传递函数与等效方框图一般可取一般可取 K K K K=0=0，则有等效框图，则有等效框图同时，传递函数变为同时，传递函数变为第32页/共158页5.2 5.2 机器人的位置控制机器人的位置控制直流传动系统的建模直流传动系统的建模1 1、传递函数与等效方框图、传递函数与等效方框图 ：电气时间常数；：电气时间常数；：机械时间常数。：机械时间常数。第33页/共158页5.2 5.2 机器人的位置控制机器人的位置控制直流传动系统的建模直流传动系统的建模1 1、传

21、递函数与等效方框图、传递函数与等效方框图由于由于 ，有时可以忽略，于是，有时可以忽略，于是而对角速度的传递函数为：而对角速度的传递函数为：，因为，因为第34页/共158页5.2 5.2 机器人的位置控制机器人的位置控制直流传动系统的建模直流传动系统的建模1 1、传递函数与等效方框图、传递函数与等效方框图（2 2）电枢控制型电机）电枢控制型电机K K K Ke e:产生反电势。产生反电势。第35页/共158页5.2 5.2 机器人的位置控制机器人的位置控制直流传动系统的建模直流传动系统的建模1 1、传递函数与等效方框图、传递函数与等效方框图 经拉氏变换、并设经拉氏变换、并设K K K K=0=0

22、，有，有第36页/共158页5.2 5.2 机器人的位置控制机器人的位置控制直流传动系统的建模直流传动系统的建模2 2、直流电机的转速调整、直流电机的转速调整误差信号：误差信号：第37页/共158页5.2 5.2 5.2 5.2 机器人的位置控制机器人的位置控制机器人的位置控制机器人的位置控制直流传动系统的建模2 2、直流电机的转速调整、直流电机的转速调整 比例补偿：控制输出与比例补偿：控制输出与e(t)e(t)成比例；成比例；微分补偿：控制输出与微分补偿：控制输出与de(t)/dtde(t)/dt成比例；成比例；积分补偿：控制输出与积分补偿：控制输出与e(t)dte(t)dt成比例；成比例；

23、测速补偿：与输出位置的微分成比例。测速补偿：与输出位置的微分成比例。比例微分比例微分PDPD补偿：补偿：比例积分比例积分PIPI补偿：补偿：比例微分积分比例微分积分PIDPID补偿：补偿：测速补偿时：第38页/共158页5.2 5.2 机器人的位置控制机器人的位置控制位置控制的基本结构位置控制的基本结构1 1、基本控制结构、基本控制结构 位置控制也称位置控制也称位姿控制位姿控制、或、或轨迹控制轨迹控制。分为：。分为：点到点点到点PTPPTP控制；如点焊；控制；如点焊；连续路径连续路径CPCP控制；如喷漆控制；如喷漆 期望的关节位置期望的关节位置 期望的工具位置和姿态期望的工具位置和姿态第39页

24、/共158页5.2 5.2 机器人的位置控制机器人的位置控制位置控制的基本结构位置控制的基本结构2 2、PUMAPUMAPUMAPUMA机器人的伺服控制结构机器人的伺服控制结构 1 1）机器人控制系统设计与一般计算机控制系统相似。）机器人控制系统设计与一般计算机控制系统相似。2 2）多数仍采用连续系统的设计方法设计控制器，然后再将）多数仍采用连续系统的设计方法设计控制器，然后再将设计好的控制律离散化，用计算机实现。设计好的控制律离散化，用计算机实现。3 3）现有的工业机器人大多数采用独立关节的）现有的工业机器人大多数采用独立关节的PIDPID控制。控制。下图下图PUMAPUMA机器人的伺服控制

25、系统构成机器人的伺服控制系统构成 第40页/共158页5.2 5.2 机器人的位置控制机器人的位置控制位置控制的基本结构位置控制的基本结构2 2、PUMAPUMAPUMAPUMA机器人的伺服控制结构机器人的伺服控制结构 第41页/共158页5.2 5.2 机器人的位置控制机器人的位置控制单关节位置控制器单关节位置控制器1 1、位置控制系统结构、位置控制系统结构具有力、位移、速度反馈具有力、位移、速度反馈 第42页/共158页5.2 5.2 机器人的位置控制机器人的位置控制单关节位置控制器单关节位置控制器1 1、位置控制系统结构、位置控制系统结构 控制器路径点的获取方式：控制器路径点的获取方式：

26、（1 1）以数字形式输入系统；若以直角坐标给出，须计算获）以数字形式输入系统；若以直角坐标给出，须计算获 得其关节坐标位置。得其关节坐标位置。（2 2）以示教方式输入系统；系统将直接获得关节坐标位置）以示教方式输入系统；系统将直接获得关节坐标位置 允许机器人只移动一个关节，而锁住其他关节。允许机器人只移动一个关节，而锁住其他关节。轨迹控制：轨迹控制：按关键点或轨迹进行定位控制。按关键点或轨迹进行定位控制。第43页/共158页5.2 5.2 机器人的位置控制机器人的位置控制单关节位置控制器单关节位置控制器2 2、单关节控制器的传递函数、单关节控制器的传递函数 对图示系统，有对图示系统，有J J

27、J J：等效转动惯量；等效转动惯量；B B B B：等效阻尼系数。等效阻尼系数。第44页/共158页5.2 5.2 机器人的位置控制机器人的位置控制单关节位置控制器单关节位置控制器2 2、单关节控制器的传递函数、单关节控制器的传递函数 因此可得其传递函数（同电枢控制直流伺服电机）因此可得其传递函数（同电枢控制直流伺服电机）第45页/共158页5.2 5.2 机器人的位置控制机器人的位置控制单关节位置控制器单关节位置控制器2 2、单关节控制器的传递函数、单关节控制器的传递函数 第46页/共158页5.2 5.2 机器人的位置控制机器人的位置控制单关节位置控制器单关节位置控制器2 2、单关节控制器

28、的传递函数、单关节控制器的传递函数 其开环传递函数为：其开环传递函数为：因为：因为：，略去，略去L Lm m的项，简化上式为：的项，简化上式为：第47页/共158页5.2 5.2 机器人的位置控制机器人的位置控制单关节位置控制器单关节位置控制器2 2、单关节控制器的传递函数、单关节控制器的传递函数 则其闭环传递函数为：则其闭环传递函数为：这是一个典型的二阶系统闭环传递函数。这是一个典型的二阶系统闭环传递函数。第48页/共158页5.2 5.2 机器人的位置控制机器人的位置控制单关节位置控制器单关节位置控制器2 2、单关节控制器的传递函数、单关节控制器的传递函数 第49页/共158页5.2 5.

29、2 机器人的位置控制机器人的位置控制单关节位置控制器单关节位置控制器2 2、单关节控制器的传递函数、单关节控制器的传递函数 含有速度反馈的机械手单关节控制器的开环传递函数为含有速度反馈的机械手单关节控制器的开环传递函数为 闭环传递函数为闭环传递函数为第50页/共158页5.2 5.2 机器人的位置控制机器人的位置控制单关节位置控制器单关节位置控制器3 3、控制参数确定与稳态误差、控制参数确定与稳态误差（1 1）的确定的确定由上述闭环传递函数，得控制系统的特征方程为：由上述闭环传递函数，得控制系统的特征方程为：将其写为二阶系统标准形式将其写为二阶系统标准形式得得第51页/共158页5.2 5.2

30、 机器人的位置控制机器人的位置控制单关节位置控制器单关节位置控制器3 3、控制参数确定与稳态误差、控制参数确定与稳态误差（1 1）的确定的确定第52页/共158页5.2 5.2 机器人的位置控制机器人的位置控制单关节位置控制器单关节位置控制器3 3、控制参数确定与稳态误差、控制参数确定与稳态误差（1 1）的确定的确定第53页/共158页5.2 5.2 机器人的位置控制机器人的位置控制单关节位置控制器单关节位置控制器3 3、控制参数确定与稳态误差、控制参数确定与稳态误差（1 1）的确定的确定 设结构的共振频率为设结构的共振频率为 ，则为避免运动中发生共振，要求，则为避免运动中发生共振，要求同时要

31、求系统阻尼大于同时要求系统阻尼大于1 1，J J值随负载和位姿变化，应选可能的最大惯量。值随负载和位姿变化，应选可能的最大惯量。第54页/共158页5.2 5.2 机器人的位置控制机器人的位置控制单关节位置控制器单关节位置控制器3 3、控制参数确定与稳态误差、控制参数确定与稳态误差（2 2）稳态误差）稳态误差 根据控制理论，在控制系统框图中，计算得到根据控制理论，在控制系统框图中，计算得到E(s),E(s),即可即可得到系统的稳态位置误差、速度误差和加速度误差。得到系统的稳态位置误差、速度误差和加速度误差。对于单位阶越位移对于单位阶越位移C C C C0 0，其稳态误差为，其稳态误差为 第55

32、页/共158页5.2 5.2 机器人的位置控制机器人的位置控制多关节位置控制器多关节位置控制器 1 1）为快速运动，一般应采用多关节协调、同步运动。）为快速运动，一般应采用多关节协调、同步运动。2 2）这时各关节的位置和速度会互相作用，因此，必须进行附加补偿。）这时各关节的位置和速度会互相作用，因此，必须进行附加补偿。1 1、动态拉格朗日公式、动态拉格朗日公式 其他关节加速其他关节加速 自身加速自身加速 科式力科式力 重力重力且且D D项皆与关节角有关。项皆与关节角有关。第56页/共158页5.2 5.2 机器人的位置控制机器人的位置控制多关节位置控制器多关节位置控制器 第57页/共158页电

33、动机速度的控制电动机速度的控制1.直流电动机的速度与转矩的关系直流电动机的速度与转矩的关系直流电动机依据图5.4中表示的磁场与电枢连接方式的不同,有他激、并激、串激和复激电动机等类型。在机器人中，他激电动机中采用永久磁铁的电机用得较多，所以本节只对这种电机进行说明。现在我们根据电机学原理,当设电动机的速度为m(rads),电动机电枢的电压、电流、电阻分别为U(V)、I(A)、R(),电动势系数为KE时,它们之间满足下列关系:(5.3)第58页/共158页式中,Vb称为电刷电压降,通常为23V,多数情况下可以忽略不计;但在外加电压比较小的电动机中,则必须予以考虑。另一方面,对于转矩Tm(Nm),

34、若设转矩系数为KT(Nm/A)时,可求得转矩为 Tm=KT(I-I0)式中,I0为轴等零件上承受的摩擦转矩的换算值,多数情况下可以忽略不计,但是当电动机的输出比较小时,就不能忽略不计。于是,从上述两式中消去电枢电流后,电动机的速度与转矩之间的关系可以用下式表示:(5.5)(5.4)第59页/共158页由式(5.5)可以看出,电电动动机机的的速速度度相相对对于于转转矩矩成成直直线线关关系系减减小小,其减小的比例显然由电枢的电阻、电动势系数和转矩系数决定。另外,在表5.3中表示了三种直流电动机的产品目录,它们是一些具有代表性的产品。这里若以电动机B为例,首先应注意式(5.3)中的单位,再将额定值代

35、入式(5.3),于是可以确定电刷上的电压降 66.5=7.41.03+0.01873000+UbUb=2.73(V)第60页/共158页此外,将额定值代入式(5.4)时,即可求出轴上承受的摩擦转矩的电流换算值。将这些值代入式(5.5),即可求出这个电动机的转矩与速度的关系,其形式为(5.6)因此,当用这个电动机驱动机器人手臂,并且希望产生的转矩为0.85Nm、电动机旋转速度为2200r/min时,对这个电动机应该施加的电压和电流,可以依据下列方法予以确定:第61页/共158页首先,将转矩和转速代入式(5.6),并且注意式中的单位,于是可以确定外加电压为 电流可以根据式(5.4)计算得到,其值为

36、 第62页/共158页一般来说,对于机器人,由于动作和姿态的不同,对电动机的速度和转矩的要求也不同,因此,电电动动机机的的外外加加电电压压和和电流也必须时刻作相应的变化电流也必须时刻作相应的变化。另外,直流电动机存在着电刷与整流子的维护以及防止火花的问题。为了能保持电动机原来的控制特性,消除因电刷和整流子引发的问题,已经开发出无刷直流电动机,并且正在进入实用化阶段。第63页/共158页图 5.6 直流电动机速度与转矩特性第64页/共158页2.2.直流电动机速度的控制直流电动机速度的控制前面我们用式(5.6)给出了表5.3中电动机B的速度与转矩的关系。图5.6表示的是改变端电压U时,得到的直流

37、电动机速度与转矩特性。在图5.6中,速度和转矩都用相对于额定值的百分率来表示。由这个图可以明显地看出,由于一方面要产生期望的转矩,另一方面还要实现期望的速度,因此必须对端电压进行调整。第65页/共158页图5.7是一个可用于可逆运转的四四象象限限短短路路器器原原理理图图。在图中的四个开关中,当S1与S4接通时,P、Q点的电位分别变成US、0,因此端子上的电压为US。当S1与S3处于接通状态时,P、Q点上的电位相同,端子上的电压为0。同样地,当设S2处于接通状态并接通S3时,则P、Q点的电位分别变成0、VS,因此端子上的电压为-VS。S2和S4接通时,端子上的电压为0。因此,当按照图(b)中那样

38、实施对开关的接通与断开时,端子上的电压将会变成如图中表示的那样,这是容易理解的。这里定义斜线位置上的两个开关一同接通的时间T1,与周期T的比为流通率流通率d,即(5.7)第66页/共158页图5.7还表明,S1和S2决定端子上电压的极性,S3和S4决定流通率。电动机平均端子电压的大小由下式决定:U=dUS(5.8)利用这个断路器,可以使电源与电动机上电流的流动是双向的。另外,作为一种电压控制方法,可以先接通S1和S4,随后接通S2和S3,根据适当的流通率,重复地进行上述接通操作。第67页/共158页图 5.7 四象限断路器电路及其操作波形 第68页/共158页电动机和机械的动态特性分析电动机和

39、机械的动态特性分析1.电动机和机械的动态特性的表示电动机和机械的动态特性的表示如果电动机产生的转矩Tm大于负载的反作用转矩TL,则会产生加速运动;反之,则会产生减速运动;如果两者处于平衡状态,则系统会以一定速度进行稳定的工作。现在如果设换算到电动机轴上的全部转动惯量为J,黏性摩擦系数为D,负载力矩为TLm,则这个机械系统的运动方程式可以由下式给出:(5.16)第75页/共158页图 5.11 减速器第76页/共158页多数驱动系统都采用了如图5.11所示的减速器。若设图中电动机和负载的速度为m和L,并且设减速器的效率为100%时,则齿数比定义如下:(5.17)这时,负载一侧的运动方程式变成式(

40、5.16)的形式,且可以写成(5.18)第77页/共158页从电动机轴观察到力矩为负载力矩的1/a,而负载一侧的机械常数则变为原来的(1/a)2。因此,这时电动机的转动惯量和黏性摩擦系数应分别进行相加,并且必须对式(5.16)中的J、D进行设置。此外,在实际计算中,多数情况下可以忽略黏性摩擦系数。第78页/共158页2.2.直流电动机的启动和停止直流电动机的启动和停止图5.12表示了电动机的加减速状态。直流电动机的电枢电流在加速过程中应控制在一定的数值Icon。这时,运动方程式可以根据式(5.4)和式(5.16)得到,并且可以表示成(5.20)将上式从时间t1到时间t2进行积分,得到关系式(5

41、.21)第79页/共158页图 5.12 电动机的加减速 第80页/共158页这里考虑从0速度到额定速度r的启动时间TS,于是在式(5.21)中,当设1=0时,可以得到(5.22)当希望机器人进行快速运动而选定电动机时,选择转动惯量小且转矩系数大的电动机比较好。基于这种原因,机器人用的电动机大都选用细长型构造,而且选用稀土类磁铁。此外,在确定电动机时,应该根据式(5.22)在大范围内设定加减速时的电流,其结果是增大了电力变换器的容量。第81页/共158页正确控制动态特性正确控制动态特性1.1.力控制力控制为了能对转矩进行控制,可在机械轴上安装转矩检测器,以构成一个反馈系统。但要得到性价比高、体

42、积小、频率特性好的转矩检测器则比较困难。另外,在直流他激电机、无刷电机和向量控制感应电机中,转矩和电流之间存在比例关系。为了得到期望的转矩,需采用电流传感器。霍尔元件的电流传感器因其价格低、体积小、频率特性好,所以这种电流传感器在实践中得到了广泛应用。第85页/共158页图5.13是采用断路器的直流他激电动机的力控制系统的构成原理图。设用电动机的转矩系数Kr除转矩指令T*,得到的结果为电流指令i*,如果使实际的电动机电流i与i*基本一致,那么电动机就能够产生与转矩指令T*相同的转矩。因此,如图5.13所示,可以把由电流传感器检测得到的实际电动机电流i与电流指令i*比较,得到电流误差:第86页/

43、共158页图 5.13 力控制系统的构成原理图 第87页/共158页在这种方法中,根据图5.14(a)中表示的三角波信号SW和i的大小关系,生成断路器的开关信号。三角波比较法的原理在图5.14(b)中清楚地表示了出来。断路器的开信号依据下列规律发生:(5.30)因此,在(1)的期间,如果i小于i*,则i增加,其结果是在(2)的期间断路器信号的流通率增大,电动机外加电压上升,i增大。当i过分增大时,i减小,于是像(3)期间那样,流通率减小,电流i减小。为了提高i对i的跟踪特性,可增大三角波的频率,根据断路器开关元件的不同,通常其频率限制在数千赫到十几千赫范围内。第88页/共158页图 5.14

44、三角波比较法的原理 第89页/共158页2.2.速度控制速度控制在前面的式(5.16)中研究了机械系统的运动方程,这里当我们忽略黏性摩擦系数,且相对于负载转矩电动机产生的转矩增加时,加速度变为正值,电动机的旋转速度上升。反之,当转矩减小时,加速度变为负值,电动机的旋转速度下降。电动机的速度控制系统构成如图5.15所示,是由转矩控制来实现的,速度控制环路配置在转矩控制环路的外侧。第90页/共158页图 5.15 速度控制系统 第91页/共158页采用以测速发电机和编码器为代表的速度传感器,可以检测出电动机的旋转速度。这个速度用来与速度指令*m进行比较。这里将产生的速度误差m返回到速度控制部分,并

45、且通过转矩指令T*的增减,力图使速度指令与实际速度达到一致。速度控制部分采用PI控制,即比例积分控制:(5.31)在式(5.31)中,用速度误差m乘以增益Kp的结果,与速度误差的积分值乘以增益K1的结果进行相加,就给出了产生转矩指令的一种方法。通过对Kp与K1的选定,可以实现所希望的速度控制响应。第92页/共158页3.3.位置控制位置控制电动机轴的旋转通过同步传送皮带和滚珠丝杠传送至机器人的机构部分,转换成位置的变化。在这种情况下,如果把机械系统的运动全部换算到电动机轴上,则可以理解,最终会以下列电动机转速的积分形式求出位置:(5.32)因此,为了使实际位置跟踪目标位置*,应当根据由*和决定

46、的位置误差,对电动机的速度进行调整,于是如图5.16所示,即将位置控制器配置到了速度环的外侧。第93页/共158页图 5.16 位置控制系统 第94页/共158页在图5.16中,将分相器和绝对编码器检测出的电动机轴位置与位置指令进行比较,再经过与节中4小节对应的作为半闭环系统的位置控制器,产生速度控制指令,构成如图5.15所示的速度控制系统的输入。在位置控制器中,一般都采用比例控制方法得到速度指令,多数情况下其形式为(5.33)但是在机器人的控制中,位置指令常常由系统前面的函数形式给出,如图5.17中虚线表示的那样,将位置指令的微分形式叠加到速度指令上,同时采用了前馈控制。这种复合控制形式也是

47、经常采用的。第95页/共158页图 5.17 位置、速度与转矩的关系 第96页/共158页5.5 机械系统的控制机械系统的控制 机器人手指位置的确定机器人手指位置的确定图5.18表示的是机器人的位置决定机构。电动机轴的驱动力通过减速器(齿轮)传递到滚珠丝杠,然后由滚珠丝杠的旋转运动变换成滚珠螺母的直线运动。这里对电动机轴的位置和速度进行检测,以取代对机器人手指的位置和速度进行测定,然后采用半闭环方式对执行器进行控制。因此,将检测出的电动机的电流、速度和位置传送到控制器，在控制器中形成电压指令，由驱动器进行功率放大后，再驱动执行电机。第97页/共158页图 5.18 由机器人决定的位置控制 第9

48、8页/共158页设计方法设计方法可以按照下列要求来说明位置控制的设计方法:(1)设可移动范围为300mm,滚珠丝杠的节距(每一转的进给量)为5mm。(2)设工件(被搬运物体)的最大质量为9kg。(3)设确定位置的精度为0.01mm。(4)加速和减速按照图5.19表示的形式进行。(5)采用直流电动机。第99页/共158页图 5.19 速度模式 第100页/共158页电动机电动机1.从电动机轴的方向观察到的负载转动惯量从电动机轴的方向观察到的负载转动惯量JL设横向移动的质量m为10kg,其中工件的最大质量为9 kg,其他附加的质量为1kg。电动机一侧齿轮的转动惯量J1=110-2kgcm2,滚珠丝

49、杠及滚珠丝杠一侧齿轮的组合转动惯量J2=110-1kgcm2,减速比为Z1/Z2=110,滚珠丝杠的节距P为5 mm,于是,JL可以表示为(5.34)第101页/共158页2.负载转矩负载转矩TL接着求施加到电动机上的负载力矩TL。设动摩擦力矩Tf为2Ncm,静摩擦力矩Tf0为4 Ncm,又设电动机的转动惯量为0.3kgcm2。因为是在50ms内加速到3000r/min,所以必须的加速度可由下式计算得到:(5.35)加速所需要的转矩T1可以由下式求得:T1=(Jm+JL)=(0.3+0.012)10-46283=19.6(Nm)(5.36)第102页/共158页 开始运动时的负载力矩T2可以由

50、T1+Tf0求得,于是得出:T2=T1+Tf0=19.6+4=23.6(Ncm)加速时的负载力矩T3可以由T1+Tf求得,于是得出:T3=T1+Tf=19.6+2=21.6(Ncm)恒速时的负载力矩T4可以由Tf构成,于是得出:T4=Tf=2(Ncm)减速时的负载力矩T5可以由-T1+Tf求得,于是得出:T5=-T1+Tf=-19.6+2=-17.6(Ncm)(5.40)(5.39)(5.38)(5.37)第103页/共158页图 5.20 负载力矩TL的变化 第104页/共158页 3.电动机的选定电动机的选定 当电动机的速度-转矩特性由图5.21给出时,有必要检验这个电动机是否满足前面的设