您好,欢迎访问三七文档
当前位置:首页 > 机械/制造/汽车 > 综合/其它 > 第05章-机器人轨迹规划
1第五章机器人的轨迹规划5.1机器人规划的定义和作用5.1.1概述所谓机器人的规划(P1anning),指的是——机器人根据自身的任务,求得完成这一任务的解决方案的过程。这里所说的任务,具有广义的概念,既可以指机器人要完成的某一具体任务,也可以是机器人的某个动作,比如手部或关节的某个规定的运动等。2为说明机器人规划的概念,我们举下面的例子:在一些老龄化比较严重的国家,开发了各种各样的机器人专门用于伺候老人,这些机器人有不少是采用声控的方式.比如主人用声音命令机器人“给我倒一杯开水”,我们先不考虑机器人是如何识别人的自然语言,而是着重分析一下机器人在得到这样一个命今后,如何来完成主人交给的任务。3首先,机器人应该把任务进行分解,把主人交代的任务分解成为“取一个杯子”、“找到水壶”、“打开瓶塞”、“把水倒人杯中”、“把水送给主人”等一系列子任务。这一层次的规划称为任务规划(Taskplanning),它完成总体任务的分解。然后再针对每一个子任务进行进一步的规划。以“把水倒入杯中”这一子任务为例,可以进一步分解成为“把水壶提到杯口上方”、“把水壶倾斜倒水入杯”、“把水壶竖直“、“把水壶放回原处”等一系列动作,这一层次的规划称为动作规划(MotionP1anning),它把实现每一个子任务的过程分解为一系列具体的动作。为了实现每一个动作,需要对手部的运动轨迹进行必要的规定,这是手部轨迹规划(Handtrajectoryplanning)。为了使手部实现预定的运动,就要知道各关节的运动规律,这是关节轨迹规划(Jointtrajectoryplanning)。最后才是关节的运动控制(Motioncontrol)。4上述例子可以看出,机器人的规划是分层次的,从高层的任务规划,动作规划到手部轨迹规划和关节轨迹规划,最后才是底层的控制(见图)。在上述例子中,我们没有讨论力的问题,实际上,对有些机器人来说,力的大小也是要控制的,这时,除了手部或关节的轨迹规划,还要进行手部和关节输出力的规划。智能化程度越高,规划的层次越多,操作就越简单。对工业机器人来说,高层的任务规划和动作规划一般是依赖人来完成的。而且一般的工业机器人也不具备力的反馈,所以,工业机器人通常只具有轨迹规划的和底层的控制功能。5取一个杯子找到水壶打开水壶把水倒入杯中把水送给主人给主人倒一杯水提起水壶到杯口上方把水壶倾斜把水壶竖直把水壶放回原处手部从A点移到B点关节从A点移到B点图智能机器人的规划层次6许多规划所包的步骤是含糊的,而且需要进一步说明(子规划)。大多数规划具有很大的子规划结构,规划中的每个目标可以由达到此目标的比较详细的子规划所代替。因此,最终得到的规划是某个问题求解算符的线性或分部排序,但是由算符来实现的目标常常具有分层结构。把某些比较复杂的问题分解为一些比较小的问题的想法使我们应用规划方法求解问题在实际上成为可能。有两条能够实现这种分解的重要途径:第一条是当从一个问题状态移动到下一个状态时,无需计算整个新的状态,而只要考虑状态中可能变化了的那些部分。第二条是把单一的困难问题分割为几个有希望的、较为容易解决的子问题,这种分解能够使困难问题的求解变得容易些。7机器人规划分为高层规划和低层规划。自动规划在机器人规划中称为高层规划。在无特别说明时,机器人规划都是指自动规划。自动规划是一种重要的问题求解技术,它从某个特定的问题状态出发,寻求一系列行为动作,并建立一个操作序列,直到求得目标状态为止。与一般问题求解相比,自动规划更注重于问题的求解过程,而不是求解结果。我们在阐述机器人自动规划问题时,机器人一般配备有传感器和一组能在某个易于理解的现场中完成的基本动作。这些动作可把该现场从一种状态或布局变换为另一种状态或布局。8机器人规划是机器人学的一个重要研究领域,也是人工智能与机器人学一个令人感兴趣的结合点。机器人学中的一个基本问题是为解决某个预定的任务而规划机器人的动作,然后在机器人执行完成那些动作所需的命令时控制它。这里,规划的意思就是机器人在行动前确定一系列动作(作决策),这种动作的确定可用问题求解系统来解决,给定初始情况后,该系统可达到某一规定的目标。因此,规划就是指机器人为达到目标而需要的行动过程的描述。规划内容可能没有次序,但是一般来说,规划具有某个规划目标的蕴含排序。例如,早晨起床后的安排。缺乏规划可能导致不是最佳的问题求解,甚至得不到问题的求解。9机器人的规划程序只需要给定任务初始状态和最终状态的描述。这些规划系统一般都不说明为实现一个算符所需的详细的机器人运动。任务规划程序则把任务级的说明变换成操作机级的说明。为了进行这种变换,任务规划程序必须包含被操作物体、任务环境、机器人执行的任务、环境的初始状态和所要求的最终(目标)状态等描述。任务规划程序的输出就是一个机器人程序,在指定的初始状态下执行该程序后,就能达到所要求的最终状态。任务规划有三个阶段:建立模型、任务说明和操作机程序综合。任务的世界模型应含有如下的信息:(1)任务环境中的所有物体和机器人的几何描述;(2)所有物体的物理描述;(3)所有连接件的运动学描述,(4)机器人和传感器特性的描述。在世界模型中,任务状态模型还必包括全部物体和连接件的布局。5.1.2机器人任务规划的作用10轨迹规划的目的是——将操作人员输入的简单的任务描述变为详细的运动轨迹描述。例如,对一般的工业机器人来说,操作员可能只输入机械手末端的目标位置和方位,而规划的任务便是要确定出达到目标的关节轨迹的形状、运动的时间和速度等。这里所说的轨迹是指随时间变化的位置、速度和加速度。11简言之,机器人的工作过程,就是通过规划,将要求的任务变为期望的运动和力,由控制环节根据期望的运动和力的信号,产生相应的控制作用,以使机器人输出实际的运动和力,从而完成期望的任务。这一过程表述如下图所示。这里,机器人实际运动的情况通常还要反馈给规划级和控制级,以便对规划和控制的结果做出适当的修正。人机接口规划控制机器人本体要求的任务期望的运动和力实际的运动和力控制作用图机器人的工作原理示意图12上图中,要求的任务由操作人员输入给机器人,为了使机器人操作方便、使用简单,必须允许操作人员给出尽量简单的描述。上图中,期望的运动和力是进行机器人控制所必需的输入量,它们是机械手末端在每一个时刻的位姿和速度,对于绝大多数情况,还要求给出每一时刻期望的关节位移和速度,有些控制方法还要求给出期望的加速度等。13对于PTP控制:通常只给出机械手末端的起点和终点,有时也给出一些中间经过点,所有这些点统称为路径点。应注意这里所说的“点”不仅包括机械手末端的位置,而且包括方位,因此描述一个点通常需要6个量。通常希望机械手末端的运动是光滑的,即它具有连续的一阶导数,有时甚至要求具有连续的二阶导数。不平滑的运动容易造成机构的磨损和破坏,甚至可能激发机械手的振动。因此规划的任务便是要根据给定的路径点规划出通过这些点的光滑的运动轨迹。14对于CP控制:机械手末端的运动轨迹是根据任务的需要给定的,但是它也必须按照一定的采样间隔,通过逆运动学计算,将其变换到关节空间,然后在关节空间中寻找光滑函数来拟合这些离散点.最后,还有在机器人的计算机内部如何表示轨迹,以及如何实时地生成轨迹的问题。15机器人轨迹规划属于机器人低层规划,基本上不涉及人工智能问题,而是在机械手运动学和动力学的基础上,讨论机器人运动的规划及其方法。所谓轨迹,就是指机器人在运动过程中的位移、速度和加速度。轨迹规划问题通常是将轨迹规划器看成“黑箱”,接受表示路径约束的输入变量,输出为起点和终点之间按时间排列的操作机中间形态(位姿,速度和加速度)序列。路径约束动力学约束路径设定轨迹规划器5.2机器人轨迹规划的一般性问题由初始点运动到终止点,所经过的由中间形态序列构成的空间曲线称为路径。这些形态序列即是曲线上的“点”。16规划操作机的轨迹有两种常用的方法:第一种方法:要求使用者在沿轨迹选定的位置点上(称为结节或插值点)显式地给定广义坐标位置、速度和加速度的一组约束(例如,连续性和光滑程度等)。然后,轨迹规划器从插值和满足插值点约束的函数中选定参数化轨迹。显然,在这种方法中,约束的给定和操作机轨迹规划是在关节坐标系中进行的。第二种方法:使用者以解析函数显式地给定操作机必经之路径,例如,笛卡尔坐标中的直线路径。然后,轨迹规划器在关节坐标或笛卡几坐标中确定一条与给定路径近似的轨迹。在这种方法中,路径约束是在笛卡尔坐标中给定的。17在第一种方法中,约束的给定和操作机轨迹规划在关节坐标系中进行。由于对操作机手部没有约束,使用者难于跟踪操作机手部运行的路径。因此,操作机手部可能在没有事先警告的情况下与障碍物相碰。在第二种方法中,路径约束在笛卡尔坐标中给定,而关节驱动器是在关节坐标中受控制的。因此,为了求得一条逼近给定路径的轨迹,必须用函数近似把笛卡尔坐标中的路径约束变换为关节坐标中的路径约束,再确定满足关节坐标路径约束的参数化轨迹。轨迹规划既可在关节变量空间中进行,也可在笛卡尔空间进行。对于关节变量空间的规划,要规划关节变量的时间函数及其前二阶时间导数,以便描述操作机的预定运动。在笛卡尔空间规划中,要规划操作机手部位置、速度和加速度的时间函数,而相应的关节位置、速度和加速度可根据手部信息导出。18面向笛卡尔空间方法的优点是概念直观,而且沿预定直线路径可达到相当的准确性。可是由于现代还没有可用笛卡尔坐标测量操作机手部位置的传感器,所有可用的控制算法都是建立在关节坐标基础上的。因此,笛卡尔空间路径规划就需要在笛卡尔坐标和关节之间进行实时变换,这是一个计算量很大的任务,常常导致较长的控制间隔。由笛卡尔坐标向关节坐标的变换是病态的,因而它不是一一对应的映射。如果在轨迹规划阶段要考虑操作机的动力学特性,就要以笛卡尔坐标给定路径约束,同时以关节坐标给定物理约束(例如,每个关节电机的力和力矩、速度和加速度权限)。这就会使最后的优化问题具有在两个不同坐标系中的混合约束。在笛卡尔空间进行轨迹规划的特点:19在关节变量空间的规划有三个优点:(1)直接用运动时的受控变量规划轨迹;(2)轨迹规划可接近实时地进行;(3)关节轨迹易于规划。伴随的缺点是难于确定运动中各杆件和手的位置,但是,为了避开轨迹上的障碍.常常又要求知道一些杆件和手位置。20由于面向笛卡尔空间的方法有前述钟种缺点,使得面向关节空间的方法被广泛采用。它把笛卡尔结点变换为相应的关节坐标,并用低次多项式内插这些关节结点。这种方法的优点是计算较快,而且易于处理操作机的动力学约束。但当取样点落在拟合的光滑多项式曲线上时,面向关节空间的方法沿笛卡尔路径的准确性会有损失。215.3关节空间法轨迹规划问题又可以分为关节空间的轨迹规划和直角空间的轨迹规划。关节空间法首先将在工具工作空间中期望的路径点,通过逆运动学计算,得到期望的关节位置,然后在关节空间内,给每个关节找到一个经过中间点到达目的终点的光滑函数,同时使得每个关节到达中间点和终点的时间相同,这样便可保证机械手工具能够到达期望的直角坐标位置。这里只要求各个关节在路径点之间的时间相同,而各个关节的光滑函数的确定则是互相独立的。22一般说来,生成关节轨迹设定点的基本算法是很简单的:0tt循环:等待下一个控制间隔;时刻操作机关节所处的位置;若,则退出循环;转向循环。ttt()httftt从上述算法可以看出,要计算的是在每个控制间隔中必须更新的轨迹函数(或轨迹规划器)h(t)。因此,对规划的轨迹要提出四个限制。第一,必须便于用迭代方式计算轨迹设定点;第二,必须求出并明确给定中间位置;第三,必须保证关节变量及其前二阶时间导数的连续性,使得规划的关节轨迹是光滑的;最后,必须减少额外的运动(例如,“游移”)。23若某关节(例如关节i)的关节轨迹使用p个多项式,则要满足初始和终止条件(关节位置、速度和加速度),并保证这些变量在多项式衔接处的连续性,因而需要确定3(p十1)个系数。若给定附加的中间条件(例如位置),则对每个中间条件需要增加一系数。通常
本文标题:第05章-机器人轨迹规划
链接地址:https://www.777doc.com/doc-6211798 .html