avoid endless loops in lib/swiotlb.c
[wrt350n-kernel.git] / arch / m68k / mac / debug.c
blobe8a57138b4a6e54980247110f56c7310a32dad4f
1 /*
2 * linux/arch/m68k/mac/debug.c
4 * Shamelessly stolen (SCC code and general framework) from:
6 * linux/arch/m68k/atari/debug.c
8 * Atari debugging and serial console stuff
10 * Assembled of parts of former atari/config.c 97-12-18 by Roman Hodek
12 * This file is subject to the terms and conditions of the GNU General Public
13 * License. See the file COPYING in the main directory of this archive
14 * for more details.
17 #include <linux/types.h>
18 #include <linux/sched.h>
19 #include <linux/tty.h>
20 #include <linux/console.h>
21 #include <linux/init.h>
22 #include <linux/delay.h>
24 #define BOOTINFO_COMPAT_1_0
25 #include <asm/setup.h>
26 #include <asm/bootinfo.h>
27 #include <asm/machw.h>
28 #include <asm/macints.h>
30 extern unsigned long mac_videobase;
31 extern unsigned long mac_videodepth;
32 extern unsigned long mac_rowbytes;
34 extern void mac_serial_print(const char *);
36 #define DEBUG_HEADS
37 #undef DEBUG_SCREEN
38 #define DEBUG_SERIAL
41 * These two auxiliary debug functions should go away ASAP. Only usage:
42 * before the console output is up (after head.S come some other crucial
43 * setup routines :-) it permits writing 'data' to the screen as bit patterns
44 * (good luck reading those). Helped to figure that the bootinfo contained
45 * garbage data on the amount and size of memory chunks ...
47 * The 'pos' argument now simply means 'linefeed after print' ...
50 #ifdef DEBUG_SCREEN
51 static int peng, line;
52 #endif
54 void mac_debugging_short(int pos, short num)
56 #ifdef DEBUG_SCREEN
57 unsigned char *pengoffset;
58 unsigned char *pptr;
59 int i;
60 #endif
62 #ifdef DEBUG_SERIAL
63 printk("debug: %d !\n", num);
64 #endif
66 #ifdef DEBUG_SCREEN
67 if (!MACH_IS_MAC) {
68 /* printk("debug: %d !\n", num); */
69 return;
72 /* calculate current offset */
73 pengoffset = (unsigned char *)mac_videobase +
74 (150+line*2) * mac_rowbytes + 80 * peng;
76 pptr = pengoffset;
78 for (i = 0; i < 8 * sizeof(short); i++) { /* # of bits */
79 /* value mask for bit i, reverse order */
80 *pptr++ = (num & (1 << (8*sizeof(short)-i-1)) ? 0xFF : 0x00);
83 peng++;
85 if (pos) {
86 line++;
87 peng = 0;
89 #endif
92 void mac_debugging_long(int pos, long addr)
94 #ifdef DEBUG_SCREEN
95 unsigned char *pengoffset;
96 unsigned char *pptr;
97 int i;
98 #endif
100 #ifdef DEBUG_SERIAL
101 printk("debug: #%ld !\n", addr);
102 #endif
104 #ifdef DEBUG_SCREEN
105 if (!MACH_IS_MAC) {
106 /* printk("debug: #%ld !\n", addr); */
107 return;
110 pengoffset=(unsigned char *)(mac_videobase+(150+line*2)*mac_rowbytes)
111 +80*peng;
113 pptr = pengoffset;
115 for (i = 0; i < 8 * sizeof(long); i++) { /* # of bits */
116 *pptr++ = (addr & (1 << (8*sizeof(long)-i-1)) ? 0xFF : 0x00);
119 peng++;
121 if (pos) {
122 line++;
123 peng = 0;
125 #endif
128 #ifdef DEBUG_SERIAL
130 * TODO: serial debug code
133 struct mac_SCC {
134 u_char cha_b_ctrl;
135 u_char char_dummy1;
136 u_char cha_a_ctrl;
137 u_char char_dummy2;
138 u_char cha_b_data;
139 u_char char_dummy3;
140 u_char cha_a_data;
143 # define scc (*((volatile struct mac_SCC*)mac_bi_data.sccbase))
145 /* Flag that serial port is already initialized and used */
146 int mac_SCC_init_done;
147 /* Can be set somewhere, if a SCC master reset has already be done and should
148 * not be repeated; used by kgdb */
149 int mac_SCC_reset_done;
151 static int scc_port = -1;
153 static struct console mac_console_driver = {
154 .name = "debug",
155 .flags = CON_PRINTBUFFER,
156 .index = -1,
160 * Crude hack to get console output to the screen before the framebuffer
161 * is initialized (happens a lot later in 2.1!).
162 * We just use the console routines declared in head.S, this will interfere
163 * with regular framebuffer console output and should be used exclusively
164 * to debug kernel problems manifesting before framebuffer init (aka WSOD)
166 * To keep this hack from interfering with the regular console driver, either
167 * deregister this driver before/on framebuffer console init, or silence this
168 * function after the fbcon driver is running (will lose console messages!?).
169 * To debug real early bugs, need to write a 'mac_register_console_hack()'
170 * that is called from start_kernel() before setup_arch() and just registers
171 * this driver if Mac.
174 void mac_debug_console_write(struct console *co, const char *str,
175 unsigned int count)
177 mac_serial_print(str);
182 /* Mac: loops_per_jiffy min. 19000 ^= .5 us; MFPDELAY was 0.6 us*/
184 #define uSEC 1
186 static inline void mac_sccb_out(char c)
188 int i;
190 do {
191 for (i = uSEC; i > 0; --i)
192 barrier();
193 } while (!(scc.cha_b_ctrl & 0x04)); /* wait for tx buf empty */
194 for (i = uSEC; i > 0; --i)
195 barrier();
196 scc.cha_b_data = c;
199 static inline void mac_scca_out(char c)
201 int i;
203 do {
204 for (i = uSEC; i > 0; --i)
205 barrier();
206 } while (!(scc.cha_a_ctrl & 0x04)); /* wait for tx buf empty */
207 for (i = uSEC; i > 0; --i)
208 barrier();
209 scc.cha_a_data = c;
212 void mac_sccb_console_write(struct console *co, const char *str,
213 unsigned int count)
215 while (count--) {
216 if (*str == '\n')
217 mac_sccb_out('\r');
218 mac_sccb_out(*str++);
222 void mac_scca_console_write(struct console *co, const char *str,
223 unsigned int count)
225 while (count--) {
226 if (*str == '\n')
227 mac_scca_out('\r');
228 mac_scca_out(*str++);
233 /* The following two functions do a quick'n'dirty initialization of the MFP or
234 * SCC serial ports. They're used by the debugging interface, kgdb, and the
235 * serial console code. */
236 #define SCCB_WRITE(reg,val) \
237 do { \
238 int i; \
239 scc.cha_b_ctrl = (reg); \
240 for (i = uSEC; i > 0; --i) \
241 barrier(); \
242 scc.cha_b_ctrl = (val); \
243 for (i = uSEC; i > 0; --i) \
244 barrier(); \
245 } while(0)
247 #define SCCA_WRITE(reg,val) \
248 do { \
249 int i; \
250 scc.cha_a_ctrl = (reg); \
251 for (i = uSEC; i > 0; --i) \
252 barrier(); \
253 scc.cha_a_ctrl = (val); \
254 for (i = uSEC; i > 0; --i) \
255 barrier(); \
256 } while(0)
258 /* loops_per_jiffy isn't initialized yet, so we can't use udelay(). This does a
259 * delay of ~ 60us. */
260 /* Mac: loops_per_jiffy min. 19000 ^= .5 us; MFPDELAY was 0.6 us*/
261 #define LONG_DELAY() \
262 do { \
263 int i; \
264 for (i = 60*uSEC; i > 0; --i) \
265 barrier(); \
266 } while(0)
268 #ifndef CONFIG_SERIAL_CONSOLE
269 static void __init mac_init_scc_port(int cflag, int port)
270 #else
271 void mac_init_scc_port(int cflag, int port)
272 #endif
274 extern int mac_SCC_reset_done;
277 * baud rates: 1200, 1800, 2400, 4800, 9600, 19.2k, 38.4k, 57.6k, 115.2k
280 static int clksrc_table[9] =
281 /* reg 11: 0x50 = BRG, 0x00 = RTxC, 0x28 = TRxC */
282 { 0x50, 0x50, 0x50, 0x50, 0x50, 0x50, 0x50, 0x00, 0x00 };
283 static int clkmode_table[9] =
284 /* reg 4: 0x40 = x16, 0x80 = x32, 0xc0 = x64 */
285 { 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0xc0, 0x80 };
286 static int div_table[9] =
287 /* reg12 (BRG low) */
288 { 94, 62, 46, 22, 10, 4, 1, 0, 0 };
290 int baud = cflag & CBAUD;
291 int clksrc, clkmode, div, reg3, reg5;
293 if (cflag & CBAUDEX)
294 baud += B38400;
295 if (baud < B1200 || baud > B38400+2)
296 baud = B9600; /* use default 9600bps for non-implemented rates */
297 baud -= B1200; /* tables starts at 1200bps */
299 clksrc = clksrc_table[baud];
300 clkmode = clkmode_table[baud];
301 div = div_table[baud];
303 reg3 = (((cflag & CSIZE) == CS8) ? 0xc0 : 0x40);
304 reg5 = (((cflag & CSIZE) == CS8) ? 0x60 : 0x20) | 0x82 /* assert DTR/RTS */;
306 if (port == 1) {
307 (void)scc.cha_b_ctrl; /* reset reg pointer */
308 SCCB_WRITE(9, 0xc0); /* reset */
309 LONG_DELAY(); /* extra delay after WR9 access */
310 SCCB_WRITE(4, (cflag & PARENB) ? ((cflag & PARODD) ? 0x01 : 0x03) : 0 |
311 0x04 /* 1 stopbit */ |
312 clkmode);
313 SCCB_WRITE(3, reg3);
314 SCCB_WRITE(5, reg5);
315 SCCB_WRITE(9, 0); /* no interrupts */
316 LONG_DELAY(); /* extra delay after WR9 access */
317 SCCB_WRITE(10, 0); /* NRZ mode */
318 SCCB_WRITE(11, clksrc); /* main clock source */
319 SCCB_WRITE(12, div); /* BRG value */
320 SCCB_WRITE(13, 0); /* BRG high byte */
321 SCCB_WRITE(14, 1);
322 SCCB_WRITE(3, reg3 | 1);
323 SCCB_WRITE(5, reg5 | 8);
324 } else if (port == 0) {
325 (void)scc.cha_a_ctrl; /* reset reg pointer */
326 SCCA_WRITE(9, 0xc0); /* reset */
327 LONG_DELAY(); /* extra delay after WR9 access */
328 SCCA_WRITE(4, (cflag & PARENB) ? ((cflag & PARODD) ? 0x01 : 0x03) : 0 |
329 0x04 /* 1 stopbit */ |
330 clkmode);
331 SCCA_WRITE(3, reg3);
332 SCCA_WRITE(5, reg5);
333 SCCA_WRITE(9, 0); /* no interrupts */
334 LONG_DELAY(); /* extra delay after WR9 access */
335 SCCA_WRITE(10, 0); /* NRZ mode */
336 SCCA_WRITE(11, clksrc); /* main clock source */
337 SCCA_WRITE(12, div); /* BRG value */
338 SCCA_WRITE(13, 0); /* BRG high byte */
339 SCCA_WRITE(14, 1);
340 SCCA_WRITE(3, reg3 | 1);
341 SCCA_WRITE(5, reg5 | 8);
344 mac_SCC_reset_done = 1;
345 mac_SCC_init_done = 1;
347 #endif /* DEBUG_SERIAL */
349 void mac_init_scca_port(int cflag)
351 mac_init_scc_port(cflag, 0);
354 void mac_init_sccb_port(int cflag)
356 mac_init_scc_port(cflag, 1);
359 static int __init mac_debug_setup(char *arg)
361 if (!MACH_IS_MAC)
362 return 0;
364 #ifdef DEBUG_SERIAL
365 if (!strcmp(arg, "ser") || !strcmp(arg, "ser1")) {
366 /* Mac modem port */
367 mac_init_scc_port(B9600|CS8, 0);
368 mac_console_driver.write = mac_scca_console_write;
369 scc_port = 0;
370 } else if (!strcmp(arg, "ser2")) {
371 /* Mac printer port */
372 mac_init_scc_port(B9600|CS8, 1);
373 mac_console_driver.write = mac_sccb_console_write;
374 scc_port = 1;
376 #endif
377 #ifdef DEBUG_HEADS
378 if (!strcmp(arg, "scn") || !strcmp(arg, "con")) {
379 /* display, using head.S console routines */
380 mac_console_driver.write = mac_debug_console_write;
382 #endif
383 if (mac_console_driver.write)
384 register_console(&mac_console_driver);
385 return 0;
388 early_param("debug", mac_debug_setup);