Updated software from flights

Includes heading regulation, pitch and airspeed regulation. Uses updated
heading and localizer gains in latest C++ code.