基于鲸鱼优化算法的移动机器人路径规划方法与流程

本发明属于机器人路径规划技术领域，特别是一种基于鲸鱼优化算法的移动机器人路径规划方法。

背景技术：

移动机器人路径规划是机器人自主导航系统的重要组成部分，它主要解决机器人在获取环境先验地图的基础上，完成“去哪里”和“如何去”的问题。其目的是在给定的有障碍物的环境地图上，按照最短距离、最小时间或最小代价的评价标准，从起点到终点寻找到一条无碰撞的安全路径。2016年，澳大利亚学者mirjalili等人根据鲸鱼捕食猎物的行为，抽象出鲸鱼在捕食时搜索、包围和攻击的3种行为的数学模型，提出一种新型基于群体智能的优化算法，即鲸鱼优化算法(whaleoptimizationalgorithm,woa)。鲸鱼算法是一种元启发式算法，与蚁群算法，人工鱼群和粒子群等算法相比，它具有原理和参数设置简单，函数寻优能力强等特点。然而同其他群体智能算法相同，在实际的工程运用中，算法的全局搜索和局部开发难以协调平衡，并且在算法的迭代后期，存在易陷入局部最优和过早收敛等问题。龙文等人通过提出一种非线性收敛因子和对最优个体进行多样性变异的方法使鲸鱼算法能都应用于大规模场景寻优。王坚浩等人提出一种基于混沌搜索策略的鲸鱼优化算法，改善算法后期易陷入局部最优的不足。emary等人提出一种自适应随机步长的鲸鱼搜索方法避免算法过早收敛。针对woa算法本身的缺陷，本方法利用高斯分布函数的特点，重新构造鲸鱼算法系数向量中收敛因子的更新公式，以此平衡鲸鱼算法的全局探索和局部开发的能力，另外，通过动态控制系数向量，有效避免了算法迭代后期易陷入局部最优。将本方法应用在移动机器人路径规划中，能够很好地解决移动机器人室内路径规划问题。

技术实现要素：

本发明旨在解决以上现有技术的问题。提出了一种收敛精度高，收敛速度快，并能避免在算法迭代后期易陷入局部最优的基于鲸鱼优化算法的移动机器人路径规划方法。本发明的技术方案如下：

一种基于鲸鱼优化算法的移动机器人路径规划方法，其包括以下步骤：

s1：对鲸鱼优化算法初始化，设置算法的参数，利用适应度函数，获得鲸鱼在所有位置上的适应度值，并确定鲸鱼种群初始个体最优位置与全局最优位置。随着算法迭代进行，根据鲸鱼个体位置更新公式，更新鲸鱼个体位置；s2：在鲸鱼优化算法中，利用新的收敛因子a'，重新计算系数向量a，并更新鲸鱼个体的新位置。利用二维栅格地图模型，获取移动机器人起始点到目标点可行路径的参数，得到每只鲸鱼所有可行的初始路径。

s3：根据鲸鱼个体位置更新公式，更新鲸鱼个体位置，利用二维栅格地图模型，获取移动机器人起始点到目标点可行路径的参数，得到每只鲸鱼所有可行的初始路径；

s4：计算新位置上鲸鱼个体的适应度值，将其与原位置的适应度值进行比较，若新位置的适应度值优于原位置适应度值，则更新鲸鱼种群的个体最好位置，并且更新全局最优位置；

s5、算法到达迭代次数后执行步骤s6，否则执行步骤s2-s4。

s6、通过鲸鱼优化算法得到的全局最优位置，选择一条适应度值最小的鲸鱼路径作为移动机器人路径规划的最优路径。

进一步的，初始化算法，将鲸鱼种群数设为n，最大迭代次数设为tmax，选取的适应度函数为：

其中，xi为第i只鲸鱼的位置，n表示鲸鱼个体在搜索空间中的维度，(xn,yn)表示第n维的鲸鱼个体在栅格地图上的坐标，同理，(xn+1,,yn+1)表示第n+1维的鲸鱼个体在栅格地图上的坐标。表示鲸鱼种群的维数。

将算法第一次迭代时每只鲸鱼的位置设为当前个体最优位置。计算每只鲸鱼的适应度值，并比较所有鲸鱼个体的适应度值，取最小适应度值的鲸鱼个体的位置为全局最优位置。

进一步，所述步骤s2中，利用高斯分布函数：

x表示高斯分布函数的自变量，x0表示高斯分布函数的期望值，σ为标准差。

构建新的收敛因子公式为：

a'＝af+(ai-af)×f(t/tmax；0,1)

其中，ai表示收敛算子的初始值，af表示收敛算子的终值。

通过新的收敛因子a'，计算系数向量a，利用新的位置更新公式来更新鲸鱼个体新位置，得到鲸鱼的初始可行路径。

步骤s3中，根据鲸鱼捕食的特点，将鲸鱼优化算法归纳为包围锁定、气幕攻击和随机搜索三个行为。

假设存在一个[0,1]内的随机数p。当p＜0.5且|a|＜1时，鲸鱼个体处于包围锁定阶段，鲸鱼个体位置更新公式为：

