little improvments and adaptations for Deterministic MPC controller