Faster path planning for rubble-roving robots