#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;
};