fprint.h

Go to the documentation of this file.

#ifndef FPRINTTT_H
#define FPRINTTT_H

#ifdef __cplusplus
extern "C" {
#endif

#include "Arduino.h"

#ifndef SUPPRESSCOLLORS
#define ANSI_COLOR_RED     "\x1b[31m"
#define ANSI_COLOR_GREEN   "\x1b[32m"
#define ANSI_COLOR_YELLOW  "\x1b[33m"
#define ANSI_COLOR_BLUE    "\x1b[34m"
#define ANSI_COLOR_MAGENTA "\x1b[35m"
#define ANSI_COLOR_CYAN    "\x1b[36m"
#define ANSI_COLOR_RESET   "\x1b[0m"
#else
#define ANSI_COLOR_RED     ""
#define ANSI_COLOR_GREEN   ""
#define ANSI_COLOR_YELLOW  ""
#define ANSI_COLOR_BLUE    ""
#define ANSI_COLOR_MAGENTA ""
#define ANSI_COLOR_CYAN    ""
#define ANSI_COLOR_RESET   ""
#endif

#define MAXCMD_LEN          255
#define HEXDUMP_COLS        16


#ifndef SUPPRESSHEXDUMP
#define SUPPRESSHEXDUMP     0
#endif
#define HEXDUMP(a, b)       (SUPPRESSHEXDUMP==0) ? __hexdump__(a,b) : (void) 0;

inline void printlnGreen(const char c[]) {
    char tmp[100];
    sprintf(tmp, "%s%s%s", ANSI_COLOR_GREEN, c, ANSI_COLOR_RESET);
    Serial.println(tmp);
}

inline void printlnRed(const char c[]) {
    char tmp[100];
    sprintf(tmp, "%s%s%s", ANSI_COLOR_RED, c, ANSI_COLOR_RESET);
    Serial.println(tmp);
}

inline void printlnMagenta(const char c[]) {
    char tmp[100];
    sprintf(tmp, "%s%s%s", ANSI_COLOR_MAGENTA, c, ANSI_COLOR_RESET);
    Serial.println(tmp);
}

inline void printMagenta(const char c[]) {
    char tmp[100];
    sprintf(tmp, "%s%s%s", ANSI_COLOR_MAGENTA, c, ANSI_COLOR_RESET);
    Serial.print(tmp);
}

inline void printGreen(const char c[]) {
    char tmp[100];
    sprintf(tmp, "%s%s%s", ANSI_COLOR_GREEN, c, ANSI_COLOR_RESET);
    Serial.print(tmp);
}

inline void __hexdump__(const void* p_buf, uint32_t l_len) {
    unsigned int i, j;
    char str[MAXCMD_LEN];
    for (i = 0; i < l_len + ((l_len % HEXDUMP_COLS) ?
                    ( HEXDUMP_COLS - l_len % HEXDUMP_COLS) : 0);
            i++) {
        /* print offset */
        if (i % HEXDUMP_COLS == 0) {
            sprintf(str, "0x%06x: ", i);
            Serial.print(str);
        }

        /* print hex data */
        if (i < l_len) {
            sprintf(str, "%02x ", 0xFF & ((char*) p_buf)[i]);
            Serial.print(str);
        } else /* end of block, just aligning for ASCII dump */
        {
            sprintf(str, "   ");
            Serial.print(str);
        }

        /* print ASCII dump */
        if (i % HEXDUMP_COLS == ( HEXDUMP_COLS - 1)) {
            for (j = i - ( HEXDUMP_COLS - 1); j <= i; j++) {
                if (j >= l_len) /* end of block, not really printing */
                {
                    Serial.print(' ');
                } else if (isprint((int) ((char*) p_buf)[j])) /* printable char */
                {
                    Serial.print(((char*) p_buf)[j]);
                } else /* other char */
                {
                    Serial.print('.');
                }
            }
            Serial.print('\r');
            Serial.print('\n');
        }
    }
}

#ifdef __cplusplus
}
#endif
#endif