第三章_机器人的控制基础

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