64 lines
1.5 KiB
C++
64 lines
1.5 KiB
C++
|
#include "ArduinoSerialLogger.h"
|
||
|
|
#include <stdarg.h>
|
||
|
|
|
||
|
|
ArduinoSerialLogger::ArduinoSerialLogger(Serial_ &hardwareSerial):
|
||
|
|
hardwareSerial(hardwareSerial)
|
||
|
|
{
|
||
|
|
hardwareSerial.begin(DEBUG_CONSOLE_BAUD);
|
||
|
|
}
|
||
|
|
|
||
|
|
ArduinoSerialLogger::~ArduinoSerialLogger()
|
||
|
|
{
|
||
|
|
hardwareSerial.end();
|
||
|
|
}
|
||
|
|
|
||
|
|
void ArduinoSerialLogger::debug(const char *format, ...) const
|
||
|
|
{
|
||
|
|
va_list args;
|
||
|
|
va_start(args, format);
|
||
|
|
formatLog("DBG/", format, args);
|
||
|
|
va_end(args);
|
||
|
|
}
|
||
|
|
|
||
|
|
void ArduinoSerialLogger::info(const char *format, ...) const
|
||
|
|
{
|
||
|
|
va_list args;
|
||
|
|
va_start(args, format);
|
||
|
|
formatLog("INF/", format, args);
|
||
|
|
va_end(args);
|
||
|
|
}
|
||
|
|
|
||
|
|
void ArduinoSerialLogger::warning(const char *format, ...) const
|
||
|
|
{
|
||
|
|
va_list args;
|
||
|
|
va_start(args, format);
|
||
|
|
formatLog("WRN/", format, args);
|
||
|
|
va_end(args);
|
||
|
|
}
|
||
|
|
|
||
|
|
void ArduinoSerialLogger::error(const char *format, ...) const
|
||
|
|
{
|
||
|
|
va_list args;
|
||
|
|
va_start(args, format);
|
||
|
|
formatLog("ERR/", format, args);
|
||
|
|
va_end(args);
|
||
|
|
}
|
||
|
|
|
||
|
|
void ArduinoSerialLogger::flush() const
|
||
|
|
{
|
||
|
|
hardwareSerial.flush();
|
||
|
|
}
|
||
|
|
|
||
|
|
void ArduinoSerialLogger::formatLog(const char *level, const char *format, va_list args) const
|
||
|
|
{
|
||
|
|
char newFormat[128];
|
||
|
|
/* This is the least crappy solution I came up with at 23:40 after a beer.
|
||
|
|
* sstream is not available on this platform.
|
||
|
|
* CAN YOU SPOT THE BUG? */
|
||
|
|
snprintf(newFormat, sizeof(newFormat), "%s%s\n", level, format);
|
||
|
|
|
||
|
|
char buffer[256];
|
||
|
|
vsnprintf(buffer, sizeof(buffer), newFormat, args);
|
||
|
|
hardwareSerial.print(buffer);
|
||
|
|
}
|