Code that flew 4/28/14. Testing heading hold, altitude hold, and airspeed.