Integrated planning and execution for robotic exploration