/**
  pfodParser for Arduino
  The pfodParser parses messages of the form
  { cmd ` arg1 ` arg2 ` ... }
  or
  { cmd ~ arg1}
  or
  { cmd }
  The args are optional
  This is a complete paser for ALL commands a pfodApp will send to a pfodDevice
  see www.pfod.com.au  for more details.

  pfodParser adds about 482 bytes to the program and uses about 260 bytes RAM

  The pfodParser parses messages of the form
  { cmd ` arg1 ` arg2 ` ... }
  or
  { cmd ~ arg1}
  or
  { cmd }
  The message is parsed into the args array by replacing '|', '`' and '}' with '/0' (null)
  When the the end of message } is seen
  parse() returns the first byte of the cmd
  getCmd() returns a pointer to the null terminated cmd
  skipCmd() returns a pointer to the first arg (null terminated)
      or a pointer to null if there are no args
  getArgsCount() returns the number of args found.
  These calls are valid until the start of the next msg { is parsed.
  At which time they are reset to empty command and no args.
*/
/*
   (c)2014-2025 Forward Computing and Control Pty. Ltd.
   NSW Australia, www.forward.com.au
   This code is not warranted to be fit for any purpose. You may only use it at your own risk.
   This code may be freely used for both private and commercial use
   Provide this copyright is maintained.
*/

// uncomment this next line and call send chars written to the debug output  USUALLY NOT USED!!
//#define DEBUG_MSG_TO_SERIAL

#include "pfodParser.h"
#include "pfodDebugPtr.h"
static Stream* debugPtr = NULL;

pfodLinkedList<pfodDrawing> pfodParser::listOfDrawings;

pfodParser::pfodParser() {
  constructInit();
}


void pfodParser::constructInit() {
  io = NULL;
  init();
  setVersion(emptyVersion);
  seqNum = 0; // no seq num yet
  lastSeqNum = 0;
  ignoreCmdSeqNum = 0; // check seqNum if any
  parserTimeout = 0;
  lastMsgTime = 0;
}

pfodParser::pfodParser(const char *_version) {
  constructInit();
  setVersion(_version);
}

/**
   Note: there must NOT be null the io stream
*/
void pfodParser::init() {
  (void)debugPtr; // suppress unused warning
#ifdef DEBUG_MSG_TO_SERIAL
  debugPtr = getDebugPtr();
#endif  
  emptyVersion[0] = '\0';
  emptyBytes[0] = '\0';
  argsCount = 0;
  argsIdx = 0;
  args[0] = 0; // no cmd
  args[1] = 0; //
  args[pfodMaxMsgLen] = 0; // double terminate
  args[pfodMaxMsgLen - 1] = 0;
  cmdStart = args; // if no version
  versionStart = (byte*)emptyVersion; // not used if : not found
  parserState = pfodWaitingForStart; // not started yet pfodInMsg when have seen {
  refresh = false;
  activeCmdStart = emptyBytes;
  missingEditedText[0] = '\0';
  touchType = 0;
  col = 0;
  row = 0;
  activeCmdStart = emptyBytes;
  missingEditedText[0] = '\0';
  row = 0; col = 0; touchType = 0;
  editedText = missingEditedText;
  encodingProcessed = 0;
  lastMsgTime = 0;
  //  rawCol = 0;
  //  rawRow = 0;
}

void pfodParser::printDwgCmdReceived(Print * outPtr) {
  if (!outPtr) {
    return;
  }
  if (!(*getDwgCmd())) {
    outPtr->print("current cmd:"); outPtr->print((char*)getCmd()); outPtr->println(" is not a dwg cmd");
  }
  outPtr->print("     touchZone cmd "); outPtr->print((const char*)getDwgCmd()); outPtr->print(" at ");
  outPtr->print("("); outPtr->print(getTouchedX()); outPtr->print(","); outPtr->print(getTouchedY()); outPtr->print(") ");
  if (isTouch()) {
    outPtr->print("touch type:TOUCHED");
  }
  outPtr->println();
  if (*getEditedText()) { // first char not '\0'
    outPtr->print("     Edited text '"); outPtr->print((const char*)getEditedText()); outPtr->println("'");
  }
}

void  pfodParser::ignoreSeqNum() {
  // for pfodSecurity so hash does not accidently drop a command.
  ignoreCmdSeqNum = 1;
}

