model predictive control code snippets in matlab