Fixed issue with Altitude control loop not being activated when Z_UNIT was Height.