//String endChar = String(char(0xFF)) + String(char(0xFF)) + String(char(0xFF));
String endChar = "ÿ";
String dfd = "";	// data from display
int long initDelayLong = 0;
int initDelayLength = 50;

int floatVal = 0;

void setup() {
  Serial.begin(9600);
  Serial1.begin(9600, SERIAL_8N1, 16, 17);
delay(500);
}

void loop() {
//if (Serial1.available()) {
lcdInput;

if (millis() > initDelayLong) {
initDelayLong += initDelayLength;
//sendToNex();
}

if (dfd.endsWith(endChar)) {
Serial.println(dfd);
Serial.println("error");
dfd = "";
//}
}
}

//    nějak tomu nerozumím a nedělá to co chci
void lcdInput() {
  dfd += char(Serial1.read());
  Serial.println(dfd);

  if((sizeof(dfd)>15 && dfd.substring(0,1) != "0")) 
  {
    dfd = "";
    Serial.println("moc dlouhe");
  }
  else{
//    if(dfd.substring((sizeof(dfd)-1),sizeof(dfd)) == "X")
//    {
Serial.println(dfd);
      // NOTE : Get the comnand
      String command = dfd.substring(1,2);
      // NOTE : Get the value(int or string)
      String value = dfd.substring(3,dfd.length()-1);
      // NOTE : FOR TESTING
      Serial.println(command + " : " + value);
      // NOTE : TEST COMMAND "CMD"
      dfd="";
//    }
  }
}

void sendToNex() {
Serial1.println("j0.val.35" + endChar);  // nněco do Nexu...
Serial1.println("j0.val.35");  // nněco do Nexu...
}