X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fproduct%2Fao_tracker.c;h=9666528b5a2475426355ff26a4ef7321557bc757;hp=c1c3366cf08b6c25e4efac94d4f353bdff0773f5;hb=d8f84ba82bab653c041eb85f93b9dcb1083bd849;hpb=fe0aaf4413035f9de2c805c612c71188ec8c6f4d diff --git a/src/product/ao_tracker.c b/src/product/ao_tracker.c index c1c3366c..9666528b 100644 --- a/src/product/ao_tracker.c +++ b/src/product/ao_tracker.c @@ -40,6 +40,31 @@ ao_usb_connected(void) #define STARTUP_AVERAGE 5 +static void +ao_tracker_start_flight(void) +{ + struct ao_log_mega log; + ao_log_start(); + log.type = AO_LOG_FLIGHT; + log.tick = ao_time(); +#if HAS_ACCEL + log.u.flight.ground_accel = ao_ground_accel; +#endif +#if HAS_GYRO + log.u.flight.ground_accel_along = ao_ground_accel_along; + log.u.flight.ground_accel_across = ao_ground_accel_across; + log.u.flight.ground_accel_through = ao_ground_accel_through; + log.u.flight.ground_roll = ao_ground_roll; + log.u.flight.ground_pitch = ao_ground_pitch; + log.u.flight.ground_yaw = ao_ground_yaw; +#endif +#if HAS_FLIGHT + log.u.flight.ground_pres = ao_ground_pres; +#endif + log.u.flight.flight = ao_flight_number; + ao_log_mega(&log); +} + static void ao_tracker(void) { @@ -112,10 +137,10 @@ ao_tracker(void) ao_flight_state = ao_flight_drogue; ao_wakeup(&ao_flight_state); ao_log_start(); + ao_tracker_start_flight(); } break; case ao_flight_drogue: - /* Modulate data rates based on speed (in cm/s) */ if (ao_gps_data.climb_rate < 0) speed = -ao_gps_data.climb_rate;