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 */ | |
73 | } | |
74 | } | |
75 | ||
76 | #ifdef CONFIG_PPC_PMAC | |
77 | ||
78 | #define SCC_TXRDY 4 | |
79 | #define SCC_RXRDY 1 | |
80 | ||
81 | static volatile u8 __iomem *sccc; | |
82 | static volatile u8 __iomem *sccd; | |
83 | ||
84 | static unsigned char scc_inittab[] = { | |
85 | 13, 0, /* set baud rate divisor */ | |
86 | 12, 0, | |
87 | 14, 1, /* baud rate gen enable, src=rtxc */ | |
88 | 11, 0x50, /* clocks = br gen */ | |
89 | 5, 0xea, /* tx 8 bits, assert DTR & RTS */ | |
90 | 4, 0x46, /* x16 clock, 1 stop */ | |
91 | 3, 0xc1, /* rx enable, 8 bits */ | |
92 | }; | |
93 | ||
94 | void udbg_init_scc(struct device_node *np) | |
95 | { | |
96 | u32 *reg; | |
97 | unsigned long addr; | |
98 | int i, x; | |
99 | ||
100 | if (np == NULL) | |
101 | np = of_find_node_by_name(NULL, "escc"); | |
102 | if (np == NULL || np->parent == NULL) | |
103 | return; | |
104 | ||
105 | udbg_printf("found SCC...\n"); | |
106 | /* Get address within mac-io ASIC */ | |
107 | reg = (u32 *)get_property(np, "reg", NULL); | |
108 | if (reg == NULL) | |
109 | return; | |
110 | addr = reg[0]; | |
111 | udbg_printf("local addr: %lx\n", addr); | |
112 | /* Get address of mac-io PCI itself */ | |
113 | reg = (u32 *)get_property(np->parent, "assigned-addresses", NULL); | |
114 | if (reg == NULL) | |
115 | return; | |
116 | addr += reg[2]; | |
117 | udbg_printf("final addr: %lx\n", addr); | |
118 | ||
119 | /* Setup for 57600 8N1 */ | |
120 | addr += 0x20; | |
121 | sccc = (volatile u8 * __iomem) ioremap(addr & PAGE_MASK, PAGE_SIZE) ; | |
122 | sccc += addr & ~PAGE_MASK; | |
123 | sccd = sccc + 0x10; | |
124 | ||
125 | udbg_printf("ioremap result sccc: %p\n", sccc); | |
126 | mb(); | |
127 | ||
128 | for (i = 20000; i != 0; --i) | |
129 | x = in_8(sccc); | |
130 | out_8(sccc, 0x09); /* reset A or B side */ | |
131 | out_8(sccc, 0xc0); | |
132 | for (i = 0; i < sizeof(scc_inittab); ++i) | |
133 | out_8(sccc, scc_inittab[i]); | |
134 | ||
135 | ppc_md.udbg_putc = udbg_putc; | |
136 | ppc_md.udbg_getc = udbg_getc; | |
137 | ppc_md.udbg_getc_poll = udbg_getc_poll; | |
138 | ||
139 | udbg_puts("Hello World !\n"); | |
140 | } | |
141 | ||
142 | #endif /* CONFIG_PPC_PMAC */ | |
143 | ||
44456d37 | 144 | #ifdef CONFIG_PPC_PMAC |
1da177e4 LT |
145 | static void udbg_real_putc(unsigned char c) |
146 | { | |
147 | while ((real_readb(sccc) & SCC_TXRDY) == 0) | |
148 | ; | |
149 | real_writeb(c, sccd); | |
150 | if (c == '\n') | |
151 | udbg_real_putc('\r'); | |
152 | } | |
153 | ||
154 | void udbg_init_pmac_realmode(void) | |
155 | { | |
156 | sccc = (volatile u8 __iomem *)0x80013020ul; | |
157 | sccd = (volatile u8 __iomem *)0x80013030ul; | |
158 | ||
159 | ppc_md.udbg_putc = udbg_real_putc; | |
160 | ppc_md.udbg_getc = NULL; | |
161 | ppc_md.udbg_getc_poll = NULL; | |
162 | } | |
163 | #endif /* CONFIG_PPC_PMAC */ | |
164 | ||
165 | #ifdef CONFIG_PPC_MAPLE | |
166 | void udbg_maple_real_putc(unsigned char c) | |
167 | { | |
168 | if (udbg_comport) { | |
169 | while ((real_readb(&udbg_comport->lsr) & LSR_THRE) == 0) | |
170 | /* wait for idle */; | |
171 | real_writeb(c, &udbg_comport->thr); eieio(); | |
cb14c4d6 MM |
172 | if (c == '\n') |
173 | udbg_maple_real_putc('\r'); | |
1da177e4 LT |
174 | } |
175 | } | |
176 | ||
177 | void udbg_init_maple_realmode(void) | |
178 | { | |
179 | udbg_comport = (volatile struct NS16550 __iomem *)0xf40003f8; | |
180 | ||
181 | ppc_md.udbg_putc = udbg_maple_real_putc; | |
182 | ppc_md.udbg_getc = NULL; | |
183 | ppc_md.udbg_getc_poll = NULL; | |
184 | } | |
185 | #endif /* CONFIG_PPC_MAPLE */ | |
186 | ||
187 | void udbg_putc(unsigned char c) | |
188 | { | |
189 | if (udbg_comport) { | |
190 | while ((in_8(&udbg_comport->lsr) & LSR_THRE) == 0) | |
191 | /* wait for idle */; | |
192 | out_8(&udbg_comport->thr, c); | |
cb14c4d6 MM |
193 | if (c == '\n') |
194 | udbg_putc('\r'); | |
1da177e4 LT |
195 | } |
196 | #ifdef CONFIG_PPC_PMAC | |
197 | else if (sccc) { | |
198 | while ((in_8(sccc) & SCC_TXRDY) == 0) | |
199 | ; | |
200 | out_8(sccd, c); | |
201 | if (c == '\n') | |
202 | udbg_putc('\r'); | |
203 | } | |
204 | #endif /* CONFIG_PPC_PMAC */ | |
205 | } | |
206 | ||
207 | int udbg_getc_poll(void) | |
208 | { | |
209 | if (udbg_comport) { | |
210 | if ((in_8(&udbg_comport->lsr) & LSR_DR) != 0) | |
211 | return in_8(&udbg_comport->rbr); | |
212 | else | |
213 | return -1; | |
214 | } | |
215 | #ifdef CONFIG_PPC_PMAC | |
216 | else if (sccc) { | |
217 | if ((in_8(sccc) & SCC_RXRDY) != 0) | |
218 | return in_8(sccd); | |
219 | else | |
220 | return -1; | |
221 | } | |
222 | #endif /* CONFIG_PPC_PMAC */ | |
223 | return -1; | |
224 | } | |
225 | ||
226 | unsigned char udbg_getc(void) | |
227 | { | |
228 | if (udbg_comport) { | |
229 | while ((in_8(&udbg_comport->lsr) & LSR_DR) == 0) | |
230 | /* wait for char */; | |
231 | return in_8(&udbg_comport->rbr); | |
232 | } | |
233 | #ifdef CONFIG_PPC_PMAC | |
234 | else if (sccc) { | |
235 | while ((in_8(sccc) & SCC_RXRDY) == 0) | |
236 | ; | |
237 | return in_8(sccd); | |
238 | } | |
239 | #endif /* CONFIG_PPC_PMAC */ | |
240 | return 0; | |
241 | } | |
242 | ||
243 | void udbg_puts(const char *s) | |
244 | { | |
245 | if (ppc_md.udbg_putc) { | |
246 | char c; | |
247 | ||
248 | if (s && *s != '\0') { | |
249 | while ((c = *s++) != '\0') | |
250 | ppc_md.udbg_putc(c); | |
251 | } | |
252 | } | |
253 | #if 0 | |
254 | else { | |
255 | printk("%s", s); | |
256 | } | |
257 | #endif | |
258 | } | |
259 | ||
260 | int udbg_write(const char *s, int n) | |
261 | { | |
262 | int remain = n; | |
263 | char c; | |
264 | ||
265 | if (!ppc_md.udbg_putc) | |
266 | return 0; | |
267 | ||
268 | if (s && *s != '\0') { | |
269 | while (((c = *s++) != '\0') && (remain-- > 0)) { | |
270 | ppc_md.udbg_putc(c); | |
271 | } | |
272 | } | |
273 | ||
274 | return n - remain; | |
275 | } | |
276 | ||
277 | int udbg_read(char *buf, int buflen) | |
278 | { | |
279 | char c, *p = buf; | |
280 | int i; | |
281 | ||
282 | if (!ppc_md.udbg_getc) | |
283 | return 0; | |
284 | ||
285 | for (i = 0; i < buflen; ++i) { | |
286 | do { | |
287 | c = ppc_md.udbg_getc(); | |
288 | } while (c == 0x11 || c == 0x13); | |
289 | if (c == 0) | |
290 | break; | |
291 | *p++ = c; | |
292 | } | |
293 | ||
294 | return i; | |
295 | } | |
296 | ||
297 | void udbg_console_write(struct console *con, const char *s, unsigned int n) | |
298 | { | |
299 | udbg_write(s, n); | |
300 | } | |
301 | ||
302 | #define UDBG_BUFSIZE 256 | |
303 | void udbg_printf(const char *fmt, ...) | |
304 | { | |
305 | unsigned char buf[UDBG_BUFSIZE]; | |
306 | va_list args; | |
307 | ||
308 | va_start(args, fmt); | |
309 | vsnprintf(buf, UDBG_BUFSIZE, fmt, args); | |
310 | udbg_puts(buf); | |
311 | va_end(args); | |
312 | } | |
313 | ||
314 | /* Special print used by PPCDBG() macro */ | |
315 | void udbg_ppcdbg(unsigned long debug_flags, const char *fmt, ...) | |
316 | { | |
317 | unsigned long active_debugs = debug_flags & ppc64_debug_switch; | |
318 | ||
319 | if (active_debugs) { | |
320 | va_list ap; | |
321 | unsigned char buf[UDBG_BUFSIZE]; | |
322 | unsigned long i, len = 0; | |
323 | ||
324 | for (i=0; i < PPCDBG_NUM_FLAGS; i++) { | |
325 | if (((1U << i) & active_debugs) && | |
326 | trace_names[i]) { | |
327 | len += strlen(trace_names[i]); | |
328 | udbg_puts(trace_names[i]); | |
329 | break; | |
330 | } | |
331 | } | |
332 | ||
333 | snprintf(buf, UDBG_BUFSIZE, " [%s]: ", current->comm); | |
334 | len += strlen(buf); | |
335 | udbg_puts(buf); | |
336 | ||
337 | while (len < 18) { | |
338 | udbg_puts(" "); | |
339 | len++; | |
340 | } | |
341 | ||
342 | va_start(ap, fmt); | |
343 | vsnprintf(buf, UDBG_BUFSIZE, fmt, ap); | |
344 | udbg_puts(buf); | |
345 | va_end(ap); | |
346 | } | |
347 | } | |
348 | ||
349 | unsigned long udbg_ifdebug(unsigned long flags) | |
350 | { | |
351 | return (flags & ppc64_debug_switch); | |
352 | } |