123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191 |
- /*
- * log.c
- *
- * Copyright (c) 2022 - 2023 Thomas Buck (thomas@xythobuz.de)
- *
- * This program is free software: you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation, either version 3 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * See <http://www.gnu.org/licenses/>.
- */
-
- #include <stdio.h>
- #include <string.h>
-
- #include "hardware/watchdog.h"
- #include "ff.h"
-
- #include "config.h"
- #include "main.h"
- #include "lcd.h"
- #include "textbox.h"
- #include "usb_cdc.h"
- #include "serial.h"
- #include "ring.h"
- #include "log.h"
-
- static uint8_t log_buff[4096] = {0};
- static struct ring_buffer log = RB_INIT(log_buff, sizeof(log_buff), 1);
-
- static uint8_t line_buff[256] = {0};
- static volatile bool got_input = false;
- static int16_t lcd_off = 0;
-
- #ifndef PICOWOTA
- static FIL log_file_fat;
- #endif // PICOWOTA
-
- static void add_to_log(const void *buff, size_t len) {
- rb_add(&log, buff, len);
- }
-
- static void lcd_write(const void *buf, size_t len) {
- char tmp[len + 1];
- memcpy(tmp, buf, len);
- tmp[len] = '\0';
- lcd_off = text_box(tmp, false,
- "fixed_10x20",
- 0, LCD_WIDTH,
- lcd_off, LCD_HEIGHT - lcd_off,
- 0);
- }
-
- void log_dump_to_lcd(void) {
- static size_t prev_len = 0;
- size_t len = rb_len(&log);
- if (len == prev_len) {
- return;
- }
- prev_len = len;
-
- lcd_off = 0;
-
- const size_t todo = 120;
- size_t text_off = 0;
- if (len > todo) {
- text_off = len - todo;
- }
-
- rb_dump(&log, lcd_write, text_off);
- }
-
- #ifndef PICOWOTA
- static void log_dump_to_x(void (*write)(const void *, size_t)) {
- if (rb_len(&log) == 0) {
- return;
- }
-
- int l = snprintf((char *)line_buff, sizeof(line_buff), "\r\n\r\nbuffered log output:\r\n");
- if ((l > 0) && (l <= (int)sizeof(line_buff))) {
- write(line_buff, l);
- }
-
- rb_dump(&log, write, 0);
-
- l = snprintf((char *)line_buff, sizeof(line_buff), "\r\n\r\nlive log:\r\n");
- if ((l > 0) && (l <= (int)sizeof(line_buff))) {
- write(line_buff, l);
- }
- }
-
- void log_dump_to_usb(void) {
- log_dump_to_x(usb_cdc_write);
- }
-
- void log_dump_to_uart(void) {
- #ifndef NDEBUG
- log_dump_to_x(serial_write);
- #endif // NDEBUG
- }
-
- static void log_file_write_callback(const void *data, size_t len) {
- UINT bw;
- FRESULT res = f_write(&log_file_fat, data, len, &bw);
- if ((res != FR_OK) || (bw != len)) {
- debug("error: f_write %u returned %d", len, res);
- }
- }
-
- void log_dump_to_disk(void) {
- FRESULT res = f_open(&log_file_fat, "log.txt", FA_CREATE_ALWAYS | FA_WRITE);
- if (res != FR_OK) {
- debug("error: f_open returned %d", res);
- return;
- }
-
- rb_dump(&log, log_file_write_callback, 0);
-
- res = f_close(&log_file_fat);
- if (res != FR_OK) {
- debug("error: f_close returned %d", res);
- }
- }
-
- #endif // PICOWOTA
-
- void debug_log_va(bool log, const char *format, va_list args) {
- int l = vsnprintf((char *)line_buff, sizeof(line_buff), format, args);
-
- if (l < 0) {
- // encoding error
- l = snprintf((char *)line_buff, sizeof(line_buff), "%s: encoding error\r\n", __func__);
- } else if (l >= (ssize_t)sizeof(line_buff)) {
- // not enough space for string
- l = snprintf((char *)line_buff, sizeof(line_buff), "%s: message too long (%d)\r\n", __func__, l);
- }
- if ((l > 0) && (l <= (int)sizeof(line_buff))) {
- #ifndef PICOWOTA
- usb_cdc_write(line_buff, l);
-
- #ifndef NDEBUG
- serial_write(line_buff, l);
- #endif // NDEBUG
- #endif // PICOWOTA
-
- if (log) {
- add_to_log(line_buff, l);
- }
- }
- }
-
- void debug_log(bool log, const char* format, ...) {
- va_list args;
- va_start(args, format);
- debug_log_va(log, format, args);
- va_end(args);
- }
-
- #ifndef PICOWOTA
- void debug_handle_input(const void *buff, size_t len) {
- (void)buff;
-
- if (len > 0) {
- got_input = true;
- }
- }
-
- void debug_wait_input(const char *format, ...) {
- va_list args;
- va_start(args, format);
- debug_log_va(false, format, args);
- va_end(args);
-
- got_input = false;
- usb_cdc_set_reroute(true);
- serial_set_reroute(true);
-
- while (!got_input) {
- main_loop_hw();
- }
-
- usb_cdc_set_reroute(false);
- serial_set_reroute(false);
- }
- #endif // PICOWOTA
|