第七章_工业机器人的轨迹规划
合集下载
相关主题
- 1、下载文档前请自行甄别文档内容的完整性，平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益，请联系客服反馈,我们会尽快为您处理(人工客服工作时间：9:00-18:30)。
6
上述例子可以看出，机器人的规划是分层次的， 上述例子可以看出，机器人的规划是分层次的， 从高层的任务规划 动作规划到 部轨迹规划和 任务规划， 从高层的任务规划，动作规划到手部轨迹规划和关节 轨迹规划，最后才是底层的控制(见图)。在上述例子 轨迹规划，最后才是底层的控制(见图) 底层的控制 我们没有讨论力的问题，实际上， 中，我们没有讨论力的问题，实际上，对有些机器人 来说，力的大小也是要控制的，这时， 来说，力的大小也是要控制的，这时，除了手部或关 节的轨迹规划，还要进行手部和关节输出力的规划 力的规划。 节的轨迹规划，还要进行手部和关节输出力的规划。 智能化程度越高，规划的层次越多， 智能化程度越高，规划的层次越多，操作就越简 单。 对工业机器人来说， 对工业机器人来说，高层的任务规划和动作规划 一般是依赖人来完成的。 一般是依赖人来完成的。而且一般的工业机器人也不 具备力的反馈，所以， 具备力的反馈，所以，工业机器人通常只具有轨迹规 划的和底层的控制功能。 划的和底层的控制功能。
在一些老龄化比较严重的国家， 在一些老龄化比较严重的国家，开发了各种各 样的机器人专门用于伺候老人， 样的机器人专门用于伺候老人，这些机器人有不少是 采用声控的方式．比如主人用声音命令机器人“给我 采用声控的方式．比如主人用声音命令机器人“ 倒一杯开水” 倒一杯开水”，我们先不考虑机器人是如何识别人的 自然语言， 自然语言，而是着重分析一下机器人在得到这样一个 命今后，如何来完成主人交给的任务。 命今后，如何来完成主人交给的任务。
解： 根据所给约束条件，直接代入式(7 4)，可得： (7根据所给约束条件，直接代入式(7-4)，可得： a0=15， a1=0， a2=20， a3=-4.44 ， ， ， 所求关节角的位置函数为： 所求关节角的位置函数为： （7-5） ） θ ( t ) = 15 + 20t 2 − 4.44t 3
15
显然，这些光滑函数必须满足以下条件： 显然，
q ( 0 ) = q0
q (t f ) = q f
（7-1） ）
同时若要求在起点和终点的速度为零， 同时若要求在起点和终点的速度为零，即：
& q (0) = 0
& q (t f ) = 0
（7-2） ）
那么可以选择如下的三次多项式： 那么可以选择如下的三次多项式：
q ( t ) = a0 + a1t + a2t 2 + a3t 3
（7-3） ）
作为所要求的光滑函数。 中有4个待定系数 作为所要求的光滑函数。式7-3中有 个待定系数，而 中有 个待定系数， 该式需满足式7-1和 的 个约束条件 个约束条件， 该式需满足式 和7-2的4个约束条件，因此可以唯一地解 出这些系数： 出这些系数：
13
轨迹规划问题又可以分为关节空间的轨迹规划和 轨迹规划问题又可以分为关节空间的轨迹规划和 关节空间的轨Байду номын сангаас规划 直角空间的轨迹规划。 直角空间的轨迹规划。
7.2
关节空间法
关节空间法首先将在工具空间中期望的路径点， 关节空间法首先将在工具空间中期望的路径点， 通过逆运动学计算，得到期望的关节位置 关节位置， 通过逆运动学计算，得到期望的关节位置，然后在关 节空间内，给每个关节找到一个经过中间点到达目的 节空间内， 终点的光滑函数 光滑函数， 终点的光滑函数，同时使得每个关节到达中间点和终 点的时间相同 时间相同， 点的时间相同，这样便可保证机械手工具能够到达期 望的直角坐标位置。 望的直角坐标位置。这里只要求各个关节在路径点之 间的时间相同 时间相同， 间的时间相同，而各个关节的光滑函数的确定则是互 相独立的。 相独立的。
12
对于CP控制: 对于CP控制: CP控制
机械手末端的运动轨迹是根据任务的需要给定 但是它也必须按照一定的采样间隔， 的，但是它也必须按照一定的采样间隔，通过逆运 动学计算，将其变换到关节空间， 动学计算，将其变换到关节空间，然后在关节空间 中寻找光滑函数来拟合这些离散点．最后， 中寻找光滑函数来拟合这些离散点．最后，还有在 机器人的计算机内部如何表示轨迹， 机器人的计算机内部如何表示轨迹，以及如何实时 地生成轨迹的问题。 地生成轨迹的问题。
利用三次多项式规划出的关节角的运动轨迹
19
2）抛物线连接的线性函数插值 前面介绍了利用三次多项式函数插值的规划方 另外一种常用方法是线性函数插值法， 法。另外一种常用方法是线性函数插值法，即用一 条直线将起点与终点连接起来。但是， 条直线将起点与终点连接起来。但是，简单的线性 函数插值将使得关节的运动速度在起点和终点处不 连续，它也意味着需要产生无穷大的加速度， 连续，它也意味着需要产生无穷大的加速度，这显 然是不希望的。因此可以考虑在起点和终点处， 然是不希望的。因此可以考虑在起点和终点处，用 抛物线与直线连接起来，在抛物线段内， 抛物线与直线连接起来，在抛物线段内，使用恒定 的加速度来平滑地改变速度， 的加速度来平滑地改变速度，从而使得整个运动轨 迹的位置和速度是连续的。 迹的位置和速度是连续的。
5
首先，机器人应该把任务进行分解，把主人交代的任务 分解成为“取一个杯子”、“找到水壶”、“打开瓶塞”、 “把水倒人杯中”、“把水送给主人”等一系列子任务。这 一层次的规划称为任务规划 任务规划(Task planning)，它完成总体任务 任务规划 的分解。 然后再针对每一个子任务进行进一步的规划。以“把水 倒入杯中”这一子任务为例，可以进一步分解成为“把水壶 提到杯口上方”、“把水壶倾斜倒水入杯”、“把水壶竖直 “、“把水壶放回原处”等一系列动作，这一层次的规划称 为动作规划 动作规划(Motion P1anning)，它把实现每一个子任务的过 动作规划 程分解为一系列具体的动作。 为了实现每一个动作，需要对手部的运动轨迹进行必要 轨迹规划(Hand trajectory planning )。 的规定，这是手部轨迹规划 轨迹规划 为了使手部实现预定的运动，就要知道各关节的运动规 律，这是关节轨迹规划 关节轨迹规划(Joint trajectory planning)。 关节轨迹规划 最后才是关节的运动控制 运动控制(Motion control)。 运动控制
第七章 工业机器人的轨迹规划
1
工业机器人系统组成
2
主要内容
7.1 机器人规划的基本概念 7.2 关节空间法 7.3 直角坐标空间法 7.4 轨迹的实时生成 7.5 路径的描述
3
7.1
机器人规划的基本概念
所谓机器人的规划(P1anning)，指的是 所谓机器人的规划(P1anning)，指的是— (P1anning) —机器人根据自身的任务，求得完成这一任务 机器人根据自身的任务，
20
线性函数插值图
14
下面具体介绍在关节空间内常用的两种规划方法 1） 三次多项式函数插值
考虑机械手末端在一定时间内从初始位置和方位移动 到目标位置和方位的问题。利用逆运动学计算， 到目标位置和方位的问题。利用逆运动学计算，可以首先 求出一组起始和终了的关节位置． 求出一组起始和终了的关节位置．现在的问题是求出一组 通过起点和终点的光滑函数 光滑函数。 通过起点和终点的光滑函数。满足这个条件的光滑函数可 以有许多条，如下图所示： 以有许多条，如下图所示：
7
给主人倒一杯水
取一个杯子
找到水壶
打开水壶
把水倒入杯中
把水送给主人
提起水壶到杯口上方
把水壶倾斜
把水壶竖直
把水壶放回原处
手部从A点移到 手部从 点移到B 点 点移到
关节从A点移到 点 关节从 点移到B点 点移到
图 智能机器人的规划层次
8
轨迹规划的目的是——将操作人员输入的 将操作人员输入的 轨迹规划的目的是 简单的任务描述变为详细的运动轨迹描述 任务描述变为详细的运动轨迹描述。 简单的任务描述变为详细的运动轨迹描述。
的解决方案的过程。这里所说的任务，具有广 这里所说的任务，
义的概念， 义的概念，既可以指机器人要完成的某一具体 任务，也可以是机器人的某个动作， 任务，也可以是机器人的某个动作，比如手部 或关节的某个规定的运动等。 或关节的某个规定的运动等。
4
为说明机器人规划的概念， 为说明机器人规划的概念，我们举下面的 例子： 例子：
16
a0 = q0 a1 = 0 3 a2 = 2 ( q f − q0 ) tf 2 a3 = − 3 ( q f − q0 ) tf
17
（7-4） ）
例： 设机械手的某个关节的起始关节角θ 设机械手的某个关节的起始关节角θ0＝150，并且机械手 原来是静止的。要求在3秒钟内平滑地运动到θ 时停下来( 原来是静止的。要求在3秒钟内平滑地运动到θf=750时停下来( 即要求在终端时速度为零) 即要求在终端时速度为零)。规划出满足上述条件的平滑运动 的轨迹，并画出关节角位置、 的轨迹，并画出关节角位置、角速度及角加速度随时间变化的 曲线。 曲线。
例如，对一般的工业机器人来说， 例如，对一般的工业机器人来说，操作员可能只 输入机械手末端的目标位置和方位， 输入机械手末端的目标位置和方位，而规划的任务便 是要确定出达到目标的关节轨迹的形状、 是要确定出达到目标的关节轨迹的形状、运动的时间 和速度等。这里所说的轨迹是指随时间变化的位置、 和速度等。这里所说的轨迹是指随时间变化的位置、 速度和加速度。 速度和加速度。
对上式求导， 对上式求导，可以得到角速度和角加速度
θ& ( t ) = 40t − 13.33t 2
&& θ ( t ) = 40 − 26.66t
（7-6） ） （7-7） ）
18
根据式(7-5)～(7-7)可画出它们随时间的变 根据式(7-5)～(7-7)可画出它们随时间的变 (7 化曲线如下图所示。由图看出， 化曲线如下图所示。由图看出，速度曲线为一抛 物线，加速度则为一直线。 物线，加速度则为一直线。
11
对于PTP控制: 对于PTP控制: PTP控制
通常只给出机械手末端的起点和终点，有时也 通常只给出机械手末端的起点和终点， 给出一些中间经过点，所有这些点统称为路径点。 给出一些中间经过点，所有这些点统称为路径点。 应注意这里所说的“ 应注意这里所说的“点” 不仅包括机械手末端的 位置，而且包括方位，因此描述一个点通常需要6 位置，而且包括方位，因此描述一个点通常需要6 个量。通常希望机械手末端的运动是光滑的， 个量。通常希望机械手末端的运动是光滑的，即它 具有连续的一阶导数， 具有连续的一阶导数，有时甚至要求具有连续的二 阶导数。 阶导数。不平滑的运动容易造成机构的磨损和破坏 甚至可能激发机械手的振动。 ，甚至可能激发机械手的振动。因此规划的任务便 是要根据给定的路径点规划出通过这些点的光滑的 运动轨迹。 运动轨迹。
9
简言之，机器人的工作过程，就是通过规划， 简言之，机器人的工作过程，就是通过规划，将要求的任 务变为期望的运动和力， 务变为期望的运动和力，由控制环节根据期望的运动和力的信 产生相应的控制作用，以使机器人输出实际的运动和力， 号，产生相应的控制作用，以使机器人输出实际的运动和力， 从而完成期望的任务。这一过程表述如下图所示。这里， 从而完成期望的任务。这一过程表述如下图所示。这里，机器 人实际运动的情况通常还要反馈给规划级和控制级， 人实际运动的情况通常还要反馈给规划级和控制级，以便对规 划和控制的结果做出适当的修正。 划和控制的结果做出适当的修正。
要求的任务
人 机 接 口
规
期望的 运动和力
控
控制作用
划
制
机 器 人 本 体
实际的 运动和力
图 机器人的工作原理示意图
10
上图中，要求的任务由操作人员输入给机器人， 上图中，要求的任务由操作人员输入给机器人， 为了使机器人操作方便、使用简单， 为了使机器人操作方便、使用简单，必须允许操作人 员给出尽量简单的描述。 员给出尽量简单的描述。 上图中， 上图中，期望的运动和力是进行机器人控制所必 需的输入量， 需的输入量，它们是机械手末端在每一个时刻的位姿 和速度，对于绝大多数情况， 和速度，对于绝大多数情况，还要求给出每一时刻期 望的关节位移和速度， 望的关节位移和速度，有些控制方法还要求给出期望 的加速度等。 的加速度等。
上述例子可以看出，机器人的规划是分层次的， 上述例子可以看出，机器人的规划是分层次的， 从高层的任务规划 动作规划到 部轨迹规划和 任务规划， 从高层的任务规划，动作规划到手部轨迹规划和关节 轨迹规划，最后才是底层的控制(见图)。在上述例子 轨迹规划，最后才是底层的控制(见图) 底层的控制 我们没有讨论力的问题，实际上， 中，我们没有讨论力的问题，实际上，对有些机器人 来说，力的大小也是要控制的，这时， 来说，力的大小也是要控制的，这时，除了手部或关 节的轨迹规划，还要进行手部和关节输出力的规划 力的规划。 节的轨迹规划，还要进行手部和关节输出力的规划。 智能化程度越高，规划的层次越多， 智能化程度越高，规划的层次越多，操作就越简 单。 对工业机器人来说， 对工业机器人来说，高层的任务规划和动作规划 一般是依赖人来完成的。 一般是依赖人来完成的。而且一般的工业机器人也不 具备力的反馈，所以， 具备力的反馈，所以，工业机器人通常只具有轨迹规 划的和底层的控制功能。 划的和底层的控制功能。
在一些老龄化比较严重的国家， 在一些老龄化比较严重的国家，开发了各种各 样的机器人专门用于伺候老人， 样的机器人专门用于伺候老人，这些机器人有不少是 采用声控的方式．比如主人用声音命令机器人“给我 采用声控的方式．比如主人用声音命令机器人“ 倒一杯开水” 倒一杯开水”，我们先不考虑机器人是如何识别人的 自然语言， 自然语言，而是着重分析一下机器人在得到这样一个 命今后，如何来完成主人交给的任务。 命今后，如何来完成主人交给的任务。
解： 根据所给约束条件，直接代入式(7 4)，可得： (7根据所给约束条件，直接代入式(7-4)，可得： a0=15， a1=0， a2=20， a3=-4.44 ， ， ， 所求关节角的位置函数为： 所求关节角的位置函数为： （7-5） ） θ ( t ) = 15 + 20t 2 − 4.44t 3
15
显然，这些光滑函数必须满足以下条件： 显然，
q ( 0 ) = q0
q (t f ) = q f
（7-1） ）
同时若要求在起点和终点的速度为零， 同时若要求在起点和终点的速度为零，即：
& q (0) = 0
& q (t f ) = 0
（7-2） ）
那么可以选择如下的三次多项式： 那么可以选择如下的三次多项式：
q ( t ) = a0 + a1t + a2t 2 + a3t 3
（7-3） ）
作为所要求的光滑函数。 中有4个待定系数 作为所要求的光滑函数。式7-3中有 个待定系数，而 中有 个待定系数， 该式需满足式7-1和 的 个约束条件 个约束条件， 该式需满足式 和7-2的4个约束条件，因此可以唯一地解 出这些系数： 出这些系数：
13
轨迹规划问题又可以分为关节空间的轨迹规划和 轨迹规划问题又可以分为关节空间的轨迹规划和 关节空间的轨Байду номын сангаас规划 直角空间的轨迹规划。 直角空间的轨迹规划。
7.2
关节空间法
关节空间法首先将在工具空间中期望的路径点， 关节空间法首先将在工具空间中期望的路径点， 通过逆运动学计算，得到期望的关节位置 关节位置， 通过逆运动学计算，得到期望的关节位置，然后在关 节空间内，给每个关节找到一个经过中间点到达目的 节空间内， 终点的光滑函数 光滑函数， 终点的光滑函数，同时使得每个关节到达中间点和终 点的时间相同 时间相同， 点的时间相同，这样便可保证机械手工具能够到达期 望的直角坐标位置。 望的直角坐标位置。这里只要求各个关节在路径点之 间的时间相同 时间相同， 间的时间相同，而各个关节的光滑函数的确定则是互 相独立的。 相独立的。
12
对于CP控制: 对于CP控制: CP控制
机械手末端的运动轨迹是根据任务的需要给定 但是它也必须按照一定的采样间隔， 的，但是它也必须按照一定的采样间隔，通过逆运 动学计算，将其变换到关节空间， 动学计算，将其变换到关节空间，然后在关节空间 中寻找光滑函数来拟合这些离散点．最后， 中寻找光滑函数来拟合这些离散点．最后，还有在 机器人的计算机内部如何表示轨迹， 机器人的计算机内部如何表示轨迹，以及如何实时 地生成轨迹的问题。 地生成轨迹的问题。
利用三次多项式规划出的关节角的运动轨迹
19
2）抛物线连接的线性函数插值 前面介绍了利用三次多项式函数插值的规划方 另外一种常用方法是线性函数插值法， 法。另外一种常用方法是线性函数插值法，即用一 条直线将起点与终点连接起来。但是， 条直线将起点与终点连接起来。但是，简单的线性 函数插值将使得关节的运动速度在起点和终点处不 连续，它也意味着需要产生无穷大的加速度， 连续，它也意味着需要产生无穷大的加速度，这显 然是不希望的。因此可以考虑在起点和终点处， 然是不希望的。因此可以考虑在起点和终点处，用 抛物线与直线连接起来，在抛物线段内， 抛物线与直线连接起来，在抛物线段内，使用恒定 的加速度来平滑地改变速度， 的加速度来平滑地改变速度，从而使得整个运动轨 迹的位置和速度是连续的。 迹的位置和速度是连续的。
5
首先，机器人应该把任务进行分解，把主人交代的任务 分解成为“取一个杯子”、“找到水壶”、“打开瓶塞”、 “把水倒人杯中”、“把水送给主人”等一系列子任务。这 一层次的规划称为任务规划 任务规划(Task planning)，它完成总体任务 任务规划 的分解。 然后再针对每一个子任务进行进一步的规划。以“把水 倒入杯中”这一子任务为例，可以进一步分解成为“把水壶 提到杯口上方”、“把水壶倾斜倒水入杯”、“把水壶竖直 “、“把水壶放回原处”等一系列动作，这一层次的规划称 为动作规划 动作规划(Motion P1anning)，它把实现每一个子任务的过 动作规划 程分解为一系列具体的动作。 为了实现每一个动作，需要对手部的运动轨迹进行必要 轨迹规划(Hand trajectory planning )。 的规定，这是手部轨迹规划 轨迹规划 为了使手部实现预定的运动，就要知道各关节的运动规 律，这是关节轨迹规划 关节轨迹规划(Joint trajectory planning)。 关节轨迹规划 最后才是关节的运动控制 运动控制(Motion control)。 运动控制
第七章 工业机器人的轨迹规划
1
工业机器人系统组成
2
主要内容
7.1 机器人规划的基本概念 7.2 关节空间法 7.3 直角坐标空间法 7.4 轨迹的实时生成 7.5 路径的描述
3
7.1
机器人规划的基本概念
所谓机器人的规划(P1anning)，指的是 所谓机器人的规划(P1anning)，指的是— (P1anning) —机器人根据自身的任务，求得完成这一任务 机器人根据自身的任务，
20
线性函数插值图
14
下面具体介绍在关节空间内常用的两种规划方法 1） 三次多项式函数插值
考虑机械手末端在一定时间内从初始位置和方位移动 到目标位置和方位的问题。利用逆运动学计算， 到目标位置和方位的问题。利用逆运动学计算，可以首先 求出一组起始和终了的关节位置． 求出一组起始和终了的关节位置．现在的问题是求出一组 通过起点和终点的光滑函数 光滑函数。 通过起点和终点的光滑函数。满足这个条件的光滑函数可 以有许多条，如下图所示： 以有许多条，如下图所示：
7
给主人倒一杯水
取一个杯子
找到水壶
打开水壶
把水倒入杯中
把水送给主人
提起水壶到杯口上方
把水壶倾斜
把水壶竖直
把水壶放回原处
手部从A点移到 手部从 点移到B 点 点移到
关节从A点移到 点 关节从 点移到B点 点移到
图 智能机器人的规划层次
8
轨迹规划的目的是——将操作人员输入的 将操作人员输入的 轨迹规划的目的是 简单的任务描述变为详细的运动轨迹描述 任务描述变为详细的运动轨迹描述。 简单的任务描述变为详细的运动轨迹描述。
的解决方案的过程。这里所说的任务，具有广 这里所说的任务，
义的概念， 义的概念，既可以指机器人要完成的某一具体 任务，也可以是机器人的某个动作， 任务，也可以是机器人的某个动作，比如手部 或关节的某个规定的运动等。 或关节的某个规定的运动等。
4
为说明机器人规划的概念， 为说明机器人规划的概念，我们举下面的 例子： 例子：
16
a0 = q0 a1 = 0 3 a2 = 2 ( q f − q0 ) tf 2 a3 = − 3 ( q f − q0 ) tf
17
（7-4） ）
例： 设机械手的某个关节的起始关节角θ 设机械手的某个关节的起始关节角θ0＝150，并且机械手 原来是静止的。要求在3秒钟内平滑地运动到θ 时停下来( 原来是静止的。要求在3秒钟内平滑地运动到θf=750时停下来( 即要求在终端时速度为零) 即要求在终端时速度为零)。规划出满足上述条件的平滑运动 的轨迹，并画出关节角位置、 的轨迹，并画出关节角位置、角速度及角加速度随时间变化的 曲线。 曲线。
例如，对一般的工业机器人来说， 例如，对一般的工业机器人来说，操作员可能只 输入机械手末端的目标位置和方位， 输入机械手末端的目标位置和方位，而规划的任务便 是要确定出达到目标的关节轨迹的形状、 是要确定出达到目标的关节轨迹的形状、运动的时间 和速度等。这里所说的轨迹是指随时间变化的位置、 和速度等。这里所说的轨迹是指随时间变化的位置、 速度和加速度。 速度和加速度。
对上式求导， 对上式求导，可以得到角速度和角加速度
θ& ( t ) = 40t − 13.33t 2
&& θ ( t ) = 40 − 26.66t
（7-6） ） （7-7） ）
18
根据式(7-5)～(7-7)可画出它们随时间的变 根据式(7-5)～(7-7)可画出它们随时间的变 (7 化曲线如下图所示。由图看出， 化曲线如下图所示。由图看出，速度曲线为一抛 物线，加速度则为一直线。 物线，加速度则为一直线。
11
对于PTP控制: 对于PTP控制: PTP控制
通常只给出机械手末端的起点和终点，有时也 通常只给出机械手末端的起点和终点， 给出一些中间经过点，所有这些点统称为路径点。 给出一些中间经过点，所有这些点统称为路径点。 应注意这里所说的“ 应注意这里所说的“点” 不仅包括机械手末端的 位置，而且包括方位，因此描述一个点通常需要6 位置，而且包括方位，因此描述一个点通常需要6 个量。通常希望机械手末端的运动是光滑的， 个量。通常希望机械手末端的运动是光滑的，即它 具有连续的一阶导数， 具有连续的一阶导数，有时甚至要求具有连续的二 阶导数。 阶导数。不平滑的运动容易造成机构的磨损和破坏 甚至可能激发机械手的振动。 ，甚至可能激发机械手的振动。因此规划的任务便 是要根据给定的路径点规划出通过这些点的光滑的 运动轨迹。 运动轨迹。
9
简言之，机器人的工作过程，就是通过规划， 简言之，机器人的工作过程，就是通过规划，将要求的任 务变为期望的运动和力， 务变为期望的运动和力，由控制环节根据期望的运动和力的信 产生相应的控制作用，以使机器人输出实际的运动和力， 号，产生相应的控制作用，以使机器人输出实际的运动和力， 从而完成期望的任务。这一过程表述如下图所示。这里， 从而完成期望的任务。这一过程表述如下图所示。这里，机器 人实际运动的情况通常还要反馈给规划级和控制级， 人实际运动的情况通常还要反馈给规划级和控制级，以便对规 划和控制的结果做出适当的修正。 划和控制的结果做出适当的修正。
要求的任务
人 机 接 口
规
期望的 运动和力
控
控制作用
划
制
机 器 人 本 体
实际的 运动和力
图 机器人的工作原理示意图
10
上图中，要求的任务由操作人员输入给机器人， 上图中，要求的任务由操作人员输入给机器人， 为了使机器人操作方便、使用简单， 为了使机器人操作方便、使用简单，必须允许操作人 员给出尽量简单的描述。 员给出尽量简单的描述。 上图中， 上图中，期望的运动和力是进行机器人控制所必 需的输入量， 需的输入量，它们是机械手末端在每一个时刻的位姿 和速度，对于绝大多数情况， 和速度，对于绝大多数情况，还要求给出每一时刻期 望的关节位移和速度， 望的关节位移和速度，有些控制方法还要求给出期望 的加速度等。 的加速度等。