2. 东南大学 土木工程学院,江苏 南京 210000
2. School of Civil Engineering, Southeast University, Nanjing 210000, China
无人船能在人力不可为的条件下实现水面和水下目标侦察与监视等任务[1],是当前水面智能体的典型代表,受到各界普遍关注。在复杂工作环境下,航行路径规划是无人船正常工作的基础与保障[2]。
王立鹏等[3]在研究舰船路径规划问题过程中,以海图为基础,确定航线与陆地物标的对应关系,采用遗传算法对规划路径进行寻优,获取最优规划路径。该方法在目标工作环境较为复杂的条件下,规划结果精度无法保障。周怡等[4]在研究舰船路径规划问题过程中,以防碰撞为目的构建航行路径规划模型,采用优化后的DDPG算法求解模型获取最优路径。该方法在实际应用过程中无法保障收敛速度与寻优性能的平衡性。
针对上述问题,提出基于混合蚁群算法的无人船航行路径自主规划方法,获取最优航行路径。
1 无人船航行路径的自主规划 1.1 环境建模无人船航行路径自主规划之前,需先构建无人船工作环境模型,由此能在无人船工作环境中明确哪些区域是安全区域,哪些区域为障碍物区域。设定无人船工作环境中的障碍物均处于静止状态,由于栅格法描述简单,易于实现,因此通过栅格法构建工作环境模型[5],以A和B分别表示安全区域与障碍物区域。以方形地图表示无人船工作环境,栅格法中包含若干个边长为1的小正方形,其中白色区域和黑色区域分别为安全区域和障碍物区域。
以方便后续对无人船工作环境信息的描述为目的,由上至下、由左至右的对栅格实施编号处理。在栅格间距确定过程中的主要依据为栅格点中心位置坐标,所以,可通过式(1)描述栅格号与无人船工作环境坐标
$ \left\{ \begin{gathered} x = {\theta ^ * }\left( {{\mathrm{ceil}}\left( {\frac{n}{{MM}}} \right) - \frac{\theta }{2}} \right) \text{,} \\ y = {\theta ^ * }\left( {MM + \frac{\theta }{2} - \text{mod} \left( {n,MM} \right)} \right) \text{。} \\ \end{gathered} \right. $ | (1) |
式中:
构建无人船工作环境模型后,再构建无人船航行路径自主规划的数学模型。无人船航行路径自主规划问题可描述为:在任意规划空间内,符合相应约束条件
利用式(2)能够描述无人船航行路径自主规划数学模型:
$ {\min _\gamma }J = D\varphi {v_{(x,y)}}^2\frac{{S\phi }}{{2\beta }} \text{。} $ | (2) |
式中:
约束条件如下:
1)地形与威胁约束。无人船航行过程中,为保障航行安全性,需防止与障碍物产生碰撞,因此设定无人船工作环境中,障碍物与危险区域均为不可穿越的区域[6]。若以
$ \forall \left( {x,y} \right) \notin {R_f},f\left( {x,y} \right) \cdot {\min _\gamma }J = 0 \text{。} $ | (3) |
2)航程上限约束。无人船内部携带能量对于航行距离上限
$ f\left( {x,y} \right)({\phi _g} + {\delta _g}) < {\phi _{\max }} \text{。} $ | (4) |
式中,
3)转弯角度约束。无人船航行转弯过程中受自身机动性能影响[8],导致角度受到一定限制,以
$ {\partial _i} \leqslant \xi ,{\forall _i} \leqslant n\text{。} $ | (5) |
4)路径平滑度约束。无人船航行路径越平滑,对自身的机动性要求越低。考虑无人船航行过程中需消耗大量能量,为路径的平滑性能够降低能源消耗。描述该约束条件公式为:
$ {S_k} = \frac{{{e^{\left( {R - r} \right)}}}}{L} \leqslant {S_{\max }} \text{。} $ | (6) |
式中:
考虑蚁群算法应用过程中存在初始阶段搜索效率差、有较大概率获取局部最优结果等问题,将其与粒子群算法相结合,提出混合蚁群算法。针对式(2)无人船航行路径自主规划数学模型,采用混合蚁群算法进行求解。将由无人船航行路径解集内选取最优路径的问题描述为蚂蚁搜索食物的问题,设定无人船航行路径解集内各解以及最优解,分别为蚂蚁搜索食物过程中路经的城市和目标点。
依照无人船航行路径自主规划的实际情况,初始化混合蚁群算法参数,设定蚁群数量与最大迭代次数分别设定为200±100次和150±50次,信息素挥发系数与信息素增加浓度范围分别为0.5±0.2和5.5±4.5,信息素初始浓度范围与启发因子关键度范围分别为55±45和5±2,信息素关键度范围为5±2。
计算蚂蚁个体的适应度
$ \Im= {S_k}w{z_i} + c\varepsilon \left( {{p_i} + {s_i}} \right)/{\phi _{\max }} \text{。}$ | (7) |
式中:
蚂蚁依照设定的迭代次数对无人船最优航行路径实施全局搜索,每实施一次搜索即完成一次迭代过程。蚂蚁在搜索无人船最优航行路径过程中会产生信息素,所以每次迭代过程后就需更新搜索路径中遗留的信息素
$ \tau \left( {t + 1} \right) = \Im \left( {1 - \rho } \right)\varpi + \Delta \tau \text{。}$ | (8) |
式中:
为避免目标迭代过程中陷入局部最优问题,对信息素上限值实施设定,公式描述如下:
$ {\tau _{\max }} = \frac{{\tau \left( {t + 1} \right)H}}{{\rho {L_{\min }}}} \text{。}$ | (9) |
式中,
为验证本文方法在路径自主规划中的应用效果,选取某型号的无人船为研究对象,表1为研究对象相关参数。设定研究对象的工作环境大小为24×20 km,采用本文方法对研究对象航行路径进行自主规划。
采用本文方法获取的研究对象最优航行路径规划结果,如图1所示。图中,黑色方块为研究对象工作环境中的障碍物与危险区域,白色圆形为研究对象的起始点坐标与终点坐标。
分析图1可知,采用本文方法能够有效构建研究对象工作环境模型,同时通过计算能够有效获取研究对象最优航行路径,该路径能够有效避开全部障碍物与危险区域。
为验证本文方法航行路径规划结果的优势性,对比采用本文方法前后研究对象的航行路径,结果如表2所示。
分析表2可知,采用本文方法对研究对象航行路径进行规划后,最优路径长度与采用本文方法前相比减少1.586 1 km,平均能耗降低6.4211 kJ,路径规划时间降低3.565 s。以上数据充分说明采用本文方法能够有效保障研究对象航行路径规划的精度与实时性,降低研究对象航行能耗,保障研究对象航行过程中的经济性。
3 结 语本文研究了一种基于混合蚁群算法的无人船航行路径自主规划方法,在工作环境模型基础上构建航行路径规划数学模型,并采用混合蚁群算法求解模型。实验结果显示,本文方法所构建的工作环境模型较为准确,所得最优路径规划结果路径最短、能耗最低。
[1] |
马小轩, 吴韵哲, 吴浩峻, 等. 基于改进人工势场法的水下自主航行器路径规划[J]. 船舶工程, 2021, 43(9): 89-93+100. MA Xiaoxuan, WU Yunzhe, WU Haojun, et al. Path planning of autonomous underwater vehicle based on improved artificial potential field method[J]. Ship Engineering, 2021, 43(9): 89-93+100. |
[2] |
滕建平, 梁霄, 陶浩, 等. 无人水下航行器全局路径规划及有限时间跟踪控制[J]. 上海海事大学学报, 2022, 43(1): 1-7. TENG Jianping, LIANG Xiao, TAO Hao, et al. Global path planning and finite-time tracking control of unmanned underwater vehicles[J]. Journal of Shanghai Maritime University, 2022, 43(1): 1-7. |
[3] |
王立鹏, 张智, 马山, 等. 考虑船舶操纵性约束的改进遗传算法航线规划[J]. 哈尔滨工程大学学报, 2021, 42(7): 1056-1062. WANG Lipeng, ZHANG Zhi, MA Shan, et al. Improved genetic algorithm-based ship route planning considering ship maneuverability constraints[J]. Journal of Harbin Engineering University, 2021, 42(7): 1056-1062. |
[4] |
刘智萍, 周清华, 彭吉琼, 等. 基于免疫遗传优化的实时交通路径诱导方法[J]. 计算机仿真, 2022, 39(2): 98-101+418. LIU Zhiping, ZHOU Qinghua, PENG Jiqiong, et al. Real-time traffic path induction method based on immune genetic optimization[J]. Computer Simulation, 2022, 39(2): 98-101+418. |
[5] |
胡致远, 王征, 杨洋, 等. 基于人工鱼群-蚁群算法的UUV三维全局路径规划[J]. 兵工学报, 2022, 43(7): 1676-1684. HU Zhiyuan, WANG Zheng, YANG Yang, et al. Three-dimensional global path planning for UUV based on artificial fish swarm and ant colony algorithm[J]. Acta Armamentarii, 2022, 43(7): 1676-1684. |
[6] |
曹建秋, 徐鹏, 张广言. 基于贪心策略下混合蚁群算法的无人机航迹规划[J]. 重庆交通大学学报(自然科学版), 2021, 40(9): 9-16+23. CAO Jianqiu, XU Peng, ZHANG Guangyan. Path Planning of UAV basedon hybrid ant colony algorithm under greedy strategy[J]. Journal of Chongqing Jiaotong University(Natural Sciences), 2021, 40(9): 9-16+23. |
[7] |
张岳星, 王轶群, 李硕, 等. 基于海图和改进粒子群优化算法的AUV全局路径规划[J]. 机器人, 2020, 42(1): 120-128. ZHANG Yuexing, WANG Yiqun, LI Shuo, et al. Global path planning for AUV based on charts and the improved particle swarm optimization algorithm[J]. Robot, 2020, 42(1): 120-128. |
[8] |
荆学东, 杜黎童, 郭泰, 等. 基于混合参数蚁群算法的移动机器人路径规划[J]. 机床与液压, 2022, 50(9): 41-47. JING Xuedong, DU Litong, GUO Tai, et al. Mobile robot path planning based on mixed parameter ant colony algorithm[J]. Machine Tool & Hydraulics, 2022, 50(9): 41-47. |