/*
  command.cpp - esp8266 configuration class

  Copyright (c) 2014 Luc Lebosse. All rights reserved.

  This library is free software; you can redistribute it and/or
  modify it under the terms of the GNU Lesser General Public
  License as published by the Free Software Foundation; either
  version 2.1 of the License, or (at your option) any later version.

  This library is distributed in the hope that it will be useful,
  but WITHOUT ANY WARRANTY; without even the implied warranty of
  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  Lesser General Public License for more details.

  You should have received a copy of the GNU Lesser General Public
  License along with this library; if not, write to the Free Software
  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
*/

#include "command.h"
#include "config.h"
#include "wifi.h"
#include "webinterface.h"
extern "C" {
#include "user_interface.h"
}

String COMMAND::buffer_serial;
String COMMAND::buffer_tcp;


void COMMAND::execute_command(int cmd,String cmd_params)
{
    //manage parameters

    switch(cmd) {
        byte mode;
    case 800:
        Serial.print("\nFW version:");
        Serial.println(FW_VERSION);
        break;
    case 100:
        if(!CONFIG::write_string(EP_SSID,cmd_params.c_str())) {
            Serial.println("\nError");
        } else {
            Serial.println("\nOk");
        }
        break;
    case 101:
        if(!CONFIG::write_string(EP_PASSWORD,cmd_params.c_str())) {
            Serial.println("\nError");
        } else {
            Serial.println("\nOk");
        }
        break;
    case 103:

        if (cmd_params=="STA") {
            mode = CLIENT_MODE;
        } else {
            mode=AP_MODE;
        }
        if(!CONFIG::write_byte(EP_WIFI_MODE,mode)) {
            Serial.println("\nError");
        } else {
            Serial.println("\nOk");
        }
        break;
    case 104:
        if (cmd_params=="STATIC") {
            mode = STATIC_IP_MODE;
        } else {
            mode=DHCP_MODE;
        }
        if(!CONFIG::write_byte(EP_IP_MODE,mode)) {
            Serial.println("\nError");
        } else {
            Serial.println("\nOk");
        }
        break;
    case 111: {
        String currentIP ;
        if (wifi_get_opmode()==WIFI_STA) {
            currentIP=WiFi.localIP().toString();
        } else {
            currentIP=WiFi.softAPIP().toString();
        }
        Serial.print("\n\r");
        Serial.print(cmd_params);
        Serial.println(currentIP);
        Serial.print("\r\n");
    }
    break;
    case 444:
        if (cmd_params=="RESET") {
            CONFIG::reset_config();
        }
        if (cmd_params=="SAFEMODE") {
            wifi_config.Safe_Setup();
        }
        if (cmd_params=="CONFIG") {
            CONFIG::print_config();
        }
        break;
    case 888:
        if (cmd_params=="RESTART") {
            Serial.print("\r");
            Serial.print(cmd_params);
            web_interface->restartmodule=true;
            Serial.print("\r\n");
        }
        break;
    case 999:
        if (cmd_params=="ERROR") {
            web_interface->error_msg.clear();
        } else if (cmd_params=="INFO") {
            web_interface->info_msg.clear();
        } else if (cmd_params=="STATUS") {
            web_interface->status_msg.clear();
        } else if (cmd_params=="ALL") {
            web_interface->error_msg.clear();
            web_interface->status_msg.clear();
            web_interface->info_msg.clear();
        }
        break;
        //default:

    }
}

