-
Notifications
You must be signed in to change notification settings - Fork 0
/
ArduinoSerialLogger.cpp
63 lines (54 loc) · 1.46 KB
/
ArduinoSerialLogger.cpp
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
#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);
}