Interactive planning and sensing in unknown static environments with task-driven sensor placement

We address planar path-planning for a mobile vehicle to traverse a planar workspace with minimum exposure to a spatially varying scalar field called the threat field. The threat field is unknown, and is estimated by a finite number of sensors that take pointwise noisy measurements. We propose an iterative sensor placement and path-planning algorithm. At each iteration, regions of interest in the workspace are identified near the path with minimum estimated cost, and the next set of sensor locations is determined to improve the confidence of threat field estimates in these regions of interest. This paper breaks new ground in dynamic data-driven autonomy, in that an explicit bidirectional interaction between a path-planning algorithm and a sensor network separate from the actor vehicle is established. We provide theoretical results and corroborative numerical simulation results on the convergence and optimality of the proposed iterative algorithm. We show that the proposed algorithm provides significant improvements over existing approaches, including information-maximizing sensor placement methods.

[1]  Puneet Singla,et al.  Computation of probabilistic hazard maps and source parameter estimation for volcanic ash transport and dispersion , 2014, J. Comput. Phys..

[2]  Michael A. Demetriou,et al.  Coupled Controls-Computational Fluids Approach for the Estimation of the Concentration From a Moving Gaseous Source in a 2-D Domain With a Lyapunov-Guided Sensing Aerial Vehicle , 2014, IEEE Transactions on Control Systems Technology.

[3]  Nicholas M. Patrikalakis,et al.  Global motion planning under uncertain motion, sensing, and environment map , 2011, Auton. Robots.

[4]  Andreas Krause,et al.  Near-optimal sensor placements in Gaussian processes , 2005, ICML.

[5]  Jonathan P. How,et al.  Two-Stage Focused Inference for Resource-Constrained Collision-Free Navigation , 2015, Robotics: Science and Systems.

[6]  Daniel Pack,et al.  Optimal UAV Sensor Management and Path Planning for Tracking Multiple Mobile Targets , 2014 .

[7]  Jongeun Choi,et al.  Efficient Bayesian spatial prediction with mobile sensor networks using Gaussian Markov random fields , 2012, 2012 American Control Conference (ACC).

[8]  Ronen I. Brafman,et al.  A Heuristic Search Approach to Planning with Continuous Resources in Stochastic Domains , 2009, J. Artif. Intell. Res..

[9]  Luc Pronzato,et al.  Optimal experimental design and some related control problems , 2008, Autom..

[10]  S. LaValle,et al.  Randomized Kinodynamic Planning , 2001 .

[11]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[12]  Arthur E. Bryson,et al.  Applied Optimal Control , 1969 .

[13]  Gints Jekabsons,et al.  A comparison of subset selection and adaptive basis function construction for polynomial regression model building , 2009, Sci. J. Riga Tech. Univ. Ser. Comput. Sci..

[14]  Minyue Fu,et al.  A distributed Kalman filtering algorithm with fast finite-time convergence for sensor networks , 2018, Autom..

[15]  José M. F. Moura,et al.  Consensus+Innovations Distributed Kalman Filter With Optimized Gains , 2016, IEEE Transactions on Signal Processing.

[16]  Puneet Singla,et al.  Information driven optimal sensor control for efficient target localization and tracking , 2014, 2014 American Control Conference.

[17]  Jorge Cortes,et al.  Distributed Control of Robotic Networks: A Mathematical Approach to Motion Coordination Algorithms , 2009 .

[18]  Andreas Krause,et al.  Near-Optimal Sensor Placements in Gaussian Processes: Theory, Efficient Algorithms and Empirical Studies , 2008, J. Mach. Learn. Res..

[19]  Dimitri P. Bertsekas,et al.  Dynamic Programming and Optimal Control, Two Volume Set , 1995 .

[20]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[21]  Xiaoming Hu,et al.  Decentralized cooperative tracking subject to motion constraints , 2018, Autom..

[22]  Alfred O. Hero,et al.  Information-driven sensor planning: Navigating a statistical manifold , 2013, 2013 IEEE Global Conference on Signal and Information Processing.

[23]  Francesco Bullo,et al.  Optimal sensor placement and motion coordination for target tracking , 2006, Autom..

[24]  Lang Tong,et al.  Estimation After Parameter Selection: Performance Analysis and Estimation Methods , 2015, IEEE Transactions on Signal Processing.

[25]  N. Roy,et al.  The Belief Roadmap: Efficient Planning in Belief Space by Factoring the Covariance , 2009, Int. J. Robotics Res..

[26]  S. Kay Fundamentals of statistical signal processing: estimation theory , 1993 .

[27]  K. Kastella,et al.  A Comparison of Task Driven and Information Driven Sensor Management for Target Tracking , 2005, Proceedings of the 44th IEEE Conference on Decision and Control.

[28]  Arnold Neumaier,et al.  Solving Ill-Conditioned and Singular Linear Systems: A Tutorial on Regularization , 1998, SIAM Rev..

[29]  Sonia Martínez,et al.  Distributed Interpolation Schemes for Field Estimation by Mobile Sensor Networks , 2010, IEEE Transactions on Control Systems Technology.

[30]  Ehud Rivlin,et al.  Landmark Selection for Task-Oriented Navigation , 2007, IEEE Trans. Robotics.

[31]  R. Saha,et al.  Simultaneous planning localization and mapping: A hybrid Bayesian/ frequentist approach , 2008, 2008 American Control Conference.

[32]  D. Ucinski Sensor network scheduling for identification of spatially distributed processes , 2010 .

[33]  Raghvendra V. Cowlagi,et al.  Interactive Planning and Sensing in Uncertain Environments with Task-Driven Sensor Placement , 2018, 2018 Annual American Control Conference (ACC).

[34]  F. Lewis,et al.  Optimal and Robust Estimation: With an Introduction to Stochastic Control Theory, Second Edition , 2007 .