基于抗扰MPC的 AUV动态目标跟踪控制

Dynamic Target Tracking Control for AUVs Based on Disturbance-Rejection MPC

  • 摘要: 针对自主水下航行器(AUV)在动态目标跟踪时,面临的目标运动不确定、未知环境扰动及模型参数摄动等多源时变干扰问题以及AUV计算资源受限的特点,本文提出一种融合时变扰动估计、预测及补偿的AUV目标跟踪鲁棒模型预测控制(MPC)策略。首先,以子AUV视角构建相对运动扩张状态观测器(ESO)模型,将多源干扰集总为总扰动并实现实时估计;其次,设计滚动时域扰动预测器模型,基于ESO估计的历史扰动序列数据,利用矩阵束方法提取主导模态初值,采用最小二乘非线性优化估计模态参数,可兼顾模型求解精度与效率,将扰动序列拟合为时间的显式函数,以实现时变扰动短时预测;最后,基于嵌入扰动预测信息的系统模型,设计模型预测控制器,在优化问题中显式纳入未来扰动的前馈补偿,采用适用于计算资源受限的TinyMPC求解框架并进行改进,从而形成多步扰动前馈补偿的抗扰MPC框架。仿真实验表明,相较于现有的ESO-MPC等单步或多步固定扰动值补偿方法,所提方法在跟踪时变目标时可显著提升控制精度;水池实验进一步验证了该算法对跟踪不同周期的运动目标的适应性及工程可行性。

     

    Abstract: To address the multi-source time-varying disturbance problems, such as target motion uncertainty, unknown environmental disturbances, and model parameter perturbations, faced by Autonomous Underwater Vehicles (AUVs) during dynamic target tracking, as well as the characteristic of limited AUV computing resources, this paper proposes a robust Model Predictive Control (MPC) strategy for AUV target tracking that integrates time-varying disturbance estimation, prediction, and compensation. First, a relative motion Extended State Observer (ESO) model is constructed from the perspective of a sub-AUV to lump multi-source disturbances into a total disturbance and achieve real-time estimation; Second, a receding horizon disturbance predictor model is designed. Based on the historical disturbance sequence data estimated by the ESO, the matrix pencil method is used to extract the initial values of the dominant modes, and the least squares nonlinear optimization is employed to estimate the modal parameters, balancing the solution accuracy and efficiency of the model, and the disturbance sequence is fitted into an explicit function of time to achieve short-term prediction of time-varying disturbances; Finally, based on the system model embedded with disturbance prediction information, a Model Predictive Controller is designed. The feedforward compensation of future disturbances is explicitly incorporated into the optimization problem, and the TinyMPC solving framework suitable for computationally constrained applications is adopted and improved, thereby forming a disturbance-rejection MPC framework with multi-step disturbance feedforward compensation. Simulation experiments show that, compared with existing single-step or multi-step fixed disturbance value compensation methods such as ESO-MPC, the proposed method can significantly improve control accuracy when tracking time-varying targets; Tank experiments further verify the adaptability and engineering feasibility of the algorithm for tracking moving targets with different periods.

     

/

返回文章
返回