基于复杂约束条件的欠驱动AUV三维路径规划

doi:10.12382/bgxb.2021.0340

摘要/Abstract

摘要： 为解决欠驱动自主水下航行器（AUV）在复杂水域下的三维路径规划和避碰问题，结合欠驱动的运动特性与自身约束条件，提出一种改进的蚁群结合3次B样条曲线拟合的算法，模拟现实海域环境信息进行水下空间环境建模。针对传统蚁群算法规划出的全局路径转角大、曲折多所造成的欠驱动AUV舵轮使用寿命低的问题，采用垂直面安全域设置的方法，设计基于低崎岖度的适应度函数结合路径长度与平缓度的双边评价体系规划出全局路径。采用3次B样条曲线，基于原型值点及目标点速度矢量约束拟合出一条曲率连续、无碰撞的优化路径。仿真结果表明，在保证收敛速度和全局搜索能力的前提下，所规划的路径合理，满足欠驱动AUV运动条件。

关键词: 欠驱动自主水下航行器, 改进蚁群算法, B样条曲线理论, 速度矢量约束

Abstract: An improved ant colony algorithm based on third-order B-spline curve fitting is proposed for the 3-D path planning and collision avoidance of underactuated AUV in complex waters，in which the underactuated motion characteristics and vehicle constraints are considered. An underwater space environment is modeled by simulating the real sea environment complexity. For the short service life issue of the underactuated AUV steering wheel，which is caused by large angle of turn and zigzagging route coming from the global path planned by original ant colony algorithm，a global path is planned by setting a vertical safety zone and redesigning the fitness function and evaluation function based on the factors of short path length and high path smoothness.TAn optimized path is fitted by using B-spline curve. And the continuous and safe path trajectory satisfies the velocity vector constraint of goal point. The simulated results show that the planned path is feasible on the precondition of guaranteeing the high convergence speed and global search capability.

Key words: underactuatedautonomousunderwatervehicle, improvedantcolonyalgorithm, B-splinecurvetheory, velocityvectorconstraint

中图分类号:

TP242.6

张家闻，房浩霖，李家旺. 基于复杂约束条件的欠驱动AUV三维路径规划[J]. 兵工学报, 2022, 43(6): 1407-1414.

ZHANG Jiawen， FANG Haolin， LI Jiawang. 3D Path Planning of Underactuated AUV Based on Complex Constraints[J]. Acta Armamentarii, 2022, 43(6): 1407-1414.

参考文献

