第5章机器人控制技术

工业机器人2020年3月28日星期六第5章机器人控制技术5.1概述5.2示教再现控制5.3运动控制习题工业机器人2020年3月28日星期六5.1引言5.1.1机器人控制特点5.1.2机器人控制方式5.1.3机器人控制功能5.1.4机器人控制系统第5章机器人控制技术工业机器人2020年3月28日星期六5.1引言5.1.1机器人控制特点第5章机器人控制技术1、大量的运动学、动力学运算，涉及矢量、矩阵、坐标变换和微积分等运算。2、机器人的控制不仅是非线性的，而且是多变量耦合的。3、机器人的控制还必须解决优化、决策的问题。工业机器人2020年3月28日星期六机器人的控制方式主要有以下两种分类：1、按机器人手部在空间的运动方式分：（1）点位控制方式——PTP点位控制又称为PTP控制，其特点是只控制机器人手部在作业空间中某些规定的离散点上的位姿。这种控制方式的主要技术指标是定位精度和运动所需的时间。常常被应用在上下料、搬运、点焊和在电路板上插接元器件等定位精度要求不高且只要求机器人在目标点处保持手部具有准确位姿的作业中。5.1引言5.1.2机器人控制方式第5章机器人控制技术工业机器人2020年3月28日星期六1、按机器人手部在空间的运动方式分：（2）连续轨迹控制方式——CP连续轨迹控制又称为CP控制，其特点是连续的控制机器人手部在作业空间中的位姿，要求其严格的按照预定的路径和速度在一定的精度范围内运动。这种控制方式的主要技术指标机器人手部位姿的轨迹跟踪精度及平稳性。通常弧焊、喷漆、去毛边和检测作业的机器人都采用这种控制方式。有的机器人在设计控制系统时，上述两种控制方式都具有，如对进行装配作业的机器人的控制等。5.1引言5.1.2机器人控制方式第5章机器人控制技术工业机器人2020年3月28日星期六2、按机器人控制是否带反馈分：（1）非伺服型控制方式非伺服型控制方式是指未采用反馈环节的开环控制方式。在这种控制方式下，机器人作业时严格按照在进行作业之前预先编制的控制程序来控制机器人的动作顺序，在控制过程中没有反馈信号，不能对机器人的作业进展及作业的质量好坏进行监测，因此，这种控制方式只适用于作业相对固定、作业程序简单、运动精度要求不高的场合，它具有费用省，操作、安装、维护简单的优点。5.1引言5.1.2机器人控制方式第5章机器人控制技术工业机器人2020年3月28日星期六2、按机器人控制是否带反馈分：（2）伺服型控制方式伺服型控制方式是指采用了反馈环节的闭环控制方式。这种控制方式的特点是在控制过程中采用内部传感器连续测量机器人的关节位移、速度、加速度等运动参数，并反馈到驱动单元构成闭环伺服控制。如果是适应型或智能型机器人的伺服控制，则增加了机器人用外部传感器对外界环境的检测，使机器人对外界环境的变化具有适应能力，从而构成总体闭环反馈的伺服控制方式。5.1引言第5章机器人控制技术5.1.2机器人控制方式工业机器人2020年3月28日星期六1、示教再现功能示教再现功能是指示教人员预先将机器人作业的各项运动参数预先教给机器人，在示教的过程中，机器人控制系统的记忆装置就将所教的操作过程自动地记录在存储器中。当需要机器人工作时，机器人的控制系统就调用存储器中存储的各项数据，使机器人再现示教过的操作过程，由此机器人即可完成要求的作业任务。机器人的示教再现功能易于实现，编程方便，在机器人的初期得到了较多的应用。5.1引言5.1.3机器人控制功能第5章机器人控制技术工业机器人2020年3月28日星期六2、运动控制功能运动控制功能是指通过对机器人手部在空间的位姿、速度、加速度等项的控制，使机器人的手部按照作业的要求进行动作，最终完成给定的作业任务。它与示教再现功能的区别：在示教再现控制中，机器人手部的各项运动参数是由示教人员教给它的，其精度取决于示教人员的熟练程度。而在运动控制中，机器人手部的各项运动参数是由机器人的控制系统经过运算得来的，且在工作人员不能示教的情况下，通过编程指令仍然可以控制机器人完成给定的作业任务。5.1引言第5章机器人控制技术5.1.3机器人控制功能工业机器人2020年3月28日星期六由于机器人的控制过程中涉及大量的坐标变换和插补运算以及较低层的实时控制，所以，目前的机器人控制系统在结构上大多数采用分层结构的微型计算机控制系统，通常采用的是两级计算机伺服控制系统。伺服驱动人机对话内部传感器通信一级（上位机）微型计算机数学运算数据存储二级（下位机）单片机运动控制器驱动装置关节运动手的运动外部传感器局部反馈全局反馈5.1引言5.1.4机器人控制系统第5章机器人控制技术工业机器人2020年3月28日星期六机器人控制系统具体的工作过程是：主控计算机接到工作人员输入的作业指令后，首先分析解释指令，确定手的运动参数，然后进行运动学、动力学和插补运算，最后得出机器人各个关节的协调运动参数。这些参数经过通信线路输出到伺服控制级作为各个关节伺服控制系统的给定信号。关节驱动器将此信号D/A转换后驱动各个关节产生协调运动，并通过传感器将各个关节的运动输出信号反馈回伺服控制级计算机形成局部闭环控制，从而更加精确的控制机器人手部在空间的运动（作业任务要求的）。在控制过程中，工作人员可直接监视机器人的运动状态，也可从显示器等输出装置上得到有关机器人运动的信息。5.1引言第5章机器人控制技术5.1.4机器人控制系统工业机器人2020年3月28日星期六机器人控制系统的组成1、硬件参数变化检测外部传感器：外部环境运动状态检测内部传感器：自身关节检测传感器伺服驱动控制器下位机：单片机、运动数据存储通信数学运算人机对话型计算机上位机：个人微机、小控制器5.1引言第5章机器人控制技术5.1.4机器人控制系统工业机器人2020年3月28日星期六机器人控制系统的组成1、硬件上位机（个人微机或小型计算机）的功能：人机对话：人将作业任务给机器人，同时机器人将结果反馈回来，即人与机器人之间的交流。数学运算：机器人运动学、动力学和数学插补运算。通信功能：与下位机进行数据传送和相互交换。数据存储：存储编制好的作业任务程序和中间数据。5.1引言第5章机器人控制技术5.1.4机器人控制系统工业机器人2020年3月28日星期六机器人控制系统的组成1、硬件下位机（单片机或运动控制器）的功能：伺服驱动控制：接收上位机的关节运动参数信号和传感器的反馈信号，并对其进行比较，然后经过误差放大和各种补偿，最终输出关节运动所需的控制信号。28March20205.1引言第5章机器人控制技术5.1.4机器人控制系统工业机器人2020年3月28日星期六机器人控制系统的组成1、硬件——单片机应用5.1引言第5章机器人控制技术5.1.4机器人控制系统工业机器人2020年3月28日星期六机器人控制系统的组成1、硬件——运动控制器介绍运动控制器核心由ADSP2181数字信号处理器及其外围部件组成，可以实现高性能的控制计算，同步控制多个运动轴，实现多轴协调运动。应用领域包括机器人、数控机床等。5.1引言第5章机器人控制技术5.1.4机器人控制系统工业机器人2020年3月28日星期六机器人控制系统的组成1、硬件——运动控制器介绍运动控制器以PC为主机，提供标准的ISA、PCI及通用的串口总线和数字I/O接口。运动控制器提供高级语言函数库和Windows动态连接库，可以实现复杂的控制功能。用户能够将这些控制函数与自己控制系统所需的数据处理、界面显示、用户接口等应用程序模块集成在一起，建造符合特定应用要求的控制系统，以适应各种应用领域的要求。5.1引言第5章机器人控制技术5.1.4机器人控制系统工业机器人2020年3月28日星期六机器人控制系统的组成1、硬件——运动控制器应用5.1引言第5章机器人控制技术5.1.4机器人控制系统工业机器人2020年3月28日星期六机器人控制系统的组成1、硬件内部传感器的功能：内部传感器的主要目的是对自身的运动状态进行检测，即检测机器人各个关节的位移、速度和加速度等运动参数，为机器人的控制提供反馈信号。机器人使用的内部传感器主要包括位置、位移、速度和加速度等传感器。5.1引言第5章机器人控制技术5.1.4机器人控制系统工业机器人2020年3月28日星期六机器人控制系统的组成1、硬件外部传感器的功能：机器人要能在变化的作业环境中完成作业任务，就必须具备类似于人类对环境的感觉功能。将机器人用于对工作环境变化的检测的传感器称为外部传感器，有时也拟人的称为环境感觉传感器或环境感觉器官。目前，机器人常用的环境感觉技术主要有视觉、听觉、触觉、力觉等。5.1引言第5章机器人控制技术5.1.4机器人控制系统工业机器人2020年3月28日星期六程序实时监视、故障报警等监控软件程序作业任务程序编制环境编程软件程序运动学、动力学和插补运算软件实时动作解释执行程序动作控制软件应用软件单片机、运动控制器系统初始化程序个人微机、小型计算机计算机操作系统系统软件机器人控制系统的组成2、软件5.1引言第5章机器人控制技术5.1.4机器人控制系统工业机器人2020年3月28日星期六控制过程：示教人员将机器人作业任务中要求手的运动预先教给机器人，在示教的过程中，机器人控制系统就将关节运动状态参数记忆存储在存储器中。当需要机器人工作时，机器人的控制系统就调用存储器中存储的各项数据，驱动关节运动，使机器人再现示教过的手的运动，由此完成要求的作业任务。作业任务手的运动关节产生运动关节运动参数控制系统驱动装置关节产生运动示教记忆再现驱动反馈5.2示教再现控制第5章机器人控制技术工业机器人2020年3月28日星期六5.2示教再现控制第5章机器人控制技术5.2.1示教方式5.2.2记忆过程工业机器人2020年3月28日星期六5.2.1示教方式机器人示教的方式种类繁多，总的可以分为集中示教方式和分离示教方式。1、集中示教方式将机器人手部在空间的位姿、速度、动作顺序等参数同时进行示教的方式，示教一次即可生成关节运动的伺服指令。2、分离示教方式将机器人手部在空间的位姿、速度、动作顺序等参数分开单独进行示教的方式，一般需要示教多次才可生成关节运动的伺服指令，但其效果要好于集中示教方式。5.2示教再现控制第5章机器人控制技术工业机器人2020年3月28日星期六5.2.1示教方式当对用点位（PTP）控制的点焊、搬运机器人进行示教时，可以分开编制程序，且能进行编辑、修改等工作，但是机器人手部在作曲线运动而且位置精度要求较高时，示教点数就会较多，示教时间就会拉长，且在每一个示教点处都要停止和启动，因此就很难进行速度的控制。5.2示教再现控制第5章机器人控制技术工业机器人2020年3月28日星期六5.2.1示教方式当对用连续轨迹（CP）控制的弧焊、喷漆机器人进行示教时，示教操作一旦开始就不能中途停止，必须不中断的连续进行到底，且在示教途中很难进行局部的修改。示教时，可以是手把手示教，也可通过示教盒示教。5.2示教再现控制第5章机器人控制技术工业机器人2020年3月28日星期六28March20205.2.2记忆过程示教关节产生运动变换装置控制系统传感装置存储器检测转换保存在示教的过程中，机器人关节运动状态的变化被传感器检测到，经过转换，再通过变换装置送入控制系统，控制系统就将这些数据保存在存储器中，作为再现示教过的手的运动时所需要的关节运动参数数据。5.2示教再现控制第5章机器人控制技术工业机器人2020年3月28日星期六示教关节产生运动变换装置控制系统传感装置存储器检测转换保存1、记忆速度取决于传感器的检测速度、变换装置的转换速度和控制系统存储器的存储速度。2、记忆容量取决于控制系统存储器的容量。5.2.2记忆过程5.2示教再现控制第5章机器人控制技术工业机器人2020年3月28日星期六机器人的运动控制是指机器人手部在空间从一点移动到另一点的过程中或沿某一轨迹运动时，对其位姿、速度和加速度等运动参数的控制。由机器人运动学可知，机器