serialcmd.h

#ifndef serialcmd_h
#define serialcmd_h

#include <temp_logger.h>
#include <motor.h> // @todo remove
#include <ssr.h>   // @todo remove
#include <pid.h>   // @todo remove

// HardwareSerial DebugOut = Serial;
// HardwareSerial DebugOut(0);
// Print Debug = &Serial;
Stream &DebugOut = Serial;

#ifdef DEBUG
bool debug_serialcmd = true;
#else
bool debug_serialcmd = true;
#endif

bool DEBUG_SERIALCMD = true;

// @todo use single stream listener
// see `readSerial` for serial and telnet etc.

  // SERIAL CONSOLE
#define MAX_NUM_CHARS 32 // maximum number of characters read from the Serial Monitor
char cmd[MAX_NUM_CHARS];       // char[] to store incoming serial commands
bool cmd_complete = false;  // whether the command string is complete

void recvChar(void) {
  static byte index = 0;
  while (Serial.available() > 0 && cmd_complete == false) {
    char rc = Serial.read();
    // Serial.println(rc);
    // @todo handle endlines of any type
    if (rc != '\n') {
      if(index < MAX_NUM_CHARS) cmd[index++] = rc;
    } else {
      cmd[index] = '\0'; // terminate the string
      index = 0;
      cmd_complete = true;
      if(DEBUG_SERIALCMD){
        Serial.print("[CMD] received '"); 
        Serial.print(cmd); 
        Serial.println("'");
      }
    }
    delay(0);
  }
}

/*
 * Prints a usage menu.
 */
const char usageText[] PROGMEM = R"=====(
Usage:
m <n> : select mode <n>

b+    : increase brightness
b-    : decrease brightness
b <n> : set brightness to <n>

s+    : increase speed
s-    : decrease speed
s <n> : set speed to <n>

c 0x007BFF : set color to 0x007BFF

Have a nice day.
~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
)=====";

void printUsage() {
  Serial.println((const __FlashStringHelper *)usageText);
}

// @todo switch to h file funcs
void doMotor(int dir,int duration){
  motorDir = dir;
  motorChange = true;
}


void command_reset(){
  cmd[0] = '\0';         // reset the commandstring
  cmd_complete = false;  // reset command complete 
}

