We have developed a custom three-Degree of Freedom autopilot system - supporting Heading Select, BARO Alt Hold, and RAD Alt Hold. More information here