src/console/printk.c

   1 /* SPDX-License-Identifier: GPL-2.0-only */
   2
   3 /*
   4  * blatantly copied from linux/kernel/printk.c
   5  */
   6
   7 #include <console/cbmem_console.h>
   8 #include <console/console.h>
   9 #include <console/streams.h>
  10 #include <console/vtxprintf.h>
  11 #include <smp/spinlock.h>
  12 #include <smp/node.h>
  13 #include <stddef.h>
  14 #include <trace.h>
  15 #include <timer.h>
  16
  17 DECLARE_SPIN_LOCK(console_lock)
  18
  19 #define TRACK_CONSOLE_TIME (!ENV_SMM && CONFIG(HAVE_MONOTONIC_TIMER))
  20
  21 static struct mono_time mt_start, mt_stop;
  22 static long console_usecs;
  23
  24 static void console_time_run(void)
  25 {
  26         if (TRACK_CONSOLE_TIME && boot_cpu())
  27                 timer_monotonic_get(&mt_start);
  28 }
  29
  30 static void console_time_stop(void)
  31 {
  32         if (TRACK_CONSOLE_TIME && boot_cpu()) {
  33                 timer_monotonic_get(&mt_stop);
  34                 console_usecs += mono_time_diff_microseconds(&mt_start, &mt_stop);
  35         }
  36 }
  37
  38 void console_time_report(void)
  39 {
  40         if (!TRACK_CONSOLE_TIME)
  41                 return;
  42
  43         printk(BIOS_DEBUG, "BS: " ENV_STRING " times (exec / console): total (unknown) / %ld ms\n",
  44                 DIV_ROUND_CLOSEST(console_usecs, USECS_PER_MSEC));
  45 }
  46
  47 long console_time_get_and_reset(void)
  48 {
  49         if (!TRACK_CONSOLE_TIME)
  50                 return 0;
  51
  52         long elapsed = console_usecs;
  53         console_usecs = 0;
  54         return elapsed;
  55 }
  56
  57 void do_putchar(unsigned char byte)
  58 {
  59         console_time_run();
  60         console_tx_byte(byte);
  61         console_time_stop();
  62 }
  63
  64 static void wrap_putchar(unsigned char byte, void *data)
  65 {
  66         console_tx_byte(byte);
  67 }
  68
  69 static void wrap_putchar_cbmemc(unsigned char byte, void *data)
  70 {
  71         __cbmemc_tx_byte(byte);
  72 }
  73
  74 int do_vprintk(int msg_level, const char *fmt, va_list args)
  75 {
  76         int i, log_this;
  77
  78         if (CONFIG(SQUELCH_EARLY_SMP) && ENV_ROMSTAGE_OR_BEFORE && !boot_cpu())
  79                 return 0;
  80
  81         log_this = console_log_level(msg_level);
  82         if (log_this < CONSOLE_LOG_FAST)
  83                 return 0;
  84
  85         DISABLE_TRACE;
  86         spin_lock(&console_lock);
  87
  88         console_time_run();
  89
  90         if (log_this == CONSOLE_LOG_FAST) {
  91                 i = vtxprintf(wrap_putchar_cbmemc, fmt, args, NULL);
  92         } else {
  93                 i = vtxprintf(wrap_putchar, fmt, args, NULL);
  94                 console_tx_flush();
  95         }
  96
  97         console_time_stop();
  98
  99         spin_unlock(&console_lock);
 100         ENABLE_TRACE;
 101
 102         return i;
 103 }
 104
 105 int do_printk(int msg_level, const char *fmt, ...)
 106 {
 107         va_list args;
 108         int i;
 109
 110         va_start(args, fmt);
 111         i = do_vprintk(msg_level, fmt, args);
 112         va_end(args);
 113
 114         return i;
 115 }