第5章机器人控制系统 机器人技术知识》课件.ppt

第5章 机器人控制系统;5.1 控制系统概述;5.1.2 机器人控制系统的组成 （1）控制计算机? ? （2）示教盒 ?? （3）操作面板 ?? （4）硬盘和软盘存储 ?? （5）数字和模拟量输入输出 ?? （6）打印机接口 ? （7）传感器接口 ?? （8）轴控制器 ?? （9）辅助设备控制 ?? （10）通信接口 ?? （11）网络接口;5.1.3 机器人控制的关键技术 1. 关键技术 (1) 开放性模块化的控制系统体系结构 (2) 模块化层次化的控制器软件系统 (3) 机器人的故障诊断与安全维护技术 (4) 网络化机器人控制器技术 2. 机器人示教 (1) 直接示教??? 手把手示教，由人直接搬动机器人的手臂对机器人进行示教，如示教盒示教或操作杆示教等。 (2) 离线示教 不对实际作业的机器人直接进行示教，而是脱离实际作业环境生成示教数据，间接地对机器人进行示教。 ;典型的微机控制系统框图如图所示。图中的输入量一般由程序给定，也可以由输入装置给定。; 5.1.4 工业机器人控制的特点 1) 传统的自动机械是以自身的动作为重点，而工业机器人的控制系统则更着重本体与操作对象的相互关系。 2) 工业机器人的控制与机构运动学及动力学密切相关。 3) 每个自由度一般包含一个伺服机构，多个独立的伺服系统必须有机地协调起来，组成一个多变量的控制系统。 4) 描述工业机器人状态和运动的数学模型是一个非线性模型，随着状态的变化，其参数也在变化，各变量之间还存在耦合。因此，仅仅是位置闭环是不够的，还要利用速度、甚至加速度闭环。系统中还经常采用一些控制策略，比如使用重力补偿、前馈、解耦、基于传感信息的控制和最优PID控制等。 5) 工业机器人还有一种特有的控制方式——示教再现控制方式。 ;5.2 工业机器人控制的分类 工业机器人控制结构的选择，是由工业机器人所执行的任务决定的，对不同类型的机器人已经发展了不同的控制综合方法。工业机器人控制的分类，没有统一的标准。;5.2.1 位置控制方式 工业机器人位置控制分为点位控制（如图a）和连续轨迹控制（如图b）两类。 ;5.2.2 速度控制方式 工业机器人，在位置控??的同时，有时还要进行速度控制。例如，在连续轨迹控制方式的情况下，工业机器人按预定的指令，控制运动部件的速度和实行加、减速，以满足运动平稳、定位准确的要求，如图5.7所示。由于工业机器人是一种工作情况(行程负载)多变、惯性负载大的运动机械，要处理好快速与平稳的矛盾，必须控制起动加速和停止前的减速这两个过渡运动区段。;5.3 工业机器人的位置控制 工业机器人位置控制的目的，就是要使机器人各关节实现预先所规划的运动，最终保证工业机器人终端(手爪)沿预定的轨迹运行。 下图所示表示机器人本身、控制器和轨迹规划器之间的关系。图中的轨迹规划器由监督计算机来完成，控制器则由模拟调节器或DDC计算机来完成。;5.4 工业机器人的运动轨迹控制; 5.4.1 路径和轨迹 所谓轨迹、是指操作臂在运动过程中的位移、速度和加速度。路径是机器人位姿的一定序列,而不考虑机器人位姿参数随时间变化的因素。 对于点位作业，需要描述它的起始状态和目标状态，对于曲面加工，不仅要规定操作臂的起始点和终止点，而且要指明两点之间的若干中间点（称路径点）、必须沿特定的路径运动（路径约束）。这类称为连续路径运动或轮廓运动。 ;5.4.2 轨迹规划 1. 轨迹规划目的 轨迹规划的目的是将操作人员输入的简单的任务描述变为详细的运动轨迹描述。对一般的工业机器人来说，操作员可能只输入机械手末端的目标位置和方位，而规划的任务便是要确定出达到目标的关节轨迹的形状、运动的时间和速度等。 ;2．轨迹规划的过程 1) 对机器人的任务，运动路径和轨迹进行描述。 2) 根据已经确定的轨迹参数, 在计算机上模拟所要求的轨迹。 3) 对轨迹进行实际计算,即在运行时间内按一定的速率计算出位置、速度和加速度,从而生成运动轨迹。 ;关节轨迹的插值： 为了求得在关节空间形成所要求的轨迹，首先运用运动学反解将路径点转换成关节矢量角度值，然后对每个关节拟合一个光滑函数，使之从起始点开始，依次通过所有路径点，最后到达目标点。 ; 假设机器人的初始位姿是已知的,通过求解逆运动学方程可以求得机器人期望的手部位姿对应的形位角。若考虑其中某一关节的运动开始时刻ti的角度为θi, 希望该关节在时刻tf运动到新的角度θf。轨迹规划的一种方法是使用多项式函数以使得初始和末端的边界