Docking of underwater vehicle: Model, Autopilot design, and Guidance