Generating informative paths for persistent sensing in unknown environments

We present an online algorithm for a robot to shape its path to a locally optimal configuration for collecting information in an unknown dynamic environment. As the robot travels along its path, it identifies both where the environment is changing, and how fast it is changing. The algorithm then morphs the robot's path online to concentrate on the dynamic areas in the environment in proportion to their rate of change. A Lyapunov-like stability proof is used to show that, under our proposed path shaping algorithm, the path converges to a locally optimal configuration according to a Voronoi-based coverage criterion. The path shaping algorithm is then combined with a previously introduced speed controller to produce guaranteed persistent monitoring trajectories for a robot in an unknown dynamic environment. Simulation and experimental results with a quadrotor robot support the proposed approach.

[1]  Randy S. Roberts,et al.  An adaptive path planning algorithm for cooperating unmanned air vehicles , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[2]  Oussama Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1986 .

[3]  Bernhard Nebel,et al.  Decentralized collision avoidance, deadlock detection, and deadlock resolution for multiple mobile robots , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[4]  Zack J. Butler,et al.  Distributed Planning and Control for Modular Robots with Unit-Compressible Modules , 2003, Int. J. Robotics Res..

[5]  Daniela Rus,et al.  Collision avoidance for persistent monitoring in multi-robot systems with intersecting trajectories , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Seth Hutchinson,et al.  Coordinating the motions of multiple robots with specified trajectories , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[7]  Steven M. LaValle,et al.  Optimal motion planning for multiple robots having independent goals , 1998, IEEE Trans. Robotics Autom..

[8]  Rachid Alami,et al.  A Scheme for Coordinating Multi-robots Planning Activities and Plans Execution , 1998, ECAI.

[9]  Aurelio Piazzi,et al.  ${ \mmb{\eta } }^{3}$-Splines for the Smooth Path Generation of Wheeled Mobile Robots , 2007, IEEE Transactions on Robotics.

[10]  De-Bao Sun,et al.  Path planning for mobile robot using the particle swarm optimization with mutation operator , 2004, Proceedings of 2004 International Conference on Machine Learning and Cybernetics (IEEE Cat. No.04EX826).

[11]  Petros A. Ioannou,et al.  Robust Adaptive Control , 2012 .

[12]  Vijay Kumar,et al.  Simultaneous Coverage and Tracking (SCAT) of Moving Targets with Robot Networks , 2008, WAFR.

[13]  Jorge Cortés,et al.  Adaptive Information Collection by Robotic Sensor Networks for Spatial Estimation , 2012, IEEE Transactions on Automatic Control.

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

[15]  Mac Schwager,et al.  Consensus learning for distributed coverage control , 2008, 2008 IEEE International Conference on Robotics and Automation.

[16]  Kostas J. Kyriakopoulos,et al.  Minimum jerk path generation , 1988, Proceedings. 1988 IEEE International Conference on Robotics and Automation.

[17]  Tamio Arai,et al.  Collision Avoidance Among Multiple Robots Using Virtual Impedance , 1989, Proceedings. IEEE/RSJ International Workshop on Intelligent Robots and Systems '. (IROS '89) 'The Autonomous Mobile Robots and Its Applications.

[18]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

[19]  Marilena Vendittelli,et al.  WMR control via dynamic feedback linearization: design, implementation, and experimental validation , 2002, IEEE Trans. Control. Syst. Technol..

[20]  I. Kroo,et al.  Persistent Surveillance Using Multiple Unmanned Air Vehicles , 2008, 2008 IEEE Aerospace Conference.

[21]  Geoffrey A. Hollinger,et al.  Multi-robot coordination with periodic connectivity , 2010, 2010 IEEE International Conference on Robotics and Automation.

[22]  Tomás Lozano-Pérez,et al.  Deadlock-free and collision-free coordination of two robot manipulators , 1989, Proceedings, 1989 International Conference on Robotics and Automation.

[23]  J. How,et al.  Information-rich Path Planning with General Constraints using Rapidly-exploring Random Trees , 2010 .

[24]  Domitilla Del Vecchio,et al.  Formal design of a provably safe robotic roundabout system , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[25]  Mac Schwager,et al.  Decentralized, Adaptive Control for Coverage with Networked Robots , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[26]  Mac Schwager,et al.  Decentralized, Adaptive Coverage Control for Networked Robots , 2009, Int. J. Robotics Res..

[27]  Jorge Cortés,et al.  Distributed Kriged Kalman Filter for Spatial Estimation , 2009, IEEE Transactions on Automatic Control.

[28]  Rachid Alami,et al.  How to solve deadlock situations within the plan-merging paradigm for multi-robot cooperation , 1997, Proceedings of the 1997 IEEE/RSJ International Conference on Intelligent Robot and Systems. Innovative Robotics for Real-World Applications. IROS '97.

[29]  M. A. Dahleh,et al.  Constraints on locational optimization problems , 2003, 42nd IEEE International Conference on Decision and Control (IEEE Cat. No.03CH37475).

[30]  Naomi Ehrich Leonard,et al.  Cooperative Filters and Control for Cooperative Exploration , 2010, IEEE Transactions on Automatic Control.

[31]  Alexei Makarenko,et al.  Information based adaptive robotic exploration , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[32]  Howie Choset,et al.  Coverage for robotics – A survey of recent results , 2001, Annals of Mathematics and Artificial Intelligence.

[33]  Albert L. Schoute,et al.  Deadlock-free traffic control with geometrical critical sections , 1994 .

[34]  Mac Schwager,et al.  Persistent Robotic Tasks: Monitoring and Sweeping in Changing Environments , 2011, IEEE Transactions on Robotics.

[35]  Dinesh Manocha,et al.  The Hybrid Reciprocal Velocity Obstacle , 2011, IEEE Transactions on Robotics.

[36]  Srinivas Akella,et al.  Coordinating Multiple Robots with Kinodynamic Constraints Along Specified Paths , 2005, Int. J. Robotics Res..

[37]  Mac Schwager,et al.  Persistent monitoring of changing environments using a robot with limited range sensing , 2011, 2011 IEEE International Conference on Robotics and Automation.

[38]  Anthony Stentz,et al.  Optimal and efficient path planning for partially-known environments , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[39]  Randy A. Freeman,et al.  Decentralized Environmental Modeling by Mobile Sensor Networks , 2008, IEEE Transactions on Robotics.

[40]  A. Volgenant,et al.  Facility location: a survey of applications and methods , 1996 .

[41]  Noa Agmon,et al.  Multi-robot area patrol under frequency constraints , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[42]  George J. Pappas,et al.  On trajectory optimization for active sensing in Gaussian process models , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[43]  Andreas Krause,et al.  Efficient Informative Sensing using Multiple Robots , 2014, J. Artif. Intell. Res..