针对船舶动力定位状态估计时使用扩展卡尔曼滤波导致模型失配而产生滤波精度不高甚至滤波发散的问题,设计一种融合无迹卡尔曼滤波和粒子滤波的动力定位船舶状态估计算法。该算法以粒子滤波作为整体框架,运用无迹卡尔曼滤波对粒子状态的每次更新进行最优化估计,从而最优化了每个粒子的状态,再根据每个粒子的重要性分布,得出船舶复合运动中的低频状态。Matlab仿真结果表明,该方法能够从含有高频和噪声干扰的测量信息中估计出的船舶低频运动状态,相比于直接使用UKF,该方法的滤波精度更高,滤波性能也比较稳定。
Considering the problem of low accuracy and instability when using extended kalman filter (EKF) in state estimation of dynamic positioning ship,a new fusion algorithm based on unscented kalman filter (UKF) and particle filter (PF) is designed.The algorithm takes PF as its overall frame,it uses UKF to find the optimal estimation of each particle state while updating the particle distribution.The state of ship in low frequency can be divided from its compound motion according to the importance factors of each particle. Simulation results show that the new algorithm can track the true state of ship in low frequency quickly from metrical information which contain high frequency signal and noise. Compared with the algorithm using UKF, this fusion algorithm has high precision and stable filtering effect.
2017,39(3): 49-53 收稿日期:2016-06-07
DOI:10.3404/j.issn.1672-7619.2017.03.010
分类号:TP301.6
基金项目:国家科技支撑计划资助项目(2014BAB13B01)
作者简介:曹园山(1992-),男,硕士研究生,主要从事动力定位控制系统设计研究
参考文献:
[1] BALCHEN J G, JENSSEN N A, MATHISEN E, et al. A Dynamic positioning system based on Kalman filtering and optimal Control[J]. Modeling Identification & Control, 1980, 1(3):135-163.
[2] SHI X, SUN X, FU M, et al. An unscented Kalman filter based wave filtering algorithm for dynamic ship positioning[C]//Automation and Logistics (ICAL), 2011 IEEE International Conference on. IEEE, 2011:399-404.
[3] DENG Xiao-long, JIN Jun, et al. A strong tracking particle filter for state estimation[C]//International Conference on Natural Computation, Icnc 2011, Shanghai, China, 26-28 July. 2011:56-60.
[4] WEI Q, XIONG Z, LI C, et al. A robust approach for multiple vehicles tracking using layered particle filter[J]. AEU-International Journal of Electronics and Communications, 2011, 65(7):609-618.
[5] 王元慧. 模型预测控制在动力定位系统中的应用[D]. 哈尔滨:哈尔滨工程大学, 2006.