Update flight algorithm based on data collected from SN-1 Flight 1

Update flight algorithm based on data collected from SN-1 Flight 1

This now correctly sequences through the flight data collected from the
first TeleMetrum test flight.

This also completes up the flight algorithm test harness (ao_flight_test),
which runs the flight algorithm on the Linux host from a captured data log.