Advanced Model Predictive Control for Autonomous Marine Vehicles