multirotor_pos_control: altitude controller initial parameters setting bug fixed