Demonstration of closed-loop trajectory control of an underwater vehicle