multirotor_pos_control: update altitude setpoint if reference altitude changed