#include "Arduino.h"
#include "heltec.h"

#define BAND    868E6

long lastReceiveTime = 0;
unsigned int counter = 0;
float snr = 0;
String rssi = "RSSI --";  //rssi value
String packSize = "--";   // size
String packet;            // stores last packet

int degLo, degLat;
float minLat, minLo;
float latconv, longconv;
float dirtylong, dirtylat;
int latitude, longitude;
uint8_t lat1,lat2,lat3;


bool deepsleepflag=false;
bool receiveflag = false;

void interrupt_GPIO0()
{
  delay(10);
  if(digitalRead(0)==0){
  deepsleepflag=true;
  }
}

void setup()
{
  Heltec.begin(true /*DisplayEnable Enable*/, true /*LoRa Enable*/, true /*Serial Enable*/, true /*LoRa use PABOOST*/, BAND /*LoRa RF working band*/);
  attachInterrupt(0,interrupt_GPIO0,FALLING);
  LoRa.setSpreadingFactor(12);
//LoRa.setSignalBandwidth(500E3);
  LoRa.onReceive(onReceive);
  LoRa.receive();
  displaySendReceive();
}
void loop()
{
 if(deepsleepflag)
  {
  LoRa.end();
  LoRa.sleep();
  delay(100);
  pinMode(4,INPUT);
  pinMode(5,INPUT);
  pinMode(14,INPUT);
  pinMode(15,INPUT);
  pinMode(16,INPUT);
  pinMode(17,INPUT);
  pinMode(18,INPUT);
  pinMode(19,INPUT);
  pinMode(26,INPUT);
  pinMode(27,INPUT);
  digitalWrite(Vext,HIGH);
  delay(2);
  esp_deep_sleep_start();
  }

  if(receiveflag)
  {
  digitalWrite(LED, HIGH);
  counter++;
  lastReceiveTime = millis();
  digitalWrite(25,HIGH);
  delay(1000);
  receiveflag = false;
  digitalWrite(LED, LOW);
  LoRa.receive();
  displaySendReceive();
  }
}

void displaySendReceive()
  {
  Heltec.display -> clear();
  Heltec.display -> drawString(0, 50, "Counter " + (String)(counter-1));
  Heltec.display -> drawString(0, 0, "Received Size " + packSize);
  Heltec.display -> drawString(0, 10, String(latconv,10));
  Heltec.display -> drawString(0, 20, String(longconv,10));
  Heltec.display -> drawString(0, 40, "RSSI  " + rssi + "db " + "  SNR " + String(snr, 2));
  Heltec.display -> display();
  delay(100);
  }

void onReceive(int packetSize)//LoRa receiver interrupt service
{
  //if (packetSize == 0) return;
   packSize = String(packetSize,DEC);
   while (LoRa.available())
     {
     packet += (char) LoRa.read();
     }



 /* for(int i = 0;i<6;i++)
   {
    packet[i]= (char) LoRa.read();
   }
*/
  rssi = String(LoRa.packetRssi(), DEC);
  snr = LoRa.packetSnr();
  receiveflag = true;

  convert();
  //sendGGA("$GPGGA,", 6);
}

void convert()
{
  lat1 = packet[0];
  lat2 = packet[1];
  lat3 = packet[2];
  latitude = (lat1*256) + (lat2*16) + lat3;


  latconv = (latitude / 93206.75) - 90;
  degLat = latconv;
  minLat = (latconv - degLat)*60;
  //dirtylat = (degLat*100) + minLat;


  Serial.println(String(latconv,10));
  /*longitude = (uint8_t)packet[3]*256 + (uint8_t)packet[4]*16 + (uint8_t)packet[5];
  longconv = (longitude / 16777215.0 * 360) - 180;
  degLo = (longitude / 16777215.0 * 360) - 180;
  minLo = ((longitude / 16777215.0 * 360) - 180 - degLo)*60;
  dirtylong = (degLo*100) + minLo;*/
}