void COMMAND::check_command(String buffer)
{
    static bool bfileslist=false;
    String buffer2;
    static uint32_t start_list=0;
    //if SD list is not on going
    if (!bfileslist) {
		//check if command is a start of SD File list
        int filesstart = buffer.indexOf("Begin file list");
        //yes it is file list starting to be displayed
        if (filesstart>-1) {
			//init time out
            start_list=system_get_time();
            //set file list started
            bfileslist=true;
            //clear current list
            web_interface->fileslist.clear();
            //block any new output to serial from ESP to avoid pollution
            (web_interface->blockserial) = true;
            return;
        }
        int Tpos = buffer.indexOf("T:");
        int Xpos = buffer.indexOf("X:");
        int Ypos = buffer.indexOf("Y:");
        int Zpos = buffer.indexOf("Z:");
#if FIRMWARE_TARGET == SMOOTHIEWARE
        int Speedpos = buffer.indexOf("Speed factor at ");
        int Flowpos = buffer.indexOf("Flow rate at ");
        int Errorpos= buffer.indexOf("error:");
        int Infopos= buffer.indexOf("info:");
        int Statuspos= buffer.indexOf("warning:");
#else
		int Speedpos = buffer.indexOf("SpeedMultiply:");
        int Flowpos = buffer.indexOf("FlowMultiply:");
        int Errorpos= buffer.indexOf("Error:");
        int Infopos= buffer.indexOf("Info:");
        int Statuspos= buffer.indexOf("Status:");
#endif

#ifdef SERIAL_COMMAND_FEATURE
        String ESP_Command;
        int ESPpos = buffer.indexOf("[ESP");
        if (ESPpos>-1) {
            //is there the second part?
            int ESPpos2 = buffer.indexOf("]",ESPpos);
            if (ESPpos2>-1) {
                //Split in command and parameters
                String cmd_part1=buffer.substring(ESPpos+4,ESPpos2);
                String cmd_part2="";
                //is there space for parameters?
                if (ESPpos2<buffer.length()) {
                    cmd_part2=buffer.substring(ESPpos2+1);
                }
                //if command is a valid number then execute command
                if(cmd_part1.toInt()!=0) {
                    execute_command(cmd_part1.toInt(),cmd_part2);
                }
                //if not is not a valid [ESPXXX] command
            }
        }
#endif
        //check for temperature
        if (Tpos>-1) {
            //look for valid temperature answer
            int slashpos = buffer.indexOf(" /",Tpos);
            int spacepos = buffer.indexOf(" ",slashpos+1);
            //if match mask T:xxx.xx /xxx.xx
            if(spacepos-Tpos < 17) {
                web_interface->answer4M105=buffer; //do not interprete just need when requested so store it
                web_interface->last_temp=system_get_time();
            }
        }
        //Position of axis
        if (Xpos>-1 && Ypos>-1 && Zpos>-1) {
            web_interface->answer4M114=buffer;
        }
        //Speed
        if (Speedpos>-1) {
			//get just the value
			
#if FIRMWARE_TARGET == SMOOTHIEWARE
			buffer2 =buffer.substring(Speedpos+16);
			int p2 = buffer2.indexOf(".");
            web_interface->answer4M220=buffer2.substring(0,p2);
#else
			web_interface->answer4M220=buffer.substring(Speedpos+14);
#endif
            
        }
        //Flow
        if (Flowpos>-1) {
			//get just the value
           
#if FIRMWARE_TARGET == SMOOTHIEWARE
			buffer2 =buffer.substring(Flowpos+13);
			int p2 = buffer2.indexOf(".");
            web_interface->answer4M221=buffer2.substring(0,p2);
#else
			web_interface->answer4M221=buffer.substring(Flowpos+13);
#endif
        }
        //Error
        if (Errorpos>-1 && !(buffer.indexOf("Format error")!=-1 || buffer.indexOf("wait")==Errorpos+6) ) {
            (web_interface->error_msg).add(buffer.substring(Errorpos+6).c_str());
        }
        //Info
        if (Infopos>-1) {
            (web_interface->info_msg).add(buffer.substring(Infopos+5).c_str());
        }
        //Status
        if (Statuspos>-1) {
#if FIRMWARE_TARGET == SMOOTHIEWARE
            (web_interface->status_msg).add(buffer.substring(Statuspos+8).c_str());
#else
			(web_interface->status_msg).add(buffer.substring(Statuspos+7).c_str());
#endif
        }
    } else { //listing file is on going
		//check if we are too long 
        if ((system_get_time()-start_list)>30000000) { //timeout in case of problem
            bfileslist=false;
            (web_interface->blockserial) = false; //release serial
        } else {
			//check if this is the end
            if (buffer.indexOf("End file list")>-1) {
                bfileslist=false;
                (web_interface->blockserial) = false; 
            } else {
                //Serial.print(buffer);
                //add list to buffer
                web_interface->fileslist.add(buffer);
            }
        }

    }
}

//read a buffer in an array
void COMMAND::read_buffer_serial(uint8_t *b, size_t len)
{
    for (long i = 0; i< len; i++) {
        read_buffer_serial(*b);
        *b++;
    }
}

//read buffer as char
void COMMAND::read_buffer_tcp(uint8_t b)
{
    static bool previous_was_char=false;
//to ensure it is continuous string, no char separated by binaries
    if (!previous_was_char) {
        buffer_tcp="";
    }
//it is a char so add it to buffer
    if (isPrintable(b)) {
        previous_was_char=true;
        buffer_tcp+=char(b);
    } else {
        previous_was_char=false; //next call will reset the buffer
    }
//this is not printable but end of command check if need to handle it
    if (b==13 ||b==10) {
        //Minimum is something like M10 so 3 char
        if (buffer_tcp.length()>3) {
            check_command(buffer_tcp);
        }
    }
}

//read buffer as char
void COMMAND::read_buffer_serial(uint8_t b)
{
    static bool previous_was_char=false;
//to ensure it is continuous string, no char separated by binaries
    if (!previous_was_char) {
        buffer_serial="";
    }
//it is a char so add it to buffer
    if (isPrintable(b)) {
        previous_was_char=true;
        buffer_serial+=char(b);
    } else {
        previous_was_char=false; //next call will reset the buffer
    }
//this is not printable but end of command check if need to handle it
    if (b==13 ||b==10) {
        //Minimum is something like M10 so 3 char
        if (buffer_serial.length()>3) {
            check_command(buffer_serial);
        }
    }
}