专利名称：机器人三维路径规划方法
技术领域：
本发明涉及机器人三维路径规划，特别涉及一种基于神经网络能量函数的 自主移动的机器人三维路径规划方法。
背景技术：
自主移动机器人路径规划是指机器人在有障碍物的工作环境中，寻找一条从 给定起点到终点的运动路径，使机器人能无碰撞地绕过所有的障碍物。机器人 路径规划问题可以分为两种， 一种是基于环境先验完全信息的全局路径规划， 另一种是基于传感器信息的局部路径规划，后者环境是未知或者部分未知的。 全局路径规划已提出的典型方法有可视图法、图搜索法、人工势场法等。可视 图法的优点是可以求得最短路径，但缺乏灵活性，并且存在组合爆炸问题。图 搜索法比较灵活，机器人的起始点和目标点的改变不会造成连通图的重新构造， 但不是任何时候都可以获得最短路径。可视图法和图搜索法适用于多边形障碍 物的避障路径规划问题，但不适用解决圆形障碍物的避障路径规划问题。人工 势场法的基本思想是通过寻找路径点的能量函数的极小值点而使路径避开障碍 物，但存在局部极小值问题且不适于寻求最短路径。文献[l]给出的基于神经网
络结构能量函数的路径规划算法(称为NA算法)，引入神经网络结构和模拟退 火等方法，计算简单，能避免某些局部极值情况，对人工势场法给予了较大的 改进。但NA算法仅适用于二维空间，本发明提出一种适用于三维空间的基于神 经网络能量函数的路径规划算法。
发明内容
本发明有4点假设(1)障碍物是三维环境中的多面体。(2)障碍物为静 止的。(3)计算时障碍物的尺寸按机器人的半径作适当的扩展。
本发明的目的在于将NA路径规划算法推广到三维空间，使机器人能够在三 维空间环境中规划出避障路径，并且使规划的无碰路径达到最短无碰路径。为实现上述目的，本发明所采用的技术方案是
定义路径总能量函数为碰撞罚函数与相应于路径长度部分能量函数的加权 和，它是各个路径点的函数，通过移动路径点的位置，使其朝着使总能量函数 的函数值减小方向运动，最终规划出避障的最短路径。
路径的碰撞罚函数定义为各路径点的碰撞罚函数之和，而一个点的碰撞罚 函数是通过它对各个障碍物的神经网络表示得到的，其中模拟退火温度的初始 温度，可根据障碍物的形状，设定相应于障碍物各边的不同的初始温度。
设置一个检测路径点位置的检测器 一个神经网络分类器，在路径规划的 过程中检测路径点的位置P0c,3^),判断该点是否在障碍物内，即是否与障碍物 相碰。
输入出发点P(x,，力,W及目标点P(^,^, )的坐标，对于/ = 0，初始路径一般 取为出发点到目标点的直线上均匀分布的点列。通过检测器检测路径点/^^,，z,) 在障碍物内或者在障碍物外，按照不同的动态运动方程，计算出相应路径点的 移动位置。
图1是一个点到一个障碍物的罚函数的神经网络。
图2是用本发明的基于神经网络能量函数的三维路径规划算法进行路径规 划的仿真实验结果图。
图3是用本发明的基于神经网络能量函数的三维路径规划算法进行路径规 划的仿真实验过程。
具体实施例方式
本发明的基于神经网络能量函数的三维路径规划算法的路径规划具体实施 方法分为如下几个步骤进行
步骤l:定义路径总能量函数。一条路径的碰撞罚函数定义为各路径点的碰撞罚函数之和，而一个点的碰 撞罚函数是通过它对各个障碍物的三层前向神经网络表示得到的。图l表示了 一个点到一个障碍物的罚函数的神经网络。输入层三个结点的输入值分别是路 径点的横坐标、纵坐标和竖坐标x、 _y、 Z，中间层的每个结点相应于障碍物的 一个面的不等式限制条件，输入层和中间层的连接权系数等于不等式中x、 >'、 Z前面的系数，中间层每个结点的阈值等于相应不等式中的常数项。中间层到输 出层的连接权为l，输出层结点的阈值取为不等式的个数减去O. 5后的负数。该连续网络的运算关系为<formula>formula see original document page 7</formula>其中各符号的含义为，C:顶层结点输出；顶层结点输入；顶层结点阈值；0 ,:中间层第m个结点的输出；/f 中间层第w个结点的阈值；w，， ,，i、 发函数为常用的S形函数，即模拟退火温度变化公式为:<formula>formula see original document page 7</formula>:中间层第附个结点的输入； m: 第w个不等式限制条件的系数。激<formula>formula see original document page 7</formula>其中y 是模拟退火初始温度。艮是相应于障碍物每一面的模拟退火初始温 度，可以根据障碍物的形状，设定各面的不同的初始温度，这样对于一些不对称图形可避免路径规划的局部极小值情况。 整条路径相应于碰撞函数能量为<formula>formula see original document page 8</formula>(8)其中X是障碍物的个数，W是路径点的个数，Cf表示第f个路径点nw,，^对第 /t个障碍物的碰撞函数。相应于路径长度部分的能量函数定义为所有线段长度的平方和，即<formula>formula see original document page 8</formula>(9)整条路径的总能量函数定义为<formula>formula see original document page 8</formula>其中^和，分别表示对每一部分的权重(w, +wt =1 )。 步骤2:根据出发点坐标/^,'"，z,)及目标点坐标/^,v,h， 取为出发点到目标点的直线上均匀分布的点列-,)，初始路径一般<formula>formula see original document page 8</formula>(11)步骤3:对于路径点〃(^》.,，0,( = 2,3,...,. '—i，用检测器检测是否在障碍物内，根据不同情况分别进行下面两种操作 (1)若路径点/^,,,,,2,)在障碍物内，则按下列运动方程移动<formula>formula see original document page 8</formula>(2)若au,，."在障碍物之外，则按下列运动方程移动i<formula>formula see original document page 8</formula>步骤4:重复执行步骤3，直到路径收敛。 仿真实验图2是用本发明的基于神经网络能量函数的三维路径规划算法进行路径规划的仿真实验结果图。图3是用本发明的基于神经网络能量函数的三维路径规划算法进行路径规划的仿真实验过程。本发明给出了一种基于神经网络能量函数的三维路径规划算法，使机器人 能够在三维空间环境中规划出最短避障路径，为自主移动机器人在三维空间的 最优路径规划提供了一个简捷有效的方法。
权利要求
1、一种机器人三维路径规划方法，其特征在于解决自主移动机器人在有障碍物的三维空间的路径规划问题，规划出的避障路径达到最短避障路径。
2、 根据权利要求1所述的机器人三维路径规划方法，其特征在于定义 路径总能量函数为碰撞罚函数与相应于路径长度部分能量函数的加权和，它 是各个路径点的函数，通过移动路径点的位置，使其朝着使总能量函数的函 数值减小方向运动，最终规划出避障的最短路径，路径的碰撞罚函数定义为各路径点的碰撞罚函数之和，而一个点的碰撞 罚函数是通过它对各个障碍物的神经网络表示得到的，其中模拟退火温度的 初始温度，可根据障碍物的形状，设定相应于障碍物各面的不同的初始温度，设置一个检测路径点位置的检测器 一个神经网络分类器，在路径规划 的过程中检测路径点的位置，判断其是否在障碍物内，即是否与障碍物相碰，初始路径一般取为出发点到目标点的直线上均匀分布的点列，通过检测 路径点在障碍物内或者在障碍物外，按照不同的动态运动方程，计算出相应路径点的移动位置。
3、 根据权利要求1所述的机器人三维路径规划方法，其特征在于基于神经网络能量函数的三维路径规划算法的路径规划具体实施方法分为如下几 个步骤进行步骤l:定义路径总能量函数。一条路径的碰撞罚函数定义为各路径点的碰撞罚函数之和，而一个点的 碰撞罚函数是通过它对各个障碍物的三层前向神经网络表示得到的，输入层 的三个结点的输入分别是路径点的横坐标、纵坐标和竖坐标x、 _y、 Z，中间 层的每个结点相应于障碍物的一个面的不等式限制条件，输入层和中间层的 连接权系数等于不等式中"_y、 Z前面的系数，中间层每个结点的阈值等于 相应不等式中的常数项。中间层到输出层的连接权为1，输出层结点的阈值取为不等式的个数减去0. 5后的负数， 该连续网络的运算关系为<formula>formula see original document page 3</formula> (1)<formula>formula see original document page 3</formula>(2)<formula>formula see original document page 3</formula>(3)<formula>formula see original document page 3</formula>( 4 )其中各符号的含义为，C:顶层结点输出；/(;:顶层结点输入；:顶层结 点阈值；中间层第m个结点的输出；/ ,，,中间层第w个结点的输入； ， 中间层第附个结点的阈值；wt ,， wz 激发函数为常用的S形函数，即 第^个不等式限制条件的系数<模拟退火温度变化公式为:(5)■ + e1og(l + ,)1og(l + 0(6)(7)其中p是模拟退火初始温度。A,是相应于障碍物每一个面的模拟退火初始温度，可以根据障碍物的形状，设定各面的不同的初始温度，这样对于一些不对称图形可避免路径规划的局部极小值情况， 整条路径相应于碰撞函数部分的能量为W 人'五『:s s《(8)其中《是障碍物的个数，iV是路径点的个数，Cf表示第/个路径点/^,^,)对第A个障碍物的碰撞函数，相应于路径长度部分的能量函数定义为所有线段长度的平方和，即对所有路径点尸(x,乂)， /"，2，…,yV，定义<formula>formula see original document page 4</formula>整条路径的总能量函数定义为￡ (10) 其中w,和气分别表示对每一部分的权重(W/+^=i)，步骤2:根据出发点坐标/^， q)及目标点坐标/Xx^;v，^.)，初始路径一 般取为出发点到目标点的直线上均匀分布的点列<formula>formula see original document page 4</formula>(11)步骤3:对于路径点/^,,%2,),, = 2,3,..,^-1，用检测器检测是否在障碍物内，根据不同情况分别进行下面两种操作 (1)若路径点/^,，^z,)在障碍物内，则按下列运动方程移动<formula>formula see original document page 4</formula>(2)若PK，y,A)在障碍物之外，则按下列运动方程移动<formula>formula see original document page 4</formula>步骤4:重复执行步骤3，直到路径收敛。
全文摘要
本发明涉及自主移动机器人三维路径规划，特别涉及一种基于神经网络能量函数的自主移动机器人三维路径规划算法，定义路径总能量函数为碰撞罚函数与相应于路径长度部分能量函数的加权和，在路径规划的过程中检测路径点的位置是否在障碍物内，根据路径点位于障碍物内外的不同位置用不同的动态运动方程移动路径点的位置，使其朝着使总能量函数的函数值减小的方向运动，最终规划出最短的避障路径。
文档编号G06N3/00GK101231714SQ200710193060
公开日2008年7月30日 申请日期2007年12月5日 优先权日2007年12月5日
发明者库卢莫夫, 禹建丽 申请人:中原工学院