Trajectory generation and tracking on SE(3) for an underactuated AUV with disturbances