［1］邸青,周竞烨,方凯,等.基于模型参数不确定的欠驱动非对称自主水下航行器全局镇定控制研究[J].兵工学报,2020, 41(5): 950-957.
DI Q,ZHOU J Y,FANG K,et al.Global stabilization of underactuated asymmetric AUVs with unknown model parameters[J]. Acta Armamentarii, 2020, 41(5): 950-957. (in Chinese)
[2］ ZENG Z,LIAN L,SAMMUT K,et al.A survey on path planning for persistent autonomy of autonomous underwater vehicles[J]. Ocean Engineering, 2015, 110:303-313.
[3］郭银景,孟庆良,孔芳,等.AUV路径规划算法研究现状与展望[J].计算机科学与探索, 2020, 14(12):1981-1994.
GUO Y J, MENG Q L, KONG F, et al. Research status and prospect of AUV path planning algorithms[J].Journal of Frontiers of Computer Science and Technology, 2020, 14(12):1981-1994. (in Chinese）
[4］ DANG V H. Improving path planning methods in 2D grid maps[J]. Journal of Computers, 2020, 15(1):1-9.
[5］ SAHOO A, DWI V D, ROBI P S. Advancements in the field of autonomous underwater vehicle[J].Ocean Engineering, 2019, 181(Jun.1):145-160.
[6］张楠楠,姜文刚,窦刚.改进蚁群算法在AUV三维路径规划中的研究[J].计算机工程与应用, 2019, 55(11):265-270.
ZHANG N N,JIANG W G,DOU G.Research on autonomous underwater vehicle 3D path planning based on improved ant colony algorithm[J]. Computer Engineering and Applications, 2019, 55(11): 265-270. (in Chinese)
[7］ ZHANG C,AO L,YANG J S,et al.An improved A^* algorithm applying to path planning of games[J]. Journal of Physics:Conference Series, 2020, 1631:012068.
[8］ LAZAROWSKA A.Discrete artificial potential field approach to mobile robot path planning[J]. IFAC-PapersOnLine, 2019, 52(8): 277-282.
[9］王超,朱大奇.基于人工势场与速度合成的AUV路径规划[J].控制工程,2015, 22(3):418-424.
WANG C, ZHU D Q. Path planning for autonomous underwater vehicle based on artificial potential field and velocity synthesis[J]. Control Engineering of China, 2015, 22(3):418-424. (in Chinese)
[10］刘贵杰,刘鹏,穆为磊,等.采用能耗最优改进蚁群算法的自治水下机器人路径优化[J].西安交通大学学报,2016, 50(10): 93-98.
LIU G J, LIU P, MU W L, et al. A path optimization algorithm for AUV using an improved ant colony algorithm with optimal energy consumption[J]. Journal of Xi'an Jiaotong University, 2016, 50(10):93-98. (in Chinese)
[11］姚鹏，解则晓.基于修正导航向量场的AUV自主避障方法[J].自动化学报，2020，46(8):1670-1680.
YAO P, XIE Z X. Autonomous obstacle avoidance for AUV based on modified guidance vector field[J]. Acta Automatica Sinica, 2020, 46(8):1670-1680. (in Chinese)
[12］ RAHEEM F A, ABDULKAREEM M I. Development of path planning algorithm using probabilistic roadmap based on modified ant colony optimization[J]. World Journal of Engineering and Technology, 2019, 7(4):583-597.
[13］ MA T, LI Y, ZHAO Y, et al. An AUV localization and path planning algorithm for terrain-aided navigation[J].ISA Transactions, 2020, 103(C):215-227.
[14］ TAHERI E, FERDOWSI M H, DANESH M. Closed-loop randomized kinodynamic path planning for an autonomous underwater vehicle[J]. Applied Ocean Research, 2019, 83:48-64.
[15］李晔, 姜言清,张国成,等.考虑几何约束的AUV回收路径规划[J].机器人, 2015, 37(4):478-485.
LI Y, JIANG Y Q, ZHANG G C, et al.AUV recovery path planning method considering geometrical constraints[J].Robot, 2015, 37(4):478-485. (in Chinese)
[16］ ZHUANG Y F, SHARMA S, SUBUDHI B, et al. Efficient collision-free path planning for autonomous underwater vehicles in dynamic environments with a hybrid optimization algorithm[J].Ocean Engineering,2016, 127:190-199.
[17］ SUN Y S, RAN X R, ZHANG G C, et al. AUV 3D path planning based on the improved hierarchical deep Q network[J]. Journal of Marine Science and Engineering, 2020, 8(2):145.
[18］ WANG H J, XIONG W. Research on global path planning based on ant colony optimization for AUV[J]. Journal of Marine Science and Application, 2009, 8(1):58-64.
[19］ XIONG C K, CHEN D F, LU D, et al. Path planning of multiple autonomous marine vehicles for adaptive sampling using Voronoi-based ant colony optimization[J]. Robotics and Autonomous Systems, 2019, 115:90-103.
[20］ DUNG V T, TIABJOWIDODO T. A direct method to solve optimal knots of B-spline curves:an application for non-uniform B-spline curves fitting[J].Plos One,2017, 12(3): e0173857.

[1]	邸青，周竞烨，方凯，姚佳琪，李家旺. 基于模型参数不确定的欠驱动非对称自主水下航行器全局镇定控制研究[J]. 兵工学报, 2020, 41(5): 950-957.
[2]	江梦洁，李家旺，吕艳芳，周家炜，黄汉涛. 饱和输入限制下欠驱动自主水下航行器水平面航迹跟踪控制[J]. 兵工学报, 2017, 38(11): 2207-2213.