An Adaptive Scheme for Robot Localization and Mapping with Dynamically Configurable Inter-Beacon Range Measurements

This work is motivated by robot-sensor network cooperation techniques where sensor nodes (beacons) are used as landmarks for range-only (RO) simultaneous localization and mapping (SLAM). This paper presents a RO-SLAM scheme that actuates over the measurement gathering process using mechanisms that dynamically modify the rate and variety of measurements that are integrated in the SLAM filter. It includes a measurement gathering module that can be configured to collect direct robot-beacon and inter-beacon measurements with different inter-beacon depth levels and at different rates. It also includes a supervision module that monitors the SLAM performance and dynamically selects the measurement gathering configuration balancing SLAM accuracy and resource consumption. The proposed scheme has been applied to an extended Kalman filter SLAM with auxiliary particle filters for beacon initialization (PF-EKF SLAM) and validated with experiments performed in the CONET Integrated Testbed. It achieved lower map and robot errors (34% and 14%, respectively) than traditional methods with a lower computational burden (16%) and similar beacon energy consumption.

[1]  J. Ramiro Martinez de Dios,et al.  An Integrated Testbed for Cooperative Perception with Heterogeneous Mobile and Static Sensors , 2011, Sensors.

[2]  Aníbal Ollero,et al.  A general Gaussian-mixture approach for range-only mapping using multiple hypotheses , 2010, 2010 IEEE International Conference on Robotics and Automation.

[3]  A. Zanella,et al.  Autonomous discovery, localization and recognition of smart objects through WSN and image features , 2010, 2010 IEEE Globecom Workshops.

[4]  Javier González,et al.  Efficient probabilistic Range-Only SLAM , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Teresa A. Vidal-Calleja,et al.  Active control for single camera SLAM , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[6]  Carlos Sagüés,et al.  Motion control strategies for improved multi robot perception , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[7]  Aníbal Ollero,et al.  Efficient robot-sensor network distributed SEIF range-only SLAM , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[8]  J. Ramiro Martinez de Dios,et al.  Integrating Internode Measurements in Sum of Gaussians Range Only SLAM , 2013, ROBOT.

[9]  Y. Charlie Hu,et al.  Sensor replacement using mobile robots , 2007, Comput. Commun..

[10]  Simone Frintrop,et al.  Attentional Landmarks and Active Gaze Control for Visual SLAM , 2008, IEEE Transactions on Robotics.

[11]  Aníbal Ollero,et al.  A WSN-Based Tool for Urban and Industrial Fire-Fighting , 2012, Sensors.

[12]  Thierry Dumont,et al.  Simultaneous localization and mapping in wireless sensor networks , 2014, Signal Process..

[13]  Hui Zhang,et al.  Simultaneous localization and mapping of Robot in Wireless Sensor Network , 2010, 2010 IEEE International Conference on Intelligent Computing and Intelligent Systems.

[14]  Emanuele Menegatti,et al.  Range-only SLAM with a mobile robot and a Wireless Sensor Networks , 2009, 2009 IEEE International Conference on Robotics and Automation.

[15]  Bernhard Nebel,et al.  RFID Technology-based Exploration and SLAM for Search And Rescue , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[16]  Gamini Dissanayake,et al.  Active SLAM using Model Predictive Control and Attractor based Exploration , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[17]  Adam Wolisz,et al.  Cooperating Embedded Systems and Wireless Sensor Networks , 2007 .

[18]  Heinrich Niemann,et al.  Active Visual Object Reconstruction using D-, E-, and T-Optimal Next Best Views , 2007, 2007 IEEE Conference on Computer Vision and Pattern Recognition.

[19]  Aníbal Ollero,et al.  Active sensing for range-only mapping using multiple hypothesis , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[20]  David W. Murray,et al.  Simultaneous Localization and Map-Building Using Active Vision , 2002, IEEE Trans. Pattern Anal. Mach. Intell..

[21]  Aníbal Ollero,et al.  A distributed architecture for a robotic platform with aerial sensor transportation and self‐deployment capabilities , 2011, J. Field Robotics.

[22]  E. Olson,et al.  Robust Range-Only Beacon Localization , 2004, IEEE Journal of Oceanic Engineering.

[23]  H. S. Wolff,et al.  iRun: Horizontal and Vertical Shape of a Region-Based Graph Compression , 2022, Sensors.

[24]  Juan Andrade-Cetto,et al.  Information-Based Compact Pose SLAM , 2010, IEEE Transactions on Robotics.

[25]  Fernando Lobo Pereira,et al.  Cooperative Autonomous Underwater Vehicle localization , 2010, OCEANS'10 IEEE SYDNEY.

[26]  Katia P. Sycara,et al.  Energy efficient data collection with mobile robots in heterogeneous sensor networks , 2013, 2013 IEEE International Conference on Robotics and Automation.

[27]  Sanjiv Singh,et al.  Range-only SLAM for robots operating cooperatively with sensor networks , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[28]  Dali Sun,et al.  Multi-robot Range-Only SLAM by Active Sensor Nodes for Urban Search and Rescue , 2008, RoboCup.

[29]  J. R. Martinez-de Dios,et al.  Cooperation Between UAS and Wireless Sensor Networks for Efficient Data Collection in Large Environments , 2013, J. Intell. Robotic Syst..