Cooperative UAV Navigation using Magnetic Anomaly Measurements and Limited Inter-Vehicle Ranging Information

The problem of cooperative localization for a small group of Unmanned Aerial Vehicles (UAVs) in a GNSS denied environment is addressed in this paper. The presented approach contains two sequential steps: first, an algorithm called cooperative ranging localization, formulated as an Extended Kalman Filter (EKF), estimates each UAV's relative pose inside the group using inter-vehicle ranging measurements; second, an algorithm named cooperative magnetic localization, formulated as a particle filter, estimates each UAV's global pose through matching the group's magnetic anomaly measurements to a given magnetic anomaly map. In this study, each UAV is assumed to only perform a ranging measurement and data exchange with one other UAV at any point in time. A simulator is developed to evaluate the algorithms with magnetic anomaly maps acquired from airborne geophysical survey. The simulation results show that the average estimated position error of a group of 16 UAVs is approximately 20 meters after flying about 180 kilometers in 1 hour. Sensitivity analysis shows that the algorithms can tolerate large variations of velocity, yaw rate, and magnetic anomaly measurement noises. Additionally, the UAV group shows improved position estimation robustness with both high and low resolution maps as more UAVs are added into the group.

[1]  Fawzi Nashashibi,et al.  Cooperative Multi-Vehicle Localization Using Split Covariance Intersection Filter , 2013, IEEE Intelligent Transportation Systems Magazine.

[2]  Girish Chowdhary,et al.  GPS‐denied Indoor and Outdoor Monocular Vision Aided Navigation and Control of Unmanned Aircraft , 2013, J. Field Robotics.

[3]  Subhas Chandra Mukhopadhyay,et al.  High Sensitivity Magnetometers , 2017 .

[4]  Martin Vetterli,et al.  Euclidean Distance Matrices: Essential theory, algorithms, and applications , 2015, IEEE Signal Processing Magazine.

[5]  Yu Gu,et al.  Robot Foraging: Autonomous Sample Return in a Large Outdoor Environment , 2018, IEEE Robotics & Automation Magazine.

[6]  Roland Siegwart,et al.  Vision-Controlled Micro Flying Robots: From System Design to Autonomous Navigation and Mapping in GPS-Denied Environments , 2014, IEEE Robotics & Automation Magazine.

[7]  Jan Wendel,et al.  An integrated GPS/MEMS-IMU navigation system for an autonomous helicopter , 2006 .

[8]  Mandyam V. Srinivasan,et al.  Visual Odometry : Autonomous UAV Navigation using Optic Flow and Stereo , 2014, ICRA 2014.

[9]  Sonia Martínez,et al.  Cooperative Robot Localization Using Event-triggered Estimation , 2018, Journal of Aerospace Information Systems.

[10]  R. Blakely Potential theory in gravity and magnetic applications , 1996 .

[11]  Roland Siegwart,et al.  Monocular‐SLAM–based navigation for autonomous micro helicopters in GPS‐denied environments , 2011, J. Field Robotics.

[12]  Giancarmine Fasano,et al.  Satellite and Vision-Aided Sensor Fusion for Cooperative Navigation of Unmanned Aircraft Swarms , 2017, J. Aerosp. Inf. Syst..

[13]  Bartosz Brzozowski,et al.  A concept of UAV indoor navigation system based on magnetic field measurements , 2016, 2016 IEEE Metrology for Aerospace (MetroAeroSpace).

[14]  Stergios I. Roumeliotis,et al.  Performance analysis of multirobot Cooperative localization , 2006, IEEE Transactions on Robotics.

[15]  Juha Röning,et al.  Magnetic field-based SLAM method for solving the localization problem in mobile robot floor-cleaning task , 2011, 2011 15th International Conference on Advanced Robotics (ICAR).

[16]  Wolfram Burgard,et al.  A Probabilistic Approach to Collaborative Multi-Robot Localization , 2000, Auton. Robots.

