improved @deterministicMPC

put disturbances and try the optimization solution