Fully actuated model-based control with six-degree-of-freedom coupled dynamical plant models for underwater vehicles: theory and experimental evaluation