// @todo replace with api or command processor library from ESPLSS
// @todo newlines included in arguments!!
void process_command(){
  if (strncmp(cmd,"f ",2) == 0) {
    uint32_t arg = (uint32_t)atoi(cmd + 2);
    if(DEBUG_SERIALCMD) DebugOut.print(F("Set value to: ") );
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    fanAV((int)arg);
    fanBV((int)arg);
  }

  if (strncmp(cmd,"f1 ",3) == 0) {
    uint32_t arg = (uint32_t)atoi(cmd + 2);
    if(DEBUG_SERIALCMD) DebugOut.print(F("Set voltage to: ") );
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    if((int)arg == 1) arg = 500;
    fanAVolts((int)arg);
  }

  if (strncmp(cmd,"f2 ",3) == 0) {
    uint32_t arg = (uint32_t)atoi(cmd + 2);
    if(DEBUG_SERIALCMD) DebugOut.print(F("Set B voltage to: ") );
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    if((int)arg == 1) arg = 500;    
    fanBVolts((int)arg);
  }

  if (strncmp(cmd,"f3 ",3) == 0) {
    uint32_t arg = (uint32_t)atoi(cmd + 2);
    if(DEBUG_SERIALCMD) DebugOut.print(F("Set C eanble to: ") );
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    fanCEnable((int)arg == 1);
  }

  if (strncmp(cmd,"f4 ",3) == 0) {
    uint32_t arg = (uint32_t)atoi(cmd + 2);
    if(DEBUG_SERIALCMD) DebugOut.print(F("Set D eanble to: ") );
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    fanDEnable((int)arg == 1);
  }

  if (strncmp(cmd,"mo",2) == 0) {
    if(DEBUG_SERIALCMD) DebugOut.println(F("Motor OFF: ") );
    doMotor(0,0);
  }

  if (strncmp(cmd,"mf",2) == 0) {
    uint32_t arg = (uint32_t)atoi(cmd + 2);
    if(DEBUG_SERIALCMD) DebugOut.print(F("Motor ON F: ") );
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    doMotor(1,(int)arg);
  }

  if (strncmp(cmd,"mr",2) == 0) {
    uint32_t arg = (uint32_t)atoi(cmd + 2);
    if(DEBUG_SERIALCMD) DebugOut.print(F("Motor ON R: ") );
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    doMotor(2,(int)arg);
  }

  if (strncmp(cmd,"freq ",5) == 0) {
    uint32_t arg = (uint32_t)atoi(cmd + 5);
    if(DEBUG_SERIALCMD) DebugOut.print(F("Set freq to: ") );
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
      #ifdef ESP8266
      analogWriteFreq(arg); // confirm ?
      #endif
  }

  if (strncmp(cmd,"A",1) == 0) {
    uint8_t arg = (uint8_t)atoi(cmd + 2);
    if(DEBUG_SERIALCMD) DebugOut.println(F("ABORT REFLOW") );
    // if(DEBUG_SERIALCMD) DebugOut.println(arg);
    reflowAbort();
  }

  if (strncmp(cmd,"R",1) == 0) {
    uint8_t arg = (uint8_t)atoi(cmd + 2);
    if(DEBUG_SERIALCMD) DebugOut.print(F("REFLOW") );
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    startReflow();  
  }

  if (strncmp(cmd,"C",1) == 0) {
    uint8_t arg = (uint8_t)atoi(cmd + 2);
    if(DEBUG_SERIALCMD) DebugOut.println(F("COOLDOWN") );
    cool(false);
    // coolDown();
  }

  if (strncmp(cmd,"S",1) == 0) {
    uint8_t arg = (uint8_t)atoi(cmd + 2);
    if(DEBUG_SERIALCMD) DebugOut.println(F("SLEEP") );
    sleep();
  }

  if (strncmp(cmd,"B ",2) == 0) {
    uint8_t arg = (uint8_t)atoi(cmd + 2);
    if(DEBUG_SERIALCMD) DebugOut.print(F("BUTTON") );
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
  }

  if (strncmp(cmd,"X",1) == 0) {
    uint8_t arg = (uint8_t)atoi(cmd + 2);
    if(DEBUG_SERIALCMD) DebugOut.print(F("REBOOT") );
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    reboot();
  }

  if (strncmp(cmd,"ssr ",4) == 0) {
    uint32_t arg = (uint32_t)atoi(cmd + 4);
    if(DEBUG_SERIALCMD) DebugOut.print(F("[CMD] [SSR] MANUAL SET duty:") );
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    SetSSRFrequency((int)arg);
  }

  if (strncmp(cmd,"temp ",5) == 0) {
    uint32_t arg = (uint32_t)atoi(cmd + 5);
    if(DEBUG_SERIALCMD) DebugOut.print(F("[CMD] [TEMP] set:") );
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    wantedTemp = (int)arg;
    Serial.println("[ERROR] START PID : " + (String)wantedTemp);
    if(wantedTemp == 0) stop_PID();
    stateTimerReset(); 
    MatchTemp();
  }

  if (strncmp(cmd,"a0 ",3) == 0) {
    uint32_t arg = (uint32_t)atoi(cmd + 3);
    if(DEBUG_SERIALCMD) DebugOut.print(F("[CMD] [ANALOG] duty:") );
    if(DEBUG_SERIALCMD) DebugOut.println((int)arg);
    #ifdef ESP8266
     analogWrite(16,(int)(arg));
    #endif
  }

  if (strncmp(cmd,"debugbox",8) == 0) {
    debug_serialcmd = !debug_serialcmd;
    DEBUG_BOX = !DEBUG_BOX;
    if(DEBUG_SERIALCMD) DebugOut.println("[CMD] [DEBUGBOX]:" + (String)(DEBUG_BOX?"ON":"OFF"));
    command_reset();
    return;
  }

  if (strncmp(cmd,"debug",5) == 0) {
    debug_serialcmd = !debug_serialcmd;
    if(DEBUG_SERIALCMD) DebugOut.println("[CMD] [DEBUG]:" + (String)(debug_serialcmd?"ON":"OFF"));
  }

  if (strncmp(cmd,"pidtune ",8) == 0) {
    uint32_t arg = (uint32_t)atoi(cmd + 8); 
    targetInputValue = (float)(int)arg;
    if(DEBUG_SERIALCMD) DebugOut.println("[DEBUG]: AUTOTUNING PID " + (String)arg);
    init_pidtune();
  }

  if (strncmp(cmd,"set title ",10) == 0) {
    String arg = String(cmd).substring(10,String(cmd).length()); 
    SetTitle(arg);
  }

  if (strncmp(cmd,"set filter ",11) == 0) {
    String arg = String(cmd).substring(11,String(cmd).length()); 
    SetFilterId((int)atoi(arg.c_str()));
  }

  // new code
  String inputCmd = "";
  int numargs = 0;
  int cmdLen = 0;

  inputCmd = "set indbright";
  numargs = 1;
  cmdLen = String(inputCmd).length();
  if (strncmp(cmd,inputCmd.c_str(),cmdLen) == 0) {
    String arg = String(cmd).substring(cmdLen+1,String(cmd).length()); 
    if(DEBUG_SERIALCMD) DebugOut.print("[CMD] ["+inputCmd+"] arg: ");
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    setIndBrightness(atoi(arg.c_str()));
    command_reset();
    return;    
  }

  inputCmd = "test ind";
  numargs = 1;
  cmdLen = String(inputCmd).length();
  if (strncmp(cmd,inputCmd.c_str(),cmdLen) == 0) {
    String arg = String(cmd).substring(cmdLen+1,String(cmd).length()); 
    if(DEBUG_SERIALCMD) DebugOut.print("[CMD] ["+inputCmd+"]");
    indTest();
  }

  inputCmd = "set ind";
  numargs = 1;
  cmdLen = String(inputCmd).length();
  if (strncmp(cmd,inputCmd.c_str(),cmdLen) == 0) {
    String arg = String(cmd).substring(cmdLen+1,String(cmd).length()); 
    if(DEBUG_SERIALCMD) DebugOut.print("[CMD] ["+inputCmd+"] arg: ");
    if(DEBUG_SERIALCMD) DebugOut.print("'");
    if(DEBUG_SERIALCMD) DebugOut.print(arg);
    if(DEBUG_SERIALCMD) DebugOut.println("'");
         if(arg == "white" || arg == "1") indSetColor(255,255,255);
    else if(arg == "black" || arg == "0") indSetColor(0,0,0);
    else if(arg == "red" || arg == "bad") indSetColor(255,0,0);
    else if(arg == "green" || arg == "good") indSetColor(0,255,0);
    else if(arg == "blue") indSetColor(0,0,255);
    else {
      DebugOut.println("[CMD] set to user input");
      // indSetColor(indWheel((byte)atoi(arg.c_str())));
      ind.setPixelColor(0,indWheel((byte)atoi(arg.c_str())));
    }
  }

  inputCmd = "set accent";
  numargs = 1;
  cmdLen = String(inputCmd).length();
  if (strncmp(cmd,inputCmd.c_str(),cmdLen) == 0) {
    String arg = String(cmd).substring(cmdLen+1,String(cmd).length());
    if(DEBUG_SERIALCMD) DebugOut.print("[CMD] ["+inputCmd+"] arg: '");
    if(DEBUG_SERIALCMD) DebugOut.print(arg);
    if(DEBUG_SERIALCMD) DebugOut.print("'");
         if(arg == "white") indAccentSetColor(255,255,255);
    else if(arg == "black") indAccentSetColor(0,0,0);
    else if(arg == "red" || arg == "bad") indAccentSetColor(255,0,0);
    else if(arg == "green" || arg == "good") indAccentSetColor(0,255,0);
    else if(arg == "blue") indAccentSetColor(0,0,255);
    else indAccentSetColor(indWheel((byte)atoi(arg.c_str())));
  }

  inputCmd = "set int";
  numargs = 1;
  cmdLen = String(inputCmd).length();
  if (strncmp(cmd,inputCmd.c_str(),cmdLen) == 0) {
    String arg = String(cmd).substring(cmdLen+1,String(cmd).length()); 
    if(DEBUG_SERIALCMD) DebugOut.print("[CMD] ["+inputCmd+"] arg: ");
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    setgraphInterval((int)atoi(arg.c_str()));
  }

  inputCmd = "set tcint";
  numargs = 1;
  cmdLen = String(inputCmd).length();
  if (strncmp(cmd,inputCmd.c_str(),cmdLen) == 0) {
    String arg = String(cmd).substring(cmdLen+1,String(cmd).length()); 
    if(DEBUG_SERIALCMD) DebugOut.print("[CMD] ["+inputCmd+"] arg: ");
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    setTCInterval((int)atoi(arg.c_str()));
  }

  inputCmd = "set pid p";
  numargs = 1;
  cmdLen = String(inputCmd).length();
  if (strncmp(cmd,inputCmd.c_str(),cmdLen) == 0) {
    String arg = String(cmd).substring(cmdLen+1,String(cmd).length()); 
    if(DEBUG_SERIALCMD) DebugOut.print("[CMD] ["+inputCmd+"] arg: ");
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    Kp = ((double)atoi(arg.c_str()));
    myPID.SetTunings(Kp, Ki, Kd); 
  }

  inputCmd = "set pid i";
  numargs = 1;
  cmdLen = String(inputCmd).length();
  if (strncmp(cmd,inputCmd.c_str(),cmdLen) == 0) {
    String arg = String(cmd).substring(cmdLen+1,String(cmd).length()); 
    if(DEBUG_SERIALCMD) DebugOut.print("[CMD] ["+inputCmd+"] arg: ");
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    Ki = ((double)atoi(arg.c_str()));
    myPID.SetTunings(Kp, Ki, Kd); 

  }

  inputCmd = "set pid d";
  numargs = 1;
  cmdLen = String(inputCmd).length();
  if (strncmp(cmd,inputCmd.c_str(),cmdLen) == 0) {
    String arg = String(cmd).substring(cmdLen+1,String(cmd).length()); 
    if(DEBUG_SERIALCMD) DebugOut.print("[CMD] ["+inputCmd+"] arg: ");
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    Kd = ((double)atoi(arg.c_str()));
    myPID.SetTunings(Kp, Ki, Kd);     
  }
 
  inputCmd = "testbargraph";
  numargs = 1;
  cmdLen = String(inputCmd).length();
  if (strncmp(cmd,inputCmd.c_str(),cmdLen) == 0) {
    if(DEBUG_SERIALCMD) DebugOut.println("testbargraph");
    testBargraph();
  }
  
  inputCmd = "wifi";
  numargs = 1;
  cmdLen = String(inputCmd).length();
  if (strncmp(cmd,inputCmd.c_str(),cmdLen) == 0) {
    String arg = String(cmd).substring(cmdLen+1,String(cmd).length()); 
    if(DEBUG_SERIALCMD) DebugOut.print("[CMD] ["+inputCmd+"] arg: ");
    if(DEBUG_SERIALCMD) DebugOut.println(arg);
    if(arg=="off")WiFi.mode(WIFI_OFF);
    else WiFi.mode(WIFI_STA);
  }

command_reset();
}

