//  FARM DATA RELAY SYSTEM
//
//  BMP280 SENSOR MODULE
//
//  Developed by Timm Bogner (bogner1@gmail.com) for Sola Gratia Farm in Urbana, Illinois, USA.
//  Each sensor is assigned a two-byte identifier along with a one-byte sensor type
//  

#define TERM_MAC    0x00 //Terminal MAC
#define SLEEPYTIME  30   //Time to sleep in seconds
#define TEMP_ID     5    //Unique ID (0 - 255) for each data reading
#define PRES_ID     6

#include <ESP8266WiFi.h>
#include <espnow.h>
#include <Adafruit_BMP280.h>
#include "DataReading.h"

Adafruit_BMP280 bmp;     //0x76
uint8_t broadcastAddress[] = {0xAA, 0xBB, 0xCC, 0xDD, 0xEE, TERM_MAC};
int wait_time = 0;

void OnDataSent(uint8_t *mac_addr, uint8_t sendStatus) {
  Serial.print("Last Packet Send Status: ");
  if (sendStatus == 0) {
    Serial.println("Delivery success");
  }
  else {
    Serial.println("Delivery fail");
  }
}



void setup() {
  Serial.begin(115200);
  Wire.begin();
  while (!bmp.begin(0x76)) {
    delay(10);
  }
  Serial.println("BMP INIT");
  if (esp_now_init() != 0) {
    return;
  }
  esp_now_set_self_role(ESP_NOW_ROLE_COMBO);
  esp_now_register_send_cb(OnDataSent);
  // Register peer
  esp_now_add_peer(broadcastAddress, ESP_NOW_ROLE_COMBO, 0, NULL, 0);
}

void loop() {
  if (millis() > wait_time) {
    wait_time = wait_time + SLEEPYTIME * 1000;
    loadData();
  }
}
void loadData() {
  float bmp_temp = bmp.readTemperature();
  float bmp_pressure = (bmp.readPressure() / 100.0F);
  //float bme_altitude = bmp.readAltitude(1013.25);
  Serial.println(bmp_temp);
  DataReading Temp;
  Temp.d = bmp_temp;
  Temp.id = TEMP_ID;
  Temp.t = 1;
  DataReading Pres;
  Pres.d = bmp_pressure;
  Pres.id = PRES_ID;
  Pres.t = 3;
  DataReading thePacket[2];
  thePacket[0] = Temp;
  thePacket[1] = Pres;
  esp_now_send(broadcastAddress, (uint8_t *) &thePacket, sizeof(thePacket));
}