为了改善船舶动力定位多传感器的融合性能,提出了一种多传感器闭环分级融合算法.该算法包括基于卡尔曼滤波的局部和全局两级估计,以全局融合信息的反馈作为局部估计的初始值进行时间更新,定义两级估计的映射关系并引入调节系数,自适应地调节全局融合增益.全局估计融入各局部估计过程中,两级估计组成了一个相互补偿的闭环系统.利用船舶半实物仿真系统的试验,仿真验证了该算法的有效性.
To improve the multi-sensor fusion performance of vessel dynamic positioning, a closed-loop hierarchical fusion algorithm is proposed. The presented fusion algorithm has local and global estimators. The Kalman filter is used in both the local and global estimates. The global fusion is fed back to the local filters. Mapping relationships between the local and global estimates are defined by environment conditions derived from each local estimator. Adjusting factors based on the local and global estimates co- variances are introduced. The gain of the global fusion is adjusted optimally according to the mapping matrices and adjusting factors. The global estimate is included in local estimates, The proposed algorithm combines the local and global estimates into one closed- loop mutual compensation system. By the vessel semi-physical simulation system the validities of the proposed algorithm are veri- fied.