Uncertainty-driven survey path planning for bathymetric mapping

We present a novel survey path planning technique which minimizes the robot´s position uncertainty along the planned path while taking into account area coverage performance. The proposed technique especially targets bathymetric mapping applications and respects application constraints such as the desire to survey in parallel tracks and to avoid turns in the target area to maximize sonar measurements quality. While accounting for uncertainty in the survey planning process can lead to more accurate data products, existing survey planning tools typically ignore it. Our method bridges this gap using the saliency on an a priori map to predict how the terrain will affect the robot´s belief at every point on the target area. Based on this magnitude, we provide an algorithm that computes the order in which to trace parallel tracks to cover the target area minimizing the overall uncertainty along the path. A particle filter keeps track of the robot´s position uncertainty during the planning process and, in order to find useful loop-closures for mapping, crossing tracks that visit salient locations are added when the uncertainty surpasses a user-provided threshold. We test our method on real-world datasets collected off the coasts of Spain, Greece and Australia. We evaluate the expected robot´s position uncertainty along the planned paths and assess their associated mapping performance using a bathymetric mapping algorithm. Results show that our method offers benefits over a standard lawnmower-type path both in terms of position uncertainty and map quality.