/* 
  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 "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)
    {
		case 800:
			Serial.println("\nCommand received");
		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 888:
			if (cmd_params=="RESTART")
				{
				Serial.print("\r");
				Serial.print(cmd_params);
				web_interface->restartmodule=true;
				Serial.print("\r\n");
				}
		break;
		//default:

	}
}

void COMMAND::check_command(String buffer)
{
	String ESP_Command;
	//look for ESP command
	//is there a first part ?
	int ESPpos = buffer.indexOf("[ESP");
	int Tpos = buffer.indexOf("T:");
	int Xpos = buffer.indexOf("X:");
	int Ypos = buffer.indexOf("Y:");
	int Zpos = buffer.indexOf("Z:");
	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:");
	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(atoi(cmd_part1.c_str())!=0)execute_command(atoi(cmd_part1.c_str()),cmd_part2);
				//if not is not a valid [ESPXXX] command
			}
		}
	//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)web_interface->answer4M220=buffer.substring(Speedpos+14);
	//Flow
	if (Flowpos>-1)web_interface->answer4M221=buffer.substring(Flowpos+13);
	//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)(web_interface->status_msg).add(buffer.substring(Statuspos+7).c_str());
}

//read a buffer in an array
void COMMAND::read_buffer_serial(uint8_t *b, size_t len)
{
for (long i; 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);
	}
}