1 1机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件工业机器人系统组成工业机器人系统组成工业机器人系统组成工业机器人系统组成2 2 2 2机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件 机器人的轨迹规划与生成机器人的轨迹规划与生成 机器人控制综述机器人控制综述 机器人控制系统的一般构成机器人控制系统的一般构成 机器人传感器机器人传感器3 3 3 3机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.1 4.1 机器人的轨迹规划与生机器人的轨迹规划与生成成4.1.1 4.1.1 机器人规划的基本概念机器人规划的基本概念4.1.2 4.1.2 关节空间法关节空间法4.1.3 4.1.3 直角坐标空间法直角坐标空间法4.1.4 4.1.4 轨迹的实时生成轨迹的实时生成4.1.5 4.1.5 路径的描述路径的描述 4 4 4 4机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.1.1 4.1.1 机器人规划的基本概念机器人规划的基本概念 所谓机器人的规划所谓机器人的规划(P1anning)(P1anning)，指的是，指的是机器人根据自身的任务，求得完成这一任务机器人根据自身的任务，求得完成这一任务的解决方案的过程的解决方案的过程。这里所说的任务，具有广。这里所说的任务，具有广义的概念，既可以指机器人要完成的某一具体义的概念，既可以指机器人要完成的某一具体任务，也可以是机器人的某个动作，比如手部任务，也可以是机器人的某个动作，比如手部或关节的某个规定的运动等。或关节的某个规定的运动等。5 5 5 5机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件 为说明机器人规划的概念，我们举下面的为说明机器人规划的概念，我们举下面的例子：例子： 在一些老龄化比较严重的国家，开发了各种各在一些老龄化比较严重的国家，开发了各种各样的机器人专门用于伺候老人，这些机器人有不少是样的机器人专门用于伺候老人，这些机器人有不少是采用声控的方式比如主人用声音命令机器人采用声控的方式比如主人用声音命令机器人“给我给我倒一杯开水倒一杯开水”，我们先不考虑机器人是如何识别人的，我们先不考虑机器人是如何识别人的自然语言，而是着重分析一下机器人在得到这样一个自然语言，而是着重分析一下机器人在得到这样一个命今后，如何来完成主人交给的任务。命今后，如何来完成主人交给的任务。6 6 6 6机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件 首先，机器人应该把任务进行分解，把主人交代的任务分解成为“取一个杯子”、“找到水壶”、“打开瓶塞”、“把水倒人杯中”、“把水送给主人”等一系列子任务。这一层次的规划称为任务规划任务规划任务规划任务规划(Task planning)，它完成总体任务的分解。 然后再针对每一个子任务进行进一步的规划。以“把水倒入杯中”这一子任务为例，可以进一步分解成为“把水壶提到杯口上方”、“把水壶倾斜倒水入杯”、“把水壶竖直“、“把水壶放回原处”等一系列动作，这一层次的规划称为动作规划动作规划动作规划动作规划(Motion P1anning)，它把实现每一个子任务的过程分解为一系列具体的动作。 为了实现每一个动作，需要对手部的运动轨迹进行必要的规定，这是手部轨迹规划轨迹规划(Hand trajectory planning )。 为了使手部实现预定的运动，就要知道各关节的运动规律，这是关节轨迹规划关节轨迹规划(Joint trajectory planning)。 最后才是关节的运动控制运动控制(Motion control)。7 7 7 7机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件 上述例子可以看出，机器人的规划是分层次的，上述例子可以看出，机器人的规划是分层次的，从高层的从高层的任务规划任务规划，动作规划动作规划到到手手部轨迹规划部轨迹规划和和关节关节轨迹规划轨迹规划，最后才是，最后才是底层的控制底层的控制( (见图见图) )。在上述例子。在上述例子中，我们没有讨论力的问题，实际上，对有些机器人中，我们没有讨论力的问题，实际上，对有些机器人来说，力的大小也是要控制的，这时，除了手部或关来说，力的大小也是要控制的，这时，除了手部或关节的轨迹规划，还要进行手部和关节输出节的轨迹规划，还要进行手部和关节输出力的规划力的规划。 智能化程度越高，规划的层次越多，操作就越简智能化程度越高，规划的层次越多，操作就越简单。单。 对工业机器人来说，高层的任务规划和动作规划对工业机器人来说，高层的任务规划和动作规划一般是依赖人来完成的。而且一般的工业机器人也不一般是依赖人来完成的。而且一般的工业机器人也不具备力的反馈，所以，工业机器人通常只具有轨迹规具备力的反馈，所以，工业机器人通常只具有轨迹规划的和底层的控制功能。划的和底层的控制功能。8 8 8 8机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件取一个杯子取一个杯子 找到水壶找到水壶 打开水壶打开水壶把水倒入杯中把水倒入杯中 把水送给主人把水送给主人给主人倒一杯水给主人倒一杯水 提起水壶到杯口上方提起水壶到杯口上方 把水壶倾斜把水壶倾斜 把水壶竖直把水壶竖直 把水壶放回原处把水壶放回原处 手部从手部从A点移到点移到B 点点 关节从关节从A点移到点移到B点点图图 智能机器人的规划层次智能机器人的规划层次9 9 9 9机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件 轨迹规划的目的是轨迹规划的目的是将操作人员输入的将操作人员输入的简单的简单的任务描述任务描述变为详细的变为详细的运动轨迹描述运动轨迹描述。 例如，对一般的工业机器人来说，操作员可能只例如，对一般的工业机器人来说，操作员可能只输入机械手末端的目标位置和方位，而规划的任务便输入机械手末端的目标位置和方位，而规划的任务便是要确定出达到目标的关节轨迹的形状、运动的时间是要确定出达到目标的关节轨迹的形状、运动的时间和速度等。这里所说的轨迹是指随时间变化的位置、和速度等。这里所说的轨迹是指随时间变化的位置、速度和加速度。速度和加速度。10101010机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件 简言之，机器人的工作过程，就是通过规划，将要求的任简言之，机器人的工作过程，就是通过规划，将要求的任务变为期望的运动和力，由控制环节根据期望的运动和力的信务变为期望的运动和力，由控制环节根据期望的运动和力的信号，产生相应的控制作用，以使机器人输出实际的运动和力，号，产生相应的控制作用，以使机器人输出实际的运动和力，从而完成期望的任务。这一过程表述如下图所示。这里，机器从而完成期望的任务。这一过程表述如下图所示。这里，机器人实际运动的情况通常还要反馈给规划级和控制级，以便对规人实际运动的情况通常还要反馈给规划级和控制级，以便对规划和控制的结果做出适当的修正。划和控制的结果做出适当的修正。人人机机接接口口规规划划控控制制机机器器人人本本体体要求的任务要求的任务 期望的期望的运动和力运动和力 实际的实际的运动和力运动和力控制作用控制作用图图 机器人的工作原理示意图机器人的工作原理示意图11111111机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件 上图中，要求的任务由操作人员输入给机器人，上图中，要求的任务由操作人员输入给机器人，为了使机器人操作方便、使用简单，必须允许操作人为了使机器人操作方便、使用简单，必须允许操作人员给出尽量简单的描述。员给出尽量简单的描述。 上图中，期望的运动和力是进行机器人控制所必上图中，期望的运动和力是进行机器人控制所必需的输入量，它们是机械手末端在每一个时刻的位姿需的输入量，它们是机械手末端在每一个时刻的位姿和速度，对于绝大多数情况，还要求给出每一时刻期和速度，对于绝大多数情况，还要求给出每一时刻期望的关节位移和速度，有些控制方法还要求给出期望望的关节位移和速度，有些控制方法还要求给出期望的加速度等。的加速度等。12121212机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件对于对于PTPPTP控制控制: : 通常只给出机械手末端的起点和终点，有时也通常只给出机械手末端的起点和终点，有时也给出一些中间经过点，所有这些点统称为路径点。给出一些中间经过点，所有这些点统称为路径点。应注意这里所说的应注意这里所说的“点点” ” 不仅包括机械手末端的位不仅包括机械手末端的位置，而且包括方位，因此描述一个点通常需要置，而且包括方位，因此描述一个点通常需要6 6个量。个量。通常希望机械手末端的运动是光滑的，即它具有连通常希望机械手末端的运动是光滑的，即它具有连续的一阶导数，有时甚至要求具有连续的二阶导数。续的一阶导数，有时甚至要求具有连续的二阶导数。不平滑的运动容易造成机构的磨损和破坏，甚至可不平滑的运动容易造成机构的磨损和破坏，甚至可能激发机械手的振动。因此规划的任务便是要根据能激发机械手的振动。因此规划的任务便是要根据给定的路径点规划出通过这些点的光滑的运动轨迹。给定的路径点规划出通过这些点的光滑的运动轨迹。13131313机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件对于对于CPCP控制控制: : 机械手末端的运动轨迹是根据任务的需要给定机械手末端的运动轨迹是根据任务的需要给定的，但是它也必须按照一定的采样间隔，通过逆运的，但是它也必须按照一定的采样间隔，通过逆运动学计算，将其变换到关节空间，然后在关节空间动学计算，将其变换到关节空间，然后在关节空间中寻找光滑函数来拟合这些离散点最后，还有在中寻找光滑函数来拟合这些离散点最后，还有在机器人的计算机内部如何表示轨迹，以及如何实时机器人的计算机内部如何表示轨迹，以及如何实时地生成轨迹的问题。地生成轨迹的问题。 14141414机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件 轨迹规划问题又可以分为轨迹规划问题又可以分为关节空间的轨迹规划关节空间的轨迹规划和和直角空间的轨迹规划直角空间的轨迹规划。4.1.2 4.1.2 关节空间法关节空间法 关节空间法首先将在工具空间中期望的路径点，关节空间法首先将在工具空间中期望的路径点，通过逆运动学计算，得到期望的通过逆运动学计算，得到期望的关节位置关节位置，然后在关，然后在关节空间内，给每个关节找到一个经过中间点到达目的节空间内，给每个关节找到一个经过中间点到达目的终点的终点的光滑函数光滑函数，同时使得每个关节到达中间点和终，同时使得每个关节到达中间点和终点的点的时间相同时间相同，这样便可保证机械手工具能够到达期，这样便可保证机械手工具能够到达期望的直角坐标位置。这里只要求各个关节在路径点之望的直角坐标位置。这里只要求各个关节在路径点之间的间的时间相同时间相同，而，而各个关节的光滑函数的确定则是互各个关节的光滑函数的确定则是互相独立的相独立的。15151515机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件下面具体介绍在关节空间内常用的两种规划方法下面具体介绍在关节空间内常用的两种规划方法1 1） 三次多项式函数插值三次多项式函数插值 考虑机械手末端在一定时间内从初始位置和方位移动到考虑机械手末端在一定时间内从初始位置和方位移动到目标位置和方位的问题。利用逆运动学计算，可以首先求目标位置和方位的问题。利用逆运动学计算，可以首先求出一组起始和终了的关节位置现在的问题是求出一组通出一组起始和终了的关节位置现在的问题是求出一组通过起点和终点的过起点和终点的光滑函数光滑函数光滑函数光滑函数。满足这个条件的光滑函数可以。满足这个条件的光滑函数可以有许多条，如下图所示：有许多条，如下图所示：16161616机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件显然，这些光滑函数必须满足以下条件显然，这些光滑函数必须满足以下条件：同时若要求在起点和终点的速度为零，即：同时若要求在起点和终点的速度为零，即：那么可以选择如下的三次多项式：那么可以选择如下的三次多项式： 作为所要求的光滑函数。式作为所要求的光滑函数。式4-3中有中有4个待定系数，而个待定系数，而该式需满足式该式需满足式4-1和和4-2的的4个约束条件，因此可以唯一地解个约束条件，因此可以唯一地解出这些系数：出这些系数：（4-3）（4-2）（4-1）17171717机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件（4-4）18181818机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件例：例： 设机械手的某个关节的起始关节角设机械手的某个关节的起始关节角0 015150 0，并且机械手，并且机械手原来是静止的。要求在原来是静止的。要求在3 3秒钟内平滑地运动到秒钟内平滑地运动到f f=75=750 0时停下来时停下来( (即要求在终端时速度为零即要求在终端时速度为零) )。规划出满足上述条件的平滑运动。规划出满足上述条件的平滑运动的轨迹，并画出关节角位置、角速度及角加速度随时间变化的的轨迹，并画出关节角位置、角速度及角加速度随时间变化的曲线。曲线。解：解： 根据所给约束条件，直接代入式根据所给约束条件，直接代入式(4-4)(4-4)，可得：，可得：a0=15，a1=0，a2=20，a3=-4.44所求关节角的位置函数为：所求关节角的位置函数为：对上式求导，可以得到角速度和角加速度对上式求导，可以得到角速度和角加速度（4-5）（4-6）（4-7）19191919机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件 根据式根据式(4-5)(4-5)(4-7)(4-7)可画出它们随时间的变可画出它们随时间的变化曲线如下图所示。由图看出，速度曲线为一抛化曲线如下图所示。由图看出，速度曲线为一抛物线，加速度则为一直线。物线，加速度则为一直线。利用三次多项式规划出的关节角的运动轨迹利用三次多项式规划出的关节角的运动轨迹20202020机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件2 2）抛物线连接的线性函数插值）抛物线连接的线性函数插值 前面介绍了利用三次多项式函数插值的规划方前面介绍了利用三次多项式函数插值的规划方法。另外一种常用方法是线性函数插值法，即用一法。另外一种常用方法是线性函数插值法，即用一条直线将起点与终点连接起来。但是，简单的线性条直线将起点与终点连接起来。但是，简单的线性函数插值将使得关节的运动速度在起点和终点处不函数插值将使得关节的运动速度在起点和终点处不连续，它也意味着需要产生无穷大的加速度，这显连续，它也意味着需要产生无穷大的加速度，这显然是不希望的。因此可以考虑在起点和终点处，用然是不希望的。因此可以考虑在起点和终点处，用抛物线与直线连接起来，在抛物线段内，使用恒定抛物线与直线连接起来，在抛物线段内，使用恒定的加速度来平滑地改变速度，从而使得整个运动轨的加速度来平滑地改变速度，从而使得整个运动轨迹的位置和速度是连续的。迹的位置和速度是连续的。21212121机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件线性函数插值图线性函数插值图利用抛物线过渡的线性函利用抛物线过渡的线性函数插值图数插值图22222222机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.1.3 4.1.3 直角坐标直角坐标空间法空间法 前面介绍的在关节空间内的规划，可以保证运动前面介绍的在关节空间内的规划，可以保证运动轨迹经过给定的路径点。但是在直角坐标空间，路径轨迹经过给定的路径点。但是在直角坐标空间，路径点之间的轨迹形状往往是十分复杂的，它取决于机械点之间的轨迹形状往往是十分复杂的，它取决于机械手的运动学机构特性。在有些情况下，对机械手末端手的运动学机构特性。在有些情况下，对机械手末端的轨迹形状也有一定要求，如要求它在两点之间走一的轨迹形状也有一定要求，如要求它在两点之间走一条直线，或者沿着一个圆弧运动以绕过障碍物等。这条直线，或者沿着一个圆弧运动以绕过障碍物等。这时便需要在直角坐标空间内规划机械手的运动轨迹时便需要在直角坐标空间内规划机械手的运动轨迹 直角坐标空间的路径点，指的是机械手末端的工直角坐标空间的路径点，指的是机械手末端的工具坐标相对于基坐标的位置和姿态每一个点由具坐标相对于基坐标的位置和姿态每一个点由6 6个个量组成，其中量组成，其中3 3个量描述位置，另外个量描述位置，另外3 3个量描述姿态。个量描述姿态。在直角坐标空间内规划的方法主要有：在直角坐标空间内规划的方法主要有：线性函数线性函数插值法插值法和和圆弧插值法圆弧插值法。23232323机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.1.4 4.1.4 轨迹的实时生成轨迹的实时生成 前面轨迹规划的任务，是根据给定的路径点规前面轨迹规划的任务，是根据给定的路径点规划出运动轨迹的所有参数。划出运动轨迹的所有参数。 例如，在用三次多项式函数插值时，便是产生例如，在用三次多项式函数插值时，便是产生出多项式系数出多项式系数a a0 0,a,a1 1,a,a2 2,a,a3 3从而得到整个轨迹的运动从而得到整个轨迹的运动方程：方程：对上式求导，可以得到速度和加速度对上式求导，可以得到速度和加速度24242424机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.1.5 4.1.5 路径的描述路径的描述 前面讨论了在给定路径点的情况下如何规划出前面讨论了在给定路径点的情况下如何规划出运动轨迹的问题。但是还有一个如何描述路径点并运动轨迹的问题。但是还有一个如何描述路径点并以合适的方式输入给机器人的问题。最常用的方法以合适的方式输入给机器人的问题。最常用的方法便是利用机器人语言。便是利用机器人语言。 用户将要求实现的动作编成相应的应用程序，用户将要求实现的动作编成相应的应用程序，其中有相应的语句用来描述轨迹规划，并通过相应其中有相应的语句用来描述轨迹规划，并通过相应的控制作用来实现期望的运动。的控制作用来实现期望的运动。25252525机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.2 4.2 机器人控制综述机器人控制综述 机器人控制的基本目的：机器人控制的基本目的：机器人控制的基本目的：机器人控制的基本目的： 告诉机器人要做什么告诉机器人要做什么告诉机器人要做什么告诉机器人要做什么; ; ; ; 机器人接受命令，并形成作业的控制策略机器人接受命令，并形成作业的控制策略机器人接受命令，并形成作业的控制策略机器人接受命令，并形成作业的控制策略; ; ; ; 保证正确完成作业保证正确完成作业保证正确完成作业保证正确完成作业; 通报作业完成情况。通报作业完成情况。通报作业完成情况。通报作业完成情况。 26262626机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人控制系统的特点机器人控制系统的特点1)1)1)1)机机机机器器器器人人人人有有有有若若若若干干干干个个个个关关关关节节节节，典典典典型型型型工工工工业业业业业业业业机机机机器器器器人人人人有有有有5 5 5 5至至至至6 6 6 6个个个个关关关关节节节节。每每每每个个个个关关关关节节节节由由由由一一一一个伺服系统控制，多个关节的运动要求各个伺服系统协同工作。个伺服系统控制，多个关节的运动要求各个伺服系统协同工作。个伺服系统控制，多个关节的运动要求各个伺服系统协同工作。个伺服系统控制，多个关节的运动要求各个伺服系统协同工作。2)2)2)2)机机机机器器器器人人人人的的的的工工工工作作作作任任任任务务务务是是是是要要要要求求求求操操操操作作作作机机机机的的的的末末末末端端端端执执执执行行行行器器器器进进进进行行行行空空空空间间间间点点点点位位位位运运运运动动动动或或或或轨轨轨轨迹迹迹迹运运运运动动动动。对对对对机机机机器器器器人人人人运运运运动动动动的的的的控控控控制制制制，需需需需要要要要进进进进行行行行复复复复杂杂杂杂的的的的坐坐坐坐标标标标变变变变换换换换运运运运算算算算，以以以以及及及及矩矩矩矩阵阵阵阵函函函函数的逆运算。数的逆运算。数的逆运算。数的逆运算。3)3)3)3)机机机机器器器器人人人人的的的的数数数数学学学学模模模模型型型型是是是是一一一一个个个个多多多多变变变变量量量量、非非非非线线线线性性性性和和和和变变变变参参参参数数数数的的的的复复复复杂杂杂杂模模模模型型型型，各各各各变变变变量量量量之之之之间间间间还还还还存存存存在在在在着着着着耦耦耦耦合合合合，因因因因此此此此机机机机器器器器人人人人的的的的控控控控制制制制中中中中经经经经常常常常使使使使用用用用前前前前馈馈馈馈、补补补补偿偿偿偿、解解解解耦耦耦耦、自自自自适应等复杂控制技术。适应等复杂控制技术。适应等复杂控制技术。适应等复杂控制技术。4)4)4)4)较较较较高高高高级级级级的的的的机机机机器器器器人人人人要要要要求求求求对对对对环环环环境境境境条条条条件件件件、控控控控制制制制指指指指令令令令进进进进行行行行测测测测定定定定和和和和分分分分析析析析，采采采采用用用用计计计计算算算算机机机机建建建建立立立立庞庞庞庞大大大大的的的的信信信信息息息息库库库库，用用用用人人人人工工工工智智智智能能能能的的的的方方方方法法法法进进进进行行行行控控控控制制制制、决决决决策策策策、管管管管理理理理和和和和操操操操作作作作，按照给定的要求自动选择最佳控制规律。按照给定的要求自动选择最佳控制规律。按照给定的要求自动选择最佳控制规律。按照给定的要求自动选择最佳控制规律。27272727机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人控制系统的功能机器人控制系统的功能(1)(1)伺伺伺伺服服服服控控控控制制制制功功功功能能能能 该该该该功功功功能能能能主主主主要要要要是是是是指指指指机机机机器器器器人人人人的的的的运运运运动动动动控控控控制制制制，实实实实现现现现机器人各关节的位置、速度、加速度等的控制。机器人各关节的位置、速度、加速度等的控制。机器人各关节的位置、速度、加速度等的控制。机器人各关节的位置、速度、加速度等的控制。(2)(2)运运运运算算算算功功功功能能能能 机机机机器器器器人人人人运运运运动动动动学学学学的的的的正正正正运运运运算算算算和和和和逆逆逆逆运运运运算算算算是是是是其其其其中中中中最最最最基基基基本本本本的的的的部部部部分分分分。对对对对于于于于具具具具有有有有连连连连续续续续轨轨轨轨迹迹迹迹控控控控制制制制功功功功能能能能的的的的机机机机器器器器人人人人来来来来说说说说，还还还还需需需需要要要要有有有有直直直直角角角角坐坐坐坐标标标标轨轨轨轨迹迹迹迹插插插插补补补补功功功功能能能能和和和和一一一一些些些些必必必必要要要要的的的的函函函函数数数数运运运运算算算算功功功功能能能能。在在在在一一一一些些些些高高高高速速速速度度度度、高高高高精精精精度度度度的的的的机机机机器器器器人人人人控控控控制制制制系系系系统统统统当当当当中中中中，系系系系统统统统往往往往往往往往还还还还要要要要完完完完成机器人动力学模型和复杂控制算法等运算功能。成机器人动力学模型和复杂控制算法等运算功能。成机器人动力学模型和复杂控制算法等运算功能。成机器人动力学模型和复杂控制算法等运算功能。(3)(3)系统的管理功能系统的管理功能系统的管理功能系统的管理功能 方便的人机交互功能。方便的人机交互功能。方便的人机交互功能。方便的人机交互功能。 具有对外部环境具有对外部环境具有对外部环境具有对外部环境( (包括作业条件包括作业条件包括作业条件包括作业条件) )的检测和感觉功能。的检测和感觉功能。的检测和感觉功能。的检测和感觉功能。 系统的监控与故障诊断功能。系统的监控与故障诊断功能。系统的监控与故障诊断功能。系统的监控与故障诊断功能。28282828机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人控制的特点机器人控制的特点机器人控制的特点机器人控制的特点机器人的控制问题是与其运动学和动力学问题密切相关机器人的控制问题是与其运动学和动力学问题密切相关机器人的控制问题是与其运动学和动力学问题密切相关机器人的控制问题是与其运动学和动力学问题密切相关从控制观点看，机器人系统代表冗余的、多变量和本质上从控制观点看，机器人系统代表冗余的、多变量和本质上从控制观点看，机器人系统代表冗余的、多变量和本质上从控制观点看，机器人系统代表冗余的、多变量和本质上非线性的控制系统，同时又是复杂的耦合动态系统。每个非线性的控制系统，同时又是复杂的耦合动态系统。每个非线性的控制系统，同时又是复杂的耦合动态系统。每个非线性的控制系统，同时又是复杂的耦合动态系统。每个控制任务本身就是一个动力学任务。控制任务本身就是一个动力学任务。控制任务本身就是一个动力学任务。控制任务本身就是一个动力学任务。在实际研究中，往往把机器人控制系统简化为若干个低阶在实际研究中，往往把机器人控制系统简化为若干个低阶在实际研究中，往往把机器人控制系统简化为若干个低阶在实际研究中，往往把机器人控制系统简化为若干个低阶子系统来描述。子系统来描述。子系统来描述。子系统来描述。29292929机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人机器人机器人机器人控制方法的分类控制方法的分类控制方法的分类控制方法的分类 根据不同的分类方法，机器人控制方式可以有根据不同的分类方法，机器人控制方式可以有不同的分类。下图是一种常用的分类方法。从总体不同的分类。下图是一种常用的分类方法。从总体上，机器人的控制方式可以分为上，机器人的控制方式可以分为动作控制方式动作控制方式和和示示教控制方式教控制方式。 按照被控对象来分，可以分为按照被控对象来分，可以分为位置控制、速度位置控制、速度控制、加速度控制、力控制、力矩控制、力和位置控制、加速度控制、力控制、力矩控制、力和位置混合控制混合控制等等。等等。 无论是位置控制或速度控制，从伺服反馈信号无论是位置控制或速度控制，从伺服反馈信号的形式来看，又可以分为的形式来看，又可以分为基于关节空间的伺服控制基于关节空间的伺服控制和和基于作业空间基于作业空间( (手部坐标手部坐标) )的伺服控制的伺服控制。30303030机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件31313131机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件32323232机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件举例：举例：关节伺服控制关节伺服控制 这是以关节位置或关节轨迹为目标值的控制形式。下图给这是以关节位置或关节轨迹为目标值的控制形式。下图给出了关节伺服系统的构成。若目标值以关节位移给出，则如下出了关节伺服系统的构成。若目标值以关节位移给出，则如下图所示，各关节可以独立构成伺服系统，十分简单。图所示，各关节可以独立构成伺服系统，十分简单。第第第第i i轴轴轴轴第第第第i i轴轴轴轴目目目目标标标标值值值值轨轨轨轨迹迹迹迹生生生生成成成成第第第第i i关节伺服系统关节伺服系统关节伺服系统关节伺服系统33333333机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.3 4.3 机器人控制系统的一般构成机器人控制系统的一般构成 从前面关于服务机器人的规划过程的介绍中可知，对于从前面关于服务机器人的规划过程的介绍中可知，对于一个具有高度智能的机器人，它的控制实际上包含了一个具有高度智能的机器人，它的控制实际上包含了“任务任务规划规划”、“动作规划动作规划”、“轨迹规划轨迹规划”和基于规模的和基于规模的“伺服伺服控制控制”等多个层次，如下图所示等多个层次，如下图所示, ,机器人首先要机器人首先要通过人机接口通过人机接口获取操作者的指令获取操作者的指令，指令的形式可以是人的自然语言，或者，指令的形式可以是人的自然语言，或者是由人发出的专用的指令语言是由人发出的专用的指令语言( (用在大部分服务机器人上用在大部分服务机器人上) )，也可以是通过示教工具输入的示教指令也可以是通过示教工具输入的示教指令( (如一般的示教控制机如一般的示教控制机器人器人) )，或者键盘输人的机器人指令语言以及计算机程序指令，或者键盘输人的机器人指令语言以及计算机程序指令( (加大部分工业机器人加大部分工业机器人) )，然后机器人对控制命令进行，然后机器人对控制命令进行解释理解释理解解，把操作者的命令分解为机器人可以实现的，把操作者的命令分解为机器人可以实现的“任务任务”，这，这是是任务规划任务规划。机器人针对各个任务进行动作分解，这是。机器人针对各个任务进行动作分解，这是动作动作规划规划。为了实现机器人的一系列动作，应该对机器人每个关。为了实现机器人的一系列动作，应该对机器人每个关节的运动进行设计，这是机器人的节的运动进行设计，这是机器人的轨迹规划轨迹规划。最底层是。最底层是关节关节运动的伺服控制运动的伺服控制。34343434机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件35353535机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人控制系统的硬件构成机器人控制系统的硬件构成(1)36363636机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人控制系统的硬件构成机器人控制系统的硬件构成(2)37373737机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件PUMA560机器人控制系统机器人控制系统38383838机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人控制系统的功能、组成机器人控制系统的功能、组成机器人控制系统的功能、组成机器人控制系统的功能、组成 基本功能构成基本功能构成基本功能构成基本功能构成记忆功能：记忆功能：记忆功能：记忆功能：存储作业顺序、运动路径、运动方式、运动速度和存储作业顺序、运动路径、运动方式、运动速度和存储作业顺序、运动路径、运动方式、运动速度和存储作业顺序、运动路径、运动方式、运动速度和 与生产工艺有关的信息。与生产工艺有关的信息。与生产工艺有关的信息。与生产工艺有关的信息。 示教功能：示教功能：示教功能：示教功能：离线编程，在线示教，间接示教。离线编程，在线示教，间接示教。离线编程，在线示教，间接示教。离线编程，在线示教，间接示教。 在线示教包括示教盒和导引示教两种。在线示教包括示教盒和导引示教两种。在线示教包括示教盒和导引示教两种。在线示教包括示教盒和导引示教两种。 与外围设备联系功能：与外围设备联系功能：与外围设备联系功能：与外围设备联系功能：输入和输出接口、通信接口、网络接口、同步接口。输入和输出接口、通信接口、网络接口、同步接口。输入和输出接口、通信接口、网络接口、同步接口。输入和输出接口、通信接口、网络接口、同步接口。 坐标设置功能：坐标设置功能：坐标设置功能：坐标设置功能：有关节、绝对、工具、用户自定义四种坐标系。有关节、绝对、工具、用户自定义四种坐标系。有关节、绝对、工具、用户自定义四种坐标系。有关节、绝对、工具、用户自定义四种坐标系。 人机接口：人机接口：人机接口：人机接口：示教盒、操作面板、显示屏。示教盒、操作面板、显示屏。示教盒、操作面板、显示屏。示教盒、操作面板、显示屏。 传感器接口：传感器接口：传感器接口：传感器接口：位置检测、视觉、触觉、力觉等位置检测、视觉、触觉、力觉等位置检测、视觉、触觉、力觉等位置检测、视觉、触觉、力觉等 位置伺服功能：位置伺服功能：位置伺服功能：位置伺服功能：机器人多轴联动、运动控制、速度和加速度控制、动态补偿等。机器人多轴联动、运动控制、速度和加速度控制、动态补偿等。机器人多轴联动、运动控制、速度和加速度控制、动态补偿等。机器人多轴联动、运动控制、速度和加速度控制、动态补偿等。 故障诊断安全保护功能：故障诊断安全保护功能：故障诊断安全保护功能：故障诊断安全保护功能：运行时系统状态监视、故障状态下的安全保护和运行时系统状态监视、故障状态下的安全保护和运行时系统状态监视、故障状态下的安全保护和运行时系统状态监视、故障状态下的安全保护和 故障自诊断。故障自诊断。故障自诊断。故障自诊断。 39393939机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件 机器人控制系统的组成机器人控制系统的组成机器人控制系统的组成机器人控制系统的组成 （1 1）控制计算机控制计算机控制计算机控制计算机 控制系统的调度指挥机构。一般为微型机、微处理器有控制系统的调度指挥机构。一般为微型机、微处理器有控制系统的调度指挥机构。一般为微型机、微处理器有控制系统的调度指挥机构。一般为微型机、微处理器有3232位、位、位、位、6464位等，如奔腾系列位等，如奔腾系列位等，如奔腾系列位等，如奔腾系列CPUCPU以及其他类型以及其他类型以及其他类型以及其他类型CPUCPU； （2 2）示教盒示教盒示教盒示教盒 示教机器人的工作轨迹和参数设定，以及所有人机交互操作，示教机器人的工作轨迹和参数设定，以及所有人机交互操作，示教机器人的工作轨迹和参数设定，以及所有人机交互操作，示教机器人的工作轨迹和参数设定，以及所有人机交互操作，拥有自己独立的拥有自己独立的拥有自己独立的拥有自己独立的CPUCPU以及存储单元，与主计算机之间以串行通信方式实现信以及存储单元，与主计算机之间以串行通信方式实现信以及存储单元，与主计算机之间以串行通信方式实现信以及存储单元，与主计算机之间以串行通信方式实现信息交互；息交互；息交互；息交互； （3 3）操作面板操作面板操作面板操作面板 由各种操作按键、状态指示灯构成，只完成基本功能操作；由各种操作按键、状态指示灯构成，只完成基本功能操作；由各种操作按键、状态指示灯构成，只完成基本功能操作；由各种操作按键、状态指示灯构成，只完成基本功能操作； （4 4）硬盘和软盘存储硬盘和软盘存储硬盘和软盘存储硬盘和软盘存储 存储机器人工作程序的外围存储器；存储机器人工作程序的外围存储器；存储机器人工作程序的外围存储器；存储机器人工作程序的外围存储器； （5 5）数字和模拟量输入输出数字和模拟量输入输出数字和模拟量输入输出数字和模拟量输入输出 各种状态和控制命令的输入或输出；各种状态和控制命令的输入或输出；各种状态和控制命令的输入或输出；各种状态和控制命令的输入或输出； （6 6）打印机接口打印机接口打印机接口打印机接口 记录需要输出的各种信息；记录需要输出的各种信息；记录需要输出的各种信息；记录需要输出的各种信息； （7 7）传感器接口传感器接口传感器接口传感器接口 用于信息的自动检测，实现机器人柔顺控制，一般为力觉、用于信息的自动检测，实现机器人柔顺控制，一般为力觉、用于信息的自动检测，实现机器人柔顺控制，一般为力觉、用于信息的自动检测，实现机器人柔顺控制，一般为力觉、触觉和视觉传感器；触觉和视觉传感器；触觉和视觉传感器；触觉和视觉传感器； （8 8）轴控制器轴控制器轴控制器轴控制器 完成机器人各关节位置、速度和加速度控制；完成机器人各关节位置、速度和加速度控制；完成机器人各关节位置、速度和加速度控制；完成机器人各关节位置、速度和加速度控制； （9 9）辅助设备控制辅助设备控制辅助设备控制辅助设备控制 用于和机器人配合的辅助设备控制，如手爪变位器等；用于和机器人配合的辅助设备控制，如手爪变位器等；用于和机器人配合的辅助设备控制，如手爪变位器等；用于和机器人配合的辅助设备控制，如手爪变位器等； （1010）通信接口通信接口通信接口通信接口 实现机器人和其他设备的信息交换，一般有串行接口、并行实现机器人和其他设备的信息交换，一般有串行接口、并行实现机器人和其他设备的信息交换，一般有串行接口、并行实现机器人和其他设备的信息交换，一般有串行接口、并行接口等；接口等；接口等；接口等； （1111）网络接口网络接口网络接口网络接口 。40404040机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件 机器人控制系统框图机器人控制系统框图机器人控制系统框图机器人控制系统框图41414141机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件 机器人机器人机器人机器人的轨迹控制的轨迹控制的轨迹控制的轨迹控制机械手由初始点机械手由初始点机械手由初始点机械手由初始点( ( ( (位置和姿态位置和姿态位置和姿态位置和姿态) ) ) )运动到终止点经过的空间曲线运动到终止点经过的空间曲线运动到终止点经过的空间曲线运动到终止点经过的空间曲线称为路径。称为路径。称为路径。称为路径。轨迹规划方法一般是在机器人初始位置和目标位置之间用多轨迹规划方法一般是在机器人初始位置和目标位置之间用多轨迹规划方法一般是在机器人初始位置和目标位置之间用多轨迹规划方法一般是在机器人初始位置和目标位置之间用多项式函数来项式函数来项式函数来项式函数来“内插内插内插内插”或或或或“逼近逼近逼近逼近”给定的路径，并产生一系列给定的路径，并产生一系列给定的路径，并产生一系列给定的路径，并产生一系列“控制设定点控制设定点控制设定点控制设定点”。路径端点一般是在笛卡儿坐标中给出的。路径端点一般是在笛卡儿坐标中给出的。路径端点一般是在笛卡儿坐标中给出的。路径端点一般是在笛卡儿坐标中给出的。如果需要某些位置的关节坐标，则可调用运动学逆问题求解如果需要某些位置的关节坐标，则可调用运动学逆问题求解如果需要某些位置的关节坐标，则可调用运动学逆问题求解如果需要某些位置的关节坐标，则可调用运动学逆问题求解程序，进行必要的转换。程序，进行必要的转换。程序，进行必要的转换。程序，进行必要的转换。 在给定的两端点之间，常有多条可能的轨迹。而轨迹在给定的两端点之间，常有多条可能的轨迹。而轨迹在给定的两端点之间，常有多条可能的轨迹。而轨迹在给定的两端点之间，常有多条可能的轨迹。而轨迹控制就是控制机器人手端沿着一定的目标轨迹运动。因此，控制就是控制机器人手端沿着一定的目标轨迹运动。因此，控制就是控制机器人手端沿着一定的目标轨迹运动。因此，控制就是控制机器人手端沿着一定的目标轨迹运动。因此，目标轨迹的给定方法和如何控制机器人手臂使之高精度地跟目标轨迹的给定方法和如何控制机器人手臂使之高精度地跟目标轨迹的给定方法和如何控制机器人手臂使之高精度地跟目标轨迹的给定方法和如何控制机器人手臂使之高精度地跟踪目标轨迹的方法是轨迹控制的两个主要内容。踪目标轨迹的方法是轨迹控制的两个主要内容。踪目标轨迹的方法是轨迹控制的两个主要内容。踪目标轨迹的方法是轨迹控制的两个主要内容。 给定目标轨迹的方式有给定目标轨迹的方式有给定目标轨迹的方式有给定目标轨迹的方式有示教再现方式示教再现方式示教再现方式示教再现方式和和和和数控方式数控方式数控方式数控方式（离线编程离线编程离线编程离线编程）两种。）两种。）两种。）两种。 42424242机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件示教再现方式示教再现方式示教再现方式示教再现方式l l示教再现方式是在机器工作之前，让机器人手端沿目标轨示教再现方式是在机器工作之前，让机器人手端沿目标轨示教再现方式是在机器工作之前，让机器人手端沿目标轨示教再现方式是在机器工作之前，让机器人手端沿目标轨迹移动，同时将位置及速度等数据存入机器人控制计算机迹移动，同时将位置及速度等数据存入机器人控制计算机迹移动，同时将位置及速度等数据存入机器人控制计算机迹移动，同时将位置及速度等数据存入机器人控制计算机中。在机器人工作时再现所示教的动作，使手端沿目标轨中。在机器人工作时再现所示教的动作，使手端沿目标轨中。在机器人工作时再现所示教的动作，使手端沿目标轨中。在机器人工作时再现所示教的动作，使手端沿目标轨迹运动。迹运动。迹运动。迹运动。l l示教时使机器人手臂运动的方法有两种：一种是用示教盒示教时使机器人手臂运动的方法有两种：一种是用示教盒示教时使机器人手臂运动的方法有两种：一种是用示教盒示教时使机器人手臂运动的方法有两种：一种是用示教盒上的控制按钮发出各种运动指令；另一种是操作者直接用上的控制按钮发出各种运动指令；另一种是操作者直接用上的控制按钮发出各种运动指令；另一种是操作者直接用上的控制按钮发出各种运动指令；另一种是操作者直接用手抓住机器人手部，使其手端按目标轨迹运动。轨迹记忆手抓住机器人手部，使其手端按目标轨迹运动。轨迹记忆手抓住机器人手部，使其手端按目标轨迹运动。轨迹记忆手抓住机器人手部，使其手端按目标轨迹运动。轨迹记忆再现的方式有点位控制再现的方式有点位控制再现的方式有点位控制再现的方式有点位控制(PTP)(PTP)和连续路径控制和连续路径控制和连续路径控制和连续路径控制(CP)(CP)。点位。点位。点位。点位控制主要用于点焊作业、更换刀具或其他工具等情况。连控制主要用于点焊作业、更换刀具或其他工具等情况。连控制主要用于点焊作业、更换刀具或其他工具等情况。连控制主要用于点焊作业、更换刀具或其他工具等情况。连续路径控制主要用于弧焊、喷漆等作业续路径控制主要用于弧焊、喷漆等作业续路径控制主要用于弧焊、喷漆等作业续路径控制主要用于弧焊、喷漆等作业。43434343机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件数控方式数控方式数控方式数控方式 数控方式与数控机床的控制方式一样，是把目标轨迹用数控方式与数控机床的控制方式一样，是把目标轨迹用数控方式与数控机床的控制方式一样，是把目标轨迹用数控方式与数控机床的控制方式一样，是把目标轨迹用数值数据的形式给出。这些数据是根据工作任务的需要设数值数据的形式给出。这些数据是根据工作任务的需要设数值数据的形式给出。这些数据是根据工作任务的需要设数值数据的形式给出。这些数据是根据工作任务的需要设置的。置的。置的。置的。无论是采用示教再现方式还是用数值方式，都需要生成点无论是采用示教再现方式还是用数值方式，都需要生成点无论是采用示教再现方式还是用数值方式，都需要生成点无论是采用示教再现方式还是用数值方式，都需要生成点与点之间的目标轨迹。此种目标轨迹要根据不同的情况要与点之间的目标轨迹。此种目标轨迹要根据不同的情况要与点之间的目标轨迹。此种目标轨迹要根据不同的情况要与点之间的目标轨迹。此种目标轨迹要根据不同的情况要求生成。但是也要遵循一些共同的原则。求生成。但是也要遵循一些共同的原则。求生成。但是也要遵循一些共同的原则。求生成。但是也要遵循一些共同的原则。 例如，生成的目标轨迹应是实际上能实现的平滑例如，生成的目标轨迹应是实际上能实现的平滑例如，生成的目标轨迹应是实际上能实现的平滑例如，生成的目标轨迹应是实际上能实现的平滑的轨迹；要保证位置、速度及加速度的连续性。保证手端的轨迹；要保证位置、速度及加速度的连续性。保证手端的轨迹；要保证位置、速度及加速度的连续性。保证手端的轨迹；要保证位置、速度及加速度的连续性。保证手端轨迹、速度及加速度的连续性，是通过各关节变量的连续轨迹、速度及加速度的连续性，是通过各关节变量的连续轨迹、速度及加速度的连续性，是通过各关节变量的连续轨迹、速度及加速度的连续性，是通过各关节变量的连续性实现的。性实现的。性实现的。性实现的。44444444机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的力控制一般与位置控制融合在一起形成位置和力机器人的力控制一般与位置控制融合在一起形成位置和力机器人的力控制一般与位置控制融合在一起形成位置和力机器人的力控制一般与位置控制融合在一起形成位置和力的混合控制。的混合控制。的混合控制。的混合控制。例如：例如：例如：例如：步行机器人在行走时，足与地面的接触力在不断变步行机器人在行走时，足与地面的接触力在不断变步行机器人在行走时，足与地面的接触力在不断变步行机器人在行走时，足与地面的接触力在不断变化，对腿的各关节控制是一个典型且严格的位置和力混合化，对腿的各关节控制是一个典型且严格的位置和力混合化，对腿的各关节控制是一个典型且严格的位置和力混合化，对腿的各关节控制是一个典型且严格的位置和力混合控制问题。腿在支撑状态时，由于机体的运动，支撑点与控制问题。腿在支撑状态时，由于机体的运动，支撑点与控制问题。腿在支撑状态时，由于机体的运动，支撑点与控制问题。腿在支撑状态时，由于机体的运动，支撑点与步行机器人重心间的相对位置在不断变化，导致足与地面步行机器人重心间的相对位置在不断变化，导致足与地面步行机器人重心间的相对位置在不断变化，导致足与地面步行机器人重心间的相对位置在不断变化，导致足与地面接触力的不断变化，同时要对各关节的位置进行控制。在接触力的不断变化，同时要对各关节的位置进行控制。在接触力的不断变化，同时要对各关节的位置进行控制。在接触力的不断变化，同时要对各关节的位置进行控制。在这种情况下，位置控制与力控制组成一个有机整体，这种情况下，位置控制与力控制组成一个有机整体，这种情况下，位置控制与力控制组成一个有机整体，这种情况下，位置控制与力控制组成一个有机整体，力控力控力控力控制是在正确的位置控制基础上进一步的控制内容。制是在正确的位置控制基础上进一步的控制内容。制是在正确的位置控制基础上进一步的控制内容。制是在正确的位置控制基础上进一步的控制内容。 机器人的力控制机器人的力控制机器人的力控制机器人的力控制45454545机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件作业约束与力控制作业约束与力控制作业约束与力控制作业约束与力控制机器人手端机器人手端机器人手端机器人手端( ( ( (常为机器人手臂端部安装的工具常为机器人手臂端部安装的工具常为机器人手臂端部安装的工具常为机器人手臂端部安装的工具) ) ) )与环境与环境与环境与环境( ( ( (作作作作业对象业对象业对象业对象) ) ) )接触时，环境的几何特性构成对作业的约束，这接触时，环境的几何特性构成对作业的约束，这接触时，环境的几何特性构成对作业的约束，这接触时，环境的几何特性构成对作业的约束，这种约束称为自然约束。自然约束是指在某种特定的接触情种约束称为自然约束。自然约束是指在某种特定的接触情种约束称为自然约束。自然约束是指在某种特定的接触情种约束称为自然约束。自然约束是指在某种特定的接触情况下自然发生的约束，而与机器人的希望或打算作的运动况下自然发生的约束，而与机器人的希望或打算作的运动况下自然发生的约束，而与机器人的希望或打算作的运动况下自然发生的约束，而与机器人的希望或打算作的运动无关。无关。无关。无关。例如，当手部与固定刚性表面接触时，不能自由穿过这个例如，当手部与固定刚性表面接触时，不能自由穿过这个例如，当手部与固定刚性表面接触时，不能自由穿过这个例如，当手部与固定刚性表面接触时，不能自由穿过这个表面，称为自然位置约束；若这个表面是光滑的，则不能表面，称为自然位置约束；若这个表面是光滑的，则不能表面，称为自然位置约束；若这个表面是光滑的，则不能表面，称为自然位置约束；若这个表面是光滑的，则不能对手施加沿表面切线方向的力，称为自然力约束。一般可对手施加沿表面切线方向的力，称为自然力约束。一般可对手施加沿表面切线方向的力，称为自然力约束。一般可对手施加沿表面切线方向的力，称为自然力约束。一般可将接触表面定义为一个广义曲面，沿曲面法线方向定义自将接触表面定义为一个广义曲面，沿曲面法线方向定义自将接触表面定义为一个广义曲面，沿曲面法线方向定义自将接触表面定义为一个广义曲面，沿曲面法线方向定义自然位置约束，沿切线方向定义自然力约束。然位置约束，沿切线方向定义自然力约束。然位置约束，沿切线方向定义自然力约束。然位置约束，沿切线方向定义自然力约束。46464646机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件位置和力控制系统结构位置和力控制系统结构位置和力控制系统结构位置和力控制系统结构l l具有力反馈的控制系统如下图：具有力反馈的控制系统如下图：具有力反馈的控制系统如下图：具有力反馈的控制系统如下图：l l其工作过程为：机器人开始工作时，机器人手端其工作过程为：机器人开始工作时，机器人手端其工作过程为：机器人开始工作时，机器人手端其工作过程为：机器人开始工作时，机器人手端( (或安装或安装或安装或安装在手臂端部的工具在手臂端部的工具在手臂端部的工具在手臂端部的工具) )按指令要求沿目标轨迹和给定速度运按指令要求沿目标轨迹和给定速度运按指令要求沿目标轨迹和给定速度运按指令要求沿目标轨迹和给定速度运动。当手端与环境接触时，安装在机器人上的接触传感动。当手端与环境接触时，安装在机器人上的接触传感动。当手端与环境接触时，安装在机器人上的接触传感动。当手端与环境接触时，安装在机器人上的接触传感器或力传感器感觉到接触的发生。机器人控制程序按新器或力传感器感觉到接触的发生。机器人控制程序按新器或力传感器感觉到接触的发生。机器人控制程序按新器或力传感器感觉到接触的发生。机器人控制程序按新的自然约束和人工约束来执行新的控制策略，即位置与的自然约束和人工约束来执行新的控制策略，即位置与的自然约束和人工约束来执行新的控制策略，即位置与的自然约束和人工约束来执行新的控制策略，即位置与力的混合控制。力的混合控制。力的混合控制。力的混合控制。47474747机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.4 4 机器人传感器机器人传感器4.4.4.4.4.1 4.1 4.1 4.1 传感器的功能与分类传感器的功能与分类传感器的功能与分类传感器的功能与分类4.4.4.4.4.2 4.2 4.2 4.2 传感器的选择要求传感器的选择要求传感器的选择要求传感器的选择要求4.4.4.4.4.3 4.3 4.3 4.3 内部测量用内部测量用内部测量用内部测量用传感器传感器传感器传感器4.4.4.4.4.4 4.4 4.4 4.4 外部测量用外部测量用外部测量用外部测量用传感器传感器传感器传感器4.4.5 4.4.5 4.4.5 4.4.5 运动机器人的传感器运动机器人的传感器运动机器人的传感器运动机器人的传感器4.4.6 4.4.6 4.4.6 4.4.6 传感器与集成控制传感器与集成控制传感器与集成控制传感器与集成控制48484848机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4机器人的传感器机器人的传感器几乎所有的机器人都使用几乎所有的机器人都使用几乎所有的机器人都使用几乎所有的机器人都使用内部传感嚣内部传感嚣内部传感嚣内部传感嚣 如：为测量回转关节位置的如：为测量回转关节位置的如：为测量回转关节位置的如：为测量回转关节位置的轴角编码器，轴角编码器，轴角编码器，轴角编码器， 测量速度以控制其运动的测量速度以控制其运动的测量速度以控制其运动的测量速度以控制其运动的测速计测速计测速计测速计。大多数控制器也具备接口能力，故来自输送装置，机床以大多数控制器也具备接口能力，故来自输送装置，机床以大多数控制器也具备接口能力，故来自输送装置，机床以大多数控制器也具备接口能力，故来自输送装置，机床以及机器人本身的信号，可被综合利用以完成一项任务。及机器人本身的信号，可被综合利用以完成一项任务。及机器人本身的信号，可被综合利用以完成一项任务。及机器人本身的信号，可被综合利用以完成一项任务。外部传感器外部传感器外部传感器外部传感器，如视觉传感器，可为更高层次的机器人控制，如视觉传感器，可为更高层次的机器人控制，如视觉传感器，可为更高层次的机器人控制，如视觉传感器，可为更高层次的机器人控制提供大得多的适应能力，也就是给工业机器人增加了自动提供大得多的适应能力，也就是给工业机器人增加了自动提供大得多的适应能力，也就是给工业机器人增加了自动提供大得多的适应能力，也就是给工业机器人增加了自动检测能力。检测能力。检测能力。检测能力。49494949机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.1 4.4.1 传感器的功能、定义与分类传感器的功能、定义与分类人类熟悉的五种感觉，即视觉、嗅觉、味觉、听觉和触觉。人类熟悉的五种感觉，即视觉、嗅觉、味觉、听觉和触觉。人类熟悉的五种感觉，即视觉、嗅觉、味觉、听觉和触觉。人类熟悉的五种感觉，即视觉、嗅觉、味觉、听觉和触觉。视觉的最重要功能是选择合适的、安全的运动路径。双目视觉的最重要功能是选择合适的、安全的运动路径。双目视觉的最重要功能是选择合适的、安全的运动路径。双目视觉的最重要功能是选择合适的、安全的运动路径。双目视觉和其它知觉的刺激，使我们能辨别物体的距离。彩色视觉和其它知觉的刺激，使我们能辨别物体的距离。彩色视觉和其它知觉的刺激，使我们能辨别物体的距离。彩色视觉和其它知觉的刺激，使我们能辨别物体的距离。彩色视觉可以很快辨别千百万种明暗不同的光线和颜色。由高视觉可以很快辨别千百万种明暗不同的光线和颜色。由高视觉可以很快辨别千百万种明暗不同的光线和颜色。由高视觉可以很快辨别千百万种明暗不同的光线和颜色。由高密度杆型和锥型感受体所提供的空间鉴别力，使我们能在密度杆型和锥型感受体所提供的空间鉴别力，使我们能在密度杆型和锥型感受体所提供的空间鉴别力，使我们能在密度杆型和锥型感受体所提供的空间鉴别力，使我们能在适宜的光线下，分辨尘埃微粒。我们对光亮的敏感度是如适宜的光线下，分辨尘埃微粒。我们对光亮的敏感度是如适宜的光线下，分辨尘埃微粒。我们对光亮的敏感度是如适宜的光线下，分辨尘埃微粒。我们对光亮的敏感度是如此之高，可以在漆黑的夜晚，看见此之高，可以在漆黑的夜晚，看见此之高，可以在漆黑的夜晚，看见此之高，可以在漆黑的夜晚，看见3030英里以外的烛光。从英里以外的烛光。从英里以外的烛光。从英里以外的烛光。从很亮的环境到很暗的环境，靠自动亮度控制，可以很快地很亮的环境到很暗的环境，靠自动亮度控制，可以很快地很亮的环境到很暗的环境，靠自动亮度控制，可以很快地很亮的环境到很暗的环境，靠自动亮度控制，可以很快地调整适应。靠眼睛供给我们需要的大部分信息。据估计，调整适应。靠眼睛供给我们需要的大部分信息。据估计，调整适应。靠眼睛供给我们需要的大部分信息。据估计，调整适应。靠眼睛供给我们需要的大部分信息。据估计，传给大脑的信息中，有传给大脑的信息中，有传给大脑的信息中，有传给大脑的信息中，有7070来自视觉器官。来自视觉器官。来自视觉器官。来自视觉器官。50505050机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.1.14.4.1.1听觉听觉听觉听觉象视觉一样，听觉也是立体的，可使我们判断声音的方向象视觉一样，听觉也是立体的，可使我们判断声音的方向象视觉一样，听觉也是立体的，可使我们判断声音的方向象视觉一样，听觉也是立体的，可使我们判断声音的方向和距离。甚至在我们出生之前，这种感觉就发育得很好。和距离。甚至在我们出生之前，这种感觉就发育得很好。和距离。甚至在我们出生之前，这种感觉就发育得很好。和距离。甚至在我们出生之前，这种感觉就发育得很好。当我们睡觉时，它也在很好地工作。它是如此的敏锐，以当我们睡觉时，它也在很好地工作。它是如此的敏锐，以当我们睡觉时，它也在很好地工作。它是如此的敏锐，以当我们睡觉时，它也在很好地工作。它是如此的敏锐，以致很多母亲能够听到在另一个房间里新生婴儿的呼吸。我致很多母亲能够听到在另一个房间里新生婴儿的呼吸。我致很多母亲能够听到在另一个房间里新生婴儿的呼吸。我致很多母亲能够听到在另一个房间里新生婴儿的呼吸。我们也可以利用听觉来选择适当的运动形式，特别是当视觉们也可以利用听觉来选择适当的运动形式，特别是当视觉们也可以利用听觉来选择适当的运动形式，特别是当视觉们也可以利用听觉来选择适当的运动形式，特别是当视觉丧失或视线受阻时，比如我们还没有看见汽车，而听到它丧失或视线受阻时，比如我们还没有看见汽车，而听到它丧失或视线受阻时，比如我们还没有看见汽车，而听到它丧失或视线受阻时，比如我们还没有看见汽车，而听到它开来，便是如此。我们也可用听觉作出判断。例如，很多开来，便是如此。我们也可用听觉作出判断。例如，很多开来，便是如此。我们也可用听觉作出判断。例如，很多开来，便是如此。我们也可用听觉作出判断。例如，很多富有经验的汽车维修工，只凭听发动机运转的声音，即可富有经验的汽车维修工，只凭听发动机运转的声音，即可富有经验的汽车维修工，只凭听发动机运转的声音，即可富有经验的汽车维修工，只凭听发动机运转的声音，即可正确地辨别是否存在问题。我们可以区分很多不同的声调正确地辨别是否存在问题。我们可以区分很多不同的声调正确地辨别是否存在问题。我们可以区分很多不同的声调正确地辨别是否存在问题。我们可以区分很多不同的声调和波长，从而能够区分和辨识世界上数以万计的物体和现和波长，从而能够区分和辨识世界上数以万计的物体和现和波长，从而能够区分和辨识世界上数以万计的物体和现和波长，从而能够区分和辨识世界上数以万计的物体和现象。象。象。象。51515151机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.1.24.4.1.2嗅觉和味觉嗅觉和味觉嗅觉和味觉嗅觉和味觉无须再用任何其它器官，我们的嗅觉就能使我们区分很多无须再用任何其它器官，我们的嗅觉就能使我们区分很多无须再用任何其它器官，我们的嗅觉就能使我们区分很多无须再用任何其它器官，我们的嗅觉就能使我们区分很多物体和现象。嗅觉在帮助我们辨识那些看不见的或隐藏的物体和现象。嗅觉在帮助我们辨识那些看不见的或隐藏的物体和现象。嗅觉在帮助我们辨识那些看不见的或隐藏的物体和现象。嗅觉在帮助我们辨识那些看不见的或隐藏的东西，如气体时是特别重要的。东西，如气体时是特别重要的。东西，如气体时是特别重要的。东西，如气体时是特别重要的。味觉在确定食物可饮用性时也很重要。四种味道味觉在确定食物可饮用性时也很重要。四种味道味觉在确定食物可饮用性时也很重要。四种味道味觉在确定食物可饮用性时也很重要。四种味道苦、苦、苦、苦、酸、咸和甜有助于提高我们摄取基本营养品的食欲。很多酸、咸和甜有助于提高我们摄取基本营养品的食欲。很多酸、咸和甜有助于提高我们摄取基本营养品的食欲。很多酸、咸和甜有助于提高我们摄取基本营养品的食欲。很多人都会说他们的味觉发育得太好了。因而，可以用我们的人都会说他们的味觉发育得太好了。因而，可以用我们的人都会说他们的味觉发育得太好了。因而，可以用我们的人都会说他们的味觉发育得太好了。因而，可以用我们的味觉器官去识别和区分很多物体。例如，可以察觉食物中味觉器官去识别和区分很多物体。例如，可以察觉食物中味觉器官去识别和区分很多物体。例如，可以察觉食物中味觉器官去识别和区分很多物体。例如，可以察觉食物中的微量金属的微量金属的微量金属的微量金属( ( ( (这就是为什么我们不用金属餐具去点调美昧这就是为什么我们不用金属餐具去点调美昧这就是为什么我们不用金属餐具去点调美昧这就是为什么我们不用金属餐具去点调美昧食品的原因食品的原因食品的原因食品的原因) ) ) )，以及那些既看不见，又闻不到的某些气体，以及那些既看不见，又闻不到的某些气体，以及那些既看不见，又闻不到的某些气体，以及那些既看不见，又闻不到的某些气体或化学物质。或化学物质。或化学物质。或化学物质。52525252机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.1.34.4.1.3触觉触觉触觉触觉触觉蕴含比我们通常想象更高的敏感度。在我们的皮肤中，触觉蕴含比我们通常想象更高的敏感度。在我们的皮肤中，触觉蕴含比我们通常想象更高的敏感度。在我们的皮肤中，触觉蕴含比我们通常想象更高的敏感度。在我们的皮肤中，植入了成千上万的压力、温度和疼痛传感器。例如，约有植入了成千上万的压力、温度和疼痛传感器。例如，约有植入了成千上万的压力、温度和疼痛传感器。例如，约有植入了成千上万的压力、温度和疼痛传感器。例如，约有2 2百万个疼痛传感器，百万个疼痛传感器，百万个疼痛传感器，百万个疼痛传感器，5050万个压力传感器和万个压力传感器和万个压力传感器和万个压力传感器和2020万个温度传万个温度传万个温度传万个温度传感器不均匀地遍布人体，主要在表皮。例如，膝盖每平方感器不均匀地遍布人体，主要在表皮。例如，膝盖每平方感器不均匀地遍布人体，主要在表皮。例如，膝盖每平方感器不均匀地遍布人体，主要在表皮。例如，膝盖每平方厘米有厘米有厘米有厘米有232232个疼痛传感器，大姆指上每平方厦米有个疼痛传感器，大姆指上每平方厦米有个疼痛传感器，大姆指上每平方厦米有个疼痛传感器，大姆指上每平方厦米有6060个而个而个而个而鼻子尖上每平方厘米有鼻子尖上每平方厘米有鼻子尖上每平方厘米有鼻子尖上每平方厘米有4444个。当其它感官失效或受到干扰个。当其它感官失效或受到干扰个。当其它感官失效或受到干扰个。当其它感官失效或受到干扰时，我们还可以用这种感觉去辨识相区分物体和现象。比时，我们还可以用这种感觉去辨识相区分物体和现象。比时，我们还可以用这种感觉去辨识相区分物体和现象。比时，我们还可以用这种感觉去辨识相区分物体和现象。比如说，无需其它感官就可以感觉和辨识则我们背上的一只如说，无需其它感官就可以感觉和辨识则我们背上的一只如说，无需其它感官就可以感觉和辨识则我们背上的一只如说，无需其它感官就可以感觉和辨识则我们背上的一只毛虫，并采取相应的行动。毛虫，并采取相应的行动。毛虫，并采取相应的行动。毛虫，并采取相应的行动。53535353机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.1.44.4.1.4动觉和平衡觉动觉和平衡觉动觉和平衡觉动觉和平衡觉动觉感官动觉感官动觉感官动觉感官位于筋、关节和肌肉等处的感觉接受器可以告知位于筋、关节和肌肉等处的感觉接受器可以告知位于筋、关节和肌肉等处的感觉接受器可以告知位于筋、关节和肌肉等处的感觉接受器可以告知大脑、整个身体的位置和运动。它使我们不必盯着自己的大脑、整个身体的位置和运动。它使我们不必盯着自己的大脑、整个身体的位置和运动。它使我们不必盯着自己的大脑、整个身体的位置和运动。它使我们不必盯着自己的腿就能走路，收缩肌肉而无须看它。闭着眼睛也可用手摸腿就能走路，收缩肌肉而无须看它。闭着眼睛也可用手摸腿就能走路，收缩肌肉而无须看它。闭着眼睛也可用手摸腿就能走路，收缩肌肉而无须看它。闭着眼睛也可用手摸到鼻子。到鼻子。到鼻子。到鼻子。平衡的感官平衡的感官平衡的感官平衡的感官主要位于内耳的前庭感官提供这种平衡感，主要位于内耳的前庭感官提供这种平衡感，主要位于内耳的前庭感官提供这种平衡感，主要位于内耳的前庭感官提供这种平衡感，这种感官告诉我们是头朝上还是脚朝下，是加快还是减慢，这种感官告诉我们是头朝上还是脚朝下，是加快还是减慢，这种感官告诉我们是头朝上还是脚朝下，是加快还是减慢，这种感官告诉我们是头朝上还是脚朝下，是加快还是减慢，是上升还是下降。当我们乘座游戏车时，正是这种感官的是上升还是下降。当我们乘座游戏车时，正是这种感官的是上升还是下降。当我们乘座游戏车时，正是这种感官的是上升还是下降。当我们乘座游戏车时，正是这种感官的巧妙控制给我们以惊险之感。巧妙控制给我们以惊险之感。巧妙控制给我们以惊险之感。巧妙控制给我们以惊险之感。54545454机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.1.54.4.1.5传感器的定义和组成传感器的定义和组成传感器的定义和组成传感器的定义和组成传感器按一定规律实现信号检测并将被测量传感器按一定规律实现信号检测并将被测量传感器按一定规律实现信号检测并将被测量传感器按一定规律实现信号检测并将被测量( (物理的、化学的物理的、化学的物理的、化学的物理的、化学的和生物的信息和生物的信息和生物的信息和生物的信息) )通过变送器变换为另一种物理量通过变送器变换为另一种物理量通过变送器变换为另一种物理量通过变送器变换为另一种物理量( (通常是电压或通常是电压或通常是电压或通常是电压或电流量电流量电流量电流量) )。它既能把非电量变换为电量，也能实现电量之间或。它既能把非电量变换为电量，也能实现电量之间或。它既能把非电量变换为电量，也能实现电量之间或。它既能把非电量变换为电量，也能实现电量之间或非电量之间的互相转换。总而言之，一切获取信息的仪表器件非电量之间的互相转换。总而言之，一切获取信息的仪表器件非电量之间的互相转换。总而言之，一切获取信息的仪表器件非电量之间的互相转换。总而言之，一切获取信息的仪表器件都可称为传感器。都可称为传感器。都可称为传感器。都可称为传感器。国际上，传感技术被列为六大核心技术国际上，传感技术被列为六大核心技术国际上，传感技术被列为六大核心技术国际上，传感技术被列为六大核心技术( (计算机、激光、通讯、计算机、激光、通讯、计算机、激光、通讯、计算机、激光、通讯、半到体、超导和传感半到体、超导和传感半到体、超导和传感半到体、超导和传感) )之一。传感技术也是现代信息技术的三之一。传感技术也是现代信息技术的三之一。传感技术也是现代信息技术的三之一。传感技术也是现代信息技术的三大基础大基础大基础大基础( (传感技术、通讯技术、计算机技术传感技术、通讯技术、计算机技术传感技术、通讯技术、计算机技术传感技术、通讯技术、计算机技术) )之一。之一。之一。之一。传感器一般由敏感元件、转换元件、基本转换电路三部分组成。传感器一般由敏感元件、转换元件、基本转换电路三部分组成。传感器一般由敏感元件、转换元件、基本转换电路三部分组成。传感器一般由敏感元件、转换元件、基本转换电路三部分组成。55555555机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.1.64.4.1.6传感器的分类传感器的分类传感器的分类传感器的分类传感器可以按不同的方式进行分类。例如：按被测物理量、传感器可以按不同的方式进行分类。例如：按被测物理量、传感器可以按不同的方式进行分类。例如：按被测物理量、传感器可以按不同的方式进行分类。例如：按被测物理量、按传感器的工作原理、按传感器转换能量的情况、按传感按传感器的工作原理、按传感器转换能量的情况、按传感按传感器的工作原理、按传感器转换能量的情况、按传感按传感器的工作原理、按传感器转换能量的情况、按传感器的工作机理、按传感器输出信号的形式器的工作机理、按传感器输出信号的形式器的工作机理、按传感器输出信号的形式器的工作机理、按传感器输出信号的形式( ( ( (模拟信号、数模拟信号、数模拟信号、数模拟信号、数字信号字信号字信号字信号) ) ) )等分类。等分类。等分类。等分类。按机器人用传感器功能可分为检测内部状态信息传感器和按机器人用传感器功能可分为检测内部状态信息传感器和按机器人用传感器功能可分为检测内部状态信息传感器和按机器人用传感器功能可分为检测内部状态信息传感器和检测外部对象和外部环境状态的外部信息传感器。检测外部对象和外部环境状态的外部信息传感器。检测外部对象和外部环境状态的外部信息传感器。检测外部对象和外部环境状态的外部信息传感器。 内部信息传感器内部信息传感器内部信息传感器内部信息传感器包括检测位置、速度、力、力矩、包括检测位置、速度、力、力矩、包括检测位置、速度、力、力矩、包括检测位置、速度、力、力矩、温度以及异常变化的传感器。温度以及异常变化的传感器。温度以及异常变化的传感器。温度以及异常变化的传感器。 外部信息传感器外部信息传感器外部信息传感器外部信息传感器包括视觉传感器、触觉传感器、包括视觉传感器、触觉传感器、包括视觉传感器、触觉传感器、包括视觉传感器、触觉传感器、力觉传感器、接近觉传感器、角度觉力觉传感器、接近觉传感器、角度觉力觉传感器、接近觉传感器、角度觉力觉传感器、接近觉传感器、角度觉( ( ( (平衡觉平衡觉平衡觉平衡觉) ) ) )传感器等。传感器等。传感器等。传感器等。具有多种外部传感器是先进机器人的重要标志。具有多种外部传感器是先进机器人的重要标志。具有多种外部传感器是先进机器人的重要标志。具有多种外部传感器是先进机器人的重要标志。56565656机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.4.2 4.2 传感器的选择要求传感器的选择要求传感器类型的选择传感器类型的选择传感器性能指标的确定传感器性能指标的确定传感器物理特征的选挥传感器物理特征的选挥57575757机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件一、传感器类型的选择一、传感器类型的选择1 1 1 1从机器人对传感器的需要来选择从机器人对传感器的需要来选择从机器人对传感器的需要来选择从机器人对传感器的需要来选择 机器人对传感器的一般要求是：机器人对传感器的一般要求是：机器人对传感器的一般要求是：机器人对传感器的一般要求是： (1) (1) (1) (1)精度高，重复性好。精度高，重复性好。精度高，重复性好。精度高，重复性好。 (2) (2) (2) (2)稳定性好，可靠性高。稳定性好，可靠性高。稳定性好，可靠性高。稳定性好，可靠性高。 (3) (3) (3) (3)抗干扰能力强。抗干扰能力强。抗干扰能力强。抗干扰能力强。 (4) (4) (4) (4)重量轻，体积小，安装方便可靠。重量轻，体积小，安装方便可靠。重量轻，体积小，安装方便可靠。重量轻，体积小，安装方便可靠。 (5) (5) (5) (5)价格便宜。价格便宜。价格便宜。价格便宜。58585858机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件2 2从加工任务的要求来选择从加工任务的要求来选择在现代工业中，机器人被用于执行各种加工任务，其中比在现代工业中，机器人被用于执行各种加工任务，其中比在现代工业中，机器人被用于执行各种加工任务，其中比在现代工业中，机器人被用于执行各种加工任务，其中比较常见的加工任务有物料搬运、装配、喷漆、焊接、检验较常见的加工任务有物料搬运、装配、喷漆、焊接、检验较常见的加工任务有物料搬运、装配、喷漆、焊接、检验较常见的加工任务有物料搬运、装配、喷漆、焊接、检验等。等。等。等。不同的加工任务对机器人提出了不同的要求。不同的加工任务对机器人提出了不同的要求。不同的加工任务对机器人提出了不同的要求。不同的加工任务对机器人提出了不同的要求。59595959机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件3 3从机器人控制的要求来选择从机器人控制的要求来选择机器人控制需要采用传感器检测机器人的运动位置、速度、机器人控制需要采用传感器检测机器人的运动位置、速度、机器人控制需要采用传感器检测机器人的运动位置、速度、机器人控制需要采用传感器检测机器人的运动位置、速度、加速度。加速度。加速度。加速度。除了较简单的开环控制机器人外，多数机器人都采用了位除了较简单的开环控制机器人外，多数机器人都采用了位除了较简单的开环控制机器人外，多数机器人都采用了位除了较简单的开环控制机器人外，多数机器人都采用了位置传感器作为闭环控制器的反馈元件。机器人根据位置传置传感器作为闭环控制器的反馈元件。机器人根据位置传置传感器作为闭环控制器的反馈元件。机器人根据位置传置传感器作为闭环控制器的反馈元件。机器人根据位置传感器反馈的位置信息，对机器人的运动误差进行补偿。感器反馈的位置信息，对机器人的运动误差进行补偿。感器反馈的位置信息，对机器人的运动误差进行补偿。感器反馈的位置信息，对机器人的运动误差进行补偿。不少机器人还装备有速度传感器和加速度传感器。加速度不少机器人还装备有速度传感器和加速度传感器。加速度不少机器人还装备有速度传感器和加速度传感器。加速度不少机器人还装备有速度传感器和加速度传感器。加速度传感器可以检测机器人构件受到的惯性力，使控制能够补传感器可以检测机器人构件受到的惯性力，使控制能够补传感器可以检测机器人构件受到的惯性力，使控制能够补传感器可以检测机器人构件受到的惯性力，使控制能够补偿惯性力引起的变形误差。速度检测用于预测机器人的运偿惯性力引起的变形误差。速度检测用于预测机器人的运偿惯性力引起的变形误差。速度检测用于预测机器人的运偿惯性力引起的变形误差。速度检测用于预测机器人的运动时间，计算和控制由离心力引起的变形误差。动时间，计算和控制由离心力引起的变形误差。动时间，计算和控制由离心力引起的变形误差。动时间，计算和控制由离心力引起的变形误差。60606060机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4 4从辅助工作的要求来选择从辅助工作的要求来选择 工业机器人在从事某些辅助工作时，也要求有一定的工业机器人在从事某些辅助工作时，也要求有一定的工业机器人在从事某些辅助工作时，也要求有一定的工业机器人在从事某些辅助工作时，也要求有一定的感觉能力。这些辅助工作包括产品的检验和工件的准备等。感觉能力。这些辅助工作包括产品的检验和工件的准备等。感觉能力。这些辅助工作包括产品的检验和工件的准备等。感觉能力。这些辅助工作包括产品的检验和工件的准备等。 机器人在外观检验中的应用日益增多。机器人在这方机器人在外观检验中的应用日益增多。机器人在这方机器人在外观检验中的应用日益增多。机器人在这方机器人在外观检验中的应用日益增多。机器人在这方面的主要用途有检查毛刺、裂缝或孔洞的存在，确定表面面的主要用途有检查毛刺、裂缝或孔洞的存在，确定表面面的主要用途有检查毛刺、裂缝或孔洞的存在，确定表面面的主要用途有检查毛刺、裂缝或孔洞的存在，确定表面粗糙度和装饰质量，检查装配体的完成等。在外观检验中，粗糙度和装饰质量，检查装配体的完成等。在外观检验中，粗糙度和装饰质量，检查装配体的完成等。在外观检验中，粗糙度和装饰质量，检查装配体的完成等。在外观检验中，机器人主要需要视觉能力，有时也需要其他类型的传感器。机器人主要需要视觉能力，有时也需要其他类型的传感器。机器人主要需要视觉能力，有时也需要其他类型的传感器。机器人主要需要视觉能力，有时也需要其他类型的传感器。61616161机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件5 5从安全方面的要求来选择从安全方面的要求来选择从安全方面考虑，机器人对传感器的要求包括以下两个方面：从安全方面考虑，机器人对传感器的要求包括以下两个方面：从安全方面考虑，机器人对传感器的要求包括以下两个方面：从安全方面考虑，机器人对传感器的要求包括以下两个方面：(1)(1)(1)(1)为了使机器人安全地工作而不受损坏，机器人的各个构为了使机器人安全地工作而不受损坏，机器人的各个构为了使机器人安全地工作而不受损坏，机器人的各个构为了使机器人安全地工作而不受损坏，机器人的各个构件都不能超过其受力极限。件都不能超过其受力极限。件都不能超过其受力极限。件都不能超过其受力极限。2)2)2)2)从保护机器人使用者的安全出发，也要考虑对机器人传感从保护机器人使用者的安全出发，也要考虑对机器人传感从保护机器人使用者的安全出发，也要考虑对机器人传感从保护机器人使用者的安全出发，也要考虑对机器人传感器的要求。器的要求。器的要求。器的要求。62626262机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件二、传感器性能指标的确定二、传感器性能指标的确定(1)(1)(1)(1)灵敏度灵敏度灵敏度灵敏度(2)(2)(2)(2)线性度线性度线性度线性度(3)(3)(3)(3)测量范围测量范围测量范围测量范围(4)(4)(4)(4)精度精度精度精度(5)(5)(5)(5)重复性重复性重复性重复性(6)(6)(6)(6)分辨率分辨率分辨率分辨率(7)(7)(7)(7)响应时间响应时间响应时间响应时间(8)(8)(8)(8)可靠性可靠性可靠性可靠性63636363机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件三、传感器物理特征的选择三、传感器物理特征的选择(1)(1)(1)(1)尺寸和重量尺寸和重量尺寸和重量尺寸和重量(2)(2)(2)(2)输出形式输出形式输出形式输出形式 (3)(3)(3)(3)可插接性可插接性可插接性可插接性64646464机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.34.4.3内部传感器内部传感器内部传感器内部传感器电位器电位器电位器电位器：电位器是：电位器是：电位器是：电位器是种典型的位置传感器，种典型的位置传感器，种典型的位置传感器，种典型的位置传感器，可分为直线型可分为直线型可分为直线型可分为直线型( ( ( (测量位移测量位移测量位移测量位移) ) ) )和旋转型和旋转型和旋转型和旋转型( ( ( (测量角测量角测量角测量角度度度度) ) ) )。电位器由环状或棒状电阻丝和滑动片。电位器由环状或棒状电阻丝和滑动片。电位器由环状或棒状电阻丝和滑动片。电位器由环状或棒状电阻丝和滑动片( ( ( (或称为电刷或称为电刷或称为电刷或称为电刷) ) ) )组成，滑动片接触电阻丝取组成，滑动片接触电阻丝取组成，滑动片接触电阻丝取组成，滑动片接触电阻丝取出电信号。电刷与驱动器连成出电信号。电刷与驱动器连成出电信号。电刷与驱动器连成出电信号。电刷与驱动器连成体，将其体，将其体，将其体，将其线位移或角位移转换成电阻的变化，在电线位移或角位移转换成电阻的变化，在电线位移或角位移转换成电阻的变化，在电线位移或角位移转换成电阻的变化，在电路中以电压或电流的变化形式输出。路中以电压或电流的变化形式输出。路中以电压或电流的变化形式输出。路中以电压或电流的变化形式输出。电位器可分为导电塑料、线绕式、混合式电位器可分为导电塑料、线绕式、混合式电位器可分为导电塑料、线绕式、混合式电位器可分为导电塑料、线绕式、混合式等滑片型和磁阻式、光标式等非接触型。等滑片型和磁阻式、光标式等非接触型。等滑片型和磁阻式、光标式等非接触型。等滑片型和磁阻式、光标式等非接触型。65656565机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件测速发电机测速发电机测速发电机测速发电机：测速发电机是利用发电机原理的速度传感器：测速发电机是利用发电机原理的速度传感器：测速发电机是利用发电机原理的速度传感器：测速发电机是利用发电机原理的速度传感器或角速度传感器。或角速度传感器。或角速度传感器。或角速度传感器。 根据这个原理测量角速度的测速发电机，可按其构造分为根据这个原理测量角速度的测速发电机，可按其构造分为根据这个原理测量角速度的测速发电机，可按其构造分为根据这个原理测量角速度的测速发电机，可按其构造分为直流测速发电机、交流测速发电机和感应式交流测速发电直流测速发电机、交流测速发电机和感应式交流测速发电直流测速发电机、交流测速发电机和感应式交流测速发电直流测速发电机、交流测速发电机和感应式交流测速发电机。机。机。机。直流测速发电机的定子是永久磁铁，转子是线圈绕组。可直流测速发电机的定子是永久磁铁，转子是线圈绕组。可直流测速发电机的定子是永久磁铁，转子是线圈绕组。可直流测速发电机的定子是永久磁铁，转子是线圈绕组。可以测量以测量以测量以测量0 010000r10000rminmin的旋转速度，线性度为的旋转速度，线性度为的旋转速度，线性度为的旋转速度，线性度为0.1%0.1%；此；此；此；此外，停机时不易产生残留电压，因此，它最适宜作速度传外，停机时不易产生残留电压，因此，它最适宜作速度传外，停机时不易产生残留电压，因此，它最适宜作速度传外，停机时不易产生残留电压，因此，它最适宜作速度传感器。感器。感器。感器。66666666机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件光学编码器光学编码器光学编码器光学编码器：光学编码器是机器人关节伺服系统中常用的：光学编码器是机器人关节伺服系统中常用的：光学编码器是机器人关节伺服系统中常用的：光学编码器是机器人关节伺服系统中常用的一种检测装置；它实际是一种量化式的模拟数字转换器。一种检测装置；它实际是一种量化式的模拟数字转换器。一种检测装置；它实际是一种量化式的模拟数字转换器。一种检测装置；它实际是一种量化式的模拟数字转换器。将机械轴的转角值或直线运动的位移值转换成相应的电脉将机械轴的转角值或直线运动的位移值转换成相应的电脉将机械轴的转角值或直线运动的位移值转换成相应的电脉将机械轴的转角值或直线运动的位移值转换成相应的电脉冲。冲。冲。冲。 和所有量化式编码器一样，光学编码器分为增量和所有量化式编码器一样，光学编码器分为增量和所有量化式编码器一样，光学编码器分为增量和所有量化式编码器一样，光学编码器分为增量式和绝对式两种。式和绝对式两种。式和绝对式两种。式和绝对式两种。所谓增量式编码器，即在编码盘上的读数起始点是不固定所谓增量式编码器，即在编码盘上的读数起始点是不固定所谓增量式编码器，即在编码盘上的读数起始点是不固定所谓增量式编码器，即在编码盘上的读数起始点是不固定的，它从读数起始点开始，把角位移或线位移的变化量进的，它从读数起始点开始，把角位移或线位移的变化量进的，它从读数起始点开始，把角位移或线位移的变化量进的，它从读数起始点开始，把角位移或线位移的变化量进行累积检测。它只能检测角值或线值的变化量行累积检测。它只能检测角值或线值的变化量行累积检测。它只能检测角值或线值的变化量行累积检测。它只能检测角值或线值的变化量( ( ( (增量增量增量增量) ) ) )故故故故称为增量式编码器。称为增量式编码器。称为增量式编码器。称为增量式编码器。所谓绝对式编码器，其读数起始点是给定的，它以编码盘所谓绝对式编码器，其读数起始点是给定的，它以编码盘所谓绝对式编码器，其读数起始点是给定的，它以编码盘所谓绝对式编码器，其读数起始点是给定的，它以编码盘固有的某图案为起始点，检测角位移或线位移。它能同时固有的某图案为起始点，检测角位移或线位移。它能同时固有的某图案为起始点，检测角位移或线位移。它能同时固有的某图案为起始点，检测角位移或线位移。它能同时检测角值或线值的初始量和增量，也就是能取出总量检测角值或线值的初始量和增量，也就是能取出总量检测角值或线值的初始量和增量，也就是能取出总量检测角值或线值的初始量和增量，也就是能取出总量( ( ( (绝绝绝绝对量对量对量对量) ) ) )，放称为绝对式编码器。，放称为绝对式编码器。，放称为绝对式编码器。，放称为绝对式编码器。67676767机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件68686868机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.44.4.4外部传感器外部传感器外部传感器外部传感器 4.4.4.1 4.4.4.1 4.4.4.1 4.4.4.1 触觉传感器触觉传感器触觉传感器触觉传感器机器人的触觉广义上可获取的信息是：接触信息；狭小区机器人的触觉广义上可获取的信息是：接触信息；狭小区机器人的触觉广义上可获取的信息是：接触信息；狭小区机器人的触觉广义上可获取的信息是：接触信息；狭小区域上的压力信息；分布压力信息；力和力矩信息；滑觉信域上的压力信息；分布压力信息；力和力矩信息；滑觉信域上的压力信息；分布压力信息；力和力矩信息；滑觉信域上的压力信息；分布压力信息；力和力矩信息；滑觉信息。这些信息分别用于触觉识别和触觉控制。从检测信息息。这些信息分别用于触觉识别和触觉控制。从检测信息息。这些信息分别用于触觉识别和触觉控制。从检测信息息。这些信息分别用于触觉识别和触觉控制。从检测信息及等级考虑，触觉识别可分为点信息识别、平面信息识别及等级考虑，触觉识别可分为点信息识别、平面信息识别及等级考虑，触觉识别可分为点信息识别、平面信息识别及等级考虑，触觉识别可分为点信息识别、平面信息识别和空间信息识别和空间信息识别和空间信息识别和空间信息识别3 3种。种。种。种。接触觉传感器接触觉传感器接触觉传感器接触觉传感器：单向微动开关单向微动开关单向微动开关单向微动开关当规定的位移或力作用到当规定的位移或力作用到当规定的位移或力作用到当规定的位移或力作用到可动部分可动部分可动部分可动部分( ( ( (称为执行器称为执行器称为执行器称为执行器) ) ) )时，开关的接点断开或接通而发出时，开关的接点断开或接通而发出时，开关的接点断开或接通而发出时，开关的接点断开或接通而发出相应的信号。相应的信号。相应的信号。相应的信号。69696969机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件接近开关接近开关接近开关接近开关： 非接触式接近传感器有高频振荡式屈感应式、非接触式接近传感器有高频振荡式屈感应式、非接触式接近传感器有高频振荡式屈感应式、非接触式接近传感器有高频振荡式屈感应式、电容感应式、超声波式、气动式、光电式、光纤式等多种电容感应式、超声波式、气动式、光电式、光纤式等多种电容感应式、超声波式、气动式、光电式、光纤式等多种电容感应式、超声波式、气动式、光电式、光纤式等多种接近开关。接近开关。接近开关。接近开关。光电开关光电开关光电开关光电开关是由是由是由是由LEDLED光源和光电二极管或光电三极管等光敏光源和光电二极管或光电三极管等光敏光源和光电二极管或光电三极管等光敏光源和光电二极管或光电三极管等光敏元件，相隔一定距离间构成的透光式开关。当充当基准位元件，相隔一定距离间构成的透光式开关。当充当基准位元件，相隔一定距离间构成的透光式开关。当充当基准位元件，相隔一定距离间构成的透光式开关。当充当基准位置的遮光片通过光源和光敏元件间的缝隙时，光射不到光置的遮光片通过光源和光敏元件间的缝隙时，光射不到光置的遮光片通过光源和光敏元件间的缝隙时，光射不到光置的遮光片通过光源和光敏元件间的缝隙时，光射不到光敏元件上，而起到开关的作用。光电开关的特点是非接触敏元件上，而起到开关的作用。光电开关的特点是非接触敏元件上，而起到开关的作用。光电开关的特点是非接触敏元件上，而起到开关的作用。光电开关的特点是非接触检测，精度可达检测，精度可达检测，精度可达检测，精度可达0.5mm0.5mm左右。左右。左右。左右。70707070机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件 触须传惑器触须传惑器触须传惑器触须传惑器 触须传感器由须状触头及其检测部构成，触头由具有一触须传感器由须状触头及其检测部构成，触头由具有一触须传感器由须状触头及其检测部构成，触头由具有一触须传感器由须状触头及其检测部构成，触头由具有一定长度的柔空软条丝构成，它与物体接触所产生的弯曲由定长度的柔空软条丝构成，它与物体接触所产生的弯曲由定长度的柔空软条丝构成，它与物体接触所产生的弯曲由定长度的柔空软条丝构成，它与物体接触所产生的弯曲由在根部的检测单元检测。与昆虫的触角的功能一样，触须在根部的检测单元检测。与昆虫的触角的功能一样，触须在根部的检测单元检测。与昆虫的触角的功能一样，触须在根部的检测单元检测。与昆虫的触角的功能一样，触须传感器的功能是识别接近的物体用于确认所设定的动作传感器的功能是识别接近的物体用于确认所设定的动作传感器的功能是识别接近的物体用于确认所设定的动作传感器的功能是识别接近的物体用于确认所设定的动作的结束，以及根据接触发出回避动作的指令或搜索对象物的结束，以及根据接触发出回避动作的指令或搜索对象物的结束，以及根据接触发出回避动作的指令或搜索对象物的结束，以及根据接触发出回避动作的指令或搜索对象物的存在。的存在。的存在。的存在。71717171机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件触觉传感器阵列触觉传感器阵列触觉传感器阵列触觉传感器阵列人类的触觉能力是相当强的。人们不但能够拣起一个物体，人类的触觉能力是相当强的。人们不但能够拣起一个物体，人类的触觉能力是相当强的。人们不但能够拣起一个物体，人类的触觉能力是相当强的。人们不但能够拣起一个物体，而且不用眼睛也能识别它的外形，并辨别出它是什么东西。而且不用眼睛也能识别它的外形，并辨别出它是什么东西。而且不用眼睛也能识别它的外形，并辨别出它是什么东西。而且不用眼睛也能识别它的外形，并辨别出它是什么东西。许多小型物体完全可以靠人的触觉辨认出来，如螺钉、开许多小型物体完全可以靠人的触觉辨认出来，如螺钉、开许多小型物体完全可以靠人的触觉辨认出来，如螺钉、开许多小型物体完全可以靠人的触觉辨认出来，如螺钉、开口销、圆销等。如果要求机器人能够进行复杂的装配工作口销、圆销等。如果要求机器人能够进行复杂的装配工作口销、圆销等。如果要求机器人能够进行复杂的装配工作口销、圆销等。如果要求机器人能够进行复杂的装配工作它也需要具有这种能力。采用多个接触传感器组成的触它也需要具有这种能力。采用多个接触传感器组成的触它也需要具有这种能力。采用多个接触传感器组成的触它也需要具有这种能力。采用多个接触传感器组成的触觉传感器阵列是辨认物体的方法之一。觉传感器阵列是辨认物体的方法之一。觉传感器阵列是辨认物体的方法之一。觉传感器阵列是辨认物体的方法之一。72727272机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.4.24.4.4.2滑觉传感器滑觉传感器滑觉传感器滑觉传感器滑觉传感器是检测垂直加压方向的力和位移的传感器。用滑觉传感器是检测垂直加压方向的力和位移的传感器。用滑觉传感器是检测垂直加压方向的力和位移的传感器。用滑觉传感器是检测垂直加压方向的力和位移的传感器。用手爪抓取处于水平位置的物体时，手爪对物体施加水平压手爪抓取处于水平位置的物体时，手爪对物体施加水平压手爪抓取处于水平位置的物体时，手爪对物体施加水平压手爪抓取处于水平位置的物体时，手爪对物体施加水平压力，如果压力较小，垂直方向作用的重力会克服这个压力力，如果压力较小，垂直方向作用的重力会克服这个压力力，如果压力较小，垂直方向作用的重力会克服这个压力力，如果压力较小，垂直方向作用的重力会克服这个压力使物体下滑。能够克服重力的手抓把持力称为最小把持力。使物体下滑。能够克服重力的手抓把持力称为最小把持力。使物体下滑。能够克服重力的手抓把持力称为最小把持力。使物体下滑。能够克服重力的手抓把持力称为最小把持力。（a）力的平衡 （b）重心的移动73737373机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件74747474机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.4.34.4.4.3力觉传感器力觉传感器力觉传感器力觉传感器力觉传感器是一类触觉传感器，它在机器人和机电一体化力觉传感器是一类触觉传感器，它在机器人和机电一体化力觉传感器是一类触觉传感器，它在机器人和机电一体化力觉传感器是一类触觉传感器，它在机器人和机电一体化设备中具有广泛的应用，这里专门加以介绍。设备中具有广泛的应用，这里专门加以介绍。设备中具有广泛的应用，这里专门加以介绍。设备中具有广泛的应用，这里专门加以介绍。力和力矩传感器是用来检测设备内部力或与外界环境相互力和力矩传感器是用来检测设备内部力或与外界环境相互力和力矩传感器是用来检测设备内部力或与外界环境相互力和力矩传感器是用来检测设备内部力或与外界环境相互作用力为目的的，力不是直接可测量的物理量，力是通过作用力为目的的，力不是直接可测量的物理量，力是通过作用力为目的的，力不是直接可测量的物理量，力是通过作用力为目的的，力不是直接可测量的物理量，力是通过其他物理量间接测量出的。其他物理量间接测量出的。其他物理量间接测量出的。其他物理量间接测量出的。力传感器可用作变换器，如压电元件，它可提供一个与变力传感器可用作变换器，如压电元件，它可提供一个与变力传感器可用作变换器，如压电元件，它可提供一个与变力传感器可用作变换器，如压电元件，它可提供一个与变形、亦即作用于接触点的力成正比的信号。这样的测量可形、亦即作用于接触点的力成正比的信号。这样的测量可形、亦即作用于接触点的力成正比的信号。这样的测量可形、亦即作用于接触点的力成正比的信号。这样的测量可用以提供碰撞复原时的力反馈，或使机器人卡爪能够夹持用以提供碰撞复原时的力反馈，或使机器人卡爪能够夹持用以提供碰撞复原时的力反馈，或使机器人卡爪能够夹持用以提供碰撞复原时的力反馈，或使机器人卡爪能够夹持像鸡蛋一类的易损物体而不弄碎它。像鸡蛋一类的易损物体而不弄碎它。像鸡蛋一类的易损物体而不弄碎它。像鸡蛋一类的易损物体而不弄碎它。75757575机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件力和力矩的一般检测方法力和力矩的一般检测方法(1)(1)通过检测物体弹性变形测量力，如采用应变片、弹簧的变通过检测物体弹性变形测量力，如采用应变片、弹簧的变通过检测物体弹性变形测量力，如采用应变片、弹簧的变通过检测物体弹性变形测量力，如采用应变片、弹簧的变形测量力；形测量力；形测量力；形测量力；(2)(2)通过检测物体压电效应检测力；通过检测物体压电效应检测力；通过检测物体压电效应检测力；通过检测物体压电效应检测力；(3)(3)通过检测物体压磁效应检测力；通过检测物体压磁效应检测力；通过检测物体压磁效应检测力；通过检测物体压磁效应检测力；(4)(4)采用电动机、液压马达驱动的设备可以通过检测电动机电采用电动机、液压马达驱动的设备可以通过检测电动机电采用电动机、液压马达驱动的设备可以通过检测电动机电采用电动机、液压马达驱动的设备可以通过检测电动机电流及液压马达油压等方法测量力或转矩；流及液压马达油压等方法测量力或转矩；流及液压马达油压等方法测量力或转矩；流及液压马达油压等方法测量力或转矩；(5)(5)装有速度、加速度传感器的设备，可以通过速度与加速度装有速度、加速度传感器的设备，可以通过速度与加速度装有速度、加速度传感器的设备，可以通过速度与加速度装有速度、加速度传感器的设备，可以通过速度与加速度的测量推出作用力。的测量推出作用力。的测量推出作用力。的测量推出作用力。76767676机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.4.44.4.4.4力觉传感器原理和腕力传感器力觉传感器原理和腕力传感器力觉传感器原理和腕力传感器力觉传感器原理和腕力传感器力觉传感器主要使用的元件是电阻应变片。电阻应变片利力觉传感器主要使用的元件是电阻应变片。电阻应变片利力觉传感器主要使用的元件是电阻应变片。电阻应变片利力觉传感器主要使用的元件是电阻应变片。电阻应变片利用了金属丝拉伸时电阻变大的现象，它被贴在加力的方向用了金属丝拉伸时电阻变大的现象，它被贴在加力的方向用了金属丝拉伸时电阻变大的现象，它被贴在加力的方向用了金属丝拉伸时电阻变大的现象，它被贴在加力的方向上。电阻应变片用导线接到外部电路上可测定输出电压，上。电阻应变片用导线接到外部电路上可测定输出电压，上。电阻应变片用导线接到外部电路上可测定输出电压，上。电阻应变片用导线接到外部电路上可测定输出电压，得出电阻值的变化。得出电阻值的变化。得出电阻值的变化。得出电阻值的变化。作用在一点的负载，包含力的作用在一点的负载，包含力的作用在一点的负载，包含力的作用在一点的负载，包含力的3 3 3 3个分量和力矩的个分量和力矩的个分量和力矩的个分量和力矩的3 3 3 3个分量，个分量，个分量，个分量，能够同时测出这能够同时测出这能够同时测出这能够同时测出这6 6 6 6个分量的传感器是六轴力觉传感器。机个分量的传感器是六轴力觉传感器。机个分量的传感器是六轴力觉传感器。机个分量的传感器是六轴力觉传感器。机器人的力控制主要控制机器人手爪的任意方向的负载分量器人的力控制主要控制机器人手爪的任意方向的负载分量器人的力控制主要控制机器人手爪的任意方向的负载分量器人的力控制主要控制机器人手爪的任意方向的负载分量因此需要六轴力觉传感器。六轴传感器一般安装在机器因此需要六轴力觉传感器。六轴传感器一般安装在机器因此需要六轴力觉传感器。六轴传感器一般安装在机器因此需要六轴力觉传感器。六轴传感器一般安装在机器人手腕上，因此也称为人手腕上，因此也称为人手腕上，因此也称为人手腕上，因此也称为腕力传感器腕力传感器腕力传感器腕力传感器。 77777777机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件腕力传感器分类腕力传感器分类腕力传感器分类腕力传感器分类筒式腕力传感器筒式腕力传感器筒式腕力传感器筒式腕力传感器十字形腕力传感器十字形腕力传感器十字形腕力传感器十字形腕力传感器78787878机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.4.54.4.4.5接近与距离觉传感器接近与距离觉传感器接近与距离觉传感器接近与距离觉传感器接近与距离觉传感器是机器人用以探测自身与周围物体之接近与距离觉传感器是机器人用以探测自身与周围物体之接近与距离觉传感器是机器人用以探测自身与周围物体之接近与距离觉传感器是机器人用以探测自身与周围物体之间相对位置和距离的传感器。它的使用对机器人工作过程间相对位置和距离的传感器。它的使用对机器人工作过程间相对位置和距离的传感器。它的使用对机器人工作过程间相对位置和距离的传感器。它的使用对机器人工作过程中适时地进行轨迹规划与防止事故发生具有重要意义。人中适时地进行轨迹规划与防止事故发生具有重要意义。人中适时地进行轨迹规划与防止事故发生具有重要意义。人中适时地进行轨迹规划与防止事故发生具有重要意义。人类没有专门的接近觉器官，如果仿照人的功能使机器人具类没有专门的接近觉器官，如果仿照人的功能使机器人具类没有专门的接近觉器官，如果仿照人的功能使机器人具类没有专门的接近觉器官，如果仿照人的功能使机器人具有接近觉将非常复杂，所以机器人采用了专门的接近觉传有接近觉将非常复杂，所以机器人采用了专门的接近觉传有接近觉将非常复杂，所以机器人采用了专门的接近觉传有接近觉将非常复杂，所以机器人采用了专门的接近觉传感器。感器。感器。感器。它主要起以下它主要起以下它主要起以下它主要起以下3 3个方面的作用：在接触对象物前得到必要个方面的作用：在接触对象物前得到必要个方面的作用：在接触对象物前得到必要个方面的作用：在接触对象物前得到必要的信息，为后面动作做准备；发现障碍物时，改变路径或的信息，为后面动作做准备；发现障碍物时，改变路径或的信息，为后面动作做准备；发现障碍物时，改变路径或的信息，为后面动作做准备；发现障碍物时，改变路径或停止，以免发生碰撞；得到对象物体表面形状的信息。停止，以免发生碰撞；得到对象物体表面形状的信息。停止，以免发生碰撞；得到对象物体表面形状的信息。停止，以免发生碰撞；得到对象物体表面形状的信息。79797979机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件分类分类分类分类由于这类传感器可用以感知对象位置，故也被称为由于这类传感器可用以感知对象位置，故也被称为由于这类传感器可用以感知对象位置，故也被称为由于这类传感器可用以感知对象位置，故也被称为位置觉位置觉位置觉位置觉传感器传感器传感器传感器。传感器越接近物体越能精确地确定物体位置，因。传感器越接近物体越能精确地确定物体位置，因。传感器越接近物体越能精确地确定物体位置，因。传感器越接近物体越能精确地确定物体位置，因此常安装于机器人的手部。此常安装于机器人的手部。此常安装于机器人的手部。此常安装于机器人的手部。根据感知范围根据感知范围根据感知范围根据感知范围( (或距离或距离或距离或距离) )，接近觉传感器大致可分为，接近觉传感器大致可分为，接近觉传感器大致可分为，接近觉传感器大致可分为3 3类：感类：感类：感类：感知近距离物体知近距离物体知近距离物体知近距离物体(mm(mm级级级级) )的有磁力式的有磁力式的有磁力式的有磁力式( (感应式感应式感应式感应式) )、气压式、电容、气压式、电容、气压式、电容、气压式、电容式等；感知中距离式等；感知中距离式等；感知中距离式等；感知中距离( (大致大致大致大致30cm30cm以内以内以内以内) )物体的有红外光电式：物体的有红外光电式：物体的有红外光电式：物体的有红外光电式：感知远距离感知远距离感知远距离感知远距离(30cm(30cm以外以外以外以外) )物体有超声式和激光式。视觉传感物体有超声式和激光式。视觉传感物体有超声式和激光式。视觉传感物体有超声式和激光式。视觉传感器也可作为接近觉传感器。器也可作为接近觉传感器。器也可作为接近觉传感器。器也可作为接近觉传感器。80808080机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件主要距离传感器主要距离传感器主要距离传感器主要距离传感器磁力式接近传感器磁力式接近传感器磁力式接近传感器磁力式接近传感器：这种传感器不大受光、热、物体表面：这种传感器不大受光、热、物体表面：这种传感器不大受光、热、物体表面：这种传感器不大受光、热、物体表面特征影响，可小型化与轻量化。但只能探测金属对象。特征影响，可小型化与轻量化。但只能探测金属对象。特征影响，可小型化与轻量化。但只能探测金属对象。特征影响，可小型化与轻量化。但只能探测金属对象。日本日立公司将其用于孤焊机器人上，用以跟踪焊缝。在日本日立公司将其用于孤焊机器人上，用以跟踪焊缝。在日本日立公司将其用于孤焊机器人上，用以跟踪焊缝。在日本日立公司将其用于孤焊机器人上，用以跟踪焊缝。在200200以下探测距离以下探测距离以下探测距离以下探测距离0 08mm8mm，误差只有，误差只有，误差只有，误差只有4 4。气压式接近传感器气压式接近传感器气压式接近传感器气压式接近传感器：这种传感器具有较强防火、防磁、这种传感器具有较强防火、防磁、这种传感器具有较强防火、防磁、这种传感器具有较强防火、防磁、防辐射能力，但要求气源保持一定程度的净化。防辐射能力，但要求气源保持一定程度的净化。防辐射能力，但要求气源保持一定程度的净化。防辐射能力，但要求气源保持一定程度的净化。红外式接近传感器红外式接近传感器红外式接近传感器红外式接近传感器： 其特点在于发送器与接受器尺寸都其特点在于发送器与接受器尺寸都其特点在于发送器与接受器尺寸都其特点在于发送器与接受器尺寸都很小，因此可以方便地安装于机器人手部。红外线传感器很小，因此可以方便地安装于机器人手部。红外线传感器很小，因此可以方便地安装于机器人手部。红外线传感器很小，因此可以方便地安装于机器人手部。红外线传感器能根容易地检测出工作空间内某物体的存在与否，但作为能根容易地检测出工作空间内某物体的存在与否，但作为能根容易地检测出工作空间内某物体的存在与否，但作为能根容易地检测出工作空间内某物体的存在与否，但作为距离的测量仍有很复杂的问题。距离的测量仍有很复杂的问题。距离的测量仍有很复杂的问题。距离的测量仍有很复杂的问题。81818181机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件82828282机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件超声波距离传感器超声波距离传感器超声波距离传感器超声波距离传感器：超声式接近传感器是用于机器人对周：超声式接近传感器是用于机器人对周：超声式接近传感器是用于机器人对周：超声式接近传感器是用于机器人对周围物体的存在与距离的探测。尤其对移动式机器人，安装围物体的存在与距离的探测。尤其对移动式机器人，安装围物体的存在与距离的探测。尤其对移动式机器人，安装围物体的存在与距离的探测。尤其对移动式机器人，安装这种传感器可随时探测前进道路上是否出现障碍物，以免这种传感器可随时探测前进道路上是否出现障碍物，以免这种传感器可随时探测前进道路上是否出现障碍物，以免这种传感器可随时探测前进道路上是否出现障碍物，以免发生碰撞。发生碰撞。发生碰撞。发生碰撞。超声波发生器有压电式、电磁式及磁滞伸缩式等。在检测超声波发生器有压电式、电磁式及磁滞伸缩式等。在检测超声波发生器有压电式、电磁式及磁滞伸缩式等。在检测超声波发生器有压电式、电磁式及磁滞伸缩式等。在检测技术中最常用的是压电式。技术中最常用的是压电式。技术中最常用的是压电式。技术中最常用的是压电式。83838383机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件84848484机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.4.64.4.4.6视觉传感器视觉传感器视觉传感器视觉传感器机器人视觉系统机器人视觉系统机器人视觉系统机器人视觉系统：如同人类视觉系统的作用一样，机器人：如同人类视觉系统的作用一样，机器人：如同人类视觉系统的作用一样，机器人：如同人类视觉系统的作用一样，机器人视觉系统赋予机器人一种高级感觉机构，使得机器人能以视觉系统赋予机器人一种高级感觉机构，使得机器人能以视觉系统赋予机器人一种高级感觉机构，使得机器人能以视觉系统赋予机器人一种高级感觉机构，使得机器人能以“智能智能智能智能”和灵活的方式对其周围环境作出反应。机器人的和灵活的方式对其周围环境作出反应。机器人的和灵活的方式对其周围环境作出反应。机器人的和灵活的方式对其周围环境作出反应。机器人的视觉信息系统类似人的视觉信息系统，它包括图像传感器、视觉信息系统类似人的视觉信息系统，它包括图像传感器、视觉信息系统类似人的视觉信息系统，它包括图像传感器、视觉信息系统类似人的视觉信息系统，它包括图像传感器、数据传递系统，以及计算机和处理系统。数据传递系统，以及计算机和处理系统。数据传递系统，以及计算机和处理系统。数据传递系统，以及计算机和处理系统。机器人视觉机器人视觉机器人视觉机器人视觉：利用视觉传感器：利用视觉传感器：利用视觉传感器：利用视觉传感器( ( ( (如摄像机如摄像机如摄像机如摄像机) ) ) )获取三维景物的获取三维景物的获取三维景物的获取三维景物的二维图像，通过视觉处理器对一幅或多幅图像进行处理、二维图像，通过视觉处理器对一幅或多幅图像进行处理、二维图像，通过视觉处理器对一幅或多幅图像进行处理、二维图像，通过视觉处理器对一幅或多幅图像进行处理、分析和解释，得到有关景物的符号描述，并为特定任务提分析和解释，得到有关景物的符号描述，并为特定任务提分析和解释，得到有关景物的符号描述，并为特定任务提分析和解释，得到有关景物的符号描述，并为特定任务提供有用的信息，用于指导机器人的动作。机器人视觉可以供有用的信息，用于指导机器人的动作。机器人视觉可以供有用的信息，用于指导机器人的动作。机器人视觉可以供有用的信息，用于指导机器人的动作。机器人视觉可以划分为六个主要部分：感觉与处理、分割、描述、识别、划分为六个主要部分：感觉与处理、分割、描述、识别、划分为六个主要部分：感觉与处理、分割、描述、识别、划分为六个主要部分：感觉与处理、分割、描述、识别、解释。根据上述过程所涉及的方法和技术的复杂性可分为解释。根据上述过程所涉及的方法和技术的复杂性可分为解释。根据上述过程所涉及的方法和技术的复杂性可分为解释。根据上述过程所涉及的方法和技术的复杂性可分为3 3 3 3个处理层次：低层视觉处理、中层视觉处理和高层视觉个处理层次：低层视觉处理、中层视觉处理和高层视觉个处理层次：低层视觉处理、中层视觉处理和高层视觉个处理层次：低层视觉处理、中层视觉处理和高层视觉处理。处理。处理。处理。85858585机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件(1)(1)机器人视觉系统的发展机器人视觉系统的发展机器人视觉系统的发展机器人视觉系统的发展第一代系统根据物体的剪影工作，可由其剪影形状推断诸第一代系统根据物体的剪影工作，可由其剪影形状推断诸第一代系统根据物体的剪影工作，可由其剪影形状推断诸第一代系统根据物体的剪影工作，可由其剪影形状推断诸如物体的位置，方位和尺寸等参数。此种系统以二值即两如物体的位置，方位和尺寸等参数。此种系统以二值即两如物体的位置，方位和尺寸等参数。此种系统以二值即两如物体的位置，方位和尺寸等参数。此种系统以二值即两个灰度级图象处理为其特征，而图象系出逆光景象生成。个灰度级图象处理为其特征，而图象系出逆光景象生成。个灰度级图象处理为其特征，而图象系出逆光景象生成。个灰度级图象处理为其特征，而图象系出逆光景象生成。第二代机器人视觉系统采用若干灰度等级以表征物体。这第二代机器人视觉系统采用若干灰度等级以表征物体。这第二代机器人视觉系统采用若干灰度等级以表征物体。这第二代机器人视觉系统采用若干灰度等级以表征物体。这种系统可根据面光景象工作，并可区分纹理模式。第三代种系统可根据面光景象工作，并可区分纹理模式。第三代种系统可根据面光景象工作，并可区分纹理模式。第三代种系统可根据面光景象工作，并可区分纹理模式。第三代系统不仅检测灰度，而且采用立体技术以确定景象中可见系统不仅检测灰度，而且采用立体技术以确定景象中可见系统不仅检测灰度，而且采用立体技术以确定景象中可见系统不仅检测灰度，而且采用立体技术以确定景象中可见物体的三维坐标。更高级的系统甚至可推断出不可见表面，物体的三维坐标。更高级的系统甚至可推断出不可见表面，物体的三维坐标。更高级的系统甚至可推断出不可见表面，物体的三维坐标。更高级的系统甚至可推断出不可见表面，例如一个物体背面的某些信息。现在正处于机器人视觉系例如一个物体背面的某些信息。现在正处于机器人视觉系例如一个物体背面的某些信息。现在正处于机器人视觉系例如一个物体背面的某些信息。现在正处于机器人视觉系统的第三代。统的第三代。统的第三代。统的第三代。86868686机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人视觉系统的重要特点是数据量大且要求处理速度快。机器人视觉系统的重要特点是数据量大且要求处理速度快。机器人视觉系统的重要特点是数据量大且要求处理速度快。机器人视觉系统的重要特点是数据量大且要求处理速度快。实用的机器人视觉系统由硬件和软件两部分组成。实用的机器人视觉系统由硬件和软件两部分组成。实用的机器人视觉系统由硬件和软件两部分组成。实用的机器人视觉系统由硬件和软件两部分组成。 硬件部分包括：景物和距离传感器、照明和光学系硬件部分包括：景物和距离传感器、照明和光学系硬件部分包括：景物和距离传感器、照明和光学系硬件部分包括：景物和距离传感器、照明和光学系统、视频信号数字化设备、视频信号快速处理器、计算机统、视频信号数字化设备、视频信号快速处理器、计算机统、视频信号数字化设备、视频信号快速处理器、计算机统、视频信号数字化设备、视频信号快速处理器、计算机及其外设、机器人或机械手及其控制器；及其外设、机器人或机械手及其控制器；及其外设、机器人或机械手及其控制器；及其外设、机器人或机械手及其控制器； 软件部分包括：计算机系统软件、机器人视觉处理软件部分包括：计算机系统软件、机器人视觉处理软件部分包括：计算机系统软件、机器人视觉处理软件部分包括：计算机系统软件、机器人视觉处理算法、机器人控制软件。算法、机器人控制软件。算法、机器人控制软件。算法、机器人控制软件。87878787机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件从机器人应用角度，视觉技术有两大类：从机器人应用角度，视觉技术有两大类：从机器人应用角度，视觉技术有两大类：从机器人应用角度，视觉技术有两大类：第一类是机器人控制的机器视觉。即通过传感器来控制机第一类是机器人控制的机器视觉。即通过传感器来控制机第一类是机器人控制的机器视觉。即通过传感器来控制机第一类是机器人控制的机器视觉。即通过传感器来控制机器人的操作和运动，这种应用的特殊要求是满足机器人控器人的操作和运动，这种应用的特殊要求是满足机器人控器人的操作和运动，这种应用的特殊要求是满足机器人控器人的操作和运动，这种应用的特殊要求是满足机器人控制的高速计算，因而采用的技术必须很简单。制的高速计算，因而采用的技术必须很简单。制的高速计算，因而采用的技术必须很简单。制的高速计算，因而采用的技术必须很简单。另一种机器人视觉应用是与质量控制的检验过程有关的，另一种机器人视觉应用是与质量控制的检验过程有关的，另一种机器人视觉应用是与质量控制的检验过程有关的，另一种机器人视觉应用是与质量控制的检验过程有关的，虽然也有高速计算的要求，但速度可能取决于传送装置，虽然也有高速计算的要求，但速度可能取决于传送装置，虽然也有高速计算的要求，但速度可能取决于传送装置，虽然也有高速计算的要求，但速度可能取决于传送装置，而不是机器人。工作状态大部分是立体型的，故可能需要而不是机器人。工作状态大部分是立体型的，故可能需要而不是机器人。工作状态大部分是立体型的，故可能需要而不是机器人。工作状态大部分是立体型的，故可能需要采用更尖端的技术。采用更尖端的技术。采用更尖端的技术。采用更尖端的技术。88888888机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件(2)(2)机器人视觉应用的几个关键要素机器人视觉应用的几个关键要素机器人视觉应用的几个关键要素机器人视觉应用的几个关键要素照明系统照明系统照明系统照明系统摄象机定位、焦距、变焦和光圈控制摄象机定位、焦距、变焦和光圈控制摄象机定位、焦距、变焦和光圈控制摄象机定位、焦距、变焦和光圈控制图像的数字化图像的数字化图像的数字化图像的数字化图像处理速度图像处理速度图像处理速度图像处理速度89898989机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件(3)(3)机器人视觉系统的应用机器人视觉系统的应用机器人视觉系统的应用机器人视觉系统的应用机器人的视觉技术主要应用在下述两个方面：机器人的视觉技术主要应用在下述两个方面：机器人的视觉技术主要应用在下述两个方面：机器人的视觉技术主要应用在下述两个方面：(1)(1)装配机器人装配机器人装配机器人装配机器人( (机械手机械手机械手机械手) )视觉装置。要求视觉系统必须做到：视觉装置。要求视觉系统必须做到：视觉装置。要求视觉系统必须做到：视觉装置。要求视觉系统必须做到：识别传送带上所要装配的机械零件；确定该零件的空间位识别传送带上所要装配的机械零件；确定该零件的空间位识别传送带上所要装配的机械零件；确定该零件的空间位识别传送带上所要装配的机械零件；确定该零件的空间位置。据此信息控制机械手的动作，做到准确装配。对机械置。据此信息控制机械手的动作，做到准确装配。对机械置。据此信息控制机械手的动作，做到准确装配。对机械置。据此信息控制机械手的动作，做到准确装配。对机械零件的检查；检查工件的完好性；量测工件的极限尺寸；零件的检查；检查工件的完好性；量测工件的极限尺寸；零件的检查；检查工件的完好性；量测工件的极限尺寸；零件的检查；检查工件的完好性；量测工件的极限尺寸；检查工件的磨损等。此外，机械手还可根据视觉的反馈信检查工件的磨损等。此外，机械手还可根据视觉的反馈信检查工件的磨损等。此外，机械手还可根据视觉的反馈信检查工件的磨损等。此外，机械手还可根据视觉的反馈信息进行自功焊接、喷漆和自动上下料等，息进行自功焊接、喷漆和自动上下料等，息进行自功焊接、喷漆和自动上下料等，息进行自功焊接、喷漆和自动上下料等，(2)(2)行走机器人视觉装置。要求视觉系统能够识别室内或室行走机器人视觉装置。要求视觉系统能够识别室内或室行走机器人视觉装置。要求视觉系统能够识别室内或室行走机器人视觉装置。要求视觉系统能够识别室内或室外的景物，进行道路跟踪和自主导航。用以完成危险材料外的景物，进行道路跟踪和自主导航。用以完成危险材料外的景物，进行道路跟踪和自主导航。用以完成危险材料外的景物，进行道路跟踪和自主导航。用以完成危险材料的搬运和野外作业等任务的搬运和野外作业等任务的搬运和野外作业等任务的搬运和野外作业等任务；90909090机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.54.4.5运动机器人的传感器运动机器人的传感器运动机器人的传感器运动机器人的传感器自主自导的运动机器人需要一些固定式机器人所不需要的自主自导的运动机器人需要一些固定式机器人所不需要的自主自导的运动机器人需要一些固定式机器人所不需要的自主自导的运动机器人需要一些固定式机器人所不需要的特殊传感器。从安全方面考虑非常必要为运动机器人配备特殊传感器。从安全方面考虑非常必要为运动机器人配备特殊传感器。从安全方面考虑非常必要为运动机器人配备特殊传感器。从安全方面考虑非常必要为运动机器人配备若干传感装置，例如使机器人避免碰撞或利用传感器反馈若干传感装置，例如使机器人避免碰撞或利用传感器反馈若干传感装置，例如使机器人避免碰撞或利用传感器反馈若干传感装置，例如使机器人避免碰撞或利用传感器反馈信息进行导引、定位以及寻找目标等。这些包括接触式触信息进行导引、定位以及寻找目标等。这些包括接触式触信息进行导引、定位以及寻找目标等。这些包括接触式触信息进行导引、定位以及寻找目标等。这些包括接触式触觉传感器、接近传感器、局部及整体位置传感器和水平传觉传感器、接近传感器、局部及整体位置传感器和水平传觉传感器、接近传感器、局部及整体位置传感器和水平传觉传感器、接近传感器、局部及整体位置传感器和水平传感器。感器。感器。感器。运动机器人需要一些特殊传感器。进而由于传感器可能用运动机器人需要一些特殊传感器。进而由于传感器可能用运动机器人需要一些特殊传感器。进而由于传感器可能用运动机器人需要一些特殊传感器。进而由于传感器可能用于控制速度范围为于控制速度范围为于控制速度范围为于控制速度范围为l l l l20202020英尺英尺英尺英尺/ / / /秒的机器人，因此高速算法秒的机器人，因此高速算法秒的机器人，因此高速算法秒的机器人，因此高速算法也是需要的。接触开关、接近探测器、导引信号装置、光也是需要的。接触开关、接近探测器、导引信号装置、光也是需要的。接触开关、接近探测器、导引信号装置、光也是需要的。接触开关、接近探测器、导引信号装置、光和声探测器、水平指示器以及局部和整体定位装置可能都和声探测器、水平指示器以及局部和整体定位装置可能都和声探测器、水平指示器以及局部和整体定位装置可能都和声探测器、水平指示器以及局部和整体定位装置可能都是需要的。是需要的。是需要的。是需要的。91919191机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件运动机器人所需要的最重要也是最困难的传感器系统之一运动机器人所需要的最重要也是最困难的传感器系统之一运动机器人所需要的最重要也是最困难的传感器系统之一运动机器人所需要的最重要也是最困难的传感器系统之一就是定位装置。局部和整体位置信息都可能需要。这种信就是定位装置。局部和整体位置信息都可能需要。这种信就是定位装置。局部和整体位置信息都可能需要。这种信就是定位装置。局部和整体位置信息都可能需要。这种信息的准确度对确定机器人控制对策也是很重要的，因为机息的准确度对确定机器人控制对策也是很重要的，因为机息的准确度对确定机器人控制对策也是很重要的，因为机息的准确度对确定机器人控制对策也是很重要的，因为机械手作业的成功和淮确与机器人定位的成功和准确直接有械手作业的成功和淮确与机器人定位的成功和准确直接有械手作业的成功和淮确与机器人定位的成功和准确直接有械手作业的成功和淮确与机器人定位的成功和准确直接有关。在车轮上安装轴角编码对短距离可提供准确信息，而关。在车轮上安装轴角编码对短距离可提供准确信息，而关。在车轮上安装轴角编码对短距离可提供准确信息，而关。在车轮上安装轴角编码对短距离可提供准确信息，而由于轮子打滑以及其它因素，对长距离可能造成大的累积由于轮子打滑以及其它因素，对长距离可能造成大的累积由于轮子打滑以及其它因素，对长距离可能造成大的累积由于轮子打滑以及其它因素，对长距离可能造成大的累积误差。所以，一些可修正确定位置的整体方法也是需要的。误差。所以，一些可修正确定位置的整体方法也是需要的。误差。所以，一些可修正确定位置的整体方法也是需要的。误差。所以，一些可修正确定位置的整体方法也是需要的。92929292机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件4.4.64.4.6传感器与集成控制传感器与集成控制传感器与集成控制传感器与集成控制因为一台智能机器人可能采用很多种传感器，所以把传感因为一台智能机器人可能采用很多种传感器，所以把传感因为一台智能机器人可能采用很多种传感器，所以把传感因为一台智能机器人可能采用很多种传感器，所以把传感的信息和存储的信息集成起来，形成控制规则也是重要的的信息和存储的信息集成起来，形成控制规则也是重要的的信息和存储的信息集成起来，形成控制规则也是重要的的信息和存储的信息集成起来，形成控制规则也是重要的问题。在某些情况下，一台计算机就完全能够控制机器人。问题。在某些情况下，一台计算机就完全能够控制机器人。问题。在某些情况下，一台计算机就完全能够控制机器人。问题。在某些情况下，一台计算机就完全能够控制机器人。在某些复杂系统中，运动机器人或柔性制造系统可能要采在某些复杂系统中，运动机器人或柔性制造系统可能要采在某些复杂系统中，运动机器人或柔性制造系统可能要采在某些复杂系统中，运动机器人或柔性制造系统可能要采用分层的、分散的计算机。一台执行控制器可用以完成总用分层的、分散的计算机。一台执行控制器可用以完成总用分层的、分散的计算机。一台执行控制器可用以完成总用分层的、分散的计算机。一台执行控制器可用以完成总体规划。它把信息传递给一系列专用的处理器，以控制机体规划。它把信息传递给一系列专用的处理器，以控制机体规划。它把信息传递给一系列专用的处理器，以控制机体规划。它把信息传递给一系列专用的处理器，以控制机器人各中功能，并从传感器系统接受输入信号。不同的层器人各中功能，并从传感器系统接受输入信号。不同的层器人各中功能，并从传感器系统接受输入信号。不同的层器人各中功能，并从传感器系统接受输入信号。不同的层次可用来完成不同的任务。次可用来完成不同的任务。次可用来完成不同的任务。次可用来完成不同的任务。93939393机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件分散的传感器和控制系统在许多方面很像人类的中枢神经分散的传感器和控制系统在许多方面很像人类的中枢神经分散的传感器和控制系统在许多方面很像人类的中枢神经分散的传感器和控制系统在许多方面很像人类的中枢神经系统。很多动作可由脊椎神经网络控制，而无需大脑的意系统。很多动作可由脊椎神经网络控制，而无需大脑的意系统。很多动作可由脊椎神经网络控制，而无需大脑的意系统。很多动作可由脊椎神经网络控制，而无需大脑的意识控制。这种局部反应和自主功能对人类的生存是必要的，识控制。这种局部反应和自主功能对人类的生存是必要的，识控制。这种局部反应和自主功能对人类的生存是必要的，识控制。这种局部反应和自主功能对人类的生存是必要的，如何设法在机器人上仿真实现这类功能也是非常重要的。如何设法在机器人上仿真实现这类功能也是非常重要的。如何设法在机器人上仿真实现这类功能也是非常重要的。如何设法在机器人上仿真实现这类功能也是非常重要的。对机器人这类机构的研究将使我们进一步理解如何才能让对机器人这类机构的研究将使我们进一步理解如何才能让对机器人这类机构的研究将使我们进一步理解如何才能让对机器人这类机构的研究将使我们进一步理解如何才能让机器工人作得更像人类一样。机器工人作得更像人类一样。机器工人作得更像人类一样。机器工人作得更像人类一样。94949494机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件机器人的轨迹规划生成与控制技术课件