Collaborative localization of robotic wheeled walkers using interlaced Extended Kalman Filters

This paper deals with the problem of localizing a group of robots. Each robot is equipped with an autonomous self-localization system based on both high-rate odometers and a front camera detecting sporadically simple visual landmarks placed on the floor at known positions and with a known attitude within a given 2D reference frame. In addition, the robots can share their own states to improve localization accuracy. In this paper, after reviewing the general problem of collaborative localization, two potential strategies based on a distributed Interlaced Extended Kalman Filter (IEKF) are compared. In the first one, localization is refined through high-rate mutual measurements of Euclidean distance between pairs of robots. The distance values are obtained using an omni-directional wireless ranging system of limited accuracy. In the second one, an on-board Kinect-like front RGB-D vision system is assumed to measure the agent's relative position with respect to other robots in view at a lower rate, but with higher accuracy. To the best of authors' knowledge, this performance comparison is new, since most of previous studies on collaborative localization are overoptimistic as implicitly assume that mutual agent measurements are not intermittent and are available at all sampling times.

[1]  Ayman Elnashar,et al.  Looking at LTE in Practice: A Performance Analysis of the LTE System Based on Field Test Results , 2013, IEEE Vehicular Technology Magazine.

[2]  Luyang Li,et al.  A Simple and Parallel Algorithm for Real-Time Robot Localization by Fusing Monocular Vision and Odometry/AHRS Sensors , 2014, IEEE/ASME Transactions on Mechatronics.

[3]  Stergios I. Roumeliotis,et al.  Synergetic localization for groups of mobile robots , 2000, Proceedings of the 39th IEEE Conference on Decision and Control (Cat. No.00CH37187).

[4]  Johann Borenstein,et al.  Sensor fusion for mobile robot dead-reckoning with a precision-calibrated fiber optic gyroscope , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[5]  Nima Alam,et al.  Collaborative navigation with ground vehicles and personal navigators , 2012, 2012 International Conference on Indoor Positioning and Indoor Navigation (IPIN).

[6]  Thia Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation: Theory, Algorithms and Software , 2001 .

[7]  Seth Hutchinson,et al.  IMU-camera data fusion: Horizontal plane observation with explicit outlier rejection , 2013, International Conference on Indoor Positioning and Indoor Navigation.

[8]  R. Michael Buehrer,et al.  Cooperative indoor position location using the parallel projection method , 2010, 2010 International Conference on Indoor Positioning and Indoor Navigation.

[9]  Marco Dionigi,et al.  A 5.6-GHz UWB Position Measurement System , 2013, IEEE Transactions on Instrumentation and Measurement.

[10]  Matthew R. Walter,et al.  Consistent cooperative localization , 2009, 2009 IEEE International Conference on Robotics and Automation.

[11]  Mihai V. Micea,et al.  Relative positioning system using Inter-Robot Ultrasonic Localization Turret , 2014, 2014 IEEE International Instrumentation and Measurement Technology Conference (I2MTC) Proceedings.

[12]  Stefano Panzieri,et al.  Multirobot Localisation Using Interlaced Extended Kalman Filter , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[13]  Luigi Palopoli,et al.  Design and performance analysis of an indoor position tracking technique for smart rollators , 2013, International Conference on Indoor Positioning and Indoor Navigation.

[14]  Daniele Fontanelli,et al.  A Data Fusion Technique for Wireless Ranging Performance Improvement , 2013, IEEE Transactions on Instrumentation and Measurement.

[15]  Mihai V. Micea,et al.  Relative localization methodology for autonomous robots in collaborative environments , 2013, 2013 IEEE International Instrumentation and Measurement Technology Conference (I2MTC).

[16]  M. Monti,et al.  The synergic localization system (SLS) , 2005, VTC-2005-Fall. 2005 IEEE 62nd Vehicular Technology Conference, 2005..

[17]  Joachim Hertzberg,et al.  High-speed laser localization for mobile robots , 2005, Robotics Auton. Syst..

[18]  David Macii,et al.  Performance evaluation of Chirp Spread Spectrum ranging for indoor embedded navigation systems , 2012, 7th IEEE International Symposium on Industrial Embedded Systems (SIES'12).

[19]  Hugh F. Durrant-Whyte,et al.  Decentralised cooperative localisation for heterogeneous teams of mobile robots , 2011, 2011 IEEE International Conference on Robotics and Automation.

[20]  Sidney Nascimento Givigi,et al.  Vision-Based Measurement for Localization of Objects in 3-D for Robotic Applications , 2015, IEEE Transactions on Instrumentation and Measurement.

[21]  Alcherio Martinoli,et al.  A reciprocal sampling algorithm for lightweight distributed multi-robot localization , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[22]  Chankil Lee,et al.  Indoor positioning: A review of indoor ultrasonic positioning systems , 2013, 2013 15th International Conference on Advanced Communications Technology (ICACT).

[23]  Lorenzo Sciavicco,et al.  Distributed Cooperative Localization , 2013, J. Inf. Technol. Res..

[24]  Takuya Maekawa,et al.  Spring Model Based Collaborative Indoor Position Estimation With Neighbor Mobile Devices , 2015, IEEE Journal of Selected Topics in Signal Processing.

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

[26]  Remo Sala,et al.  A metrological characterization of the Kinect V2 time-of-flight camera , 2016, Robotics Auton. Syst..

[27]  Luigi Palopoli,et al.  Indoor Positioning of a Robotic Walking Assistant for Large Public Environments , 2015, IEEE Transactions on Instrumentation and Measurement.

[28]  Prabir Barooah,et al.  Collaborative localization with heterogeneous inter-robot measurements by Riemannian optimization , 2013, 2013 IEEE International Conference on Robotics and Automation.

[29]  Chen Liang,et al.  Survey of WLAN fingerprinting positioning system , 2012, 2012 First National Conference for Engineering Sciences (FNCES 2012).