void pfodParser::connect(Stream* ioPtr) {
  init();
  io = ioPtr;
}

void pfodParser::closeConnection() {
  //io = NULL; cannot clear this here
  init();
}

Stream* pfodParser::getPfodAppStream() {
  return io;
}

size_t pfodParser::write(uint8_t c) {
  if (!io) {
    return 1; // cannot write if io null but just pretend to
  }
#ifdef DEBUG_MSG_TO_SERIAL 
  if (debugPtr) { 
    if (c=='{') {
  	  debugPtr->print("\n>>");
    }
    debugPtr->print((char)c);
    if (c == '}') {
  	  debugPtr->println();
    }
  }
#endif  
  return io->write(c);
}

size_t pfodParser::write(const uint8_t *buffer, size_t size) {
    size_t n = 0;
    while(size--) {
        n += write(*buffer++);
    }
    return n;
}


int pfodParser::available() {
  return 0;
}

int pfodParser::read() {
  return 0;
}
int pfodParser::peek() {
  return 0;
}

void pfodParser::flush() {
  if (!io) {
    return ; // cannot write if io null but just pretend to
  }
  io->flush(); // whatever that does, may block
}

void pfodParser::setIdleTimeout(unsigned long timeout_in_seconds) {
  parserTimeout = timeout_in_seconds * 1000;
#ifdef DEBUG_TIMER
  if (debugOut != NULL) {
    debugOut->print(F("setIdleTimeout() set idleTimeout to "));
    debugOut->println(parserTimeout);
  }
#endif
}

void pfodParser::setCmd(byte cmd) {
  init();
  args[0] = cmd;
  args[1] = 0;
  cmdStart = args;
  versionStart = (byte*)emptyVersion; // leave refresh unchanged
}

/**
   Return pointer to start of message return start of cmd
*/
byte* pfodParser::getCmd() {
  return cmdStart;
}

bool pfodParser::cmdEquals(pfodAutoCmd &a_Cmd) { // for load dwg cmds
  if ((*a_Cmd.cmd == '\0') || (*getCmd() == '\0')) {
    return 0; // false
  }
  return !strcmp(a_Cmd.cmd, (const char*)getCmd());
}


// returns true if parser cmd, as returned by getCmd() == cmdStr
bool pfodParser::cmdEquals(const char* cmdStr) {
  if ((!cmdStr) || (*getCmd() == '\0')) {
    return 0; // false
  }
  return !strcmp(cmdStr, (const char*)getCmd());
}

// returns true if parser cmd as returned by getCmd() is just once char and == cmdChar
bool pfodParser::cmdEquals(const char cmdChar) {
  if ((!cmdChar) || (*getCmd() == '\0')) {
    return 0; // false
  }
  return (getCmd()[0] == cmdChar) && (getCmd()[1] == '\0');
}

/**
   msg starts with {: the : is dropped from the cmd
*/
bool pfodParser::isRefresh() {
  return refresh;
}

/**
   the version asked for in the command i.e. {versionRequested:...}
*/
const char *pfodParser::getVersionRequested() {
  return (const char*)versionStart; // may be empty if not version requested
}

const char* pfodParser::getVersion() {
  return version;
}

void pfodParser::setVersion(const char* _version) {
  version = _version;
}

void pfodParser::sendVersion() {
  print('~');
  print(getVersion());
}

// send `refresh_mS ~ version to parser.print
void pfodParser::sendRefreshAndVersion(unsigned long refresh_mS) {
  print('`');
  print(refresh_mS);
  sendVersion();
}


/**
   Return pointer to first arg (or pointer to null if no args)

   Start at args[0] and scan for first null
   if argsCount > 0 increment to point to  start of first arg
   else if argsCount == 0 leave pointing to null
*/
byte* pfodParser::getFirstArg() {
  byte* idxPtr = cmdStart;
  while ( *idxPtr != 0) {
    ++idxPtr;
  }
  if (argsCount > 0) {
    ++idxPtr;
  }
  return idxPtr;
}

/**
   Return pointer to next arg or pointer to null if end of args
   Need to call getFirstArg() first
   Start at current pointer and scan for first null
   if scanned over a non empty arg then skip terminating null and return
   pointer to next arg, else return start if start points to null already
*/
byte* pfodParser::getNextArg(byte *start) {
  byte* idxPtr = start;
  while ( *idxPtr != 0) {
    ++idxPtr;
  }
  if (idxPtr != start) {
    ++idxPtr; // skip null
  } // else this was the last arg
  return idxPtr;
}

