Robust trajectory control of underwater vehicles