mc_pos_control: altitude setpoint offset limiting fixed