CN113485371B - 一种基于改进麻雀搜索算法的水下多auv路径规划方法 - Google Patents

一种基于改进麻雀搜索算法的水下多auv路径规划方法 Download PDF

Info

Publication number
CN113485371B
CN113485371B CN202110918390.0A CN202110918390A CN113485371B CN 113485371 B CN113485371 B CN 113485371B CN 202110918390 A CN202110918390 A CN 202110918390A CN 113485371 B CN113485371 B CN 113485371B
Authority
CN
China
Prior art keywords
sparrow
auv
path
ith
algorithm
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202110918390.0A
Other languages
English (en)
Other versions
CN113485371A (zh
Inventor
黄浩乾
金超
王冰
魏嘉颖
唐家成
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hohai University HHU
Original Assignee
Hohai University HHU
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Hohai University HHU filed Critical Hohai University HHU
Priority to CN202110918390.0A priority Critical patent/CN113485371B/zh
Publication of CN113485371A publication Critical patent/CN113485371A/zh
Application granted granted Critical
Publication of CN113485371B publication Critical patent/CN113485371B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/0206Control of position or course in two dimensions specially adapted to water vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种基于改进麻雀搜索算法的水下多机器人(AutonomousUnderwaterVehicle)AUV路径规划方法,首先,利用栅格法构建海洋环境二维地图;然后,利用粒子群算法对多AUV进行任务分配;其次,由于海洋环境复杂,AUV在水下航行时受洋流影响最大,为了充分利用洋流,本发明将速度合成法和麻雀搜索算法的适应值函数结合起来,使算法根据洋流信息和麻雀目前所处位置,综合估计出每个麻雀的适应值。在算法不断迭代后,找到具有最优适应值的解,最终完成路径规划。本发明实现了多个AUV的动态安全避障,保证每个AUV快速分配到最优的任务目标的同时,快速规划出每个AUV的无碰撞最优路径。

Description

一种基于改进麻雀搜索算法的水下多AUV路径规划方法
技术领域
本发明涉及自主水下机器人(Autonomous Underwater Vehicle,AUV)的一种路径规划方法,尤其涉及一种基于改进麻雀搜索算法的水下多AUV路径规划方法。
背景技术
AUV作为人类探测海洋的主要工具,在水下和外部环境进行交互时,能够安全避开障碍,规划出一条合理的路径对于保证水下机器人的安全是至关重要的。目前,多AUV系统相比于单AUV效率更高,使用范围更加广泛。国内外学者对于单一AUV系统有了很多研究,然而针对多AUV系统的研究仍然是一项挑战。
目前,水下机器人的路径规划在二维环境研究中众多,如典型的A*算法,蚁群算法(Ant Colony Algorithm,ACO),人工势场法(Artificial Potential Field Method,APF)等,但都有着各自的缺陷,比如A*算法在处理大规模地图时运算速度慢,蚁群算法前期收敛速度慢,人工势场法容易陷入局部最优,而且不适用于多AUV的路径规划。
粒子群算法(Particle Swarm Optimization,PSO)和麻雀搜索算法(SparrowSearch Algorithm,SSA),作为新型的智能优化技术,在解决优化问题上有了很成熟的应用。两种算法都具有参数简单、搜索速度快的优点,然而麻雀搜索算法相比于粒子群算法,收敛速度更快,能够适用复杂的海洋环境。粒子群算法在解决优化问题方面有着很好的收敛性。
而如何通过具体的方法来在对每个AUV快速分配到最优的任务目标的同时,又快速地规划出每个AUV的无碰撞最优路径,成为亟需解决的技术问题。
发明内容
发明目的:对于AUV在复杂海洋环境下工作时容易受到海流影响,并且考虑到AUV的动力消耗;以及针对多AUV和多目标的情况,为了规划出多AUV的最优路径,本发明提出了一种基于改进麻雀搜索算法的水下多AUV路径规划方法,首先将粒子群算法用于多AUV的任务分配,然后改进的麻雀搜索算法用于多AUV的路径规划问题,在保证每个AUV快速分配到最优的任务目标的同时,快速地规划出每个AUV的无碰撞最优先路径。
技术方案:本发明基于改进麻雀搜索算法的水下多AUV路径规划方法包括以下步骤:
(1)利用栅格法构建海洋环境二维地图,对水下机器人AUV的工作环境进行单元分割;
(2)针对多机器人多目标,利用粒子群算法对每个水下机器人进行任务分配;具体步骤如下:
(2.1)通过粒子群算法搜索粒子的最佳位置,每个粒子看作D维搜索空间的一个搜索个体,将粒子的速度Vid更新为公式(1),粒子的位置Xid更新为公式(2):
V′id=ωVid+C1r1(Pid-Xid)+C2r2(Pgd-Xid)           (1)
X′id=Xid+V′id                       (2)
其中,ω为惯性因子,ω的值为非负,较大时全局寻优能力强;较小时,局部寻优能力强;C1和C2为学习因子,均为常数;r1和r2是[0,1]随机数,Pid为个体最优解,Pgd为全局最优解;V′id为更新后的粒子速度;X′id为更新后的粒子位置;
(2.2)根据目标与AUV之间的距离和AUV到达目标的理想时间得出粒子群的适应值函数;
(2.3)采用粒子群算法根据式(1)和(2)不断更新,寻找最优解,在迭代完成后,输出每个水下机器人和目标的匹配情况,完成任务分配;
(3)采用基于速度合成法并融合洋流的改进麻雀搜索算法进行多AUV的路径规划,具体过程如下:
(3.1)在洋流速度已知的情况下,通过调节AUV的速度和方向并利用洋流来进行路径规划,此时水下机器人AUV期望的速度VE为公式(4):
Figure BDA0003206475420000021
α1为Vc和x轴之间的夹角;α2为VE和x轴之间的夹角;α3为VA和x轴之间的夹角;Vc为洋流速度矢量;
根据公式(4),以及水下机器人AUV与该AUV对应的目标之间的欧式距离构建了改进麻雀搜索算法的适应值函数F(i)如公式(5):
F(i)=d(i)·0.5+d(i)/VE+C·100             (5)
其中,d(i)为粒子生成路径的总长度,如公式(6)所示;C为穿过障碍物的惩罚系数;
Figure BDA0003206475420000022
D为麻雀的维度,D也代表AUV在路径规划中生成的中间路径点;xid为当前麻雀在二维地图中横坐标的值,yid为当前麻雀在二维地图中纵坐标的值,xid-1表示第i只麻雀搜索路径的第d-1个路径点的横坐标,yid-1表示第i只麻雀搜索路径的第d-1个路径点的纵坐标;
(3.2)设置麻雀种群规模为M,迭代次数为T,发现者个数为M*0.2,预警者个数为Sd,搜索空间为D维,针对k个AUV,每个AUV分配D/k个维度的搜索空间;
(3.3)假设有M只麻雀在D维搜索空间中,则第i只麻雀在D维空间的位置Xi为公式(8),适应值Fi为公式(9):
Xi=[xi1,...,xij,...,xMD]                     (8)
Fi=f[x1,...,x2,...,xM];                     (9)
其中,xi1代表第i只麻雀在第1维的位置,xij代表第i只麻雀在第j维的位置,xMD代表第i只麻雀在第j维的位置;x1代表第1只麻雀,x2代表第2只麻雀,xM代表第M只麻雀;
(3.4)根据麻雀的适应值大小进行排序,选取适应值最佳的麻雀作为发现者去发现地图中的更优位置并为加入者提供优化的方向;其中,发现者的更新公式为(10):
Figure BDA0003206475420000031
Figure BDA0003206475420000032
代表在第t+1次迭代时第i个麻雀在第j维的位置;
Figure BDA0003206475420000033
代表第t次迭代时第i个麻雀在第j维的位置;a代表0~1的随机数,Q代表0和1之间的随机数;t代表当前迭代数,Tmax为最大迭代次数;R2为预警值,ST为安全值;L是一个1*D的矩阵,矩阵中的每个元素都为1;
当R2<ST时,表明此时的搜索空间没有遇到捕食者,发现者搜索最优位置;当R2≥ST时,表明有麻雀遭遇到了捕食者,并向整个麻雀种群中其他麻雀发出危险警告;
(3.5)加入者根据发现者发现的更优位置,不断更新自己的位置;加入者的位置更新公式为(11):
Figure BDA0003206475420000034
Figure BDA0003206475420000035
代表截止t+1次迭代时麻雀发现的最佳位置,A+代表A+=AT(AAT)-1,其中,AT表示A的转置矩阵;A为一个1*D的矩阵;
Figure BDA0003206475420000041
表示第i只麻雀在第t次迭代时的位置,j表示解的维数;Xworst为目前发现者所发现的全局最差的位置;
(3.6)预警者是意识到危险的麻雀,预警者的位置更新公式为如下:
Figure BDA0003206475420000042
其中,β为均值等于0,方差为1服从正态分布的随机数;K为-1和1之间的随机数,fi为第i个麻雀的适应度,fg为第i个麻雀的当前最佳适应值,a是一个避免分母等于零的情况的常数;K为麻雀移动的方向同时也是步长控制参数;fw表示当前麻雀的最差适应值;
Figure BDA0003206475420000043
代表第t次迭代时所有麻雀发现的最佳位置,表示这个位置的麻雀是种群中最佳位置;
Figure BDA0003206475420000044
代表第t+1迭代时所有麻雀发现的最佳位置。
其中,步骤(1.1)中,对水下机器人AUV的工作环境进行单元分割,并区分出障碍物和自由区域。
步骤(2.2)中的适应值函数Fitness(i)公式如下:
Fitness(i)=d(i)·0.5+d(i)/VE              (3)
其中,i表示第i个粒子,d(i)表示第i个粒子生成的路径长度;VE表示AUV期望的速度,d(i)/VE表示AUV到达目标的理想时间。
步骤(3)中,将麻雀搜索到的最小适应值所对应的位置作为最佳位置,并根据不同AUV和不同目标规划出多条最优路径。
步骤(3.1)中,C为穿过障碍物的惩罚系数,C如公式(7)所示:
Figure BDA0003206475420000045
当麻雀组成的路径穿过障碍物时,E为大于其他粒子适应值的正常数;而当路径没有穿过障碍物时,C为0。
步骤(3.4)中,根据麻雀的适应值大小进行排序,选取适应度最佳的前10~20个麻雀作为发现者去发现地图中的更优位置并为加入者提供优化的方向。
步骤(3.5)中,矩阵A中的每个元素值随机赋值1或-1。
步骤(3.5)中,当i>n/2时,适应度低的第i个加入者麻雀搜索其他地方获得更高的适应度。
步骤(3.6)中,当fi>fg,表明此时的麻雀处于整个种群的边缘,受到捕食者的威胁。
步骤(3.6)中,当fi=fg时,表明处于种群中间的麻雀发现了威胁,前往其他位置来避免危险。
有益效果:与现有技术相比,本发明具有以下优点:
(1)本发明首先利用栅格法构建了二维地图,通过对水下机器人AUV的工作环境进行单元分割,能够很好地储存环境信息,利于算法的运行;
(2)粒子群算法收敛速度快,精度高,本发明利用粒子群优化算法进行多AUV的任务分配,能够保证每个AUV快速分配到最优的任务目标。
(3)实际情况下,海洋中存在着海流的影响,AUV的路径规划受海流影响最大,本发明利用速度合成法调整AUV的速度和方向,来抵消洋流的负影响,并通过麻雀搜索算法的适应值函数,使AUV在运行时充分利用洋流,节约了AUV的能量,即通过采用结合速度合成法的麻雀搜索算法在路径规划时保证AUV充分利用洋流,减少不必要的能源消耗。
(4)改进的麻雀搜索算法收敛速度快,参数设置少,在多AUV和多目标的情况下,利用该改进的麻雀搜索算法来进行多AUV的路径规划,实现多AUV的动态安全避障,保证每个AUV完成任务,且快速规划出每个AUV的无碰撞最优路径。
附图说明
图1为本发明基于改进麻雀搜索算法的水下多AUV路径规划方法的流程图;
图2为本发明基于栅格法的二维地图;
图3为本发明速度合成法示意图;
图4为本发明基于改进麻雀算法的多AUV路径规划图。
具体实施方式
实施例:
如图1所示,本发明基于改进麻雀搜索算法的水下多AUV路径规划方法,首先利用栅格法进行二维环境建模,即利用栅格法构建海洋环境二维地图;并运用粒子群算法进行多AUV和多目标的任务分配。由于海洋环境复杂,AUV在水下航行时受洋流影响大,因此考虑到洋流对AUV的影响,本发明提出结合速度合成法的适应值函数并将该适应值函数运用到改进麻雀算法中;使算法根据洋流信息和麻雀目前所处位置,综合估计出每个麻雀的适应值。在算法不断迭代后,找到具有最优适应值的解,然后进行多AUV的路径规划。
本实施例中,基于改进麻雀搜索算法的水下多AUV路径规划方法具体包括以下步骤:
(1)利用栅格法构建海洋环境二维地图,对水下机器人AUV工作环境进行单元分割,用相同大小的方块表示出来。如图2所示,黑色方块表示障碍物,白色区域表示自由区域。
图2中,1号指1号水下机器人AUV,2号指2号水下机器人AUV,3号指3号水下机器人AUV。
(2)针对多机器人多目标,利用粒子群算法对每个水下机器人进行任务分配,即进行多AUV的任务分配,以本实施例中的3个水下机器人AUV为例,目标是得到3个AUV的准确位置,采用粒子群算法,该算法产生多个粒子,多个粒子在该算法作用下优化出最终的3个水下机器人AUV位置,具体步骤如下:
①粒子群算法模仿鸟类的活动,随机搜寻该粒子群算法中粒子的最佳位置,每个粒子看作D维搜索空间的一个搜索个体,粒子具备2种属性:粒子的速度Vid和粒子的位置Xid,该粒子的速度Vid更新公式为(1),粒子的位置Xid的更新公式为(2):
V′id=ωVid+C1r1(Pid-Xid)+C2r2(Pgd-Xid)           (1)
X′id=Xid+V′id                       (2)
其中,ω为惯性因子,ω的值为非负,较大时全局寻优能力强;较小时,局部寻优能力强。C1和C2为学习因子,均为常数。r1和r2是[0,1]随机数,Pid为个体最优解,Pgd为全局最优解;Vi'd为更新后的粒子速度;Xi'd为更新后的粒子位置。
②根据目标与AUV之间的距离和AUV到达目标的理想时间得出粒子群的适应值函数,其适应值函数Fitness(i)公式如下:
Fitness(i)=d(i)·0.5+d(i)/VE             (3)
其中,i表示第i个粒子,d(i)表示第i个粒子生成的路径长度;VE表示AUV期望的速度,d(i)/VE表示AUV到达目标的理想时间。
在上面的步骤①中,将多个AUV的坐标和多个目标的坐标作为粒子群算法的输入,以图2为例,输入3个AUV的坐标和3个目标的坐标,通过粒子群算法得到3个水下机器人AUV的位置最优解,即每个AUV找到3个目标中的最优目标。
如公式(3)所述,粒子群算法的适应值函数的值越大,表示AUV到达目标的代价越大,则当前AUV需要更换目标,反之,适应值越小,AUV和当前目标越匹配。
③将粒子群算法的迭代次数设为100,种群大小为60,维度D为3。采用粒子群算法根据式(1)和(2)不断更新,在迭代更新完成后,输出1号水下机器人AUV和目标3的匹配情况,2号水下机器人AUV和目标1的匹配情况,3号水下机器人AUV和目标2的匹配情况,完成任务分配。
(3)采用基于速度合成法并融合洋流的改进麻雀搜索算法进行多AUV的路径规划,具体过程如下:
①考虑到复杂海洋环境的洋流,AUV在路径规划时受洋流影响比较大,本文结合了速度合成法对粒子的状态进行评估。如图3所示,Vc为洋流速度矢量,VA为AUV的速度矢量,VE是期望的AUV速度矢量。VE的方向由水下机器人AUV指向目标点。Vcn为洋流在VE上的垂直分量,Van为水下机器人在VE上的垂直分量。当Vcn和Van互相抵消时,洋流的副作用就被抵消了,在洋流速度已知的情况下,通过调节AUV的速度和方向就能充分利用洋流来进行路径规划。此时水下机器人AUV期望的速度为公式(4)。
Figure BDA0003206475420000071
α1为Vc和x轴之间的夹角;α2为VE和x轴之间的夹角;α3为VA和x轴之间的夹角。
根据公式(4),以及水下机器人AUV与该AUV对应的目标之间的欧式距离构建了改进麻雀搜索算法的适应值函数。适应值公式如(5)式。
F(i)=d(i)·0.5+d(i)/VE+C·100             (5)
其中d(i)为粒子生成路径的总长度,如公式(6)所示;C为穿过障碍物的惩罚系数,如公式(7)所示;该公式(5)综合考虑了洋流和障碍物,使AUV不仅能避开障碍物还能充分利用洋流来节约能耗。
如公式(6)所示,d(i)为粒子生成的路径总长度,D为麻雀的维度,D也代表AUV在路径规划中生成的中间路径点,D的值也决定了路径段的数量,该路径段表示AUV起始点和目标点之间组成总路径的若干小段。xid为当前麻雀在二维地图中横坐标的值,yid为当前麻雀在二维地图中纵坐标的值;xid-1表示第i只麻雀搜索路径的第d-1个路径点的横坐标,yid-1表示第i只麻雀搜索路径的第d-1个路径点的纵坐标。
采用麻雀算法进行路径规划的思路为,每条路径由若干小段组成,比如a,b,c…n,而每小段最优,则最终的合路径最优。
Figure BDA0003206475420000072
Figure BDA0003206475420000073
其中,C为惩罚系数,该C的公式为式(7)。当麻雀组成的路径穿过障碍物时,E为远远大于其他粒子适应值的正常数;而当路径没有穿过障碍物时,C为0,因此式(7)保证生成的路径不会穿过障碍物,保证了AUV在向目标运动时避开障碍物。
②设置麻雀种群规模为M,迭代次数为T,发现者个数为M*0.2,预警者个数为Sd,搜索空间为D维,针对k个AUV,每个AUV分配D/k个维度的搜索空间。
③假设有M只麻雀在D维搜索空间中,则第i只麻雀在D维空间的位置Xi为公式(8),适应值Fi为公式(9):
Xi=[xi1,...,xij,...,xMD]                      (8)
Fi=f[x1,...,x2,...,xM];                      (9)
其中,xi1代表第i只麻雀在第1维的位置,xij代表第i只麻雀在第j维的位置,xMD代表第i只麻雀在第j维的位置;x1代表第1只麻雀,x2代表第2只麻雀,xM代表第M只麻雀。
④根据麻雀的适应值大小进行排序,选取适应度最佳的前20个麻雀作为发现者去发现地图中的更优位置并为加入者提供优化的方向。可以理解为,麻雀即AUV,通过不断搜索路径,最终寻找到最优的一条路径。其中,发现者的更新公式为(10):
Figure BDA0003206475420000081
Figure BDA0003206475420000082
代表在第t+1次迭代时第i个麻雀在第j维的位置;
Figure BDA0003206475420000083
代表第t次迭代时第i个麻雀在第j维的位置;a代表0~1的随机数,Q代表0和1之间的随机数;t代表当前迭代数,Tmax为最大迭代次数。R2为预警值,ST为安全值。该预警值表示麻雀发现危险的一个临界值,安全值表示此时麻雀处于安全状态。L是一个1*D的矩阵,其中每个元素都为1。
当R2<ST时,表明此时的搜索空间没有遇到捕食者,发现者自由的搜索最优位置。然而当R2≥ST时,表明有麻雀遭遇到了捕食者,并向整个麻雀种群中其他麻雀发出危险警告。
⑤加入者不断的加入发现者的阵营,加入者根据发现者发现的更优的位置,不断更新自己的位置。加入者的位置更新公式为(11):
Figure BDA0003206475420000091
Figure BDA0003206475420000092
代表截止第t+1次迭代时麻雀发现的最佳位置,A+代表A+=AT(AAT)-1,其中,AT表示A的转置矩阵;A为一个1*D的矩阵。
Figure BDA0003206475420000093
表示第i只麻雀在第t次迭代时的位置,j表示解的维数。
可以理解为,
Figure BDA0003206475420000094
为目前发现者所发现的全局最优位置,Xworst为目前发现者所发现的全局最差的位置,其中矩阵A中的每个元素值随机赋值1或-1。当i>n/2时,适应度低的第i个加入者麻雀需要搜索其他地方获得更高的适应度。
⑥预警者发现当前周围的威胁,并提醒麻雀群避免危险。预警者是意识到危险的麻雀。预警者的位置更新公式为下式:
Figure BDA0003206475420000095
其中,β为均值等于0,方差为1服从正态分布的随机数;K为-1和1之间的随机数,fi为第i个麻雀的适应度,fg为第i个麻雀的当前最佳适应值,a是一个避免分母等于零的情况的常数。K为麻雀移动的方向同时也是步长控制参数。fw表示当前麻雀的最差适应值。
当fi>fg表明此时的麻雀正处于整个种群的边缘,很容易受到捕食者的威胁。而当fi=fg时,表明处于种群中间的麻雀发现了威胁,需要前往其他位置来避免危险。
Figure BDA0003206475420000096
代表第t次迭代时所有麻雀发现的最佳位置,表示这个位置的麻雀是种群中最佳位置同时也非常安全。
Figure BDA0003206475420000097
代表第t+1迭代时所有麻雀发现的最佳位置。
针对多AUV和多目标的系统,为了得到更精确的搜索解,即解的维数越高,解越精确,故而采用提出的改进麻雀算法,本实施例中,如图2所示,以3个AUV和3个目标点为例,每个AUV分配5维解,利用5维解搜索对应的最优目标,因此D=3个*5维/个=15。当采用麻雀搜索算法迭代时,根据粒子群算法任务分配的AUV和目标点,计算各自AUV的适应值,根据3个AUV适应值,寻找15维最优解,然后每个AUV根据该15维解,最终完成路径规划,如图4所示。

Claims (1)

1.一种基于改进麻雀搜索算法的水下多AUV路径规划方法,其特征在于:包括以下步骤:
(1)利用栅格法构建海洋环境二维地图,对水下机器人AUV的工作环境进行单元分割;并区分出障碍物和自由区域;
(2)针对多机器人多目标,利用粒子群算法对每个水下机器人进行任务分配;具体步骤如下:
(2.1)通过粒子群算法搜索粒子的最佳位置,每个粒子看作D维搜索空间的一个搜索个体,将粒子的速度Vid更新为公式(1),粒子的位置Xid更新为公式(2):
V′id=ωVid+C1r1(Pid-Xid)+C2r2(Pgd-Xid)   (1)
X′id=Xid+V′id   (2)
其中,ω为惯性因子,ω的值为非负,较大时全局寻优能力强;较小时,局部寻优能力强;C1和C2为学习因子,均为常数;r1和r2是[0,1]随机数,Pid为个体最优解,Pgd为全局最优解;V′id为更新后的粒子速度;X′id为更新后的粒子位置;
(2.2)根据目标与AUV之间的距离和AUV到达目标的理想时间得出粒子群的适应值函数;
所述适应值函数Fitness(i)公式如下:
Fitness(i)=d(i)·0.5+d(i)/VE    (3)
其中,i表示第i个粒子,d(i)表示第i个粒子生成的路径长度;VE表示AUV期望的速度,d(i)/VE表示AUV到达目标的理想时间;
(2.3)采用粒子群算法根据式(1)和(2)不断更新,寻找最优解,在迭代完成后,输出每个水下机器人和目标的匹配情况,完成任务分配;
(3)采用基于速度合成法并融合洋流的改进麻雀搜索算法进行多AUV的路径规划,具体过程如下:
(3.1)在洋流速度已知的情况下,通过调节AUV的速度和方向并利用洋流来进行路径规划,此时水下机器人AUV期望的速度VE为公式(4):
α1为Vc和x轴之间的夹角;α2为VE和x轴之间的夹角;α3为VA和x轴之间的夹角;Vc为洋流速度矢量;
根据公式(4),以及水下机器人AUV与该AUV对应的目标之间的欧式距离构建了改进麻雀搜索算法的适应值函数F(i)如公式(5):
F(i)=d(i)·0.5+d(i)/VE+C·100    (5)
其中,d(i)为粒子生成路径的总长度,如公式(6)所示;C为穿过障碍物的惩罚系数;C如公式(7)所示:
当麻雀组成的路径穿过障碍物时,E为大于其他粒子适应值的正常数;而当路径没有穿过障碍物时,C为0;
D为麻雀的维度,D也代表AUV在路径规划中生成的中间路径点;xid为当前麻雀在二维地图中横坐标的值,yid为当前麻雀在二维地图中纵坐标的值,xid-1表示第i只麻雀搜索路径的第d-1个路径点的横坐标,yid-1表示第i只麻雀搜索路径的第d-1个路径点的纵坐标;
(3.2)设置麻雀种群规模为M,迭代次数为T,发现者个数为M*0.2,预警者个数为Sd,搜索空间为D维,针对k个AUV,每个AUV分配D/k个维度的搜索空间;
(3.3)假设有M只麻雀在D维搜索空间中,则第i只麻雀在D维空间的位置Xi为公式(8),适应值Fi为公式(9):
Xi=[xi1,...,xij,...,xMD]    (8)
Fi=f[x1,...,x2,...,xM];    (9)
其中,xi1代表第i只麻雀在第1维的位置,xij代表第i只麻雀在第j维的位置,xMD代表第M只麻雀在第D维的位置;x1代表第1只麻雀,x2代表第2只麻雀,xM代表第M只麻雀;
(3.4)根据麻雀的适应值大小进行排序,选取适应值最佳的麻雀作为发现者去发现地图中的更优位置并为加入者提供优化的方向;其中,发现者的更新公式为(10):
代表在第t+1次迭代时第i个麻雀在第j维的位置;代表第t次迭代时第i个麻雀在第j维的位置;a代表0~1的随机数,Q代表0和1之间的随机数;t代表当前迭代数,Tmax为最大迭代次数;R2为预警值,ST为安全值;L是一个1*D的矩阵,矩阵中的每个元素都为1;
当R2<ST时,表明此时的搜索空间没有遇到捕食者,发现者搜索最优位置;当R2≥ST时,表明有麻雀遭遇到了捕食者,并向整个麻雀种群中其他麻雀发出危险警告;
(3.5)加入者根据发现者发现的更优位置,不断更新自己的位置;加入者的位置更新公式为(11):
代表截止t+1次迭代时麻雀发现的最佳位置,A+代表A+=AT(AAT)-1,其中,AT表示A的转置矩阵;A为一个1*D的矩阵;表示第i只麻雀在第t次迭代时的位置,j表示解的维数;Xworst为目前发现者所发现的全局最差的位置;
(3.6)预警者是意识到危险的麻雀,预警者的位置更新公式为如下:
其中,β为均值等于0,方差为1服从正态分布的随机数;K为-1和1之间的随机数,fi为第i个麻雀的适应度,fg为第i个麻雀的当前最佳适应值,a是一个避免分母等于零的情况的常数;K为麻雀移动的方向同时也是步长控制参数;fw表示当前麻雀的最差适应值;代表第t次迭代时所有麻雀发现的最佳位置,表示这个位置的麻雀是种群中最佳位置;代表第t+1迭代时所有麻雀发现的最佳位置;
当fi>fg,表明此时的麻雀处于整个种群的边缘,受到捕食者的威胁;
当fi=fg时,表明处于种群中间的麻雀发现了威胁,前往其他位置来避免危险。
CN202110918390.0A 2021-08-11 2021-08-11 一种基于改进麻雀搜索算法的水下多auv路径规划方法 Active CN113485371B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110918390.0A CN113485371B (zh) 2021-08-11 2021-08-11 一种基于改进麻雀搜索算法的水下多auv路径规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110918390.0A CN113485371B (zh) 2021-08-11 2021-08-11 一种基于改进麻雀搜索算法的水下多auv路径规划方法

Publications (2)

Publication Number Publication Date
CN113485371A CN113485371A (zh) 2021-10-08
CN113485371B true CN113485371B (zh) 2023-04-25

Family

ID=77944842

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110918390.0A Active CN113485371B (zh) 2021-08-11 2021-08-11 一种基于改进麻雀搜索算法的水下多auv路径规划方法

Country Status (1)

Country Link
CN (1) CN113485371B (zh)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113190037A (zh) * 2021-04-08 2021-07-30 上海吞山智能科技有限公司 基于改进流体扰动和麻雀算法的无人机最优路径搜索方法
CN114189887B (zh) * 2021-11-23 2023-08-08 西安电子科技大学 基于改进麻雀搜索算法优化移动自组网网络路由的方法
CN114167880A (zh) * 2021-12-02 2022-03-11 大连海事大学 一种基于时间最优的多水下滑翔机路径规划系统
CN114460941B (zh) * 2022-02-09 2023-10-24 云南大学 一种基于改进麻雀搜索算法的机器人路径规划方法及系统
CN115373409B (zh) * 2022-08-02 2023-05-30 哈尔滨工程大学 一种复杂环境下水下机器人协同捕捞海生物的路径规划方法
CN115855226B (zh) * 2023-02-24 2023-05-30 青岛科技大学 基于dqn和矩阵补全的多auv协同水下数据采集方法

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110222885B (zh) * 2019-05-24 2020-07-07 合肥工业大学 无人系统中智能体自主路径规划的优化方法和系统
CN112461247B (zh) * 2020-12-16 2023-05-23 广州大学 一种基于自适应麻雀搜索算法的机器人路径规划方法
CN112990419A (zh) * 2021-03-19 2021-06-18 浙江科技学院 基于改进麻雀搜索算法的优化方法
CN113190026B (zh) * 2021-05-10 2022-06-28 河海大学 一种基于再励机制粒子群算法的节能型水下路径规划方法

Also Published As

Publication number Publication date
CN113485371A (zh) 2021-10-08

Similar Documents

Publication Publication Date Title
CN113485371B (zh) 一种基于改进麻雀搜索算法的水下多auv路径规划方法
Zhu et al. Complete coverage path planning of autonomous underwater vehicle based on GBNN algorithm
Zhu et al. Task assignment and path planning of a multi-AUV system based on a Glasius bio-inspired self-organising map algorithm
CN110632931A (zh) 动态环境下基于深度强化学习的移动机器人避碰规划方法
CN112925315A (zh) 一种基于改进蚁群算法和a*算法的履带车路径规划方法
CN108919818B (zh) 基于混沌种群变异pio的航天器姿态轨道协同规划方法
CN115143970B (zh) 一种基于威胁度评估的水下航行器避障方法和系统
CN112733251B (zh) 一种多无人飞行器协同航迹规划方法
Li et al. A behavior-based mobile robot navigation method with deep reinforcement learning
Polycarpou et al. Cooperative control of distributed multi-agent systems
CN112666981A (zh) 基于原鸽群动态群组学习的无人机集群动态航路规划方法
Biswas et al. A particle swarm optimization based path planning method for autonomous systems in unknown terrain
Yang et al. A knowledge based GA for path planning of multiple mobile robots in dynamic environments
Abaas et al. Autonomous mobile robot navigation based on PSO algorithm with inertia weight variants for optimal path planning
CN108445894A (zh) 一种考虑无人艇运动性能的二次路径规划方法
CN108227718B (zh) 一种自适应切换的自动搬运小车路径规划方法
Wang et al. Research on autonomous planning method based on improved quantum Particle Swarm Optimization for Autonomous Underwater Vehicle
Chaudhary et al. Obstacle avoidance of a point-mass robot using feedforward neural network
Liu et al. The Path Planning Study of Autonomous Patrol Robot based on Modified Astar Algorithm and Genetic Algorithm
Liu et al. UUV path planning method based on QPSO
Farooq et al. A low cost microcontroller implementation of neural network based hurdle avoidance controller for a car-like robot
Li et al. Vision-based obstacle avoidance algorithm for mobile robot
Li et al. End-to-end autonomous exploration for mobile robots in unknown environments through deep reinforcement learning
Qin et al. A path planning algorithm based on deep reinforcement learning for mobile robots in unknown environment
Zhang et al. Research on complete coverage path planning for unmanned surface vessel

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant