fsfw/serviceinterface/ServiceInterfacePrinter.cpp

141 lines
3.6 KiB
C++
Raw Normal View History

2021-01-03 01:49:12 +01:00
#include <FSFWConfig.h>
2021-01-02 23:22:50 +01:00
#include "ServiceInterfacePrinter.h"
#include "serviceInterfaceDefintions.h"
2021-01-03 01:02:07 +01:00
#include "../timemanager/Clock.h"
#include <cstdarg>
#include <cstdint>
2021-01-12 15:06:25 +01:00
static sif::PrintLevel printLevel = sif::PrintLevel::DEBUG_LEVEL;
#if defined(WIN32) && FSFW_COLORED_OUTPUT == 1
static bool consoleInitialized = false;
#endif /* defined(WIN32) && FSFW_COLORED_OUTPUT == 1 */
#if FSFW_DISABLE_PRINTOUT == 0
static bool addCrAtEnd = false;
2021-01-03 01:02:07 +01:00
uint8_t printBuffer[fsfwconfig::FSFW_PRINT_BUFFER_SIZE];
2021-01-12 15:06:25 +01:00
void fsfwPrint(sif::PrintLevel printType, const char* fmt, va_list arg) {
2021-01-03 15:15:03 +01:00
#if defined(WIN32) && FSFW_COLORED_OUTPUT == 1
if(not consoleInitialized) {
HANDLE hOut = GetStdHandle(STD_OUTPUT_HANDLE);
DWORD dwMode = 0;
GetConsoleMode(hOut, &dwMode);
dwMode |= ENABLE_VIRTUAL_TERMINAL_PROCESSING;
SetConsoleMode(hOut, dwMode);
}
consoleInitialized = true;
#endif
2021-01-03 01:49:12 +01:00
size_t len = 0;
2021-01-03 01:47:01 +01:00
char* bufferPosition = reinterpret_cast<char*>(printBuffer);
2021-01-03 01:02:07 +01:00
/* Check logger level */
2021-01-12 15:06:25 +01:00
if(printType == sif::PrintLevel::NONE or printType > printLevel) {
2021-01-03 01:02:07 +01:00
return;
}
/* Log message to terminal */
#if FSFW_COLORED_OUTPUT == 1
2021-01-12 15:06:25 +01:00
if(printType == sif::PrintLevel::INFO_LEVEL) {
len += sprintf(bufferPosition, sif::ANSI_COLOR_GREEN);
2021-01-03 01:02:07 +01:00
}
2021-01-12 15:06:25 +01:00
else if(printType == sif::PrintLevel::DEBUG_LEVEL) {
len += sprintf(bufferPosition, sif::ANSI_COLOR_MAGENTA);
2021-01-03 01:02:07 +01:00
}
2021-01-12 15:06:25 +01:00
else if(printType == sif::PrintLevel::WARNING_LEVEL) {
len += sprintf(bufferPosition, sif::ANSI_COLOR_YELLOW);
2021-01-03 01:02:07 +01:00
}
2021-01-12 15:06:25 +01:00
else if(printType == sif::PrintLevel::ERROR_LEVEL) {
len += sprintf(bufferPosition, sif::ANSI_COLOR_RED);
2021-01-03 01:02:07 +01:00
}
#endif
2021-01-12 15:06:25 +01:00
if (printType == sif::PrintLevel::INFO_LEVEL) {
2021-01-03 01:47:01 +01:00
len += sprintf(bufferPosition + len, "INFO: ");
2021-01-03 01:02:07 +01:00
}
2021-01-12 15:06:25 +01:00
if(printType == sif::PrintLevel::DEBUG_LEVEL) {
2021-01-03 01:47:01 +01:00
len += sprintf(bufferPosition + len, "DEBUG: ");
2021-01-03 01:02:07 +01:00
}
2021-01-12 15:06:25 +01:00
if(printType == sif::PrintLevel::WARNING_LEVEL) {
2021-01-03 01:47:01 +01:00
len += sprintf(bufferPosition + len, "WARNING: ");
2021-01-03 01:02:07 +01:00
}
2021-01-12 15:06:25 +01:00
if(printType == sif::PrintLevel::ERROR_LEVEL) {
2021-01-03 01:47:01 +01:00
len += sprintf(bufferPosition + len, "ERROR: ");
2021-01-03 01:02:07 +01:00
}
Clock::TimeOfDay_t now;
Clock::getDateAndTime(&now);
/*
* Log current time to terminal if desired.
*/
2021-01-03 01:47:01 +01:00
len += sprintf(bufferPosition + len, "| %lu:%02lu:%02lu.%03lu | ",
2021-01-03 01:02:07 +01:00
(unsigned long) now.hour,
(unsigned long) now.minute,
(unsigned long) now.second,
(unsigned long) now.usecond /1000);
2021-01-03 01:47:01 +01:00
len += vsnprintf(bufferPosition + len, sizeof(printBuffer) - len, fmt, arg);
2021-01-03 01:02:07 +01:00
2021-01-12 15:06:25 +01:00
if(addCrAtEnd) {
len += sprintf(bufferPosition + len, "\r");
}
2021-01-03 01:02:07 +01:00
2021-01-12 15:06:25 +01:00
printf("%s", printBuffer);
2021-01-03 01:02:07 +01:00
}
2021-01-12 15:06:25 +01:00
void sif::printInfo(const char *fmt, ...) {
2021-01-03 01:02:07 +01:00
va_list args;
va_start(args, fmt);
2021-01-12 15:06:25 +01:00
fsfwPrint(sif::PrintLevel::INFO_LEVEL, fmt, args);
2021-01-03 01:02:07 +01:00
va_end(args);
}
2021-01-12 15:06:25 +01:00
void sif::printWarning(const char *fmt, ...) {
2021-01-03 01:02:07 +01:00
va_list args;
va_start(args, fmt);
2021-01-12 15:06:25 +01:00
fsfwPrint(sif::PrintLevel::WARNING_LEVEL, fmt, args);
2021-01-03 01:02:07 +01:00
va_end(args);
}
2021-01-12 15:06:25 +01:00
void sif::printDebug(const char *fmt, ...) {
2021-01-03 01:02:07 +01:00
va_list args;
va_start(args, fmt);
2021-01-12 15:06:25 +01:00
fsfwPrint(sif::PrintLevel::DEBUG_LEVEL, fmt, args);
2021-01-03 01:02:07 +01:00
va_end(args);
}
2021-01-12 15:06:25 +01:00
void sif::setToAddCrAtEnd(bool addCrAtEnd_) {
addCrAtEnd = addCrAtEnd_;
}
void sif::printError(const char *fmt, ...) {
2021-01-03 01:02:07 +01:00
va_list args;
va_start(args, fmt);
2021-01-12 15:06:25 +01:00
fsfwPrint(sif::PrintLevel::ERROR_LEVEL, fmt, args);
2021-01-03 01:02:07 +01:00
va_end(args);
}
2021-01-12 15:06:25 +01:00
#else
void sif::printInfo(const char *fmt, ...) {}
void sif::printWarning(const char *fmt, ...) {}
void sif::printDebug(const char *fmt, ...) {}
void sif::printError(const char *fmt, ...) {}
#endif /* FSFW_DISABLE_PRINTOUT == 0 */
void sif::setPrintLevel(PrintLevel printLevel_) {
printLevel = printLevel_;
}
sif::PrintLevel sif::getPrintLevel() {
return printLevel;
}