?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
[PATCH] md: remove some old ifdefed-out code from raid5.c
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / tc / zs.c
blobfc3197273663e93c48f975cded7c748727ad0370
1 /*
2 * decserial.c: Serial port driver for IOASIC DECstations.
3 *
4 * Derived from drivers/sbus/char/sunserial.c by Paul Mackerras.
5 * Derived from drivers/macintosh/macserial.c by Harald Koerfgen.
6 *
7 * DECstation changes
8 * Copyright (C) 1998-2000 Harald Koerfgen
9 * Copyright (C) 2000, 2001, 2002, 2003, 2004, 2005 Maciej W. Rozycki
10 *
11 * For the rest of the code the original Copyright applies:
12 * Copyright (C) 1996 Paul Mackerras (Paul.Mackerras@cs.anu.edu.au)
13 * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
14 *
15 *
16 * Note: for IOASIC systems the wiring is as follows:
17 *
18 * mouse/keyboard:
19 * DIN-7 MJ-4 signal SCC
20 * 2 1 TxD <- A.TxD
21 * 3 4 RxD -> A.RxD
22 *
23 * EIA-232/EIA-423:
24 * DB-25 MMJ-6 signal SCC
25 * 2 2 TxD <- B.TxD
26 * 3 5 RxD -> B.RxD
27 * 4 RTS <- ~A.RTS
28 * 5 CTS -> ~B.CTS
29 * 6 6 DSR -> ~A.SYNC
30 * 8 CD -> ~B.DCD
31 * 12 DSRS(DCE) -> ~A.CTS (*)
32 * 15 TxC -> B.TxC
33 * 17 RxC -> B.RxC
34 * 20 1 DTR <- ~A.DTR
35 * 22 RI -> ~A.DCD
36 * 23 DSRS(DTE) <- ~B.RTS
37 *
38 * (*) EIA-232 defines the signal at this pin to be SCD, while DSRS(DCE)
39 * is shared with DSRS(DTE) at pin 23.
40 */
41
42 #include <linux/errno.h>
43 #include <linux/signal.h>
44 #include <linux/sched.h>
45 #include <linux/timer.h>
46 #include <linux/interrupt.h>
47 #include <linux/tty.h>
48 #include <linux/tty_flip.h>
49 #include <linux/major.h>
50 #include <linux/string.h>
51 #include <linux/fcntl.h>
52 #include <linux/mm.h>
53 #include <linux/kernel.h>
54 #include <linux/delay.h>
55 #include <linux/init.h>
56 #include <linux/ioport.h>
57 #include <linux/spinlock.h>
58 #ifdef CONFIG_SERIAL_DEC_CONSOLE
59 #include <linux/console.h>
60 #endif
61
62 #include <asm/io.h>
63 #include <asm/pgtable.h>
64 #include <asm/irq.h>
65 #include <asm/system.h>
66 #include <asm/bootinfo.h>
67
68 #include <asm/dec/interrupts.h>
69 #include <asm/dec/ioasic_addrs.h>
70 #include <asm/dec/machtype.h>
71 #include <asm/dec/serial.h>
72 #include <asm/dec/system.h>
73 #include <asm/dec/tc.h>
74
75 #ifdef CONFIG_KGDB
76 #include <asm/kgdb.h>
77 #endif
78 #ifdef CONFIG_MAGIC_SYSRQ
79 #include <linux/sysrq.h>
80 #endif
81
82 #include "zs.h"
83
84 /*
85 * It would be nice to dynamically allocate everything that
86 * depends on NUM_SERIAL, so we could support any number of
87 * Z8530s, but for now...
88 */
89 #define NUM_SERIAL 2 /* Max number of ZS chips supported */
90 #define NUM_CHANNELS (NUM_SERIAL * 2) /* 2 channels per chip */
91 #define CHANNEL_A_NR (zs_parms->channel_a_offset > zs_parms->channel_b_offset)
92 /* Number of channel A in the chip */
93 #define ZS_CHAN_IO_SIZE 8
94 #define ZS_CLOCK 7372800 /* Z8530 RTxC input clock rate */
95
96 #define RECOVERY_DELAY udelay(2)
97
98 struct zs_parms {
99 unsigned long scc0;
100 unsigned long scc1;
101 int channel_a_offset;
102 int channel_b_offset;
103 int irq0;
104 int irq1;
105 int clock;
106 };
107
108 static struct zs_parms *zs_parms;
109
110 #ifdef CONFIG_MACH_DECSTATION
111 static struct zs_parms ds_parms = {
112 scc0 : IOASIC_SCC0,
113 scc1 : IOASIC_SCC1,
114 channel_a_offset : 1,
115 channel_b_offset : 9,
116 irq0 : -1,
117 irq1 : -1,
118 clock : ZS_CLOCK
119 };
120 #endif
121
122 #ifdef CONFIG_MACH_DECSTATION
123 #define DS_BUS_PRESENT (IOASIC)
124 #else
125 #define DS_BUS_PRESENT 0
126 #endif
127
128 #define BUS_PRESENT (DS_BUS_PRESENT)
129
130 DEFINE_SPINLOCK(zs_lock);
131
132 struct dec_zschannel zs_channels[NUM_CHANNELS];
133 struct dec_serial zs_soft[NUM_CHANNELS];
134 int zs_channels_found;
135 struct dec_serial *zs_chain; /* list of all channels */
136
137 struct tty_struct zs_ttys[NUM_CHANNELS];
138
139 #ifdef CONFIG_SERIAL_DEC_CONSOLE
140 static struct console sercons;
141 #endif
142 #if defined(CONFIG_SERIAL_DEC_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ) && \
143 !defined(MODULE)
144 static unsigned long break_pressed; /* break, really ... */
145 #endif
146
147 static unsigned char zs_init_regs[16] __initdata = {
148 0, /* write 0 */
149 0, /* write 1 */
150 0, /* write 2 */
151 0, /* write 3 */
152 (X16CLK), /* write 4 */
153 0, /* write 5 */
154 0, 0, 0, /* write 6, 7, 8 */
155 (MIE | DLC | NV), /* write 9 */
156 (NRZ), /* write 10 */
157 (TCBR | RCBR), /* write 11 */
158 0, 0, /* BRG time constant, write 12 + 13 */
159 (BRSRC | BRENABL), /* write 14 */
160 0 /* write 15 */
161 };
162
163 static struct tty_driver *serial_driver;
164
165 /* serial subtype definitions */
166 #define SERIAL_TYPE_NORMAL 1
167
168 /* number of characters left in xmit buffer before we ask for more */
169 #define WAKEUP_CHARS 256
170
171 /*
172 * Debugging.
173 */
174 #undef SERIAL_DEBUG_OPEN
175 #undef SERIAL_DEBUG_FLOW
176 #undef SERIAL_DEBUG_THROTTLE
177 #undef SERIAL_PARANOIA_CHECK
178
179 #undef ZS_DEBUG_REGS
180
181 #ifdef SERIAL_DEBUG_THROTTLE
182 #define _tty_name(tty,buf) tty_name(tty,buf)
183 #endif
184
185 #define RS_STROBE_TIME 10
186 #define RS_ISR_PASS_LIMIT 256
187
188 static void probe_sccs(void);
189 static void change_speed(struct dec_serial *info);
190 static void rs_wait_until_sent(struct tty_struct *tty, int timeout);
191
192 static inline int serial_paranoia_check(struct dec_serial *info,
193 char *name, const char *routine)
194 {
195 #ifdef SERIAL_PARANOIA_CHECK
196 static const char *badmagic =
197 "Warning: bad magic number for serial struct %s in %s\n";
198 static const char *badinfo =
199 "Warning: null mac_serial for %s in %s\n";
200
201 if (!info) {
202 printk(badinfo, name, routine);
203 return 1;
204 }
205 if (info->magic != SERIAL_MAGIC) {
206 printk(badmagic, name, routine);
207 return 1;
208 }
209 #endif
210 return 0;
211 }
212
213 /*
214 * This is used to figure out the divisor speeds and the timeouts
215 */
216 static int baud_table[] = {
217 0, 50, 75, 110, 134, 150, 200, 300, 600, 1200, 1800, 2400, 4800,
218 9600, 19200, 38400, 57600, 115200, 0 };
219
220 /*
221 * Reading and writing Z8530 registers.
222 */
223 static inline unsigned char read_zsreg(struct dec_zschannel *channel,
224 unsigned char reg)
225 {
226 unsigned char retval;
227
228 if (reg != 0) {
229 *channel->control = reg & 0xf;
230 fast_iob(); RECOVERY_DELAY;
231 }
232 retval = *channel->control;
233 RECOVERY_DELAY;
234 return retval;
235 }
236
237 static inline void write_zsreg(struct dec_zschannel *channel,
238 unsigned char reg, unsigned char value)
239 {
240 if (reg != 0) {
241 *channel->control = reg & 0xf;
242 fast_iob(); RECOVERY_DELAY;
243 }
244 *channel->control = value;
245 fast_iob(); RECOVERY_DELAY;
246 return;
247 }
248
249 static inline unsigned char read_zsdata(struct dec_zschannel *channel)
250 {
251 unsigned char retval;
252
253 retval = *channel->data;
254 RECOVERY_DELAY;
255 return retval;
256 }
257
258 static inline void write_zsdata(struct dec_zschannel *channel,
259 unsigned char value)
260 {
261 *channel->data = value;
262 fast_iob(); RECOVERY_DELAY;
263 return;
264 }
265
266 static inline void load_zsregs(struct dec_zschannel *channel,
267 unsigned char *regs)
268 {
269 /* ZS_CLEARERR(channel);
270 ZS_CLEARFIFO(channel); */
271 /* Load 'em up */
272 write_zsreg(channel, R3, regs[R3] & ~RxENABLE);
273 write_zsreg(channel, R5, regs[R5] & ~TxENAB);
274 write_zsreg(channel, R4, regs[R4]);
275 write_zsreg(channel, R9, regs[R9]);
276 write_zsreg(channel, R1, regs[R1]);
277 write_zsreg(channel, R2, regs[R2]);
278 write_zsreg(channel, R10, regs[R10]);
279 write_zsreg(channel, R11, regs[R11]);
280 write_zsreg(channel, R12, regs[R12]);
281 write_zsreg(channel, R13, regs[R13]);
282 write_zsreg(channel, R14, regs[R14]);
283 write_zsreg(channel, R15, regs[R15]);
284 write_zsreg(channel, R3, regs[R3]);
285 write_zsreg(channel, R5, regs[R5]);
286 return;
287 }
288
289 /* Sets or clears DTR/RTS on the requested line */
290 static inline void zs_rtsdtr(struct dec_serial *info, int which, int set)
291 {
292 unsigned long flags;
293
294 spin_lock_irqsave(&zs_lock, flags);
295 if (info->zs_channel != info->zs_chan_a) {
296 if (set) {
297 info->zs_chan_a->curregs[5] |= (which & (RTS | DTR));
298 } else {
299 info->zs_chan_a->curregs[5] &= ~(which & (RTS | DTR));
300 }
301 write_zsreg(info->zs_chan_a, 5, info->zs_chan_a->curregs[5]);
302 }
303 spin_unlock_irqrestore(&zs_lock, flags);
304 }
305
306 /* Utility routines for the Zilog */
307 static inline int get_zsbaud(struct dec_serial *ss)
308 {
309 struct dec_zschannel *channel = ss->zs_channel;
310 int brg;
311
312 /* The baud rate is split up between two 8-bit registers in
313 * what is termed 'BRG time constant' format in my docs for
314 * the chip, it is a function of the clk rate the chip is
315 * receiving which happens to be constant.
316 */
317 brg = (read_zsreg(channel, 13) << 8);
318 brg |= read_zsreg(channel, 12);
319 return BRG_TO_BPS(brg, (zs_parms->clock/(ss->clk_divisor)));
320 }
321
322 /* On receive, this clears errors and the receiver interrupts */
323 static inline void rs_recv_clear(struct dec_zschannel *zsc)
324 {
325 write_zsreg(zsc, 0, ERR_RES);
326 write_zsreg(zsc, 0, RES_H_IUS); /* XXX this is unnecessary */
327 }
328
329 /*
330 * ----------------------------------------------------------------------
331 *
332 * Here starts the interrupt handling routines. All of the following
333 * subroutines are declared as inline and are folded into
334 * rs_interrupt(). They were separated out for readability's sake.
335 *
336 * - Ted Ts'o (tytso@mit.edu), 7-Mar-93
337 * -----------------------------------------------------------------------
338 */
339
340 /*
341 * This routine is used by the interrupt handler to schedule
342 * processing in the software interrupt portion of the driver.
343 */
344 static void rs_sched_event(struct dec_serial *info, int event)
345 {
346 info->event |= 1 << event;
347 tasklet_schedule(&info->tlet);
348 }
349
350 static void receive_chars(struct dec_serial *info)
351 {
352 struct tty_struct *tty = info->tty;
353 unsigned char ch, stat, flag;
354
355 while ((read_zsreg(info->zs_channel, R0) & Rx_CH_AV) != 0) {
356
357 stat = read_zsreg(info->zs_channel, R1);
358 ch = read_zsdata(info->zs_channel);
359
360 if (!tty && (!info->hook || !info->hook->rx_char))
361 continue;
362
363 flag = TTY_NORMAL;
364 if (info->tty_break) {
365 info->tty_break = 0;
366 flag = TTY_BREAK;
367 if (info->flags & ZILOG_SAK)
368 do_SAK(tty);
369 /* Ignore the null char got when BREAK is removed. */
370 if (ch == 0)
371 continue;
372 } else {
373 if (stat & Rx_OVR) {
374 flag = TTY_OVERRUN;
375 } else if (stat & FRM_ERR) {
376 flag = TTY_FRAME;
377 } else if (stat & PAR_ERR) {
378 flag = TTY_PARITY;
379 }
380 if (flag != TTY_NORMAL)
381 /* reset the error indication */
382 write_zsreg(info->zs_channel, R0, ERR_RES);
383 }
384
385 #if defined(CONFIG_SERIAL_DEC_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ) && \
386 !defined(MODULE)
387 if (break_pressed && info->line == sercons.index) {
388 /* Ignore the null char got when BREAK is removed. */
389 if (ch == 0)
390 continue;
391 if (time_before(jiffies, break_pressed + HZ * 5)) {
392 handle_sysrq(ch, NULL);
393 break_pressed = 0;
394 continue;
395 }
396 break_pressed = 0;
397 }
398 #endif
399
400 if (info->hook && info->hook->rx_char) {
401 (*info->hook->rx_char)(ch, flag);
402 return;
403 }
404
405 tty_insert_flip_char(tty, ch, flag);
406 }
407 if (tty)
408 tty_flip_buffer_push(tty);
409 }
410
411 static void transmit_chars(struct dec_serial *info)
412 {
413 if ((read_zsreg(info->zs_channel, R0) & Tx_BUF_EMP) == 0)
414 return;
415 info->tx_active = 0;
416
417 if (info->x_char) {
418 /* Send next char */
419 write_zsdata(info->zs_channel, info->x_char);
420 info->x_char = 0;
421 info->tx_active = 1;
422 return;
423 }
424
425 if ((info->xmit_cnt <= 0) || (info->tty && info->tty->stopped)
426 || info->tx_stopped) {
427 write_zsreg(info->zs_channel, R0, RES_Tx_P);
428 return;
429 }
430 /* Send char */
431 write_zsdata(info->zs_channel, info->xmit_buf[info->xmit_tail++]);
432 info->xmit_tail = info->xmit_tail & (SERIAL_XMIT_SIZE-1);
433 info->xmit_cnt--;
434 info->tx_active = 1;
435
436 if (info->xmit_cnt < WAKEUP_CHARS)
437 rs_sched_event(info, RS_EVENT_WRITE_WAKEUP);
438 }
439
440 static void status_handle(struct dec_serial *info)
441 {
442 unsigned char stat;
443
444 /* Get status from Read Register 0 */
445 stat = read_zsreg(info->zs_channel, R0);
446
447 if ((stat & BRK_ABRT) && !(info->read_reg_zero & BRK_ABRT)) {
448 #if defined(CONFIG_SERIAL_DEC_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ) && \
449 !defined(MODULE)
450 if (info->line == sercons.index) {
451 if (!break_pressed)
452 break_pressed = jiffies;
453 } else
454 #endif
455 info->tty_break = 1;
456 }
457
458 if (info->zs_channel != info->zs_chan_a) {
459
460 /* Check for DCD transitions */
461 if (info->tty && !C_CLOCAL(info->tty) &&
462 ((stat ^ info->read_reg_zero) & DCD) != 0 ) {
463 if (stat & DCD) {
464 wake_up_interruptible(&info->open_wait);
465 } else {
466 tty_hangup(info->tty);
467 }
468 }
469
470 /* Check for CTS transitions */
471 if (info->tty && C_CRTSCTS(info->tty)) {
472 if ((stat & CTS) != 0) {
473 if (info->tx_stopped) {
474 info->tx_stopped = 0;
475 if (!info->tx_active)
476 transmit_chars(info);
477 }
478 } else {
479 info->tx_stopped = 1;
480 }
481 }
482
483 }
484
485 /* Clear status condition... */
486 write_zsreg(info->zs_channel, R0, RES_EXT_INT);
487 info->read_reg_zero = stat;
488 }
489
490 /*
491 * This is the serial driver's generic interrupt routine
492 */
493 static irqreturn_t rs_interrupt(int irq, void *dev_id)
494 {
495 struct dec_serial *info = (struct dec_serial *) dev_id;
496 irqreturn_t status = IRQ_NONE;
497 unsigned char zs_intreg;
498 int shift;
499
500 /* NOTE: The read register 3, which holds the irq status,
501 * does so for both channels on each chip. Although
502 * the status value itself must be read from the A
503 * channel and is only valid when read from channel A.
504 * Yes... broken hardware...
505 */
506 #define CHAN_IRQMASK (CHBRxIP | CHBTxIP | CHBEXT)
507
508 if (info->zs_chan_a == info->zs_channel)
509 shift = 3; /* Channel A */
510 else
511 shift = 0; /* Channel B */
512
513 for (;;) {
514 zs_intreg = read_zsreg(info->zs_chan_a, R3) >> shift;
515 if ((zs_intreg & CHAN_IRQMASK) == 0)
516 break;
517
518 status = IRQ_HANDLED;
519
520 if (zs_intreg & CHBRxIP) {
521 receive_chars(info);
522 }
523 if (zs_intreg & CHBTxIP) {
524 transmit_chars(info);
525 }
526 if (zs_intreg & CHBEXT) {
527 status_handle(info);
528 }
529 }
530
531 /* Why do we need this ? */
532 write_zsreg(info->zs_channel, 0, RES_H_IUS);
533
534 return status;
535 }
536
537 #ifdef ZS_DEBUG_REGS
538 void zs_dump (void) {
539 int i, j;
540 for (i = 0; i < zs_channels_found; i++) {
541 struct dec_zschannel *ch = &zs_channels[i];
542 if ((long)ch->control == UNI_IO_BASE+UNI_SCC1A_CTRL) {
543 for (j = 0; j < 15; j++) {
544 printk("W%d = 0x%x\t",
545 j, (int)ch->curregs[j]);
546 }
547 for (j = 0; j < 15; j++) {
548 printk("R%d = 0x%x\t",
549 j, (int)read_zsreg(ch,j));
550 }
551 printk("\n\n");
552 }
553 }
554 }
555 #endif
556
557 /*
558 * -------------------------------------------------------------------
559 * Here ends the serial interrupt routines.
560 * -------------------------------------------------------------------
561 */
562
563 /*
564 * ------------------------------------------------------------
565 * rs_stop() and rs_start()
566 *
567 * This routines are called before setting or resetting tty->stopped.
568 * ------------------------------------------------------------
569 */
570 static void rs_stop(struct tty_struct *tty)
571 {
572 struct dec_serial *info = (struct dec_serial *)tty->driver_data;
573 unsigned long flags;
574
575 if (serial_paranoia_check(info, tty->name, "rs_stop"))
576 return;
577
578 #if 1
579 spin_lock_irqsave(&zs_lock, flags);
580 if (info->zs_channel->curregs[5] & TxENAB) {
581 info->zs_channel->curregs[5] &= ~TxENAB;
582 write_zsreg(info->zs_channel, 5, info->zs_channel->curregs[5]);
583 }
584 spin_unlock_irqrestore(&zs_lock, flags);
585 #endif
586 }
587
588 static void rs_start(struct tty_struct *tty)
589 {
590 struct dec_serial *info = (struct dec_serial *)tty->driver_data;
591 unsigned long flags;
592
593 if (serial_paranoia_check(info, tty->name, "rs_start"))
594 return;
595
596 spin_lock_irqsave(&zs_lock, flags);
597 #if 1
598 if (info->xmit_cnt && info->xmit_buf && !(info->zs_channel->curregs[5] & TxENAB)) {
599 info->zs_channel->curregs[5] |= TxENAB;
600 write_zsreg(info->zs_channel, 5, info->zs_channel->curregs[5]);
601 }
602 #else
603 if (info->xmit_cnt && info->xmit_buf && !info->tx_active) {
604 transmit_chars(info);
605 }
606 #endif
607 spin_unlock_irqrestore(&zs_lock, flags);
608 }
609
610 /*
611 * This routine is used to handle the "bottom half" processing for the
612 * serial driver, known also the "software interrupt" processing.
613 * This processing is done at the kernel interrupt level, after the
614 * rs_interrupt() has returned, BUT WITH INTERRUPTS TURNED ON. This
615 * is where time-consuming activities which can not be done in the
616 * interrupt driver proper are done; the interrupt driver schedules
617 * them using rs_sched_event(), and they get done here.
618 */
619
620 static void do_softint(unsigned long private_)
621 {
622 struct dec_serial *info = (struct dec_serial *) private_;
623 struct tty_struct *tty;
624
625 tty = info->tty;
626 if (!tty)
627 return;
628
629 if (test_and_clear_bit(RS_EVENT_WRITE_WAKEUP, &info->event)) {
630 tty_wakeup(tty);
631 wake_up_interruptible(&tty->write_wait);
632 }
633 }
634
635 static int zs_startup(struct dec_serial * info)
636 {
637 unsigned long flags;
638
639 if (info->flags & ZILOG_INITIALIZED)
640 return 0;
641
642 if (!info->xmit_buf) {
643 info->xmit_buf = (unsigned char *) get_zeroed_page(GFP_KERNEL);
644 if (!info->xmit_buf)
645 return -ENOMEM;
646 }
647
648 spin_lock_irqsave(&zs_lock, flags);
649
650 #ifdef SERIAL_DEBUG_OPEN
651 printk("starting up ttyS%d (irq %d)...", info->line, info->irq);
652 #endif
653
654 /*
655 * Clear the receive FIFO.
656 */
657 ZS_CLEARFIFO(info->zs_channel);
658 info->xmit_fifo_size = 1;
659
660 /*
661 * Clear the interrupt registers.
662 */
663 write_zsreg(info->zs_channel, R0, ERR_RES);
664 write_zsreg(info->zs_channel, R0, RES_H_IUS);
665
666 /*
667 * Set the speed of the serial port
668 */
669 change_speed(info);
670
671 /*
672 * Turn on RTS and DTR.
673 */
674 zs_rtsdtr(info, RTS | DTR, 1);
675
676 /*
677 * Finally, enable sequencing and interrupts
678 */
679 info->zs_channel->curregs[R1] &= ~RxINT_MASK;
680 info->zs_channel->curregs[R1] |= (RxINT_ALL | TxINT_ENAB |
681 EXT_INT_ENAB);
682 info->zs_channel->curregs[R3] |= RxENABLE;
683 info->zs_channel->curregs[R5] |= TxENAB;
684 info->zs_channel->curregs[R15] |= (DCDIE | CTSIE | TxUIE | BRKIE);
685 write_zsreg(info->zs_channel, R1, info->zs_channel->curregs[R1]);
686 write_zsreg(info->zs_channel, R3, info->zs_channel->curregs[R3]);
687 write_zsreg(info->zs_channel, R5, info->zs_channel->curregs[R5]);
688 write_zsreg(info->zs_channel, R15, info->zs_channel->curregs[R15]);
689
690 /*
691 * And clear the interrupt registers again for luck.
692 */
693 write_zsreg(info->zs_channel, R0, ERR_RES);
694 write_zsreg(info->zs_channel, R0, RES_H_IUS);
695
696 /* Save the current value of RR0 */
697 info->read_reg_zero = read_zsreg(info->zs_channel, R0);
698
699 if (info->tty)
700 clear_bit(TTY_IO_ERROR, &info->tty->flags);
701 info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;
702
703 info->flags |= ZILOG_INITIALIZED;
704 spin_unlock_irqrestore(&zs_lock, flags);
705 return 0;
706 }
707
708 /*
709 * This routine will shutdown a serial port; interrupts are disabled, and
710 * DTR is dropped if the hangup on close termio flag is on.
711 */
712 static void shutdown(struct dec_serial * info)
713 {
714 unsigned long flags;
715
716 if (!(info->flags & ZILOG_INITIALIZED))
717 return;
718
719 #ifdef SERIAL_DEBUG_OPEN
720 printk("Shutting down serial port %d (irq %d)....", info->line,
721 info->irq);
722 #endif
723
724 spin_lock_irqsave(&zs_lock, flags);
725
726 if (info->xmit_buf) {
727 free_page((unsigned long) info->xmit_buf);
728 info->xmit_buf = 0;
729 }
730
731 info->zs_channel->curregs[1] = 0;
732 write_zsreg(info->zs_channel, 1, info->zs_channel->curregs[1]); /* no interrupts */
733
734 info->zs_channel->curregs[3] &= ~RxENABLE;
735 write_zsreg(info->zs_channel, 3, info->zs_channel->curregs[3]);
736
737 info->zs_channel->curregs[5] &= ~TxENAB;
738 write_zsreg(info->zs_channel, 5, info->zs_channel->curregs[5]);
739 if (!info->tty || C_HUPCL(info->tty)) {
740 zs_rtsdtr(info, RTS | DTR, 0);
741 }
742
743 if (info->tty)
744 set_bit(TTY_IO_ERROR, &info->tty->flags);
745
746 info->flags &= ~ZILOG_INITIALIZED;
747 spin_unlock_irqrestore(&zs_lock, flags);
748 }
749
750 /*
751 * This routine is called to set the UART divisor registers to match
752 * the specified baud rate for a serial port.
753 */
754 static void change_speed(struct dec_serial *info)
755 {
756 unsigned cflag;
757 int i;
758 int brg, bits;
759 unsigned long flags;
760
761 if (!info->hook) {
762 if (!info->tty || !info->tty->termios)
763 return;
764 cflag = info->tty->termios->c_cflag;
765 if (!info->port)
766 return;
767 } else {
768 cflag = info->hook->cflags;
769 }
770
771 i = cflag & CBAUD;
772 if (i & CBAUDEX) {
773 i &= ~CBAUDEX;
774 if (i < 1 || i > 2) {
775 if (!info->hook)
776 info->tty->termios->c_cflag &= ~CBAUDEX;
777 else
778 info->hook->cflags &= ~CBAUDEX;
779 } else
780 i += 15;
781 }
782
783 spin_lock_irqsave(&zs_lock, flags);
784 info->zs_baud = baud_table[i];
785 if (info->zs_baud) {
786 brg = BPS_TO_BRG(info->zs_baud, zs_parms->clock/info->clk_divisor);
787 info->zs_channel->curregs[12] = (brg & 255);
788 info->zs_channel->curregs[13] = ((brg >> 8) & 255);
789 zs_rtsdtr(info, DTR, 1);
790 } else {
791 zs_rtsdtr(info, RTS | DTR, 0);
792 return;
793 }
794
795 /* byte size and parity */
796 info->zs_channel->curregs[3] &= ~RxNBITS_MASK;
797 info->zs_channel->curregs[5] &= ~TxNBITS_MASK;
798 switch (cflag & CSIZE) {
799 case CS5:
800 bits = 7;
801 info->zs_channel->curregs[3] |= Rx5;
802 info->zs_channel->curregs[5] |= Tx5;
803 break;
804 case CS6:
805 bits = 8;
806 info->zs_channel->curregs[3] |= Rx6;
807 info->zs_channel->curregs[5] |= Tx6;
808 break;
809 case CS7:
810 bits = 9;
811 info->zs_channel->curregs[3] |= Rx7;
812 info->zs_channel->curregs[5] |= Tx7;
813 break;
814 case CS8:
815 default: /* defaults to 8 bits */
816 bits = 10;
817 info->zs_channel->curregs[3] |= Rx8;
818 info->zs_channel->curregs[5] |= Tx8;
819 break;
820 }
821
822 info->timeout = ((info->xmit_fifo_size*HZ*bits) / info->zs_baud);
823 info->timeout += HZ/50; /* Add .02 seconds of slop */
824
825 info->zs_channel->curregs[4] &= ~(SB_MASK | PAR_ENA | PAR_EVEN);
826 if (cflag & CSTOPB) {
827 info->zs_channel->curregs[4] |= SB2;
828 } else {
829 info->zs_channel->curregs[4] |= SB1;
830 }
831 if (cflag & PARENB) {
832 info->zs_channel->curregs[4] |= PAR_ENA;
833 }
834 if (!(cflag & PARODD)) {
835 info->zs_channel->curregs[4] |= PAR_EVEN;
836 }
837
838 if (!(cflag & CLOCAL)) {
839 if (!(info->zs_channel->curregs[15] & DCDIE))
840 info->read_reg_zero = read_zsreg(info->zs_channel, 0);
841 info->zs_channel->curregs[15] |= DCDIE;
842 } else
843 info->zs_channel->curregs[15] &= ~DCDIE;
844 if (cflag & CRTSCTS) {
845 info->zs_channel->curregs[15] |= CTSIE;
846 if ((read_zsreg(info->zs_channel, 0) & CTS) == 0)
847 info->tx_stopped = 1;
848 } else {
849 info->zs_channel->curregs[15] &= ~CTSIE;
850 info->tx_stopped = 0;
851 }
852
853 /* Load up the new values */
854 load_zsregs(info->zs_channel, info->zs_channel->curregs);
855
856 spin_unlock_irqrestore(&zs_lock, flags);
857 }
858
859 static void rs_flush_chars(struct tty_struct *tty)
860 {
861 struct dec_serial *info = (struct dec_serial *)tty->driver_data;
862 unsigned long flags;
863
864 if (serial_paranoia_check(info, tty->name, "rs_flush_chars"))
865 return;
866
867 if (info->xmit_cnt <= 0 || tty->stopped || info->tx_stopped ||
868 !info->xmit_buf)
869 return;
870
871 /* Enable transmitter */
872 spin_lock_irqsave(&zs_lock, flags);
873 transmit_chars(info);
874 spin_unlock_irqrestore(&zs_lock, flags);
875 }
876
877 static int rs_write(struct tty_struct * tty,
878 const unsigned char *buf, int count)
879 {
880 int c, total = 0;
881 struct dec_serial *info = (struct dec_serial *)tty->driver_data;
882 unsigned long flags;
883
884 if (serial_paranoia_check(info, tty->name, "rs_write"))
885 return 0;
886
887 if (!tty || !info->xmit_buf)
888 return 0;
889
890 while (1) {
891 spin_lock_irqsave(&zs_lock, flags);
892 c = min(count, min(SERIAL_XMIT_SIZE - info->xmit_cnt - 1,
893 SERIAL_XMIT_SIZE - info->xmit_head));
894 if (c <= 0)
895 break;
896
897 memcpy(info->xmit_buf + info->xmit_head, buf, c);
898 info->xmit_head = (info->xmit_head + c) & (SERIAL_XMIT_SIZE-1);
899 info->xmit_cnt += c;
900 spin_unlock_irqrestore(&zs_lock, flags);
901 buf += c;
902 count -= c;
903 total += c;
904 }
905
906 if (info->xmit_cnt && !tty->stopped && !info->tx_stopped
907 && !info->tx_active)
908 transmit_chars(info);
909 spin_unlock_irqrestore(&zs_lock, flags);
910 return total;
911 }
912
913 static int rs_write_room(struct tty_struct *tty)
914 {
915 struct dec_serial *info = (struct dec_serial *)tty->driver_data;
916 int ret;
917
918 if (serial_paranoia_check(info, tty->name, "rs_write_room"))
919 return 0;
920 ret = SERIAL_XMIT_SIZE - info->xmit_cnt - 1;
921 if (ret < 0)
922 ret = 0;
923 return ret;
924 }
925
926 static int rs_chars_in_buffer(struct tty_struct *tty)
927 {
928 struct dec_serial *info = (struct dec_serial *)tty->driver_data;
929
930 if (serial_paranoia_check(info, tty->name, "rs_chars_in_buffer"))
931 return 0;
932 return info->xmit_cnt;
933 }
934
935 static void rs_flush_buffer(struct tty_struct *tty)
936 {
937 struct dec_serial *info = (struct dec_serial *)tty->driver_data;
938
939 if (serial_paranoia_check(info, tty->name, "rs_flush_buffer"))
940 return;
941 spin_lock_irq(&zs_lock);
942 info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;
943 spin_unlock_irq(&zs_lock);
944 tty_wakeup(tty);
945 }
946
947 /*
948 * ------------------------------------------------------------
949 * rs_throttle()
950 *
951 * This routine is called by the upper-layer tty layer to signal that
952 * incoming characters should be throttled.
953 * ------------------------------------------------------------
954 */
955 static void rs_throttle(struct tty_struct * tty)
956 {
957 struct dec_serial *info = (struct dec_serial *)tty->driver_data;
958 unsigned long flags;
959
960 #ifdef SERIAL_DEBUG_THROTTLE
961 char buf[64];
962
963 printk("throttle %s: %d....\n", _tty_name(tty, buf),
964 tty->ldisc.chars_in_buffer(tty));
965 #endif
966
967 if (serial_paranoia_check(info, tty->name, "rs_throttle"))
968 return;
969
970 if (I_IXOFF(tty)) {
971 spin_lock_irqsave(&zs_lock, flags);
972 info->x_char = STOP_CHAR(tty);
973 if (!info->tx_active)
974 transmit_chars(info);
975 spin_unlock_irqrestore(&zs_lock, flags);
976 }
977
978 if (C_CRTSCTS(tty)) {
979 zs_rtsdtr(info, RTS, 0);
980 }
981 }
982
983 static void rs_unthrottle(struct tty_struct * tty)
984 {
985 struct dec_serial *info = (struct dec_serial *)tty->driver_data;
986 unsigned long flags;
987
988 #ifdef SERIAL_DEBUG_THROTTLE
989 char buf[64];
990
991 printk("unthrottle %s: %d....\n", _tty_name(tty, buf),
992 tty->ldisc.chars_in_buffer(tty));
993 #endif
994
995 if (serial_paranoia_check(info, tty->name, "rs_unthrottle"))
996 return;
997
998 if (I_IXOFF(tty)) {
999 spin_lock_irqsave(&zs_lock, flags);
1000 if (info->x_char)
1001 info->x_char = 0;
1002 else {
1003 info->x_char = START_CHAR(tty);
1004 if (!info->tx_active)
1005 transmit_chars(info);
1006 }
1007 spin_unlock_irqrestore(&zs_lock, flags);
1008 }
1009
1010 if (C_CRTSCTS(tty)) {
1011 zs_rtsdtr(info, RTS, 1);
1012 }
1013 }
1014
1015 /*
1016 * ------------------------------------------------------------
1017 * rs_ioctl() and friends
1018 * ------------------------------------------------------------
1019 */
1020
1021 static int get_serial_info(struct dec_serial * info,
1022 struct serial_struct * retinfo)
1023 {
1024 struct serial_struct tmp;
1025
1026 if (!retinfo)
1027 return -EFAULT;
1028 memset(&tmp, 0, sizeof(tmp));
1029 tmp.type = info->type;
1030 tmp.line = info->line;
1031 tmp.port = info->port;
1032 tmp.irq = info->irq;
1033 tmp.flags = info->flags;
1034 tmp.baud_base = info->baud_base;
1035 tmp.close_delay = info->close_delay;
1036 tmp.closing_wait = info->closing_wait;
1037 tmp.custom_divisor = info->custom_divisor;
1038 return copy_to_user(retinfo,&tmp,sizeof(*retinfo)) ? -EFAULT : 0;
1039 }
1040
1041 static int set_serial_info(struct dec_serial * info,
1042 struct serial_struct * new_info)
1043 {
1044 struct serial_struct new_serial;
1045 struct dec_serial old_info;
1046 int retval = 0;
1047
1048 if (!new_info)
1049 return -EFAULT;
1050 copy_from_user(&new_serial,new_info,sizeof(new_serial));
1051 old_info = *info;
1052
1053 if (!capable(CAP_SYS_ADMIN)) {
1054 if ((new_serial.baud_base != info->baud_base) ||
1055 (new_serial.type != info->type) ||
1056 (new_serial.close_delay != info->close_delay) ||
1057 ((new_serial.flags & ~ZILOG_USR_MASK) !=
1058 (info->flags & ~ZILOG_USR_MASK)))
1059 return -EPERM;
1060 info->flags = ((info->flags & ~ZILOG_USR_MASK) |
1061 (new_serial.flags & ZILOG_USR_MASK));
1062 info->custom_divisor = new_serial.custom_divisor;
1063 goto check_and_exit;
1064 }
1065
1066 if (info->count > 1)
1067 return -EBUSY;
1068
1069 /*
1070 * OK, past this point, all the error checking has been done.
1071 * At this point, we start making changes.....
1072 */
1073
1074 info->baud_base = new_serial.baud_base;
1075 info->flags = ((info->flags & ~ZILOG_FLAGS) |
1076 (new_serial.flags & ZILOG_FLAGS));
1077 info->type = new_serial.type;
1078 info->close_delay = new_serial.close_delay;
1079 info->closing_wait = new_serial.closing_wait;
1080
1081 check_and_exit:
1082 retval = zs_startup(info);
1083 return retval;
1084 }
1085
1086 /*
1087 * get_lsr_info - get line status register info
1088 *
1089 * Purpose: Let user call ioctl() to get info when the UART physically
1090 * is emptied. On bus types like RS485, the transmitter must
1091 * release the bus after transmitting. This must be done when
1092 * the transmit shift register is empty, not be done when the
1093 * transmit holding register is empty. This functionality
1094 * allows an RS485 driver to be written in user space.
1095 */
1096 static int get_lsr_info(struct dec_serial * info, unsigned int *value)
1097 {
1098 unsigned char status;
1099
1100 spin_lock(&zs_lock);
1101 status = read_zsreg(info->zs_channel, 0);
1102 spin_unlock_irq(&zs_lock);
1103 put_user(status,value);
1104 return 0;
1105 }
1106
1107 static int rs_tiocmget(struct tty_struct *tty, struct file *file)
1108 {
1109 struct dec_serial * info = (struct dec_serial *)tty->driver_data;
1110 unsigned char control, status_a, status_b;
1111 unsigned int result;
1112
1113 if (info->hook)
1114 return -ENODEV;
1115
1116 if (serial_paranoia_check(info, tty->name, __FUNCTION__))
1117 return -ENODEV;
1118
1119 if (tty->flags & (1 << TTY_IO_ERROR))
1120 return -EIO;
1121
1122 if (info->zs_channel == info->zs_chan_a)
1123 result = 0;
1124 else {
1125 spin_lock(&zs_lock);
1126 control = info->zs_chan_a->curregs[5];
1127 status_a = read_zsreg(info->zs_chan_a, 0);
1128 status_b = read_zsreg(info->zs_channel, 0);
1129 spin_unlock_irq(&zs_lock);
1130 result = ((control & RTS) ? TIOCM_RTS: 0)
1131 | ((control & DTR) ? TIOCM_DTR: 0)
1132 | ((status_b & DCD) ? TIOCM_CAR: 0)
1133 | ((status_a & DCD) ? TIOCM_RNG: 0)
1134 | ((status_a & SYNC_HUNT) ? TIOCM_DSR: 0)
1135 | ((status_b & CTS) ? TIOCM_CTS: 0);
1136 }
1137 return result;
1138 }
1139
1140 static int rs_tiocmset(struct tty_struct *tty, struct file *file,
1141 unsigned int set, unsigned int clear)
1142 {
1143 struct dec_serial * info = (struct dec_serial *)tty->driver_data;
1144
1145 if (info->hook)
1146 return -ENODEV;
1147
1148 if (serial_paranoia_check(info, tty->name, __FUNCTION__))
1149 return -ENODEV;
1150
1151 if (tty->flags & (1 << TTY_IO_ERROR))
1152 return -EIO;
1153
1154 if (info->zs_channel == info->zs_chan_a)
1155 return 0;
1156
1157 spin_lock(&zs_lock);
1158 if (set & TIOCM_RTS)
1159 info->zs_chan_a->curregs[5] |= RTS;
1160 if (set & TIOCM_DTR)
1161 info->zs_chan_a->curregs[5] |= DTR;
1162 if (clear & TIOCM_RTS)
1163 info->zs_chan_a->curregs[5] &= ~RTS;
1164 if (clear & TIOCM_DTR)
1165 info->zs_chan_a->curregs[5] &= ~DTR;
1166 write_zsreg(info->zs_chan_a, 5, info->zs_chan_a->curregs[5]);
1167 spin_unlock_irq(&zs_lock);
1168 return 0;
1169 }
1170
1171 /*
1172 * rs_break - turn transmit break condition on/off
1173 */
1174 static void rs_break(struct tty_struct *tty, int break_state)
1175 {
1176 struct dec_serial *info = (struct dec_serial *) tty->driver_data;
1177 unsigned long flags;
1178
1179 if (serial_paranoia_check(info, tty->name, "rs_break"))
1180 return;
1181 if (!info->port)
1182 return;
1183
1184 spin_lock_irqsave(&zs_lock, flags);
1185 if (break_state == -1)
1186 info->zs_channel->curregs[5] |= SND_BRK;
1187 else
1188 info->zs_channel->curregs[5] &= ~SND_BRK;
1189 write_zsreg(info->zs_channel, 5, info->zs_channel->curregs[5]);
1190 spin_unlock_irqrestore(&zs_lock, flags);
1191 }
1192
1193 static int rs_ioctl(struct tty_struct *tty, struct file * file,
1194 unsigned int cmd, unsigned long arg)
1195 {
1196 struct dec_serial * info = (struct dec_serial *)tty->driver_data;
1197
1198 if (info->hook)
1199 return -ENODEV;
1200
1201 if (serial_paranoia_check(info, tty->name, "rs_ioctl"))
1202 return -ENODEV;
1203
1204 if ((cmd != TIOCGSERIAL) && (cmd != TIOCSSERIAL) &&
1205 (cmd != TIOCSERCONFIG) && (cmd != TIOCSERGWILD) &&
1206 (cmd != TIOCSERSWILD) && (cmd != TIOCSERGSTRUCT)) {
1207 if (tty->flags & (1 << TTY_IO_ERROR))
1208 return -EIO;
1209 }
1210
1211 switch (cmd) {
1212 case TIOCGSERIAL:
1213 if (!access_ok(VERIFY_WRITE, (void *)arg,
1214 sizeof(struct serial_struct)))
1215 return -EFAULT;
1216 return get_serial_info(info, (struct serial_struct *)arg);
1217
1218 case TIOCSSERIAL:
1219 return set_serial_info(info, (struct serial_struct *)arg);
1220
1221 case TIOCSERGETLSR: /* Get line status register */
1222 if (!access_ok(VERIFY_WRITE, (void *)arg,
1223 sizeof(unsigned int)))
1224 return -EFAULT;
1225 return get_lsr_info(info, (unsigned int *)arg);
1226
1227 case TIOCSERGSTRUCT:
1228 if (!access_ok(VERIFY_WRITE, (void *)arg,
1229 sizeof(struct dec_serial)))
1230 return -EFAULT;
1231 copy_from_user((struct dec_serial *)arg, info,
1232 sizeof(struct dec_serial));
1233 return 0;
1234
1235 default:
1236 return -ENOIOCTLCMD;
1237 }
1238 return 0;
1239 }
1240
1241 static void rs_set_termios(struct tty_struct *tty, struct ktermios *old_termios)
1242 {
1243 struct dec_serial *info = (struct dec_serial *)tty->driver_data;
1244 int was_stopped;
1245
1246 if (tty->termios->c_cflag == old_termios->c_cflag)
1247 return;
1248 was_stopped = info->tx_stopped;
1249
1250 change_speed(info);
1251
1252 if (was_stopped && !info->tx_stopped)
1253 rs_start(tty);
1254 }
1255
1256 /*
1257 * ------------------------------------------------------------
1258 * rs_close()
1259 *
1260 * This routine is called when the serial port gets closed.
1261 * Wait for the last remaining data to be sent.
1262 * ------------------------------------------------------------
1263 */
1264 static void rs_close(struct tty_struct *tty, struct file * filp)
1265 {
1266 struct dec_serial * info = (struct dec_serial *)tty->driver_data;
1267 unsigned long flags;
1268
1269 if (!info || serial_paranoia_check(info, tty->name, "rs_close"))
1270 return;
1271
1272 spin_lock_irqsave(&zs_lock, flags);
1273
1274 if (tty_hung_up_p(filp)) {
1275 spin_unlock_irqrestore(&zs_lock, flags);
1276 return;
1277 }
1278
1279 #ifdef SERIAL_DEBUG_OPEN
1280 printk("rs_close ttyS%d, count = %d\n", info->line, info->count);
1281 #endif
1282 if ((tty->count == 1) && (info->count != 1)) {
1283 /*
1284 * Uh, oh. tty->count is 1, which means that the tty
1285 * structure will be freed. Info->count should always
1286 * be one in these conditions. If it's greater than
1287 * one, we've got real problems, since it means the
1288 * serial port won't be shutdown.
1289 */
1290 printk("rs_close: bad serial port count; tty->count is 1, "
1291 "info->count is %d\n", info->count);
1292 info->count = 1;
1293 }
1294 if (--info->count < 0) {
1295 printk("rs_close: bad serial port count for ttyS%d: %d\n",
1296 info->line, info->count);
1297 info->count = 0;
1298 }
1299 if (info->count) {
1300 spin_unlock_irqrestore(&zs_lock, flags);
1301 return;
1302 }
1303 info->flags |= ZILOG_CLOSING;
1304 /*
1305 * Now we wait for the transmit buffer to clear; and we notify
1306 * the line discipline to only process XON/XOFF characters.
1307 */
1308 tty->closing = 1;
1309 if (info->closing_wait != ZILOG_CLOSING_WAIT_NONE)
1310 tty_wait_until_sent(tty, info->closing_wait);
1311 /*
1312 * At this point we stop accepting input. To do this, we
1313 * disable the receiver and receive interrupts.
1314 */
1315 info->zs_channel->curregs[3] &= ~RxENABLE;
1316 write_zsreg(info->zs_channel, 3, info->zs_channel->curregs[3]);
1317 info->zs_channel->curregs[1] = 0; /* disable any rx ints */
1318 write_zsreg(info->zs_channel, 1, info->zs_channel->curregs[1]);
1319 ZS_CLEARFIFO(info->zs_channel);
1320 if (info->flags & ZILOG_INITIALIZED) {
1321 /*
1322 * Before we drop DTR, make sure the SCC transmitter
1323 * has completely drained.
1324 */
1325 rs_wait_until_sent(tty, info->timeout);
1326 }
1327
1328 shutdown(info);
1329 if (tty->driver->flush_buffer)
1330 tty->driver->flush_buffer(tty);
1331 tty_ldisc_flush(tty);
1332 tty->closing = 0;
1333 info->event = 0;
1334 info->tty = 0;
1335 if (info->blocked_open) {
1336 if (info->close_delay) {
1337 msleep_interruptible(jiffies_to_msecs(info->close_delay));
1338 }
1339 wake_up_interruptible(&info->open_wait);
1340 }
1341 info->flags &= ~(ZILOG_NORMAL_ACTIVE|ZILOG_CLOSING);
1342 wake_up_interruptible(&info->close_wait);
1343 spin_unlock_irqrestore(&zs_lock, flags);
1344 }
1345
1346 /*
1347 * rs_wait_until_sent() --- wait until the transmitter is empty
1348 */
1349 static void rs_wait_until_sent(struct tty_struct *tty, int timeout)
1350 {
1351 struct dec_serial *info = (struct dec_serial *) tty->driver_data;
1352 unsigned long orig_jiffies;
1353 int char_time;
1354
1355 if (serial_paranoia_check(info, tty->name, "rs_wait_until_sent"))
1356 return;
1357
1358 orig_jiffies = jiffies;
1359 /*
1360 * Set the check interval to be 1/5 of the estimated time to
1361 * send a single character, and make it at least 1. The check
1362 * interval should also be less than the timeout.
1363 */
1364 char_time = (info->timeout - HZ/50) / info->xmit_fifo_size;
1365 char_time = char_time / 5;
1366 if (char_time == 0)
1367 char_time = 1;
1368 if (timeout)
1369 char_time = min(char_time, timeout);
1370 while ((read_zsreg(info->zs_channel, 1) & Tx_BUF_EMP) == 0) {
1371 msleep_interruptible(jiffies_to_msecs(char_time));
1372 if (signal_pending(current))
1373 break;
1374 if (timeout && time_after(jiffies, orig_jiffies + timeout))
1375 break;
1376 }
1377 current->state = TASK_RUNNING;
1378 }
1379
1380 /*
1381 * rs_hangup() --- called by tty_hangup() when a hangup is signaled.
1382 */
1383 static void rs_hangup(struct tty_struct *tty)
1384 {
1385 struct dec_serial * info = (struct dec_serial *)tty->driver_data;
1386
1387 if (serial_paranoia_check(info, tty->name, "rs_hangup"))
1388 return;
1389
1390 rs_flush_buffer(tty);
1391 shutdown(info);
1392 info->event = 0;
1393 info->count = 0;
1394 info->flags &= ~ZILOG_NORMAL_ACTIVE;
1395 info->tty = 0;
1396 wake_up_interruptible(&info->open_wait);
1397 }
1398
1399 /*
1400 * ------------------------------------------------------------
1401 * rs_open() and friends
1402 * ------------------------------------------------------------
1403 */
1404 static int block_til_ready(struct tty_struct *tty, struct file * filp,
1405 struct dec_serial *info)
1406 {
1407 DECLARE_WAITQUEUE(wait, current);
1408 int retval;
1409 int do_clocal = 0;
1410
1411 /*
1412 * If the device is in the middle of being closed, then block
1413 * until it's done, and then try again.
1414 */
1415 if (info->flags & ZILOG_CLOSING) {
1416 interruptible_sleep_on(&info->close_wait);
1417 #ifdef SERIAL_DO_RESTART
1418 return ((info->flags & ZILOG_HUP_NOTIFY) ?
1419 -EAGAIN : -ERESTARTSYS);
1420 #else
1421 return -EAGAIN;
1422 #endif
1423 }
1424
1425 /*
1426 * If non-blocking mode is set, or the port is not enabled,
1427 * then make the check up front and then exit.
1428 */
1429 if ((filp->f_flags & O_NONBLOCK) ||
1430 (tty->flags & (1 << TTY_IO_ERROR))) {
1431 info->flags |= ZILOG_NORMAL_ACTIVE;
1432 return 0;
1433 }
1434
1435 if (tty->termios->c_cflag & CLOCAL)
1436 do_clocal = 1;
1437
1438 /*
1439 * Block waiting for the carrier detect and the line to become
1440 * free (i.e., not in use by the callout). While we are in
1441 * this loop, info->count is dropped by one, so that
1442 * rs_close() knows when to free things. We restore it upon
1443 * exit, either normal or abnormal.
1444 */
1445 retval = 0;
1446 add_wait_queue(&info->open_wait, &wait);
1447 #ifdef SERIAL_DEBUG_OPEN
1448 printk("block_til_ready before block: ttyS%d, count = %d\n",
1449 info->line, info->count);
1450 #endif
1451 spin_lock(&zs_lock);
1452 if (!tty_hung_up_p(filp))
1453 info->count--;
1454 spin_unlock_irq(&zs_lock);
1455 info->blocked_open++;
1456 while (1) {
1457 spin_lock(&zs_lock);
1458 if (tty->termios->c_cflag & CBAUD)
1459 zs_rtsdtr(info, RTS | DTR, 1);
1460 spin_unlock_irq(&zs_lock);
1461 set_current_state(TASK_INTERRUPTIBLE);
1462 if (tty_hung_up_p(filp) ||
1463 !(info->flags & ZILOG_INITIALIZED)) {
1464 #ifdef SERIAL_DO_RESTART
1465 if (info->flags & ZILOG_HUP_NOTIFY)
1466 retval = -EAGAIN;
1467 else
1468 retval = -ERESTARTSYS;
1469 #else
1470 retval = -EAGAIN;
1471 #endif
1472 break;
1473 }
1474 if (!(info->flags & ZILOG_CLOSING) &&
1475 (do_clocal || (read_zsreg(info->zs_channel, 0) & DCD)))
1476 break;
1477 if (signal_pending(current)) {
1478 retval = -ERESTARTSYS;
1479 break;
1480 }
1481 #ifdef SERIAL_DEBUG_OPEN
1482 printk("block_til_ready blocking: ttyS%d, count = %d\n",
1483 info->line, info->count);
1484 #endif
1485 schedule();
1486 }
1487 current->state = TASK_RUNNING;
1488 remove_wait_queue(&info->open_wait, &wait);
1489 if (!tty_hung_up_p(filp))
1490 info->count++;
1491 info->blocked_open--;
1492 #ifdef SERIAL_DEBUG_OPEN
1493 printk("block_til_ready after blocking: ttyS%d, count = %d\n",
1494 info->line, info->count);
1495 #endif
1496 if (retval)
1497 return retval;
1498 info->flags |= ZILOG_NORMAL_ACTIVE;
1499 return 0;
1500 }
1501
1502 /*
1503 * This routine is called whenever a serial port is opened. It
1504 * enables interrupts for a serial port, linking in its ZILOG structure into
1505 * the IRQ chain. It also performs the serial-specific
1506 * initialization for the tty structure.
1507 */
1508 static int rs_open(struct tty_struct *tty, struct file * filp)
1509 {
1510 struct dec_serial *info;
1511 int retval, line;
1512
1513 line = tty->index;
1514 if ((line < 0) || (line >= zs_channels_found))
1515 return -ENODEV;
1516 info = zs_soft + line;
1517
1518 if (info->hook)
1519 return -ENODEV;
1520
1521 if (serial_paranoia_check(info, tty->name, "rs_open"))
1522 return -ENODEV;
1523 #ifdef SERIAL_DEBUG_OPEN
1524 printk("rs_open %s, count = %d\n", tty->name, info->count);
1525 #endif
1526
1527 info->count++;
1528 tty->driver_data = info;
1529 info->tty = tty;
1530
1531 /*
1532 * If the port is the middle of closing, bail out now
1533 */
1534 if (tty_hung_up_p(filp) ||
1535 (info->flags & ZILOG_CLOSING)) {
1536 if (info->flags & ZILOG_CLOSING)
1537 interruptible_sleep_on(&info->close_wait);
1538 #ifdef SERIAL_DO_RESTART
1539 return ((info->flags & ZILOG_HUP_NOTIFY) ?
1540 -EAGAIN : -ERESTARTSYS);
1541 #else
1542 return -EAGAIN;
1543 #endif
1544 }
1545
1546 /*
1547 * Start up serial port
1548 */
1549 retval = zs_startup(info);
1550 if (retval)
1551 return retval;
1552
1553 retval = block_til_ready(tty, filp, info);
1554 if (retval) {
1555 #ifdef SERIAL_DEBUG_OPEN
1556 printk("rs_open returning after block_til_ready with %d\n",
1557 retval);
1558 #endif
1559 return retval;
1560 }
1561
1562 #ifdef CONFIG_SERIAL_DEC_CONSOLE
1563 if (sercons.cflag && sercons.index == line) {
1564 tty->termios->c_cflag = sercons.cflag;
1565 sercons.cflag = 0;
1566 change_speed(info);
1567 }
1568 #endif
1569
1570 #ifdef SERIAL_DEBUG_OPEN
1571 printk("rs_open %s successful...", tty->name);
1572 #endif
1573 /* tty->low_latency = 1; */
1574 return 0;
1575 }
1576
1577 /* Finally, routines used to initialize the serial driver. */
1578
1579 static void __init show_serial_version(void)
1580 {
1581 printk("DECstation Z8530 serial driver version 0.09\n");
1582 }
1583
1584 /* Initialize Z8530s zs_channels
1585 */
1586
1587 static void __init probe_sccs(void)
1588 {
1589 struct dec_serial **pp;
1590 int i, n, n_chips = 0, n_channels, chip, channel;
1591 unsigned long flags;
1592
1593 /*
1594 * did we get here by accident?
1595 */
1596 if(!BUS_PRESENT) {
1597 printk("Not on JUNKIO machine, skipping probe_sccs\n");
1598 return;
1599 }
1600
1601 switch(mips_machtype) {
1602 #ifdef CONFIG_MACH_DECSTATION
1603 case MACH_DS5000_2X0:
1604 case MACH_DS5900:
1605 n_chips = 2;
1606 zs_parms = &ds_parms;
1607 zs_parms->irq0 = dec_interrupt[DEC_IRQ_SCC0];
1608 zs_parms->irq1 = dec_interrupt[DEC_IRQ_SCC1];
1609 break;
1610 case MACH_DS5000_1XX:
1611 n_chips = 2;
1612 zs_parms = &ds_parms;
1613 zs_parms->irq0 = dec_interrupt[DEC_IRQ_SCC0];
1614 zs_parms->irq1 = dec_interrupt[DEC_IRQ_SCC1];
1615 break;
1616 case MACH_DS5000_XX:
1617 n_chips = 1;
1618 zs_parms = &ds_parms;
1619 zs_parms->irq0 = dec_interrupt[DEC_IRQ_SCC0];
1620 break;
1621 #endif
1622 default:
1623 panic("zs: unsupported bus");
1624 }
1625 if (!zs_parms)
1626 panic("zs: uninitialized parms");
1627
1628 pp = &zs_chain;
1629
1630 n_channels = 0;
1631
1632 for (chip = 0; chip < n_chips; chip++) {
1633 for (channel = 0; channel <= 1; channel++) {
1634 /*
1635 * The sccs reside on the high byte of the 16 bit IOBUS
1636 */
1637 zs_channels[n_channels].control =
1638 (volatile void *)CKSEG1ADDR(dec_kn_slot_base +
1639 (0 == chip ? zs_parms->scc0 : zs_parms->scc1) +
1640 (0 == channel ? zs_parms->channel_a_offset :
1641 zs_parms->channel_b_offset));
1642 zs_channels[n_channels].data =
1643 zs_channels[n_channels].control + 4;
1644
1645 #ifndef CONFIG_SERIAL_DEC_CONSOLE
1646 /*
1647 * We're called early and memory managment isn't up, yet.
1648 * Thus request_region would fail.
1649 */
1650 if (!request_region((unsigned long)
1651 zs_channels[n_channels].control,
1652 ZS_CHAN_IO_SIZE, "SCC"))
1653 panic("SCC I/O region is not free");
1654 #endif
1655 zs_soft[n_channels].zs_channel = &zs_channels[n_channels];
1656 /* HACK alert! */
1657 if (!(chip & 1))
1658 zs_soft[n_channels].irq = zs_parms->irq0;
1659 else
1660 zs_soft[n_channels].irq = zs_parms->irq1;
1661
1662 /*
1663 * Identification of channel A. Location of channel A
1664 * inside chip depends on mapping of internal address
1665 * the chip decodes channels by.
1666 * CHANNEL_A_NR returns either 0 (in case of
1667 * DECstations) or 1 (in case of Baget).
1668 */
1669 if (CHANNEL_A_NR == channel)
1670 zs_soft[n_channels].zs_chan_a =
1671 &zs_channels[n_channels+1-2*CHANNEL_A_NR];
1672 else
1673 zs_soft[n_channels].zs_chan_a =
1674 &zs_channels[n_channels];
1675
1676 *pp = &zs_soft[n_channels];
1677 pp = &zs_soft[n_channels].zs_next;
1678 n_channels++;
1679 }
1680 }
1681
1682 *pp = 0;
1683 zs_channels_found = n_channels;
1684
1685 for (n = 0; n < zs_channels_found; n++) {
1686 for (i = 0; i < 16; i++) {
1687 zs_soft[n].zs_channel->curregs[i] = zs_init_regs[i];
1688 }
1689 }
1690
1691 spin_lock_irqsave(&zs_lock, flags);
1692 for (n = 0; n < zs_channels_found; n++) {
1693 if (n % 2 == 0) {
1694 write_zsreg(zs_soft[n].zs_chan_a, R9, FHWRES);
1695 udelay(10);
1696 write_zsreg(zs_soft[n].zs_chan_a, R9, 0);
1697 }
1698 load_zsregs(zs_soft[n].zs_channel,
1699 zs_soft[n].zs_channel->curregs);
1700 }
1701 spin_unlock_irqrestore(&zs_lock, flags);
1702 }
1703
1704 static const struct tty_operations serial_ops = {
1705 .open = rs_open,
1706 .close = rs_close,
1707 .write = rs_write,
1708 .flush_chars = rs_flush_chars,
1709 .write_room = rs_write_room,
1710 .chars_in_buffer = rs_chars_in_buffer,
1711 .flush_buffer = rs_flush_buffer,
1712 .ioctl = rs_ioctl,
1713 .throttle = rs_throttle,
1714 .unthrottle = rs_unthrottle,
1715 .set_termios = rs_set_termios,
1716 .stop = rs_stop,
1717 .start = rs_start,
1718 .hangup = rs_hangup,
1719 .break_ctl = rs_break,
1720 .wait_until_sent = rs_wait_until_sent,
1721 .tiocmget = rs_tiocmget,
1722 .tiocmset = rs_tiocmset,
1723 };
1724
1725 /* zs_init inits the driver */
1726 int __init zs_init(void)
1727 {
1728 int channel, i;
1729 struct dec_serial *info;
1730
1731 if(!BUS_PRESENT)
1732 return -ENODEV;
1733
1734 /* Find out how many Z8530 SCCs we have */
1735 if (zs_chain == 0)
1736 probe_sccs();
1737 serial_driver = alloc_tty_driver(zs_channels_found);
1738 if (!serial_driver)
1739 return -ENOMEM;
1740
1741 show_serial_version();
1742
1743 /* Initialize the tty_driver structure */
1744 /* Not all of this is exactly right for us. */
1745
1746 serial_driver->owner = THIS_MODULE;
1747 serial_driver->name = "ttyS";
1748 serial_driver->major = TTY_MAJOR;
1749 serial_driver->minor_start = 64;
1750 serial_driver->type = TTY_DRIVER_TYPE_SERIAL;
1751 serial_driver->subtype = SERIAL_TYPE_NORMAL;
1752 serial_driver->init_termios = tty_std_termios;
1753 serial_driver->init_termios.c_cflag =
1754 B9600 | CS8 | CREAD | HUPCL | CLOCAL;
1755 serial_driver->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;
1756 tty_set_operations(serial_driver, &serial_ops);
1757
1758 if (tty_register_driver(serial_driver))
1759 panic("Couldn't register serial driver");
1760
1761 for (info = zs_chain, i = 0; info; info = info->zs_next, i++) {
1762
1763 /* Needed before interrupts are enabled. */
1764 info->tty = 0;
1765 info->x_char = 0;
1766
1767 if (info->hook && info->hook->init_info) {
1768 (*info->hook->init_info)(info);
1769 continue;
1770 }
1771
1772 info->magic = SERIAL_MAGIC;
1773 info->port = (int) info->zs_channel->control;
1774 info->line = i;
1775 info->custom_divisor = 16;
1776 info->close_delay = 50;
1777 info->closing_wait = 3000;
1778 info->event = 0;
1779 info->count = 0;
1780 info->blocked_open = 0;
1781 tasklet_init(&info->tlet, do_softint, (unsigned long)info);
1782 init_waitqueue_head(&info->open_wait);
1783 init_waitqueue_head(&info->close_wait);
1784 printk("ttyS%02d at 0x%08x (irq = %d) is a Z85C30 SCC\n",
1785 info->line, info->port, info->irq);
1786 tty_register_device(serial_driver, info->line, NULL);
1787
1788 }
1789
1790 for (channel = 0; channel < zs_channels_found; ++channel) {
1791 zs_soft[channel].clk_divisor = 16;
1792 zs_soft[channel].zs_baud = get_zsbaud(&zs_soft[channel]);
1793
1794 if (request_irq(zs_soft[channel].irq, rs_interrupt, IRQF_SHARED,
1795 "scc", &zs_soft[channel]))
1796 printk(KERN_ERR "decserial: can't get irq %d\n",
1797 zs_soft[channel].irq);
1798
1799 if (zs_soft[channel].hook) {
1800 zs_startup(&zs_soft[channel]);
1801 if (zs_soft[channel].hook->init_channel)
1802 (*zs_soft[channel].hook->init_channel)
1803 (&zs_soft[channel]);
1804 }
1805 }
1806
1807 return 0;
1808 }
1809
1810 /*
1811 * polling I/O routines
1812 */
1813 static int zs_poll_tx_char(void *handle, unsigned char ch)
1814 {
1815 struct dec_serial *info = handle;
1816 struct dec_zschannel *chan = info->zs_channel;
1817 int ret;
1818
1819 if(chan) {
1820 int loops = 10000;
1821
1822 while (loops && !(read_zsreg(chan, 0) & Tx_BUF_EMP))
1823 loops--;
1824
1825 if (loops) {
1826 write_zsdata(chan, ch);
1827 ret = 0;
1828 } else
1829 ret = -EAGAIN;
1830
1831 return ret;
1832 } else
1833 return -ENODEV;
1834 }
1835
1836 static int zs_poll_rx_char(void *handle)
1837 {
1838 struct dec_serial *info = handle;
1839 struct dec_zschannel *chan = info->zs_channel;
1840 int ret;
1841
1842 if(chan) {
1843 int loops = 10000;
1844
1845 while (loops && !(read_zsreg(chan, 0) & Rx_CH_AV))
1846 loops--;
1847
1848 if (loops)
1849 ret = read_zsdata(chan);
1850 else
1851 ret = -EAGAIN;
1852
1853 return ret;
1854 } else
1855 return -ENODEV;
1856 }
1857
1858 int register_zs_hook(unsigned int channel, struct dec_serial_hook *hook)
1859 {
1860 struct dec_serial *info = &zs_soft[channel];
1861
1862 if (info->hook) {
1863 printk("%s: line %d has already a hook registered\n",
1864 __FUNCTION__, channel);
1865
1866 return 0;
1867 } else {
1868 hook->poll_rx_char = zs_poll_rx_char;
1869 hook->poll_tx_char = zs_poll_tx_char;
1870 info->hook = hook;
1871
1872 return 1;
1873 }
1874 }
1875
1876 int unregister_zs_hook(unsigned int channel)
1877 {
1878 struct dec_serial *info = &zs_soft[channel];
1879
1880 if (info->hook) {
1881 info->hook = NULL;
1882 return 1;
1883 } else {
1884 printk("%s: trying to unregister hook on line %d,"
1885 " but none is registered\n", __FUNCTION__, channel);
1886 return 0;
1887 }
1888 }
1889
1890 /*
1891 * ------------------------------------------------------------
1892 * Serial console driver
1893 * ------------------------------------------------------------
1894 */
1895 #ifdef CONFIG_SERIAL_DEC_CONSOLE
1896
1897
1898 /*
1899 * Print a string to the serial port trying not to disturb
1900 * any possible real use of the port...
1901 */
1902 static void serial_console_write(struct console *co, const char *s,
1903 unsigned count)
1904 {
1905 struct dec_serial *info;
1906 int i;
1907
1908 info = zs_soft + co->index;
1909
1910 for (i = 0; i < count; i++, s++) {
1911 if(*s == '\n')
1912 zs_poll_tx_char(info, '\r');
1913 zs_poll_tx_char(info, *s);
1914 }
1915 }
1916
1917 static struct tty_driver *serial_console_device(struct console *c, int *index)
1918 {
1919 *index = c->index;
1920 return serial_driver;
1921 }
1922
1923 /*
1924 * Setup initial baud/bits/parity. We do two things here:
1925 * - construct a cflag setting for the first rs_open()
1926 * - initialize the serial port
1927 * Return non-zero if we didn't find a serial port.
1928 */
1929 static int __init serial_console_setup(struct console *co, char *options)
1930 {
1931 struct dec_serial *info;
1932 int baud = 9600;
1933 int bits = 8;
1934 int parity = 'n';
1935 int cflag = CREAD | HUPCL | CLOCAL;
1936 int clk_divisor = 16;
1937 int brg;
1938 char *s;
1939 unsigned long flags;
1940
1941 if(!BUS_PRESENT)
1942 return -ENODEV;
1943
1944 info = zs_soft + co->index;
1945
1946 if (zs_chain == 0)
1947 probe_sccs();
1948
1949 info->is_cons = 1;
1950
1951 if (options) {
1952 baud = simple_strtoul(options, NULL, 10);
1953 s = options;
1954 while(*s >= '0' && *s <= '9')
1955 s++;
1956 if (*s)
1957 parity = *s++;
1958 if (*s)
1959 bits = *s - '0';
1960 }
1961
1962 /*
1963 * Now construct a cflag setting.
1964 */
1965 switch(baud) {
1966 case 1200:
1967 cflag |= B1200;
1968 break;
1969 case 2400:
1970 cflag |= B2400;
1971 break;
1972 case 4800:
1973 cflag |= B4800;
1974 break;
1975 case 19200:
1976 cflag |= B19200;
1977 break;
1978 case 38400:
1979 cflag |= B38400;
1980 break;
1981 case 57600:
1982 cflag |= B57600;
1983 break;
1984 case 115200:
1985 cflag |= B115200;
1986 break;
1987 case 9600:
1988 default:
1989 cflag |= B9600;
1990 /*
1991 * Set this to a sane value to prevent a divide error.
1992 */
1993 baud = 9600;
1994 break;
1995 }
1996 switch(bits) {
1997 case 7:
1998 cflag |= CS7;
1999 break;
2000 default:
2001 case 8:
2002 cflag |= CS8;
2003 break;
2004 }
2005 switch(parity) {
2006 case 'o': case 'O':
2007 cflag |= PARODD;
2008 break;
2009 case 'e': case 'E':
2010 cflag |= PARENB;
2011 break;
2012 }
2013 co->cflag = cflag;
2014
2015 spin_lock_irqsave(&zs_lock, flags);
2016
2017 /*
2018 * Set up the baud rate generator.
2019 */
2020 brg = BPS_TO_BRG(baud, zs_parms->clock / clk_divisor);
2021 info->zs_channel->curregs[R12] = (brg & 255);
2022 info->zs_channel->curregs[R13] = ((brg >> 8) & 255);
2023
2024 /*
2025 * Set byte size and parity.
2026 */
2027 if (bits == 7) {
2028 info->zs_channel->curregs[R3] |= Rx7;
2029 info->zs_channel->curregs[R5] |= Tx7;
2030 } else {
2031 info->zs_channel->curregs[R3] |= Rx8;
2032 info->zs_channel->curregs[R5] |= Tx8;
2033 }
2034 if (cflag & PARENB) {
2035 info->zs_channel->curregs[R4] |= PAR_ENA;
2036 }
2037 if (!(cflag & PARODD)) {
2038 info->zs_channel->curregs[R4] |= PAR_EVEN;
2039 }
2040 info->zs_channel->curregs[R4] |= SB1;
2041
2042 /*
2043 * Turn on RTS and DTR.
2044 */
2045 zs_rtsdtr(info, RTS | DTR, 1);
2046
2047 /*
2048 * Finally, enable sequencing.
2049 */
2050 info->zs_channel->curregs[R3] |= RxENABLE;
2051 info->zs_channel->curregs[R5] |= TxENAB;
2052
2053 /*
2054 * Clear the interrupt registers.
2055 */
2056 write_zsreg(info->zs_channel, R0, ERR_RES);
2057 write_zsreg(info->zs_channel, R0, RES_H_IUS);
2058
2059 /*
2060 * Load up the new values.
2061 */
2062 load_zsregs(info->zs_channel, info->zs_channel->curregs);
2063
2064 /* Save the current value of RR0 */
2065 info->read_reg_zero = read_zsreg(info->zs_channel, R0);
2066
2067 zs_soft[co->index].clk_divisor = clk_divisor;
2068 zs_soft[co->index].zs_baud = get_zsbaud(&zs_soft[co->index]);
2069
2070 spin_unlock_irqrestore(&zs_lock, flags);
2071
2072 return 0;
2073 }
2074
2075 static struct console sercons = {
2076 .name = "ttyS",
2077 .write = serial_console_write,
2078 .device = serial_console_device,
2079 .setup = serial_console_setup,
2080 .flags = CON_PRINTBUFFER,
2081 .index = -1,
2082 };
2083
2084 /*
2085 * Register console.
2086 */
2087 void __init zs_serial_console_init(void)
2088 {
2089 register_console(&sercons);
2090 }
2091 #endif /* ifdef CONFIG_SERIAL_DEC_CONSOLE */
2092
2093 #ifdef CONFIG_KGDB
2094 struct dec_zschannel *zs_kgdbchan;
2095 static unsigned char scc_inittab[] = {
2096 9, 0x80, /* reset A side (CHRA) */
2097 13, 0, /* set baud rate divisor */
2098 12, 1,
2099 14, 1, /* baud rate gen enable, src=rtxc (BRENABL) */
2100 11, 0x50, /* clocks = br gen (RCBR | TCBR) */
2101 5, 0x6a, /* tx 8 bits, assert RTS (Tx8 | TxENAB | RTS) */
2102 4, 0x44, /* x16 clock, 1 stop (SB1 | X16CLK)*/
2103 3, 0xc1, /* rx enable, 8 bits (RxENABLE | Rx8)*/
2104 };
2105
2106 /* These are for receiving and sending characters under the kgdb
2107 * source level kernel debugger.
2108 */
2109 void putDebugChar(char kgdb_char)
2110 {
2111 struct dec_zschannel *chan = zs_kgdbchan;
2112 while ((read_zsreg(chan, 0) & Tx_BUF_EMP) == 0)
2113 RECOVERY_DELAY;
2114 write_zsdata(chan, kgdb_char);
2115 }
2116 char getDebugChar(void)
2117 {
2118 struct dec_zschannel *chan = zs_kgdbchan;
2119 while((read_zsreg(chan, 0) & Rx_CH_AV) == 0)
2120 eieio(); /*barrier();*/
2121 return read_zsdata(chan);
2122 }
2123 void kgdb_interruptible(int yes)
2124 {
2125 struct dec_zschannel *chan = zs_kgdbchan;
2126 int one, nine;
2127 nine = read_zsreg(chan, 9);
2128 if (yes == 1) {
2129 one = EXT_INT_ENAB|RxINT_ALL;
2130 nine |= MIE;
2131 printk("turning serial ints on\n");
2132 } else {
2133 one = RxINT_DISAB;
2134 nine &= ~MIE;
2135 printk("turning serial ints off\n");
2136 }
2137 write_zsreg(chan, 1, one);
2138 write_zsreg(chan, 9, nine);
2139 }
2140
2141 static int kgdbhook_init_channel(void *handle)
2142 {
2143 return 0;
2144 }
2145
2146 static void kgdbhook_init_info(void *handle)
2147 {
2148 }
2149
2150 static void kgdbhook_rx_char(void *handle, unsigned char ch, unsigned char fl)
2151 {
2152 struct dec_serial *info = handle;
2153
2154 if (fl != TTY_NORMAL)
2155 return;
2156 if (ch == 0x03 || ch == '$')
2157 breakpoint();
2158 }
2159
2160 /* This sets up the serial port we're using, and turns on
2161 * interrupts for that channel, so kgdb is usable once we're done.
2162 */
2163 static inline void kgdb_chaninit(struct dec_zschannel *ms, int intson, int bps)
2164 {
2165 int brg;
2166 int i, x;
2167 volatile char *sccc = ms->control;
2168 brg = BPS_TO_BRG(bps, zs_parms->clock/16);
2169 printk("setting bps on kgdb line to %d [brg=%x]\n", bps, brg);
2170 for (i = 20000; i != 0; --i) {
2171 x = *sccc; eieio();
2172 }
2173 for (i = 0; i < sizeof(scc_inittab); ++i) {
2174 write_zsreg(ms, scc_inittab[i], scc_inittab[i+1]);
2175 i++;
2176 }
2177 }
2178 /* This is called at boot time to prime the kgdb serial debugging
2179 * serial line. The 'tty_num' argument is 0 for /dev/ttya and 1
2180 * for /dev/ttyb which is determined in setup_arch() from the
2181 * boot command line flags.
2182 */
2183 struct dec_serial_hook zs_kgdbhook = {
2184 .init_channel = kgdbhook_init_channel,
2185 .init_info = kgdbhook_init_info,
2186 .rx_char = kgdbhook_rx_char,
2187 .cflags = B38400 | CS8 | CLOCAL,
2188 }
2189
2190 void __init zs_kgdb_hook(int tty_num)
2191 {
2192 /* Find out how many Z8530 SCCs we have */
2193 if (zs_chain == 0)
2194 probe_sccs();
2195 zs_soft[tty_num].zs_channel = &zs_channels[tty_num];
2196 zs_kgdbchan = zs_soft[tty_num].zs_channel;
2197 zs_soft[tty_num].change_needed = 0;
2198 zs_soft[tty_num].clk_divisor = 16;
2199 zs_soft[tty_num].zs_baud = 38400;
2200 zs_soft[tty_num].hook = &zs_kgdbhook; /* This runs kgdb */
2201 /* Turn on transmitter/receiver at 8-bits/char */
2202 kgdb_chaninit(zs_soft[tty_num].zs_channel, 1, 38400);
2203 printk("KGDB: on channel %d initialized\n", tty_num);
2204 set_debug_traps(); /* init stub */
2205 }
2206 #endif /* ifdef CONFIG_KGDB */
Linux 2.6 ibm-acpi/thinkpad-acpi driver git tree