166 lines
3.6 KiB
C
166 lines
3.6 KiB
C
/* SPDX-License-Identifier: GPL-2.0-only */
|
|
|
|
/*
|
|
* blatantly copied from linux/kernel/printk.c
|
|
*/
|
|
|
|
#include <console/cbmem_console.h>
|
|
#include <console/console.h>
|
|
#include <console/streams.h>
|
|
#include <console/vtxprintf.h>
|
|
#include <smp/spinlock.h>
|
|
#include <smp/node.h>
|
|
#include <timer.h>
|
|
|
|
DECLARE_SPIN_LOCK(console_lock)
|
|
|
|
#define TRACK_CONSOLE_TIME (!ENV_SMM && CONFIG(HAVE_MONOTONIC_TIMER))
|
|
|
|
static struct mono_time mt_start, mt_stop;
|
|
static long console_usecs;
|
|
|
|
static void console_time_run(void)
|
|
{
|
|
if (TRACK_CONSOLE_TIME && boot_cpu())
|
|
timer_monotonic_get(&mt_start);
|
|
}
|
|
|
|
static void console_time_stop(void)
|
|
{
|
|
if (TRACK_CONSOLE_TIME && boot_cpu()) {
|
|
timer_monotonic_get(&mt_stop);
|
|
console_usecs += mono_time_diff_microseconds(&mt_start, &mt_stop);
|
|
}
|
|
}
|
|
|
|
void console_time_report(void)
|
|
{
|
|
if (!TRACK_CONSOLE_TIME)
|
|
return;
|
|
|
|
printk(BIOS_DEBUG, "BS: " ENV_STRING " times (exec / console): total (unknown) / %ld ms\n",
|
|
DIV_ROUND_CLOSEST(console_usecs, USECS_PER_MSEC));
|
|
}
|
|
|
|
long console_time_get_and_reset(void)
|
|
{
|
|
if (!TRACK_CONSOLE_TIME)
|
|
return 0;
|
|
|
|
long elapsed = console_usecs;
|
|
console_usecs = 0;
|
|
return elapsed;
|
|
}
|
|
|
|
void do_putchar(unsigned char byte)
|
|
{
|
|
console_time_run();
|
|
console_tx_byte(byte);
|
|
console_time_stop();
|
|
}
|
|
|
|
union log_state {
|
|
void *as_ptr;
|
|
struct {
|
|
uint8_t level;
|
|
uint8_t speed;
|
|
};
|
|
};
|
|
|
|
#define LOG_FAST(state) (HAS_ONLY_FAST_CONSOLES || ((state).speed == CONSOLE_LOG_FAST))
|
|
|
|
static void wrap_interactive_printf(const char *fmt, ...)
|
|
{
|
|
va_list args;
|
|
va_start(args, fmt);
|
|
vtxprintf(console_interactive_tx_byte, fmt, args, NULL);
|
|
va_end(args);
|
|
}
|
|
|
|
static void line_start(union log_state state)
|
|
{
|
|
if (state.level > BIOS_LOG_PREFIX_MAX_LEVEL)
|
|
return;
|
|
|
|
/* Stored consoles just get a single control char marker to save space. If we are in
|
|
LOG_FAST mode, just write the marker to CBMC and exit -- the rest of this function
|
|
implements the LOG_ALL case. */
|
|
unsigned char marker = BIOS_LOG_LEVEL_TO_MARKER(state.level);
|
|
if (LOG_FAST(state)) {
|
|
__cbmemc_tx_byte(marker);
|
|
return;
|
|
}
|
|
console_stored_tx_byte(marker, NULL);
|
|
|
|
/* Interactive consoles get a `[DEBUG] ` style readable prefix,
|
|
and potentially an escape sequence for highlighting. */
|
|
if (CONFIG(CONSOLE_USE_ANSI_ESCAPES))
|
|
wrap_interactive_printf(BIOS_LOG_ESCAPE_PATTERN, bios_log_escape[state.level]);
|
|
if (CONFIG(CONSOLE_USE_LOGLEVEL_PREFIX))
|
|
wrap_interactive_printf(BIOS_LOG_PREFIX_PATTERN, bios_log_prefix[state.level]);
|
|
}
|
|
|
|
static void line_end(union log_state state)
|
|
{
|
|
if (CONFIG(CONSOLE_USE_ANSI_ESCAPES) && !LOG_FAST(state))
|
|
wrap_interactive_printf(BIOS_LOG_ESCAPE_RESET);
|
|
}
|
|
|
|
static void wrap_putchar(unsigned char byte, void *data)
|
|
{
|
|
union log_state state = { .as_ptr = data };
|
|
static bool line_started = false;
|
|
|
|
if (byte == '\n') {
|
|
line_end(state);
|
|
line_started = false;
|
|
} else if (!line_started) {
|
|
line_start(state);
|
|
line_started = true;
|
|
}
|
|
|
|
if (LOG_FAST(state))
|
|
__cbmemc_tx_byte(byte);
|
|
else
|
|
console_tx_byte(byte);
|
|
}
|
|
|
|
int vprintk(int msg_level, const char *fmt, va_list args)
|
|
{
|
|
union log_state state = { .level = msg_level };
|
|
int i;
|
|
|
|
if (CONFIG(SQUELCH_EARLY_SMP) && ENV_ROMSTAGE_OR_BEFORE && !boot_cpu())
|
|
return 0;
|
|
|
|
state.speed = console_log_level(msg_level);
|
|
if (state.speed < CONSOLE_LOG_FAST)
|
|
return 0;
|
|
|
|
spin_lock(&console_lock);
|
|
|
|
console_time_run();
|
|
|
|
i = vtxprintf(wrap_putchar, fmt, args, state.as_ptr);
|
|
if (LOG_FAST(state))
|
|
console_tx_flush();
|
|
|
|
console_time_stop();
|
|
|
|
spin_unlock(&console_lock);
|
|
|
|
return i;
|
|
}
|
|
|
|
int printk(int msg_level, const char *fmt, ...)
|
|
{
|
|
va_list args;
|
|
int i;
|
|
|
|
va_start(args, fmt);
|
|
i = vprintk(msg_level, fmt, args);
|
|
va_end(args);
|
|
|
|
return i;
|
|
}
|