multirotor_pos_control cleanup