Motion-aided network SLAM with range

A key problem in the deployment of sensor networks is that of determining the location of each sensor such that subsequent data gathered can be registered. We would also like the network to provide localization for mobile entities, allowing them to navigate and explore the environment. In this paper, we present a thorough evaluation of our algorithm for localizing and mapping the mobile and stationary nodes in sparsely connected sensor networks using range-only measurements and odometry from the mobile node. Our approach utilizes an extended Kalman filter (EKF) in polar space allowing us to model the non-linearity within the range-only measurements using Gaussian distributions. Utilizing the motion information from a mobile node, we show additional improvements to the static network localization solution. In addition to this centralized filtering technique, an asynchronous and decentralized approach is investigated and experimentally proven. This decentralized filtering technique distributes the computation across all nodes in the network, leveraging their numbers for improved efficiency. We demonstrate the effectiveness of our approach using simulated and real-world experiments in challenging environments with limited network connectivity. Our results reveal that our proposed method offers good accuracy in these challenging environments even when little to no prior information is available. Additionally, it is shown that by initializing the network map with a static network solution, the network mapping with a mobile node can be further improved.

[1]  A.S. Willsky,et al.  Nonparametric belief propagation for self-calibration in sensor networks , 2004, Third International Symposium on Information Processing in Sensor Networks, 2004. IPSN 2004.

[2]  Benjamin Grocholsky,et al.  Modeling mobile robot motion with polar representations , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[3]  Sanjiv Singh,et al.  Parrots: A Range Measuring Sensor Network , 2006 .

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

[5]  Randy A. Freeman,et al.  Distributed Cooperative Active Sensing Using Consensus Filters , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[6]  Pat Hanrahan,et al.  Distributed Algorithm , 2008, Encyclopedia of GIS.

[7]  M. Cao,et al.  Agreeing Asynchronously: Announcement of Results , 2006, Proceedings of the 45th IEEE Conference on Decision and Control.

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

[9]  Christian Lavault,et al.  A distributed algorithm for constructing a minimum diameter spanning tree , 2004, J. Parallel Distributed Comput..

[10]  Avi Pfeffer,et al.  Asynchronous Dynamic Bayesian Networks , 2005, UAI.

[11]  Hari Balakrishnan,et al.  6th ACM/IEEE International Conference on on Mobile Computing and Networking (ACM MOBICOM ’00) The Cricket Location-Support System , 2022 .

[12]  Brian D. O. Anderson,et al.  Reaching a Consensus in a Dynamically Changing Environment: Convergence Rates, Measurement Delays, and Asynchronous Events , 2008, SIAM J. Control. Optim..

[13]  Alexei Makarenko,et al.  Decentralised Data Fusion And Control In Active Sensor Networks , 2004 .

[14]  Christos Faloutsos,et al.  FastMap: a fast algorithm for indexing, data-mining and visualization of traditional and multimedia datasets , 1995, SIGMOD '95.

[15]  David C. Moore,et al.  Robust distributed network localization with noisy range measurements , 2004, SenSys '04.

[16]  Benjamin Grocholsky,et al.  Decentralized mapping of robot-aided sensor networks , 2008, 2008 IEEE International Conference on Robotics and Automation.

[17]  Sanjiv Singh,et al.  A Robust Method of Localization and Mapping Using Only Range , 2008, ISER.

[18]  Richard T. Vaughan,et al.  The Player/Stage Project: Tools for Multi-Robot and Distributed Sensor Systems , 2003 .

[19]  Volkan Isler,et al.  Triangulation Based Multi Target Tracking with Mobile Sensor Networks , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[20]  B. Brumback,et al.  A Chi-square test for fault-detection in Kalman filters , 1987 .

[21]  R. Prim.  Shortest connection networks and some generalizations , 1957 .

[22]  Michael J. Carey,et al.  Proceedings of the 1995 ACM SIGMOD International Conference on Management of Data, San Jose, California, USA, May 22-25, 1995 , 1995, PODS 1995.

[23]  C. N. Liu,et al.  Approximating discrete probability distributions with dependence trees , 1968, IEEE Trans. Inf. Theory.

[24]  P. Groenen,et al.  Modern Multidimensional Scaling: Theory and Applications , 1999 .

[25]  B. Anderson,et al.  Agreeing Asynchronously in Continuous Time ∗ , 2006 .

[26]  Rahul Sukthankar,et al.  Distributed localization of networked cameras , 2006, 2006 5th International Conference on Information Processing in Sensor Networks.

[27]  Judea Pearl,et al.  Probabilistic reasoning in intelligent systems - networks of plausible inference , 1991, Morgan Kaufmann series in representation and reasoning.

[28]  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..

[29]  Sebastian Thrun,et al.  Decentralized Sensor Fusion with Distributed Particle Filters , 2002, UAI.

[30]  Leonidas J. Guibas,et al.  Collaborative signal and information processing: an information-directed approach , 2003 .

[31]  Xavier Boyen,et al.  Tractable Inference for Complex Stochastic Processes , 1998, UAI.

[32]  Hanumant Singh,et al.  Synchronous‐clock, one‐way‐travel‐time acoustic navigation for underwater vehicles , 2011, J. Field Robotics.

[33]  Hari Balakrishnan,et al.  Tracking moving devices with the cricket location system , 2004, MobiSys '04.

[34]  Sebastian Thrun,et al.  Perspectives on standardization in mobile robot programming: the Carnegie Mellon Navigation (CARMEN) Toolkit , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).