Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 1 | /* |
Damien Roth | 4e7e987 | 2016-01-16 18:59:51 -0700 | [diff] [blame] | 2 | * This file is part of the coreboot project. |
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 | * Copyright (C) 1991, 1992 Linus Torvalds |
| 5 | * Copyright (C) 2015 Timothy Pearson <tpearson@raptorengineeringinc.com>, |
| 6 | * Raptor Engineering |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 7 | * |
Damien Roth | 4e7e987 | 2016-01-16 18:59:51 -0700 | [diff] [blame] | 8 | * This program is free software; you can redistribute it and/or modify |
| 9 | * it under the terms of the GNU General Public License as published by |
| 10 | * the Free Software Foundation; version 2 of the License. |
| 11 | * |
| 12 | * This program is distributed in the hope that it will be useful, |
| 13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 15 | * GNU General Public License for more details. |
| 16 | * |
| 17 | * blatantly copied from linux/kernel/printk.c |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 18 | */ |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 19 | |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 20 | #include <console/console.h> |
Kyösti Mälkki | 4076072 | 2014-02-27 19:30:18 +0200 | [diff] [blame] | 21 | #include <console/streams.h> |
Edward O'Callaghan | 0ddb826 | 2014-06-17 18:37:08 +1000 | [diff] [blame] | 22 | #include <console/vtxprintf.h> |
| 23 | #include <smp/spinlock.h> |
| 24 | #include <smp/node.h> |
| 25 | #include <stddef.h> |
Rudolf Marek | 7f0e930 | 2011-09-02 23:23:41 +0200 | [diff] [blame] | 26 | #include <trace.h> |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 27 | |
Timothy Pearson | 44d5342 | 2015-05-18 16:04:10 -0500 | [diff] [blame] | 28 | #if (!defined(__PRE_RAM__) && IS_ENABLED(CONFIG_HAVE_ROMSTAGE_CONSOLE_SPINLOCK)) || !IS_ENABLED(CONFIG_HAVE_ROMSTAGE_CONSOLE_SPINLOCK) |
Myles Watson | 2e67273 | 2009-11-12 16:38:03 +0000 | [diff] [blame] | 29 | DECLARE_SPIN_LOCK(console_lock) |
Timothy Pearson | 44d5342 | 2015-05-18 16:04:10 -0500 | [diff] [blame] | 30 | #endif |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 31 | |
Kyösti Mälkki | 657e0be | 2014-02-04 19:03:57 +0200 | [diff] [blame] | 32 | void do_putchar(unsigned char byte) |
| 33 | { |
Kyösti Mälkki | 657e0be | 2014-02-04 19:03:57 +0200 | [diff] [blame] | 34 | console_tx_byte(byte); |
| 35 | } |
| 36 | |
Kyösti Mälkki | 77f43e9 | 2014-02-04 19:50:07 +0200 | [diff] [blame] | 37 | static void wrap_putchar(unsigned char byte, void *data) |
Kyösti Mälkki | b04e0ff | 2014-02-04 14:28:17 +0200 | [diff] [blame] | 38 | { |
| 39 | do_putchar(byte); |
| 40 | } |
| 41 | |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 42 | int do_printk(int msg_level, const char *fmt, ...) |
| 43 | { |
| 44 | va_list args; |
| 45 | int i; |
| 46 | |
Kyösti Mälkki | 56ae139 | 2014-02-28 14:37:27 +0200 | [diff] [blame] | 47 | if (!console_log_level(msg_level)) |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 48 | return 0; |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 49 | |
Edward O'Callaghan | 0ddb826 | 2014-06-17 18:37:08 +1000 | [diff] [blame] | 50 | #if IS_ENABLED (CONFIG_SQUELCH_EARLY_SMP) && defined(__PRE_RAM__) |
Kyösti Mälkki | b2d2596 | 2014-01-27 15:09:13 +0200 | [diff] [blame] | 51 | if (!boot_cpu()) |
| 52 | return 0; |
| 53 | #endif |
| 54 | |
Rudolf Marek | 7f0e930 | 2011-09-02 23:23:41 +0200 | [diff] [blame] | 55 | DISABLE_TRACE; |
Timothy Pearson | 44d5342 | 2015-05-18 16:04:10 -0500 | [diff] [blame] | 56 | #ifdef __PRE_RAM__ |
| 57 | #if IS_ENABLED(CONFIG_HAVE_ROMSTAGE_CONSOLE_SPINLOCK) |
| 58 | spin_lock(romstage_console_lock()); |
| 59 | #endif |
| 60 | #else |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 61 | spin_lock(&console_lock); |
Timothy Pearson | 44d5342 | 2015-05-18 16:04:10 -0500 | [diff] [blame] | 62 | #endif |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 63 | |
| 64 | va_start(args, fmt); |
Kyösti Mälkki | b04e0ff | 2014-02-04 14:28:17 +0200 | [diff] [blame] | 65 | i = vtxprintf(wrap_putchar, fmt, args, NULL); |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 66 | va_end(args); |
| 67 | |
| 68 | console_tx_flush(); |
| 69 | |
Timothy Pearson | 44d5342 | 2015-05-18 16:04:10 -0500 | [diff] [blame] | 70 | #ifdef __PRE_RAM__ |
| 71 | #if IS_ENABLED(CONFIG_HAVE_ROMSTAGE_CONSOLE_SPINLOCK) |
| 72 | spin_unlock(romstage_console_lock()); |
| 73 | #endif |
| 74 | #else |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 75 | spin_unlock(&console_lock); |
Timothy Pearson | 44d5342 | 2015-05-18 16:04:10 -0500 | [diff] [blame] | 76 | #endif |
Rudolf Marek | 7f0e930 | 2011-09-02 23:23:41 +0200 | [diff] [blame] | 77 | ENABLE_TRACE; |
Eric Biederman | 8ca8d76 | 2003-04-22 19:02:15 +0000 | [diff] [blame] | 78 | |
| 79 | return i; |
| 80 | } |
Kyösti Mälkki | b3356bb | 2014-03-06 16:55:05 +0200 | [diff] [blame] | 81 | |
Edward O'Callaghan | 0ddb826 | 2014-06-17 18:37:08 +1000 | [diff] [blame] | 82 | #if IS_ENABLED (CONFIG_CHROMEOS) |
Aaron Durbin | 8fb36c0 | 2015-05-01 16:48:54 -0500 | [diff] [blame] | 83 | void do_printk_va_list(int msg_level, const char *fmt, va_list args) |
Kyösti Mälkki | b3356bb | 2014-03-06 16:55:05 +0200 | [diff] [blame] | 84 | { |
Aaron Durbin | 8fb36c0 | 2015-05-01 16:48:54 -0500 | [diff] [blame] | 85 | if (!console_log_level(msg_level)) |
| 86 | return; |
Kyösti Mälkki | b04e0ff | 2014-02-04 14:28:17 +0200 | [diff] [blame] | 87 | vtxprintf(wrap_putchar, fmt, args, NULL); |
Kyösti Mälkki | b3356bb | 2014-03-06 16:55:05 +0200 | [diff] [blame] | 88 | console_tx_flush(); |
| 89 | } |
Edward O'Callaghan | 0ddb826 | 2014-06-17 18:37:08 +1000 | [diff] [blame] | 90 | #endif /* CONFIG_CHROMEOS */ |