/* Keeps track of Incoming Data */
boolean wsStringComplete;
String wsInputString;



void setup() {
  // put your setup code here, to run once:

  Serial.begin(9600);
  pinMode(LED_BUILTIN, OUTPUT);
}

void loop() {
  // put your main code here, to run repeatedly:


  handleIncommingOutgoingSerial();
}




void handleIncommingOutgoingSerial()
{
  /* This doesn't happen so often, but maybe we should handle serial input one byte at a time */
  while (Serial.available()) {
    char inChar = (char)Serial.read();
    if (inChar == '\n') {
      wsStringComplete = true;
      int equalsign = wsInputString.indexOf('=');
      String variable = wsInputString.substring(0, equalsign);
      String value  = wsInputString.substring(equalsign + 1);
      trigger(variable, value);
      wsInputString = "";
      wsStringComplete = false;
    } else {
      wsInputString += inChar;
    }
  }
}


void trigger(String VARIABLE, String VALUE)
{
  if (VARIABLE == "ssqHello")
  {
    Serial.println("ssrHello");
  }
  else if (VARIABLE == "ssqLED")
  {
    if (VALUE == "on") {
      digitalWrite(LED_BUILTIN, HIGH);
      Serial.println("ssrLED=on");
    }
    else {
      digitalWrite(LED_BUILTIN, LOW);
      Serial.println("ssrLED=off");
    }
  }
  else
  {
    Serial.println("ssrUnknown");
  }
}

def arduinoWriteWithResponse = { comPort, theData ->

  String theResponse = "";

  try
  {
    byte[] bytesToWrite = theData.getBytes("UTF-8");

    comPort.writeBytes(bytesToWrite, bytesToWrite.length);

    while (comPort.bytesAvailable() == 0) { Thread.sleep(20); }
    wait(1);

    byte[] readBuffer = new byte[comPort.bytesAvailable()];
    int numRead = comPort.readBytes(readBuffer, readBuffer.length);
    String readString = new String(readBuffer);
    theResponse = readString;
  }
  catch (Exception e)
  {
    show("Exception!! (arduinoWriteWithResponse)");
    wait(5);
    show(e);
    showButton("Exception!!");
  }

  return theResponse.trim();
}



// Open the port.
try
{
  //Will fetch the first COM port available
  com.fazecast.jSerialComm.SerialPort comPort = com.fazecast.jSerialComm.SerialPort.getCommPorts()[0];
  //If you know the COM port, use this.
  //com.fazecast.jSerialComm.SerialPort comPort = com.fazecast.jSerialComm.SerialPort.getCommPort("COM3");

  boolean openedSuccessfully = comPort.openPort();


  if (!openedSuccessfully)
  {
    show("Unable to open port Successfully. Please try again.");
    showButton("Exit");
    exit();
  }

  wait(2);  //For some reason, I found waiting here stops a couple of bugs later on... Remove at your own risk.
  comPort.setComPortTimeouts(com.fazecast.jSerialComm.SerialPort.TIMEOUT_READ_BLOCKING, 500, 500);


  if (arduinoWriteWithResponse(comPort, "ssqHello\n") == "ssrHello")
  {
    show("Awesome, it works!"); showButton("Next");

    show("LED Should turn ON...");
    if (arduinoWriteWithResponse(comPort, "ssqLED=on\n") == "ssrLED=on") {
      show("LED is ON"); showButton("Next");
    }
    else {
      show("Communication failed??? -- LED ON"); showButton("Exit"); exit();
    }

    show("LED Should turn OFF...");
    if (arduinoWriteWithResponse(comPort, "ssqLED=off\n") == "ssrLED=off") {
      show("LED is OFF"); showButton("Next");
    }
    else {
      show("Communication failed??? -- LED OFF"); showButton("Exit"); exit();
    }
  }
  else
  {
    show("Communication failed??? -- ssrHello"); showButton("Noooo");
  }


  //Important to close port.
  comPort.closePort();

  show("Done");
  showButton("Exit");
  exit();

}
catch (Exception e)
{
  show("Exception!!");
  wait(5);
  show(e);
  showButton("Exception!!");
}