Angel Pons | b706ab3 | 2020-04-02 23:48:09 +0200 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0-only */ |
Angel Pons | b706ab3 | 2020-04-02 23:48:09 +0200 | [diff] [blame] | 2 | |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 3 | /* |
Damien Roth | 4e7e987 | 2016-01-16 18:59:51 -0700 | [diff] [blame] | 4 | * blatantly copied from linux/kernel/printk.c |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 5 | */ |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 6 | |
Kyösti Mälkki | e613d70 | 2019-02-12 14:16:21 +0200 | [diff] [blame] | 7 | #include <console/cbmem_console.h> |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 8 | #include <console/console.h> |
Kyösti Mälkki | 4076072 | 2014-02-27 19:30:18 +0200 | [diff] [blame] | 9 | #include <console/streams.h> |
Edward O'Callaghan | 0ddb826 | 2014-06-17 18:37:08 +1000 | [diff] [blame] | 10 | #include <console/vtxprintf.h> |
| 11 | #include <smp/spinlock.h> |
| 12 | #include <smp/node.h> |
Kyösti Mälkki | 45ddb43 | 2019-11-02 14:12:18 +0200 | [diff] [blame] | 13 | #include <timer.h> |
Elyes Haouas | 9483001 | 2022-10-02 12:29:03 +0200 | [diff] [blame] | 14 | #include <types.h> |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 15 | |
Myles Watson | 2e67273 | 2009-11-12 16:38:03 +0000 | [diff] [blame] | 16 | DECLARE_SPIN_LOCK(console_lock) |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 17 | |
Kyösti Mälkki | 05fe16c | 2019-12-01 08:38:11 +0200 | [diff] [blame] | 18 | #define TRACK_CONSOLE_TIME (!ENV_SMM && CONFIG(HAVE_MONOTONIC_TIMER)) |
Kyösti Mälkki | 45ddb43 | 2019-11-02 14:12:18 +0200 | [diff] [blame] | 19 | |
| 20 | static struct mono_time mt_start, mt_stop; |
| 21 | static long console_usecs; |
| 22 | |
| 23 | static void console_time_run(void) |
| 24 | { |
Kyösti Mälkki | 05fe16c | 2019-12-01 08:38:11 +0200 | [diff] [blame] | 25 | if (TRACK_CONSOLE_TIME && boot_cpu()) |
Kyösti Mälkki | 45ddb43 | 2019-11-02 14:12:18 +0200 | [diff] [blame] | 26 | timer_monotonic_get(&mt_start); |
| 27 | } |
| 28 | |
| 29 | static void console_time_stop(void) |
| 30 | { |
Kyösti Mälkki | 05fe16c | 2019-12-01 08:38:11 +0200 | [diff] [blame] | 31 | if (TRACK_CONSOLE_TIME && boot_cpu()) { |
Kyösti Mälkki | 45ddb43 | 2019-11-02 14:12:18 +0200 | [diff] [blame] | 32 | timer_monotonic_get(&mt_stop); |
| 33 | console_usecs += mono_time_diff_microseconds(&mt_start, &mt_stop); |
| 34 | } |
| 35 | } |
| 36 | |
| 37 | void console_time_report(void) |
| 38 | { |
| 39 | if (!TRACK_CONSOLE_TIME) |
| 40 | return; |
| 41 | |
Kyösti Mälkki | 94694a8 | 2019-11-02 18:14:31 +0200 | [diff] [blame] | 42 | printk(BIOS_DEBUG, "BS: " ENV_STRING " times (exec / console): total (unknown) / %ld ms\n", |
Kyösti Mälkki | 45ddb43 | 2019-11-02 14:12:18 +0200 | [diff] [blame] | 43 | DIV_ROUND_CLOSEST(console_usecs, USECS_PER_MSEC)); |
| 44 | } |
| 45 | |
| 46 | long console_time_get_and_reset(void) |
| 47 | { |
| 48 | if (!TRACK_CONSOLE_TIME) |
| 49 | return 0; |
| 50 | |
| 51 | long elapsed = console_usecs; |
| 52 | console_usecs = 0; |
| 53 | return elapsed; |
| 54 | } |
| 55 | |
Kyösti Mälkki | 657e0be | 2014-02-04 19:03:57 +0200 | [diff] [blame] | 56 | void do_putchar(unsigned char byte) |
| 57 | { |
Kyösti Mälkki | 45ddb43 | 2019-11-02 14:12:18 +0200 | [diff] [blame] | 58 | console_time_run(); |
Kyösti Mälkki | 657e0be | 2014-02-04 19:03:57 +0200 | [diff] [blame] | 59 | console_tx_byte(byte); |
Kyösti Mälkki | 45ddb43 | 2019-11-02 14:12:18 +0200 | [diff] [blame] | 60 | console_time_stop(); |
Kyösti Mälkki | 657e0be | 2014-02-04 19:03:57 +0200 | [diff] [blame] | 61 | } |
| 62 | |
Julius Werner | b6cf642 | 2022-02-02 17:21:02 -0800 | [diff] [blame] | 63 | union log_state { |
| 64 | void *as_ptr; |
| 65 | struct { |
| 66 | uint8_t level; |
| 67 | uint8_t speed; |
| 68 | }; |
| 69 | }; |
| 70 | |
Mario Scheithauer | f605611 | 2022-02-22 09:46:33 +0100 | [diff] [blame] | 71 | #define LOG_FAST(state) (HAS_ONLY_FAST_CONSOLES || ((state).speed == CONSOLE_LOG_FAST)) |
Julius Werner | 266041f | 2022-02-03 17:25:44 -0800 | [diff] [blame] | 72 | |
Julius Werner | 7cd8ba6 | 2022-01-21 15:15:29 -0800 | [diff] [blame] | 73 | static void wrap_interactive_printf(const char *fmt, ...) |
| 74 | { |
| 75 | va_list args; |
| 76 | va_start(args, fmt); |
| 77 | vtxprintf(console_interactive_tx_byte, fmt, args, NULL); |
Julius Werner | ababf01 | 2022-02-08 16:37:41 -0800 | [diff] [blame] | 78 | va_end(args); |
Julius Werner | 7cd8ba6 | 2022-01-21 15:15:29 -0800 | [diff] [blame] | 79 | } |
| 80 | |
| 81 | static void line_start(union log_state state) |
| 82 | { |
| 83 | if (state.level > BIOS_LOG_PREFIX_MAX_LEVEL) |
| 84 | return; |
Julius Werner | 984d03c | 2022-01-21 15:33:47 -0800 | [diff] [blame] | 85 | |
| 86 | /* Stored consoles just get a single control char marker to save space. If we are in |
| 87 | LOG_FAST mode, just write the marker to CBMC and exit -- the rest of this function |
| 88 | implements the LOG_ALL case. */ |
| 89 | unsigned char marker = BIOS_LOG_LEVEL_TO_MARKER(state.level); |
Julius Werner | 266041f | 2022-02-03 17:25:44 -0800 | [diff] [blame] | 90 | if (LOG_FAST(state)) { |
Julius Werner | 984d03c | 2022-01-21 15:33:47 -0800 | [diff] [blame] | 91 | __cbmemc_tx_byte(marker); |
Julius Werner | 7cd8ba6 | 2022-01-21 15:15:29 -0800 | [diff] [blame] | 92 | return; |
Julius Werner | 984d03c | 2022-01-21 15:33:47 -0800 | [diff] [blame] | 93 | } |
| 94 | console_stored_tx_byte(marker, NULL); |
Julius Werner | 7cd8ba6 | 2022-01-21 15:15:29 -0800 | [diff] [blame] | 95 | |
Julius Werner | a120e0d | 2022-01-21 15:24:12 -0800 | [diff] [blame] | 96 | /* Interactive consoles get a `[DEBUG] ` style readable prefix, |
| 97 | and potentially an escape sequence for highlighting. */ |
| 98 | if (CONFIG(CONSOLE_USE_ANSI_ESCAPES)) |
| 99 | wrap_interactive_printf(BIOS_LOG_ESCAPE_PATTERN, bios_log_escape[state.level]); |
Igor Bagnucki | f0d6521 | 2022-03-03 11:41:57 +0100 | [diff] [blame] | 100 | if (CONFIG(CONSOLE_USE_LOGLEVEL_PREFIX)) |
| 101 | wrap_interactive_printf(BIOS_LOG_PREFIX_PATTERN, bios_log_prefix[state.level]); |
Julius Werner | 7cd8ba6 | 2022-01-21 15:15:29 -0800 | [diff] [blame] | 102 | } |
| 103 | |
Julius Werner | a120e0d | 2022-01-21 15:24:12 -0800 | [diff] [blame] | 104 | static void line_end(union log_state state) |
| 105 | { |
Julius Werner | 266041f | 2022-02-03 17:25:44 -0800 | [diff] [blame] | 106 | if (CONFIG(CONSOLE_USE_ANSI_ESCAPES) && !LOG_FAST(state)) |
Julius Werner | a120e0d | 2022-01-21 15:24:12 -0800 | [diff] [blame] | 107 | wrap_interactive_printf(BIOS_LOG_ESCAPE_RESET); |
| 108 | } |
| 109 | |
Kyösti Mälkki | 77f43e9 | 2014-02-04 19:50:07 +0200 | [diff] [blame] | 110 | static void wrap_putchar(unsigned char byte, void *data) |
Kyösti Mälkki | b04e0ff | 2014-02-04 14:28:17 +0200 | [diff] [blame] | 111 | { |
Julius Werner | b6cf642 | 2022-02-02 17:21:02 -0800 | [diff] [blame] | 112 | union log_state state = { .as_ptr = data }; |
Julius Werner | 7cd8ba6 | 2022-01-21 15:15:29 -0800 | [diff] [blame] | 113 | static bool line_started = false; |
| 114 | |
| 115 | if (byte == '\n') { |
Julius Werner | a120e0d | 2022-01-21 15:24:12 -0800 | [diff] [blame] | 116 | line_end(state); |
Julius Werner | 7cd8ba6 | 2022-01-21 15:15:29 -0800 | [diff] [blame] | 117 | line_started = false; |
| 118 | } else if (!line_started) { |
| 119 | line_start(state); |
| 120 | line_started = true; |
| 121 | } |
Kyösti Mälkki | e613d70 | 2019-02-12 14:16:21 +0200 | [diff] [blame] | 122 | |
Julius Werner | 266041f | 2022-02-03 17:25:44 -0800 | [diff] [blame] | 123 | if (LOG_FAST(state)) |
Julius Werner | b6cf642 | 2022-02-02 17:21:02 -0800 | [diff] [blame] | 124 | __cbmemc_tx_byte(byte); |
| 125 | else |
| 126 | console_tx_byte(byte); |
Kyösti Mälkki | b04e0ff | 2014-02-04 14:28:17 +0200 | [diff] [blame] | 127 | } |
| 128 | |
Nico Huber | 7cc14ac | 2021-03-27 20:03:02 +0100 | [diff] [blame] | 129 | int vprintk(int msg_level, const char *fmt, va_list args) |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 130 | { |
Julius Werner | b6cf642 | 2022-02-02 17:21:02 -0800 | [diff] [blame] | 131 | union log_state state = { .level = msg_level }; |
| 132 | int i; |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 133 | |
Kyösti Mälkki | 21160a7 | 2019-08-17 17:29:36 +0300 | [diff] [blame] | 134 | if (CONFIG(SQUELCH_EARLY_SMP) && ENV_ROMSTAGE_OR_BEFORE && !boot_cpu()) |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 135 | return 0; |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 136 | |
Julius Werner | b6cf642 | 2022-02-02 17:21:02 -0800 | [diff] [blame] | 137 | state.speed = console_log_level(msg_level); |
| 138 | if (state.speed < CONSOLE_LOG_FAST) |
Kyösti Mälkki | b2d2596 | 2014-01-27 15:09:13 +0200 | [diff] [blame] | 139 | return 0; |
Kyösti Mälkki | b2d2596 | 2014-01-27 15:09:13 +0200 | [diff] [blame] | 140 | |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 141 | spin_lock(&console_lock); |
| 142 | |
Kyösti Mälkki | 45ddb43 | 2019-11-02 14:12:18 +0200 | [diff] [blame] | 143 | console_time_run(); |
| 144 | |
Julius Werner | b6cf642 | 2022-02-02 17:21:02 -0800 | [diff] [blame] | 145 | i = vtxprintf(wrap_putchar, fmt, args, state.as_ptr); |
Julius Werner | 266041f | 2022-02-03 17:25:44 -0800 | [diff] [blame] | 146 | if (LOG_FAST(state)) |
Kyösti Mälkki | e613d70 | 2019-02-12 14:16:21 +0200 | [diff] [blame] | 147 | console_tx_flush(); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 148 | |
Kyösti Mälkki | 45ddb43 | 2019-11-02 14:12:18 +0200 | [diff] [blame] | 149 | console_time_stop(); |
| 150 | |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 151 | spin_unlock(&console_lock); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 152 | |
| 153 | return i; |
| 154 | } |
Kyösti Mälkki | b3356bb | 2014-03-06 16:55:05 +0200 | [diff] [blame] | 155 | |
Nico Huber | 7cc14ac | 2021-03-27 20:03:02 +0100 | [diff] [blame] | 156 | int printk(int msg_level, const char *fmt, ...) |
Kyösti Mälkki | b3356bb | 2014-03-06 16:55:05 +0200 | [diff] [blame] | 157 | { |
Kyösti Mälkki | 7132f25 | 2019-02-14 23:08:29 +0200 | [diff] [blame] | 158 | va_list args; |
| 159 | int i; |
| 160 | |
| 161 | va_start(args, fmt); |
Nico Huber | 7cc14ac | 2021-03-27 20:03:02 +0100 | [diff] [blame] | 162 | i = vprintk(msg_level, fmt, args); |
Kyösti Mälkki | 7132f25 | 2019-02-14 23:08:29 +0200 | [diff] [blame] | 163 | va_end(args); |
| 164 | |
| 165 | return i; |
Kyösti Mälkki | b3356bb | 2014-03-06 16:55:05 +0200 | [diff] [blame] | 166 | } |