Vision-Based Coordinated Localization for Mobile Sensor Networks

In this paper, we propose a coordinated localization algorithm for mobile sensor networks with camera sensors to operate under Global Positioning System (GPS) denied areas or indoor environments. Mobile robots are partitioned into two groups. One group moves within the field of views of remaining stationary robots. The moving robots are tracked by stationary robots and their trajectories are used as spatiotemporal features. From these spatiotemporal features, relative poses of robots are computed using multiview geometry and a group of robots is localized with respect to the reference coordinate based on the proposed multirobot localization. Once poses of all robots are recovered, a group of robots moves from one location to another while maintaining the formation of robots for coordinated localization under the proposed multirobot navigation strategy. By taking the advantage of a multiagent system, we can reliably localize robots over time as they perform a group task. In experiment, we demonstrate that the proposed method consistently achieves a localization error rate of 0.37% or less for trajectories of length between 715 cm and 890 cm using an inexpensive off-the-shelf robotic platform.

[1]  Gaurav S. Sukhatme,et al.  Mobile Robot Sensing for Environmental Applications , 2007, FSR.

[2]  Steven M. LaValle,et al.  Randomized Kinodynamic Planning , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[3]  Howie Choset,et al.  Leap-Frog Path Design for Multi-Robot Cooperative Localization , 2009, FSR.

[4]  G LoweDavid,et al.  Distinctive Image Features from Scale-Invariant Keypoints , 2004 .

[5]  Randal W. Beard,et al.  Bearing-only Cooperative Localization , 2013, J. Intell. Robotic Syst..

[6]  Peter Volgyesi,et al.  Towards Precise Indoor RF Localization , 2008 .

[7]  Richard M. Murray,et al.  Consensus problems in networks of agents with switching topology and time-delays , 2004, IEEE Transactions on Automatic Control.

[8]  Michael R. M. Jenkin,et al.  Computational principles of mobile robotics , 2000 .

[9]  Sonia Martínez,et al.  Coverage control for mobile sensing networks , 2002, IEEE Transactions on Robotics and Automation.

[10]  S. Shankar Sastry,et al.  Markov Chain Monte Carlo Data Association for Multi-Target Tracking , 2009, IEEE Transactions on Automatic Control.

[11]  C. Guestrin,et al.  Distributed localization of networked cameras , 2006, 2006 5th International Conference on Information Processing in Sensor Networks.

[12]  Randal W. Beard,et al.  Consensus seeking in multiagent systems under dynamically changing interaction topologies , 2005, IEEE Transactions on Automatic Control.

[13]  Wolfram Burgard,et al.  Cooperative robot localization and target tracking based on least squares minimization , 2013, 2013 IEEE International Conference on Robotics and Automation.

[14]  Max Mintz,et al.  Cooperative Control for Localization of Mobile Sensor Networks , 2003 .

[15]  S. Shankar Sastry,et al.  Tracking and Coordination of Multiple Agents Using Sensor Networks: System Design, Algorithms and Experiments , 2007, Proceedings of the IEEE.

[16]  S. Shankar Sastry,et al.  Automatic Camera Network Localization using Object Image Tracks , 2007, 2007 IEEE 11th International Conference on Computer Vision.

[17]  Kiam Tian Seow,et al.  Discrete-Event Coordination Design for Distributed Agents , 2012, IEEE Transactions on Automation Science and Engineering.

[18]  Songhwai Oh,et al.  A cooperative localization algorithm for mobile sensor networks , 2012, 2012 IEEE International Conference on Automation Science and Engineering (CASE).

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

[20]  Robert C. Bolles,et al.  Random sample consensus: a paradigm for model fitting with applications to image analysis and automated cartography , 1981, CACM.

[21]  Volkan Isler,et al.  Sensor Placement for Triangulation-Based Localization , 2010, IEEE Transactions on Automation Science and Engineering.

[22]  G.B. Giannakis,et al.  Localization via ultra-wideband radios: a look at positioning aspects for future sensor networks , 2005, IEEE Signal Processing Magazine.

[23]  S. Shankar Sastry,et al.  An Invitation to 3-D Vision , 2004 .

[24]  Eduardo Tovar,et al.  GTS allocation analysis in IEEE 802.15.4 for real-time wireless sensor networks , 2006, Proceedings 20th IEEE International Parallel & Distributed Processing Symposium.

[25]  Yong Chen,et al.  Robust Calibration for Localization in Clustered Wireless Sensor Networks , 2007, 2007 IEEE International Conference on Automation Science and Engineering.

[26]  Ioannis M. Rekleitis,et al.  I see you, you see me: Cooperative localization through bearing-only mutually observing robots , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[27]  Jiri Matas,et al.  Robust wide-baseline stereo from maximally stable extremal regions , 2004, Image Vis. Comput..

[28]  Alcherio Martinoli,et al.  Accurate indoor localization with ultra-wideband using spatial models and collaboration , 2014, Int. J. Robotics Res..

[29]  David E. Culler,et al.  The effects of ranging noise on multihop localization: an empirical study , 2005, IPSN 2005. Fourth International Symposium on Information Processing in Sensor Networks, 2005..

[30]  Camillo J. Taylor,et al.  Self Localizing Smart Camera Networks and their Applications to 3 D Modeling , 2006 .

[31]  Miklós Maróti,et al.  Radio interferometric geolocation , 2005, SenSys '05.

[32]  George J. Pappas,et al.  Stability of Flocking Motion , 2003 .