Added altitude hold test mode