/**
   Return number of args in last parsed msg
*/
byte pfodParser::getArgsCount() {
  return argsCount;
}

// | <cmd> ~ areaCmd `col `row `type [~editedText]
byte pfodParser::parseDwgCmd() {
//  emptyBytes[0] = '\0';
//  activeCmdStart = emptyBytes;
//  missingEditedText[0] = '\0';
//  row = 0; col = 0; touchType = 0;
//  editedText = missingEditedText;
  if ((getArgsCount() != 4) && (getArgsCount() != 5)) {
    return '\0'; // not an image cmd
  }

  long tempLong = 0;
  byte *argPtr = getFirstArg();

  activeCmdStart = argPtr; // image cmd
  argPtr = getNextArg(argPtr);

  parseLong(argPtr, &tempLong);
  col = (int)tempLong;
  argPtr = getNextArg(argPtr);

  parseLong(argPtr, &tempLong);
  row  = (int)tempLong;
  argPtr = getNextArg(argPtr);

  parseLong(argPtr, &tempLong);
  touchType = (uint8_t)tempLong;

  if (getArgsCount() == 5) {
    argPtr = getNextArg(argPtr);
    editedText = argPtr;
    getEditedText(); // process encoding this updates that arg!!
    // Note: if we ever add another arg after this one the need to keep
    // the location of the start of the next arg in case this one is shortened.
  }
  return *activeCmdStart;
}

bool pfodParser::dwgCmdEquals(const char dwgCmd) { // valid only after parseDwgCmd() called on image cmd
  if ((!dwgCmd) || (*activeCmdStart == '\0')) {
    return 0; // false
  }
  return (activeCmdStart[0] == dwgCmd) && (activeCmdStart[1] == '\0');
}

// valid only after parseDwgCmd() called on image cmd
bool pfodParser::dwgCmdEquals(const char* dwgCmdStr) {
  if ((!dwgCmdStr) || (*activeCmdStart == '\0')) {
    return 0; // false
  }
  return !strcmp(dwgCmdStr, (const char*)activeCmdStart);
}

bool pfodParser::dwgCmdEquals(pfodAutoCmd &a_Cmd) { // valid only after parseDwgCmd() called on image cmd
  if ( (!(a_Cmd.cmd[0])) || (*activeCmdStart == '\0')) {
    return 0; // false
  }
  return !strcmp(a_Cmd.cmd, (const char*)activeCmdStart);
}

const byte* pfodParser::getDwgCmd() {
  return activeCmdStart;
}

// applies replacements automatically
const byte *pfodParser::getEditedText() {
  if (encodingProcessed == 0) {
    replace("&#92;", "\\", (char*)editedText);
    replace("&lt;", "<", (char*)editedText);
    replace("&#123;", "{", (char*)editedText);
    replace("&#125;", "}", (char*)editedText);
    replace("&#124;", "|", (char*)editedText);
    replace("&#126;", "~", (char*)editedText);
    replace("&#96;", "`", (char*)editedText);
    replace("&amp;", "&", (char*)editedText); // do this last
    encodingProcessed = 1; // only do this once
  }
  return editedText;
}

// findStr length MUST be >= replacePtr length!!
// input is const byte* BUT recast as (char*) and is modified by this method
// const byte* is to match getEditedText() return
void pfodParser::replace(const char* findStr, const char *replacePtr, char* buffer) {
  if ((!findStr) || (!replacePtr) || (!buffer)) {
    return;
  }
  size_t findLen = strlen(findStr);
  size_t replaceLen = strlen(replacePtr);
  size_t len = strlen(buffer);
  if ((len == 0) || (findLen == 0)) {
    return;
  }
  if (replacePtr == buffer) {
    return;
  }
  int diff = replaceLen - findLen;
  if (diff > 0) {
    return;
  }
  char *_readFrom = buffer;
  char *foundAt;
  if (diff == 0) {
    while ((foundAt = strstr(_readFrom, findStr)) != NULL) {
      memmove(foundAt, replacePtr, replaceLen);
      _readFrom = foundAt + replaceLen; // prevents replacing the replace
    }
  } else if (diff < 0) {
    char *writeTo = buffer;
    while ((foundAt = strstr(_readFrom, findStr)) != NULL) {
      size_t n = foundAt - _readFrom;
      memmove(writeTo, _readFrom, n);
      writeTo += n;
      memmove(writeTo, replacePtr, replaceLen);
      writeTo += replaceLen;
      _readFrom = foundAt + findLen; // prevents replacing the replace
      len += diff;
    }
    memmove(writeTo, _readFrom, strlen(_readFrom) + 1);
  }
  return;
}

