altos/stm: Add polling ADC sampler API

[fw/altos] / src / stm / ao_adc_stm.c

diff --git a/src/stm/ao_adc_stm.c b/src/stm/ao_adc_stm.c
index 67416a9d43ae9a5a2fec6f3f03f5dcd85031b8fd..24912bb28b34849d7b2297ff8c11e6e6cd63a4fb 100644 (file)
--- a/src/stm/ao_adc_stm.c
+++ b/src/stm/ao_adc_stm.c
@@ -3,7 +3,8 @@
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; version 2 of the License.
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
  *
  * This program is distributed in the hope that it will be useful, but
  * WITHOUT ANY WARRANTY; without even the implied warranty of
@@ -56,6 +57,9 @@ static void ao_adc_done(int index)
 #endif
 #if HAS_MPU6000
                ao_data_ring[ao_data_head].mpu6000 = ao_mpu6000_current;
+#endif
+#if HAS_MPU9250
+               ao_data_ring[ao_data_head].mpu9250 = ao_mpu9250_current;
 #endif
                ao_data_ring[ao_data_head].tick = ao_tick_count;
                ao_data_head = ao_data_ring_next(ao_data_head);
@@ -376,7 +380,7 @@ ao_adc_init(void)
 #if AO_NUM_ADC > 18
 #error "need to finish stm_adc.sqr settings"
 #endif
-       
+
        /* Turn ADC on */
        stm_adc.cr2 = AO_ADC_CR2_VAL;