#include <LowPower.h>
#include <nRF24L01.h>
#include <printf.h>
#include <RF24.h>
#include <RF24_config.h>
#include <EEPROM.h>
#include <stdint.h>

#include <PinChangeInterrupt.h>

/* -------CONFIG---------*/
#define LOGDEBUG  0
/* --------------------- */

#define NODE_ID   5
/* --------------------- */

#define EE_ADDR   0
/* --------------------- */

#define RF24_CH   25
/* --------------------- */

#define SLEEP_DT   36  //5min , 8s par cycle
#define SLEEP_VT   75  //10min
/* --------------------- */


#define VT_PIN    14    //ADC3
#define RF24_ON   6
#define LED_PIN   5
#define PULSE_PIN 16    //PCINT10
/* --------------------- */

//DEBUG 
#if LOGDEBUG==1
#define DEBUG_PRINT(x)       Serial.print(x)
#define DEBUG_PRINTDEC(x)    Serial.print(x, DEC)
#define DEBUG_PRINTLN(x)     Serial.println(x)
#define DEBUG_RADIO()        radio.printDetails()
#else
#define DEBUG_PRINT(x)
#define DEBUG_PRINTDEC(x)
#define DEBUG_PRINTLN(x)
#define DEBUG_RADIO()
#endif
/* --------------------- */


uint8_t   server_address[5]       = {10, 20, 30, 40, 50};
uint8_t   node_address[5]         = {1, 20, 30, 40, 50};
/* --------------------- */


uint16_t  nodeId = NODE_ID;
RF24      radio(9,10);

uint8_t   radioBuffer[32]    = {0};

uint16_t  cntVT = SLEEP_VT;
uint16_t  cntDT = SLEEP_DT;

float     voltage       = 0;
uint32_t  daLCount      = 5018;


void radioSetup(){
  radio.begin();
  radio.setChannel(RF24_CH);
  radio.setDataRate(RF24_250KBPS);
  radio.setPALevel(RF24_PA_MAX);
  radio.setCRCLength(RF24_CRC_16);
  radio.setRetries(15, 5);  
  radio.setAutoAck(1);
  radio.openReadingPipe(1, node_address);
  radio.openWritingPipe(server_address);

  DEBUG_RADIO();
}


void setup() {
  delay(500);

  #if LOGDEBUG==1
  Serial.begin(9600);
  printf_begin();
  #endif

  //EEPROM.put(EE_ADDR, daLCount);

  pinMode(LED_PIN, OUTPUT);
  digitalWrite(LED_PIN, LOW);  

  pinMode(PULSE_PIN, INPUT);    
 
  pinMode(RF24_ON, OUTPUT);
  digitalWrite(RF24_ON, HIGH);  


  //flash led
  digitalWrite(LED_PIN, HIGH);
  delay(250);
  digitalWrite(LED_PIN, LOW);
  

  analogReference(INTERNAL);

  DEBUG_PRINTLN("Read EEPROM");
  EEPROM.get(EE_ADDR, daLCount);


  //flash led
  delay(500);
  digitalWrite(LED_PIN, HIGH);
  delay(1000);
  digitalWrite(LED_PIN, LOW);

  DEBUG_PRINTLN("attachPCIN");
  attachPCINT(digitalPinToPCINT(PULSE_PIN), pulseEvent, FALLING); 
}


void pulseEvent(){
  DEBUG_PRINT("Pulse.");  
  ++daLCount;
  
  //save to eeprom
  DEBUG_PRINT("Save to EEPROM daL=");
  DEBUG_PRINTLN(daLCount);
  EEPROM.put(EE_ADDR, daLCount);  
}


void loop() {
  DEBUG_PRINTLN(">");


  if( (cntDT >= SLEEP_DT) || (cntVT >= SLEEP_VT)){

    //power on radio
    digitalWrite(RF24_ON, LOW);
    
    delay(100);
    radioSetup();
    
    DEBUG_PRINTLN("Radio up");

    if(cntDT >= SLEEP_DT){
      //send message
      memcpy(radioBuffer,     &nodeId,               2);
      memcpy(radioBuffer+2,   "CS",                  2);
      memcpy(radioBuffer+4,   &daLCount,             4);
               
      if(radio.write(radioBuffer, 32)){
        cntDT = 0;
      }
      else{
        if(cntDT >= (SLEEP_DT+5)){
          //retry up to 5 cycles of 8s.
          cntDT = 0;
        }
      }     
  
    }

    delay(250);
    radio.flush_tx();


       
    if(cntVT >= SLEEP_VT){
      voltage = analogRead(VT_PIN);
      voltage = voltage * 1.1 * ((1670000.0)/470000.0) / 1024.0;
    
      DEBUG_PRINT("V=");
      DEBUG_PRINTLN(voltage);

     
      memcpy(radioBuffer,     &nodeId,           2);
      memcpy(radioBuffer+2,   "VT",              2);
    
      memcpy(radioBuffer+4,   &voltage,          4);
    
      if(radio.write(radioBuffer, 32)){
        cntVT = 0;
      }
      else{
        if(cntVT >= (SLEEP_VT+5)){
          //retry up to 5 cycles of 8s.
          cntVT = 0;
        }
      }
    }   


    delay(50);
    
    //power down radio
    radio.powerDown();
    digitalWrite(RF24_ON, HIGH);
  }
     
  ++cntVT;
  ++cntDT;
  
  //flash led
  digitalWrite(LED_PIN, HIGH);
  delay(1);
  digitalWrite(LED_PIN, LOW);

  DEBUG_PRINTLN("."); 

  LowPower.powerDown(SLEEP_8S, ADC_OFF, BOD_OFF);

}