Application of Adaptive Federated Kalman Filter Algorithm to Multi-parameter Estimation for Torpedo Navigation and Positioning
-
摘要: 针对鱼雷水下航行的特殊性以及组合导航系统中由于量测噪声统计特性的不确定而导致滤波精度降低的问题, 提出了一种新的应用于鱼雷导航定位的自适应滤波算法。该算法通过新息自适应量测噪声, 在噪声统计特性未知的情况下能进行滤波计算。同时在信息融合时提出一种新的自适应信息分配方法, 该方法利用估计的均方误差阵来实时确定各子滤波器的信息分配系数, 使信息分配系数能够跟随子滤波器的性能而改变。通过对新算法与标准卡尔曼滤波算法所做的对比仿真试验分析, 结果表明, 该自适应联邦滤波算法在鱼雷多参量自适应联邦滤波导航定位应用中的有效性。Abstract: Considering the particularity of torpedo underwater navigation, a new adaptive Kalman filter algorithm for torpedo multi-parameter estimation is presented for the purpose of torpedo navigation and positioning. Hence, the low filtering precision due to the uncertainty of the measurement noise′s statistical characteristics of Kalman filter in inte-grated navigation can be improved. This algorithm can conduct filtering calculation via measurement noise′s adaptive information with unknown statistical characteristics of noise. Moreover, a new adaptive information distribution strategy for information fusion is proposed. This distribution strategy can determine the information distribution coefficient of each sub-filter by making use of the estimated mean square error matrix, and make the variation of the coefficient de-pend on the optimal performance of the sub-filter at any time. Comparison between the simulations of the proposed al-gorithm and the normal Kalman filter algorithm verifies the effectiveness of the proposed algorithm.
-
Key words:
- torpedo /
- integrated navigation /
- adaptive federated Kalman filtering /
- information fusion /
- innovation
-
[1] 李建辰. 鱼雷定位技术[M]. 北京: 国防工业出版社, 2009. [2] 鲁平, 赵龙, 陈哲. 改进的 Sage-Husa 自适应滤波及其应用[J]. 系统仿真学报, 2007, 19(15): 3503-3505.Lu Ping, Zhao Long, Chen Zhe. Improved Sage-Husa Adaptive Filtering and Its Application[J]. Journal of Sys-tem Simulation, 2007, 19(15): 3503-3505. [3] 李旦, 秦永元, 梅春波. 组合导航自适应卡尔曼滤波改进算法研究[J]. 测控技术, 2011, 30(3): 114-116.Li Dan, Qin Yong-yuan, Mei Chun-bo. An Improved Adaptive Kalman Filter Algorithm for SINS/GPS Integra- ted Navigation System[J]. Measurement & Control Tech- nology, 2011, 30(3): 114-116. [4] 卞鸿巍, 金志华, 王俊璞, 等. 组合导航系统信息自适应卡尔曼滤波算法[J]. 上海交通大学学报, 2006, 40(6): 1000-1004.Bian Hong-wei, Jin Zhi-hua, Wang Jun-pu, et al. The In-novation-Based Estimation Adaptive Kalman Filter Algo- rithm for INS/GPS Integrated Navigation System[J]. Jour- nal of Shang hai Jiaotong University, 2006, 40(6): 1000- 1004. [5] 刘勇, 徐世杰. 基于联邦UKF算法的月球探测自主组合导航[J]. 宇航学报, 2006, 27(3): 518-530.Liu Yong, Xu Shi-jie. Autonomous Integrated Navigation for Lunar Probe Based on Federated UKF Algorithm[J]. Journal of Astronautics, 2006, 27(3): 518-530.
点击查看大图
计量
- 文章访问数: 1298
- HTML全文浏览量: 2
- PDF下载量: 500
- 被引次数: 0