#include <LowPower.h>
#include <nRF24L01.h>
#include <printf.h>
#include <RF24.h>
#include <RF24_config.h>
#include <Wire.h>
#include <stdint.h>
#include "SparkFunHTU21D.h"

#define DEBUG     1

#define SLEEP_A   25    //5min
#define SLEEP_B   5400  //12h
#define VT_PIN    14    //A0
#define RF24_ON   7     //D6

uint8_t   node_address[5]         = {"1Node"};
uint8_t   server_address[5]       = {"2Node"};

HTU21D    htu21d;
RF24      radio(9,10);
uint8_t   plainRadioBuffer[32]    = {0};
uint16_t  cntA = SLEEP_A;
uint16_t  cntB = SLEEP_B;

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

#if DEBUG==1
  radio.printDetails();
#endif  
}

void setup() {
#if DEBUG==1
  Serial.begin(9600);
  Serial.println(F("Setup")); 
#endif
  analogReference(INTERNAL);
  htu21d.begin();
  pinMode(RF24_ON, OUTPUT);
  digitalWrite(RF24_ON, HIGH);
}

void loop() {

  if(cntA == SLEEP_A || cntB == SLEEP_B){
    //power on radio
    digitalWrite(RF24_ON, LOW);
    delay(100);
    setup_radio();
    
    if(cntA == SLEEP_A){
      float humd = htu21d.readHumidity();
      float temp = htu21d.readTemperature();

#if DEBUG==1
      Serial.print(F("Measures : "));
	  Serial.print(temp);
      Serial.print(F("°C - "));  
      Serial.print(humd);
      Serial.println(F("%"));    
#endif        
      
      memcpy(plainRadioBuffer,   "DATA",       4);
    
      memcpy(plainRadioBuffer+4,   &temp,      4);
      memcpy(plainRadioBuffer+8,   &humd,      4);

      radio.write(plainRadioBuffer, 32);   
      cntA = 0;
    }

    if(cntB == SLEEP_B){
      float voltage = analogRead(VT_PIN);
      voltage = voltage * 1.1 * ((1670000.0)/470000.0) / 1024.0;   
      
      memcpy(plainRadioBuffer,   "VOLT",       4);    
      memcpy(plainRadioBuffer+4,   &voltage,   4);      

      radio.write(plainRadioBuffer, 32);   
      cntB = 0;
    }   

    //power down radio
    digitalWrite(RF24_ON, HIGH);
  }
  ++cntA;
  ++cntB;

#if DEBUG==1
  Serial.println(F("Sleep for 8 seconds")); 
#endif
  LowPower.powerDown(SLEEP_8S, ADC_OFF, BOD_OFF);
}