Basic OS running on STM32L

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

diff --git a/src/stm/ao_timer.c b/src/stm/ao_timer.c
index 76304f0e2b9fea2c590dbb55ab0c00c198a17eaf..387df184c7747bb3f595c1c6d00d86a80d09993c 100644 (file)
--- a/src/stm/ao_timer.c
+++ b/src/stm/ao_timer.c
@@ -48,13 +48,16 @@ ao_debug_out(char c);
 
 void stm_tim6_isr(void)
 {
-       ++ao_tick_count;
+       if (stm_tim6.sr & (1 << STM_TIM67_SR_UIF)) {
+               stm_tim6.sr = 0;
+               ++ao_tick_count;
 #if HAS_ADC
-       if (++ao_adc_count == ao_adc_interval) {
-               ao_adc_count = 0;
-               ao_adc_poll();
-       }
+               if (++ao_adc_count == ao_adc_interval) {
+                       ao_adc_count = 0;
+                       ao_adc_poll();
+               }
 #endif
+       }
 }
 
 #if HAS_ADC