altos: Add orientation tracking to ao_flight_test