dz: clean up and improve the setup of termios settings
[safe/jmp/linux-2.6] / drivers / serial / dz.c
1 /*
2  * dz.c: Serial port driver for DECstations equipped
3  *       with the DZ chipset.
4  *
5  * Copyright (C) 1998 Olivier A. D. Lebaillif
6  *
7  * Email: olivier.lebaillif@ifrsys.com
8  *
9  * Copyright (C) 2004, 2006, 2007  Maciej W. Rozycki
10  *
11  * [31-AUG-98] triemer
12  * Changed IRQ to use Harald's dec internals interrupts.h
13  * removed base_addr code - moving address assignment to setup.c
14  * Changed name of dz_init to rs_init to be consistent with tc code
15  * [13-NOV-98] triemer fixed code to receive characters
16  *    after patches by harald to irq code.
17  * [09-JAN-99] triemer minor fix for schedule - due to removal of timeout
18  *            field from "current" - somewhere between 2.1.121 and 2.1.131
19  Qua Jun 27 15:02:26 BRT 2001
20  * [27-JUN-2001] Arnaldo Carvalho de Melo <acme@conectiva.com.br> - cleanups
21  *
22  * Parts (C) 1999 David Airlie, airlied@linux.ie
23  * [07-SEP-99] Bugfixes
24  *
25  * [06-Jan-2002] Russell King <rmk@arm.linux.org.uk>
26  * Converted to new serial core
27  */
28
29 #undef DEBUG_DZ
30
31 #if defined(CONFIG_SERIAL_DZ_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
32 #define SUPPORT_SYSRQ
33 #endif
34
35 #include <linux/bitops.h>
36 #include <linux/compiler.h>
37 #include <linux/console.h>
38 #include <linux/delay.h>
39 #include <linux/errno.h>
40 #include <linux/init.h>
41 #include <linux/interrupt.h>
42 #include <linux/kernel.h>
43 #include <linux/major.h>
44 #include <linux/module.h>
45 #include <linux/serial.h>
46 #include <linux/serial_core.h>
47 #include <linux/sysrq.h>
48 #include <linux/tty.h>
49
50 #include <asm/bootinfo.h>
51 #include <asm/system.h>
52
53 #include <asm/dec/interrupts.h>
54 #include <asm/dec/kn01.h>
55 #include <asm/dec/kn02.h>
56 #include <asm/dec/machtype.h>
57 #include <asm/dec/prom.h>
58
59 #include "dz.h"
60
61 static char *dz_name = "DECstation DZ serial driver version ";
62 static char *dz_version = "1.03";
63
64 struct dz_port {
65         struct uart_port        port;
66         unsigned int            cflag;
67 };
68
69 static struct dz_port dz_ports[DZ_NB_PORT];
70
71 /*
72  * ------------------------------------------------------------
73  * dz_in () and dz_out ()
74  *
75  * These routines are used to access the registers of the DZ
76  * chip, hiding relocation differences between implementation.
77  * ------------------------------------------------------------
78  */
79
80 static inline unsigned short dz_in(struct dz_port *dport, unsigned offset)
81 {
82         volatile unsigned short *addr =
83                 (volatile unsigned short *) (dport->port.membase + offset);
84
85         return *addr;
86 }
87
88 static inline void dz_out(struct dz_port *dport, unsigned offset,
89                           unsigned short value)
90 {
91         volatile unsigned short *addr =
92                 (volatile unsigned short *) (dport->port.membase + offset);
93
94         *addr = value;
95 }
96
97 /*
98  * ------------------------------------------------------------
99  * rs_stop () and rs_start ()
100  *
101  * These routines are called before setting or resetting
102  * tty->stopped. They enable or disable transmitter interrupts,
103  * as necessary.
104  * ------------------------------------------------------------
105  */
106
107 static void dz_stop_tx(struct uart_port *uport)
108 {
109         struct dz_port *dport = (struct dz_port *)uport;
110         unsigned short tmp, mask = 1 << dport->port.line;
111
112         tmp = dz_in(dport, DZ_TCR);     /* read the TX flag */
113         tmp &= ~mask;                   /* clear the TX flag */
114         dz_out(dport, DZ_TCR, tmp);
115 }
116
117 static void dz_start_tx(struct uart_port *uport)
118 {
119         struct dz_port *dport = (struct dz_port *)uport;
120         unsigned short tmp, mask = 1 << dport->port.line;
121
122         tmp = dz_in(dport, DZ_TCR);     /* read the TX flag */
123         tmp |= mask;                    /* set the TX flag */
124         dz_out(dport, DZ_TCR, tmp);
125 }
126
127 static void dz_stop_rx(struct uart_port *uport)
128 {
129         struct dz_port *dport = (struct dz_port *)uport;
130
131         dport->cflag &= ~DZ_RXENAB;
132         dz_out(dport, DZ_LPR, dport->cflag);
133 }
134
135 static void dz_enable_ms(struct uart_port *port)
136 {
137         /* nothing to do */
138 }
139
140 /*
141  * ------------------------------------------------------------
142  *
143  * Here start the interrupt handling routines.  All of the following
144  * subroutines are declared as inline and are folded into
145  * dz_interrupt.  They were separated out for readability's sake.
146  *
147  * Note: dz_interrupt() is a "fast" interrupt, which means that it
148  * runs with interrupts turned off.  People who may want to modify
149  * dz_interrupt() should try to keep the interrupt handler as fast as
150  * possible.  After you are done making modifications, it is not a bad
151  * idea to do:
152  *
153  *      make drivers/serial/dz.s
154  *
155  * and look at the resulting assemble code in dz.s.
156  *
157  * ------------------------------------------------------------
158  */
159
160 /*
161  * ------------------------------------------------------------
162  * receive_char ()
163  *
164  * This routine deals with inputs from any lines.
165  * ------------------------------------------------------------
166  */
167 static inline void dz_receive_chars(struct dz_port *dport_in)
168 {
169         struct uart_port *uport;
170         struct dz_port *dport;
171         struct tty_struct *tty = NULL;
172         struct uart_icount *icount;
173         int lines_rx[DZ_NB_PORT] = { [0 ... DZ_NB_PORT - 1] = 0 };
174         unsigned short status;
175         unsigned char ch, flag;
176         int i;
177
178         while ((status = dz_in(dport_in, DZ_RBUF)) & DZ_DVAL) {
179                 dport = &dz_ports[LINE(status)];
180                 uport = &dport->port;
181                 tty = uport->info->tty;         /* point to the proper dev */
182
183                 ch = UCHAR(status);             /* grab the char */
184                 flag = TTY_NORMAL;
185
186                 icount = &uport->icount;
187                 icount->rx++;
188
189                 if (unlikely(status & (DZ_OERR | DZ_FERR | DZ_PERR))) {
190
191                         /*
192                          * There is no separate BREAK status bit, so treat
193                          * null characters with framing errors as BREAKs;
194                          * normally, otherwise.  For this move the Framing
195                          * Error bit to a simulated BREAK bit.
196                          */
197                         if (!ch) {
198                                 status |= (status & DZ_FERR) >>
199                                           (ffs(DZ_FERR) - ffs(DZ_BREAK));
200                                 status &= ~DZ_FERR;
201                         }
202
203                         /* Handle SysRq/SAK & keep track of the statistics. */
204                         if (status & DZ_BREAK) {
205                                 icount->brk++;
206                                 if (uart_handle_break(uport))
207                                         continue;
208                         } else if (status & DZ_FERR)
209                                 icount->frame++;
210                         else if (status & DZ_PERR)
211                                 icount->parity++;
212                         if (status & DZ_OERR)
213                                 icount->overrun++;
214
215                         status &= uport->read_status_mask;
216                         if (status & DZ_BREAK)
217                                 flag = TTY_BREAK;
218                         else if (status & DZ_FERR)
219                                 flag = TTY_FRAME;
220                         else if (status & DZ_PERR)
221                                 flag = TTY_PARITY;
222
223                 }
224
225                 if (uart_handle_sysrq_char(uport, ch))
226                         continue;
227
228                 uart_insert_char(uport, status, DZ_OERR, ch, flag);
229                 lines_rx[LINE(status)] = 1;
230         }
231         for (i = 0; i < DZ_NB_PORT; i++)
232                 if (lines_rx[i])
233                         tty_flip_buffer_push(dz_ports[i].port.info->tty);
234 }
235
236 /*
237  * ------------------------------------------------------------
238  * transmit_char ()
239  *
240  * This routine deals with outputs to any lines.
241  * ------------------------------------------------------------
242  */
243 static inline void dz_transmit_chars(struct dz_port *dport_in)
244 {
245         struct dz_port *dport;
246         struct circ_buf *xmit;
247         unsigned short status;
248         unsigned char tmp;
249
250         status = dz_in(dport_in, DZ_CSR);
251         dport = &dz_ports[LINE(status)];
252         xmit = &dport->port.info->xmit;
253
254         if (dport->port.x_char) {               /* XON/XOFF chars */
255                 dz_out(dport, DZ_TDR, dport->port.x_char);
256                 dport->port.icount.tx++;
257                 dport->port.x_char = 0;
258                 return;
259         }
260         /* If nothing to do or stopped or hardware stopped. */
261         if (uart_circ_empty(xmit) || uart_tx_stopped(&dport->port)) {
262                 spin_lock(&dport->port.lock);
263                 dz_stop_tx(&dport->port);
264                 spin_unlock(&dport->port.lock);
265                 return;
266         }
267
268         /*
269          * If something to do... (remember the dz has no output fifo,
270          * so we go one char at a time) :-<
271          */
272         tmp = xmit->buf[xmit->tail];
273         xmit->tail = (xmit->tail + 1) & (DZ_XMIT_SIZE - 1);
274         dz_out(dport, DZ_TDR, tmp);
275         dport->port.icount.tx++;
276
277         if (uart_circ_chars_pending(xmit) < DZ_WAKEUP_CHARS)
278                 uart_write_wakeup(&dport->port);
279
280         /* Are we are done. */
281         if (uart_circ_empty(xmit)) {
282                 spin_lock(&dport->port.lock);
283                 dz_stop_tx(&dport->port);
284                 spin_unlock(&dport->port.lock);
285         }
286 }
287
288 /*
289  * ------------------------------------------------------------
290  * check_modem_status()
291  *
292  * DS 3100 & 5100: Only valid for the MODEM line, duh!
293  * DS 5000/200: Valid for the MODEM and PRINTER line.
294  * ------------------------------------------------------------
295  */
296 static inline void check_modem_status(struct dz_port *dport)
297 {
298         /*
299          * FIXME:
300          * 1. No status change interrupt; use a timer.
301          * 2. Handle the 3100/5000 as appropriate. --macro
302          */
303         unsigned short status;
304
305         /* If not the modem line just return.  */
306         if (dport->port.line != DZ_MODEM)
307                 return;
308
309         status = dz_in(dport, DZ_MSR);
310
311         /* it's easy, since DSR2 is the only bit in the register */
312         if (status)
313                 dport->port.icount.dsr++;
314 }
315
316 /*
317  * ------------------------------------------------------------
318  * dz_interrupt ()
319  *
320  * this is the main interrupt routine for the DZ chip.
321  * It deals with the multiple ports.
322  * ------------------------------------------------------------
323  */
324 static irqreturn_t dz_interrupt(int irq, void *dev)
325 {
326         struct dz_port *dport = dev;
327         unsigned short status;
328
329         /* get the reason why we just got an irq */
330         status = dz_in(dport, DZ_CSR);
331
332         if ((status & (DZ_RDONE | DZ_RIE)) == (DZ_RDONE | DZ_RIE))
333                 dz_receive_chars(dport);
334
335         if ((status & (DZ_TRDY | DZ_TIE)) == (DZ_TRDY | DZ_TIE))
336                 dz_transmit_chars(dport);
337
338         return IRQ_HANDLED;
339 }
340
341 /*
342  * -------------------------------------------------------------------
343  * Here ends the DZ interrupt routines.
344  * -------------------------------------------------------------------
345  */
346
347 static unsigned int dz_get_mctrl(struct uart_port *uport)
348 {
349         /*
350          * FIXME: Handle the 3100/5000 as appropriate. --macro
351          */
352         struct dz_port *dport = (struct dz_port *)uport;
353         unsigned int mctrl = TIOCM_CAR | TIOCM_DSR | TIOCM_CTS;
354
355         if (dport->port.line == DZ_MODEM) {
356                 if (dz_in(dport, DZ_MSR) & DZ_MODEM_DSR)
357                         mctrl &= ~TIOCM_DSR;
358         }
359
360         return mctrl;
361 }
362
363 static void dz_set_mctrl(struct uart_port *uport, unsigned int mctrl)
364 {
365         /*
366          * FIXME: Handle the 3100/5000 as appropriate. --macro
367          */
368         struct dz_port *dport = (struct dz_port *)uport;
369         unsigned short tmp;
370
371         if (dport->port.line == DZ_MODEM) {
372                 tmp = dz_in(dport, DZ_TCR);
373                 if (mctrl & TIOCM_DTR)
374                         tmp &= ~DZ_MODEM_DTR;
375                 else
376                         tmp |= DZ_MODEM_DTR;
377                 dz_out(dport, DZ_TCR, tmp);
378         }
379 }
380
381 /*
382  * -------------------------------------------------------------------
383  * startup ()
384  *
385  * various initialization tasks
386  * -------------------------------------------------------------------
387  */
388 static int dz_startup(struct uart_port *uport)
389 {
390         struct dz_port *dport = (struct dz_port *)uport;
391         unsigned long flags;
392         unsigned short tmp;
393
394         spin_lock_irqsave(&dport->port.lock, flags);
395
396         /* enable the interrupt and the scanning */
397         tmp = dz_in(dport, DZ_CSR);
398         tmp |= DZ_RIE | DZ_TIE | DZ_MSE;
399         dz_out(dport, DZ_CSR, tmp);
400
401         spin_unlock_irqrestore(&dport->port.lock, flags);
402
403         return 0;
404 }
405
406 /*
407  * -------------------------------------------------------------------
408  * shutdown ()
409  *
410  * This routine will shutdown a serial port; interrupts are disabled, and
411  * DTR is dropped if the hangup on close termio flag is on.
412  * -------------------------------------------------------------------
413  */
414 static void dz_shutdown(struct uart_port *uport)
415 {
416         struct dz_port *dport = (struct dz_port *)uport;
417         unsigned long flags;
418
419         spin_lock_irqsave(&dport->port.lock, flags);
420         dz_stop_tx(&dport->port);
421         spin_unlock_irqrestore(&dport->port.lock, flags);
422 }
423
424 /*
425  * -------------------------------------------------------------------
426  * dz_tx_empty() -- get the transmitter empty status
427  *
428  * Purpose: Let user call ioctl() to get info when the UART physically
429  *          is emptied.  On bus types like RS485, the transmitter must
430  *          release the bus after transmitting. This must be done when
431  *          the transmit shift register is empty, not be done when the
432  *          transmit holding register is empty.  This functionality
433  *          allows an RS485 driver to be written in user space.
434  * -------------------------------------------------------------------
435  */
436 static unsigned int dz_tx_empty(struct uart_port *uport)
437 {
438         struct dz_port *dport = (struct dz_port *)uport;
439         unsigned short tmp, mask = 1 << dport->port.line;
440
441         tmp = dz_in(dport, DZ_TCR);
442         tmp &= mask;
443
444         return tmp ? 0 : TIOCSER_TEMT;
445 }
446
447 static void dz_break_ctl(struct uart_port *uport, int break_state)
448 {
449         /*
450          * FIXME: Can't access BREAK bits in TDR easily;
451          * reuse the code for polled TX. --macro
452          */
453         struct dz_port *dport = (struct dz_port *)uport;
454         unsigned long flags;
455         unsigned short tmp, mask = 1 << dport->port.line;
456
457         spin_lock_irqsave(&uport->lock, flags);
458         tmp = dz_in(dport, DZ_TCR);
459         if (break_state)
460                 tmp |= mask;
461         else
462                 tmp &= ~mask;
463         dz_out(dport, DZ_TCR, tmp);
464         spin_unlock_irqrestore(&uport->lock, flags);
465 }
466
467 static int dz_encode_baud_rate(unsigned int baud)
468 {
469         switch (baud) {
470         case 50:
471                 return DZ_B50;
472         case 75:
473                 return DZ_B75;
474         case 110:
475                 return DZ_B110;
476         case 134:
477                 return DZ_B134;
478         case 150:
479                 return DZ_B150;
480         case 300:
481                 return DZ_B300;
482         case 600:
483                 return DZ_B600;
484         case 1200:
485                 return DZ_B1200;
486         case 1800:
487                 return DZ_B1800;
488         case 2000:
489                 return DZ_B2000;
490         case 2400:
491                 return DZ_B2400;
492         case 3600:
493                 return DZ_B3600;
494         case 4800:
495                 return DZ_B4800;
496         case 7200:
497                 return DZ_B7200;
498         case 9600:
499                 return DZ_B9600;
500         default:
501                 return -1;
502         }
503 }
504
505 static void dz_set_termios(struct uart_port *uport, struct ktermios *termios,
506                            struct ktermios *old_termios)
507 {
508         struct dz_port *dport = (struct dz_port *)uport;
509         unsigned long flags;
510         unsigned int cflag, baud;
511         int bflag;
512
513         cflag = dport->port.line;
514
515         switch (termios->c_cflag & CSIZE) {
516         case CS5:
517                 cflag |= DZ_CS5;
518                 break;
519         case CS6:
520                 cflag |= DZ_CS6;
521                 break;
522         case CS7:
523                 cflag |= DZ_CS7;
524                 break;
525         case CS8:
526         default:
527                 cflag |= DZ_CS8;
528         }
529
530         if (termios->c_cflag & CSTOPB)
531                 cflag |= DZ_CSTOPB;
532         if (termios->c_cflag & PARENB)
533                 cflag |= DZ_PARENB;
534         if (termios->c_cflag & PARODD)
535                 cflag |= DZ_PARODD;
536
537         baud = uart_get_baud_rate(uport, termios, old_termios, 50, 9600);
538         bflag = dz_encode_baud_rate(baud);
539         if (bflag < 0)  {                       /* Try to keep unchanged.  */
540                 baud = uart_get_baud_rate(uport, old_termios, NULL, 50, 9600);
541                 bflag = dz_encode_baud_rate(baud);
542                 if (bflag < 0)  {               /* Resort to 9600.  */
543                         baud = 9600;
544                         bflag = DZ_B9600;
545                 }
546                 tty_termios_encode_baud_rate(termios, baud, baud);
547         }
548         cflag |= bflag;
549
550         if (termios->c_cflag & CREAD)
551                 cflag |= DZ_RXENAB;
552
553         spin_lock_irqsave(&dport->port.lock, flags);
554
555         uart_update_timeout(uport, termios->c_cflag, baud);
556
557         dz_out(dport, DZ_LPR, cflag);
558         dport->cflag = cflag;
559
560         /* setup accept flag */
561         dport->port.read_status_mask = DZ_OERR;
562         if (termios->c_iflag & INPCK)
563                 dport->port.read_status_mask |= DZ_FERR | DZ_PERR;
564         if (termios->c_iflag & (BRKINT | PARMRK))
565                 dport->port.read_status_mask |= DZ_BREAK;
566
567         /* characters to ignore */
568         uport->ignore_status_mask = 0;
569         if ((termios->c_iflag & (IGNPAR | IGNBRK)) == (IGNPAR | IGNBRK))
570                 dport->port.ignore_status_mask |= DZ_OERR;
571         if (termios->c_iflag & IGNPAR)
572                 dport->port.ignore_status_mask |= DZ_FERR | DZ_PERR;
573         if (termios->c_iflag & IGNBRK)
574                 dport->port.ignore_status_mask |= DZ_BREAK;
575
576         spin_unlock_irqrestore(&dport->port.lock, flags);
577 }
578
579 static const char *dz_type(struct uart_port *port)
580 {
581         return "DZ";
582 }
583
584 static void dz_release_port(struct uart_port *port)
585 {
586         /* nothing to do */
587 }
588
589 static int dz_request_port(struct uart_port *port)
590 {
591         return 0;
592 }
593
594 static void dz_config_port(struct uart_port *port, int flags)
595 {
596         if (flags & UART_CONFIG_TYPE)
597                 port->type = PORT_DZ;
598 }
599
600 /*
601  * verify the new serial_struct (for TIOCSSERIAL).
602  */
603 static int dz_verify_port(struct uart_port *port, struct serial_struct *ser)
604 {
605         int ret = 0;
606         if (ser->type != PORT_UNKNOWN && ser->type != PORT_DZ)
607                 ret = -EINVAL;
608         if (ser->irq != port->irq)
609                 ret = -EINVAL;
610         return ret;
611 }
612
613 static struct uart_ops dz_ops = {
614         .tx_empty       = dz_tx_empty,
615         .get_mctrl      = dz_get_mctrl,
616         .set_mctrl      = dz_set_mctrl,
617         .stop_tx        = dz_stop_tx,
618         .start_tx       = dz_start_tx,
619         .stop_rx        = dz_stop_rx,
620         .enable_ms      = dz_enable_ms,
621         .break_ctl      = dz_break_ctl,
622         .startup        = dz_startup,
623         .shutdown       = dz_shutdown,
624         .set_termios    = dz_set_termios,
625         .type           = dz_type,
626         .release_port   = dz_release_port,
627         .request_port   = dz_request_port,
628         .config_port    = dz_config_port,
629         .verify_port    = dz_verify_port,
630 };
631
632 static void __init dz_init_ports(void)
633 {
634         static int first = 1;
635         struct dz_port *dport;
636         unsigned long base;
637         int i;
638
639         if (!first)
640                 return;
641         first = 0;
642
643         if (mips_machtype == MACH_DS23100 ||
644             mips_machtype == MACH_DS5100)
645                 base = CKSEG1ADDR(KN01_SLOT_BASE + KN01_DZ11);
646         else
647                 base = CKSEG1ADDR(KN02_SLOT_BASE + KN02_DZ11);
648
649         for (i = 0, dport = dz_ports; i < DZ_NB_PORT; i++, dport++) {
650                 spin_lock_init(&dport->port.lock);
651                 dport->port.membase     = (char *) base;
652                 dport->port.iotype      = UPIO_MEM;
653                 dport->port.irq         = dec_interrupt[DEC_IRQ_DZ11];
654                 dport->port.line        = i;
655                 dport->port.fifosize    = 1;
656                 dport->port.ops         = &dz_ops;
657                 dport->port.flags       = UPF_BOOT_AUTOCONF;
658         }
659 }
660
661 static void dz_reset(struct dz_port *dport)
662 {
663         dz_out(dport, DZ_CSR, DZ_CLR);
664         while (dz_in(dport, DZ_CSR) & DZ_CLR);
665         iob();
666
667         /* enable scanning */
668         dz_out(dport, DZ_CSR, DZ_MSE);
669 }
670
671 #ifdef CONFIG_SERIAL_DZ_CONSOLE
672 /*
673  * -------------------------------------------------------------------
674  * dz_console_putchar() -- transmit a character
675  *
676  * Polled transmission.  This is tricky.  We need to mask transmit
677  * interrupts so that they do not interfere, enable the transmitter
678  * for the line requested and then wait till the transmit scanner
679  * requests data for this line.  But it may request data for another
680  * line first, in which case we have to disable its transmitter and
681  * repeat waiting till our line pops up.  Only then the character may
682  * be transmitted.  Finally, the state of the transmitter mask is
683  * restored.  Welcome to the world of PDP-11!
684  * -------------------------------------------------------------------
685  */
686 static void dz_console_putchar(struct uart_port *uport, int ch)
687 {
688         struct dz_port *dport = (struct dz_port *)uport;
689         unsigned long flags;
690         unsigned short csr, tcr, trdy, mask;
691         int loops = 10000;
692
693         spin_lock_irqsave(&dport->port.lock, flags);
694         csr = dz_in(dport, DZ_CSR);
695         dz_out(dport, DZ_CSR, csr & ~DZ_TIE);
696         tcr = dz_in(dport, DZ_TCR);
697         tcr |= 1 << dport->port.line;
698         mask = tcr;
699         dz_out(dport, DZ_TCR, mask);
700         iob();
701         spin_unlock_irqrestore(&dport->port.lock, flags);
702
703         do {
704                 trdy = dz_in(dport, DZ_CSR);
705                 if (!(trdy & DZ_TRDY))
706                         continue;
707                 trdy = (trdy & DZ_TLINE) >> 8;
708                 if (trdy == dport->port.line)
709                         break;
710                 mask &= ~(1 << trdy);
711                 dz_out(dport, DZ_TCR, mask);
712                 iob();
713                 udelay(2);
714         } while (loops--);
715
716         if (loops)                              /* Cannot send otherwise. */
717                 dz_out(dport, DZ_TDR, ch);
718
719         dz_out(dport, DZ_TCR, tcr);
720         dz_out(dport, DZ_CSR, csr);
721 }
722
723 /*
724  * -------------------------------------------------------------------
725  * dz_console_print ()
726  *
727  * dz_console_print is registered for printk.
728  * The console must be locked when we get here.
729  * -------------------------------------------------------------------
730  */
731 static void dz_console_print(struct console *co,
732                              const char *str,
733                              unsigned int count)
734 {
735         struct dz_port *dport = &dz_ports[co->index];
736 #ifdef DEBUG_DZ
737         prom_printf((char *) str);
738 #endif
739         uart_console_write(&dport->port, str, count, dz_console_putchar);
740 }
741
742 static int __init dz_console_setup(struct console *co, char *options)
743 {
744         struct dz_port *dport = &dz_ports[co->index];
745         int baud = 9600;
746         int bits = 8;
747         int parity = 'n';
748         int flow = 'n';
749
750         if (options)
751                 uart_parse_options(options, &baud, &parity, &bits, &flow);
752
753         dz_reset(dport);
754
755         return uart_set_options(&dport->port, co, baud, parity, bits, flow);
756 }
757
758 static struct uart_driver dz_reg;
759 static struct console dz_console = {
760         .name   = "ttyS",
761         .write  = dz_console_print,
762         .device = uart_console_device,
763         .setup  = dz_console_setup,
764         .flags  = CON_PRINTBUFFER,
765         .index  = -1,
766         .data   = &dz_reg,
767 };
768
769 static int __init dz_serial_console_init(void)
770 {
771         if (!IOASIC) {
772                 dz_init_ports();
773                 register_console(&dz_console);
774                 return 0;
775         } else
776                 return -ENXIO;
777 }
778
779 console_initcall(dz_serial_console_init);
780
781 #define SERIAL_DZ_CONSOLE       &dz_console
782 #else
783 #define SERIAL_DZ_CONSOLE       NULL
784 #endif /* CONFIG_SERIAL_DZ_CONSOLE */
785
786 static struct uart_driver dz_reg = {
787         .owner                  = THIS_MODULE,
788         .driver_name            = "serial",
789         .dev_name               = "ttyS",
790         .major                  = TTY_MAJOR,
791         .minor                  = 64,
792         .nr                     = DZ_NB_PORT,
793         .cons                   = SERIAL_DZ_CONSOLE,
794 };
795
796 static int __init dz_init(void)
797 {
798         int ret, i;
799
800         if (IOASIC)
801                 return -ENXIO;
802
803         printk("%s%s\n", dz_name, dz_version);
804
805         dz_init_ports();
806
807 #ifndef CONFIG_SERIAL_DZ_CONSOLE
808         /* reset the chip */
809         dz_reset(&dz_ports[0]);
810 #endif
811
812         ret = uart_register_driver(&dz_reg);
813         if (ret != 0)
814                 goto out;
815
816         ret = request_irq(dz_ports[0].port.irq, dz_interrupt, IRQF_DISABLED,
817                           "DZ", &dz_ports[0]);
818         if (ret != 0) {
819                 printk(KERN_ERR "dz: Cannot get IRQ %d!\n",
820                        dz_ports[0].port.irq);
821                 goto out_unregister;
822         }
823
824         for (i = 0; i < DZ_NB_PORT; i++)
825                 uart_add_one_port(&dz_reg, &dz_ports[i].port);
826
827         return ret;
828
829 out_unregister:
830         uart_unregister_driver(&dz_reg);
831
832 out:
833         return ret;
834 }
835
836 module_init(dz_init);
837
838 MODULE_DESCRIPTION("DECstation DZ serial driver");
839 MODULE_LICENSE("GPL");