SDDTMPC_nonlinear_project