50 lines
1.1 KiB
C
50 lines
1.1 KiB
C
#include <sysinit.h>
|
|
|
|
#include "basic/basic.h"
|
|
#include "funk/nrf24l01p.h"
|
|
|
|
#define VOLTAGE_SAMPLES 8
|
|
static uint32_t voltage=5000*VOLTAGE_SAMPLES;
|
|
static uint8_t chrg=1;
|
|
|
|
void VoltageCheck(void){
|
|
uint32_t v;
|
|
chrg=gpioGetValue(RB_PWR_CHRG);
|
|
//slow down the adc for our high impedance voltage devider
|
|
ADC_AD0CR = ((CFG_CPU_CCLK / SCB_SYSAHBCLKDIV) / 100000 - 1 ) << 8;
|
|
v = adcRead(1);
|
|
//speed it up again
|
|
ADC_AD0CR = ((CFG_CPU_CCLK / SCB_SYSAHBCLKDIV) / 1000000 - 1 ) << 8;
|
|
|
|
v *= 10560;
|
|
v /= 1024;
|
|
|
|
//add the drop over the voltage switch
|
|
v += 50;
|
|
|
|
voltage -= voltage/VOLTAGE_SAMPLES;
|
|
voltage += v;
|
|
|
|
//battery is assumed empty if the volatge falls bellow 3.5V
|
|
if( voltage < (3500*VOLTAGE_SAMPLES) ){
|
|
//if( voltage < 3500 ){
|
|
nrf_off();
|
|
gpioSetValue (RB_PWR_GOOD, 0);
|
|
gpioSetValue (RB_LCD_BL, 0);
|
|
|
|
//put the chip into deep power down
|
|
SCB_SCR |= SCB_SCR_SLEEPDEEP;
|
|
PMU_PMUCTRL = PMU_PMUCTRL_DPDEN_DEEPPOWERDOWN;
|
|
__asm volatile ("WFI");
|
|
};
|
|
};
|
|
|
|
uint32_t GetVoltage(void){
|
|
return voltage/8;
|
|
//return voltage;
|
|
};
|
|
|
|
uint8_t GetChrgStat(void){
|
|
return !chrg;
|
|
};
|