Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * NS16550 Serial Port (uart) debugging stuff. | |
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> | |
13 | #define WANT_PPCDBG_TAB /* Only defined here */ | |
14 | #include <linux/config.h> | |
15 | #include <linux/types.h> | |
16 | #include <asm/ppcdebug.h> | |
17 | #include <asm/processor.h> | |
18 | #include <asm/uaccess.h> | |
19 | #include <asm/machdep.h> | |
20 | #include <asm/io.h> | |
21 | #include <asm/prom.h> | |
22 | #include <asm/pmac_feature.h> | |
23 | ||
24 | extern u8 real_readb(volatile u8 __iomem *addr); | |
25 | extern void real_writeb(u8 data, volatile u8 __iomem *addr); | |
26 | ||
27 | struct NS16550 { | |
28 | /* this struct must be packed */ | |
29 | unsigned char rbr; /* 0 */ | |
30 | unsigned char ier; /* 1 */ | |
31 | unsigned char fcr; /* 2 */ | |
32 | unsigned char lcr; /* 3 */ | |
33 | unsigned char mcr; /* 4 */ | |
34 | unsigned char lsr; /* 5 */ | |
35 | unsigned char msr; /* 6 */ | |
36 | unsigned char scr; /* 7 */ | |
37 | }; | |
38 | ||
39 | #define thr rbr | |
40 | #define iir fcr | |
41 | #define dll rbr | |
42 | #define dlm ier | |
43 | #define dlab lcr | |
44 | ||
45 | #define LSR_DR 0x01 /* Data ready */ | |
46 | #define LSR_OE 0x02 /* Overrun */ | |
47 | #define LSR_PE 0x04 /* Parity error */ | |
48 | #define LSR_FE 0x08 /* Framing error */ | |
49 | #define LSR_BI 0x10 /* Break */ | |
50 | #define LSR_THRE 0x20 /* Xmit holding register empty */ | |
51 | #define LSR_TEMT 0x40 /* Xmitter empty */ | |
52 | #define LSR_ERR 0x80 /* Error */ | |
53 | ||
54 | static volatile struct NS16550 __iomem *udbg_comport; | |
55 | ||
56 | void udbg_init_uart(void __iomem *comport, unsigned int speed) | |
57 | { | |
58 | u16 dll = speed ? (115200 / speed) : 12; | |
59 | ||
60 | if (comport) { | |
61 | udbg_comport = (struct NS16550 __iomem *)comport; | |
62 | out_8(&udbg_comport->lcr, 0x00); | |
63 | out_8(&udbg_comport->ier, 0xff); | |
64 | out_8(&udbg_comport->ier, 0x00); | |
65 | out_8(&udbg_comport->lcr, 0x80); /* Access baud rate */ | |
66 | out_8(&udbg_comport->dll, dll & 0xff); /* 1 = 115200, 2 = 57600, | |
67 | 3 = 38400, 12 = 9600 baud */ | |
68 | out_8(&udbg_comport->dlm, dll >> 8); /* dll >> 8 which should be zero | |
69 | for fast rates; */ | |
70 | out_8(&udbg_comport->lcr, 0x03); /* 8 data, 1 stop, no parity */ | |
71 | out_8(&udbg_comport->mcr, 0x03); /* RTS/DTR */ | |
72 | out_8(&udbg_comport->fcr ,0x07); /* Clear & enable FIFOs */ | |
37548d58 MM |
73 | ppc_md.udbg_putc = udbg_putc; /* set access methods */ |
74 | ppc_md.udbg_getc = udbg_getc; | |
75 | ppc_md.udbg_getc_poll = udbg_getc_poll; | |
1da177e4 LT |
76 | } |
77 | } | |
78 | ||
79 | #ifdef CONFIG_PPC_PMAC | |
80 | ||
81 | #define SCC_TXRDY 4 | |
82 | #define SCC_RXRDY 1 | |
83 | ||
84 | static volatile u8 __iomem *sccc; | |
85 | static volatile u8 __iomem *sccd; | |
86 | ||
87 | static unsigned char scc_inittab[] = { | |
88 | 13, 0, /* set baud rate divisor */ | |
89 | 12, 0, | |
90 | 14, 1, /* baud rate gen enable, src=rtxc */ | |
91 | 11, 0x50, /* clocks = br gen */ | |
92 | 5, 0xea, /* tx 8 bits, assert DTR & RTS */ | |
93 | 4, 0x46, /* x16 clock, 1 stop */ | |
94 | 3, 0xc1, /* rx enable, 8 bits */ | |
95 | }; | |
96 | ||
97 | void udbg_init_scc(struct device_node *np) | |
98 | { | |
99 | u32 *reg; | |
100 | unsigned long addr; | |
101 | int i, x; | |
102 | ||
103 | if (np == NULL) | |
104 | np = of_find_node_by_name(NULL, "escc"); | |
105 | if (np == NULL || np->parent == NULL) | |
106 | return; | |
107 | ||
108 | udbg_printf("found SCC...\n"); | |
109 | /* Get address within mac-io ASIC */ | |
110 | reg = (u32 *)get_property(np, "reg", NULL); | |
111 | if (reg == NULL) | |
112 | return; | |
113 | addr = reg[0]; | |
114 | udbg_printf("local addr: %lx\n", addr); | |
115 | /* Get address of mac-io PCI itself */ | |
116 | reg = (u32 *)get_property(np->parent, "assigned-addresses", NULL); | |
117 | if (reg == NULL) | |
118 | return; | |
119 | addr += reg[2]; | |
120 | udbg_printf("final addr: %lx\n", addr); | |
121 | ||
122 | /* Setup for 57600 8N1 */ | |
123 | addr += 0x20; | |
124 | sccc = (volatile u8 * __iomem) ioremap(addr & PAGE_MASK, PAGE_SIZE) ; | |
125 | sccc += addr & ~PAGE_MASK; | |
126 | sccd = sccc + 0x10; | |
127 | ||
128 | udbg_printf("ioremap result sccc: %p\n", sccc); | |
129 | mb(); | |
130 | ||
131 | for (i = 20000; i != 0; --i) | |
132 | x = in_8(sccc); | |
133 | out_8(sccc, 0x09); /* reset A or B side */ | |
134 | out_8(sccc, 0xc0); | |
135 | for (i = 0; i < sizeof(scc_inittab); ++i) | |
136 | out_8(sccc, scc_inittab[i]); | |
137 | ||
138 | ppc_md.udbg_putc = udbg_putc; | |
139 | ppc_md.udbg_getc = udbg_getc; | |
140 | ppc_md.udbg_getc_poll = udbg_getc_poll; | |
141 | ||
142 | udbg_puts("Hello World !\n"); | |
143 | } | |
144 | ||
145 | #endif /* CONFIG_PPC_PMAC */ | |
146 | ||
44456d37 | 147 | #ifdef CONFIG_PPC_PMAC |
1da177e4 LT |
148 | static void udbg_real_putc(unsigned char c) |
149 | { | |
150 | while ((real_readb(sccc) & SCC_TXRDY) == 0) | |
151 | ; | |
152 | real_writeb(c, sccd); | |
153 | if (c == '\n') | |
154 | udbg_real_putc('\r'); | |
155 | } | |
156 | ||
157 | void udbg_init_pmac_realmode(void) | |
158 | { | |
159 | sccc = (volatile u8 __iomem *)0x80013020ul; | |
160 | sccd = (volatile u8 __iomem *)0x80013030ul; | |
161 | ||
162 | ppc_md.udbg_putc = udbg_real_putc; | |
163 | ppc_md.udbg_getc = NULL; | |
164 | ppc_md.udbg_getc_poll = NULL; | |
165 | } | |
166 | #endif /* CONFIG_PPC_PMAC */ | |
167 | ||
168 | #ifdef CONFIG_PPC_MAPLE | |
169 | void udbg_maple_real_putc(unsigned char c) | |
170 | { | |
171 | if (udbg_comport) { | |
172 | while ((real_readb(&udbg_comport->lsr) & LSR_THRE) == 0) | |
173 | /* wait for idle */; | |
174 | real_writeb(c, &udbg_comport->thr); eieio(); | |
cb14c4d6 MM |
175 | if (c == '\n') |
176 | udbg_maple_real_putc('\r'); | |
1da177e4 LT |
177 | } |
178 | } | |
179 | ||
180 | void udbg_init_maple_realmode(void) | |
181 | { | |
182 | udbg_comport = (volatile struct NS16550 __iomem *)0xf40003f8; | |
183 | ||
184 | ppc_md.udbg_putc = udbg_maple_real_putc; | |
185 | ppc_md.udbg_getc = NULL; | |
186 | ppc_md.udbg_getc_poll = NULL; | |
187 | } | |
188 | #endif /* CONFIG_PPC_MAPLE */ | |
189 | ||
190 | void udbg_putc(unsigned char c) | |
191 | { | |
192 | if (udbg_comport) { | |
193 | while ((in_8(&udbg_comport->lsr) & LSR_THRE) == 0) | |
194 | /* wait for idle */; | |
195 | out_8(&udbg_comport->thr, c); | |
cb14c4d6 MM |
196 | if (c == '\n') |
197 | udbg_putc('\r'); | |
1da177e4 LT |
198 | } |
199 | #ifdef CONFIG_PPC_PMAC | |
200 | else if (sccc) { | |
201 | while ((in_8(sccc) & SCC_TXRDY) == 0) | |
202 | ; | |
203 | out_8(sccd, c); | |
204 | if (c == '\n') | |
205 | udbg_putc('\r'); | |
206 | } | |
207 | #endif /* CONFIG_PPC_PMAC */ | |
208 | } | |
209 | ||
210 | int udbg_getc_poll(void) | |
211 | { | |
212 | if (udbg_comport) { | |
213 | if ((in_8(&udbg_comport->lsr) & LSR_DR) != 0) | |
214 | return in_8(&udbg_comport->rbr); | |
215 | else | |
216 | return -1; | |
217 | } | |
218 | #ifdef CONFIG_PPC_PMAC | |
219 | else if (sccc) { | |
220 | if ((in_8(sccc) & SCC_RXRDY) != 0) | |
221 | return in_8(sccd); | |
222 | else | |
223 | return -1; | |
224 | } | |
225 | #endif /* CONFIG_PPC_PMAC */ | |
226 | return -1; | |
227 | } | |
228 | ||
229 | unsigned char udbg_getc(void) | |
230 | { | |
231 | if (udbg_comport) { | |
232 | while ((in_8(&udbg_comport->lsr) & LSR_DR) == 0) | |
233 | /* wait for char */; | |
234 | return in_8(&udbg_comport->rbr); | |
235 | } | |
236 | #ifdef CONFIG_PPC_PMAC | |
237 | else if (sccc) { | |
238 | while ((in_8(sccc) & SCC_RXRDY) == 0) | |
239 | ; | |
240 | return in_8(sccd); | |
241 | } | |
242 | #endif /* CONFIG_PPC_PMAC */ | |
243 | return 0; | |
244 | } | |
245 | ||
246 | void udbg_puts(const char *s) | |
247 | { | |
248 | if (ppc_md.udbg_putc) { | |
249 | char c; | |
250 | ||
251 | if (s && *s != '\0') { | |
252 | while ((c = *s++) != '\0') | |
253 | ppc_md.udbg_putc(c); | |
254 | } | |
255 | } | |
256 | #if 0 | |
257 | else { | |
258 | printk("%s", s); | |
259 | } | |
260 | #endif | |
261 | } | |
262 | ||
263 | int udbg_write(const char *s, int n) | |
264 | { | |
265 | int remain = n; | |
266 | char c; | |
267 | ||
268 | if (!ppc_md.udbg_putc) | |
269 | return 0; | |
270 | ||
271 | if (s && *s != '\0') { | |
272 | while (((c = *s++) != '\0') && (remain-- > 0)) { | |
273 | ppc_md.udbg_putc(c); | |
274 | } | |
275 | } | |
276 | ||
277 | return n - remain; | |
278 | } | |
279 | ||
280 | int udbg_read(char *buf, int buflen) | |
281 | { | |
282 | char c, *p = buf; | |
283 | int i; | |
284 | ||
285 | if (!ppc_md.udbg_getc) | |
286 | return 0; | |
287 | ||
288 | for (i = 0; i < buflen; ++i) { | |
289 | do { | |
290 | c = ppc_md.udbg_getc(); | |
291 | } while (c == 0x11 || c == 0x13); | |
292 | if (c == 0) | |
293 | break; | |
294 | *p++ = c; | |
295 | } | |
296 | ||
297 | return i; | |
298 | } | |
299 | ||
300 | void udbg_console_write(struct console *con, const char *s, unsigned int n) | |
301 | { | |
302 | udbg_write(s, n); | |
303 | } | |
304 | ||
305 | #define UDBG_BUFSIZE 256 | |
306 | void udbg_printf(const char *fmt, ...) | |
307 | { | |
308 | unsigned char buf[UDBG_BUFSIZE]; | |
309 | va_list args; | |
310 | ||
311 | va_start(args, fmt); | |
312 | vsnprintf(buf, UDBG_BUFSIZE, fmt, args); | |
313 | udbg_puts(buf); | |
314 | va_end(args); | |
315 | } | |
316 | ||
317 | /* Special print used by PPCDBG() macro */ | |
318 | void udbg_ppcdbg(unsigned long debug_flags, const char *fmt, ...) | |
319 | { | |
320 | unsigned long active_debugs = debug_flags & ppc64_debug_switch; | |
321 | ||
322 | if (active_debugs) { | |
323 | va_list ap; | |
324 | unsigned char buf[UDBG_BUFSIZE]; | |
325 | unsigned long i, len = 0; | |
326 | ||
327 | for (i=0; i < PPCDBG_NUM_FLAGS; i++) { | |
328 | if (((1U << i) & active_debugs) && | |
329 | trace_names[i]) { | |
330 | len += strlen(trace_names[i]); | |
331 | udbg_puts(trace_names[i]); | |
332 | break; | |
333 | } | |
334 | } | |
335 | ||
336 | snprintf(buf, UDBG_BUFSIZE, " [%s]: ", current->comm); | |
337 | len += strlen(buf); | |
338 | udbg_puts(buf); | |
339 | ||
340 | while (len < 18) { | |
341 | udbg_puts(" "); | |
342 | len++; | |
343 | } | |
344 | ||
345 | va_start(ap, fmt); | |
346 | vsnprintf(buf, UDBG_BUFSIZE, fmt, ap); | |
347 | udbg_puts(buf); | |
348 | va_end(ap); | |
349 | } | |
350 | } | |
351 | ||
352 | unsigned long udbg_ifdebug(unsigned long flags) | |
353 | { | |
354 | return (flags & ppc64_debug_switch); | |
355 | } |