其中，t为当前迭代次数，表示第i只鲸鱼在d维空间中的位置向量，表示当前时刻全局最优位置向量。

a和c称为系数向量，定义：

a＝2a'×r1-a'

c＝2×r2

其中，r1和r2为[0,1]范围内产生的随机数，a'为新的收敛因子。

当p≥0.5时，鲸鱼个体处于气幕攻击阶段，此阶段位置更新公式为：

其中，表示第i只鲸鱼和当前全局最优位置的鲸鱼之间的距离，b为常数，用于限定对数螺旋形状，l为[-1,1]之间的随机数，p为[0,1]内的随机数。

当p＜0.5且|a|≥1时，鲸鱼个体处于随机搜索阶段时，此时，位置更新公式为:

其中，表示从当前群体中随机选择的鲸鱼个体位置向量。

计算新位置个体的适应度值，通过对比新位置与原位置的适应度值，选择适应度小的作为最优个体位置，进一步确定全局最优位置。最后，选择一条适应度值最小的鲸鱼路径作为移动机器人路径规划的最优路径。

本发明的有益技术效果在于：

本发明提供了一种基于鲸鱼优化算法的移动机器人路径规划方法，通过在收敛因子中引入高斯分布函数，使得在算法初始阶段，收敛因子的值相对较大，全局搜索能力强，收敛速度快，并且容易移动到更优的位置，随着算法迭代的进行，到了算法后期，收敛因子的值相对较小，有利于算法后期的局部搜索，提高鲸鱼算法的局部开发能力，并且避免算法陷入局部最优。

附图说明

为了使本发明的目的、技术方案和有益效果更加清楚，本发明提供如下附图进行说明：

图1为本发明提供优选实施例基于鲸鱼优化算法的移动机器人路径规划方法流程图。

具体实施方式

下面将结合本发明实施例中的附图，对本发明的优选实施例进行详细的描述。

参见图1，本发明提供了一种基于鲸鱼优化算法的移动机器人路径规划方法，包括以下步骤：

s1，对鲸鱼优化算法初始化，设置算法的参数，将鲸鱼种群数设为n，最大迭代次数设为tmax。

选取的适应度函数为：

其中，xi为第i只鲸鱼的位置，n表示鲸鱼个体在搜索空间中的维度，(xn,yn)表示第n维的鲸鱼个体在栅格地图上的坐标，同理，(xn+1,,yn+1)表示第n+1维的鲸鱼个体在栅格地图上的坐标。表示鲸鱼种群的维数。

计算鲸鱼在所有位置上的适应度值，并确定鲸鱼种群初始个体最优位置与全局最优位置。

s2，利用高斯分布函数：

其中，x表示高斯分布函数的自变量，x0表示高斯分布函数的期望值，σ为标准差。

构建新的收敛因子公式为：

a'＝af+(ai-af)×f(t/tmax；0,1)

其中，ai表示收敛算子的初始值，af表示收敛算子的终值。

通过新的收敛因子a'，计算系数向量a，利用新的位置更新公式来更新鲸鱼个体新位置，得到鲸鱼的初始可行路径。

s3，根据鲸鱼捕食的特点，将鲸鱼优化算法归纳为包围锁定、气幕攻击和随机搜索三个行为。

假定有一个常数p，其为[0,1]内的随机数。若p≥0.5，算法将执行气幕攻击行为，此时鲸鱼个体位置更新公式为：

其中，表示第i只鲸鱼和当前全局最优位置的鲸鱼之间的距离，b为常数，用于限定对数螺旋形状，l为[-1,1]之间的随机数。

若p＜0.5且a的模|a|＜1，算法执行包围锁定，此时鲸鱼个体更新的位置公式为：

其中，t为当前迭代次数，表示第i只鲸鱼在d维空间中的位置向量，表示当前时刻全局最优位置向量。a和c称为系数向量，定义:

a＝2a'×r1-a'

c＝2×r2

其中，r1和r2为[0,1]范围内产生的随机数，a'为新的收敛因子。

若p＜0.5且a的模|a|≥1，算法将执行随机搜索行为，此时，鲸鱼个体更新位置公式为：

其中，表示从当前群体中随机选择的鲸鱼个体位置向量，其余参数与包围锁定行为相同。

s4，计算新位置上鲸鱼个体的适应度值，将其与原位置的适应度值进行比较，选择适应度小的作为最优个体位置，若新位置的适应度值优于原位置适应度值，则更新鲸鱼种群的个体最好位置，并且更新全局最优位置；

s5，若算法到达迭代次数后执行步骤s6，否则执行步骤s2-s4；

s6、通过鲸鱼优化算法得到的全局最优位置，选择一条适应度值最小的鲸鱼路径作为移动机器人路径规划的最优路径。

以上这些实施例应理解为仅用于说明本发明而不用于限制本发明的保护范围。在阅读了本发明的记载的内容之后，技术人员可以对本发明作各种改动或修改，这些等效变化和修饰同样落入本发明权利要求所限定的范围。