舰船科学技术  2025, Vol. 47 Issue (19): 99-106    DOI: 10.3404/j.issn.1672-7649.2025.19.016   PDF    
基于改进HHO融合DWA算法的无人船动态路径规划
王孝帅, 孙昱浩, 宫荣宝     
山东交通学院 航运学院,山东 威海 264209
摘要: 针对无人船在动态环境下的路径规划问题,提出一种改进哈里斯鹰优化算法(IHHO)混合动态窗口算法(DWA)的融合算法(IHHO-DWA)。首先,针对哈里斯鹰算法收敛精度低和易陷入局部最优等问题,对哈里斯鹰算法进行混沌初始化改进,增加种群生成的离散度,避免算法过早陷入局部最优;引入高斯变异机制对哈里斯鹰最优个体进行变异扰动,提高算法开发能力。其次,引入动态窗口算法提高无人船在动态环境下规划路径的平滑度,将全局规划路径信息融入局部避障算法中,兼顾实时避障与规划安全最优路径。最后,在不同复杂度环境下进行对比仿真实验,实验结果表明,所提方法兼顾安全避障与路径最优,更有利于无人船的航行。
关键词: 路径规划     哈里斯鹰优化算法     混沌初始化     高斯变异     动态窗口算法    
Dynamic path planning for unmanned boats based on improved HHO algorithm integrated with DWA
WANG Xiaoshuai, SUN Yuhao, GONG Rongbao     
School of Shipping, Shandong Jiaotong University, Weihai 264209, China
Abstract: To address the path planning challenge for unmanned vessels in dynamic environments, a novel fusion algorithm (IHHO-DWA), which combines the improved Harris Hawk optimization algorithm (IHHO) with the dynamic window algorithm (DWA), is introduced. Initially, the Harris Hawk algorithm is enhanced with chaotic initialization to increase population diversity and prevent early convergence to suboptimal solutions. Gaussian mutation is also applied to the algorithm’s best individuals, boosting its solution exploration capabilities. Furthermore, the integration of the dynamic window algorithm smoothens path planning in dynamic environments by merging global path planning data with local obstacle avoidance strategies, ensuring both real-time safety and optimal route planning. Comparative simulations in environments of varying complexity demonstrate that this method effectively balances safety and route optimization, significantly benefiting the navigation of unmanned vessels.
Key words: path planning     harris hawk optimization algorithm     chaotic initialization     gaussian mutatin     dynamic window algorithm    
0 引 言

无人船(Unmanned Surface Vehicle,USV)以其经济安全、智能航行等优点在事故救援等作业中发挥着重要作用[1]。规划出安全、高效的救援路径是无人船开展作业的重要保障。

由无人船对周围环境信息的了解程度,路径规划整体可分为全局与局部路径规划。其中,全局路径规划算法包括A*算法[2]和群智能优化算法[3]等;局部路径规划算法包括动态窗口法(Dynamic Window Approach,DWA)[4]、人工势场法[5]等。传统路径规划算法在解决复杂问题时往往由于庞大的计算量和时间跨度等不能满足实际的规划需求,而基于群智能优化的路径规划算法很大程度上弥补了这一不足[6],主流的群智能优化算法有:遗传算法(Genetic Algorithm,GA)[7]、粒子群算法(Particle Swarm Optimization,PSO)[8]、灰狼优化算法(Grey Wolf Optimizer,GWO)[9]等。

Heidari等[10]受哈里斯鹰种群化捕猎行为的启发于2019年提出了群智能优化算法哈里斯鹰优化算法(Harris Hawks Optimization,HHO),该算法模拟了哈里斯鹰通过群体合作探索与多策略围攻猎物的捕食行为,具有参数少、稳定性强、组成简单以及寻优速度快等优点,但原始算法仍不可避免地在处理复杂问题时陷入局部最优和收敛精度不高的问题。张林等[11]引入信噪比判断个体位置信息,设计协调学习策略更合理地更新种群个体位置;胡春安等[12]引入混沌局部搜索与精英备选池策略多策略改进哈里斯鹰优化算法;Li等[13]引入反向学习与螺旋探索等策略提升算法的全局探索能力,提高了规划效率和路径质量。上述改进极大地提高了哈里斯鹰算法的寻优能力和全局路径规划能力,但针对无人船局部路径规划与实时避障问题仍不能妥善解决,对此一些学者提出了相应的改进策略。Fu等[14]提出了多行为融合改进的势场方法,通过激活条件确定无人船的目标需求、边界记忆跟随和动态避障3种行为模式;Eduardo等[15]将动态障碍树法融入DWA算法中提高了算法的性能,并结合动态曲率速度法与预测曲率速度法提高了路径的安全性;魏立新等[16]提出融合改进的动态路径规划算法,为解决蚁群算法(Ant Colony Algorithm,ACA)死锁问题引入蚁群搜索接力方式,之后融合DWA算法进行局部避障。

