A Model Predictive Control Approach to AUVs Motion Coordination