diff --git a/firmware/batmon.c b/firmware/batmon.c index aafc715..c70e9ca 100644 --- a/firmware/batmon.c +++ b/firmware/batmon.c @@ -33,15 +33,14 @@ uint8_t batmon_proc() if (ADCSRA & (1 << ADIF)) { sum += ADCH; - if (!(cnt++)) { + if (!(++cnt)) { vbat = sum >> 8; sum = 0; + if (vbat < BAT_THRES_POWER_OFF) + return 1; } - vbat = ADCH; ADCSRA &= ~(1 << ADIF); ADCSRA |= (1 << ADSC); // TODO: I want this to work off TIMER0 - if (vbat < BAT_THRES_POWER_OFF) - return 1; } return 0; }