void serialprocess(){
  recvChar(); // read serial comm
  if(cmd_complete) {
    process_command();
  }
}

String inputString;         // a string to hold incoming data
bool stringComplete = false; // whether the string is complete
bool echo = false;

char inData[32]; // Allocate some space for the string, cmd buffer
char inChar= 0; // Where to store the character read
byte inidx = 0; // Index into array; where to store the character

void emptyBuffer(){
    // clear buffer
    inidx = 0;
    inData[0] = (char)0;
    inputString = "";
}

void parseSerial(Stream & consolePort,char *cmdStr){
    DebugOut.println("---------------------------");
    DebugOut.println("Start Parsing");
        // Serial.println(Serial.peek());
     // inputString = consolePort.readStringUntil('\n');
     DebugOut.println(cmdStr);
     consolePort.println(cmdStr);
     // cmd = cmdStr;
     strncpy(cmd, cmdStr, 32);
     process_command();
}

// FF FD 3 FF FD 1 mode raw character
// FF FE 3 FF FE 1 mode line
// 
void readSerial(Stream & consolePort){
    while (consolePort.available() > 0) // Don't read unless
                                   // there you know there is data
    {
        DebugOut.println("Bytes avail: " + (String)consolePort.available());
        inChar = consolePort.read(); // Read a character
        if(inChar == 0x00) DebugOut.println("Char: NULL");
        if(inidx < 32 && inChar != 0x00) // buffer not full and not null
        {
            inputString += inChar;
            inData[inidx] = inChar; // Store it
            inidx++; // Increment where to write next
            
            // debugging
            if(inChar == 0x0A) DebugOut.print("Char: LF ");
            else if(inChar == 0x0D) DebugOut.print("Char: CR ");
            else DebugOut.print("Char: " + (String)inChar + " ");
            DebugOut.print(inChar,HEX);
            DebugOut.print(" ");
            DebugOut.print(inChar,OCT);
            DebugOut.println("");
    
            if(echo && (inChar > 0x1F)) consolePort.print(inChar);

            // newline detected
            if (inChar == 0x0D || inChar == 0x0A){
                // ignore LF following CR
                if(consolePort.available() > 0 && consolePort.peek() == 0x0A){
                    DebugOut.println("Ignoring LF");
                    // consolePort.flush(); // @todo I think this works on incoming? not sure, NOPE
                    consolePort.read(); // eat LF from input buffer
                }
                inData[inidx++] = '\0'; // Null terminate the string
                DebugOut.println("LINE RECEIVED");
                // DebugOut.println(inputString);
                // DebugOut.flush();
                // if(echo) consolePort.println("");
                // handle string
                parseSerial(consolePort,inData);
                emptyBuffer();
            }
        }
        else if(inChar != 0x00){
            consolePort.println("ERROR: CMD BUFFER FULL");
            emptyBuffer();
        }
    }
}


// class DualWriter : public Print{
//     public:
//       DualWriter( Print &p_Out1, Print &p_Out2 ) : OutputA( p_Out1 ), OutputB( p_Out2 ){}
       
//       size_t write( uint8_t u_Data )
//         {
//           OutputA.write( u_Data );
//           OutputB.write( u_Data );
//           return 0x01;
//         }
//     protected:
//       Print &OutputA;
//       Print &OutputB;
//   }; 

#endif