// 
// contributed by Matt VK5ZM
// 

#include "debug.h"

void DebugClass::print(const char *str)
{
	#if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)
	
	if (debug_mode & CONTROL_PORT0)
	{
		control_port->print(str);
	}
	#endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

	#ifdef FEATURE_ETHERNET
	if (debug_mode & ETHERNET_PORT0)
	{
		ethernetclient0.print(str);
	}
	#endif //FEATURE_ETHERNET

	#if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
	if (debug_mode & ETHERNET_PORT1)
	{
		ethernetclient1.print(str);
	}
	#endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
}

void DebugClass::print(const __FlashStringHelper *str)
{
	char c;
	if(!str) return;
	
	/* since str is a const we can't increment it, so do this instead */
	char *p = (char *)str;
	
	/* keep going until we find the null */
	while((c = pgm_read_byte(p++)))
	{
		#if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)
		 if (debug_mode & CONTROL_PORT0)
		 {
			control_port->write(c);
		 }
		#endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

		#ifdef FEATURE_ETHERNET
		 if (debug_mode & ETHERNET_PORT0)
		 {
			ethernetclient0.write(c);
		 }
		#endif //FEATURE_ETHERNET

		#if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
		 if (debug_mode & ETHERNET_PORT1)
		 {
			ethernetclient1.write(c);
		 }
		#endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
	}
}

void DebugClass::print(char ch)
{
	#if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)
	if (debug_mode & CONTROL_PORT0){
		control_port->print(ch);
	}
	#endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

	#ifdef FEATURE_ETHERNET
	if (debug_mode & ETHERNET_PORT0){
		ethernetclient0.print(ch);
	}
	#endif //FEATURE_ETHERNET

	#if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
	if (debug_mode & ETHERNET_PORT1){
		ethernetclient1.print(ch);
	}
	#endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
}

void DebugClass::print(int i)
{
	#if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)
	if (debug_mode & CONTROL_PORT0){
		control_port->print(i);
	}
	#endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

	#ifdef FEATURE_ETHERNET
	if (debug_mode & ETHERNET_PORT0){
		ethernetclient0.print(i);
	}
	#endif //FEATURE_ETHERNET

	#if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
	if (debug_mode & ETHERNET_PORT1){
		ethernetclient1.print(i);
	}
	#endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
}

void DebugClass::print(unsigned int i)
{
	#if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)
	if (debug_mode & CONTROL_PORT0){
		control_port->print(i);
	}
	#endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

	#ifdef FEATURE_ETHERNET
	if (debug_mode & ETHERNET_PORT0){
		ethernetclient0.print(i);
	}
	#endif //FEATURE_ETHERNET

	#if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
	if (debug_mode & ETHERNET_PORT1){
		ethernetclient1.print(i);
	}
	#endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
}

void DebugClass::print(long unsigned int i)
{
	#if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)
	if (debug_mode & CONTROL_PORT0){
		control_port->print(i);
	}
	#endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

	#ifdef FEATURE_ETHERNET
	if (debug_mode & ETHERNET_PORT0){
		ethernetclient0.print(i);
	}
	#endif //FEATURE_ETHERNET

	#if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
	if (debug_mode & ETHERNET_PORT1){
		ethernetclient1.print(i);
	}
	#endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
}

void DebugClass::print(long i)
{
	#if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)
	if (debug_mode & CONTROL_PORT0){
		control_port->print(i);
	}
	#endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

	#ifdef FEATURE_ETHERNET
	if (debug_mode & ETHERNET_PORT0){
		ethernetclient0.print(i);
	}
	#endif //FEATURE_ETHERNET

	#if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
	if (debug_mode & ETHERNET_PORT1){
		ethernetclient1.print(i);
	}
	#endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
}

void DebugClass::print(double i)
{
	#if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)
	if (debug_mode & CONTROL_PORT0){
		control_port->print(i);
	}
	#endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

	#ifdef FEATURE_ETHERNET
	if (debug_mode & ETHERNET_PORT0){
		ethernetclient0.print(i);
	}
	#endif //FEATURE_ETHERNET

	#if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
	if (debug_mode & ETHERNET_PORT1){
		ethernetclient1.print(i);
	}
	#endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
}

