[PATCH] m68k: indent sys_ptrace
[linux-2.6.git] / arch / m68k / atari / debug.c
1 /*
2  * linux/arch/m68k/atari/debug.c
3  *
4  * Atari debugging and serial console stuff
5  *
6  * Assembled of parts of former atari/config.c 97-12-18 by Roman Hodek
7  *
8  * This file is subject to the terms and conditions of the GNU General Public
9  * License.  See the file COPYING in the main directory of this archive
10  * for more details.
11  */
12
13 #include <linux/config.h>
14 #include <linux/types.h>
15 #include <linux/tty.h>
16 #include <linux/console.h>
17 #include <linux/init.h>
18 #include <linux/delay.h>
19
20 #include <asm/atarihw.h>
21 #include <asm/atariints.h>
22
23 extern char m68k_debug_device[];
24
25 /* Flag that Modem1 port is already initialized and used */
26 int atari_MFP_init_done;
27 /* Flag that Modem1 port is already initialized and used */
28 int atari_SCC_init_done;
29 /* Can be set somewhere, if a SCC master reset has already be done and should
30  * not be repeated; used by kgdb */
31 int atari_SCC_reset_done;
32
33 static struct console atari_console_driver = {
34         .name =         "debug",
35         .flags =        CON_PRINTBUFFER,
36         .index =        -1,
37 };
38
39
40 static inline void ata_mfp_out (char c)
41 {
42     while (!(mfp.trn_stat & 0x80)) /* wait for tx buf empty */
43         barrier ();
44     mfp.usart_dta = c;
45 }
46
47 void atari_mfp_console_write (struct console *co, const char *str,
48                               unsigned int count)
49 {
50     while (count--) {
51         if (*str == '\n')
52             ata_mfp_out( '\r' );
53         ata_mfp_out( *str++ );
54     }
55 }
56
57 static inline void ata_scc_out (char c)
58 {
59     do {
60         MFPDELAY();
61     } while (!(scc.cha_b_ctrl & 0x04)); /* wait for tx buf empty */
62     MFPDELAY();
63     scc.cha_b_data = c;
64 }
65
66 void atari_scc_console_write (struct console *co, const char *str,
67                               unsigned int count)
68 {
69     while (count--) {
70         if (*str == '\n')
71             ata_scc_out( '\r' );
72         ata_scc_out( *str++ );
73     }
74 }
75
76 static inline void ata_midi_out (char c)
77 {
78     while (!(acia.mid_ctrl & ACIA_TDRE)) /* wait for tx buf empty */
79         barrier ();
80     acia.mid_data = c;
81 }
82
83 void atari_midi_console_write (struct console *co, const char *str,
84                                unsigned int count)
85 {
86     while (count--) {
87         if (*str == '\n')
88             ata_midi_out( '\r' );
89         ata_midi_out( *str++ );
90     }
91 }
92
93 static int ata_par_out (char c)
94 {
95     unsigned char tmp;
96     /* This a some-seconds timeout in case no printer is connected */
97     unsigned long i = loops_per_jiffy > 1 ? loops_per_jiffy : 10000000/HZ;
98
99     while( (mfp.par_dt_reg & 1) && --i ) /* wait for BUSY == L */
100         ;
101     if (!i) return( 0 );
102
103     sound_ym.rd_data_reg_sel = 15;  /* select port B */
104     sound_ym.wd_data = c;           /* put char onto port */
105     sound_ym.rd_data_reg_sel = 14;  /* select port A */
106     tmp = sound_ym.rd_data_reg_sel;
107     sound_ym.wd_data = tmp & ~0x20; /* set strobe L */
108     MFPDELAY();                     /* wait a bit */
109     sound_ym.wd_data = tmp | 0x20;  /* set strobe H */
110     return( 1 );
111 }
112
113 static void atari_par_console_write (struct console *co, const char *str,
114                                      unsigned int count)
115 {
116     static int printer_present = 1;
117
118     if (!printer_present)
119         return;
120
121     while (count--) {
122         if (*str == '\n')
123             if (!ata_par_out( '\r' )) {
124                 printer_present = 0;
125                 return;
126             }
127         if (!ata_par_out( *str++ )) {
128             printer_present = 0;
129             return;
130         }
131     }
132 }
133
134 #ifdef CONFIG_SERIAL_CONSOLE
135 int atari_mfp_console_wait_key(struct console *co)
136 {
137     while( !(mfp.rcv_stat & 0x80) ) /* wait for rx buf filled */
138         barrier();
139     return( mfp.usart_dta );
140 }
141
142 int atari_scc_console_wait_key(struct console *co)
143 {
144     do {
145         MFPDELAY();
146     } while( !(scc.cha_b_ctrl & 0x01) ); /* wait for rx buf filled */
147     MFPDELAY();
148     return( scc.cha_b_data );
149 }
150
151 int atari_midi_console_wait_key(struct console *co)
152 {
153     while( !(acia.mid_ctrl & ACIA_RDRF) ) /* wait for rx buf filled */
154         barrier();
155     return( acia.mid_data );
156 }
157 #endif
158
159 /* The following two functions do a quick'n'dirty initialization of the MFP or
160  * SCC serial ports. They're used by the debugging interface, kgdb, and the
161  * serial console code. */
162 #ifndef CONFIG_SERIAL_CONSOLE
163 static void __init atari_init_mfp_port( int cflag )
164 #else
165 void atari_init_mfp_port( int cflag )
166 #endif
167 {
168     /* timer values for 1200...115200 bps; > 38400 select 110, 134, or 150
169      * bps, resp., and work only correct if there's a RSVE or RSSPEED */
170     static int baud_table[9] = { 16, 11, 8, 4, 2, 1, 175, 143, 128 };
171     int baud = cflag & CBAUD;
172     int parity = (cflag & PARENB) ? ((cflag & PARODD) ? 0x04 : 0x06) : 0;
173     int csize = ((cflag & CSIZE) == CS7) ? 0x20 : 0x00;
174
175     if (cflag & CBAUDEX)
176         baud += B38400;
177     if (baud < B1200 || baud > B38400+2)
178         baud = B9600; /* use default 9600bps for non-implemented rates */
179     baud -= B1200; /* baud_table[] starts at 1200bps */
180
181     mfp.trn_stat &= ~0x01; /* disable TX */
182     mfp.usart_ctr = parity | csize | 0x88; /* 1:16 clk mode, 1 stop bit */
183     mfp.tim_ct_cd &= 0x70;  /* stop timer D */
184     mfp.tim_dt_d = baud_table[baud];
185     mfp.tim_ct_cd |= 0x01;  /* start timer D, 1:4 */
186     mfp.trn_stat |= 0x01;  /* enable TX */
187
188     atari_MFP_init_done = 1;
189 }
190
191 #define SCC_WRITE(reg,val)                              \
192     do {                                                \
193         scc.cha_b_ctrl = (reg);                         \
194         MFPDELAY();                                     \
195         scc.cha_b_ctrl = (val);                         \
196         MFPDELAY();                                     \
197     } while(0)
198
199 /* loops_per_jiffy isn't initialized yet, so we can't use udelay(). This does a
200  * delay of ~ 60us. */
201 #define LONG_DELAY()                            \
202     do {                                        \
203         int i;                                  \
204         for( i = 100; i > 0; --i )              \
205             MFPDELAY();                         \
206     } while(0)
207
208 #ifndef CONFIG_SERIAL_CONSOLE
209 static void __init atari_init_scc_port( int cflag )
210 #else
211 void atari_init_scc_port( int cflag )
212 #endif
213 {
214     extern int atari_SCC_reset_done;
215     static int clksrc_table[9] =
216         /* reg 11: 0x50 = BRG, 0x00 = RTxC, 0x28 = TRxC */
217         { 0x50, 0x50, 0x50, 0x50, 0x50, 0x50, 0x50, 0x00, 0x00 };
218     static int brgsrc_table[9] =
219         /* reg 14: 0 = RTxC, 2 = PCLK */
220         { 2, 2, 2, 2, 2, 2, 0, 2, 2 };
221     static int clkmode_table[9] =
222         /* reg 4: 0x40 = x16, 0x80 = x32, 0xc0 = x64 */
223         { 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0xc0, 0x80 };
224     static int div_table[9] =
225         /* reg12 (BRG low) */
226         { 208, 138, 103, 50, 24, 11, 1, 0, 0 };
227
228     int baud = cflag & CBAUD;
229     int clksrc, clkmode, div, reg3, reg5;
230
231     if (cflag & CBAUDEX)
232         baud += B38400;
233     if (baud < B1200 || baud > B38400+2)
234         baud = B9600; /* use default 9600bps for non-implemented rates */
235     baud -= B1200; /* tables starts at 1200bps */
236
237     clksrc  = clksrc_table[baud];
238     clkmode = clkmode_table[baud];
239     div     = div_table[baud];
240     if (ATARIHW_PRESENT(TT_MFP) && baud >= 6) {
241         /* special treatment for TT, where rates >= 38400 are done via TRxC */
242         clksrc = 0x28; /* TRxC */
243         clkmode = baud == 6 ? 0xc0 :
244                   baud == 7 ? 0x80 : /* really 76800bps */
245                               0x40;  /* really 153600bps */
246         div = 0;
247     }
248
249     reg3 = (cflag & CSIZE) == CS8 ? 0xc0 : 0x40;
250     reg5 = (cflag & CSIZE) == CS8 ? 0x60 : 0x20 | 0x82 /* assert DTR/RTS */;
251
252     (void)scc.cha_b_ctrl;       /* reset reg pointer */
253     SCC_WRITE( 9, 0xc0 );       /* reset */
254     LONG_DELAY();               /* extra delay after WR9 access */
255     SCC_WRITE( 4, (cflag & PARENB) ? ((cflag & PARODD) ? 0x01 : 0x03) : 0 |
256                   0x04 /* 1 stopbit */ |
257                   clkmode );
258     SCC_WRITE( 3, reg3 );
259     SCC_WRITE( 5, reg5 );
260     SCC_WRITE( 9, 0 );          /* no interrupts */
261     LONG_DELAY();               /* extra delay after WR9 access */
262     SCC_WRITE( 10, 0 );         /* NRZ mode */
263     SCC_WRITE( 11, clksrc );    /* main clock source */
264     SCC_WRITE( 12, div );       /* BRG value */
265     SCC_WRITE( 13, 0 );         /* BRG high byte */
266     SCC_WRITE( 14, brgsrc_table[baud] );
267     SCC_WRITE( 14, brgsrc_table[baud] | (div ? 1 : 0) );
268     SCC_WRITE( 3, reg3 | 1 );
269     SCC_WRITE( 5, reg5 | 8 );
270
271     atari_SCC_reset_done = 1;
272     atari_SCC_init_done = 1;
273 }
274
275 #ifndef CONFIG_SERIAL_CONSOLE
276 static void __init atari_init_midi_port( int cflag )
277 #else
278 void atari_init_midi_port( int cflag )
279 #endif
280 {
281     int baud = cflag & CBAUD;
282     int csize = ((cflag & CSIZE) == CS8) ? 0x10 : 0x00;
283     /* warning 7N1 isn't possible! (instead 7O2 is used...) */
284     int parity = (cflag & PARENB) ? ((cflag & PARODD) ? 0x0c : 0x08) : 0x04;
285     int div;
286
287     /* 4800 selects 7812.5, 115200 selects 500000, all other (incl. 9600 as
288      * default) the standard MIDI speed 31250. */
289     if (cflag & CBAUDEX)
290         baud += B38400;
291     if (baud == B4800)
292         div = ACIA_DIV64; /* really 7812.5 bps */
293     else if (baud == B38400+2 /* 115200 */)
294         div = ACIA_DIV1; /* really 500 kbps (does that work??) */
295     else
296         div = ACIA_DIV16; /* 31250 bps, standard for MIDI */
297
298     /* RTS low, ints disabled */
299     acia.mid_ctrl = div | csize | parity |
300                     ((atari_switches & ATARI_SWITCH_MIDI) ?
301                      ACIA_RHTID : ACIA_RLTID);
302 }
303
304 void __init atari_debug_init(void)
305 {
306     if (!strcmp( m68k_debug_device, "ser" )) {
307         /* defaults to ser2 for a Falcon and ser1 otherwise */
308         strcpy( m68k_debug_device, MACH_IS_FALCON ? "ser2" : "ser1" );
309
310     }
311
312     if (!strcmp( m68k_debug_device, "ser1" )) {
313         /* ST-MFP Modem1 serial port */
314         atari_init_mfp_port( B9600|CS8 );
315         atari_console_driver.write = atari_mfp_console_write;
316     }
317     else if (!strcmp( m68k_debug_device, "ser2" )) {
318         /* SCC Modem2 serial port */
319         atari_init_scc_port( B9600|CS8 );
320         atari_console_driver.write = atari_scc_console_write;
321     }
322     else if (!strcmp( m68k_debug_device, "midi" )) {
323         /* MIDI port */
324         atari_init_midi_port( B9600|CS8 );
325         atari_console_driver.write = atari_midi_console_write;
326     }
327     else if (!strcmp( m68k_debug_device, "par" )) {
328         /* parallel printer */
329         atari_turnoff_irq( IRQ_MFP_BUSY ); /* avoid ints */
330         sound_ym.rd_data_reg_sel = 7;  /* select mixer control */
331         sound_ym.wd_data = 0xff;       /* sound off, ports are output */
332         sound_ym.rd_data_reg_sel = 15; /* select port B */
333         sound_ym.wd_data = 0;          /* no char */
334         sound_ym.rd_data_reg_sel = 14; /* select port A */
335         sound_ym.wd_data = sound_ym.rd_data_reg_sel | 0x20; /* strobe H */
336         atari_console_driver.write = atari_par_console_write;
337     }
338     if (atari_console_driver.write)
339         register_console(&atari_console_driver);
340 }
341
342 /*
343  * Local variables:
344  *  c-indent-level: 4
345  *  tab-width: 8
346  * End:
347  */