k3ng_rotator_controller/rotator_debug.cpp

500 lines
15 KiB
C++
Raw Normal View History

//
// contributed by Matt VK5ZM
//
#include "rotator_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)
}
*/