X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=ao_adc.c;h=bef6bb7f68e3703a2a5866f6efc383ce95e162ca;hp=82e1b01b7ad72eacf5eda1b7fa3234251c2f9832;hb=beae3360828da21eb1a3c4f88e930f242d4e36b7;hpb=d1887ded41a5bfec8e10e9fd736fa9444b9b6222 diff --git a/ao_adc.c b/ao_adc.c index 82e1b01b..bef6bb7f 100644 --- a/ao_adc.c +++ b/ao_adc.c @@ -35,10 +35,7 @@ ao_adc_sleep(void) void ao_adc_get(__xdata struct ao_adc *packet) { - uint8_t i = ao_adc_head; - if (i == 0) - i = AO_ADC_RING; - i--; + uint8_t i = ao_adc_ring_prev(ao_adc_head); memcpy(packet, &ao_adc_ring[i], sizeof (struct ao_adc)); } @@ -58,9 +55,7 @@ ao_adc_isr(void) interrupt 1 } else { /* record this conversion series */ ao_adc_ring[ao_adc_head].tick = ao_time(); - ao_adc_head++; - if (ao_adc_head == AO_ADC_RING) - ao_adc_head = 0; + ao_adc_head = ao_adc_ring_next(ao_adc_head); ao_wakeup(ao_adc_ring); } } @@ -72,7 +67,7 @@ ao_adc_dump(void) ao_adc_get(&packet); printf("tick: %5u accel: %4d pres: %4d temp: %4d batt: %4d drogue: %4d main: %4d\n", packet.tick, packet.accel >> 4, packet.pres >> 4, packet.temp >> 4, - packet.sense_d >> 4, packet.sense_m >> 4); + packet.v_batt >> 4, packet.sense_d >> 4, packet.sense_m >> 4); } __code struct ao_cmds ao_adc_cmds[] = {