sxkbd

Firmware for RP2040-based corne split keyboard
git clone https://git.sinitax.com/sinitax/sxkbd
Log | Files | Refs | Submodules | README | LICENSE | sfeed.txt

util.c (1629B)

      1 #include "util.h"
      2 
      3 #include "split.h"
      4 #include "board.h"
      5 #include "class/cdc/cdc_device.h"
      6 #include "led.h"
      7 #include "ws2812.h"
      8 
      9 #include "pico/stdio.h"
     10 #include "tusb.h"
     11 #include "bsp/board.h"
     12 #include "tusb_config.h"
     13 
     14 #include <stdio.h>
     15 
     16 char warnlog[256];
     17 int log_level_min = LOG_INFO;
     18 int log_group_mask = LOG_ALL;
     19 
     20 static void
     21 __attribute__((format(printf, 1, 0)))
     22 panic_task(const char *fmtstr, va_list ap, uint32_t sleep_ms)
     23 {
     24 	static uint32_t start_ms = 0;
     25 	va_list cpy;
     26 
     27 	if (!tud_cdc_connected())
     28 		return;
     29 
     30 	if (!start_ms) start_ms = board_millis();
     31 
     32 	if (board_millis() < start_ms + sleep_ms)
     33 		return;
     34 
     35 	va_copy(cpy, ap);
     36 	vprintf(fmtstr, cpy);
     37 	printf("\n");
     38 	tud_cdc_write_flush();
     39 
     40 	start_ms += sleep_ms;
     41 }
     42 
     43 void
     44 __attribute__ ((format (printf, 3, 4)))
     45 stdio_log(int facility, int level, const char *fmtstr, ...)
     46 {
     47 	va_list ap, cpy;
     48 
     49 	if (!(facility & log_group_mask))
     50 		return;
     51 
     52 	if (level < log_level_min)
     53 		return;
     54 
     55 	if (level == LOG_WARN && !*warnlog) {
     56 		led_start_blip(HARD_RED, 100);
     57 		va_copy(cpy, ap);
     58 		va_start(cpy, fmtstr);
     59 		vsnprintf(warnlog, sizeof(warnlog), fmtstr, cpy);
     60 		va_end(cpy);
     61 
     62 		if (split_role == SLAVE)
     63 			split_warn_master(warnlog);
     64 	}
     65 
     66 	if (!tud_cdc_connected())
     67 		return;
     68 
     69 	va_start(ap, fmtstr);
     70 	vprintf(fmtstr, ap);
     71 	va_end(ap);
     72 	printf("\n");
     73 	tud_cdc_write_flush();
     74 }
     75 
     76 void
     77 __attribute__((format(printf, 3, 4)))
     78 blink_panic(uint32_t blink_ms, uint32_t rgb, const char *fmtstr, ...)
     79 {
     80 	va_list ap;
     81 
     82 	led_blink_ms = blink_ms;
     83 	led_rgb = rgb;
     84 	led_mode = LED_BLINK;
     85 
     86 	va_start(ap, fmtstr);
     87 	while (1) {
     88 		tud_task();
     89 		panic_task(fmtstr, ap, 1000);
     90 		led_task();
     91 	}
     92 	va_end(ap);
     93 }