Integrated Indoor Navigation System for Ground Vehicles With Automatic 3-D Alignment and Position Initialization

This paper introduces an autonomous integrated indoor navigation system for ground vehicles that fuses inertial sensors, light detection and ranging (LiDAR) sensors, received signal strength (RSS) observations in wireless local area networks (WLANs), odometry, and predefined occupancy floor maps. This paper proposes a solution for the problem of automatic self-alignment and position initialization indoors under the absence of an absolute navigation system such as Global Navigation Satellite Systems (GNSS). The initial tilt angles (roll and pitch) are estimated by an extended Kalman filter (EKF) that uses two horizontal accelerometers as measurements. The initial position and heading estimation is performed using a subimage matching algorithm based on normalized cross-correlation between projected 2-D LiDAR scans and an occupancy floor map of the environment. The ambiguities in position/heading initialization are resolved using RSS. The proposed position/heading estimation module is also utilized in navigation mode as a source of absolute position/heading updates to EKF for enhanced observability. The state predictor is an enhanced 3-D inertial navigation system that utilizes low-cost microelectromechanical system (MEMS)-based reduced inertial sensor set aided by vehicle odometry. In navigation mode, LiDAR scans are used to estimate the vehicle's relative motions using an inertial-aided iterative closest point algorithm. To fuse all available measurements, a multirate multimode EKF design is proposed to correct navigation states and estimate sensor biases. The developed system was tested under a real indoor office environment covered by an IEEE 802.11 WLAN on a mobile robot platform equipped with MEMS inertial sensors, a WLAN interface, a 2-D LiDAR scanner, and a quadrature encoder. Results demonstrated the capabilities of the self-alignment and initialization module and showed average submeter-level positioning accuracy.

[1]  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).

[2]  Xun Li,et al.  Indoor positioning within a single camera and 3D maps , 2010, 2010 Ubiquitous Positioning Indoor Navigation and Location Based Service.

[3]  A. El-Rabbany.  Introduction to GPS: The Global Positioning System , 2002 .

[4]  Sang-Kook Han,et al.  An Indoor Visible Light Communication Positioning System Using a RF Carrier Allocation Technique , 2013, Journal of Lightwave Technology.

[5]  Aboelmagd Noureldin,et al.  Tightly Coupled Low Cost 3D RISS/GPS Integration Using a Mixture Particle Filter for Vehicular Navigation , 2011, Sensors.

[6]  Florent Lamiraux,et al.  Metric-based iterative closest point scan matching for sensor displacement estimation , 2006, IEEE Transactions on Robotics.

[7]  Gérard G. Medioni,et al.  Object modelling by registration of multiple range images , 1992, Image Vis. Comput..

[8]  Veerachai Malyavej,et al.  Indoor robot localization by RSSI/IMU sensor fusion , 2013, 2013 10th International Conference on Electrical Engineering/Electronics, Computer, Telecommunications and Information Technology.

[9]  Andrey Soloviev,et al.  Tight Coupling of Laser Scanner and Inertial Measurements for a Fully Autonomous Relative Navigation Solution , 2007 .

[10]  Stefanie Zollmann,et al.  FlyAR: Augmented Reality Supported Micro Aerial Vehicle Navigation , 2014, IEEE Transactions on Visualization and Computer Graphics.

[11]  D. Titterton,et al.  Strapdown inertial navigation technology - 2nd edition - [Book review] , 2005, IEEE Aerospace and Electronic Systems Magazine.

[12]  Bofeng Li,et al.  Real-Time Kinematic positioning using fused data from multiple GNSS antennas , 2012, 2012 15th International Conference on Information Fusion.

[13]  Martin David Adams,et al.  The Estimation Theoretic Sensor Bias Correction Problem in Map Aided Localization , 2006, Int. J. Robotics Res..

[14]  J. Sarvaiya,et al.  Image Registration by Template Matching Using Normalized Cross-Correlation , 2009, 2009 International Conference on Advances in Computing, Control, and Telecommunication Technologies.

[15]  U. Iqbal,et al.  An integrated reduced inertial sensor system — RISS / GPS for land vehicle , 2008, 2008 IEEE/ION Position, Location and Navigation Symposium.

