一种采用人工鱼群模型的机器人路径规划方法

1.本发明属于机器人应用技术领域，具体涉及一种采用人工鱼群模型的机器人路径规划方法。


背景技术：

2.机器人路径规划是指在满足一定的物理约束条件下，为机器人完成设定任务和动作所设计的运动序列安排。可以通过人工鱼群原理实现机器人路径规划。基本人工鱼群算法中参数固定，导致出现人工鱼视野和步长过大或过小两种可能，参数鲁棒性极差。当人工鱼视野和步长过大时，算法前期在聚群行为和追尾行为的作用下人工鱼能快速向最优解邻域聚集，算法后期，人工鱼出现觅食障碍，产生振荡现象，优化精度较低。当视野和步长设置过小时，人工鱼的觅食行为占据主导，移动速度较慢，人工鱼搜索区域较小，会出现无法全局收敛，陷入局部最优的现象。算法后期，人工鱼可能在局部最优区域反复搜索，导致被局部最优干扰。人工鱼视野过大或过小，都会对寻优效果造成影响，出现收敛速度和解的精度不能兼顾的矛盾。
3.现有的一种采用自适应函数对人工鱼的视野和步长进行衰减的改进人工鱼群原理，由于没有进行人工鱼视野和步长自适应定量控制，人工鱼视野和步长变化区间不能根据优化对象的特点进行事先设定，优化过程中不能精确控制人工鱼视野和步长变化，参数变化受迭代次数影响较大,优化结果存在陷入局部最优的可能，导致算法早熟，不能定量分析人工鱼视野和步长对算法性能的影响。对机器人路径规划的准确性有一定影响。


技术实现要素：

