A Foot-Mounted Inertial Measurement Unit (IMU) Positioning Algorithm Based on Magnetic Constraint

With the development of related applications, indoor positioning techniques have been more and more widely developed. Based on Wi-Fi, Bluetooth low energy (BLE) and geomagnetism, indoor positioning techniques often rely on the physical location of fingerprint information. The focus and difficulty of establishing the fingerprint database are in obtaining a relatively accurate physical location with as little given information as possible. This paper presents a foot-mounted inertial measurement unit (IMU) positioning algorithm under the loop closure constraint based on magnetic information. It can provide relatively reliable position information without maps and geomagnetic information and provides a relatively accurate coordinate for the collection of a fingerprint database. In the experiment, the features extracted by the multi-level Fourier transform method proposed in this paper are validated and the validity of loop closure matching is tested with a RANSAC-based method. Moreover, the loop closure detection results show that the cumulative error of the trajectory processed by the graph optimization algorithm is significantly suppressed, presenting a good accuracy. The average error of the trajectory under loop closure constraint is controlled below 2.15 m.

[1]  Paul Lukowicz,et al.  Collaborative PDR Localisation with Mobile Phones , 2011, 2011 15th Annual International Symposium on Wearable Computers.

[2]  Naser El-Sheimy,et al.  PDR/INS/WiFi Integration Based on Handheld Devices for Indoor Pedestrian Navigation , 2015, Micromachines.

[3]  Fakhri Karray,et al.  Multisensor data fusion: A review of the state-of-the-art , 2013, Inf. Fusion.

[4]  Andrei Szabo,et al.  WLAN-Based Pedestrian Tracking Using Particle Filters and Low-Cost MEMS Sensors , 2007, 2007 4th Workshop on Positioning, Navigation and Communication.

[5]  Frank Dellaert,et al.  IMU Preintegration on Manifold for Efficient Visual-Inertial Maximum-a-Posteriori Estimation , 2015, Robotics: Science and Systems.

[6]  Tin Kam Ho,et al.  SignalSLAM: Simultaneous localization and mapping with mixed WiFi, Bluetooth, LTE and magnetic signals , 2013, International Conference on Indoor Positioning and Indoor Navigation.

[7]  Avik Ghose,et al.  InLoc: An end-to-end robust indoor localization and routing solution using mobile phones and BLE beacons , 2016, 2016 International Conference on Indoor Positioning and Indoor Navigation (IPIN).

[8]  Basilio Bona,et al.  A fast and accurate approximation for planar pose graph optimization , 2014, Int. J. Robotics Res..

[9]  D. Simon.  Kalman filtering with state constraints: a survey of linear and nonlinear algorithms , 2010 .

[10]  Sun Yan,et al.  Data Fusion for Indoor Mobile Robot Positioning Based on Tightly Coupled INS/UWB , 2017 .

[11]  Gerhard Tröster,et al.  3D ActionSLAM: wearable person tracking in multi-floor environments , 2014, Personal and Ubiquitous Computing.

[12]  Nicolas Petit,et al.  Using magnetic disturbances to improve IMU-based position estimation , 2007, 2007 European Control Conference (ECC).

[13]  Hyun Myung,et al.  Magnetic field constraints and sequence-based matching for indoor pose graph SLAM , 2015, Robotics Auton. Syst..

[14]  Yunhui Liu,et al.  Pose graph optimization with hierarchical conditionally independent graph partitioning , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[15]  Xin Li,et al.  The IMU/UWB Fusion Positioning Algorithm Based on a Particle Filter , 2017, ISPRS Int. J. Geo Inf..

[16]  Patrick Robertson,et al.  Magnetic maps of indoor environments for precise localization of legged and non-legged locomotion , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[17]  Wolfram Burgard,et al.  G2o: A general framework for graph optimization , 2011, 2011 IEEE International Conference on Robotics and Automation.

[18]  Fredrik Gustafsson,et al.  Particle filters for positioning, navigation, and tracking , 2002, IEEE Trans. Signal Process..

[19]  B. Merminod,et al.  Optimal data fusion for pedestrian navigation based on UWB and MEMS , 2008, 2008 IEEE/ION Position, Location and Navigation Symposium.

[20]  Yi Kechu,et al.  Particle Filter Localization in Underground Mines Using UWB Ranging , 2011, 2011 Fourth International Conference on Intelligent Computation Technology and Automation.

[21]  Isaac Skog,et al.  A note on the limitations of ZUPTs and the implications on sensor error modeling , 2012 .

[22]  Sebastian Thrun,et al.  3-Axis magnetic field mapping and fusion for indoor localization , 2012, 2012 IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems (MFI).

[23]  Stefan Schaal,et al.  Automatic Outlier Detection: A Bayesian Approach , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[24]  Thomas Zwick,et al.  Study on UWB/INS integration techniques , 2011, 2011 8th Workshop on Positioning, Navigation and Communication.

[25]  Jian Wang,et al.  A Bluetooth/PDR Integration Algorithm for an Indoor Positioning System , 2015, Sensors.

[26]  Isaac Skog,et al.  Zero-Velocity Detection—An Algorithm Evaluation , 2010, IEEE Transactions on Biomedical Engineering.

[27]  Xiaoji Niu,et al.  Self-Contained Indoor Pedestrian Navigation Using Smartphone Sensors and Magnetic Features , 2016, IEEE Sensors Journal.

[28]  Yuechun Chu,et al.  A UWB-based 3D location system for indoor environments , 2005, 2nd International Conference on Broadband Networks, 2005..

[29]  Alessio De Angelis,et al.  A magnetic ranging aided dead-reckoning indoor positioning system for pedestrian applications , 2016, 2016 IEEE International Instrumentation and Measurement Technology Conference Proceedings.