#include <SoftwareSerial.h>
#include <TinyGPS++.h>

SoftwareSerial simSerial(5, 6);
SoftwareSerial gpsSerial(4, 3); // RX, TX
TinyGPSPlus gps;

char incomingByte;
String inputString;
String phone;
double latitude, longitude;
String link = "GPS masih proses";

//long interval = 3000; // the time we need to wait
//long previousMillis = 0; // millis() returns an unsigned long.

////////////////////////////////////////////////////////////////////////////////////////////////////////
////////////////////////////////////////////////////////////////////////////////////////////////////////
void setup() {
  Serial.begin(9600);

  gpsSerial.begin(9600);
  simSerial.begin(9600);

  simSerial.listen();

  while (!simSerial.available()) {
    simSerial.println("AT");
    delay(1000);
  }

  simSerial.println("AT+CMGF=1");  //Set SMS to Text Mode
  simSerial.println("AT+CNMI=1,2,0,0,0");  //Procedure to handle newly arrived messages(command name in text: new message indications to TE)
  simSerial.println("AT+CMGL=\"REC UNREAD\""); // Read Unread Messages
  delay(1000);
  simSerial.println("AT+CMGDA=\"DEL ALL\"");
  delay(1000);

}
////////////////////////////////////////////////////////////////////////////////////////////////////////
////////////////////////////////////////////////////////////////////////////////////////////////////////
void loop() {
  /*//Loop Read GPS
      gpsSerial.listen();

    while (gpsSerial.available()) {
      gps.encode(gpsSerial.read());

      if (gps.location.isUpdated()) {
        latitude = gps.location.lat();
        longitude = gps.location.lng();
        link = "www.google.com/maps/place/" + String(latitude, 6) + "," + String(longitude, 6);
        Serial.println(link);
      }
    }*/

  if (simSerial.available()) {
    delay(100);
    while (simSerial.available()) {
      incomingByte = simSerial.read();
      inputString += incomingByte;
    }

    delay(10);
    Serial.println(inputString);

    if (inputString.indexOf("gps") > -1) {
      if (inputString.indexOf("CMT:") > 0) {
        phone = inputString.substring(inputString.indexOf("+CMT: ") + 7,  inputString.indexOf(",") - 1);
      }
      gpsLink();
      delay(1000);
      sendSMS();
      delay(1000);
      simSerial.println("AT+CMGDA=\"DEL ALL\"");//Delete Messages & Save Memory
    }
    inputString = "";
  }

}
////////////////////////////////////////////////////////////////////////////////////////////////////////
////////////////////////////////////////////////////////////////////////////////////////////////////////
void sendSMS() {
  simSerial.listen();
  Serial.println("Sending message........");
  simSerial.println("AT+CMGS=\"" + phone + "\"\r"); //Mobile phone number to send message
  delay(1000);
  simSerial.println(link);
  delay(1000);
  simSerial.println((char)26);// ASCII code of CTRL+Z
}
////////////////////////////////////////////////////////////////////////////////////////////////////////
////////////////////////////////////////////////////////////////////////////////////////////////////////
void gpsLink() {
  gpsSerial.listen();

  while (gpsSerial.available()) {
    gps.encode(gpsSerial.read());

    if (gps.location.isUpdated()) {
      latitude = gps.location.lat();
      longitude = gps.location.lng();
      link = "www.google.com/maps/place/" + String(latitude, 6) + "," + String(longitude, 6);
      Serial.println(link);
    }
  }
}
////////////////////////////////////////////////////////////////////////////////////////////////////////
////////////////////////////////////////////////////////////////////////////////////////////////////////