- ao_adc_get(&recv.telemetry.u.adc);
- ao_telemetry_send(&recv.telemetry);
- ao_delay(AO_MS_TO_TICKS(1000));
+ telemetry.addr = ao_serial_number;
+ telemetry.flight_state = ao_flight_state;
+ ao_adc_get(&telemetry.adc);
+ ao_mutex_get(&ao_gps_mutex);
+ memcpy(&telemetry.gps, &ao_gps_data, sizeof (struct ao_gps_data));
+ ao_mutex_put(&ao_gps_mutex);
+ ao_radio_send(&telemetry);
+ ao_delay(AO_MS_TO_TICKS(100));