Tactility/TactilityCore/Source/Log.cpp

#ifndef ESP_PLATFORM

#include "Log.h"

#ifdef ESP_PLATFORM
#include "freertos/FreeRTOS.h"
#include "freertos/task.h"
#else
#include <cstdint>
#include <sys/time.h>
#endif

namespace tt {

static char loglevel_to_prefix(LogLevel level) {
    switch (level) {
        case LogLevelError:
            return 'E';
        case LogLevelWarning:
            return 'W';
        case LogLevelInfo:
            return 'I';
        case LogLevelDebug:
            return 'D';
        case LogLevelTrace:
            return 'T';
        default:
            return '?';
    }
}

static const char* loglevel_to_colour(LogLevel level) {
    switch (level) {
        case LogLevelError:
            return "\033[1;31m";
        case LogLevelWarning:
            return "\033[33m";
        case LogLevelInfo:
            return "\033[32m";
        case LogLevelDebug:
            return "\033[1;37m";
        case LogLevelTrace:
            return "\033[37m";
        default:
            return "";
    }
}

uint64_t log_timestamp() {
#ifdef ESP_PLATFORM
    if (xTaskGetSchedulerState() == taskSCHEDULER_NOT_STARTED) {
        return clock() / CLOCKS_PER_SEC * 1000;
    }
    static uint32_t base = 0;
    if (base == 0 && xPortGetCoreID() == 0) {
        base = clock() / CLOCKS_PER_SEC * 1000;
    }
    TickType_t tick_count = xPortInIsrContext() ? xTaskGetTickCountFromISR() : xTaskGetTickCount();
    return base + tick_count * (1000 / configTICK_RATE_HZ);
#else
    static uint64_t base = 0;

    struct timeval time {};
    gettimeofday(&time, nullptr);
    uint64_t now = ((uint64_t)time.tv_sec * 1000) + (time.tv_usec / 1000);
    if (base == 0) {
        base = now;
    }
    return now - base;
#endif
}

void log(LogLevel level, const char* tag, const char* format, ...) {
    printf(
        "%s%c (%lu) %s: ",
        loglevel_to_colour(level),
        loglevel_to_prefix(level),
        log_timestamp(),
        tag
    );

    va_list args;
    va_start(args, format);
    vprintf(format, args);
    va_end(args);

    printf("\033[0m\n");
}

} // namespace

#endif