crashtest-r0ket/firmware/basic/voltage.c

34 lines
612 B
C

#include <sysinit.h>
#include "basic/basic.h"
#include "funk/nrf24l01p.h"
static uint32_t results=5000;
static uint8_t chrg=1;
void VoltageCheck(void){
chrg=gpioGetValue(RB_PWR_CHRG);
results = adcRead(1);
results *= 10560;
results /= 1024;
results += 50;
if( results < 3500 ){
nrf_off();
gpioSetValue (RB_PWR_GOOD, 0);
gpioSetValue (RB_LCD_BL, 0);
SCB_SCR |= SCB_SCR_SLEEPDEEP;
PMU_PMUCTRL = PMU_PMUCTRL_DPDEN_DEEPPOWERDOWN;
__asm volatile ("WFI");
};
};
uint32_t GetVoltage(void){
return results;
};
uint8_t GetChrgStat(void){
return !chrg;
};