Simultaneous calibration and navigation (SCAN) of multiple ultrasonic local positioning systems

Abstract This paper proposes a Simultaneous Calibration and Navigation (SCAN) algorithm of a multiple Ultrasonic Local Positioning Systems (ULPSs) that cover an extensive indoor area. The idea is the development of the same concept than SLAM (Simultaneous Localization and Mapping), in which a Mobile Robot (MR) estimates the map while it is navigating. In our approach, the MR calibrates the beacons of several ULPSs while it is moving inside the localization area. The concept of calibration is the estimation of the position of the beacons referenced to a known map. The scenario is composed of some calibrated ULPSs that we denote as Globally Referenced Ultrasonic Local Positioning Systems (GRULPSs) that are located in strategic points like entrances covering the start and the end of a possible trajectory in the environment. Additionally, there are several non-calibrated ULPSs named Locally Referenced Ultrasonic Local Positioning Systems (LRULPSs) that are placed around the localization area. The proposal uses a MR with odometer for calibrating the beacons of the LRULPSs while it is navigating on their coverage area and go from one GRULPS to another. The algorithm is based on multiple filters running in parallel (one filter for each LRULPS and another one for the GRULPSs) that estimate the global and local trajectories of the MR (one trajectory for each local reference system of the LRULPSs) fusing the information related to the Ultrasound Signals (US) and the odometer of the MR. The position of the beacons of the LRULPSs are obtained by a transformation vector for each LRULPS that converts the local coordinates to the global reference system. This transformation vector is calculated using several points of a local trajectory and the corresponding points of the global one. The method is independent of the type of filter, provided that it works properly with non-linear systems and possibly non-Gaussian noise. Extended Kalman Filter (EKF), Unscented Kalman Filter (UKF) and H-∞ Filter have been tested, in simulations and real experiments, in order to compare their performance in this case.

[1]  Seth J. Teller,et al.  The cricket compass for context-aware mobile applications , 2001, MobiCom '01.

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

[3]  Joel J. P. C. Rodrigues,et al.  WicLoc: An indoor localization system based on WiFi fingerprints and crowdsourcing , 2015, 2015 IEEE International Conference on Communications (ICC).

[4]  Jun S. Liu,et al.  Sequential Monte Carlo methods for dynamic systems , 1997 .

[5]  Juan C. García,et al.  Extensive Ultrasonic Local Positioning System for navigating with mobile robots , 2013, 2013 10th Workshop on Positioning, Navigation and Communication (WPNC).

[6]  Álvaro Hernández,et al.  Optimal test-point positions for calibrating an ultrasonic LPS system , 2008, 2008 IEEE International Conference on Emerging Technologies and Factory Automation.

[7]  Anna Scaglione,et al.  Convergence and Applications of a Gossip-Based Gauss-Newton Algorithm , 2012, IEEE Transactions on Signal Processing.

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

[9]  Henry Cox,et al.  On the estimation of state variables and parameters for noisy dynamic systems , 1964 .

[10]  Dan Simon,et al.  A game theory approach to constrained minimax state estimation , 2006, IEEE Transactions on Signal Processing.

[11]  K. C. Ho,et al.  A simple and efficient estimator for hyperbolic location , 1994, IEEE Trans. Signal Process..

[12]  Fernando Figueroa,et al.  An automatic self-installation and calibration method for a 3D position sensing system using ultrasonics , 1999, Robotics Auton. Syst..

[13]  Hugh Durrant-Whyte,et al.  Simultaneous localization and mapping (SLAM): part II , 2006 .

[14]  Trung-Dung Vu,et al.  Grid-based localization and local mapping with moving object detection and tracking , 2011, Inf. Fusion.

[15]  Álvaro Hernández,et al.  Ultrasonic local positioning system for mobile robot navigation: From low to high level processing , 2015, 2015 IEEE International Conference on Industrial Technology (ICIT).

[16]  Swarun Kumar,et al.  Decimeter-Level Localization with a Single WiFi Access Point , 2016, NSDI.

[17]  Jesus Urena,et al.  LPS self-calibration method using a mobile robot , 2011, 2011 IEEE International Instrumentation and Measurement Technology Conference.

[18]  Hugh F. Durrant-Whyte,et al.  Simultaneous localization and mapping: part I , 2006, IEEE Robotics & Automation Magazine.

[19]  Hiroshi Mizoguchi,et al.  Portable ultrasonic 3D tag system based on a quick calibration method , 2004, 2004 IEEE International Conference on Systems, Man and Cybernetics (IEEE Cat. No.04CH37583).

[20]  K. J. Ray Liu,et al.  Time-reversal indoor positioning with centimeter accuracy using multi-antenna WiFi , 2016, 2016 IEEE Global Conference on Signal and Information Processing (GlobalSIP).

[21]  Min Yu,et al.  Study of fingerprint location algorithm based on WiFi technology for indoor localization , 2014 .

[22]  Paramvir Bahl,et al.  RADAR: an in-building RF-based user location and tracking system , 2000, Proceedings IEEE INFOCOM 2000. Conference on Computer Communications. Nineteenth Annual Joint Conference of the IEEE Computer and Communications Societies (Cat. No.00CH37064).

[23]  Andrew G. Dempster,et al.  Errors in determinstic wireless fingerprinting systems for localisation , 2008, 2008 3rd International Symposium on Wireless Pervasive Computing.

[24]  Senén Barro,et al.  Particle filter robot localisation through robust fusion of laser, WiFi, compass, and a network of external cameras , 2016, Inf. Fusion.

[25]  Juan C. García,et al.  Locally-Referenced Ultrasonic – LPS for Localization and Navigation , 2014, Sensors.

[26]  Jack Brassil,et al.  Improving Indoor Positioning Accuracy with Dense, Cooperating Beacons , 2014, MoWNet.

[27]  Rudolph van der Merwe,et al.  The unscented Kalman filter for nonlinear estimation , 2000, Proceedings of the IEEE 2000 Adaptive Systems for Signal Processing, Communications, and Control Symposium (Cat. No.00EX373).

[28]  Jean-Marc Delosme,et al.  Source location from time differences of arrival: Identifiability and estimation , 1980, ICASSP.

[29]  Álvaro Hernández,et al.  Measuring Time-of-Flight in an Ultrasonic LPS System Using Generalized Cross-Correlation , 2011, Sensors.

[30]  Álvaro Hernández,et al.  Advanced sensorial system for an acoustic LPS , 2007, Microprocess. Microsystems.