CasADi_MPC_MHE_CPP