OpenSprinkler-Firmware/debug_log.cpp at master · opensprinklershop/OpenSprinkler-Firmware · GitHub

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
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
#include "debug_log.h"
#include <string.h>
#include <stdlib.h>
#if defined(ESP8266) && defined(MMU_IRAM_HEAP)
#include <umm_malloc/umm_heap_select.h>
#endif

DebugBufferClass debug_buffer;

DebugBufferClass::DebugBufferClass() : buffer(NULL), head(0), size(0), wrapped(false) {
}

DebugBufferClass::~DebugBufferClass() {
    if (buffer) {
        free(buffer);
    }
}

void DebugBufferClass::begin(size_t sz) {
    if (buffer) {
        free(buffer);
        buffer = NULL;
    }
    size = sz;
    head = 0;
    wrapped = false;
    if (size > 0) {
#if defined(ESP8266) && defined(MMU_IRAM_HEAP)
        // ESP8266: keep the 2 KB ring buffer out of DRAM (IRAM heap, byte
        // access via the core's non32xfer handler; debug builds only).
        HeapSelectIram ephemeral;
#endif
        buffer = (char*)malloc(size);
        if (buffer) {
            memset(buffer, 0, size);
        }
    }
}

void DebugBufferClass::clear() {
    head = 0;
    wrapped = false;
    if (buffer && size > 0) {
        memset(buffer, 0, size);
    }
}

size_t DebugBufferClass::write(uint8_t c) {
    if (!buffer || size == 0) return 0;

    buffer[head] = (char)c;
    head++;
    if (head >= size) {
        head = 0;
        wrapped = true;
    }
    return 1;
}

size_t DebugBufferClass::write(const uint8_t *buf, size_t len) {
    if (!buffer || size == 0 || !buf || len == 0) return 0;

    for (size_t i = 0; i < len; i++) {
        write(buf[i]);
    }
    return len;
}

#if !defined(ARDUINO)
void DebugBufferClass::print(const char* s) {
    if (s) write((const uint8_t*)s, strlen(s));
}

void DebugBufferClass::print(char c) {
    write((uint8_t)c);
}

void DebugBufferClass::print(int n) {
    char tmp[32];
    sprintf(tmp, "%d", n);
    print(tmp);
}

void DebugBufferClass::print(unsigned int n) {
    char tmp[32];
    sprintf(tmp, "%u", n);
    print(tmp);
}

void DebugBufferClass::print(long n) {
    char tmp[32];
    sprintf(tmp, "%ld", n);
    print(tmp);
}

void DebugBufferClass::print(unsigned long x) {
    char tmp[32];
    sprintf(tmp, "%lu", x);
    print(tmp);
}

void DebugBufferClass::print(double d) {
    char tmp[32];
    sprintf(tmp, "%.2f", d);
    print(tmp);
}

void DebugBufferClass::println() {
    print("\n");
}

void DebugBufferClass::println(const char* s) {
    print(s);
    println();
}

void DebugBufferClass::printf(const char* format, ...) {
    char tmp[256];
    va_list args;
    va_start(args, format);
    int len = vsnprintf(tmp, sizeof(tmp), format, args);
    va_end(args);
    if (len > 0) {
        write((const uint8_t*)tmp, len);
    }
}
#endif