AUV path optimization.
Merge pull request #90 from ocefpaf/AUV_track

AUV path optimization.