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