void DebugClass::println(double i)
{
	#if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)
	if (debug_mode & CONTROL_PORT0){
		control_port->println(i);
	}
	#endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

	#ifdef FEATURE_ETHERNET
	if (debug_mode & ETHERNET_PORT0){
		ethernetclient0.println(i);
	}
	#endif //FEATURE_ETHERNET

	#if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
	if (debug_mode & ETHERNET_PORT1){
		ethernetclient1.println(i);
	}
	#endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
}

void DebugClass::print(float f,byte places)
{
	char tempstring[16] = "";

	dtostrf( f,0,places,tempstring);

	#if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)
	if (debug_mode & CONTROL_PORT0){
		control_port->print(tempstring);
	}
	#endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

	#ifdef FEATURE_ETHERNET
	if (debug_mode & ETHERNET_PORT0){
		ethernetclient0.print(tempstring);
	}
	#endif //FEATURE_ETHERNET

	#if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
	if (debug_mode & ETHERNET_PORT1){
		ethernetclient1.print(tempstring);
	}
	#endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
}

void DebugClass::print(float f)
{
	char tempstring[16] = "";

	dtostrf( f,0,2,tempstring);

	#if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)
	if (debug_mode & CONTROL_PORT0){
		control_port->print(tempstring);
	}
	#endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

	#ifdef FEATURE_ETHERNET
	if (debug_mode & ETHERNET_PORT0){
		ethernetclient0.print(tempstring);
	}
	#endif //FEATURE_ETHERNET

	#if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
	if (debug_mode & ETHERNET_PORT1){
		ethernetclient1.print(tempstring);
	}
	#endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
}

void DebugClass::println(const char *str)
{
	#if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)
	if (debug_mode & CONTROL_PORT0){
		control_port->println(str);
	}
	#endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

	#ifdef FEATURE_ETHERNET
	if (debug_mode & ETHERNET_PORT0){
		ethernetclient0.println(str);
	}
	#endif //FEATURE_ETHERNET

	#if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
	if (debug_mode & ETHERNET_PORT1){
		ethernetclient1.println(str);
	}
	#endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)

}

void DebugClass::write(const char *str)
{
	#if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)
	if (debug_mode & CONTROL_PORT0){
		control_port->write(str);
	}
	#endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

	#ifdef FEATURE_ETHERNET
	if (debug_mode & ETHERNET_PORT0){
		ethernetclient0.write(str);
	}
	#endif //FEATURE_ETHERNET

	#if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
	if (debug_mode & ETHERNET_PORT1){
		ethernetclient1.write(str);
	}
	#endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)

}

void DebugClass::write(int i)
{
	#if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)
	if (debug_mode & CONTROL_PORT0){
		control_port->write(i);
	}
	#endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

	#ifdef FEATURE_ETHERNET
	if (debug_mode & ETHERNET_PORT0){
		ethernetclient0.write(i);
	}
	#endif //FEATURE_ETHERNET

	#if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
	if (debug_mode & ETHERNET_PORT1){
		ethernetclient1.write(i);
	}
	#endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)

}

//DebugClass Debug;



