基于改进三层自适应UKF的无人艇操纵运动参数辨识

An improved three-layer adaptive UKF for parameter identification of USV maneuvering models

  • 摘要: 【目的】针对水面无人艇操纵动力学模型参数辨识中传统Sage-Husa自适应无迹卡尔曼滤波(SH-UKF)多从整体层面调节过程噪声协方差,难以兼顾突变工况响应性与弱可观测参数稳定性的问题,提出一种三层自适应无迹卡尔曼滤波(ST-OA-SH-UKF)参数辨识方法。【方法】在标准UKF框架下,引入Sage-Husa机制估计过程噪声协方差整体水平;利用归一化新息平方(NIS)滑动窗口构造强跟踪增强机制,以提高突变工况下参数子空间的更新强度;进一步基于卡尔曼增益矩阵行信息构造逐参数可观测性指标,对参数过程噪声协方差进行差异化调制。基于“育鲲”轮仿真模型,采用变转速推进、Z形操舵和回转操舵联合激励,对所提方法进行开环重构、消融对比和泛化验证。【结果】与已有精度提升的OA-SH-UKF相比,所提ST-OA-SH-UKF使纵向速度、横向速度和艏摇角速度开环RMSE分别降低10.42%、53.81%和71.35%,纵向位置和横向位置RMSE分别降低25.99%和16.19%;在最大舵角由20°增大至25°的泛化工况下,辨识模型仍能保持主要航迹形态和速度变化趋势的一致性。【结论】所提方法能够在复杂机动条件下兼顾参数更新灵敏性和估计稳定性,提高无人艇操纵运动模型的开环重构精度和跨工况适应能力。

     

    Abstract: Objectives To address the difficulty of traditional Sage-Husa adaptive unscented Kalman filtering in balancing transient-response capability and the stability of weakly observable parameters, a three-layer adaptive UKF method is proposed for parameter identification of unmanned surface vehicle (USV) maneuvering dynamics models. Methods Within the standard UKF framework, the Sage-Husa mechanism is used to estimate the overall level of the process noise covariance. A strong tracking mechanism based on a sliding-window normalized innovation squared (NIS) statistic is then introduced to enhance parameter-subspace updating under transient maneuvering conditions. Furthermore, an observability-aware index is constructed from the parameter rows of the Kalman gain matrix, and the parameter process noise covariance is modulated differentially. Using the “Yukun” vessel simulation model, open-loop reconstruction, ablation comparison and generalization tests are carried out under combined excitation of variable-speed propulsion, zigzag steering and turning maneuvers. Results Compared with OA-SH-UKF, the proposed ST-OA-SH-UKF reduces the open-loop RMSEs of surge velocity, sway velocity and yaw rate by 10.42%, 53.81% and 71.35%, respectively, and reduces the RMSEs of longitudinal and transverse positions by 25.99% and 16.19%, respectively. Under a generalized condition in which the maximum rudder angle is increased from 20° to 25°, the identified model still preserves the main trajectory pattern and velocity trend. Conclusions The proposed method can balance parameter-update sensitivity and estimation stability under complex maneuvering conditions, improving the open-loop reconstruction accuracy and cross-condition adaptability of USV maneuvering models.

     

/

返回文章
返回