Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
7f853352 | 2 | * polling mode stateless debugging stuff, originally for NS16550 Serial Ports |
1da177e4 LT |
3 | * |
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> | |
1da177e4 | 13 | #include <linux/types.h> |
188d2ce7 | 14 | #include <linux/sched.h> |
8d927391 | 15 | #include <linux/console.h> |
3b5e905e | 16 | #include <linux/init.h> |
1da177e4 | 17 | #include <asm/processor.h> |
296167ae | 18 | #include <asm/udbg.h> |
1da177e4 | 19 | |
51d3082f | 20 | void (*udbg_putc)(char c); |
af9c7249 | 21 | void (*udbg_flush)(void); |
bb6b9b28 | 22 | int (*udbg_getc)(void); |
c8f1c8be MM |
23 | int (*udbg_getc_poll)(void); |
24 | ||
296167ae ME |
25 | /* |
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 | */ | |
29 | void __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(); | |
cc46bb98 | 37 | #elif defined(CONFIG_PPC_EARLY_DEBUG_RTAS_PANEL) |
296167ae | 38 | /* RTAS panel debug */ |
cc46bb98 ME |
39 | udbg_init_rtas_panel(); |
40 | #elif defined(CONFIG_PPC_EARLY_DEBUG_RTAS_CONSOLE) | |
41 | /* RTAS console debug */ | |
42 | udbg_init_rtas_console(); | |
296167ae ME |
43 | #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(); | |
d7480a9f IK |
49 | #elif defined(CONFIG_PPC_EARLY_DEBUG_BEAT) |
50 | udbg_init_debug_beat(); | |
39c870d5 OJ |
51 | #elif defined(CONFIG_PPC_EARLY_DEBUG_PAS_REALMODE) |
52 | udbg_init_pas_realmode(); | |
719c91cc DG |
53 | #elif defined(CONFIG_BOOTX_TEXT) |
54 | udbg_init_btext(); | |
d9b55a03 DG |
55 | #elif defined(CONFIG_PPC_EARLY_DEBUG_44x) |
56 | /* PPC44x debug */ | |
57 | udbg_init_44x_as1(); | |
9dae8afd BH |
58 | #elif defined(CONFIG_PPC_EARLY_DEBUG_40x) |
59 | /* PPC40x debug */ | |
60 | udbg_init_40x_realmode(); | |
c374e00e SW |
61 | #elif defined(CONFIG_PPC_EARLY_DEBUG_CPM) |
62 | udbg_init_cpm(); | |
d1d56f8c AH |
63 | #elif defined(CONFIG_PPC_EARLY_DEBUG_USBGECKO) |
64 | udbg_init_usbgecko(); | |
296167ae | 65 | #endif |
7ee17466 BH |
66 | |
67 | #ifdef CONFIG_PPC_EARLY_DEBUG | |
68 | console_loglevel = 10; | |
69 | #endif | |
296167ae ME |
70 | } |
71 | ||
8d927391 | 72 | /* udbg library, used by xmon et al */ |
1da177e4 LT |
73 | void udbg_puts(const char *s) |
74 | { | |
c8f1c8be | 75 | if (udbg_putc) { |
1da177e4 LT |
76 | char c; |
77 | ||
78 | if (s && *s != '\0') { | |
79 | while ((c = *s++) != '\0') | |
c8f1c8be | 80 | udbg_putc(c); |
1da177e4 | 81 | } |
af9c7249 AK |
82 | |
83 | if (udbg_flush) | |
84 | udbg_flush(); | |
1da177e4 LT |
85 | } |
86 | #if 0 | |
87 | else { | |
88 | printk("%s", s); | |
89 | } | |
90 | #endif | |
91 | } | |
92 | ||
93 | int udbg_write(const char *s, int n) | |
94 | { | |
95 | int remain = n; | |
96 | char c; | |
97 | ||
c8f1c8be | 98 | if (!udbg_putc) |
1da177e4 LT |
99 | return 0; |
100 | ||
101 | if (s && *s != '\0') { | |
102 | while (((c = *s++) != '\0') && (remain-- > 0)) { | |
c8f1c8be | 103 | udbg_putc(c); |
1da177e4 LT |
104 | } |
105 | } | |
106 | ||
af9c7249 AK |
107 | if (udbg_flush) |
108 | udbg_flush(); | |
109 | ||
1da177e4 LT |
110 | return n - remain; |
111 | } | |
112 | ||
113 | int udbg_read(char *buf, int buflen) | |
114 | { | |
bb6b9b28 BH |
115 | char *p = buf; |
116 | int i, c; | |
1da177e4 | 117 | |
c8f1c8be | 118 | if (!udbg_getc) |
1da177e4 LT |
119 | return 0; |
120 | ||
121 | for (i = 0; i < buflen; ++i) { | |
122 | do { | |
c8f1c8be | 123 | c = udbg_getc(); |
bb6b9b28 BH |
124 | if (c == -1 && i == 0) |
125 | return -1; | |
126 | ||
1da177e4 | 127 | } while (c == 0x11 || c == 0x13); |
bb6b9b28 | 128 | if (c == 0 || c == -1) |
1da177e4 LT |
129 | break; |
130 | *p++ = c; | |
131 | } | |
132 | ||
133 | return i; | |
134 | } | |
135 | ||
1da177e4 LT |
136 | #define UDBG_BUFSIZE 256 |
137 | void udbg_printf(const char *fmt, ...) | |
138 | { | |
51d3082f | 139 | char buf[UDBG_BUFSIZE]; |
1da177e4 LT |
140 | 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 | ||
be6b8439 KG |
148 | void __init udbg_progress(char *s, unsigned short hex) |
149 | { | |
150 | udbg_puts(s); | |
151 | udbg_puts("\n"); | |
152 | } | |
153 | ||
8d927391 MM |
154 | /* |
155 | * Early boot console based on udbg | |
156 | */ | |
157 | static void udbg_console_write(struct console *con, const char *s, | |
158 | unsigned int n) | |
159 | { | |
160 | udbg_write(s, n); | |
161 | } | |
162 | ||
163 | static struct console udbg_console = { | |
164 | .name = "udbg", | |
165 | .write = udbg_console_write, | |
f336632f | 166 | .flags = CON_PRINTBUFFER | CON_ENABLED | CON_BOOT | CON_ANYTIME, |
c7afb4e2 | 167 | .index = 0, |
8d927391 MM |
168 | }; |
169 | ||
38c0ff06 SR |
170 | static int early_console_initialized; |
171 | ||
220ddc08 MM |
172 | /* |
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 | */ | |
282045b4 | 176 | void __init register_early_udbg_console(void) |
8d927391 | 177 | { |
51d3082f BH |
178 | if (early_console_initialized) |
179 | return; | |
69331af7 | 180 | |
220ddc08 MM |
181 | if (!udbg_putc) |
182 | return; | |
183 | ||
69331af7 GH |
184 | if (strstr(boot_command_line, "udbg-immortal")) { |
185 | printk(KERN_INFO "early console immortal !\n"); | |
186 | udbg_console.flags &= ~CON_BOOT; | |
187 | } | |
38c0ff06 | 188 | early_console_initialized = 1; |
8d927391 MM |
189 | register_console(&udbg_console); |
190 | } | |
191 | ||
192 | #if 0 /* if you want to use this as a regular output console */ | |
193 | console_initcall(register_udbg_console); | |
194 | #endif |