机器人学机器人控制算法课件.pptVIP

第5章机器人的控制系统5.3控制理论与算法?在机器人的运动学中，已知机器人末端欲到达的位姿，通过运动方程的求解可求出各关节需转过的角度。所以运动过程中各个关节的运动并不是相互独立的，而是各轴相互关联、协调地运动。?机器人运动的控制实际上是通过各轴伺服系统分别控制来实现的。所以机器人末端执行器的运动必须分解到各个轴的分运动，即执行器运动的速度、加速度和力或力矩必须分解为各个轴的速度、加速度和力或力矩，由各轴伺服系统的独立控制来完成。?然而，各轴伺服系统的控制往往在关节坐标系下进行，而用户通常采用笛卡儿坐标来表示末端执行器的位姿，所以有必要进行各种运动参数包括速度、加速度和力(或力矩)的分解运动控制。分解运动控制能很大程度上化简为完成某个任务而对运动顺序提出的要求。本节将讨论分解运动的求解问题。

7.1引言(Introduction)前几章，我们借助齐次变换阐述了对于包括机械手在内的任何物体的位置和姿态的描述方法。研究了机械手的运动学，建立了机械手关节坐标和与直角坐标的位置和速度之间的关系，推导了机械手的动力学方程。本章，我们要根据动力学方程来考虑机械手的控制问题，由于任何机械手的实际控制都是通过对各个关节的协调控制来实现的，因此，必须对每一个关节进行有效的控制。

7.2机器人控制器和控制结构机器人的控制就是要使机器人的各关节或末端执行器的位置能够以理想的动态品质跟踪给定的轨迹或稳定在给定的位姿上。机器人控制特点：冗余的、多变量、本质非线性、耦合的1.控制器分类结构形式：伺服、非伺服、位置反馈、速度反馈、力矩控制、控制方式：非线性控制、分解加速度控制、最优控制、自适应控制、滑模变结构控制、模糊控制，神经网络控制等控制器选择：依工作任务，可选PLC控制、普通计算机控制，智能计算机控制等。简单分类：单关节控制器：主要考虑稳态误差补偿；多关节控制器：主要考虑耦合惯量补偿。

2、主要控制变量任务轴R：描述工件位置的坐标系0X(t):末端执行器状态；θ(t):关节变量；C(t)：关节力矩矢量；T(t)：电机力矩矢量；V(t)：电机电压矢量本质是对下列双向方程的控制

3、主要控制层次分三个层次：人工智能级、控制模式级、伺服系统级1）人工智能级完成从机器人工作任务的语言描述生成X(t)；仍处于研究阶段。2）控制模式级建立X(t)T(t)之间的双向关系。电机模型传动模型关节动力学模型机器人模型3）伺服系统级解决关节伺服控制问题即

PUMA机器人的伺服控制结构计算机分级控制结构，VAL编程语言。采用独立关节的PID伺服控制，伺服系统的反馈系数是确定的。由于机器人惯性力、关节间耦合、重力与机器人位姿和速度有关，所以难于保证在高速、变速和变载情况下的精度。上位机配有64kBRAM内存，采用Q-Bus作为系统总线，经过A、B接口板与下位机交换数据。上位机作运动规划，并将手部运动转化为各关节的运动，按控制周期传给下位机。A接口板插在上位机的Q-Bus总线上，B接口板插在下位机的J-Bus总线上。B板有一个A/D转换器，用于采样电位器反馈的位置信息。

下位机进行运动插补及关节伺服控制。它由6块6503CPU为核心的单板机组成，它与B接口板、手臂信号板插在J-Bus总线上。C接口板、高压控制板和6块功率放大器板插在Powerampbus上。上位机软件为系统编程软件——软件系统的各种系统定义、命令、语言及其编译系统。针对各种运动形式的轨迹规划和坐标变换，以28ms的时间间隔完成轨迹插补点的计算、与下位机信息交换、执行VAL程序、示教盒信息处理、机器人标定、故障检测等。下位机软件为伺服软件——驻留在下位机6503微处理器的EPROM中。每隔28ms接受上位机轨迹设定点信息，将计算的关节误差以0.875ms的周期伺服控制各关节的运动。

7.3机器人的位置控制位置控制是在预先指定的坐标系上,Zendeffector对机器人末端执行器（endeffector）的位置和姿态（方向）的控制。如图所示，末端执行器的位置和姿态是在三维空间描述的，包括三个平移分量和三个旋转分量，它们分别表示末端执行器坐标在参考坐标中的空间位置和方向（姿态）。因此，必须给它指定一个参考坐标，原则上这个参考坐标可以任意设置，但为了规范化和简化计算，通常以OXYZYX图机器人操作手机器人的基坐标作为参考坐标。机器人的基坐标的设置也不尽相同，如日本的Movemaster－Ex系列机器人，它们的基坐标都设置在腰关节上，而美国的Stanford机器人和Unimation公司出产的PUM系列机器人则是以肩关节坐标作为机器人的基坐标的。

机器人的位置控制主要有直角坐标和关节坐标两种控制方式。直角坐标位置控制：是对机器人末端执行器坐标在参考坐标中的位