fw: Implement power-on battery check
This commit is contained in:
parent
b4cfb40bb7
commit
a396052487
@ -49,3 +49,28 @@ inline uint8_t batmon_get_voltage()
|
|||||||
{
|
{
|
||||||
return vbat;
|
return vbat;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static uint8_t batmon_get_voltage_sync()
|
||||||
|
{
|
||||||
|
uint16_t sum = 0;
|
||||||
|
uint8_t cnt = 255;
|
||||||
|
|
||||||
|
ADCSRA |= (1 << ADSC);
|
||||||
|
|
||||||
|
do {
|
||||||
|
if (ADCSRA & (1 << ADIF)) {
|
||||||
|
sum += ADCH;
|
||||||
|
ADCSRA &= ~(1 << ADIF);
|
||||||
|
ADCSRA |= (1 << ADSC);
|
||||||
|
cnt--;
|
||||||
|
}
|
||||||
|
} while (cnt);
|
||||||
|
|
||||||
|
return (sum >> 8);
|
||||||
|
}
|
||||||
|
|
||||||
|
// Note: Call batmon_init() after using this function before using batmon_proc() again
|
||||||
|
inline uint8_t batmon_ok_to_boot()
|
||||||
|
{
|
||||||
|
return (batmon_get_voltage_sync() > BAT_THRES_POWER_ON);
|
||||||
|
}
|
||||||
|
@ -12,5 +12,6 @@
|
|||||||
void batmon_init();
|
void batmon_init();
|
||||||
uint8_t batmon_get_voltage();
|
uint8_t batmon_get_voltage();
|
||||||
uint8_t batmon_proc();
|
uint8_t batmon_proc();
|
||||||
|
uint8_t batmon_ok_to_boot();
|
||||||
|
|
||||||
#endif // BATMON_H
|
#endif // BATMON_H
|
||||||
|
@ -88,6 +88,7 @@ int main()
|
|||||||
MCUSR &= ~(1 << WDRF);
|
MCUSR &= ~(1 << WDRF);
|
||||||
WDTCSR = (1 << WDCE);
|
WDTCSR = (1 << WDCE);
|
||||||
cli();
|
cli();
|
||||||
|
_delay_ms(25);
|
||||||
|
|
||||||
suspend();
|
suspend();
|
||||||
|
|
||||||
|
@ -4,6 +4,7 @@
|
|||||||
#include <avr/interrupt.h>
|
#include <avr/interrupt.h>
|
||||||
#include <avr/pgmspace.h>
|
#include <avr/pgmspace.h>
|
||||||
#include "pm.h"
|
#include "pm.h"
|
||||||
|
#include "batmon.h"
|
||||||
|
|
||||||
static void disable_periphery()
|
static void disable_periphery()
|
||||||
{
|
{
|
||||||
@ -58,7 +59,10 @@ void reset()
|
|||||||
|
|
||||||
char* post()
|
char* post()
|
||||||
{
|
{
|
||||||
// TODO: Implement battery voltage check
|
|
||||||
_delay_ms(500);
|
_delay_ms(500);
|
||||||
|
|
||||||
|
if (!batmon_ok_to_boot())
|
||||||
|
return PSTR("Low battery.");
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user