[16]  Avinash C. Kak,et al.  Vision for Mobile Robot Navigation: A Survey , 2002, IEEE Trans. Pattern Anal. Mach. Intell..

[17]  Gyu-In Jee,et al.  GPS multipath detection based on sequence of successive-time double-differences , 2004, IEEE Signal Processing Letters.

[18]  Jay A. Farrell,et al.  Aided Navigation: GPS with High Rate Sensors , 2008 .

[19]  H. Ahn,et al.  Fast alignment using rotation vector and adaptive Kalman filter , 2006 .

[20]  Aboelmagd Noureldin,et al.  Dynamic Online-Calibrated Radio Maps for Indoor Positioning in Wireless Local Area Networks , 2013, IEEE Transactions on Mobile Computing.

[21]  Michal Reinstein,et al.  Evaluation of the EKF-Based Estimation Architectures for Data Fusion in Mobile Robots , 2015, IEEE/ASME Transactions on Mechatronics.

[22]  Andrea Censi,et al.  An ICP variant using a point-to-line metric , 2008, 2008 IEEE International Conference on Robotics and Automation.

[23]  Qingquan Li,et al.  A Sensor-Fusion Drivable-Region and Lane-Detection System for Autonomous Vehicle Navigation in Challenging Road Scenarios , 2014, IEEE Transactions on Vehicular Technology.

[24]  M. M. Atia,et al.  A WiFi-aided reduced inertial sensors-based navigation system with fast embedded implementation of particle filtering , 2012, 2012 8th International Symposium on Mechatronics and its Applications.

[25]  Lindsay Kleeman,et al.  Laser scan matching in polar coordinates with application to SLAM , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[26]  J. Leclerc.  MEMs for Aerospace Navigation , 2007, IEEE Aerospace and Electronic Systems Magazine.

[27]  Luigi Cinque,et al.  An Autonomous Vehicle for Video Surveillance of Indoor Environments , 2007, IEEE Transactions on Vehicular Technology.

[28]  Salah Sukkarieh,et al.  Visual-Inertial-Aided Navigation for High-Dynamic Motion in Built Environments Without Initial Conditions , 2012, IEEE Transactions on Robotics.

[29]  An Li,et al.  Strapdown inertial navigation system alignment based on marginalised unscented kalman filter , 2013 .

[30]  Paul J. Besl,et al.  A Method for Registration of 3-D Shapes , 1992, IEEE Trans. Pattern Anal. Mach. Intell..

[31]  John Weston,et al.  Strapdown Inertial Navigation Technology , 1997 .

[32]  M. Kayton,et al.  Global positioning system: signals, measurements, and performance [Book Review] , 2002, IEEE Aerospace and Electronic Systems Magazine.

[33]  Jianwen Xie,et al.  An image template matching method using particle swarm optimization , 2009, 2009 Asia-Pacific Conference on Computational Intelligence and Industrial Applications (PACIIA).

[34]  Soon-Yong Park,et al.  Polar-Cartesian Hybrid Transforms: A novel 2D range scan registration algorithm , 2013 .

[35]  Sukhan Lee,et al.  Embedded Visual SLAM: Applications for Low-Cost Consumer Robots , 2013, IEEE Robotics & Automation Magazine.

[36]  Marc Levoy,et al.  Efficient variants of the ICP algorithm , 2001, Proceedings Third International Conference on 3-D Digital Imaging and Modeling.

[37]  C. Boucher,et al.  Hybrid filtering for map-aided vehicle navigation , 2006, 2006 IEEE International Conference on Computational Intelligence for Measurement Systems and Applications.

[38]  Ignas Niemegeers,et al.  A survey of indoor positioning systems for wireless personal networks , 2009, IEEE Communications Surveys & Tutorials.

[39]  Jeong Gu Lee,et al.  Multiposition alignment of strapdown inertial navigation system , 1993 .

[40]  Xiaoji Niu,et al.  Analysis and Modeling of Inertial Sensors Using Allan Variance , 2008, IEEE Transactions on Instrumentation and Measurement.