[17]  Aníbal Ollero,et al.  Vision-Based Odometry and SLAM for Medium and High Altitude Flying UAVs , 2009, J. Intell. Robotic Syst..

[18]  Bartosz Brzozowski,et al.  Magnetic field mapping as a support for UAV indoor navigation system , 2017, 2017 IEEE International Workshop on Metrology for AeroSpace (MetroAeroSpace).

[19]  J. Gower Properties of Euclidean and non-Euclidean distance matrices , 1985 .

[20]  Jan Skaloud,et al.  Autonomous Vehicle Dynamic Model-Based Navigation for Small UAVs , 2016 .

[21]  Ryo Kurazume,et al.  Cooperative positioning with multiple robots , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[22]  Raman K. Mehra,et al.  Covariance intersection algorithm for distributed spacecraft state estimation , 2001, Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148).

[23]  L. Nenadovic,et al.  Rapid and precise absolute distance measurements at long range , 2009 .

[24]  Xin Li,et al.  Design of an Autonomous Precision Pollination Robot , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[25]  Stergios I. Roumeliotis,et al.  Distributed Maximum A Posteriori Estimation for Multi-robot Cooperative Localization , 2009 .

[26]  Michael W. McElhinny,et al.  The Magnetic Field of the Earth: Paleomagnetism, the Core, and the Deep Mantle , 1997 .

[27]  Andrew G. Dempster,et al.  How feasible is the use of magnetic field alone for indoor positioning? , 2012, 2012 International Conference on Indoor Positioning and Indoor Navigation (IPIN).

[28]  Kevin M. Brink,et al.  Cooperative UAV Navigation using Inter-Vehicle Ranging and Magnetic Anomaly Measurements , 2018 .

[29]  Kevin M. Brink,et al.  Improved Magnetic Anomaly Navigation Accuracy through Cooperative Navigation , 2017 .

[30]  Peter I. Corke Robotics, Vision and Control - Fundamental Algorithms In MATLAB® Second, Completely Revised, Extended And Updated Edition, Second Edition , 2017, Springer Tracts in Advanced Robotics.

[31]  Yu Gu,et al.  Cooperative relative localization for moving UAVs with single link range measurements , 2016, 2016 IEEE/ION Position, Location and Navigation Symposium (PLANS).

[32]  Li Wang,et al.  LiDAR Scan Matching Aided Inertial Navigation System in GNSS-Denied Environments , 2015, Sensors.

[33]  Nicholas Roy,et al.  RANGE - robust autonomous navigation in GPS-denied environments , 2010, 2010 IEEE International Conference on Robotics and Automation.

[34]  Peter I. Corke,et al.  Robotics, Vision and Control - Fundamental Algorithms in MATLAB® , 2011, Springer Tracts in Advanced Robotics.

[35]  Eric N. Johnson,et al.  Factored Extended Kalman Filter for Monocular Vision-Aided Inertial Navigation , 2016, J. Aerosp. Inf. Syst..

[36]  Aaron Canciani,et al.  Absolute Positioning Using the Earth's Magnetic Anomaly Field† , 2015 .

[37]  Stergios I. Roumeliotis,et al.  Distributed multirobot localization , 2002, IEEE Trans. Robotics Autom..

[38]  D. Simon Optimal State Estimation: Kalman, H Infinity, and Nonlinear Approaches , 2006 .

[39]  Gaurav S. Sukhatme,et al.  Localization for mobile robot teams using maximum likelihood estimation , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[40]  Ramavarapu S. Sreenivas,et al.  Autonomous Navigation and Localization of a Quadrotor in an Indoor Environment , 2015, J. Aerosp. Inf. Syst..

[41]  P. J. Hood History of aeromagnetic surveying in Canada , 2007 .

[42]  I.A. Getting,et al.  Perspective/navigation-The Global Positioning System , 1993, IEEE Spectrum.