本文为兼顾全局路径的最优与局部动态避障的问题,提出一种改进HHO算法混合DWA算法的动态路径规划算法。

1 改进HHO算法 1.1 HHO算法

HHO算法是由哈里斯鹰在不同情况下的群体捕猎行为抽象演化而成的群智能优化算法,该算法的数学模型由探索阶段、过渡阶段和开发阶段组成。

1.1.1 探索阶段

该阶段哈里斯鹰位置随机分布,在狩猎区域内广泛地探索观察猎物,如下式:

$ X\left(t+1\right)=\left\{\begin{array}{l}{X}_{\text{rand}}\left(t\right)-{r}_{1}\left|{X}_{\text{rand}}\left(t\right)-2{r}_{2}X\left(t\right)\right|,\\ q \geqslant 0.5,\\ {X}_{\text{rabbit}}\left(t\right)-{X}_{m}\left(t\right)-\\ {r}_{3}\left(LB+{r}_{4}\left(UB-LB\right),q < 0.5,\right.\end{array}\right. $ (1)
$ {X}_{m}\left(t\right)=\dfrac{1}{N}\displaystyle\sum _{i=1}^{N} {X}_{i}\left(t\right)。$ (2)

式中:$ X\left(t+1\right) $为哈里斯鹰个体在$ t+1 $次迭代时的位置;$ {X}_{{\mathrm{rand}}}\left(t\right) $为随机个体位置;$ {r}_{1}\sim {r}_{4} $$ q $为区间在$ \left(\mathrm{0,1}\right) $内的随机数;$ {X}_{\rm{rabbit}}\left(t\right) $为第$ t $次迭代时猎物的位置;$ LB $$ UB $为搜索空间的上下界;$ {X}_{m}\left(t\right) $为种群位置的平均值;$ N $为种群数。

1.1.2 过渡阶段

HHO算法在围猎行为下会根据猎物的逃逸能量变化改变搜索行为,猎物逃避过程中能量不断递减,哈里斯鹰进行探索阶段到开发阶段的转换:

$ E={2E}_{0}\left(1-\dfrac{t}{T}\right)。$ (3)

式中:$ E $为猎物的逃逸能量;$ {E}_{0} $为初始逃逸能量;$ T $为最大迭代次数。当$ \left|E\right|\geqslant 1 $时,执行探索阶段;当$ \left|E\right| < 1 $时,执行开发阶段。

1.1.3 开发阶段

该阶段哈里斯鹰会根据逃逸能量$ E $和随机数$ r $判定位置更新策略,其中$ r $为猎物的逃跑概率。哈里斯鹰以4种策略展开围猎。

策略1 软围攻

$ r\geqslant 0.5 $$ \left|E\right|\geqslant 0.5 $时,哈里斯鹰对猎物进行软包围借以消耗猎物体力。公式如下:

$ X\left(t+1\right)={X}_{\rm{rabbit}}\left(t\right)-X\left(t\right)- E\left|J\cdot {X}_{\rm{rabbit}}\left(t\right)-X\left(t\right)\right|, $ (4)
$ J=2\left(1-{{r}}_{5}\right),{{r}}_{5}\in \left(\mathrm{0,1}\right)。$ (5)

式中:$ J $为逃窜过程中猎物的随机跳跃强度。

策略2 硬围攻

$ r\geqslant 0.5 $$ \left|E\right| < 0.5 $时,哈里斯鹰采取硬包围策略并准备进行最后的突袭。公式如下:

$ X\left(t+1\right)={X}_{\text{rabbit}}\left(t\right)-E\left|{X}_{\text{rabbit}}\left(t\right)-X\left(t\right)\right|。$ (6)

策略3 渐进式俯冲软围攻

$ r < 0.5 $$ \left|E\right|\geqslant 0.5 $时,哈里斯鹰采取更智能的渐进式俯冲软围攻策略,压缩猎物的生存空间。公式如下:

$ Y={X}_{\text{rabbit}}\left(t\right)-E\left|J\cdot {X}_{\text{rabbit}\text{}}\left(t\right)-X\left(t\right)\right|,$ (7)
$ Z=Y+S\cdot LF\left(D\right),$ (8)
$ LF\left(D\right)=0.01\times \dfrac{u\times {\left(\dfrac{\mathrm{\Gamma }\left(1+\beta \right)\times \sin \left(\dfrac{{\text{π}} \beta }{2}\right)}{\mathrm{\Gamma }\left(\dfrac{1+\beta }{2}\right)\times \beta \times {2}^{\left(\tfrac{\beta -1}{2}\right)}}\right)}^{{1}/{\beta }}}{|v{|}^{{1}/{\beta }}},$ (9)
$ X\left(t+1\right)=\left\{\begin{array}{c}Y,F\left(Y\right) < F\left(X\right(t\left)\right),\\ Z,F\left(Z\right) < F\left(X\right(t\left)\right)。\end{array}\right. $ (10)

式中:$ Y $为软围攻后的更新位置;$ D $为所求问题的维度;$ S $$ D $维上随机行向量;$ Z $为Levy飞行扰动的更新位置;$ LF\left(D\right) $为Levy飞行公式;$ u $$ v $为区间$ \left[\mathrm{0,1}\right] $上的随机数;$ \beta $是值为$ 1.5 $的默认常数。

策略4 渐进式俯冲硬围攻

$ r < 0.5 $$ \left|E\right| < 0.5 $时,哈里斯鹰采取渐进式俯冲硬围攻的方式对猎物展开突袭。公式如下:

$ Y={X}_{\text{rabbit}}\left(t\right)-E\left|J\cdot {X}_{\text{rabbit}\text{}}\left(t\right)-{X}_{m}\left(t\right)\right|,$ (11)
$ Z=Y+S\cdot LF\left(D\right)。$ (12)
1.2 HHO算法的改进 1.2.1 混沌初始化策略

原始HHO算法在求解复杂问题时,以随机生成的方式初始化种群的个体位置,无法确保种群的多样性,可能会导致算法对问题的寻优速度较慢和“早熟”现象的发生。为了让算法在开始寻优时有较高的全局搜索能力,针对HHO算法进行混沌初始化改进,在算法初始化阶段引入混沌映射,借助其较强的随机性和遍历性,增强种群生成的离散度,提高局部搜索策略的有效性,进一步降低过早陷入局部最优的可能性。

引入非线性Logistic混沌映射(虫口映射)进行种群初始化,使混沌映射取代常规均匀分布的随机数来提高原算法的适应度函数,在特殊参数下混沌序列呈现为无序、概率和遍历状态,公式如下:

$ s_{t+1}=u\cdot {s}_{t}\left(1-{s}_{t}\right)。$ (13)

式中:$ {s}_{t}\in \left(\mathrm{0,1}\right) $为算法在第$ t $次迭代时的混沌轨道状态值;$ u\in \left[\mathrm{0,4}\right] $为控制参数,$ u $的值越大混沌性越高,序列在$ u=4 $且混沌轨道状态初始值s0$\notin ${0.25,0.5,0.75}时,处于完全混沌状态,显著增强搜索的多样性。图1为处于特殊值下的随机序列和混沌状态的混沌序列。

图 1 混沌映射图 Fig. 1 Chaotic mapping diagram

在已知$ LB $$ UB $$ T $$ N $参数下,随机生成1个分量在$ \left(\mathrm{0,1}\right) $间的$ D $维向量$ {s}_{0} $,经Logistic映射生成$ n $个衍生向量,即围猎猎物附近的多个邻域解,从而得到混沌化之后的新种群:

$ \overline{{s}}={X}_{\rm{rabbit}}\left(t\right)+R\left(2{s}-1\right)。$ (14)

$ {s} $的每个分量映射到对应以哈里斯鹰围猎猎物为中心以$ R $为半径的取值区间上,为混沌化变量$ \overline{{s}}$赋值。

1.2.2 高斯变异策略

高斯变异策略以服从正态分布的随机数作用于原位置向量借以更新位置。变异算子分布在当前位置周围及外围分别进行邻域探索和远距离勘探,有利于算法摆脱局部最优陷阱,不仅能够提高算法优化精度,也能增强种群的多样性。高斯变异公式如下:

$G\left(x\right)=\dfrac{1}{\sqrt{2{\text{π}} }\sigma }\mathrm{exp}\left(-\dfrac{(x-\mu )^{2}}{2{\sigma }^{2}}\right)。$ (15)

式中:$ \mu $为分布均值;$ \sigma $为标准差;$ {\sigma }^{2} $为方差。

运用高斯变异演化机制,随机选取哈里斯鹰位置和维度进行变异扰动,其主要步骤如下:

步骤1 确定变异概率。设置变异阈值$ Vt $,判断当前哈里斯鹰个体是否处于需要变异的状态,公式如下:

$Vt=\dfrac{t}{T}+0.5。$ (16)

式中:$ t $为当前迭代次数;$ T $为哈里斯鹰最大迭代次数;$ 0.5 $为多次实验后得到的经验值,用于平衡种群的探索稳定性。

步骤2 随机决策过程。判断$ rand $随机数与变异阈值$ Vt $之间的大小关系,$ Vt $较小则进行变异处理,反之则继续常规迭代流程。$ rand $随机数的取值如下:

$ rand > \left(1-\dfrac{t}{T}\right)。$ (17)

步骤3 计算变异过程。由分布均值$ \mu $和方差$ {\sigma }^{2} $生成服从正态分布的新值,公式如下:

$ x\left({X}_{\text{rand}}\left(t\right),d\right)=x\left({X}_{\text{rand}}\left(t\right),d\right)\times \text{G}\text{a}\text{u}\text{s}\text{s}\text{i}\text{a}\text{n}\left(\mu ,{\sigma }^{2}\right)。$ (18)

式中:$ {X}_{{\mathrm{rand}}}\left(t\right) $为哈里斯鹰随机个体位置,$ d $为变异扰动维度,新值和原始位置之间处于稍微偏离或较大跳跃的摇摆位,避免陷入局部最优。

步骤4 位置更新过程。在变异扰动后对哈里斯鹰进行位置更新,使种群的解发生变化,在保持局部优势的同时增加探索未知区域的可能性,提高算法的整体性能和全局优化效果,向最优解的方向进化。

2 改进HHO算法与DWA算法的融合 2.1 无人船运动模型

图2为无人船在进行局部路径规划时的二维运动模型,坐标系采用北东地坐标系,x指向地面正北,y指向地面正东,U标识无人船,UX为无人船当前航向。图中标识分别为动态、静态障碍物,为方便计算将探索区域内的障碍物进行外接方形的膨胀处理。

图 2 无人船二维运动模型 Fig. 2 2D motion model of USV

无人船在$ t $时刻的位置信息可以用向量$ {u}= [x_t,y_t, \theta _t] $表示,$ {x}_{t} $$ {y}_{t} $分别为无人船的纵轴、横轴坐标,$ {\theta }_{t} $为无人船的航向角,此时$ {v}_{t} $为无人船的线速度,$ {\omega }_{t} $为无人船的角速度。假设无人船在周期时间$ \Delta t $内运动轨迹是一条直线,则下一周期时间无人船运动距离即$ {v}_{t}\cdot \Delta t $,对应计算无人船的位置信息及角速度等位姿信息的公式如下:

$ \left\{\begin{array}{l}{x}_{t+1}={x}_{t}+{V}_{t}\cdot \Delta t\cdot \cos{\theta }_{t},\\ {y}_{t+1}={y}_{t}+{V}_{t}\cdot \Delta t\cdot \sin{\theta }_{t},\end{array}\right. $ (19)
$ {\theta }_{t+1}={\theta }_{t}+{\omega }_{t}\cdot \Delta. t $ (20)
2.2 DWA算法

由上述无人船运动模型,可根据无人船的线速度、角速度模拟其运动轨迹。因无人船自身的物理结构和运动学特性及作业环境等对无人船实际运动过程中存在着速度约束,所以DWA算法需要生成动态窗口选择性的对速度矢量空间进行采样,通过采集到的可行速度集合模拟生成若干条轨迹,根据评价函数对预测轨迹进行评分,选择最优速度驱动无人船安全快速地到达目标点。

2.2.1 速度空间采样

约束1 无人船在运动过程中其速度空间取值的最大范围$ {V}_{o} $

$ {V}_{o}=\left\{\left(v,\omega \right)\mid v\in \left[{v}_{{\mathrm{min}}},{v}_{{\mathrm{max}}}\right],\omega \in \left[{\omega }_{\text{min}},{\omega }_{\text{max}}\right]\right\}。$ (21)

式中:$ {v}_{{\mathrm{min}}} $$ {v}_{{\mathrm{max}}} $$ {\omega }_{{\mathrm{min}}} $$ {\omega }_{{\mathrm{max}}} $分别为无人船的最小、最大角速度和无人船的最小、最大线速度。

约束2 无人船的加减速度变化存在限制,即无人船实际运动中能达到的速度范围$ {V}_{p} $

$ \begin{split}{V}_{p}=&\left\{\left(v,\omega \right)\mid v\in \left[{v}_{n}-{\dot{v}}_{m}\cdot \mathrm{\Delta }t,{v}_{n}+{\dot{v}}_{a}\cdot \mathrm{\Delta }t\right],\right.\\ &\left.w\in \left[{\omega }_{n}-{\dot{\omega }}_{m}\cdot \mathrm{\Delta }t,{\omega }_{n}+{\dot{\omega }}_{a}\cdot \mathrm{\Delta }t\right]\right\}。\end{split} $ (22)

式中:$ {v}_{n} $$ {\omega }_{n} $分别为当前无人船的线速度、角速度;$ {\dot{v}}_{m} $$ {\dot{\omega }}_{m} $$ {\dot{v}}_{a} $$ {\dot{\omega }}_{a} $分别为无人船线速度与角速度的最大减速度和最大加速度。

约束3 无人船在作业中的安全避障制动距离,即DWA算法的可容许速度集合$ {V}_{q} $

$ \begin{split}{V}_{q}=&\left\{\left(v,\omega \right)\mid v\leqslant \sqrt{2\cdot {D}\left(v,\omega \right)\cdot {\dot{v}}_{m}}\right.,\\ &\left.\omega \leqslant \sqrt{2\cdot {D}\left(v,\omega \right)\cdot {\dot{\omega }}_{m}}\right\}。\end{split}$ (23)

式中:$ D\left(v,\omega \right) $为速度与$ \left(v,\omega \right) $对应的预测轨迹上无人船与障碍物之间的最小距离。

综上所述,设$ {V}_{r} $为DWA动态窗口的速度采样空间,则应满足以上3个约束,即:

${V}_{r}={V}_{o}\cap {V}_{p}\cap {V}_{q}。$ (24)

获取到的速度采样空间结合无人船运动模型可生成若干条预测轨迹,如图3所示。

图 3 采样轨迹图 Fig. 3 Sampling pathway chart
2.2.2 轨迹评价函数

获取到的无人船预测轨迹由评价函数评分后,选定评分最高的轨迹对应的采样速度作为无人船下一阶段的最优速度加以执行。

$ \begin{split}G(v,\omega )=&\sigma \left(\alpha \cdot heading\left(v,\omega \right)+\right.\\ &\beta \cdot dist(v,\omega )+\gamma \cdot vel(v,\omega ))。\end{split} $ (25)

评价函数如式(25)所示,方位角函数$ heading\left(v,\omega \right) $为轨迹终点与目标点之间的方位角偏差;障碍物距离函数$ dist(v,\omega ) $为轨迹终点与最近障碍物之间的距离偏差;速度函数$ vel(v,\omega ) $为无人船的运行速度,$ \alpha $$ \beta $$ \gamma $分别为其权重,$ \sigma $为归一化函数,公式如下:

$ \left\{\begin{split}&{\sigma }_{heading}=\dfrac{{heading}\left(i\right)}{\displaystyle\sum _{i=1}^{n}{heading}\left(i\right)},\\ &{\sigma }_{dist}=\dfrac{{dist}\left(i\right)}{\displaystyle\sum _{i=1}^{n}dist\left(i\right)},\\ &{\sigma }_{vel}=\dfrac{vel\left(i\right)}{\displaystyle\sum _{i=1}^{n}vel\left(i\right)}。\end{split} \right.$ (26)

式中:$ i $为当前评价轨迹的序列号,$ n $为预测周期内的轨迹数量。

2.3 融合算法设计

以改进HHO算法即IHHO(Improvement Harris Hawks Optimization,IHHO)算法规划全局路径可以为无人船到达目标位置提供前提条件,但其路径欠缺平滑度且无法及时地对无人船作业环境中的动态障碍物进行实时避障;DWA算法作为局部路径规划在考虑无人船相关动力学约束的同时能够进行动态避障,但没有静态算法引导,在复杂环境下极易陷入局部最优。

因此,需要将IHHO与DWA相融合,由IHHO算法规划由起始点到目标点的最优路径在全局层面上寻求最优解,借助DWA算法在局部层面上进行实时的动态避障,并在该部分引入评价子函数$ guide\left(v,\omega \right) $,其权重为$ \delta $,目的是加强IHHO规划出的全局路径对无人船避障的导向作用,通过关键引导点将全局最优路径作为引导路径引导DWA规划的路径与全局最优路径相拟合,在安全避障的同时缩短路径长度与规划速度。引入的评价子函数公式为:

$ guide\left(v,\omega \right)=\dfrac{1}{\sqrt{{\left({x}_{i}-x\right)}^{2}+{\left({y}_{i}-y\right)}^{2}}}。$ (27)

式中:$ \left(x,y\right) $为预测轨迹末端位置;$ \left({x}_{i},{y}_{i}\right) $为当前时刻IHHO最优路径引导点位置。其值越大说明无人船越靠近最优位置,对应的评分越高进而被优先选择并执行。更新的DWA评价函数如下:

$ \begin{split}G(v,\omega )=&\sigma (\alpha \cdot heading\left(v,\omega \right)+ \beta \cdot dist\left(v,\omega \right)+\\ &\gamma \cdot vel\left(v,\omega \right)+ \delta \cdot guide\left(v,\omega \right))。\end{split} $ (28)

融合算法(以下简称IHHO-DWA)策略如下:

步骤1 根据无人船作业空间搭建环境模型,初始化环境位置坐标及算法参数和无人船参数设置;

步骤2 在搜索空间内对IHHO进行Logistics混沌映射初始化种群;

步骤3 计算种群适应度值,并将最优个体位置设置为猎物位置;

步骤4 采用IHHO四种不同围捕策略对种群位置进行更新并执行高斯变异操作,寻找最优的适应度值和猎物位置;

步骤5 在最大迭代次数内对算法进行循环,直到算法迭代次数停止,此时得到的最优解即为最优路径,最优解的适应度值即为最优路径长度;

步骤6 通过静态算法IHHO得到最优路径的局部目标引导点,引导DWA进行局部路径规划;

步骤7 判断无人船是否达到局部目标点,若到达则将选择下一个全局最优路径的分段点作为局部目标点;

步骤8 通过判断局部目标点是否为全局目标终点,到达则算法结束,否则继续执行局部路径规划。

IHHO-DWA算法流程如图4所示。

图 4 算法流程图 Fig. 4 Algorithmic process diagram
3 仿真实验分析

实验环境:操作系统为Windows 11(64bit),处理器为13th Gen Intel(R)Core(TM) i7-13650HX 2.60 GHz,RAM 32 GB,仿真平台为Matlab 2021b。

为充分验证IHHO-DWA算法的性能,本文设置了2组实验:

1) IHHO全局路径规划实验。设置3个不同的实验环境,通过对比仿真验证IHHO算法在不同环境下具有较好的规划路径性能;

2) IHHO-DWA融合算法实验。在静态和动态环境下分别对融合算法性能进行验证。

3.1 全局路径规划实验

无人船的作业环境通常位于障碍物并不密集的海面,可采用静态障碍物模拟雷达等设备检测到的浅滩、礁石等障碍物,同时为了避免算法的偶然性,将实验环境分为环境1、2、3,分别为50×100、100×100、100×100的不同环境不同复杂度的静态栅格地图中,实验中种群规模为30,最大迭代次数为500,环境1起终点为(50,0)和(49,99),环境2、3起终点为(1,1)和(99,99),设置IHHO算法的对照组算法为GA、PSO,仿真结果如图5所示。

图 5 全局路径规划结果 Fig. 5 Global path planning outcomes

表1仿真结果比较可以看出,在环境1中,IHHO算法规划路径长度相较于GA算法路径减少了32.9%,相较于PSO算法路径减少了28%;在环境2中,IHHO算法规划路径长度相较于GA算法路径减少了15%,相较于PSO算法路径减少了9.4%;在环境3中,IHHO算法规划路径长度相较于GA算法路径减少了18.1%,相较于PSO算法路径减少了9.9%,且在3种环境下IHHO算法运行时间皆最短,证明IHHO算法具有较好的搜索性能。此外,从图5可以看出在不同环境下IHHO算法规划出的路线更为平滑,没有较多路径冗余,且算法收敛速度表现优异。实验结果表明改进的IHHO算法在全局路径规划上有较好的稳定性和优越性。

表 1 各算法仿真结果比较 Tab.1 Comparing simulation results of algorithms
3.2 融合算法动态规划实验

上文验证了IHHO算法在全局路径规划中的性能,证明改进算法的性能得到了显著提升。为了进一步验证IHHO-DWA融合算法的性能,设置算法对照组为GA-DWA、PSO-DWA两种算法,在上述3种环境中进行仿真实验,设置无人船的状态参数及评价函数权重如表2所示。

表 2 仿真参数表 Tab.2 Simulation parameter sheet
3.2.1 融合算法在静态环境中的仿真实验

图6所示,实线部分为实时避障路径,虚线部分为GA、PSO、IHHO预设的全局最优路径。在只有静态障碍物的各环境中,算法行进到某一目标点后,将局部目标替换为下一个全局目标点,最终各算法都到达了全局目标终点。其中IHHO-DWA算法很好地完成了静态避障任务,且相较GA-DWA和PSO-DWA,IHHO-DWA规划的路径平滑度更高。

图 6 融合算法静态路径规划结果 Fig. 6 Integrated algorithm for static path planning
3.2.2 融合算法在动态环境中的仿真实验

上文对IHHO-DWA算法在静态环境中的性能进行仿真,结果显示其搜索性能和避障性能都得到了优化。结合无人船作业环境,为进一步验证融合算法在动态环境中的避障性能,在上述仿真环境的基础上加入以一定频率移动的2个动态障碍物,以灰色方块的形式模拟航行船只等,结合全局路径规划中的静态障碍物进行仿真,测试IHHO-DWA算法的动态避障能力。

图7图9为动态环境下各算法路径规划结果。为了便于观察启用DWA算法后融合算法实时避障的过程和无人船行进过程中的角速度变化,各环境下各算法路径规划结果中序列号为Ⅰ、Ⅱ、Ⅲ的分别为其俯视图、侧视图与角速度变化曲线图。

图 7 环境1各算法路径规划结果 Fig. 7 Path planning of algorithms in environment 1

图 8 环境2各算法路径规划结果 Fig. 8 Path planning of algorithms in environment 2

图 9 环境3各算法路径规划结果 Fig. 9 Path planning of algorithms in environment 3

图7可以看出,在IHHO-DWA算法中,无人船在较为靠近动态障碍物时,会及时地采取避障措施绕开动态障碍物,对自身航向进行适当的调整,并在成功完成避障任务后马上回归到IHHO预设的最优路径上来。虽然各算法都成功完成了避障任务并顺利到达了目标点,但从图7中规划路径及角速度变化曲线不难看出,IHHO-DWA算法规划的路径较GA-DWA、PSO-DWA更为平滑,角速度波动幅度更低,驱动无人船行进更为平稳。从表3的数据对比也可以看出,在最优路径和算法运行时间上,IHHO-DWA算法的性能最优。

表 3 融合算法仿真结果比较 Tab.3 Comparing simulation results of fusion algorithms

综上所述,本文提出的IHHO-DWA算法在不同范围不同复杂度的环境中,兼顾了全局最优路径与局部规划动态避障,验证了该算法的可行性和优越性。

4 结 语

本文对HHO算法进行混沌初始化,在算法初始化阶段引入混沌映射,在位置更新阶段引入高斯变异操作,避免算法陷入局部最优并保持种群的多样性。仿真实验证明IHHO算法相较于GA算法和PSO算法表现更优。为了提高算法在局部路径规划时的动态避障能力,本文将IHHO算法与DWA算法相融合,融合算法在静态地图和动态地图中在路径长度和平滑度、运行速度等方面都展现出了优于对照组算法的性能。实验证明,本文所提出的融合算法IHHO-DWA具备路径规划有效性和可行性,能够满足无人船全路最优路径和局部动态避障的需求。

参考文献
[1]
TEIXEIRA A P, GUEDES SOARES C. Risk of maritime traffic in coastal waters[C]//International Conference on Offshore Mechanics and Arctic Engineering, 2018.
[2]
OUYANG Q, FAN Y X, ZHANG X L, et al. Improved A* path planning method based on the grid map[J/OL]. Sensors, (2022-08-18) [2024-02-02].
[3]
CHEN L M, MA M L, SUN L X. Heuristic swarm intelligent optimization algorithm for path planning of agricultural product logistics distribution[J]. Journal of Intelligent and Fuzzy Systems, 2019, 37(4): 4697-4703. DOI:10.3233/JIFS-179304
[4]
FOX D, BURGARD W, THRUN S. The dynamic window approach to collision avoidance[J]. IEEE Robotics and Automation Magazine, 1997, 4(1): 23-33. DOI:10.1109/100.580977
[5]
SUDHAKARA P, GANAPATHY V, PRIYADHARSHINI B, et al. Obstacle avoidance and navigation planning of a wheeled mobile robot using amended artificial potential field method[J]. Procedia Computer Science, 2018, 133: 998-1004. DOI:10.1016/j.procs.2018.07.076
[6]
刘祥, 叶晓明, 王泉斌, 等. 无人水面艇局部路径规划算法研究综述[J]. 中国舰船研究, 2021, 16(S1): 1-10.
[7]
DENNING P J. The science of computing: Genetic algorithms[J]. American Scientist, 1992, 80(1): 12-14.
[8]
Kennedy J. Particle swarm optimization[C]//Proceeding of IEEE International Conference, Neural Networks, Perth, Australia, 2011.
[9]
MIRJALILI S, MIRJALILI S M, LEWIS A. Grey wolf optimizer[J]. Advances in Engineering Software, 2014, 69: 46-61. DOI:10.1016/j.advengsoft.2013.12.007
[10]
HEIDARI A A, MIRJALILI S, FARIS H, et al. Harris hawks optimization: algorithm and applications[J]. Future Generation Computer Systems, 2019, 97: 849-872. DOI:10.1016/j.future.2019.02.028
[11]
张林, 沈佳颖, 胡传陆, 等. 基于信噪比的学习型哈里斯鹰算法[J/OL]. 北京航空航天大学学报, 1−17 [2024-10-18].
[12]
胡春安, 熊昱然. 多策略改进的混沌哈里斯鹰优化算法[J]. 计算机工程与科学, 2023, 45(9): 1648-1660. DOI:10.3969/j.issn.1007-130X.2023.09.014
[13]
LI C Y, LI J, CHEN H L, et al. Enhanced harris hawks optimization with multi-strategy for global optimization tasks[J]. Expert Systems with Applications, 2021, 185: 115499. DOI:10.1016/j.eswa.2021.115499
[14]
FU M Y, WANG S S, WANG Y H. Multi-behavior fusion based potential field method for path planning of unmanned surface vessel[J]. China Ocean Engineering, 2019, 33(5): 583-592. DOI:10.1007/s13344-019-0056-y
[15]
MOLINOS E J, LLAMAZARES A, OCAÑA M. Dynamic window based approaches for avoiding obstacles in moving[J]. Robotics and Autonomous Systems, 2019, 118: 112-130. DOI:10.1016/j.robot.2019.05.003
[16]
魏立新, 张钰锟, 孙浩, 等. 基于改进蚁群和DWA算法的机器人动态路径规划[J]. 控制与决策, 2022, 37(9): 2211-2216.