The IMU/UWB Fusion Positioning Algorithm Based on a Particle Filter

This paper integrates UWB (ultra-wideband) and IMU (Inertial Measurement Unit) data to realize pedestrian positioning through a particle filter in a non-line-of-sight (NLOS) environment. After the acceleration and angular velocity are integrated by the ZUPT-based algorithm, the velocity and orientation of the feet are obtained, and then the velocity and orientation of the whole body are estimated by a virtual odometer method. This information will be adopted as the prior information for the particle filter, and the observation value of UWB will act as the basis for weight updating. According to experimental results, the prior information provided by an IMU can be used to restrain the observation error of UWB under an NLOS condition, and the positioning precision can be improved from the positioning error of 1.6 m obtained using the pure UWB-based algorithm to approximately 0.7 m. Moreover, with high computational efficiency, this algorithm can achieve real-time computing performance on ordinary embedded devices.

[1]  Francisco José Madrid-Cuevas,et al.  Automatic generation and detection of highly reliable fiducial markers under occlusion , 2014, Pattern Recognit..

[2]  Chunlei Song,et al.  A ZUPT method based on SVM regression curve fitting for SINS , 2014, CCC 2014.

[3]  Ji Zhang,et al.  Visual-lidar odometry and mapping: low-drift, robust, and fast , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[4]  S. Marchand-Maillet,et al.  Bluetooth Indoor Positioning , 2012 .

[5]  Cipriano Galindo,et al.  Mobile robot localization based on Ultra-Wide-Band ranging: A particle filter approach , 2009, Robotics Auton. Syst..

[6]  K. V. S. Hari,et al.  Foot-mounted INS for everybody - an open-source embedded implementation , 2012, Proceedings of the 2012 IEEE/ION Position, Location and Navigation Symposium.

[7]  Juan D. Tardós,et al.  Probabilistic Semi-Dense Mapping from Highly Accurate Feature-Based Monocular SLAM , 2015, Robotics: Science and Systems.

[8]  Youngnam Han,et al.  Improved heading estimation for smartphone-based indoor positioning systems , 2012, 2012 IEEE 23rd International Symposium on Personal, Indoor and Mobile Radio Communications - (PIMRC).

[9]  J. M. M. Montiel,et al.  ORB-SLAM: A Versatile and Accurate Monocular SLAM System , 2015, IEEE Transactions on Robotics.

[10]  Yuan Zhou,et al.  Indoor Elliptical Localization Based on Asynchronous UWB Range Measurement , 2011, IEEE Transactions on Instrumentation and Measurement.

[11]  Lian Zhao,et al.  Synergism of INS and PDR in Self-Contained Pedestrian Tracking With a Miniature Sensor Module , 2010, IEEE Sensors Journal.

[12]  Ian Oppermann,et al.  UWB location and tracking for wireless embedded networks , 2006, Signal Process..

[13]  Andreas Eichhorn,et al.  IMU/magnetometer based 3D indoor positioning for wheeled platforms in NLoS scenarios , 2016, 2016 International Conference on Indoor Positioning and Indoor Navigation (IPIN).

[14]  Pavol Fedor,et al.  Autonomous flying with quadrocopter using fuzzy control and ArUco markers , 2017, Intell. Serv. Robotics.

[15]  Isaac Skog,et al.  Pedestrian tracking using an IMU array , 2014, 2014 IEEE International Conference on Electronics, Computing and Communication Technologies (CONECCT).

[16]  Alessio De Angelis,et al.  A constraint approach for UWB and PDR fusion , 2012, 2012 International Conference on Indoor Positioning and Indoor Navigation (IPIN).

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

[18]  Neeti Wagle,et al.  A Particle Filter Approach to WiFi Target Localization , 2010 .

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

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

[21]  G. Lachapelle,et al.  PEDESTRIAN DEAD RECKONING— A SOLUTION TO NAVIGATION IN GPS SIGNAL DEGRADED AREAS? , 2005 .