uint8_t pfodParser::getTouchType() {
  return touchType;
}
bool pfodParser::isTouch() {
  return (touchType == TOUCH);
}
bool pfodParser::isPress() {
  return (touchType == PRESS);
}
bool pfodParser::isClick() {
  return (touchType == CLICK);
}
bool pfodParser::isDown() {
  return (touchType == DOWN);
}
bool pfodParser::isDrag() {
  return (touchType == DRAG);
}
bool pfodParser::isUp() {
  return (touchType == UP);
}

//bool pfodParser::isEntry() {
//  return (touchType == ENTRY);
//}
//bool pfodParser::isExit() {
//  return (touchType == EXIT);
//}

int pfodParser::getTouchedCol() {
  return col;
}

int pfodParser::getTouchedRow() {
  return row;
}

int pfodParser::getTouchedY() {
  return row;
}

int pfodParser::getTouchedX() {
  return col;
}

/**
   pfodWaitingForStart if outside msg
   pfodMsgStarted if just seen opening {
   pfodInMsg in msg after {
   pfodMsgEnd if just seen closing }
*/
byte pfodParser::getParserState() {
  if ((parserState == pfodWaitingForStart) ||
      (parserState == pfodMsgStarted) ||
      (parserState == pfodInMsg) ||
      (parserState == pfodMsgEnd) ) {
    return parserState;
  } //else {
  return pfodInMsg;
}

// static
void pfodParser::addDwg(pfodDrawing *dwgPtr) {
	pfodParser::listOfDrawings.add(dwgPtr); 
	// pfodLinkedList expects its data to be cleaned up by caller if necessary 
}
	
	
byte pfodParser::parse() { // called often
  byte rtn = 0;
  if (parserTimeout != 0) {
      // check for time out
      if ((millis() - lastMsgTime) > parserTimeout) {
         // close connection
         closeConnection();
         return '!';
      }
  }
  if (!io) {
    return rtn;
  }
  while (io->available()) {
    int in = io->read();
    rtn = parse((byte)in);
    if (rtn != 0) {
      // found msg
      lastMsgTime = millis(); // reset timeout
      if (rtn == '!') {
        closeConnection();
      } else { // process dwgs depends on ALL cmds menu items and dwg cmds and loadCmds being unique
        parseDwgCmd(); // do once here for all the dwg cmds
        pfodDrawing *dwgPtr = pfodParser::listOfDrawings.getFirst();
      	while (dwgPtr) {
           dwgPtr->setParser(this); // make this parser the output stream
      	  if (dwgPtr->sendDwg()) {
      	    rtn = 0; // this msg has been replied to
      	    break;
          } else if (dwgPtr->processDwgCmds()) {
      	    rtn = 0; // this msg has been replied to
      	    break; // leave rtn unchanged so main code 
      	    //can detect touch on menu item and pick up changes if necessary
      	  }
      	  dwgPtr = pfodParser::listOfDrawings.getNext();
        }
      }
      return rtn;
    }
  }
  return rtn;
}

