Search-based Planning for Active Sensing in Goal-Directed Coverage Tasks

Path planning for robotic coverage is the task of determining a collision-free robot trajectory that observes all points of interest in an environment. Robots employed for such tasks are often capable of exercising active control over onboard observational sensors during navigation. In this paper, we tackle the problem of planning robot and sensor trajectories that maximize information gain in such tasks where the robot needs to cover points of interest with its sensor footprint. Search-based planners in general guarantee completeness and provable bounds on suboptimality with respect to an underlying graph discretization. However, searching for kinodynamically feasible paths in the joint space of robot and sensor state variables with standard search is computationally expensive. We propose two alternative search-based approaches to this problem. The first solves for robot and sensor trajectories independently in decoupled state spaces while maintaining a history of sensor headings during the search. The second is a two-step approach that first quickly computes a solution in decoupled state spaces and then refines it by searching its local neighborhood in the joint space for a better solution. We evaluate our approaches in simulation with a kinodynamically constrained unmanned aerial vehicle performing coverage over a 2D environment and show their benefits.

[1]  Alonzo Kelly,et al.  Generating near minimal spanning control sets for constrained motion planning in discrete state spaces , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  Margarita Chli,et al.  Autonomous Aerial Inspection Using Visual-Inertial Robust Localization and Mapping , 2017, FSR.

[3]  Hideo Mori,et al.  Active sensing in vision-based stereotyped motion , 1990, EEE International Workshop on Intelligent Robots and Systems, Towards a New Frontier of Applications.

[4]  J. Karl Hedrick,et al.  Particle filter based information-theoretic active sensing , 2010, Robotics Auton. Syst..

[5]  Jamal Arkat,et al.  Complete Coverage Path Planning for a Multi-UAV Response System in Post-Earthquake Assessment , 2016, Robotics.

[6]  Sebastian Scherer,et al.  Autonomous landing at unprepared sites by a full-scale helicopter , 2012, Robotics Auton. Syst..

[7]  Alfred O. Hero,et al.  Sensor Management: Past, Present, and Future , 2011, IEEE Sensors Journal.

[8]  Wenjie Lu,et al.  An Information Potential Approach to Integrated Sensor Path Planning and Control , 2014, IEEE Transactions on Robotics.

[9]  George J. Pappas,et al.  Maximum Information Bounds for Planning Active Sensing Trajectories , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[10]  David Furcy ITSA * : Iterative Tunneling Search with A * , 2006 .

[11]  George J. Pappas,et al.  Asymptotically Optimal Planning for Non-Myopic Multi-Robot Information Gathering , 2019, Robotics: Science and Systems.

[12]  Richard M. Murray,et al.  On a stochastic sensor selection algorithm with applications in sensor scheduling and sensor coverage , 2006, Autom..

[13]  Sebastian Scherer,et al.  PASP: Policy based approach for sensor planning , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[14]  Gaurav S. Sukhatme,et al.  Persistent ocean monitoring with underwater gliders: Adapting sampling resolution , 2011, J. Field Robotics.

[15]  Masatoshi Ishikawa,et al.  A sensor selection method considering communication delays , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[16]  Albert S. Huang,et al.  Visual Odometry and Mapping for Autonomous Flight Using an RGB-D Camera , 2011, ISRR.

[17]  Jan Faigl,et al.  On the Dubins Traveling Salesman Problem with Neighborhoods , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[18]  Maxim Likhachev,et al.  A Planning Framework for Persistent, Multi-UAV Coverage with Global Deconfliction , 2019, FSR.

[19]  Maxim Likhachev,et al.  Multi-Heuristic A* , 2014, Int. J. Robotics Res..

[20]  Martin Saska,et al.  Data collection planning with non-zero sensing distance for a budget and curvature constrained unmanned aerial vehicle , 2019, Auton. Robots.

[21]  Martin Saska,et al.  Physical Orienteering Problem for Unmanned Aerial Vehicle Data Collection Planning in Environments With Obstacles , 2019, IEEE Robotics and Automation Letters.

[22]  R.M. Murray,et al.  On a decentralized active sensing strategy using mobile sensor platforms in a network , 2004, 2004 43rd IEEE Conference on Decision and Control (CDC) (IEEE Cat. No.04CH37601).

[23]  J. Peschon,et al.  Optimal control of measurement subsystems , 1967, IEEE Transactions on Automatic Control.

[24]  Qiang Du,et al.  Centroidal Voronoi Tessellations: Applications and Algorithms , 1999, SIAM Rev..

[25]  Ira Pohl,et al.  Heuristic Search Viewed as Path Finding in a Graph , 1970, Artif. Intell..

[26]  Martin Saska,et al.  On solution of the Dubins touring problem , 2017, 2017 European Conference on Mobile Robots (ECMR).

[27]  Hugh F. Durrant-Whyte,et al.  Coordinated decentralized search for a lost target in a Bayesian world , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[28]  Masatoshi Ishikawa,et al.  An active sensing method using estimated errors for multisensor fusion systems , 1996, IEEE Trans. Ind. Electron..

[29]  Paolo Valigi,et al.  Perception-aware Path Planning , 2016, ArXiv.

[30]  Suman Srinivasan,et al.  Airborne traffic surveillance systems: video surveillance of highway traffic , 2004, VSSN '04.

[31]  George J. Pappas,et al.  Information acquisition with sensing robots: Algorithms and error bounds , 2013, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[32]  Marc Carreras,et al.  A survey on coverage path planning for robotics , 2013, Robotics Auton. Syst..

[33]  Paul Timothy Furgale,et al.  Visual teach and repeat for long‐range rover autonomy , 2010, J. Field Robotics.

[34]  Y. Oshman Optimal sensor selection strategy for discrete-time state estimators , 1994 .

[35]  Tomas Lozano-Perez,et al.  On multiple moving objects , 1986, Proceedings. 1986 IEEE International Conference on Robotics and Automation.