Nonlinear Model Predictive Control for Hydrobatics: Experiments with an Underactuated AUV