autonomous underwater vehicles, AUVs, submarine, path planning, mission targets, shortest path faster algorithm, SPFA