some code improvment in full_step_ctrl