基于改进人工势场法与模型预测控制的多无人艇编队避障控制

展开
  • (大连海事大学 航海学院,辽宁 大连 116026)
孙慧(1991 — ),女,博士,讲师,研究方向:船艇智能控制与优化。薛庆(1997 — ),男,硕士生,研究方向:船艇群体智能控制与优化。潘明阳*(1975 — ),男,博士,教授,博士生导师,研究方向:船舶导航、数字航道、智能航运。E-mail:panmingyang@dlmu.edu.cn。张若澜(1990 — ),男,博士,讲师,研究方向:船舶航行智能感知与自主航行决策。郝江凌(1971 — ),男,硕士,副教授,研究方向:水上交通信息工程与控制。

网络出版日期: 2025-03-29

基金资助

国家重点研发计划(2022YFB4301401);广西科技重⼤专项(桂科AA23062052-03);辽宁省自然科学基金(2023BS075)

Formation obstacle-avoidance control for multi-USVs based on improved artificial potential field method and model predictive control

Expand
  • (Navigation College, Dalian Maritime University, Dalian 116026, China)

Online published: 2025-03-29

摘要

针对多无人艇系统经过狭窄水域等复杂环境的情形,提出一种结合人工势场法与模型预测控制的编队控制与避障算法。首先,对传统的人工势场法进行了改进,采用饱和形式的引力势场和分区式的斥力势场,提升无人艇编队在复杂环境中的避障精度和队形保持能力。然后,结合模型预测控制的多步预测优化能力,利用势场力生成的期望轨迹,动态调整控制输入,进而实现编队的稳定控制和高效避障,避免了传统人工势场法在狭窄水域的路径振荡问题。仿真实验结果表明,改进算法在避障成功率、编队稳定性和路径规划效率等方面均优于传统方法,能够有效避免局部最优,保持队形稳定,顺利通过复杂水域,从而验证了算法的有效性。

本文引用格式

孙慧, 薛庆, 潘明阳, 张若澜, 郝江凌 . 基于改进人工势场法与模型预测控制的多无人艇编队避障控制[J]. 大连海事大学学报, 2025 , 51(2) : 39 -48 . DOI: 10.16411/j.cnki.issn1006-7736.2025.02.005

Abstract

For multi-unmanned surface vehicle (USV) systems navigating through narrow channels and other complex environments, a formation obstacle-avoidance control algorithm is presented that integrates the artificial potential field (APF) method with model predictive control (MPC). To mitigate these problems,the traditional APF approach is improved, including the use of a saturated gravitational potential field and a partitioned repulsive potential field. These modifications aim to improve the precision of obstacle avoidance and the ability to maintain formation coherence in complex environments. Furthermore, by leveraging the multi-step predictive optimization capabilities of MPC, the proposed algorithm dynamically adjusts control inputs based on desired trajectories generated from potential field forces, which ensures the stability of formation control and the effectiveness of obstacle avoidance, thereby avoiding the path oscillation issues encountered by traditional artificial potential field methods in narrow waters. Simulation results demonstrate that the proposed algorithm outperforms traditional methods in terms of obstacle-avoidance success rate, formation stability, and path planning efficiency. And the improved algorithm can avoid local minima, maintains formation integrity, and ensure smoothly passage through narrow channels, thereby validating its effectiveness.

参考文献

