CHAINGING DT SETTING AND ILQG MODIFICATION ON CURR_COST