搜索
第三章机器人的控制基础§3.1概述一、机器人控制系统的特点和一般的伺服系统或过程控制系统相比，机器人控制系统有如下特点：1)机器人的控制与机构运动学及动力学密切相关。机器人手足的状态可以在各种坐标下进行描述，应当根据需要，选择不同的参考坐标系，并做适当的坐标变换。经常要求解运动学正问题和逆问题，除此之外还要考虑惯性力、外力及哥氏力、向心力的影响。一、机器人控制系统的特点2)一个简单的机器人也至少有3~5个自由度，比较复杂的机器人有十几个、甚至几十个自由度。每个自由度一般包含一个伺服机构，它们必须协调起来，组成一个多变量控制系统。3)把多个伺服系统有机地协调起来，使其按照人的意志行动，甚至赋予机器人一定的“智能”，这个任务只能由计算机完。因此，机器人控制系统必须是一个计算机控制系统。同时，计算机软件担负着艰巨的任务。一、机器人控制系统的特点4)描述机器人状态和运动的数学模型是一个非线性模型，随着状态的不同和外力的变化，其参数也在变化，各变量之间还存在耦合。因此，仅仅利用位置闭环是不够的，还要利用速度闭环甚至加速度闭环。系统中经常使用重力补偿、前馈、解耦或自适应控制等方法。5)机器人的动作往往可以通过不同的方式和路径来完成，因此存在一个“最优”的问题。较高级的机器人可以用人工智能的方法，用计算机建立庞大的信息库，借助信息库进行控制、决策、管理和操作。根据传感器和模式识别的方法获得对象及环境的工况，按照给定的指标要求，自动地选择最佳的控制规律。二、机器人的控制方式１．点位式很多机器人要求能准确地控制末端执行器的工作位置，而路径却无关紧要。例如，在印制电路板上安插元件、点焊、装配等工作，都属于点位式工作方式。一般来说这种方式比较简单，但是要达到2~3微米的定位精度也是相当困难的。二、机器人的控制方式２．轨迹式在弧焊、喷漆、切割等工作中，要求机器人末端执行器按照示教的轨迹和速度运动。如果偏离预定的轨迹和速度，就会使产品报废。其控制方式类似于控制原理中的跟踪系统，可称之为轨迹伺服控制。二、机器人的控制方式３．力（力矩）控制方式在完成装配、抓放物体等工作时，除要准确定位之外，还要求使用适度的力或力矩进行工作，这时就要利用力（力矩）伺服方式。这种方式的控制原理与位置伺服控制原理基本相同，只不过输入量和反馈量不是位置信号，而是力（力矩）信号，因此系统中必须有（力矩）传感器。有时也利用接近、滑动等传感器进行自适应控制。４．智能控制方式三、机器人控制的基本单元１．电动机作为驱动机器人运动的驱动力，常见的有液压驱动、气压驱动、直流伺服电动机驱动、交流伺服电动机驱动和步进电动机驱动。随着驱动电路元件的性能提高，当前应用最多的是直流伺服电动机驱动和交流伺服电动机驱动。２．减速器减速器是为了增加驱动力矩、降低运动速度。三、机器人控制的基本单元３．驱动电路由于直流伺服电动机或交流伺服电动机的流经电流较大，一般为几安培到几十安培，机器人电动机的驱动需要使用大功率的驱动电路，为了实现对电动机运动特性的控制，机器人常采用脉冲宽度调制(PWM)方式进行驱动。４．运动特性检测传感器机器人运动特性传感器用于检测机器人运动的位置、速度、加速度等参数。三、机器人控制的基本单元５．控制系统的硬件机器人的控制系统是以计算机为基础的，机器人控制系统的硬件系统采用的是二级结构，第一级为协调级，第二级为执行级。协调级实现对机器人各个关节的运动，实现机器人和外界环境的信息交换等功能，执行级实现机器人的各个关节的伺服控制，获得机器人内部的运动状态参数等功能。６．控制系统的软件机器人的控制系统软件实现对机器人运动特性的计算、机器人的智能控制和机器人与人的信息交换等功能。§3.2伺服电动机的原理与特性一、直流电动机的工作原理一、直流电动机的工作原理上页图所示为一台最简单的直流电动机模型，N和S是一对固定的磁级（一般是电磁铁，也可以是永久磁铁），磁极之间有一个可以转动的铁质圆柱体，称为电枢铁心，铁心表面固定一个用绝缘导体构成的电枢线圈abcd，线圈的两端分别接到相互绝缘的两个弧形铜片上，弧形铜片称为换向片，他们的组合体称为换向器。在换向器上放置固定不动而与换向片滑动接触的电刷A和B，线圈abcd通过换向器和电刷接通外电路。电枢线圈和换向器构成的整体称为电枢。一、直流电动机的工作原理此模型作为直流电动机运行时，将直流电源加于电刷A和B。例如将电源正极加于电刷A，电源负极加于电刷B，则线圈abcd中流过电流，在导体ab中，电流由a流向b，在导体cd中，电流由c流向d。载流导体ab和cd均处于N、S极之间，受到电磁力的作用，电磁力的方向用左手定则确定，可知这一对电磁力形成一个转矩，称为电磁转矩，转矩的方向为逆时针方向，使整个电枢逆时针方向旋转。当电枢旋转1800时，导体cd转到N极下，ab转到S极下，由于电流仍从电刷A流入，使cd中的电流变为由d流向c，而ab中的电流由b流向a，从电刷B流出，用左手定则判别可知，电磁转矩的方向仍是逆时针。由此可见加于直流电动机的直流电源，借助于换向器和电刷的作用，是直流电动机电枢线圈中流过的电流，方向是交变的，从而使电枢产生的电磁转矩方向恒定不变，确保直流电动机朝确定的方向连续旋转，这就是直流电动机工作原理。二、直流电动机的结构和额定值1．直流电动机的结构二、直流电动机的结构和额定值２．直流电动机额定值(1)额定功率额定功率是指按照规定的工作方式运行时所能提供的输出功率。对电机来说，额定功率是指轴上输出的机械功率，单位为kW。(2)额定电压额定电压是电动机电枢绕组嫩够安全工作的最大外加电压或输出电压，单位为V。(3)额定电流额定电流是指电动机按照规定的工作方式运行时，电枢绕组允许流过的最大电流，单位为A.(4)额定转速额定转速是指电动机在额定电压、额定电流和输出额定功率的情况下运行时，电动机的转速，单位为r/min。三、直流伺服电动机传统型：也即是微型的他励直流电动机，它由定子、转子两部分组成。按定子磁极的种类分为两种，永磁式和电磁式。永磁式的磁极是永久磁铁；电磁式的磁极是电磁铁，磁极外面套着励磁绕组。低惯量型：特点是转子轻、转动惯量小、快速响应好。按照电枢型式的不同分为盘形电枢直流伺服电动机、空心杯电枢永磁式直流伺服电动机及无槽电枢直流伺服电动机。三、直流伺服电动机如图所示，盘型电枢直流伺服电动机的定子是由永久磁铁和前后磁扼组成，转轴上装有圆盘，圆盘上有电枢绕组，可以是印制组，也可以是绕线式绕组，电枢绕组中的电流沿径向流过圆盘表面，与轴向磁通相互作用产生转矩。三、直流伺服电动机如图所示，空心杯电枢永磁式直流伺服电动机有一个外定子和一个内定子。外定子是两个半圆形的永久磁铁，内定子由圆柱形的软磁铁材料做成，空心杯电枢置于内外定子之间的圆周气隙中，并直接安装在电动机轴上。当电枢绕组流过一定的电流时，空心杯电枢能在内外定子间的气隙中旋转，并带动电动机旋转。三、直流伺服电动机在电枢控制方式下，直流伺服电动机的主要静态特性是机械特性和调节特性。１．机械特性机械特性是指控制电压恒定时，电动机的转速随转矩变化的关系，直流伺服电动机的机械特性可以用下式表达：１．机械特性由式可知，当Ua不同时，机械特性为一组平行直线如下页图a所示，当Ua一定时，随着转矩T的增加，转速n成正比例下降。随着控制电压Ua的降低，机械特性平行的向低速度、小转矩方向平移，其斜率保持不变。２．调节特性调节特性是指转矩恒定时，电动机的转速随控制电压变化的关系。当T为不同值时调节特性为一组平行线，如右图所示。当T一定时,控制电压高则转速也高，转速的增加与控制电压的增加成正比，这是理想的调节特性。２．调节特性调节特性曲线与横坐标的焦点(n=0),就表示在一定负载转矩时的电动机的始动电压.在该转矩下,电动机的控制电压只有大于相应的电压时,电动机才能起动。理想空载时，始动电压为零，它的大小决定于电动机的空载制动转矩.空载制动转矩大,始动电压也大.当电动机带动负载时，始动电压随负载转矩的增大而增大。四、交流伺服电动机交流伺服电动机为两相异步电动机，定子两相绕组在空间相距900电角度，一相为励磁绕组，运行时接至电压为Uf的交流电源上；另一相为控制绕组，输入控制电压为Uc，Uc与为同频率的交流电压，转子为笼型。和直流伺服电动机一样，交流伺服电动机也必须具有宽广的调速范围、线性的机械特性和快速响应等性能，还应无“自转”现象。四、交流伺服电动机为了使转子具有较大的电阻和较小的转动惯量，交流伺服电动机的转子有３种类型结构式：(1)高电阻率导条的笼型转子这种转子的结构同普通笼式异步电动机一样，只是转子细而长，笼导条和端环采用高电阻率的导电材料(如黄铜、青铜等)制造，国内生产的SL系列的交流伺服电动机就是采用这种结构。(2)非磁性空心杯转子在外定子铁心槽中放置空间相距900的两相分布绕组；内定子铁心由硅钢片叠成，不放绕组，仅作为磁路的一部分；由铝合金制成的空心杯转子置于内外定子铁心之间的气隙中，并靠其底盘和转轴固定。四、交流伺服电动机(3)铁磁性空心转子转子采用铁磁材料制成，转子本身既是主磁通的磁路，又作为转子绕组，结构简单，但当定子、转子气隙稍微不均匀时，转子就容易因单边磁拉力而被“吸住”，所以目前较少用。§3.3伺服电动机调速的基本原理调速即速度调节或速度控制，是指通过改变电动机的参数、结构或外加电器量(如供压、电流的大小或者频率)来改变电动机的速度，以满足工作机械的要求。调速要靠改变电动机的机械特性来实现。如图为调速时的特性曲线，其中工作机械即负载的特性曲线为ML，通过调整装置改变的电动机特性曲线为M1、M2、M3与线M1的交点分别为1、2、3。与之相对应的角速度为Ω1、Ω2、Ω3，即电动机将有不同的角速度，实现了调速。如果不改变电动机的特性，而靠改变负载转矩虽然也可以使速度变化，如图所示，负载转矩由ML1增加到ML2或ML3，虽然也可以使电动机速度降低，但这不是调速，而是负载扰动，在实际使用中我们不希望出现这种情况，这是稳速控制的主要问题。一、稳态精度１．速度变化率（静差率）２．调速精度３．稳速精度二、调速范围在满足稳态精度的要求下，电动机可能达到的最高角速度Ωmax和最低角速度Ωmin的比定义为调速范围。§3.4单关节机器人的伺服系统建模一、开环控制系统和闭环控制系统开环控制系统是最基本的，它是由手动控制基础上发展起来的控制系统。如上图所示的电动机控制系统为开环控制系统的框图。一、开环控制系统和闭环控制系统开环控制调速系统的输入量vi由手动调节，也可由上一级控制装置给出。系统的输出量是电动机的转动角度Ө。如图，系统只有输入量的前后给定控制作用，输出量（或者被控量）没有反馈影响输入量，即输出量没有反馈到输入端参与控制作用。且输入量到输出量控制作用是单方向传递，所以称为开换控制量。一、开环控制系统和闭环控制系统闭环控制系统：二、模拟控制系统模拟控制是指控制系统中传递的信号是时间连续信号。与模拟控制相对应的是数字控制，在这种系统中，除某些环节传递的仍是连续信号外，另一些环节传递的信号则是时间的断续信号，即离散的脉冲序列或数字编码。这类系统又称为采样系统或计算机控制系统。模拟控制是最早发展起来的控制系统，但当被控对象具有明显滞后特性时，这种控制就不适用，因为它容易引起系统的不稳定，又难以选择时间常数很大的教正装置来解决系统的不稳定问题。采用数字控制效果好得多。如图是采样控制的原理图，采样开关周期性地接通和断开。S接通时系统放大系数可以很大，进行调节和控制；S端开时等待被控对象自身去运行，指导下一次接通采样开关时，才检测误差，并根据它来继续对被控对象进行控制。这样从控制过程的总体看，系统的平均放大系数小，容易保证系统稳定，但从开关接通的调节看，系统的放大系数很大，可以保证稳态的精度。三、伺服系统的动态参数１．伺服系统的几个动态参数(1)超调量(2)转矩变化的时间响应(3)阶跃输入的转速响应时间(4)建立时间(5)频带宽度１．伺服系统的几个动态参数a)转速初使值为零b)转速初使值不为零2．伺服系统的几个主要问题(1)稳态