Nonlinear Model Predictive Control of Autonomous Surface Vehicle In Rough Seas