针对无人水下航行器多约束条件下最优航迹快速规划问题，通过设置航行区域校正点及误差约束，建立可行航迹最短的目标函数，提出一种基于最小转向角的搜索算法。对航迹最短、转向角最小的球形可搜索区域内的校正点误差校正，结果表明：在不考虑和考虑转向角约束的2种情况下，基于最小转向角算法的航迹长度为106350 m ，比不考虑转向角约束的航迹长度缩短22559 m, 共经过8次校正点，总转向角度为120.66°，航迹方向最贴近起点和终点连线方向，航迹光滑没有折回、比邻、平行的现象， 可以在通信条件受限的情况下，校正误差实时自主定位。
Aiming at the problem of fast optimal path planning for unmanned underwater vehicles with multiple constraints, the objective function of the shortest feasible path is established by setting the correction points and error constraints of the navigation area, and a search algorithm based on the minimum steering angle is proposed. The error correction of correction points in the spherical searchable area with the shortest track and the smallest steering angle is carried out. The results show that the track length based on the minimum steering angle algorithm is 106350 m without considering and considering the steering angle constraint, which is 22559 m shorter than that without considering the steering angle constraint. It passes through eight correction points, and the total steering angle is 120.66°. The track direction is closest to the linear direction of the starting point. The track is smooth without turning back, neighborhood and parallelism. The correction error can be real-time and autonomously located under limited communication conditions.
2023,45(8): 84-89 收稿日期：2022-05-16
DOI：10.3404/j.issn.1672-7649.2023.08.017
分类号：U691
基金项目：浙江省教育厅项目(Y202044638)；舟山市科技计划项目(2021CZ1010)
作者简介：韩喜红(1996-),男,硕士研究生,研究方向为海上安全技术
参考文献：
[1] 郝拥军, 程玲, 鲍轩. 多任务UUV的路径规划算法及其应用[J]. 舰船科学技术, 2021, 43(S1): 48–51
[2] 肖玉杰, 邱志明, 石章松. UUV国内外研究现状及若干关键问题综述[J]. 电光与控制, 2014, 21(2): 46–49+89
[3] 冯炜, 张静远, 王众, 等. 海洋环境下基于量子行为粒子群优化的时间最短路径规划方法[J]. 海军工程大学学报, 2017, 29(6): 72–77
[4] 马元. 自主式水下航行器运动控制系统的设计[D]. 青岛: 中国海洋大学, 2014.
[5] 付俞鑫. 基于模糊神经网络的无人水下航行器航迹跟踪控制[D]. 大连: 大连海事大学, 2017
[6] 杨雪, 王端民, 查翔. 无人机自主飞行航迹规划研究[J]. 计算机工程, 2012, 38(5): 192–195
[7] 王英志, 范文涛. 水下导航定位技术研究进展[J]. 数字海洋与水下攻防, 2020, 3(5): 372–381
[8] 高钟毓. 惯性导航系统技术[M]. 北京: 清华大学出版社, 2012.
[9] 程凝怡, 刘志乾, 李昱奇. 一种基于Dijkstra的多约束条件下智能飞行器航迹规划算法[J]. 西北工业大学学报, 2020, 38(6): 1284-1290.
[10] 王伟, 王华. 基于约束人工势场法的弹载飞行器实时避障航迹规划[J]. 航空动力学报, 2014, 29(7): 1738–1743
[11] 陶重犇, 雷祝兵, 李春光, 等. 基于改进模拟退火算法的搬运机器人路径规划[J]. 计算机测量与控制, 2018, 26(7): 182–185
[12] 岳秀, 张超峰, 张伟, 等. 基于A-Star和改进模拟退火算法的航迹规划[J]. 控制工程, 2020, 27(8): 1365–1371
[13] 张楠楠, 姜文刚, 窦刚. 改进蚁群算法在AUV三维路径规划中的研究[J]. 计算机工程与应用, 2019, 55(11): 265–270
[14] 陈洋, 赵新刚, 韩建达. 移动机器人3维路径规划方法综述[J]. 机器人, 2010, 32(4): 568–576
