- Increase `sim_stop_idx` to near the limit - Adjust some cost parameters - Remove unused `NL` cost parameter - Increase `fmincon` iteration & evaluation limits - Decrease `fmincon` constraint tolerance