1、第二章 机器人系统简介2.1 机器人的运动机构（执行机构）机器人的运动机构是机器人实现对象操作及移动自身功能的载体，可以大体分为操作手（包括臂和手）和移动机构两类。对机器人的操作手而言，它应该象人的手臂那样，能把（抓持装工具的）手依次伸到预定的操作位置，并保持相应的姿态，完成给定的操作；或者能够以一定速度，沿预定空间曲线移动并保持手的姿态，并在运动过程中完成预定的操作。移动机构应能将机器人移动到任意位置，并保持预定方位姿势。为此，它应能实现前进、后退、各方向的转弯等基本移动功能。在结构上它可以象人、兽、昆虫，具有二足、四足或六足的步行机构，也可以象车或坦克那样采用轮或履带结构2.1.1 机器人
2、的臂结构机器人的臂通常采用关节连杆链形结构，它由连杆和连杆间的关节组成。关节，又称运动副，是两个构件组成相对运动的联接。在关节的约束下，两连杆间只能有简单的相对运动。机器人中常用的关节主要有两类：(1) 滑动关节(Prismatic joint): 与关节相连的两连杆只能沿滑动轴做直线位移运动，移动的距离是滑动关节的主要变量，滑动轴一般和杆的轴线重合或平行。(2)转动关节(Revolute joint): 与关节相连的两连杆只能绕关节轴做相对旋转运动，其转动角度是关节的主要变量，转动轴的方向通常与轴线重合或垂直 。杆件和关节的构成方法大致可分为两种：(1) 杆件和手臂串联连接，开链机械手(2)
3、 杆件和手臂串联连接，闭链机械手。以操作对象为理想刚体为例，物体的位置和姿态各需要 3 个独立变量来描述。我们将确定物体在坐标系中位姿的独立坐标数目称为自由度（DOF（degreeof freedom）。而机器人的自由度是由有关节数和每个关节所具有的自由度数决定的（每个关节可以有一个或多个自由度，通常为 1 个）。机器人的自由度是独立的单独运动的数目，是表示机器人运动灵活性的尺度。（由驱动器能产生主动动作的自由度称为主动自由度，不能产生驱动力的自由度称为被动自由度。通常开链机构仅使用主动自由度）机器人自由度的构成，取决于它应能保证完成与目标作业相适应的动作。分析可知，为使机器人能任意操纵物体的
4、位姿，至少须6DOF，通常用三个自由度确定手的空间位置（手臂），三个自由度确定手的姿态（手）。比较而言，人的臂有七个自由度，手有二十个自由度，其中肩 3DOF，肘2 DOF，碗 2DOF。这种比 6 还多的自由度称为冗余自由度。人的臂由于有这样的冗余性，在固定手的位置和姿态的情况下，肘的位置不唯一。因此人的手臂能灵活回避障碍物。对机器人而言，冗余自由度的设置易于增强运动的灵活性，但由于存在多解，需要在约束条件下寻优，计算量和控制的难度相对增大。典型的机器人臂结构有以下几种：(1)直角坐标型(Cartesian/rectanglar/gantry) (3P) 由三个线性滑动关节组成。 三个关节的
5、滑动方向分别和直角坐标轴 x,y,z 平行。 工作空间是个立方体(2)圆柱坐标型(cylindrical)(R2P) 由一个转动关节和两个滑动关节组成。 两个滑动关节分别对应于圆柱坐标的径向和垂直方向位置，一个旋转关节对应关于圆柱轴线的转角。 工作区域为矩形截面的旋转体。(3) 球坐标型(spherical) (2RP) 两个转动关节和一个滑动关节分别实现手的左右，上下及前后运动。 工作区域是扇形旋转体。(4)关节坐标型(articulated/anthropomorphic)(3R) 用三个转动关节实现手在工作空间的任意定位。 工作区域是一个旋转体，其截面由转动关节转动行程角所确定的一些弧线
6、构成。(5)平面关节型 SCARA (Selective Compliance Assembly Robot Arm)由两个转动关节和一个滑动关节组成。 两个转动关节控制前后，左右运动；滑动关节实现上下运动。 工作区域是截面为矩形的旋转体这里只给出了几种简单的臂结构。各类型结构的优缺点简要分析如下：直角坐标型结构：三个关节分别沿着直角坐标的三坐标轴移动，几何运动直观，计算简单，便于控制。该结构刚度好，可得到较高精度。但机器人所占运行空间大，滑动关节密封性及操作的灵活性差。多转动关节型：灵活性最强，可以避开一些障碍物到达操作点。运行所占空间及占地面积小，关节易于密封。但是关节角与空间位置的关系复
7、杂且相互关联，因此控制计算量大，控制相对复杂。圆柱坐标型和球坐标型的优缺点介于上述两类结构之间。平面关节型：结构简单，特别适合小型零件的插接装配。注：机器人的腕和手（操作器）的结构略2.1.1 机器人的移动机构对机器人移动机构的基本要求是能承受机器人自身重力及操作过程中存在的力和力矩，并保持平衡和具有一定的刚度；具有较高的机动性。目前移动机构的主要类型有轮式、履带式、足式及其它（如机器鱼，爬壁机器人等），下面对移动机器人的几种典型机构及特点给出简要介绍。轮式移动机构：轮式移动机构有移动平稳、机动性高、便于操纵等特点。但只适合在平坦地面运行，不能上下阶梯、越沟。轮式移动机构一般具有三轮、四轮式两
8、种，其中驱动轮用以驱动机器人运动，控制移动的速度，有时也用以控制移动方向；转向轮用以控制机器人移动方向；小脚轮和自由轮：用以支撑机器人保持平衡，被动地适应机器人转向运动的要求。几种轮式移动机构。三轮机构，四轮移动机构，全转向三轮移动机构，每个轮子都同时用作驱动和转向轮，能随时向任意方向做直线运动，这时三轮的轴线均与运动方向垂直。它也能作任意孤线运动，只要三轮轴线均通过弧线的曲率中心点，就可以作就地转动，以及完成这些运动的组合。因此，这类机构又称为全方位移动机构。履带式移动机构这是类似于履带坦克及拖拉机的移动机构，其特点是能在凹凸不平的地面上行走，稳定性好，能跨越障碍物，爬越较大斜坡或阶梯。但是
9、履带式移动机构运动方向的操纵，由左右履带的速度差值所控制。因此，转向时必出现滑动，阻力较大，转向半径及中心准确度较差。有关各种特效的履带移动机构，可参考有关文献。步行式移动机构步行式移动机构是指采用了类似人、兽或昆虫用脚迈步移动的机构，有两足、四足、六足、八足等移动机构，它们的特点是只需要离散的着地点，能在平地也能在凹凸不平的地面行走；能越过沟、穴等障碍物；能上、下阶梯，具有较高的机动性。然而步行控制复杂，尤其是对于双足机器人，步行的稳定性不易控制。除了模仿人的两足步行机构外，还有模仿兽类的四足步行机构，它有四条腿，通常每条腿有三个自由度。还有模仿昆虫的六足步行机构，它有六条腿，每条腿通常有三
10、个自由度，共 18 个自由度。这些机构能灵活地前进、后退、向左或向右以不同半径转弯以及调整机器人离地高度及倾斜角度等。2.2 机器人的驱动机构驱动机构通常包括驱动机、减速及传递机构。2.2.1 驱动机常用于机器人的驱动机有液压、气压和电动驱动机。液压驱动机的优点是能产生非常大的力（如在 280105 牛顿米工作压力下，2 厘米直径液压缸就能产生 8000 牛顿力）。力矩-重量比值较高，能以体积小重量轻的驱动器提供较大的驱动力，刚度大。缺点是：需液压动力源设备，内部漏油及油温影响驱动特性；管理、维修技术要求高，一次性投资较高等。目前液压执行机构主要用于大型机器人的驱动气压驱动机的优点是：成本低，
11、可靠性高，维修管理容易，无污染，不会失火。缺点是：难于准确控制速度和位置，出力小，有噪声，易锈蚀等。一般用于控制要求不高、出力要求不大的场合。电动驱动机即指电机，它的优点是：便于控制，能实现快速精确的位置和速度控制，信号处理方便，配线容易，比较清洁。缺点是：力矩一重量比值较低，为得到低速大力矩，需使用减速器，并因减速器存在齿隙而引起一些控制问题。常用的电机主要有步进电机、直流伺服电机和交流伺服电机三种。其中直流伺服电机应用最广，这是由于直流伺服电机的机械特性和控制特性好，调速范围宽，起动力矩大，效率高等。随着电子技术的发展，近年来出现了采用电子换向技术的直流无刷电机，避免了机械换向可能带来的火
12、花问题。交流伺服电机的电源提供简单，但控制相对复杂。步进电机直接用脉冲数字信号控制，控制简单，位置控制准确。但一般效率较低，长期工作有丢步问题。一般用于小型普及型机器人。还有一些特殊的驱动方式，如气囊驱动：英国的“Shadow”计划研制的双足步行机器人的传动结构就是采用的气囊肌肉的方式进行驱动。它具有重量轻，输出力大，柔顺性好等优点；记忆合金驱动器（SMA）：功率重量比大，驱动电压低，无噪音，无污染等优点；压电驱动器：体积小、精度高、响应快、输出力大，可用于微动机器人。关节的驱动方式有直接驱动方式和间接驱动方式两种。直接驱动方式是驱动器的输出轴和机器人手臂的关节轴直接相连；这种方式的优点是驱动
13、器和关节之间的机械系统较少，因而能够减少摩擦、间隙等非线性因素的影响，可以做到控制性能比较好。然而，在另一方面，为了直接驱动手臂的关节，驱动器的输出力矩必须很大，此外，必须考虑手臂的动力学问题。间接驱动方式是把驱动器的力通过减速器等传递给关节。大部分机器人的关节是间接驱动。这种间接驱动，通常其驱动器的输出力矩大大小于驱动关节所需要的力矩，所以必须使用减速器。2.2.2 减速机构减速机构的目的是把电动机输出的高转速小力矩的运动变换成低转速大力矩的关节旋转运动，或变换成低速驱动力大的关节直线运动。描述减速机构的基本参数是传动比，又称减速比。传动比与传动效率定义 2.1 传动比 i ：输入转速与输出
14、转速之比定义 2.2 传动效率 ：输出功率与输入功率之比在忽略传动机构功耗的情况下，输出转速是输入转速的 1/ i ，输出力矩是输入力矩的 i 倍。常用的减速机构有两类:旋转减速机构和平移减速机构。旋转减速机构：一般输入轴由电机带动作高速旋转运动，输出轴作低转速运动。主要有齿轮减速机构、蜗轮蜗杆减速机构、行星齿轮减速机构和谐波减速机构等。齿轮减速机构输入轴与输出轴可以平行（见图 2.5(a)）也可以垂直相交（见图 2.5(b)），转速比即为输出齿轮的齿数与输入齿轮的齿数之比。一级齿轮减速比较小，且有齿隙。为获得大减速比，通常需多级。蜗轮蜗杆减速机构用于交错轴间传递运动与力，轴交角通常为 90
15、度。它有较大的转速比。有自锁功能（即在外力作用下能自行保持关节位置）。但其机械效率低(60%)，且有齿隙。行星减速机构由太阳轮 S、行星齿轮 P、行星轮支架（即转臂）C 和内齿轮 A 组成。太阳轮位于行星减速机构“太阳系” 中心，是有外齿的中心轮。中心轮是指与行星齿轮相啮合，且轴线固定的齿轮。行星齿轮在转臂的带动下围绕太阳轮做行星运动，行星齿轮既有公转，又有自转。内齿轮位于行星减速机构的最外侧，是具有内齿的中心轮。用 Z 表示齿数， 表示转速，即 ZS 表示太阳轮齿数， ZA 表示内齿轮齿数。为表示各组件间的运动关系，将传动比表示为 aibc ，其中上标a 表示固定件，下标 b 表示主动件 c
16、 表示从动件太炎；传动比为正，表示主动件与从动件转向相同，传动比为负，表示主动件与从动件转向相反。(1)转臂固定，太阳轮与输入轴相连，内齿轮与输出轴相连时太阳轮顺时针旋转一周，带动行星轮逆时针转过 ZS 个齿，从而带动内齿轮也转过 ZS 个齿，即 ZS / ZA 周.当转臂不是固定件时，可采用转臂固定法来计算传动比。转臂固定法的基本思想是：根据相对运动原理，如果给整个行星机构加上一个与转臂 C 的角速度 C 大小相等、方向相反的公共角速度C ，则行星机构中各构件之间的相对运动关系仍然保持不变。(2)内齿轮固定，太阳轮与输入轴相连，转臂与输出轴相连时 行星减速机构的特点是机械效率高，具有中等程度
17、的减速比，但有齿隙。谐波减速机构谐波减速机构一般由波形发生器H、柔轮 A 和刚轮 B 三个基本构件组成。波形发生器(Wave Generator)是椭圆形凸轮。通常将波形发生器装在电机轴上。柔轮(又称 Flex Spline)是由弹性金属制成具有外齿 ；刚轮(又称 Circular Spline)是有内齿的圆形刚体构件，内齿的大小与柔轮外齿的大小相同，但齿数多于柔轮外齿。谐波齿轮传动是在谐波发生器 H 的作用下迫使柔轮 A 产生弹性变形，并与刚轮 B 相互啮合而实现传递运动或动力的目的。它的主要特征是：在 H 的作用下，柔轮 A 的各点依次与刚轮啮合时，柔轮 A 各点的径向位移随转角的变化为一
18、基本对称的简谐波，这也是该机构被称为谐波减速机构的原因。传动比可如下计算：(1)刚轮 B 固定，波形发生器 H 与输入轴相连，柔轮 A 与输出轴相连时。凸轮转一周时，柔轮沿相反方向转过 ZB-ZA 个齿，相当于(ZB-ZA)/ZA 转。(2)柔轮固定，凸轮与输入轴相连，刚轮与输出轴相连时当凸轮转一周时，刚轮沿相同方向转过 ZB-ZA 个齿谐波减速机构具有以下特点：(1) 结构简单，体积小，重量轻体积小，构造简单，减速比大。(2)传动比大，且传动比范围宽。(3)传动精度高。(4)齿面磨损小，且均匀。(5) 传动效率高。(6)间隙（空回量）小，甚至可实现无间隙传动。(7)运动平稳，无冲击。(8)同
19、轴性好。也有一些局限性：(1) 传动比下限值较高。(2)柔轮和波发生器的制造较复杂，制造成本较高。(3)一般不能做成相交轴和交错轴的传动机构。平移减速机构：将旋转运动转换为平移运动，输入与高速旋转的电机轴相连，输出与滑动关节相连。常用的有齿轮齿条机构和滚珠丝杠等。此外，为了减轻各关节驱动器的负载，解决安装空间的限制和实现机器人臂的重力平衡，机器人的驱动机构常常不能直接安装在关节上带动臂运动，而是安装在适当的位置（如基座）通过转递机构实现力或力矩的传输，如可采用链条等间接驱动机构。2.3 机器人控制系统2.3.1 机器人的典型运动方式分析机器人在各类作业中的运动，可以看到两种基本运动形式：点点P
20、TP(Point to Point)运动和连续 CP(Continual Path)运动点点的运动：机器人只在某些指定点上进行操作。因此只要求在这些点上，操作器应有准确的位置和姿态，以保证操作质量。对于操作器在各相邻点间的运动（包括路径和姿态）不做任何规定。如进行点焊。上料、下料、搬运等作业。连续的运动：指机器人沿指定轨迹运动的同时进行连续操作的运动过程。因此，要求机械手末端的操作器严格按预定轨迹运动，才有可能完成作业要求。如用于喷漆、弧焊等作业。显然，连续运动可以看作是密集的 PTP 运动的总和，点和点之间的轨迹可用折线近似。只要预定点足够密，就可以用点点运动控制的方法实现所需精度的连续运动
21、。2.3.2 机器人控制系统分类控制系统的结构和工作原理与机器人的功能和精度要求有密切的关系。机器人控制系统从基本原理和系统结构上可分为两类：非伺服型系统和伺服型系统。非伺服型系统包括不采用反馈信号的开环非伺服型系统和仅采用开关反馈的非伺服型系统，一些采用步进电机控制的机器人均属于这种类型。非伺服型控制系统适用于作业相对固定，操作程序简单，运动要求不很高的作业。采用这类控制系统的机器人，具有价格低廉，操作、安装和维护简单，可靠性较好等特点。伺服型控制系统：主要特点是系统中采用传感器测量关节参数，如关节位置、速度，并反馈到驱动器构成闭环伺服系统。在伺服系统控制下，能保证机器人各关节准确跟踪给定位
22、置、速度，能根据要求完成复杂、灵巧的操作。几乎所有的多功能、高性能的机器人，均采用伺服型控制系统近年来出现的各种智能型机器人控制系统：在伺服型系统的基础上，增加了环境检测，构成机器人总体的闭环反馈控制系统，增加了决策功能，并使系统具有自主性。2.3.3 机器人控制系统本节以工业机器人的控制系统为例来介绍机器人的控制系统。机器人控制系统在结构上是分层结构的计算机控制系统。一般的工业机器人系统由伺服控制和协调控制层组成。协调层由协调控制计算机及其外围设备组成，用以接受作业指令，完成个关节运动的协调计算等功能。伺服控制层由一组伺服系统组成，用以控制机械系统各关节跟随指定轨迹运动。系统工作过程简述如下
23、：操纵者利用控制计算机的键盘或者示教盒输入作业要求，如要求机械手末端由 A 点沿直线运动到 B 点。协调层计算机接到指令后完成以下工作：(1)分析解释指令，确定运动参数;(2)进行插值计算;(3)进行坐标变换，得到相应的各关节协调运动参数;(4)将关节运动参数输出到伺服控制级，作为各伺服系统的给定信号。伺服系统实现各关节的跟踪运动，从而控制机械系统完成运动。协调控制计算机完成从任务、运动指令到关节运动之间的全部运算，这些任务需要特定的协调控制软件来完成，协调控制软件的功能主要包括：指令的分析解释；运动规划；根据运动规划和轨迹关键点规划出沿轨迹的运动参数，并通过插值计算，得到适当密度的中间点；完
24、成坐标变换（作业空间坐标与关节空间坐标等），得到关节的指令参数。有关坐标变化、运动规划等内容将在后续章节中详细讨论。伺服控制系统机器人的每个关节分别由一个伺服系统驱动。系统的输入来自协调控制级输出的关节运动参数。系统控制各关节机械运动跟踪输入值。电伺服控制系统通常由控制器、驱动器（功放等）、电机、位置传感器，速度传感器及制动器组成。电机输出轴通过传动机构与机器人的关节相联。制动器在失电时使关节能自行制动，保持静止状态。驱动器及电机（略）位置速度传感器位置、速度传感器用以测量关节位置和速度，并用作反馈信号，构成具有预期静态和动态特性的位置（或速度）伺服系统。用于机器人的位置传感器有电位计、差动变
25、压器、光码盘和旋转变压器等。其中光码盘的可靠性、准确性较高，应用最广。现将其基本工作原理简述如下：光码盘由光源、光敏元件、编码盘和信号处理电路组成，它的工作原理如图 2.9所示。光码盘有两类：绝对式光码盘和增量式光码盘（又称相对码盘）。其主要差别是所用码盘编码格式不同 。图 2.10(a)是四位绝对式光码盘，含四道码环。其中黑色为不透光部分，白色为透光部分。一个 N位绝对码盘有：N 道码环，N 个沿半径方向、对准各码环分布的光源和光敏器件对工作时光线透过码盘，经光敏器件接收，信号处理电路放大整形后输出与码盘位置对应的二进制位置信号。当然，码盘也可以按照其它方式编码，如格雷码等。图 2.10(b
26、)是增量式光码盘，它含三道码环，其中 A、B 道的编码图形完全相同，但布置上相差半个窄缝。主要用以测量位置的变化及方向。C 道只有一个窄缝，用以校准初始位。有三个沿半径对准各码环分布的光源、光敏器件对。当位置变化时，光线透过码盘的情况也改变，经接收放大后输出测量信号。在等速运动时对应码道 A、B 的测量信号是等宽脉冲信号，脉冲的频率反映位移的速率，脉冲数反映位置变化的增量值，而波形相位的领先或落后反映位移方向是正向或反向。以长春第一光学仪器厂生产的增量码盘产品 LBJ-007-500 为，每转脉冲数为500，经过四细分电路，可得 2000 脉冲/转，角度分辨率可达：0.18deg；输出方式为长
27、线驱动，电源电压：50.25V。尺寸：38*40mm ，重量：100g。制动器：一般由电磁铁、摩擦盘等组成，工作时电磁铁线圈通电，街铁吸合，并与固定在电机轴上的摩擦盘脱开，这时轴可自由转动当失电时，衔铁在弹簧作用下打开，并紧压在摩擦盘上，产生足够大的摩擦力制动。制动器结构多种多样的，目前一些电机产品本身即带有制动器。控制器控制器的基本部件是比较器、误差放大器和补偿器。输入信号除参考输入外，还有各种反馈信号及前馈信号，构成具有位置、速度反馈和前馈补偿的伺服系统控制器可以采用模拟器件，也可以采用数字器件（如微处理器）。目前大多采用微处理器与必要的模拟器件的组合构成伺服控制器，控制参数由软件设定，便
28、于实现各种控制算法，获得高的性能指标。伺服驱动系统的技术要求伺服系统是把指令变为现实运动的关键设备。它的品质直接影响机器人的性能。作为机器人用伺服系统的要求，可表示为静态特性，动态特性及抗扰性等三个方面。静态性能：要求系统静态位置误差小，以保证机器人的重复定位精度。要求调速范围大，速度误差小，以保证机器人各种运动速度对精度的要求。动态性能：要求系统快速、平稳、无超调，以保证机器人动态跟踪精度，防止碰撞。抗扰性能：要求系统具有较强的抗于扰能力及鲁棒性能。由于机器人作业内容的多样性和复杂性，以及机器人机械系统的特点，使伺服系统的参数和负载力矩在作业过程中有快速、大幅度的变化，并且各伺服系统间有相互
29、影响，要求系统在此情况下保持稳定。2.3.4 机器人控制系统实例1.PUMA 工业机器人的控制系统PUMA 机器人的控制系统可分为协调控制级和伺服控制级。协调控制级包括由 LSI-11 处理器为 CPU 的控制计算机及其外围设备组成。控制机采用VAL 机器人语言完成编程工作，并进行协调控制计算（包括运动的规划、插值和坐标变换等）。最后每 28ms 输出六个伺服系统的给定位置信号。伺服控制级包括六套伺服系统，各系统的输入是协调层输出的给定关节位置信号 qd ，输出为关节实际位置。系统选用直流伺服电机、增量式光码盘分别作为系统的驱动和测量元件，由速度放大器、晶体管脉冲调宽功率放。大器和脉冲频率、电
30、压变换器构成速度反馈回路。由微处理器 6503p 构成位置反馈环，其功能是每28ms 接收伺服控制计算机给定的位置信号，并完成间隔为 0.875ms 的插值计算。伺服控制回路的控制周期为 0.875ms,即每 0.875ms 读入关节实际位置，与所得插值比较，将误差信号放大经 DAC 输出并传递到驱动关节的模拟伺服板。2.仿人机器人 P2/P3/Asimo 的控制系统结构及功能分布控制器: a control computer with 4 microprocessors(micro SPARC ）操作系统：VxWorks对于仿人机器人的控制系统而言，伺服控制级和协调控制级构成了运动控制子系统
31、，为使系统具有灵活的移动能力，不仅需要各关节状态的局部反馈，还需要又反映整体运动状态的身体姿态、脚底受到的力、力矩等传感信息，并在此基础上增强对环境的感知能力（如视觉等），以这些信息为基础，进行决策。2.4 RM-501 机器人控制系统RM-501 机器人是日本三菱电气株式会社生产的轻型关节式 5 自由度机器人，由直流电机驱动。图 2.13 仿人机器人 P2 控制系统结构（P3/ASIMO 的控制系结构与之类似）图 2.14 RM-501 机械结构2.4.1.性能及参数（1）主要技术指标 运动范围: 腰旋转 300肩部旋转 130肘部旋转 90腕部俯仰 90腕部旋转 180 允许抓重: 1.2
32、kg（包括手重）( 腕端面速度为 100mm/s 时） 最大合成速度：400mm/s（指腕端面） 位置重复精度： 0.5mm（小于绝对误差） 驱动装置：直流伺服电机 主体重：27kg图 2.15 RM-501 机器人运动范围（2）控制系统组成及性能 速度设定：0 9 级 位置设定点数629 存储器: ROM: 32k 系统,8k 用户;RAM:32k 外部 I/O: 8in/8out2.4.2.驱动单元的硬件结构驱动单元是单 CPU 结构，包括：电源板、CPU 板、伺服控制板、输入/输出接口板。电源板将交流 220V 电压转换称 24v、5V、12V 等直流电压，供控制电路及伺服电机使用；CP
33、U 板用 Z80CPU,主频 4MHz，用 EPROM 存储系统程序，并有 RAM 。此板是整个驱动单元的核心。伺服控制板控制电机转动；输入输出接口板可使驱动单元与示教盒、上位机及其它外围信号相连。这里仅对伺服控制和输入输出接口加以说明。（1）伺服控制驱动单元对伺服电机控制的基本原理(见图 2.17)。CPU 发出的是脉冲序列，每一个脉冲使伺服电机转一个相应的角度（称脉冲当量角）。CPU 在发表示转角增量的脉冲序列的同时，给出增量的方向。控制逻辑根据转向要求，将脉冲送到计数器的加端（或减端）。伺服电机的转动由增量式光码盘检测，转换逻辑将码盘的信号转换成表示转过角度的脉冲信号和转向信号，控制逻辑
34、根据并按转向，将转角反馈脉冲送到计数器的减端（或加端）。这样，12bit 加/减计数器的值就相当于电机转动给定值与反馈值之差。计数器的输出经变补器和 D/A 变换等环节（高位放大器相当于非线性的 D/A 变换），在 D 端产生电压，驱动电机转动，直到计数器的值小到不能使电机再转为止。由于计数器的输出为补码，而下面的 D/A 和高位放大器接受的只能是原码，因此计数器的输出需要变补。计数器中值的正负通过 Q11 反映出来的，用它来产生电机正反转控制信号PR 和 NR。PR 和 NR 用于控制施加到电机电枢上的电压极性：误差为正时：PR=1,NR=0；误差为负时：PR=0,NR=1；越限时：PR=0
35、，NR=0。伺服电机的驱动电路通过三极管切换电机两端的电压来实现电机正反转的： 当计数器的值为正时: PR=1，NR=0。此时 T1 截止，T2 饱和，T3 截止，T4饱和。 m1 点电位随控制电路输出端 D 的电位变化，m2 接近地电位，电机正转。当计数器的值为负时: PR=0，NR=1。 T1 饱和， T2 截止， T3 饱和，T4 截止。m2 点电位随 D 的电位变化，m1接近地电位，电机反转。 当计数器的绝对值过大时: PR=0，NR=0( 可能是 CPU 发的脉冲频率过高，要求电机转的速度过快，或是关节转动部分有故障，造成给定与反馈误差过大)，T1 和 T2 都截止，电机两端电位差接
36、近零，电机停转。末端夹持器的控制力的大小可控: 控制口 87H 的 D0D2手爪状态可控: 控制口 85H 的 D0 、D1。D1D0=00 打开；D1D0=10 夹；D1D0=1 松弛(2)输入/输出板 RM-501 驱动单元与计算机的接口(a)Centronics 标准并行口加上并行接口电路后，可用标准电缆将其与主计算机的打印口相连。主计算机可使用高级语言的打印语句，将命令或数据传给驱动单元。(b)RS-232 标准串行口 I/O 口 8255 并行接口芯片+光隔 EPROM 写入器接口2.4.3.示教盒示教再现是工业机器人的基本功能之一，示教再现即先用示教盒控制机器人各关节运动，并记录机
37、器人在完成一个作业的动作序列（点），需要时让机器人将这一动作序列复现出来。2.4.4.RM-501 机器人的控制模式及控制命令除了用示教盒控制机器人的运动外，RM-501 机器人有四种控制模式：试验模式、PC 模式、编辑模式和 ROM 模式 ，其中最常用的是 PC 模式，这种模式用上级计算机作为监控机，向驱动单元发送操作命令，发送一条，执行一条，此时，示教盒上的切换开关应置于”off”状态。RM-501 机器人的驱动单元提供了 38 条智能操作命令，其中动作命令 16 条，I/O 命令 6 条，程序控制命令 16 条。其中最常用的有:NT机械复位RS当命令传送或执行有错时，错误指示灯亮，不能继
38、续工序，执行 RS 命令后可以消除错误状态NW清除驱动单元 RAM 中的所有数据PS a0，a1，a2，a3，a4 ，a5， a6位置设定命令，其中 a0 是设定的位置编号， a1，a2 ，a3，a4，a5 分别是五个关节从运动原点到所设定的位置需走过的步数，a6 始终为零。前面已经指出，发给伺服电机的是脉冲序列，每发一个脉冲转一个脉冲当量角，a1，a2，a3，a4，a5 即为个关节转角相对应的脉冲数。值得注意的是，手腕运动与 a4+a5 及 a4a5 有关，a4+a5 对应腕俯仰，a4 a5 对应腕旋转。初始位置在机械原点，或是执行了 NT 命令后，a1a5 的参数范围如表 2.3所示。SP
39、 a设定运动速度等级，0 a 9， a=0 时速度最低， a=9 时速度最高。MI a1， a2，a3，a4，a5，a6相对运动命令，各关节分别运动由 a1a5 确定的步数，a1a6 的意义与 PS 命令相同。MO a使机器人运动到 a 号位置。表 2.3 参数范围关节 参数范围 角度当量腰 12000a1 0 0.025/每步肩 5200 a2 0 0.025/每步肘 0 a3 3600 0.025/每步腕(俯仰) 0 a4-a5 4800 0.075/每步腕(旋转) -9600 a4+a5 9600 0.075/每步2.4.5 RM-501 控制软件(1)RM-501 软件结构驱动单元的监
40、控程序固化在 EPROM(2732*3)中，占用 12k 字节的存储区，地址为 0000H 2FFFH，前 8k 中存放的是控制程序及一些数据表格，后 4k 中存放的全是数据。软件功能主要有: 实现示教盒的示教功能; 接收并执行 38 个智能命令并执行。开机后，先初始化。 然后，若示教盒上的开关打开，则调用示教盒管理程序，否则，调用智能命令解读与执行程序。 示教盒管理程序 示教盒上的 24 个键分成 3 组，每组用一个字节表示 8 个按键的状态，三个口地址分别为 08H、09H、0AH。 软件为每一按键规定了一个键码，双功能键则对应两个键码，根据键码即可找到对应该键功能的子程序。 智能命令的解
41、读与执行每个智能命令对应一个代码，根据内部代码就可查到参数处理入口地址和命令执行入口地址。 将接收到的命令转换成内部码命令由两个字母组成，通过两级查表即可找到内部码 根据内部码查找参数处理入口地址 根据内部码查找命令执行程序入口地址。(2)运动控制算法在前面的驱动器硬件原理中已提到，电机的转动靠 CPU 发脉冲控制，每发一个脉冲，电机转一个固定的角度。这里主要分析一下 RM-501 如何进行速度控制和如何使各个轴同步运动。转速控制RM-501 的转速分 10 级，CPU 发脉冲的频率越高(脉冲时间间隔越短)，电机的转速就越快。在控制电路允许的运行频率范围内，改变脉冲频率，就可以改变电机的转速。
42、为保证运动平稳，各关节的转速给定不应该有突变。RM-501 采用直线加减速控制，各轴转速按右图所示的梯形规律变化。为提高控制的实时性，减少计算量，RM-501 将加减速度段的数据以表格的形式预先放入存储器中,控制时用查表法取出这些数据。对于每一级转速，都有一条升速曲线和一条降速曲线与之对应。每条曲线以脉冲时间间隔的形式存放。同步控制当机器人手爪从一个位姿改变为另一个位姿时，各关节转过的角度可能是很不同的。如果速度相同，各轴动作完成的时间有早有晚，手爪所经过的轨迹会是很不规则的。较好的方法是使各个关节同时启动，同时到达目标点，这样手爪的轨迹较接近直线。这种使各关节同时启停的控制即同步控制。RM-
43、501 采用控制算法使各关节的脉冲序列在同一时间段内几乎呈均匀分布，达到同时起停、转速均匀的目的。虽然 RM-501 机器人的控制系统采用的器件显得不够先进，但它的控制系统的体系结构及控制思路并不落后于近年来出现的工业机器人的控制，仍值得借鉴。2.5 本章小结本章简要介绍了机器人的运动机构、驱动及减速机构，以及控制系统（特别是伺服系统部分）的组成，目的是给出机器人的一个比较完整的框架，使读者初步了解机器人的构建和控制需要解决哪些基本问题。设计题目(1)从本章开始，可以将所学到的知识用于一个简单机器人的设计中。例如，设计一个固定基座的机器人，它的末端可以在三维工作空间内沿任意轨迹运动（只要求机器人末端的位置轨迹，对机器人末端的姿态不做要求）。通过本章的学习，应能解决以下问题：(1) 至少需要几个自由度？(2) 设计机器人本体的结构，画出它的工作空间。(3) 为实现关节轨迹的精确跟踪，伺服控制系统应包含哪些基本组件？(4) 各关节间的协调控制是否必要？协调控制应具有哪些基本功能？
