Text this: An Underwater Pathfinding Algorithm for Optimised Planning of Survey Dives