40 lines
1.0 KiB
C++
40 lines
1.0 KiB
C++
#pragma once
|
|
#include <functional>
|
|
#include <string>
|
|
#include <string_view>
|
|
#include <vector>
|
|
#include "pico/time.h"
|
|
#include "ring_buffer.h"
|
|
|
|
struct log_entry {
|
|
uint32_t timestamp_us;
|
|
std::string message;
|
|
};
|
|
|
|
inline ring_buffer<log_entry, 32> g_debug_log;
|
|
|
|
inline void dlog(std::string_view msg) {
|
|
g_debug_log.push_overwrite(log_entry{static_cast<uint32_t>(time_us_32()), std::string(msg)});
|
|
}
|
|
|
|
inline void dlog_if_slow(std::string_view label, uint32_t threshold_us, std::function<void()> fn) {
|
|
uint32_t t0 = time_us_32();
|
|
fn();
|
|
uint32_t elapsed = time_us_32() - t0;
|
|
if (elapsed > threshold_us)
|
|
dlog(std::string(label) + " " + std::to_string(elapsed) + "us");
|
|
}
|
|
|
|
inline std::vector<log_entry> dlog_drain() {
|
|
std::vector<log_entry> result;
|
|
uint16_t n = g_debug_log.used();
|
|
result.reserve(n);
|
|
for (uint16_t i = 0; i < n; i++) {
|
|
log_entry e;
|
|
g_debug_log.peek(std::span{&e, 1});
|
|
result.push_back(std::move(e));
|
|
g_debug_log.consume(1);
|
|
}
|
|
return result;
|
|
}
|