blob: e39cad83c8849a69ecb710a8ac0d8bc595bdce3a [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Milton Miller7f853352005-09-06 11:56:02 +10002 * polling mode stateless debugging stuff, originally for NS16550 Serial Ports
Linus Torvalds1da177e2005-04-16 15:20:36 -07003 *
4 * c 2001 PPC 64 Team, IBM Corp
5 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version
9 * 2 of the License, or (at your option) any later version.
10 */
11
12#include <stdarg.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070013#include <linux/types.h>
Milton Miller188d2ce2005-09-06 11:57:00 +100014#include <linux/sched.h>
Milton Miller8d927392005-09-06 11:57:27 +100015#include <linux/console.h>
Benjamin Herrenschmidt3b5e9052006-06-07 12:06:20 +100016#include <linux/init.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070017#include <asm/processor.h>
Michael Ellerman296167a2006-01-11 11:54:09 +110018#include <asm/udbg.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070019
Benjamin Herrenschmidt51d30822005-11-23 17:57:25 +110020void (*udbg_putc)(char c);
Andrew Klossneraf9c7242009-03-09 07:52:41 +000021void (*udbg_flush)(void);
Benjamin Herrenschmidtbb6b9b22005-11-30 16:54:12 +110022int (*udbg_getc)(void);
Milton Millerc8f1c8b2005-09-06 11:56:42 +100023int (*udbg_getc_poll)(void);
24
Michael Ellerman296167a2006-01-11 11:54:09 +110025/*
26 * Early debugging facilities. You can enable _one_ of these via .config,
27 * if you do so your kernel _will not boot_ on anything else. Be careful.
28 */
29void __init udbg_early_init(void)
30{
31#if defined(CONFIG_PPC_EARLY_DEBUG_LPAR)
32 /* For LPAR machines that have an HVC console on vterm 0 */
33 udbg_init_debug_lpar();
34#elif defined(CONFIG_PPC_EARLY_DEBUG_G5)
35 /* For use on Apple G5 machines */
36 udbg_init_pmac_realmode();
Michael Ellermancc46bb92006-06-23 18:20:16 +100037#elif defined(CONFIG_PPC_EARLY_DEBUG_RTAS_PANEL)
Michael Ellerman296167a2006-01-11 11:54:09 +110038 /* RTAS panel debug */
Michael Ellermancc46bb92006-06-23 18:20:16 +100039 udbg_init_rtas_panel();
40#elif defined(CONFIG_PPC_EARLY_DEBUG_RTAS_CONSOLE)
41 /* RTAS console debug */
42 udbg_init_rtas_console();
Michael Ellerman296167a2006-01-11 11:54:09 +110043#elif defined(CONFIG_PPC_EARLY_DEBUG_MAPLE)
44 /* Maple real mode debug */
45 udbg_init_maple_realmode();
46#elif defined(CONFIG_PPC_EARLY_DEBUG_ISERIES)
47 /* For iSeries - hit Ctrl-x Ctrl-x to see the output */
48 udbg_init_iseries();
Ishizaki Koud7480a92007-02-02 16:43:21 +090049#elif defined(CONFIG_PPC_EARLY_DEBUG_BEAT)
50 udbg_init_debug_beat();
Olof Johansson39c870d2007-02-04 16:36:49 -060051#elif defined(CONFIG_PPC_EARLY_DEBUG_PAS_REALMODE)
52 udbg_init_pas_realmode();
David Gibson719c91c2007-02-13 15:54:22 +110053#elif defined(CONFIG_BOOTX_TEXT)
54 udbg_init_btext();
David Gibsond9b55a02007-05-08 12:59:31 +100055#elif defined(CONFIG_PPC_EARLY_DEBUG_44x)
56 /* PPC44x debug */
57 udbg_init_44x_as1();
Benjamin Herrenschmidt9dae8af2007-12-21 15:39:26 +110058#elif defined(CONFIG_PPC_EARLY_DEBUG_40x)
59 /* PPC40x debug */
60 udbg_init_40x_realmode();
Scott Woodc374e002007-07-16 11:43:43 -050061#elif defined(CONFIG_PPC_EARLY_DEBUG_CPM)
62 udbg_init_cpm();
Albert Herranzd1d56f82009-12-12 06:31:51 +000063#elif defined(CONFIG_PPC_EARLY_DEBUG_USBGECKO)
64 udbg_init_usbgecko();
Michael Ellerman296167a2006-01-11 11:54:09 +110065#endif
Benjamin Herrenschmidt7ee17462007-12-11 14:48:24 +110066
67#ifdef CONFIG_PPC_EARLY_DEBUG
68 console_loglevel = 10;
69#endif
Michael Ellerman296167a2006-01-11 11:54:09 +110070}
71
Milton Miller8d927392005-09-06 11:57:27 +100072/* udbg library, used by xmon et al */
Linus Torvalds1da177e2005-04-16 15:20:36 -070073void udbg_puts(const char *s)
74{
Milton Millerc8f1c8b2005-09-06 11:56:42 +100075 if (udbg_putc) {
Linus Torvalds1da177e2005-04-16 15:20:36 -070076 char c;
77
78 if (s && *s != '\0') {
79 while ((c = *s++) != '\0')
Milton Millerc8f1c8b2005-09-06 11:56:42 +100080 udbg_putc(c);
Linus Torvalds1da177e2005-04-16 15:20:36 -070081 }
Andrew Klossneraf9c7242009-03-09 07:52:41 +000082
83 if (udbg_flush)
84 udbg_flush();
Linus Torvalds1da177e2005-04-16 15:20:36 -070085 }
86#if 0
87 else {
88 printk("%s", s);
89 }
90#endif
91}
92
93int udbg_write(const char *s, int n)
94{
95 int remain = n;
96 char c;
97
Milton Millerc8f1c8b2005-09-06 11:56:42 +100098 if (!udbg_putc)
Linus Torvalds1da177e2005-04-16 15:20:36 -070099 return 0;
100
101 if (s && *s != '\0') {
102 while (((c = *s++) != '\0') && (remain-- > 0)) {
Milton Millerc8f1c8b2005-09-06 11:56:42 +1000103 udbg_putc(c);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700104 }
105 }
106
Andrew Klossneraf9c7242009-03-09 07:52:41 +0000107 if (udbg_flush)
108 udbg_flush();
109
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110 return n - remain;
111}
112
113int udbg_read(char *buf, int buflen)
114{
Benjamin Herrenschmidtbb6b9b22005-11-30 16:54:12 +1100115 char *p = buf;
116 int i, c;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700117
Milton Millerc8f1c8b2005-09-06 11:56:42 +1000118 if (!udbg_getc)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700119 return 0;
120
121 for (i = 0; i < buflen; ++i) {
122 do {
Milton Millerc8f1c8b2005-09-06 11:56:42 +1000123 c = udbg_getc();
Benjamin Herrenschmidtbb6b9b22005-11-30 16:54:12 +1100124 if (c == -1 && i == 0)
125 return -1;
126
Linus Torvalds1da177e2005-04-16 15:20:36 -0700127 } while (c == 0x11 || c == 0x13);
Benjamin Herrenschmidtbb6b9b22005-11-30 16:54:12 +1100128 if (c == 0 || c == -1)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700129 break;
130 *p++ = c;
131 }
132
133 return i;
134}
135
Linus Torvalds1da177e2005-04-16 15:20:36 -0700136#define UDBG_BUFSIZE 256
137void udbg_printf(const char *fmt, ...)
138{
Benjamin Herrenschmidt51d30822005-11-23 17:57:25 +1100139 char buf[UDBG_BUFSIZE];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700140 va_list args;
141
142 va_start(args, fmt);
143 vsnprintf(buf, UDBG_BUFSIZE, fmt, args);
144 udbg_puts(buf);
145 va_end(args);
146}
147
Kumar Galabe6b8432005-12-20 16:37:07 -0600148void __init udbg_progress(char *s, unsigned short hex)
149{
150 udbg_puts(s);
151 udbg_puts("\n");
152}
153
Milton Miller8d927392005-09-06 11:57:27 +1000154/*
155 * Early boot console based on udbg
156 */
157static void udbg_console_write(struct console *con, const char *s,
158 unsigned int n)
159{
160 udbg_write(s, n);
161}
162
163static struct console udbg_console = {
164 .name = "udbg",
165 .write = udbg_console_write,
Michael Ellermanf3366322008-04-24 15:13:14 +1000166 .flags = CON_PRINTBUFFER | CON_ENABLED | CON_BOOT | CON_ANYTIME,
Michael Ellermanc7afb4e2008-04-24 15:13:13 +1000167 .index = 0,
Milton Miller8d927392005-09-06 11:57:27 +1000168};
169
Stephen Rothwell38c0ff02005-09-07 19:52:38 +1000170static int early_console_initialized;
171
Milton Miller220ddc02007-06-10 14:32:43 +1000172/*
173 * Called by setup_system after ppc_md->probe and ppc_md->early_init.
174 * Call it again after setting udbg_putc in ppc_md->setup_arch.
175 */
Kumar Gala282045b2007-07-26 00:16:05 -0500176void __init register_early_udbg_console(void)
Milton Miller8d927392005-09-06 11:57:27 +1000177{
Benjamin Herrenschmidt51d30822005-11-23 17:57:25 +1100178 if (early_console_initialized)
179 return;
Gerd Hoffmann69331af2007-05-08 00:26:49 -0700180
Milton Miller220ddc02007-06-10 14:32:43 +1000181 if (!udbg_putc)
182 return;
183
Gerd Hoffmann69331af2007-05-08 00:26:49 -0700184 if (strstr(boot_command_line, "udbg-immortal")) {
185 printk(KERN_INFO "early console immortal !\n");
186 udbg_console.flags &= ~CON_BOOT;
187 }
Stephen Rothwell38c0ff02005-09-07 19:52:38 +1000188 early_console_initialized = 1;
Milton Miller8d927392005-09-06 11:57:27 +1000189 register_console(&udbg_console);
190}
191
192#if 0 /* if you want to use this as a regular output console */
193console_initcall(register_udbg_console);
194#endif