#include <TinyGPSPlus.h>
#include <SoftwareSerial.h>
#include <Wire.h>
#include <MPU6050.h>

#define buzzer 13
#define btn1  2
static const int RXPin = 6, TXPin = 5;
String s = "www.google.com/maps/dir/";
static const uint32_t GPSBaud = 9600;
String Lat = "";
String Lng = "";
String Number = "+966591772557";
String MSG1 = "newSwitch [Activated]";
String MSG2 = "Flip [Activated]";

const size_t BUFSIZE = 300;
char f_buffer[BUFSIZE];
float *f_buf = (float*)f_buffer;

TinyGPSPlus gps;// The TinyGPSPlus object
SoftwareSerial ss(RXPin, TXPin);// The serial connection to the GPS device

MPU6050 mpu;

void setup()
{
  Serial.begin(9600);
  Wire.begin();
  pinMode(btn1, INPUT_PULLUP);
  pinMode(buzzer, OUTPUT);
  setupA9G();
  mpu.initialize();
  Serial.println("Setup Executed");
  attachInterrupt(digitalPinToInterrupt(btn1), send_gps_data, CHANGE);
}

void loop() {
  readGPS_Data();
  mpu_Data();
  //send_gps_data();
}

static void smartDelay(unsigned long ms)
{
  unsigned long start = millis();
  do
  {
    while (ss.available())
      gps.encode(ss.read());
  } while (millis() - start < ms);
}

void send_gps_data()
{
  /*
    if (gps.location.lat() == 0 || gps.location.lng() == 0)
    {
    Serial.println("Return Executed");
    return;
    }
  */
  send_SMS_Location(Number, MSG1);
  digitalWrite(buzzer, HIGH);
}


void setupA9G() {

  ss.begin(GPSBaud);
  Serial.println("Starting...");
  ss.println("\r");
  ss.println("AT\r");
  delay(10);
  ss.println("\r");
  ss.println("AT+GPS=1\r");
  delay(100);
  ss.println("AT+CREG=2\r");
  delay(6000);
  //ss.print("AT+CREG?\r");
  ss.println("AT+CGATT=1\r");
  delay(6000);
  ss.println("AT+CGDCONT=1,\"IP\",\"WWW\"\r");
  delay(6000);
  // ss.println("AT+LOCATION=1\r");
  ss.println("AT+CGACT=1,1\r");
  delay(6000);
  //Initialize ends
  //Initialize GPS
  ss.println("\r");
  ss.println("AT+GPS=1\r");
  delay(1000);
  //ss.println("AT+GPSMD=1\r");   // Change to only GPS mode from GPS+BDS, set to 2 to revert to default.
  ss.println("AT+GPSRD=10\r");
  delay(100);
  // set SMS mode to text mode
  ss.println("AT+CMGF=1\r");
  delay(1000);
  //ss.println("AT+LOCATION=2\r");

}

void send_SMS_Location(String number, String message) {
  Serial.print("Latitude (deg): ");
  Lat = String(gps.location.lat(), 6);
  Serial.println(Lat);

  Serial.print("Longitude (deg): ");
  Lng = String(gps.location.lng(), 6);
  Serial.println(Lng);
  Serial.println();

  s += String(gps.location.lat(), 6);
  s += ",";
  s += String(gps.location.lng(), 6);
  s += "/";
  Serial.println(s);
  Serial.println("Sending Message");
  String numbertosend = "AT+CMGS=\"";
  numbertosend += number;
  numbertosend += "\"\r";
  String messaG = message;
  messaG += " \n";
  messaG += s;
  ss.println("AT+CMGF=1\r");
  delay(1000);
  ss.println("AT+CNMI=2,2,0,0,0\r");
  delay(1000);
  ss.print(numbertosend);
  delay(1000);
  ss.print(messaG);
  //ss.print(s);
  ss.write(0x1A);
  delay(1000);
  s = "www.google.com/maps/dir/";
}

void sendSMSwithLocation() {
  Serial.println("Switch [Activated] - Sending Message");
  ss.println("AT + CMGF = 1\r");
  delay(1000);
  ss.println("AT + CNMI = 2, 2, 0, 0, 0\r");
  delay(1000);
  ss.print("AT + CMGS = \"+9660591772557\"\r"); //Replace this with your mobile number
  delay(1000);
  ss.print("Switch [Activated] \n");
  ss.print(s);
  ss.write(0x1A);
  delay(1000);
  s = "www.google.com/maps/dir/";
}

void sendSMSFlipLocation() {
  Serial.println("Flip [Activated] - Sending Message");
  ss.println("AT+CMGF=1\r");
  delay(1000);
  ss.println("AT+CNMI=2,2,0,0,0\r");
  delay(1000);
  ss.print("AT+CMGS=\"+966591772557\"\r");//Replace this with your mobile number
  delay(1000);
  ss.print("Flip [Activated] \n");
  ss.print(s);
  ss.write(0x1A);
  delay(1000);
  s = "www.google.com/maps/dir/";
}

void readGPS_Data() {
  smartDelay(2000);
  if (millis() > 5000 && gps.charsProcessed() < 10)
    Serial.println(F("No GPS data received: check wiring"));

}

void mpu_Data() {
  int16_t ax, ay, az;
  mpu.getAcceleration(&ax, &ay, &az);
  if (az < 0) {
    digitalWrite(buzzer, HIGH);
    send_SMS_Location(Number, MSG2);
  }
  else {
    digitalWrite(buzzer, LOW); // Turn off the  buzzer
  }
  Serial.print("X = ");
  Serial.print(ax);
  Serial.print(" Y = ");
  Serial.print(ay);
  Serial.print(" Z = ");
  Serial.println(az);
  //delay(500); // Delay for stability
}