4.为了克服上述现有技术存在的不足，本发明提供了一种采用人工鱼群模型的机器人路径规划方法。
5.为了实现上述目的，本发明提供如下技术方案：
6.一种采用人工鱼群模型的机器人路径规划方法，包括以下步骤：
7.根据机器人运动的起点位置、终点位置和运动范围，建立二维坐标系；
8.在二维坐标系内以y轴为基准，均匀划分多条平行线，在每条平行线上取一点作为初始参考点；
9.依据二维坐标系建立人工鱼群模型，设置人工鱼群模型中的区间控制函数f()、迭代次数的最大值max_gen和初始值，迭代区间控制函数f()控制人工鱼的视野和人工鱼的步长；
10.将每个初始参考点的纵坐标作为每条人工鱼的初始参数，执行觅食、追尾和聚群行为，计算所述觅食、追尾和聚群行为的适应度，根据适应度控制人工鱼移动，根据每条人工鱼实时的纵坐标改变每条人工鱼的参数；
11.以所有人工鱼的横坐标和纵坐标为依据，确定多个路径参考点，依次连接多个路径参考点获得机器人运动路径，以机器人运动路径的长度为评价依据，将机器人运动路径
长度最短的运动路径作为机器人运动的最终路径。
12.优选的，所述区间控制函数f()控制人工鱼的视野和人工鱼的步长的具体步骤包括：
13.给人工鱼的视野和步长赋相同的初始值initial；
14.各条人工鱼分别执行觅食、追尾、聚群和随机行为，比较各种行为执行后的适应度，执行最高适应度对应的行为；
15.在最高适应度对应的行为下，直至人工鱼个体适应度满足公告牌更新条件，将该条件下人工鱼的视野和步长作为最终人工鱼的视野和步长adap；否则重复对人工鱼的视野和步长的操作。
16.优选的，
17.所述区间控制函数f()每次迭代后的函数值均小于迭代前的函数值。
18.优选的，所述最终人工鱼的视野和步长adap的确定包括：：
19.利用下式计算人工的鱼视野和人工鱼的步长的终值adap，
20.adap＝initial*f(iter)
21.其中，iter为当前的迭代次数。
22.优选的，
23.所述区间控制函数f()为幂函数型区间控制函数，
24.f(iter)＝k*iterb25.式中，
26.k＝max_y
[0027][0028]
幂函数型区间控制函数的具体表达式如下，
[0029][0030]
其中，iter为当前的迭代次数；max_y为所述区间控制函数f()初次迭代后的函数值；min_y为所述区间控制函数f()在当前的迭代次数下最后一次迭代后的函数值。
[0031]
优选的，
[0032]
所述区间控制函数f()为线性函数型区间控制函数，
[0033]
f(iter)＝k*iter b
[0034]
式中，
[0035][0036][0037]
线性函数型区间控制函数的具体表达式如下，
[0038][0039]
其中，iter为当前的迭代次数；max_y为所述区间控制函数f()初次迭代后的函数值；min_y为所述区间控制函数f()在当前的迭代次数下最后一次迭代后的函数值。
[0040]
优选的，
[0041]
所述区间控制函数f()为指数函数型区间控制函数，
[0042]
f(iter)＝k*b
iter
[0043]
式中，
[0044][0045][0046]
指数函数型区间控制函数的具体表达式如下，
[0047][0048]
其中，iter为当前的迭代次数；max_y为所述区间控制函数f()初次迭代后的函数值；min_y为所述区间控制函数f()在当前的迭代次数下最后一次迭代后的函数值。
[0049]
优选的，依据下式获得机器人运动路径长度：
[0050][0051]
式中，
[0052]
xi＝xs i*(x
t-xs)
[0053]
式中，(xs,ys)为机器人运动的起点坐标，(x
t
,y
t
)为机器人运动的终点坐标，yi为第i条人工鱼的纵坐标，(xi,yi)为第i个路径参考点的二维坐标。
[0054]
优选的，还包括：
[0055]
在人工鱼移动过程中，每移动一次，对人工鱼二维坐标进行检测，若超出二维坐标系的运动范围，则令该人工鱼二维坐标为运动范围的边界值。
[0056]
优选的，还包括：
[0057]
将二维坐标系内的区域划分为可移动区域和不可移动区域；
[0058]
在人工鱼移动过程中，每移动一次，对人工鱼二维坐标进行检测，直至任意相邻的两条人工鱼的二维坐标的连线位于可移动区域内，否则，重复更新人工鱼的位置。
[0059]
本发明提供的采用人工鱼群模型的机器人路径规划方法具有以下有益效果：本发明通过对人工鱼视野和步长的变化区间进行设置，限定整个算法执行过程中人工鱼视野和步长的变化范围，且不受算法迭代次数的影响，实现了人工鱼视野和步长在可调区间内按照设定的精确变化范围进行改进，提高了机器人路径规划的精确度。
附图说明
[0060]
为了更清楚地说明本发明实施例及其设计方案，下面将对本实施例所需的附图作简单地介绍。下面描述中的附图仅仅是本发明的部分实施例，对于本领域普通技术人员来说，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
[0061]
图1为本发明实施例1的采用人工鱼群模型的机器人路径规划方法的结构示意图；
[0062]
图2为本发明实施例1的对区间控制函数进行迭代的方法流程图；
[0063]
图3为本发明实施例1的具体路线规划示意图；
[0064]
图4为本发明实施例1的采用基本鱼群算法规划的机器人路径的示意图；
[0065]
图5为本发明实施例1的规划的机器人路径的示意图。
具体实施方式
[0066]
为了使本领域技术人员更好的理解本发明的技术方案并能予以实施，下面结合附图和具体实施例对本发明进行详细说明。以下实施例仅用于更加清楚地说明本发明的技术方案，而不能以此来限制本发明的保护范围。
[0067]
在本发明的描述中，需要理解的是，术语“中心”、“纵向”、“横向”、“长度”、“宽度”、“厚度”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”、“轴向”、“径向”、“周向”等指示的方位或位置关系为基于附图所示的方位或位置关系，仅是为了便于描述本发明的技术方案和简化描述，而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作，因此不能理解为对本发明的限制。
[0068]
此外，术语“第一”、“第二”等仅用于描述目的，而不能理解为指示或暗示相对重要性。在本发明的描述中，需要说明的是，除非另有明确的规定或限定，术语“相连”、“连接”应作广义理解，例如，可以是固定连接，也可以是可拆卸连接，或一体式连接；可以是机械连接，也可以是电连接；可以是直接相连，也可以是通过中间媒介间接相连。对于本领域的普通技术人员而言，可以根据具体情况理解上述术语在本发明中的具体含义。在本发明的描述中，除非另有说明，“多个”的含义是两个或两个以上，在此不再详述。
[0069]
实施例1
[0070]
本发明提供了一种采用人工鱼群模型的机器人路径规划方法，具体如图1所示，包括以下步骤：根据机器人运动的起点位置、终点位置和运动范围，建立二维坐标系；在二维坐标系内以y轴为基准，均匀划分多条平行线，在每条平行线上取一点作为初始参考点；依据二维坐标系建立人工鱼群模型，设置人工鱼群模型中的区间控制函数f()、迭代次数的最大值max_gen和初始值，迭代区间控制函数f()控制人工鱼的视野和人工鱼的步长；将每个初始参考点的纵坐标作为每条人工鱼的初始参数，执行觅食、追尾和聚群行为，计算觅食、追尾和聚群行为的适应度，根据适应度控制人工鱼移动，根据每条人工鱼实时的纵坐标改变每条人工鱼的参数；以所有人工鱼的横坐标和纵坐标为依据，确定多个路径参考点，依次连接多个路径参考点获得机器人运动路径，以机器人运动路径的长度为评价依据，将机器人运动路径长度最短的运动路径作为机器人运动的最终路径。
[0071]
参阅图2，在本实施例中，区间控制函数f()控制人工鱼的视野和人工鱼的步长的具体步骤包括：给人工鱼的视野和步长赋相同的初始值initial；各条人工鱼分别执行觅食、追尾、聚群和随机行为，比较各种行为执行后的适应度，执行最高适应度对应的行为；在
最高适应度对应的行为下，直至人工鱼个体适应度满足公告牌更新条件，将该条件下人工鱼的视野和步长作为最终人工鱼的视野和步长adap；否则重复对人工鱼的视野和步长的操作。区间控制函数f()每次迭代后的函数值均小于迭代前的函数值。
[0072]
具体的，最终人工鱼的视野和步长adap的确定包括：利用下式计算人工的鱼视野和人工鱼的步长的终值adap，
[0073]
adap＝initial*f(iter)
[0074]
其中，iter为当前的迭代次数。
[0075]
在本实施例中，区间控制函数f()为幂函数型区间控制函数，
[0076]
f(iter)＝k*iterb[0077]
式中，
[0078]
k＝max_y
[0079][0080]
幂函数型区间控制函数的具体表达式如下，
[0081][0082]
其中，iter为当前的迭代次数；max_y为区间控制函数f()初次迭代后的函数值；min_y为区间控制函数f()在当前的迭代次数下最后一次迭代后的函数值。
[0083]
具体的，依据下式获得机器人运动路径长度：
[0084][0085]
式中，
[0086]
xi＝xs i*(x
t-xs)
[0087]
式中，(xs,ys)为机器人运动的起点坐标，(x
t
,y
t
)为机器人运动的终点坐标，yi为第i条人工鱼的纵坐标，(xi,yi)为第i个路径参考点的二维坐标。
[0088]
为了使机器人实现避障功能。在人工鱼移动过程中，每移动一次，对人工鱼二维坐标进行检测，若超出二维坐标系的运动范围，则令该人工鱼二维坐标为运动范围的边界值。同时，将二维坐标系内的区域划分为可移动区域和不可移动区域；在人工鱼移动过程中，每移动一次，对人工鱼二维坐标进行检测，直至任意相邻的两条人工鱼的二维坐标的连线位于可移动区域内，否则，重复更新人工鱼的位置。
[0089]
参阅图3，在本实施例中，将不可移动区域通过凸多边形和圆形进行表示。对于多边形障碍而言，首先判断多边形各个顶点与该段路径两个端点的横坐标之间的关系。处于路径端点横坐标之外的多边形顶点，则对路径无影响。在路径端点横坐标之间的多边形顶点，若是分布在该段路径的同侧，则对路径也无影响。当多边形顶点分布在路径两侧时，说明该段路径与不可移动区域有重合，该路径不可行，须调整参考点位置。设第i个中心为(x
ri
,y
ri
)的不可移动区域与第j个参考点(xj,yj)满足：
则可满足参考点在可移动区域内。其中
△
为可设定安全距离裕量，机器人被抽象成移动质点，设定一定的裕量保证机器人行走路径与不可移动区域有一定的安全距离。当参考点均处于可移动区域内，路径连线仍可能有部分处于不可移动区域内。当参考点均在安全区域内时，对起点、参考点和终点两个相邻点之间的路径连线，若任意不可移动区域中心到该连线的垂足不在该连线上，则该段路径必不经过该不可移动区域内。若垂足处于该段路径内，对第j段路径上的垂足(x
dj
,y
dj
)满足：即可满足该段路径在可移动区域内。
[0090]
下面通过具体的数据比较说明本技术的优越性。在本实例中，机器人路径优化区域为100
×
100，起点s(10,10)，终点t(100,100)，鱼群规模n＝20，最大迭代次数max_gen＝250，人工鱼个体视野为20，移动步长为5，觅食尝试次数为100，拥挤度因子为0.618，采用基本鱼群算法和区间可调的鱼群算法对路径模型进行规划研究，分别运算25次。
[0091]
表1基本人工鱼群原理与本技术的结果对比表
[0092][0093]
参阅图4和图5，基本鱼群算法规划的路径距离较长，路径不够平滑，因为基本鱼群算法存在精度不足的缺陷。区间可调的人工鱼群原理在算法后期进行了精细化搜索，得到了距离更短，更为平滑的路径。区间可调的人工鱼群原理强化了局部细致搜索，得到的路径距离更短，人工鱼进行寻优的效率更高。
[0094]
实施例2
[0095]
在本实施例中，区间控制函数f()为线性函数型区间控制函数，
[0096]
f(iter)＝k*iter b
[0097]
式中，
[0098][0099][0100]
线性函数型区间控制函数的具体表达式如下，
[0101]
[0102]
其中，iter为当前的迭代次数；max_y为区间控制函数f()初次迭代后的函数值；min_y为区间控制函数f()在当前的迭代次数下最后一次迭代后的函数值。
[0103]
其余内容与实施例1相同，不再赘述。
[0104]
实施例3
[0105]
在本实施例中，区间控制函数f()为指数函数型区间控制函数，
[0106]
f(iter)＝k*b
iter
[0107]
式中，
[0108][0109][0110]
指数函数型区间控制函数的具体表达式如下，
[0111][0112]
其中，iter为当前的迭代次数；max_y为区间控制函数f()初次迭代后的函数值；min_y为区间控制函数f()在当前的迭代次数下最后一次迭代后的函数值。
[0113]
其余内容与实施例1相同，不再赘述。
[0114]
以上实施例仅为本发明较佳的具体实施方式，本发明的保护范围不限于此，任何熟悉本领域的技术人员在本发明披露的技术范围内，可显而易见地得到的技术方案的简单变化或等效替换，均属于本发明的保护范围。