[1]刘洋,董早鹏,王浩.速度信息缺失下的多无人艇协同编队控制方法[J].大连海事大学学报,2022,48(2):21-30.
LIU Y, DONG Z P, WANG H. Cooperative formation control method of multi underactuated unmanned vehicle under missing velocity information[J]. Journal of Dalian Maritime University, 2022, 48(2):21-30. (in Chinese)
[2]田勇,王丹,彭周华,等.无人水面艇直线航迹跟踪控制器的设计与验证[J].大连海事大学学报,2015,41(4):14-18.
TIAN Y, WANG D, PENG Z H, et al. Design and validation of path tracking controller for USV along straight-lines[J]. Journal of Dalian Maritime University, 2015, 41(4): 14-18. (in Chinese)
[3] LIU L, WANG D, PENG Z H, et al. Cooperative path following ring-networked under-actuated autonomous surface vehicles: Algorithms and experimental results[J]. IEEE Transactions on Cybernetics, 2018, 50(4): 1519-1529.
[4] YUAN P Y, ZHANG Z, LI Y, et al. Leader-follower control and APF for multi-USV coordination and obstacle avoidance[J]. Ocean Engineering, 2024, 313: 119487.
[5] TAN G G, ZHUANG J Y, ZOU J, et al. Coordination control for multiple unmanned surface vehicles using hybrid behavior-based method[J]. Ocean Engineering, 2021, 232: 109147. 
[6] 宋大雷, 干文浩, 许嘤枝, 等. 无人船实时路径规划与编队控制仿真研究[J].系统仿真学报,2023,35(5): 957-970.
SONG D L, GAN W H, XU Y Z, et al. Simulation of real-time path planning and formation control for unmanned surface vessel[J]. Journal of System Simulation, 2023, 35(5): 957-970. (in Chinese)
[7] LIU G Q, WEN N F, LONG F F, et al. A formation control and obstacle avoidance method for multiple unmanned surface vehicles[J]. Ocean Engineering, 2023, 266: 113164.
[8] WEN G H, LAM J, FU J J, et al. Distributed MPC-based robust collision avoidance formation navigation of constrained multiple USVs[J]. IEEE Transactions on Intelligent Vehicles, 2024, 9(1): 1804-1816.
[9] DONG Z P, ZHANG Z Q, QI S J, et al. Autonomous cooperative formation control of underactuated USVs based on improved MPC in complex ocean environment[J]. Ocean Engineering, 2023, 270: 113633.
[10] 张佳尚,陈志华.基于预添加虚拟力的改进人工势场算法[J].兵器装备工程学报,2023,44(3):219-225.
ZHANG J S, CHEN Z H. The improved artificial potential field algorithm based on pre-added virtual force[J]. Journal of Ordnance Equipment Engineering, 2023, 44(3), 219-225. (in Chinese)
[11] ZHANG Y X, WANG Q, SHEN Y, et al. Multi-AUV cooperative control and autonomous obstacle avoidance study[J]. Ocean Engineering, 2024, 304: 1-14.
[12] YAN X, JIANG D P, MIAO R L, et al. Formation control and obstacle avoidance algorithm of a multi-USV system based on virtual structure and artificial potential field[J]. Journal of Marine Science and Engineering, 2021, 9(2): 161.
[13] 吕鉴博.基于虚拟矩阵结构的水面无人艇编队重构方法研究[D].哈尔滨:哈尔滨工程大学,2023.
LV J B. Research on formation reconstruction method of unmanned surface vessel based on virtual matrix structure[D]. Harbin:Harbin Engineering University, 2023. (in Chinese)
[14] 潘无为,姜大鹏,庞永杰,等.人工势场和虚拟结构相结合的多水下机器人编队控制[J].兵工学报,2017,38(2): 326-334.
PAN W W,JIANG D P,PANG Y J,et.al. A multi-AUV formation algorithm combining artificial potential field and virtual structure[J]. Acta Armamentarii, 2017, 38(2):326-334. (in Chinese)
[15] JOHANSEN T A, PEREZ T, CRISTOFARO A. Ship collision avoidance and COLREGS compliance using simulation-based control behavior selection with predictive hazard assessment[J]. IEEE Transactions on Intelligent Transportation Systems, 2016, 17(12): 3407-3422.
[16] HE Z B, LIU C G, CHU X M, et al. A novel artificial potential field based ship path planning algorithm using model predictive control strategy[C]. Proceedings of the 6th International Conference on Transportation Information and Safety, IEEE, 2021: 1136-1142.
[17] ABDELAAL M, HAHN A. Predictive path following and collision avoidance of autonomous vessels in narrow channels[J]. IFAC-PapersOnLine, 2021, 54(16): 245-251.
[18] NING B X, SUN Q, WANG S Y, et al. Multi-unmanned surface vehicles formation based on DMPC and improved APF method[C]. Proceedings of the 2023 IEEE 23rd International Conference on Communication Technology, IEEE, 2023: 117-122.
[19] ZHEN Q Z, WAN L, LI Y L, et al. Formation control of a multi-AUVs system based on virtual structure and artificial potential field on SE (3)[J]. Ocean Engineering, 2022, 253: 111148.
[20] DO K D. Synchronization motion tracking control of multiple underactuated ships with collision avoidance[J]. IEEE Transactions on Industrial Electronics. 2016, 63(5): 2976-2989.
[21] KHATIB O. Real-time obstacle avoidance for manipulators and mobile robots[J]. The International Journal of Robotics Research, 1986, 5(1): 90-98.
[22] KONG S H, SUN J L, QIU C L, et al. Extended state observer-based controller with model predictive governor for 3-D trajectory tracking of underactuated underwater vehicles[J]. IEEE Transactions on Industrial Informatics, 2020, 17(9): 6114-6124.

文章导航

/