Novel algorithm for geomagnetic navigation

Abstract

To solve the highly nonlinear and non-Gaussian recursive state estimation problem in geomagnetic navigation, the unscented particle filter (UPF) was introduced to navigation system. The simulation indicates that geomagnetic navigation using UPF could complete the position estimation with large initial horizontal position errors. However, this navigation system could only provide the position information. To provide all the kinematics states estimation of aircraft, a novel autonomous navigation algorithm, named unscented particle and Kalman hybrid navigation algorithm (UPKHNA), was proposed for geomagnetic navigation. The UPKHNA used the output of UPF and barometric altimeter as position measurement, and employed the Kalman filter to estimate the kinematics states of aircraft. The simulation shows that geomagnetic navigation using UPKHNA could provide all the kinematics states estimation of aircraft continuously, and the horizontal positioning performance is better than that only using the UPF.

Keywords

autonomous navigation / geomagnetic navigation / unscented particle filter / Kalman filter / kinematics state estimation

References

[1] FELIX G. Geomagnetic navigation beyond the magnetic compass [C]// PLANS. San Diego, California, 2006: 684–694.

[2] CarlT.. Magnetic anomalies as a reference of ground-speed and map-matching navigation [J]. Journal of Navigation, 1982, 35(2): 242-254

[3] GusarovA., LevronD., PapernoE., ShukerR., BarangaA. B.. Three-dimensional magnetic field measurements in a single SERF atomic-magnetometer cell [J]. IEEE Transactions on Magnetics, 2009, 45(10): 4778-4481

[4] CrassidisJ. L., Lai, HarmanR. R.. Real-time attitude-independent three-axis magnetometer calibration [J]. Journal of Guidance, Control, and Dynamics, 2005, 28(1): 115-150

[5] FENG Hao-nan, YANG Zhao-hua, FANG Jian-cheng. Simulation design of geomagnetic aided inertial navigation system [C]// Proceeding 2nd International Symposium on Systems and Control in Aerospace and Astronautics. Shenzhen, China, 2008: 1–5.

[6] LUO Shi-tu, WANG Yan-ling, LIU Yin, HU Xiao-ping. Research on geomagnetic matching technology based on improved ICP algorithm [C]// Proceedings of the 2008 IEEE International Conference on Information and Automation. Zhangjiajie, China, 2008: 815–819.

[7] MU Hua, WU Mei-ping, HU Xiao-ping, MA Hong-xu. Geomagnetic surface navigation using adaptive EKF [C]// 2007 2nd IEEE Conference on Industrial Electronics and Applications. Harbin, China, 2007: 2821–2825.

[8] GrovesP. D., HandleyR. J.. Optimising the integration of terrain referenced navigation with INS and GPS [J]. The Journal of Navigation, 2006, 59: 71-89

[9] TongX.-h., WuS.-c., WuS.-q., LiuD.-jie.. A novel vehicle navigation map-matching algorithm based on fuzzy logic and its application [J]. Journal of Central South University, 2005, 12(2): 215-219

[10] GustafssonF., GunnarssonF., BergmanN., ForssellU., JanssonJ., KarlssonR., NordlundP. J.. Particles filters for positioning, navigation, and tracking [J]. IEEE Transactions on Signal Processing, 2002, 50(2): 425-437

[11] MerweR. V. D., DoucetA., FreitasN. D., EricW.The unscented particle filter [D], 2000, Cambridge, Cambridge University: 1-45

[12] BEHZAD K P, BEHROOZ K P. Vehicle location on gravity maps [C]// Conference on Unmanned Ground Vehicle Technology. Orlando, Florida, 1999: 182–191.

[13] BERGH A K, ODDVAR H. Terrain aided underwater navigation using point mass and particle filters [C]// IEEE PLANS, Position, Location, and Navigation Symposium. San Diego, CA, United States, 2006: 1027–1035.

[14] NORDLUND P J, GUSTAFSSON F. Sequential Monte Carlo filtering techniques applied to integrated navigation systems [C]// Proceedings of the American Control Conference. Arlington, VA, United States, 2001: 4375–4380.

[15] DoucetArnaud, GodsillSimon, AndrieuChristopheStatistics and Computing, 2000, 10(3): 197-208

[16] JulierS. J., UhlmannJ. K., Durrant-WhyteH. F.. A new approach for the nonlinear transformation of means and covariances in linear filters [J]. IEEE Transactions on Automatic Control, 2000, 5(3): 477-482

[17] LiuJ. S., ChenR.. Sequential monte carlo methods for dynamic systems [J]. Journal of the American Statistical Association, 1998, 93: 1032-1044

[18] DOUC R, CAPPE O, MOULINES E. Comparison of resampling schemes for particle filtering [C]// Proceedings of the 4th International Symposium on image and Signal Processing and Analysis. Zagreb, Croatia, 2005: 64–69.

[19] U.S. Geological SurveyDigital data grids for the magnetic anomaly map of North America: U.S. Geological Survey Open-File Report 02-414 [R], 2002, Denver, Colorado, USA, U.S. Geological Survey

[20] HuX.-ping.Principles and applications of autonomous navigation [M], 2002, Changsha, Press of National University of Defense Technology