A Consensus-Based Model Predictive Control with Optimized Line-of-Sight Guidance for Formation Trajectory Tracking of Autonomous Underwater Vehicles

Zhonglan Qian,Weichao Lyu,Yizhan Dai,Jing Xu
DOI: https://doi.org/10.1007/s10846-022-01710-4
2022-08-27
Journal of Intelligent and Robotic Systems: Theory and Applications
Abstract:This paper investigates the leader-follower formation control problem of underactuated autonomous underwater vehicles. To solve the issues of inputs constraint and partial communication blocked between the leader and the followers, a novel consensus-based model predictive control scheme with optimized line-of-sight guidance is proposed. A desired optimal heading is generated by the line-of-sight guidance with reference governor, which is instrumented to compensate for the lack of actuator in sway direction. The reference governor is employed to prescribe the increment of desired optimal heading by balancing the line-of-sight guidance law and current heading. The information from the leader and neighbors is integrated using graph theory based on consensus scheme, which reduces the dependency of the leader compared to traditional leader-follower formation methods. The relative distances between followers are used to design state constraints for collision avoidance. Meanwhile, when the communication between the leader and the followers is partially blocked, the proposed controller can still generate the optimal control inputs and guarantee the formation tracking performance relying on the neighbors' state. An auxiliary Lyapunov-based contraction constraint is implemented to guarantee the stability. Finally, numerical simulations are provided to demonstrate the effectiveness and robustness of the proposed controller.
What problem does this paper attempt to address?