/**
   parse
   Inputs:
   byte in -- byte read from Serial port
   Return:
   return 0 if complete message not found yet
   else return first char of cmd when see closing }
   or ignore msg if pfodMaxCmdLen bytes after {
   On non-zero return args[] contains
   the cmd null terminated followed by the args null terminated
   argsCount is the number of args

   parses
   { cmd | arg1 ` arg2 ... }
   { cmd ` arg1 ` arg2 ... }
   { cmd ~ arg1 ~ arg2 ... }
   save the cmd in args[] replace |, ~ and ` with null (\0)
   then save arg1,arg2 etc in args[]
   count of args saved in argCount
   on seeing } return first char of cmd
   if no } seen for pfodMaxCmdLen bytes after starting { then
   ignore msg and start looking for { again

   States:
   before {   parserState == pfodWaitingForStart
   when   { seen parserState == pfodInMsg
*/
byte pfodParser::parse(byte in) {
  if (in == 0xff) {
    // note 0xFF is not a valid utf-8 char
    // but is returned by underlying stream if start or end of connection
    // NOTE: Stream.read() is wrapped in while(Serial.available()) so should not get this
    // unless explicitlly added to stream buffer
    init(); // clean out last partial msg if any
    return 0;
  }
#ifdef DEBUG_MSG_TO_SERIAL     
  if (debugPtr) {
    if ((parserState == pfodWaitingForStart) || (parserState == pfodMsgEnd)) {
  	  debugPtr->print("\n<< ");
    }
    debugPtr->print((char)in);
  }
#endif

  if ((parserState == pfodWaitingForStart) || (parserState == pfodMsgEnd)) {
    parserState = pfodWaitingForStart;
    if (in == pfodMsgStarted) { // found {
      init(); // clean out last cmd
      parserState = pfodMsgStarted;
    } else {
      seqNum = (uint8_t)in; // keep for seqNum
    }
    // else ignore this char as waiting for start {
    // always reset counter if waiting for {
    return 0;
  }

  // else have seen {
  if ((argsIdx >= (pfodMaxMsgLen - 2)) && // -2 since { never stored
      (in != pfodMsgEnd)) {
    // ignore this msg and reset
    // should not happen as pfodApp should limit
    // msgs sent to pfodDevice to <=255 bytes
    init();
    return 0;
  }
  // first char after opening {
  if (parserState == pfodMsgStarted) {
    parserState = pfodInMsg;
    if (in == pfodRefresh) {
      //refresh = true;
      return 0; // skip this byte if get {:
    }
  }
  // else continue. Check for version:
  if ((in == pfodRefresh) && (versionStart != args)) {
    // found first : set version pointer
    args[argsIdx++] = 0;
    versionStart = args;
    cmdStart = args + argsIdx; // next byte after :
    //    if (strlen((const char*)versionStart) != strlen(version)) {
    //      refresh = false;
    //    } else {
    refresh = (strcmp((const char*)versionStart, version) == 0);
    //    }
    return 0;
  }

  // else process this msg char
  // look for special chars | ' }
  if ((in == pfodMsgEnd) || (in == pfodBar) || (in == pfodTilda) || (in == pfodAccent)) {
    args[argsIdx++] = 0;
    if (parserState == pfodArgStarted) {
      // increase count if was parsing arg
      argsCount++;
    }
    if (in == pfodMsgEnd) {
      parserState = pfodMsgEnd; // reset state
      args[argsIdx++] = 0;
      // return command byte found
      // this will return 0 when parsing {} msg
      if (ignoreCmdSeqNum != 0) {
        return cmdStart[0]; // just return all cmds parsed
      } else { // check for duplicate seqNum
        // ignore non-printable cr nl tab etc space
        if ((seqNum <= 32) || (seqNum != lastSeqNum)) {
          // ok new msg
          lastSeqNum = seqNum;
          seqNum = 0;
          return cmdStart[0];
        } else {
          // seqNum = last so skip this msg
          seqNum = 0;
          return 0;
        }
      }
    } else {
      parserState = pfodArgStarted;
    }
    return 0;
  }
  // else normal byte
  args[argsIdx++] = in;
  return 0;
}


/**
   parseLong
   will parse between  -2,147,483,648 to 2,147,483,647
   No error checking done.
   will return 0 for empty string, i.e. first byte == null

   Inputs:
    idxPtr - byte* pointer to start of bytes to parse
    result - long* pointer to where to store result
   return
     byte* updated pointer to bytes after skipping terminator

*/
byte* pfodParser::parseLong(byte* idxPtr, long *result) {
  long rtn = 0;
  boolean neg = false;
  while ( *idxPtr != 0) {
    if (*idxPtr == '-') {
      neg = true;
    } else {
      rtn = (rtn << 3) + (rtn << 1); // *10 = *8+*2
      rtn = rtn +  (*idxPtr - '0');
    }
    ++idxPtr;
  }
  if (neg) {
    rtn = -rtn;
  }
  *result = rtn;
  return ++idxPtr; // skip null
}


void pfodParser::setDebugStream(Print* debugOut) {
  (void)(debugOut);
  // does nothing
}

