crashtest-r0ket/firmware/basic/voltage.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;
};