/*


2015-09-05
old code from ino:



void debug_print(char * print_string){

  #if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION) || defined(UNDER_DEVELOPMENT_REMOTE_UNIT_COMMANDS) 
    if (debug_mode & CONTROL_PORT0){
      control_port->print(print_string);
    }
  #endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

  #ifdef FEATURE_ETHERNET
    if (debug_mode & ETHERNET_PORT0){
      ethernetclient0.print(print_string);
    }
  #endif //FEATURE_ETHERNET

  #if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
    if (debug_mode & ETHERNET_PORT1){
      ethernetclient1.print(print_string);
    }
  #endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)

}
// --------------------------------------------------------------
void debug_println(char * print_string){

  #if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION) || defined(UNDER_DEVELOPMENT_REMOTE_UNIT_COMMANDS)
  if (debug_mode & CONTROL_PORT0){
    control_port->println(print_string);
  }
  #endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

  #ifdef FEATURE_ETHERNET
  if (debug_mode & ETHERNET_PORT0){
    ethernetclient0.println(print_string);
  }
  #endif //FEATURE_ETHERNET

  #if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
  if (debug_mode & ETHERNET_PORT1){
    ethernetclient1.println(print_string);
  }
  #endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)

}
// --------------------------------------------------------------
void debug_print_char(char print_char){

  #if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION) || defined(UNDER_DEVELOPMENT_REMOTE_UNIT_COMMANDS)
  if (debug_mode & CONTROL_PORT0){
    control_port->print(print_char);
  }
  #endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

  #ifdef FEATURE_ETHERNET
  if (debug_mode & ETHERNET_PORT0){
    ethernetclient0.print(print_char);
  }
  #endif //FEATURE_ETHERNET

  #if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
  if (debug_mode & ETHERNET_PORT1){
    ethernetclient1.print(print_char);
  }
  #endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
}
// --------------------------------------------------------------
void debug_write(char * print_string){

  #if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION) || defined(UNDER_DEVELOPMENT_REMOTE_UNIT_COMMANDS)
  if (debug_mode & CONTROL_PORT0){
    control_port->write(print_string);
  }
  #endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

  #ifdef FEATURE_ETHERNET
  if (debug_mode & ETHERNET_PORT0){
    ethernetclient0.write(print_string);
  }
  #endif //FEATURE_ETHERNET

  #if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
  if (debug_mode & ETHERNET_PORT1){
    ethernetclient1.write(print_string);
  }
  #endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1) 

}
// --------------------------------------------------------------
void debug_print_int(int print_int){

  #if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION) || defined(UNDER_DEVELOPMENT_REMOTE_UNIT_COMMANDS)
  if (debug_mode & CONTROL_PORT0){
    control_port->print(print_int);
  }
  #endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

  #ifdef FEATURE_ETHERNET
  if (debug_mode & ETHERNET_PORT0){
    ethernetclient0.print(print_int);
  }
  #endif //FEATURE_ETHERNET

  #if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
  if (debug_mode & ETHERNET_PORT1){
    ethernetclient1.print(print_int);
  }
  #endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1) 


}
// --------------------------------------------------------------
void debug_write_int(int write_int){

  #if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION) || defined(UNDER_DEVELOPMENT_REMOTE_UNIT_COMMANDS)
  if (debug_mode & CONTROL_PORT0){
    control_port->write(write_int);
  }
  #endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

  #ifdef FEATURE_ETHERNET
  if (debug_mode & ETHERNET_PORT0){
    ethernetclient0.write(write_int);
  }  
  #endif //FEATURE_ETHERNET

  #if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
  if (debug_mode & ETHERNET_PORT1){
    ethernetclient1.write(write_int);
  }  
  #endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)

}
// --------------------------------------------------------------
void debug_print_float(float print_float,byte places){

  char tempstring[16] = "";

  dtostrf(print_float,0,places,tempstring);

  #if defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION) || defined(UNDER_DEVELOPMENT_REMOTE_UNIT_COMMANDS)
  if (debug_mode & CONTROL_PORT0){
    control_port->print(tempstring);
  }
  #endif //defined(FEATURE_REMOTE_UNIT_SLAVE) || defined(FEATURE_YAESU_EMULATION) || defined(FEATURE_EASYCOM_EMULATION)

  #ifdef FEATURE_ETHERNET
  if (debug_mode & ETHERNET_PORT0){
    ethernetclient0.print(tempstring);
  }
  #endif //FEATURE_ETHERNET

  #if defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)
  if (debug_mode & ETHERNET_PORT1){
    ethernetclient1.print(tempstring);
  }
  #endif //defined(FEATURE_ETHERNET) && defined(ETHERNET_TCP_PORT_1)  

}
*/