Altitude hold state semi working.