基于时延补偿及模型预测的ASV-AUV编队协同控制方法

A Cooperative Formation Control Method for ASV-AUV Based on Time-Delay Compensation and Model Predictive Control

  • 摘要: 针对水声通信固有的大时延、高丢包率特性所引发的自主水面船(ASV)与自主水下航行器(AUV)异构编队协同控制精度受限、鲁棒性不足等关键问题,本文提出一种基于增广状态线性时变模型预测控制(LTV-MPC)的协同控制方法,以实现弱通信约束下异构编队的高精度稳定保持。首先,基于协同转弯与速度(CTRV)模型构建长时序状态预测补偿机制,结合历史运动轨迹估计有效抑制长通信中断区间内纯航位推算所引入的非线性误差累计;其次,构建包含速度前馈的轨迹平滑器与增广状态空间,通过在线雅可比线性化实现预测模型的实时修正,有效缓解了大机动工况中的模型非线性失配问题,同时抑制了控制输入抖振现象。部分周期下的数值仿真结果表明,在水声通信高丢包率及随机长时延的条件下,该方法的位置跟踪均方根误差为1.401m,相比于传统PID控制算法与滑模控制算法在精度上分别提高了78.6%与23.2%,而且在与标准模型预测控制算法保持高度一致的控制精度的同时,控制输出指令更加平滑稳定。本研究有效克服弱通信约束与非线性动力学带来的双重挑战,显著提升了ASV- AUV异构编队协同控制的鲁棒性与稳定性,为跨域异构集群在弱通信条件下的协同控制提供了理论依据。

     

    Abstract: Aiming at the key challenges of limited control accuracy and insufficient robustness in the cooperative control of Autonomous Surface Vessels (ASVs) and Autonomous Underwater Vehicles (AUVs) heterogeneous formations—stemming from the inherent large time delay and high packet loss rate of underwater acoustic communication—this paper proposes a cooperative control method based on Augmented State Linear Time-Varying Model Predictive Control (LTV-MPC). The core objective is to achieve high-precision and stable formation maintenance under weak communication constraints. First, a long-horizon state prediction and compensation mechanism is constructed based on the Cooperative Turn and Velocity (CTRV) model. By integrating historical motion trajectory estimation, the nonlinear error accumulation induced by pure dead reckoning during extended communication interruption intervals is effectively suppressed. Second, a trajectory smoother with velocity feedforward and an augmented state space are designed. Real-time correction of the predictive model is realized via online Jacobian linearization, which not only mitigates the model nonlinear mismatch problem in high-maneuver scenarios but also suppresses control input chattering. Numerical simulation results over partial cycles demonstrate that, under conditions of high packet loss rate and random long time delay in underwater acoustic communication, the root mean square error (RMSE) of position tracking for the proposed method is 1.401 m. This represents a 78.6% and 23.2% improvement in accuracy compared to traditional PID control and sliding mode control algorithms, respectively. Furthermore, while maintaining control accuracy highly consistent with the standard MPC algorithm, the control output commands are significantly smoother and more stable. This study effectively addresses the dual challenges posed by weak communication constraints and nonlinear dynamics, significantly enhancing the robustness and stability of ASV-AUV heterogeneous formation cooperative control. It provides a theoretical foundation for the cooperative control of cross-domain heterogeneous clusters under weak communication conditions.

     

/

返回文章
返回