[发明专利]一种基于萤火虫算法的舰船路径规划方法有效
申请号: | 201110257951.3 | 申请日: | 2011-09-02 |
公开(公告)号: | CN102360214A | 公开(公告)日: | 2012-02-22 |
发明(设计)人: | 刘厂;高峰;李刚;赵玉新;董静 | 申请(专利权)人: | 哈尔滨工程大学 |
主分类号: | G05D1/02 | 分类号: | G05D1/02;G05B13/02 |
代理公司: | 北京永创新实专利事务所 11121 | 代理人: | 赵文利 |
地址: | 150001 黑龙江*** | 国省代码: | 黑龙江;23 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 萤火虫 算法 舰船 路径 规划 方法 | ||
1.一种基于萤火虫算法的舰船路径规划方法,其特征在于,包括以下几个步骤:
步骤一:根据任务信息确定路径的起始点和目标点,并根据起始点和目标点确定航行区 域;
航行区域为以路径起始点和终止点连线为对角线的矩形区域,航行区域的边界坐标为 Xmin,Xmax,Ymin,Ymax;
步骤二:以起始点为坐标原点,起始点和目标点的连线为横坐标建立新的坐标系;
在原坐标系中,一个点的位置由x,y两个点确定,以起始点S和目标点G的连线为横坐 标轴X′,过S的垂线为纵坐标轴Y′,建立新的坐标系S-X′Y′;
步骤三:将航行区域内的障碍物进行简化合并,生成禁航区;
具体为:
安全区:该区域中舰船航行没有任何危险;
禁航区:该区域存在不利于舰船安全航行的要素,会危及舰船航行安全;
步骤四:利用萤火虫算法进行最优路径搜索;
具体步骤如下:
步骤4.1:确定萤火虫种群的参数、最大迭代次数;
确定随机参数起始值αb、随机参数终止值αe、随机运动步长l、完全随机运动时的吸引 力β0、吸收系数起始值γb、吸收系数终止值γe、维数n、最大迭代次数N;
步骤4.2:初始化萤火虫种群,并计算每个萤火虫的亮度值;
具体为:
一个萤火虫代表一条候选路径,一条候选路径由一系列路径点构成,萤火虫的各维分量 对应的实际含义是路径上的路径点的坐标;设萤火虫的维数为n,将线段SG进行n+1等分, 在每一个等分点作垂线,得到平行直线族(L1,L2,...,Ln-1,Ln),它们与路径的交点即为可用路径 点序列(p1,p2,...,pn-1,pn);设定起始点S为p0和目标点G即为pn+1,候选路径表示为可用路径 点的集合:p=(p1,p2,...,pn,pn+1);
由于平行直线族(L1,L2,...,Ln-1,Ln)相邻两条直线间的距离相同,路径点在S-X′Y′坐标系中 横坐标根据其所在直线序号确定,纵坐标为工作区域中的随机数,新坐标系中第i个路径点的 坐标为:
其中:LSG为起始点和目标点连线的直线长度,Y′min和Y′max分别为纵坐标的最小值和最大 值,rand为介于纵坐标最大值和最小值间的随机数;
将路径的评价函数设为萤火虫的亮度,萤火虫亮度的获取方法为:
采用路径长度作为路径的评价函数;对于一条含有n个航路点的路径来说,由n-1条路 径段组成,路径长度为将各个路径段的长度相加,即:
其中,ΔLi表示第i个路径点和第i+1个路径点间的距离,x′i,y′i为第i个路径点的坐标, x′i-1,y′i-1为第i-1个路径点的坐标,1≤i<n;
路径评价函数为:
其中:为起始点与第一个路径点间的距离,ΔLi为第i个路径点和第i+1个路径点间的 距离,为最后一个路径点与目标点间的距离;
将评价函数的倒数作为萤火虫的亮度值,即
其中:Ii表示第i个萤火虫的亮度值,Ei表示第i条候选路径的长度;
步骤4.3:将萤火虫种群按照亮度进行排序,找到最亮虫;
步骤4.4:判断当前迭代次数是否达到设定的最大迭代次数N,如果达到则执行步骤五, 否则转向步骤4.5;
步骤4.5:根据当前的迭代次数,确定吸收系数和随机参数;
吸收系数γ为:
第i次迭代的吸收参数γ为:
γi=γb+(γe-γb)×i/N
其中:γe>γb,γb为初始值,γe为最终值,N为总的迭代次数;
随机参数α为:
第i次迭代的随机参数α为:
αi=αb+(αe-αb)×i/N
其中:αe<αb,αb为初始值,αe为最终值,N为总的迭代次数;
步骤4.6:将非最亮萤火虫的位置进行更新;
假设萤火虫i被一个比它亮的萤火虫j吸引,它的新位置为:
其中:x1i表示萤火虫i的新位置;
x0i表示萤火虫i的当前位置;
由该萤火虫被其它临近虫看到的光强度决定;γ由步骤4.5得到;rij是萤火虫i和萤 火虫j之间的欧里几何距离,计算公式如下:
xi和xj分别为萤火虫i和萤火虫j的位置,n为维数;
表示当前萤火虫的随机运动;α根据步骤4.5得到;rand是一个介于0 和1之间的随机数;
判断非最亮萤火虫的位置是否均更新完毕,如果是,则转向步骤4.7,否则,继续更新 非最亮萤火虫的位置;
步骤4.7:将最亮萤火虫的位置进行更新,并转向步骤4.3;
最亮虫的位置进行更新为:
步骤五:将最优路径中各个路径点的坐标转换为O-XY下的坐标;
步骤六:得到舰船的最优路径,路径规划结束。
2.根据权利要求1所述的一种基于萤火虫算法的舰船路径规划方法,其特征在于,禁 航区的信息用一个二维数组来表示,POINT Obstacle[M][N],其中,M为禁航区的数目,N 为禁航区的最大顶点个数。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工程大学,未经哈尔滨工程大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201110257951.3/1.html,转载请声明来源钻瓜专利网。