[SCSI] scsi_debug: use shost_priv macro
[linux-2.6] / drivers / char / serial167.c
1 /*
2  * linux/drivers/char/serial167.c
3  *
4  * Driver for MVME166/7 board serial ports, which are via a CD2401.
5  * Based very much on cyclades.c.
6  *
7  * MVME166/7 work by Richard Hirst [richard@sleepie.demon.co.uk]
8  *
9  * ==============================================================
10  *
11  * static char rcsid[] =
12  * "$Revision: 1.36.1.4 $$Date: 1995/03/29 06:14:14 $";
13  *
14  *  linux/kernel/cyclades.c
15  *
16  * Maintained by Marcio Saito (cyclades@netcom.com) and
17  * Randolph Bentson (bentson@grieg.seaslug.org)
18  *
19  * Much of the design and some of the code came from serial.c
20  * which was copyright (C) 1991, 1992  Linus Torvalds.  It was
21  * extensively rewritten by Theodore Ts'o, 8/16/92 -- 9/14/92,
22  * and then fixed as suggested by Michael K. Johnson 12/12/92.
23  *
24  * This version does not support shared irq's.
25  *
26  * $Log: cyclades.c,v $
27  * Revision 1.36.1.4  1995/03/29  06:14:14  bentson
28  * disambiguate between Cyclom-16Y and Cyclom-32Ye;
29  *
30  * Changes:
31  *
32  * 200 lines of changes record removed - RGH 11-10-95, starting work on
33  * converting this to drive serial ports on mvme166 (cd2401).
34  *
35  * Arnaldo Carvalho de Melo <acme@conectiva.com.br> - 2000/08/25
36  * - get rid of verify_area
37  * - use get_user to access memory from userspace in set_threshold,
38  *   set_default_threshold and set_timeout
39  * - don't use the panic function in serial167_init
40  * - do resource release on failure on serial167_init
41  * - include missing restore_flags in mvme167_serial_console_setup
42  *
43  * Kars de Jong <jongk@linux-m68k.org> - 2004/09/06
44  * - replace bottom half handler with task queue handler
45  */
46
47 #include <linux/errno.h>
48 #include <linux/signal.h>
49 #include <linux/sched.h>
50 #include <linux/timer.h>
51 #include <linux/tty.h>
52 #include <linux/interrupt.h>
53 #include <linux/serial.h>
54 #include <linux/serialP.h>
55 #include <linux/string.h>
56 #include <linux/fcntl.h>
57 #include <linux/ptrace.h>
58 #include <linux/serial167.h>
59 #include <linux/delay.h>
60 #include <linux/major.h>
61 #include <linux/mm.h>
62 #include <linux/console.h>
63 #include <linux/module.h>
64 #include <linux/bitops.h>
65 #include <linux/tty_flip.h>
66
67 #include <asm/system.h>
68 #include <asm/io.h>
69 #include <asm/mvme16xhw.h>
70 #include <asm/bootinfo.h>
71 #include <asm/setup.h>
72
73 #include <linux/types.h>
74 #include <linux/kernel.h>
75
76 #include <asm/uaccess.h>
77 #include <linux/init.h>
78
79 #define SERIAL_PARANOIA_CHECK
80 #undef  SERIAL_DEBUG_OPEN
81 #undef  SERIAL_DEBUG_THROTTLE
82 #undef  SERIAL_DEBUG_OTHER
83 #undef  SERIAL_DEBUG_IO
84 #undef  SERIAL_DEBUG_COUNT
85 #undef  SERIAL_DEBUG_DTR
86 #undef  CYCLOM_16Y_HACK
87 #define  CYCLOM_ENABLE_MONITORING
88
89 #define WAKEUP_CHARS 256
90
91 #define STD_COM_FLAGS (0)
92
93 static struct tty_driver *cy_serial_driver;
94 extern int serial_console;
95 static struct cyclades_port *serial_console_info = NULL;
96 static unsigned int serial_console_cflag = 0;
97 u_char initial_console_speed;
98
99 /* Base address of cd2401 chip on mvme166/7 */
100
101 #define BASE_ADDR (0xfff45000)
102 #define pcc2chip        ((volatile u_char *)0xfff42000)
103 #define PccSCCMICR      0x1d
104 #define PccSCCTICR      0x1e
105 #define PccSCCRICR      0x1f
106 #define PccTPIACKR      0x25
107 #define PccRPIACKR      0x27
108 #define PccIMLR         0x3f
109
110 /* This is the per-port data structure */
111 struct cyclades_port cy_port[] = {
112         /* CARD#  */
113         {-1},                   /* ttyS0 */
114         {-1},                   /* ttyS1 */
115         {-1},                   /* ttyS2 */
116         {-1},                   /* ttyS3 */
117 };
118
119 #define NR_PORTS        ARRAY_SIZE(cy_port)
120
121 /*
122  * This is used to look up the divisor speeds and the timeouts
123  * We're normally limited to 15 distinct baud rates.  The extra
124  * are accessed via settings in info->flags.
125  *         0,     1,     2,     3,     4,     5,     6,     7,     8,     9,
126  *        10,    11,    12,    13,    14,    15,    16,    17,    18,    19,
127  *                                                  HI            VHI
128  */
129 static int baud_table[] = {
130         0, 50, 75, 110, 134, 150, 200, 300, 600, 1200,
131         1800, 2400, 4800, 9600, 19200, 38400, 57600, 76800, 115200, 150000,
132         0
133 };
134
135 #if 0
136 static char baud_co[] = {       /* 25 MHz clock option table */
137         /* value =>    00    01   02    03    04 */
138         /* divide by    8    32   128   512  2048 */
139         0x00, 0x04, 0x04, 0x04, 0x04, 0x04, 0x03, 0x03, 0x03, 0x02,
140         0x02, 0x02, 0x01, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
141 };
142
143 static char baud_bpr[] = {      /* 25 MHz baud rate period table */
144         0x00, 0xf5, 0xa3, 0x6f, 0x5c, 0x51, 0xf5, 0xa3, 0x51, 0xa3,
145         0x6d, 0x51, 0xa3, 0x51, 0xa3, 0x51, 0x36, 0x29, 0x1b, 0x15
146 };
147 #endif
148
149 /* I think 166 brd clocks 2401 at 20MHz.... */
150
151 /* These values are written directly to tcor, and >> 5 for writing to rcor */
152 static u_char baud_co[] = {     /* 20 MHz clock option table */
153         0x00, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x60, 0x60, 0x40,
154         0x40, 0x40, 0x20, 0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
155 };
156
157 /* These values written directly to tbpr/rbpr */
158 static u_char baud_bpr[] = {    /* 20 MHz baud rate period table */
159         0x00, 0xc0, 0x80, 0x58, 0x6c, 0x40, 0xc0, 0x81, 0x40, 0x81,
160         0x57, 0x40, 0x81, 0x40, 0x81, 0x40, 0x2b, 0x20, 0x15, 0x10
161 };
162
163 static u_char baud_cor4[] = {   /* receive threshold */
164         0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a, 0x0a,
165         0x0a, 0x0a, 0x0a, 0x09, 0x09, 0x08, 0x08, 0x08, 0x08, 0x07
166 };
167
168 static void shutdown(struct cyclades_port *);
169 static int startup(struct cyclades_port *);
170 static void cy_throttle(struct tty_struct *);
171 static void cy_unthrottle(struct tty_struct *);
172 static void config_setup(struct cyclades_port *);
173 extern void console_print(const char *);
174 #ifdef CYCLOM_SHOW_STATUS
175 static void show_status(int);
176 #endif
177
178 #ifdef CONFIG_REMOTE_DEBUG
179 static void debug_setup(void);
180 void queueDebugChar(int c);
181 int getDebugChar(void);
182
183 #define DEBUG_PORT      1
184 #define DEBUG_LEN       256
185
186 typedef struct {
187         int in;
188         int out;
189         unsigned char buf[DEBUG_LEN];
190 } debugq;
191
192 debugq debugiq;
193 #endif
194
195 /*
196  * I have my own version of udelay(), as it is needed when initialising
197  * the chip, before the delay loop has been calibrated.  Should probably
198  * reference one of the vmechip2 or pccchip2 counter for an accurate
199  * delay, but this wild guess will do for now.
200  */
201
202 void my_udelay(long us)
203 {
204         u_char x;
205         volatile u_char *p = &x;
206         int i;
207
208         while (us--)
209                 for (i = 100; i; i--)
210                         x |= *p;
211 }
212
213 static inline int serial_paranoia_check(struct cyclades_port *info, char *name,
214                 const char *routine)
215 {
216 #ifdef SERIAL_PARANOIA_CHECK
217         if (!info) {
218                 printk("Warning: null cyclades_port for (%s) in %s\n", name,
219                                 routine);
220                 return 1;
221         }
222
223         if ((long)info < (long)(&cy_port[0])
224             || (long)(&cy_port[NR_PORTS]) < (long)info) {
225                 printk("Warning: cyclades_port out of range for (%s) in %s\n",
226                                 name, routine);
227                 return 1;
228         }
229
230         if (info->magic != CYCLADES_MAGIC) {
231                 printk("Warning: bad magic number for serial struct (%s) in "
232                                 "%s\n", name, routine);
233                 return 1;
234         }
235 #endif
236         return 0;
237 }                               /* serial_paranoia_check */
238
239 #if 0
240 /* The following diagnostic routines allow the driver to spew
241    information on the screen, even (especially!) during interrupts.
242  */
243 void SP(char *data)
244 {
245         unsigned long flags;
246         local_irq_save(flags);
247         console_print(data);
248         local_irq_restore(flags);
249 }
250
251 char scrn[2];
252 void CP(char data)
253 {
254         unsigned long flags;
255         local_irq_save(flags);
256         scrn[0] = data;
257         console_print(scrn);
258         local_irq_restore(flags);
259 }                               /* CP */
260
261 void CP1(int data)
262 {
263         (data < 10) ? CP(data + '0') : CP(data + 'A' - 10);
264 }                               /* CP1 */
265 void CP2(int data)
266 {
267         CP1((data >> 4) & 0x0f);
268         CP1(data & 0x0f);
269 }                               /* CP2 */
270 void CP4(int data)
271 {
272         CP2((data >> 8) & 0xff);
273         CP2(data & 0xff);
274 }                               /* CP4 */
275 void CP8(long data)
276 {
277         CP4((data >> 16) & 0xffff);
278         CP4(data & 0xffff);
279 }                               /* CP8 */
280 #endif
281
282 /* This routine waits up to 1000 micro-seconds for the previous
283    command to the Cirrus chip to complete and then issues the
284    new command.  An error is returned if the previous command
285    didn't finish within the time limit.
286  */
287 u_short write_cy_cmd(volatile u_char * base_addr, u_char cmd)
288 {
289         unsigned long flags;
290         volatile int i;
291
292         local_irq_save(flags);
293         /* Check to see that the previous command has completed */
294         for (i = 0; i < 100; i++) {
295                 if (base_addr[CyCCR] == 0) {
296                         break;
297                 }
298                 my_udelay(10L);
299         }
300         /* if the CCR never cleared, the previous command
301            didn't finish within the "reasonable time" */
302         if (i == 10) {
303                 local_irq_restore(flags);
304                 return (-1);
305         }
306
307         /* Issue the new command */
308         base_addr[CyCCR] = cmd;
309         local_irq_restore(flags);
310         return (0);
311 }                               /* write_cy_cmd */
312
313 /* cy_start and cy_stop provide software output flow control as a
314    function of XON/XOFF, software CTS, and other such stuff. */
315
316 static void cy_stop(struct tty_struct *tty)
317 {
318         struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
319         volatile unsigned char *base_addr = (unsigned char *)BASE_ADDR;
320         int channel;
321         unsigned long flags;
322
323 #ifdef SERIAL_DEBUG_OTHER
324         printk("cy_stop %s\n", tty->name);      /* */
325 #endif
326
327         if (serial_paranoia_check(info, tty->name, "cy_stop"))
328                 return;
329
330         channel = info->line;
331
332         local_irq_save(flags);
333         base_addr[CyCAR] = (u_char) (channel);  /* index channel */
334         base_addr[CyIER] &= ~(CyTxMpty | CyTxRdy);
335         local_irq_restore(flags);
336 }                               /* cy_stop */
337
338 static void cy_start(struct tty_struct *tty)
339 {
340         struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
341         volatile unsigned char *base_addr = (unsigned char *)BASE_ADDR;
342         int channel;
343         unsigned long flags;
344
345 #ifdef SERIAL_DEBUG_OTHER
346         printk("cy_start %s\n", tty->name);     /* */
347 #endif
348
349         if (serial_paranoia_check(info, tty->name, "cy_start"))
350                 return;
351
352         channel = info->line;
353
354         local_irq_save(flags);
355         base_addr[CyCAR] = (u_char) (channel);
356         base_addr[CyIER] |= CyTxMpty;
357         local_irq_restore(flags);
358 }                               /* cy_start */
359
360 /* The real interrupt service routines are called
361    whenever the card wants its hand held--chars
362    received, out buffer empty, modem change, etc.
363  */
364 static irqreturn_t cd2401_rxerr_interrupt(int irq, void *dev_id)
365 {
366         struct tty_struct *tty;
367         struct cyclades_port *info;
368         volatile unsigned char *base_addr = (unsigned char *)BASE_ADDR;
369         unsigned char err, rfoc;
370         int channel;
371         char data;
372
373         /* determine the channel and change to that context */
374         channel = (u_short) (base_addr[CyLICR] >> 2);
375         info = &cy_port[channel];
376         info->last_active = jiffies;
377
378         if ((err = base_addr[CyRISR]) & CyTIMEOUT) {
379                 /* This is a receive timeout interrupt, ignore it */
380                 base_addr[CyREOIR] = CyNOTRANS;
381                 return IRQ_HANDLED;
382         }
383
384         /* Read a byte of data if there is any - assume the error
385          * is associated with this character */
386
387         if ((rfoc = base_addr[CyRFOC]) != 0)
388                 data = base_addr[CyRDR];
389         else
390                 data = 0;
391
392         /* if there is nowhere to put the data, discard it */
393         if (info->tty == 0) {
394                 base_addr[CyREOIR] = rfoc ? 0 : CyNOTRANS;
395                 return IRQ_HANDLED;
396         } else {                /* there is an open port for this data */
397                 tty = info->tty;
398                 if (err & info->ignore_status_mask) {
399                         base_addr[CyREOIR] = rfoc ? 0 : CyNOTRANS;
400                         return IRQ_HANDLED;
401                 }
402                 if (tty_buffer_request_room(tty, 1) != 0) {
403                         if (err & info->read_status_mask) {
404                                 if (err & CyBREAK) {
405                                         tty_insert_flip_char(tty, data,
406                                                              TTY_BREAK);
407                                         if (info->flags & ASYNC_SAK) {
408                                                 do_SAK(tty);
409                                         }
410                                 } else if (err & CyFRAME) {
411                                         tty_insert_flip_char(tty, data,
412                                                              TTY_FRAME);
413                                 } else if (err & CyPARITY) {
414                                         tty_insert_flip_char(tty, data,
415                                                              TTY_PARITY);
416                                 } else if (err & CyOVERRUN) {
417                                         tty_insert_flip_char(tty, 0,
418                                                              TTY_OVERRUN);
419                                         /*
420                                            If the flip buffer itself is
421                                            overflowing, we still loose
422                                            the next incoming character.
423                                          */
424                                         if (tty_buffer_request_room(tty, 1) !=
425                                             0) {
426                                                 tty_insert_flip_char(tty, data,
427                                                                      TTY_FRAME);
428                                         }
429                                         /* These two conditions may imply */
430                                         /* a normal read should be done. */
431                                         /* else if(data & CyTIMEOUT) */
432                                         /* else if(data & CySPECHAR) */
433                                 } else {
434                                         tty_insert_flip_char(tty, 0,
435                                                              TTY_NORMAL);
436                                 }
437                         } else {
438                                 tty_insert_flip_char(tty, data, TTY_NORMAL);
439                         }
440                 } else {
441                         /* there was a software buffer overrun
442                            and nothing could be done about it!!! */
443                 }
444         }
445         tty_schedule_flip(tty);
446         /* end of service */
447         base_addr[CyREOIR] = rfoc ? 0 : CyNOTRANS;
448         return IRQ_HANDLED;
449 }                               /* cy_rxerr_interrupt */
450
451 static irqreturn_t cd2401_modem_interrupt(int irq, void *dev_id)
452 {
453         struct cyclades_port *info;
454         volatile unsigned char *base_addr = (unsigned char *)BASE_ADDR;
455         int channel;
456         int mdm_change;
457         int mdm_status;
458
459         /* determine the channel and change to that context */
460         channel = (u_short) (base_addr[CyLICR] >> 2);
461         info = &cy_port[channel];
462         info->last_active = jiffies;
463
464         mdm_change = base_addr[CyMISR];
465         mdm_status = base_addr[CyMSVR1];
466
467         if (info->tty == 0) {   /* nowhere to put the data, ignore it */
468                 ;
469         } else {
470                 if ((mdm_change & CyDCD)
471                     && (info->flags & ASYNC_CHECK_CD)) {
472                         if (mdm_status & CyDCD) {
473 /* CP('!'); */
474                                 wake_up_interruptible(&info->open_wait);
475                         } else {
476 /* CP('@'); */
477                                 tty_hangup(info->tty);
478                                 wake_up_interruptible(&info->open_wait);
479                                 info->flags &= ~ASYNC_NORMAL_ACTIVE;
480                         }
481                 }
482                 if ((mdm_change & CyCTS)
483                     && (info->flags & ASYNC_CTS_FLOW)) {
484                         if (info->tty->stopped) {
485                                 if (mdm_status & CyCTS) {
486                                         /* !!! cy_start isn't used because... */
487                                         info->tty->stopped = 0;
488                                         base_addr[CyIER] |= CyTxMpty;
489                                         tty_wakeup(info->tty);
490                                 }
491                         } else {
492                                 if (!(mdm_status & CyCTS)) {
493                                         /* !!! cy_stop isn't used because... */
494                                         info->tty->stopped = 1;
495                                         base_addr[CyIER] &=
496                                             ~(CyTxMpty | CyTxRdy);
497                                 }
498                         }
499                 }
500                 if (mdm_status & CyDSR) {
501                 }
502         }
503         base_addr[CyMEOIR] = 0;
504         return IRQ_HANDLED;
505 }                               /* cy_modem_interrupt */
506
507 static irqreturn_t cd2401_tx_interrupt(int irq, void *dev_id)
508 {
509         struct cyclades_port *info;
510         volatile unsigned char *base_addr = (unsigned char *)BASE_ADDR;
511         int channel;
512         int char_count, saved_cnt;
513         int outch;
514
515         /* determine the channel and change to that context */
516         channel = (u_short) (base_addr[CyLICR] >> 2);
517
518 #ifdef CONFIG_REMOTE_DEBUG
519         if (channel == DEBUG_PORT) {
520                 panic("TxInt on debug port!!!");
521         }
522 #endif
523
524         info = &cy_port[channel];
525
526         /* validate the port number (as configured and open) */
527         if ((channel < 0) || (NR_PORTS <= channel)) {
528                 base_addr[CyIER] &= ~(CyTxMpty | CyTxRdy);
529                 base_addr[CyTEOIR] = CyNOTRANS;
530                 return IRQ_HANDLED;
531         }
532         info->last_active = jiffies;
533         if (info->tty == 0) {
534                 base_addr[CyIER] &= ~(CyTxMpty | CyTxRdy);
535                 base_addr[CyTEOIR] = CyNOTRANS;
536                 return IRQ_HANDLED;
537         }
538
539         /* load the on-chip space available for outbound data */
540         saved_cnt = char_count = base_addr[CyTFTC];
541
542         if (info->x_char) {     /* send special char */
543                 outch = info->x_char;
544                 base_addr[CyTDR] = outch;
545                 char_count--;
546                 info->x_char = 0;
547         }
548
549         if (info->x_break) {
550                 /*  The Cirrus chip requires the "Embedded Transmit
551                    Commands" of start break, delay, and end break
552                    sequences to be sent.  The duration of the
553                    break is given in TICs, which runs at HZ
554                    (typically 100) and the PPR runs at 200 Hz,
555                    so the delay is duration * 200/HZ, and thus a
556                    break can run from 1/100 sec to about 5/4 sec.
557                    Need to check these values - RGH 141095.
558                  */
559                 base_addr[CyTDR] = 0;   /* start break */
560                 base_addr[CyTDR] = 0x81;
561                 base_addr[CyTDR] = 0;   /* delay a bit */
562                 base_addr[CyTDR] = 0x82;
563                 base_addr[CyTDR] = info->x_break * 200 / HZ;
564                 base_addr[CyTDR] = 0;   /* terminate break */
565                 base_addr[CyTDR] = 0x83;
566                 char_count -= 7;
567                 info->x_break = 0;
568         }
569
570         while (char_count > 0) {
571                 if (!info->xmit_cnt) {
572                         base_addr[CyIER] &= ~(CyTxMpty | CyTxRdy);
573                         break;
574                 }
575                 if (info->xmit_buf == 0) {
576                         base_addr[CyIER] &= ~(CyTxMpty | CyTxRdy);
577                         break;
578                 }
579                 if (info->tty->stopped || info->tty->hw_stopped) {
580                         base_addr[CyIER] &= ~(CyTxMpty | CyTxRdy);
581                         break;
582                 }
583                 /* Because the Embedded Transmit Commands have been
584                    enabled, we must check to see if the escape
585                    character, NULL, is being sent.  If it is, we
586                    must ensure that there is room for it to be
587                    doubled in the output stream.  Therefore we
588                    no longer advance the pointer when the character
589                    is fetched, but rather wait until after the check
590                    for a NULL output character. (This is necessary
591                    because there may not be room for the two chars
592                    needed to send a NULL.
593                  */
594                 outch = info->xmit_buf[info->xmit_tail];
595                 if (outch) {
596                         info->xmit_cnt--;
597                         info->xmit_tail = (info->xmit_tail + 1)
598                             & (PAGE_SIZE - 1);
599                         base_addr[CyTDR] = outch;
600                         char_count--;
601                 } else {
602                         if (char_count > 1) {
603                                 info->xmit_cnt--;
604                                 info->xmit_tail = (info->xmit_tail + 1)
605                                     & (PAGE_SIZE - 1);
606                                 base_addr[CyTDR] = outch;
607                                 base_addr[CyTDR] = 0;
608                                 char_count--;
609                                 char_count--;
610                         } else {
611                                 break;
612                         }
613                 }
614         }
615
616         if (info->xmit_cnt < WAKEUP_CHARS)
617                 tty_wakeup(info->tty);
618
619         base_addr[CyTEOIR] = (char_count != saved_cnt) ? 0 : CyNOTRANS;
620         return IRQ_HANDLED;
621 }                               /* cy_tx_interrupt */
622
623 static irqreturn_t cd2401_rx_interrupt(int irq, void *dev_id)
624 {
625         struct tty_struct *tty;
626         struct cyclades_port *info;
627         volatile unsigned char *base_addr = (unsigned char *)BASE_ADDR;
628         int channel;
629         char data;
630         int char_count;
631         int save_cnt;
632         int len;
633
634         /* determine the channel and change to that context */
635         channel = (u_short) (base_addr[CyLICR] >> 2);
636         info = &cy_port[channel];
637         info->last_active = jiffies;
638         save_cnt = char_count = base_addr[CyRFOC];
639
640 #ifdef CONFIG_REMOTE_DEBUG
641         if (channel == DEBUG_PORT) {
642                 while (char_count--) {
643                         data = base_addr[CyRDR];
644                         queueDebugChar(data);
645                 }
646         } else
647 #endif
648                 /* if there is nowhere to put the data, discard it */
649         if (info->tty == 0) {
650                 while (char_count--) {
651                         data = base_addr[CyRDR];
652                 }
653         } else {                /* there is an open port for this data */
654                 tty = info->tty;
655                 /* load # characters available from the chip */
656
657 #ifdef CYCLOM_ENABLE_MONITORING
658                 ++info->mon.int_count;
659                 info->mon.char_count += char_count;
660                 if (char_count > info->mon.char_max)
661                         info->mon.char_max = char_count;
662                 info->mon.char_last = char_count;
663 #endif
664                 len = tty_buffer_request_room(tty, char_count);
665                 while (len--) {
666                         data = base_addr[CyRDR];
667                         tty_insert_flip_char(tty, data, TTY_NORMAL);
668 #ifdef CYCLOM_16Y_HACK
669                         udelay(10L);
670 #endif
671                 }
672                 tty_schedule_flip(tty);
673         }
674         /* end of service */
675         base_addr[CyREOIR] = save_cnt ? 0 : CyNOTRANS;
676         return IRQ_HANDLED;
677 }                               /* cy_rx_interrupt */
678
679 /* This is called whenever a port becomes active;
680    interrupts are enabled and DTR & RTS are turned on.
681  */
682 static int startup(struct cyclades_port *info)
683 {
684         unsigned long flags;
685         volatile unsigned char *base_addr = (unsigned char *)BASE_ADDR;
686         int channel;
687
688         if (info->flags & ASYNC_INITIALIZED) {
689                 return 0;
690         }
691
692         if (!info->type) {
693                 if (info->tty) {
694                         set_bit(TTY_IO_ERROR, &info->tty->flags);
695                 }
696                 return 0;
697         }
698         if (!info->xmit_buf) {
699                 info->xmit_buf = (unsigned char *)get_zeroed_page(GFP_KERNEL);
700                 if (!info->xmit_buf) {
701                         return -ENOMEM;
702                 }
703         }
704
705         config_setup(info);
706
707         channel = info->line;
708
709 #ifdef SERIAL_DEBUG_OPEN
710         printk("startup channel %d\n", channel);
711 #endif
712
713         local_irq_save(flags);
714         base_addr[CyCAR] = (u_char) channel;
715         write_cy_cmd(base_addr, CyENB_RCVR | CyENB_XMTR);
716
717         base_addr[CyCAR] = (u_char) channel;    /* !!! Is this needed? */
718         base_addr[CyMSVR1] = CyRTS;
719 /* CP('S');CP('1'); */
720         base_addr[CyMSVR2] = CyDTR;
721
722 #ifdef SERIAL_DEBUG_DTR
723         printk("cyc: %d: raising DTR\n", __LINE__);
724         printk("     status: 0x%x, 0x%x\n", base_addr[CyMSVR1],
725                base_addr[CyMSVR2]);
726 #endif
727
728         base_addr[CyIER] |= CyRxData;
729         info->flags |= ASYNC_INITIALIZED;
730
731         if (info->tty) {
732                 clear_bit(TTY_IO_ERROR, &info->tty->flags);
733         }
734         info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;
735
736         local_irq_restore(flags);
737
738 #ifdef SERIAL_DEBUG_OPEN
739         printk(" done\n");
740 #endif
741         return 0;
742 }                               /* startup */
743
744 void start_xmit(struct cyclades_port *info)
745 {
746         unsigned long flags;
747         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
748         int channel;
749
750         channel = info->line;
751         local_irq_save(flags);
752         base_addr[CyCAR] = channel;
753         base_addr[CyIER] |= CyTxMpty;
754         local_irq_restore(flags);
755 }                               /* start_xmit */
756
757 /*
758  * This routine shuts down a serial port; interrupts are disabled,
759  * and DTR is dropped if the hangup on close termio flag is on.
760  */
761 static void shutdown(struct cyclades_port *info)
762 {
763         unsigned long flags;
764         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
765         int channel;
766
767         if (!(info->flags & ASYNC_INITIALIZED)) {
768 /* CP('$'); */
769                 return;
770         }
771
772         channel = info->line;
773
774 #ifdef SERIAL_DEBUG_OPEN
775         printk("shutdown channel %d\n", channel);
776 #endif
777
778         /* !!! REALLY MUST WAIT FOR LAST CHARACTER TO BE
779            SENT BEFORE DROPPING THE LINE !!!  (Perhaps
780            set some flag that is read when XMTY happens.)
781            Other choices are to delay some fixed interval
782            or schedule some later processing.
783          */
784         local_irq_save(flags);
785         if (info->xmit_buf) {
786                 free_page((unsigned long)info->xmit_buf);
787                 info->xmit_buf = NULL;
788         }
789
790         base_addr[CyCAR] = (u_char) channel;
791         if (!info->tty || (info->tty->termios->c_cflag & HUPCL)) {
792                 base_addr[CyMSVR1] = 0;
793 /* CP('C');CP('1'); */
794                 base_addr[CyMSVR2] = 0;
795 #ifdef SERIAL_DEBUG_DTR
796                 printk("cyc: %d: dropping DTR\n", __LINE__);
797                 printk("     status: 0x%x, 0x%x\n", base_addr[CyMSVR1],
798                        base_addr[CyMSVR2]);
799 #endif
800         }
801         write_cy_cmd(base_addr, CyDIS_RCVR);
802         /* it may be appropriate to clear _XMIT at
803            some later date (after testing)!!! */
804
805         if (info->tty) {
806                 set_bit(TTY_IO_ERROR, &info->tty->flags);
807         }
808         info->flags &= ~ASYNC_INITIALIZED;
809         local_irq_restore(flags);
810
811 #ifdef SERIAL_DEBUG_OPEN
812         printk(" done\n");
813 #endif
814 }                               /* shutdown */
815
816 /*
817  * This routine finds or computes the various line characteristics.
818  */
819 static void config_setup(struct cyclades_port *info)
820 {
821         unsigned long flags;
822         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
823         int channel;
824         unsigned cflag;
825         int i;
826         unsigned char ti, need_init_chan = 0;
827
828         if (!info->tty || !info->tty->termios) {
829                 return;
830         }
831         if (info->line == -1) {
832                 return;
833         }
834         cflag = info->tty->termios->c_cflag;
835
836         /* baud rate */
837         i = cflag & CBAUD;
838 #ifdef CBAUDEX
839 /* Starting with kernel 1.1.65, there is direct support for
840    higher baud rates.  The following code supports those
841    changes.  The conditional aspect allows this driver to be
842    used for earlier as well as later kernel versions.  (The
843    mapping is slightly different from serial.c because there
844    is still the possibility of supporting 75 kbit/sec with
845    the Cyclades board.)
846  */
847         if (i & CBAUDEX) {
848                 if (i == B57600)
849                         i = 16;
850                 else if (i == B115200)
851                         i = 18;
852 #ifdef B78600
853                 else if (i == B78600)
854                         i = 17;
855 #endif
856                 else
857                         info->tty->termios->c_cflag &= ~CBAUDEX;
858         }
859 #endif
860         if (i == 15) {
861                 if ((info->flags & ASYNC_SPD_MASK) == ASYNC_SPD_HI)
862                         i += 1;
863                 if ((info->flags & ASYNC_SPD_MASK) == ASYNC_SPD_VHI)
864                         i += 3;
865         }
866         /* Don't ever change the speed of the console port.  It will
867          * run at the speed specified in bootinfo, or at 19.2K */
868         /* Actually, it should run at whatever speed 166Bug was using */
869         /* Note info->timeout isn't used at present */
870         if (info != serial_console_info) {
871                 info->tbpr = baud_bpr[i];       /* Tx BPR */
872                 info->tco = baud_co[i]; /* Tx CO */
873                 info->rbpr = baud_bpr[i];       /* Rx BPR */
874                 info->rco = baud_co[i] >> 5;    /* Rx CO */
875                 if (baud_table[i] == 134) {
876                         info->timeout =
877                             (info->xmit_fifo_size * HZ * 30 / 269) + 2;
878                         /* get it right for 134.5 baud */
879                 } else if (baud_table[i]) {
880                         info->timeout =
881                             (info->xmit_fifo_size * HZ * 15 / baud_table[i]) +
882                             2;
883                         /* this needs to be propagated into the card info */
884                 } else {
885                         info->timeout = 0;
886                 }
887         }
888         /* By tradition (is it a standard?) a baud rate of zero
889            implies the line should be/has been closed.  A bit
890            later in this routine such a test is performed. */
891
892         /* byte size and parity */
893         info->cor7 = 0;
894         info->cor6 = 0;
895         info->cor5 = 0;
896         info->cor4 = (info->default_threshold ? info->default_threshold : baud_cor4[i]);        /* receive threshold */
897         /* Following two lines added 101295, RGH. */
898         /* It is obviously wrong to access CyCORx, and not info->corx here,
899          * try and remember to fix it later! */
900         channel = info->line;
901         base_addr[CyCAR] = (u_char) channel;
902         if (C_CLOCAL(info->tty)) {
903                 if (base_addr[CyIER] & CyMdmCh)
904                         base_addr[CyIER] &= ~CyMdmCh;   /* without modem intr */
905                 /* ignore 1->0 modem transitions */
906                 if (base_addr[CyCOR4] & (CyDSR | CyCTS | CyDCD))
907                         base_addr[CyCOR4] &= ~(CyDSR | CyCTS | CyDCD);
908                 /* ignore 0->1 modem transitions */
909                 if (base_addr[CyCOR5] & (CyDSR | CyCTS | CyDCD))
910                         base_addr[CyCOR5] &= ~(CyDSR | CyCTS | CyDCD);
911         } else {
912                 if ((base_addr[CyIER] & CyMdmCh) != CyMdmCh)
913                         base_addr[CyIER] |= CyMdmCh;    /* with modem intr */
914                 /* act on 1->0 modem transitions */
915                 if ((base_addr[CyCOR4] & (CyDSR | CyCTS | CyDCD)) !=
916                     (CyDSR | CyCTS | CyDCD))
917                         base_addr[CyCOR4] |= CyDSR | CyCTS | CyDCD;
918                 /* act on 0->1 modem transitions */
919                 if ((base_addr[CyCOR5] & (CyDSR | CyCTS | CyDCD)) !=
920                     (CyDSR | CyCTS | CyDCD))
921                         base_addr[CyCOR5] |= CyDSR | CyCTS | CyDCD;
922         }
923         info->cor3 = (cflag & CSTOPB) ? Cy_2_STOP : Cy_1_STOP;
924         info->cor2 = CyETC;
925         switch (cflag & CSIZE) {
926         case CS5:
927                 info->cor1 = Cy_5_BITS;
928                 break;
929         case CS6:
930                 info->cor1 = Cy_6_BITS;
931                 break;
932         case CS7:
933                 info->cor1 = Cy_7_BITS;
934                 break;
935         case CS8:
936                 info->cor1 = Cy_8_BITS;
937                 break;
938         }
939         if (cflag & PARENB) {
940                 if (cflag & PARODD) {
941                         info->cor1 |= CyPARITY_O;
942                 } else {
943                         info->cor1 |= CyPARITY_E;
944                 }
945         } else {
946                 info->cor1 |= CyPARITY_NONE;
947         }
948
949         /* CTS flow control flag */
950 #if 0
951         /* Don't complcate matters for now! RGH 141095 */
952         if (cflag & CRTSCTS) {
953                 info->flags |= ASYNC_CTS_FLOW;
954                 info->cor2 |= CyCtsAE;
955         } else {
956                 info->flags &= ~ASYNC_CTS_FLOW;
957                 info->cor2 &= ~CyCtsAE;
958         }
959 #endif
960         if (cflag & CLOCAL)
961                 info->flags &= ~ASYNC_CHECK_CD;
962         else
963                 info->flags |= ASYNC_CHECK_CD;
964
965      /***********************************************
966         The hardware option, CyRtsAO, presents RTS when
967         the chip has characters to send.  Since most modems
968         use RTS as reverse (inbound) flow control, this
969         option is not used.  If inbound flow control is
970         necessary, DTR can be programmed to provide the
971         appropriate signals for use with a non-standard
972         cable.  Contact Marcio Saito for details.
973      ***********************************************/
974
975         channel = info->line;
976
977         local_irq_save(flags);
978         base_addr[CyCAR] = (u_char) channel;
979
980         /* CyCMR set once only in mvme167_init_serial() */
981         if (base_addr[CyLICR] != channel << 2)
982                 base_addr[CyLICR] = channel << 2;
983         if (base_addr[CyLIVR] != 0x5c)
984                 base_addr[CyLIVR] = 0x5c;
985
986         /* tx and rx baud rate */
987
988         if (base_addr[CyCOR1] != info->cor1)
989                 need_init_chan = 1;
990         if (base_addr[CyTCOR] != info->tco)
991                 base_addr[CyTCOR] = info->tco;
992         if (base_addr[CyTBPR] != info->tbpr)
993                 base_addr[CyTBPR] = info->tbpr;
994         if (base_addr[CyRCOR] != info->rco)
995                 base_addr[CyRCOR] = info->rco;
996         if (base_addr[CyRBPR] != info->rbpr)
997                 base_addr[CyRBPR] = info->rbpr;
998
999         /* set line characteristics  according configuration */
1000
1001         if (base_addr[CySCHR1] != START_CHAR(info->tty))
1002                 base_addr[CySCHR1] = START_CHAR(info->tty);
1003         if (base_addr[CySCHR2] != STOP_CHAR(info->tty))
1004                 base_addr[CySCHR2] = STOP_CHAR(info->tty);
1005         if (base_addr[CySCRL] != START_CHAR(info->tty))
1006                 base_addr[CySCRL] = START_CHAR(info->tty);
1007         if (base_addr[CySCRH] != START_CHAR(info->tty))
1008                 base_addr[CySCRH] = START_CHAR(info->tty);
1009         if (base_addr[CyCOR1] != info->cor1)
1010                 base_addr[CyCOR1] = info->cor1;
1011         if (base_addr[CyCOR2] != info->cor2)
1012                 base_addr[CyCOR2] = info->cor2;
1013         if (base_addr[CyCOR3] != info->cor3)
1014                 base_addr[CyCOR3] = info->cor3;
1015         if (base_addr[CyCOR4] != info->cor4)
1016                 base_addr[CyCOR4] = info->cor4;
1017         if (base_addr[CyCOR5] != info->cor5)
1018                 base_addr[CyCOR5] = info->cor5;
1019         if (base_addr[CyCOR6] != info->cor6)
1020                 base_addr[CyCOR6] = info->cor6;
1021         if (base_addr[CyCOR7] != info->cor7)
1022                 base_addr[CyCOR7] = info->cor7;
1023
1024         if (need_init_chan)
1025                 write_cy_cmd(base_addr, CyINIT_CHAN);
1026
1027         base_addr[CyCAR] = (u_char) channel;    /* !!! Is this needed? */
1028
1029         /* 2ms default rx timeout */
1030         ti = info->default_timeout ? info->default_timeout : 0x02;
1031         if (base_addr[CyRTPRL] != ti)
1032                 base_addr[CyRTPRL] = ti;
1033         if (base_addr[CyRTPRH] != 0)
1034                 base_addr[CyRTPRH] = 0;
1035
1036         /* Set up RTS here also ????? RGH 141095 */
1037         if (i == 0) {           /* baud rate is zero, turn off line */
1038                 if ((base_addr[CyMSVR2] & CyDTR) == CyDTR)
1039                         base_addr[CyMSVR2] = 0;
1040 #ifdef SERIAL_DEBUG_DTR
1041                 printk("cyc: %d: dropping DTR\n", __LINE__);
1042                 printk("     status: 0x%x, 0x%x\n", base_addr[CyMSVR1],
1043                        base_addr[CyMSVR2]);
1044 #endif
1045         } else {
1046                 if ((base_addr[CyMSVR2] & CyDTR) != CyDTR)
1047                         base_addr[CyMSVR2] = CyDTR;
1048 #ifdef SERIAL_DEBUG_DTR
1049                 printk("cyc: %d: raising DTR\n", __LINE__);
1050                 printk("     status: 0x%x, 0x%x\n", base_addr[CyMSVR1],
1051                        base_addr[CyMSVR2]);
1052 #endif
1053         }
1054
1055         if (info->tty) {
1056                 clear_bit(TTY_IO_ERROR, &info->tty->flags);
1057         }
1058
1059         local_irq_restore(flags);
1060
1061 }                               /* config_setup */
1062
1063 static void cy_put_char(struct tty_struct *tty, unsigned char ch)
1064 {
1065         struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
1066         unsigned long flags;
1067
1068 #ifdef SERIAL_DEBUG_IO
1069         printk("cy_put_char %s(0x%02x)\n", tty->name, ch);
1070 #endif
1071
1072         if (serial_paranoia_check(info, tty->name, "cy_put_char"))
1073                 return;
1074
1075         if (!info->xmit_buf)
1076                 return;
1077
1078         local_irq_save(flags);
1079         if (info->xmit_cnt >= PAGE_SIZE - 1) {
1080                 local_irq_restore(flags);
1081                 return;
1082         }
1083
1084         info->xmit_buf[info->xmit_head++] = ch;
1085         info->xmit_head &= PAGE_SIZE - 1;
1086         info->xmit_cnt++;
1087         local_irq_restore(flags);
1088 }                               /* cy_put_char */
1089
1090 static void cy_flush_chars(struct tty_struct *tty)
1091 {
1092         struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
1093         unsigned long flags;
1094         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
1095         int channel;
1096
1097 #ifdef SERIAL_DEBUG_IO
1098         printk("cy_flush_chars %s\n", tty->name);       /* */
1099 #endif
1100
1101         if (serial_paranoia_check(info, tty->name, "cy_flush_chars"))
1102                 return;
1103
1104         if (info->xmit_cnt <= 0 || tty->stopped
1105             || tty->hw_stopped || !info->xmit_buf)
1106                 return;
1107
1108         channel = info->line;
1109
1110         local_irq_save(flags);
1111         base_addr[CyCAR] = channel;
1112         base_addr[CyIER] |= CyTxMpty;
1113         local_irq_restore(flags);
1114 }                               /* cy_flush_chars */
1115
1116 /* This routine gets called when tty_write has put something into
1117     the write_queue.  If the port is not already transmitting stuff,
1118     start it off by enabling interrupts.  The interrupt service
1119     routine will then ensure that the characters are sent.  If the
1120     port is already active, there is no need to kick it.
1121  */
1122 static int cy_write(struct tty_struct *tty, const unsigned char *buf, int count)
1123 {
1124         struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
1125         unsigned long flags;
1126         int c, total = 0;
1127
1128 #ifdef SERIAL_DEBUG_IO
1129         printk("cy_write %s\n", tty->name);     /* */
1130 #endif
1131
1132         if (serial_paranoia_check(info, tty->name, "cy_write")) {
1133                 return 0;
1134         }
1135
1136         if (!info->xmit_buf) {
1137                 return 0;
1138         }
1139
1140         while (1) {
1141                 local_irq_save(flags);
1142                 c = min_t(int, count, min(SERIAL_XMIT_SIZE - info->xmit_cnt - 1,
1143                                           SERIAL_XMIT_SIZE - info->xmit_head));
1144                 if (c <= 0) {
1145                         local_irq_restore(flags);
1146                         break;
1147                 }
1148
1149                 memcpy(info->xmit_buf + info->xmit_head, buf, c);
1150                 info->xmit_head =
1151                     (info->xmit_head + c) & (SERIAL_XMIT_SIZE - 1);
1152                 info->xmit_cnt += c;
1153                 local_irq_restore(flags);
1154
1155                 buf += c;
1156                 count -= c;
1157                 total += c;
1158         }
1159
1160         if (info->xmit_cnt && !tty->stopped && !tty->hw_stopped) {
1161                 start_xmit(info);
1162         }
1163         return total;
1164 }                               /* cy_write */
1165
1166 static int cy_write_room(struct tty_struct *tty)
1167 {
1168         struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
1169         int ret;
1170
1171 #ifdef SERIAL_DEBUG_IO
1172         printk("cy_write_room %s\n", tty->name);        /* */
1173 #endif
1174
1175         if (serial_paranoia_check(info, tty->name, "cy_write_room"))
1176                 return 0;
1177         ret = PAGE_SIZE - info->xmit_cnt - 1;
1178         if (ret < 0)
1179                 ret = 0;
1180         return ret;
1181 }                               /* cy_write_room */
1182
1183 static int cy_chars_in_buffer(struct tty_struct *tty)
1184 {
1185         struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
1186
1187 #ifdef SERIAL_DEBUG_IO
1188         printk("cy_chars_in_buffer %s %d\n", tty->name, info->xmit_cnt);        /* */
1189 #endif
1190
1191         if (serial_paranoia_check(info, tty->name, "cy_chars_in_buffer"))
1192                 return 0;
1193
1194         return info->xmit_cnt;
1195 }                               /* cy_chars_in_buffer */
1196
1197 static void cy_flush_buffer(struct tty_struct *tty)
1198 {
1199         struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
1200         unsigned long flags;
1201
1202 #ifdef SERIAL_DEBUG_IO
1203         printk("cy_flush_buffer %s\n", tty->name);      /* */
1204 #endif
1205
1206         if (serial_paranoia_check(info, tty->name, "cy_flush_buffer"))
1207                 return;
1208         local_irq_save(flags);
1209         info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;
1210         local_irq_restore(flags);
1211         tty_wakeup(tty);
1212 }                               /* cy_flush_buffer */
1213
1214 /* This routine is called by the upper-layer tty layer to signal
1215    that incoming characters should be throttled or that the
1216    throttle should be released.
1217  */
1218 static void cy_throttle(struct tty_struct *tty)
1219 {
1220         struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
1221         unsigned long flags;
1222         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
1223         int channel;
1224
1225 #ifdef SERIAL_DEBUG_THROTTLE
1226         char buf[64];
1227
1228         printk("throttle %s: %d....\n", tty_name(tty, buf),
1229                tty->ldisc.chars_in_buffer(tty));
1230         printk("cy_throttle %s\n", tty->name);
1231 #endif
1232
1233         if (serial_paranoia_check(info, tty->name, "cy_nthrottle")) {
1234                 return;
1235         }
1236
1237         if (I_IXOFF(tty)) {
1238                 info->x_char = STOP_CHAR(tty);
1239                 /* Should use the "Send Special Character" feature!!! */
1240         }
1241
1242         channel = info->line;
1243
1244         local_irq_save(flags);
1245         base_addr[CyCAR] = (u_char) channel;
1246         base_addr[CyMSVR1] = 0;
1247         local_irq_restore(flags);
1248 }                               /* cy_throttle */
1249
1250 static void cy_unthrottle(struct tty_struct *tty)
1251 {
1252         struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
1253         unsigned long flags;
1254         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
1255         int channel;
1256
1257 #ifdef SERIAL_DEBUG_THROTTLE
1258         char buf[64];
1259
1260         printk("throttle %s: %d....\n", tty_name(tty, buf),
1261                tty->ldisc.chars_in_buffer(tty));
1262         printk("cy_unthrottle %s\n", tty->name);
1263 #endif
1264
1265         if (serial_paranoia_check(info, tty->name, "cy_nthrottle")) {
1266                 return;
1267         }
1268
1269         if (I_IXOFF(tty)) {
1270                 info->x_char = START_CHAR(tty);
1271                 /* Should use the "Send Special Character" feature!!! */
1272         }
1273
1274         channel = info->line;
1275
1276         local_irq_save(flags);
1277         base_addr[CyCAR] = (u_char) channel;
1278         base_addr[CyMSVR1] = CyRTS;
1279         local_irq_restore(flags);
1280 }                               /* cy_unthrottle */
1281
1282 static int
1283 get_serial_info(struct cyclades_port *info,
1284                 struct serial_struct __user * retinfo)
1285 {
1286         struct serial_struct tmp;
1287
1288 /* CP('g'); */
1289         if (!retinfo)
1290                 return -EFAULT;
1291         memset(&tmp, 0, sizeof(tmp));
1292         tmp.type = info->type;
1293         tmp.line = info->line;
1294         tmp.port = info->line;
1295         tmp.irq = 0;
1296         tmp.flags = info->flags;
1297         tmp.baud_base = 0;      /*!!! */
1298         tmp.close_delay = info->close_delay;
1299         tmp.custom_divisor = 0; /*!!! */
1300         tmp.hub6 = 0;           /*!!! */
1301         return copy_to_user(retinfo, &tmp, sizeof(*retinfo)) ? -EFAULT : 0;
1302 }                               /* get_serial_info */
1303
1304 static int
1305 set_serial_info(struct cyclades_port *info,
1306                 struct serial_struct __user * new_info)
1307 {
1308         struct serial_struct new_serial;
1309         struct cyclades_port old_info;
1310
1311 /* CP('s'); */
1312         if (!new_info)
1313                 return -EFAULT;
1314         if (copy_from_user(&new_serial, new_info, sizeof(new_serial)))
1315                 return -EFAULT;
1316         old_info = *info;
1317
1318         if (!capable(CAP_SYS_ADMIN)) {
1319                 if ((new_serial.close_delay != info->close_delay) ||
1320                     ((new_serial.flags & ASYNC_FLAGS & ~ASYNC_USR_MASK) !=
1321                      (info->flags & ASYNC_FLAGS & ~ASYNC_USR_MASK)))
1322                         return -EPERM;
1323                 info->flags = ((info->flags & ~ASYNC_USR_MASK) |
1324                                (new_serial.flags & ASYNC_USR_MASK));
1325                 goto check_and_exit;
1326         }
1327
1328         /*
1329          * OK, past this point, all the error checking has been done.
1330          * At this point, we start making changes.....
1331          */
1332
1333         info->flags = ((info->flags & ~ASYNC_FLAGS) |
1334                        (new_serial.flags & ASYNC_FLAGS));
1335         info->close_delay = new_serial.close_delay;
1336
1337 check_and_exit:
1338         if (info->flags & ASYNC_INITIALIZED) {
1339                 config_setup(info);
1340                 return 0;
1341         }
1342         return startup(info);
1343 }                               /* set_serial_info */
1344
1345 static int cy_tiocmget(struct tty_struct *tty, struct file *file)
1346 {
1347         struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
1348         int channel;
1349         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
1350         unsigned long flags;
1351         unsigned char status;
1352
1353         channel = info->line;
1354
1355         local_irq_save(flags);
1356         base_addr[CyCAR] = (u_char) channel;
1357         status = base_addr[CyMSVR1] | base_addr[CyMSVR2];
1358         local_irq_restore(flags);
1359
1360         return ((status & CyRTS) ? TIOCM_RTS : 0)
1361             | ((status & CyDTR) ? TIOCM_DTR : 0)
1362             | ((status & CyDCD) ? TIOCM_CAR : 0)
1363             | ((status & CyDSR) ? TIOCM_DSR : 0)
1364             | ((status & CyCTS) ? TIOCM_CTS : 0);
1365 }                               /* cy_tiocmget */
1366
1367 static int
1368 cy_tiocmset(struct tty_struct *tty, struct file *file,
1369             unsigned int set, unsigned int clear)
1370 {
1371         struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
1372         int channel;
1373         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
1374         unsigned long flags;
1375
1376         channel = info->line;
1377
1378         if (set & TIOCM_RTS) {
1379                 local_irq_save(flags);
1380                 base_addr[CyCAR] = (u_char) channel;
1381                 base_addr[CyMSVR1] = CyRTS;
1382                 local_irq_restore(flags);
1383         }
1384         if (set & TIOCM_DTR) {
1385                 local_irq_save(flags);
1386                 base_addr[CyCAR] = (u_char) channel;
1387 /* CP('S');CP('2'); */
1388                 base_addr[CyMSVR2] = CyDTR;
1389 #ifdef SERIAL_DEBUG_DTR
1390                 printk("cyc: %d: raising DTR\n", __LINE__);
1391                 printk("     status: 0x%x, 0x%x\n", base_addr[CyMSVR1],
1392                        base_addr[CyMSVR2]);
1393 #endif
1394                 local_irq_restore(flags);
1395         }
1396
1397         if (clear & TIOCM_RTS) {
1398                 local_irq_save(flags);
1399                 base_addr[CyCAR] = (u_char) channel;
1400                 base_addr[CyMSVR1] = 0;
1401                 local_irq_restore(flags);
1402         }
1403         if (clear & TIOCM_DTR) {
1404                 local_irq_save(flags);
1405                 base_addr[CyCAR] = (u_char) channel;
1406 /* CP('C');CP('2'); */
1407                 base_addr[CyMSVR2] = 0;
1408 #ifdef SERIAL_DEBUG_DTR
1409                 printk("cyc: %d: dropping DTR\n", __LINE__);
1410                 printk("     status: 0x%x, 0x%x\n", base_addr[CyMSVR1],
1411                        base_addr[CyMSVR2]);
1412 #endif
1413                 local_irq_restore(flags);
1414         }
1415
1416         return 0;
1417 }                               /* set_modem_info */
1418
1419 static void send_break(struct cyclades_port *info, int duration)
1420 {                               /* Let the transmit ISR take care of this (since it
1421                                    requires stuffing characters into the output stream).
1422                                  */
1423         info->x_break = duration;
1424         if (!info->xmit_cnt) {
1425                 start_xmit(info);
1426         }
1427 }                               /* send_break */
1428
1429 static int
1430 get_mon_info(struct cyclades_port *info, struct cyclades_monitor __user * mon)
1431 {
1432
1433         if (copy_to_user(mon, &info->mon, sizeof(struct cyclades_monitor)))
1434                 return -EFAULT;
1435         info->mon.int_count = 0;
1436         info->mon.char_count = 0;
1437         info->mon.char_max = 0;
1438         info->mon.char_last = 0;
1439         return 0;
1440 }
1441
1442 static int set_threshold(struct cyclades_port *info, unsigned long __user * arg)
1443 {
1444         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
1445         unsigned long value;
1446         int channel;
1447
1448         if (get_user(value, arg))
1449                 return -EFAULT;
1450
1451         channel = info->line;
1452         info->cor4 &= ~CyREC_FIFO;
1453         info->cor4 |= value & CyREC_FIFO;
1454         base_addr[CyCOR4] = info->cor4;
1455         return 0;
1456 }
1457
1458 static int
1459 get_threshold(struct cyclades_port *info, unsigned long __user * value)
1460 {
1461         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
1462         int channel;
1463         unsigned long tmp;
1464
1465         channel = info->line;
1466
1467         tmp = base_addr[CyCOR4] & CyREC_FIFO;
1468         return put_user(tmp, value);
1469 }
1470
1471 static int
1472 set_default_threshold(struct cyclades_port *info, unsigned long __user * arg)
1473 {
1474         unsigned long value;
1475
1476         if (get_user(value, arg))
1477                 return -EFAULT;
1478
1479         info->default_threshold = value & 0x0f;
1480         return 0;
1481 }
1482
1483 static int
1484 get_default_threshold(struct cyclades_port *info, unsigned long __user * value)
1485 {
1486         return put_user(info->default_threshold, value);
1487 }
1488
1489 static int set_timeout(struct cyclades_port *info, unsigned long __user * arg)
1490 {
1491         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
1492         int channel;
1493         unsigned long value;
1494
1495         if (get_user(value, arg))
1496                 return -EFAULT;
1497
1498         channel = info->line;
1499
1500         base_addr[CyRTPRL] = value & 0xff;
1501         base_addr[CyRTPRH] = (value >> 8) & 0xff;
1502         return 0;
1503 }
1504
1505 static int get_timeout(struct cyclades_port *info, unsigned long __user * value)
1506 {
1507         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
1508         int channel;
1509         unsigned long tmp;
1510
1511         channel = info->line;
1512
1513         tmp = base_addr[CyRTPRL];
1514         return put_user(tmp, value);
1515 }
1516
1517 static int set_default_timeout(struct cyclades_port *info, unsigned long value)
1518 {
1519         info->default_timeout = value & 0xff;
1520         return 0;
1521 }
1522
1523 static int
1524 get_default_timeout(struct cyclades_port *info, unsigned long __user * value)
1525 {
1526         return put_user(info->default_timeout, value);
1527 }
1528
1529 static int
1530 cy_ioctl(struct tty_struct *tty, struct file *file,
1531          unsigned int cmd, unsigned long arg)
1532 {
1533         unsigned long val;
1534         struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
1535         int ret_val = 0;
1536         void __user *argp = (void __user *)arg;
1537
1538 #ifdef SERIAL_DEBUG_OTHER
1539         printk("cy_ioctl %s, cmd = %x arg = %lx\n", tty->name, cmd, arg);       /* */
1540 #endif
1541
1542         switch (cmd) {
1543         case CYGETMON:
1544                 ret_val = get_mon_info(info, argp);
1545                 break;
1546         case CYGETTHRESH:
1547                 ret_val = get_threshold(info, argp);
1548                 break;
1549         case CYSETTHRESH:
1550                 ret_val = set_threshold(info, argp);
1551                 break;
1552         case CYGETDEFTHRESH:
1553                 ret_val = get_default_threshold(info, argp);
1554                 break;
1555         case CYSETDEFTHRESH:
1556                 ret_val = set_default_threshold(info, argp);
1557                 break;
1558         case CYGETTIMEOUT:
1559                 ret_val = get_timeout(info, argp);
1560                 break;
1561         case CYSETTIMEOUT:
1562                 ret_val = set_timeout(info, argp);
1563                 break;
1564         case CYGETDEFTIMEOUT:
1565                 ret_val = get_default_timeout(info, argp);
1566                 break;
1567         case CYSETDEFTIMEOUT:
1568                 ret_val = set_default_timeout(info, (unsigned long)arg);
1569                 break;
1570         case TCSBRK:            /* SVID version: non-zero arg --> no break */
1571                 ret_val = tty_check_change(tty);
1572                 if (ret_val)
1573                         break;
1574                 tty_wait_until_sent(tty, 0);
1575                 if (!arg)
1576                         send_break(info, HZ / 4);       /* 1/4 second */
1577                 break;
1578         case TCSBRKP:           /* support for POSIX tcsendbreak() */
1579                 ret_val = tty_check_change(tty);
1580                 if (ret_val)
1581                         break;
1582                 tty_wait_until_sent(tty, 0);
1583                 send_break(info, arg ? arg * (HZ / 10) : HZ / 4);
1584                 break;
1585
1586 /* The following commands are incompletely implemented!!! */
1587         case TIOCGSOFTCAR:
1588                 ret_val =
1589                     put_user(C_CLOCAL(tty) ? 1 : 0,
1590                              (unsigned long __user *)argp);
1591                 break;
1592         case TIOCSSOFTCAR:
1593                 ret_val = get_user(val, (unsigned long __user *)argp);
1594                 if (ret_val)
1595                         break;
1596                 tty->termios->c_cflag =
1597                     ((tty->termios->c_cflag & ~CLOCAL) | (val ? CLOCAL : 0));
1598                 break;
1599         case TIOCGSERIAL:
1600                 ret_val = get_serial_info(info, argp);
1601                 break;
1602         case TIOCSSERIAL:
1603                 ret_val = set_serial_info(info, argp);
1604                 break;
1605         default:
1606                 ret_val = -ENOIOCTLCMD;
1607         }
1608
1609 #ifdef SERIAL_DEBUG_OTHER
1610         printk("cy_ioctl done\n");
1611 #endif
1612
1613         return ret_val;
1614 }                               /* cy_ioctl */
1615
1616 static void cy_set_termios(struct tty_struct *tty, struct ktermios *old_termios)
1617 {
1618         struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
1619
1620 #ifdef SERIAL_DEBUG_OTHER
1621         printk("cy_set_termios %s\n", tty->name);
1622 #endif
1623
1624         if (tty->termios->c_cflag == old_termios->c_cflag)
1625                 return;
1626         config_setup(info);
1627
1628         if ((old_termios->c_cflag & CRTSCTS) &&
1629             !(tty->termios->c_cflag & CRTSCTS)) {
1630                 tty->stopped = 0;
1631                 cy_start(tty);
1632         }
1633 #ifdef tytso_patch_94Nov25_1726
1634         if (!(old_termios->c_cflag & CLOCAL) &&
1635             (tty->termios->c_cflag & CLOCAL))
1636                 wake_up_interruptible(&info->open_wait);
1637 #endif
1638 }                               /* cy_set_termios */
1639
1640 static void cy_close(struct tty_struct *tty, struct file *filp)
1641 {
1642         struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
1643
1644 /* CP('C'); */
1645 #ifdef SERIAL_DEBUG_OTHER
1646         printk("cy_close %s\n", tty->name);
1647 #endif
1648
1649         if (!info || serial_paranoia_check(info, tty->name, "cy_close")) {
1650                 return;
1651         }
1652 #ifdef SERIAL_DEBUG_OPEN
1653         printk("cy_close %s, count = %d\n", tty->name, info->count);
1654 #endif
1655
1656         if ((tty->count == 1) && (info->count != 1)) {
1657                 /*
1658                  * Uh, oh.  tty->count is 1, which means that the tty
1659                  * structure will be freed.  Info->count should always
1660                  * be one in these conditions.  If it's greater than
1661                  * one, we've got real problems, since it means the
1662                  * serial port won't be shutdown.
1663                  */
1664                 printk("cy_close: bad serial port count; tty->count is 1, "
1665                        "info->count is %d\n", info->count);
1666                 info->count = 1;
1667         }
1668 #ifdef SERIAL_DEBUG_COUNT
1669         printk("cyc: %d: decrementing count to %d\n", __LINE__,
1670                info->count - 1);
1671 #endif
1672         if (--info->count < 0) {
1673                 printk("cy_close: bad serial port count for ttys%d: %d\n",
1674                        info->line, info->count);
1675 #ifdef SERIAL_DEBUG_COUNT
1676                 printk("cyc: %d: setting count to 0\n", __LINE__);
1677 #endif
1678                 info->count = 0;
1679         }
1680         if (info->count)
1681                 return;
1682         info->flags |= ASYNC_CLOSING;
1683         if (info->flags & ASYNC_INITIALIZED)
1684                 tty_wait_until_sent(tty, 3000); /* 30 seconds timeout */
1685         shutdown(info);
1686         if (tty->driver->flush_buffer)
1687                 tty->driver->flush_buffer(tty);
1688         tty_ldisc_flush(tty);
1689         info->tty = NULL;
1690         if (info->blocked_open) {
1691                 if (info->close_delay) {
1692                         msleep_interruptible(jiffies_to_msecs
1693                                              (info->close_delay));
1694                 }
1695                 wake_up_interruptible(&info->open_wait);
1696         }
1697         info->flags &= ~(ASYNC_NORMAL_ACTIVE | ASYNC_CLOSING);
1698         wake_up_interruptible(&info->close_wait);
1699
1700 #ifdef SERIAL_DEBUG_OTHER
1701         printk("cy_close done\n");
1702 #endif
1703 }                               /* cy_close */
1704
1705 /*
1706  * cy_hangup() --- called by tty_hangup() when a hangup is signaled.
1707  */
1708 void cy_hangup(struct tty_struct *tty)
1709 {
1710         struct cyclades_port *info = (struct cyclades_port *)tty->driver_data;
1711
1712 #ifdef SERIAL_DEBUG_OTHER
1713         printk("cy_hangup %s\n", tty->name);    /* */
1714 #endif
1715
1716         if (serial_paranoia_check(info, tty->name, "cy_hangup"))
1717                 return;
1718
1719         shutdown(info);
1720 #if 0
1721         info->event = 0;
1722         info->count = 0;
1723 #ifdef SERIAL_DEBUG_COUNT
1724         printk("cyc: %d: setting count to 0\n", __LINE__);
1725 #endif
1726         info->tty = 0;
1727 #endif
1728         info->flags &= ~ASYNC_NORMAL_ACTIVE;
1729         wake_up_interruptible(&info->open_wait);
1730 }                               /* cy_hangup */
1731
1732 /*
1733  * ------------------------------------------------------------
1734  * cy_open() and friends
1735  * ------------------------------------------------------------
1736  */
1737
1738 static int
1739 block_til_ready(struct tty_struct *tty, struct file *filp,
1740                 struct cyclades_port *info)
1741 {
1742         DECLARE_WAITQUEUE(wait, current);
1743         unsigned long flags;
1744         int channel;
1745         int retval;
1746         volatile u_char *base_addr = (u_char *) BASE_ADDR;
1747
1748         /*
1749          * If the device is in the middle of being closed, then block
1750          * until it's done, and then try again.
1751          */
1752         if (info->flags & ASYNC_CLOSING) {
1753                 interruptible_sleep_on(&info->close_wait);
1754                 if (info->flags & ASYNC_HUP_NOTIFY) {
1755                         return -EAGAIN;
1756                 } else {
1757                         return -ERESTARTSYS;
1758                 }
1759         }
1760
1761         /*
1762          * If non-blocking mode is set, then make the check up front
1763          * and then exit.
1764          */
1765         if (filp->f_flags & O_NONBLOCK) {
1766                 info->flags |= ASYNC_NORMAL_ACTIVE;
1767                 return 0;
1768         }
1769
1770         /*
1771          * Block waiting for the carrier detect and the line to become
1772          * free (i.e., not in use by the callout).  While we are in
1773          * this loop, info->count is dropped by one, so that
1774          * cy_close() knows when to free things.  We restore it upon
1775          * exit, either normal or abnormal.
1776          */
1777         retval = 0;
1778         add_wait_queue(&info->open_wait, &wait);
1779 #ifdef SERIAL_DEBUG_OPEN
1780         printk("block_til_ready before block: %s, count = %d\n",
1781                tty->name, info->count);
1782         /**/
1783 #endif
1784             info->count--;
1785 #ifdef SERIAL_DEBUG_COUNT
1786         printk("cyc: %d: decrementing count to %d\n", __LINE__, info->count);
1787 #endif
1788         info->blocked_open++;
1789
1790         channel = info->line;
1791
1792         while (1) {
1793                 local_irq_save(flags);
1794                 base_addr[CyCAR] = (u_char) channel;
1795                 base_addr[CyMSVR1] = CyRTS;
1796 /* CP('S');CP('4'); */
1797                 base_addr[CyMSVR2] = CyDTR;
1798 #ifdef SERIAL_DEBUG_DTR
1799                 printk("cyc: %d: raising DTR\n", __LINE__);
1800                 printk("     status: 0x%x, 0x%x\n", base_addr[CyMSVR1],
1801                        base_addr[CyMSVR2]);
1802 #endif
1803                 local_irq_restore(flags);
1804                 set_current_state(TASK_INTERRUPTIBLE);
1805                 if (tty_hung_up_p(filp)
1806                     || !(info->flags & ASYNC_INITIALIZED)) {
1807                         if (info->flags & ASYNC_HUP_NOTIFY) {
1808                                 retval = -EAGAIN;
1809                         } else {
1810                                 retval = -ERESTARTSYS;
1811                         }
1812                         break;
1813                 }
1814                 local_irq_save(flags);
1815                 base_addr[CyCAR] = (u_char) channel;
1816 /* CP('L');CP1(1 && C_CLOCAL(tty)); CP1(1 && (base_addr[CyMSVR1] & CyDCD) ); */
1817                 if (!(info->flags & ASYNC_CLOSING)
1818                     && (C_CLOCAL(tty)
1819                         || (base_addr[CyMSVR1] & CyDCD))) {
1820                         local_irq_restore(flags);
1821                         break;
1822                 }
1823                 local_irq_restore(flags);
1824                 if (signal_pending(current)) {
1825                         retval = -ERESTARTSYS;
1826                         break;
1827                 }
1828 #ifdef SERIAL_DEBUG_OPEN
1829                 printk("block_til_ready blocking: %s, count = %d\n",
1830                        tty->name, info->count);
1831                 /**/
1832 #endif
1833                     schedule();
1834         }
1835         __set_current_state(TASK_RUNNING);
1836         remove_wait_queue(&info->open_wait, &wait);
1837         if (!tty_hung_up_p(filp)) {
1838                 info->count++;
1839 #ifdef SERIAL_DEBUG_COUNT
1840                 printk("cyc: %d: incrementing count to %d\n", __LINE__,
1841                        info->count);
1842 #endif
1843         }
1844         info->blocked_open--;
1845 #ifdef SERIAL_DEBUG_OPEN
1846         printk("block_til_ready after blocking: %s, count = %d\n",
1847                tty->name, info->count);
1848         /**/
1849 #endif
1850             if (retval)
1851                 return retval;
1852         info->flags |= ASYNC_NORMAL_ACTIVE;
1853         return 0;
1854 }                               /* block_til_ready */
1855
1856 /*
1857  * This routine is called whenever a serial port is opened.  It
1858  * performs the serial-specific initialization for the tty structure.
1859  */
1860 int cy_open(struct tty_struct *tty, struct file *filp)
1861 {
1862         struct cyclades_port *info;
1863         int retval, line;
1864
1865 /* CP('O'); */
1866         line = tty->index;
1867         if ((line < 0) || (NR_PORTS <= line)) {
1868                 return -ENODEV;
1869         }
1870         info = &cy_port[line];
1871         if (info->line < 0) {
1872                 return -ENODEV;
1873         }
1874 #ifdef SERIAL_DEBUG_OTHER
1875         printk("cy_open %s\n", tty->name);      /* */
1876 #endif
1877         if (serial_paranoia_check(info, tty->name, "cy_open")) {
1878                 return -ENODEV;
1879         }
1880 #ifdef SERIAL_DEBUG_OPEN
1881         printk("cy_open %s, count = %d\n", tty->name, info->count);
1882         /**/
1883 #endif
1884             info->count++;
1885 #ifdef SERIAL_DEBUG_COUNT
1886         printk("cyc: %d: incrementing count to %d\n", __LINE__, info->count);
1887 #endif
1888         tty->driver_data = info;
1889         info->tty = tty;
1890
1891         /*
1892          * Start up serial port
1893          */
1894         retval = startup(info);
1895         if (retval) {
1896                 return retval;
1897         }
1898
1899         retval = block_til_ready(tty, filp, info);
1900         if (retval) {
1901 #ifdef SERIAL_DEBUG_OPEN
1902                 printk("cy_open returning after block_til_ready with %d\n",
1903                        retval);
1904 #endif
1905                 return retval;
1906         }
1907 #ifdef SERIAL_DEBUG_OPEN
1908         printk("cy_open done\n");
1909         /**/
1910 #endif
1911             return 0;
1912 }                               /* cy_open */
1913
1914 /*
1915  * ---------------------------------------------------------------------
1916  * serial167_init() and friends
1917  *
1918  * serial167_init() is called at boot-time to initialize the serial driver.
1919  * ---------------------------------------------------------------------
1920  */
1921
1922 /*
1923  * This routine prints out the appropriate serial driver version
1924  * number, and identifies which options were configured into this
1925  * driver.
1926  */
1927 static void show_version(void)
1928 {
1929         printk("MVME166/167 cd2401 driver\n");
1930 }                               /* show_version */
1931
1932 /* initialize chips on card -- return number of valid
1933    chips (which is number of ports/4) */
1934
1935 /*
1936  * This initialises the hardware to a reasonable state.  It should
1937  * probe the chip first so as to copy 166-Bug setup as a default for
1938  * port 0.  It initialises CMR to CyASYNC; that is never done again, so
1939  * as to limit the number of CyINIT_CHAN commands in normal running.
1940  *
1941  * ... I wonder what I should do if this fails ...
1942  */
1943
1944 void mvme167_serial_console_setup(int cflag)
1945 {
1946         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
1947         int ch;
1948         u_char spd;
1949         u_char rcor, rbpr, badspeed = 0;
1950         unsigned long flags;
1951
1952         local_irq_save(flags);
1953
1954         /*
1955          * First probe channel zero of the chip, to see what speed has
1956          * been selected.
1957          */
1958
1959         base_addr[CyCAR] = 0;
1960
1961         rcor = base_addr[CyRCOR] << 5;
1962         rbpr = base_addr[CyRBPR];
1963
1964         for (spd = 0; spd < sizeof(baud_bpr); spd++)
1965                 if (rbpr == baud_bpr[spd] && rcor == baud_co[spd])
1966                         break;
1967         if (spd >= sizeof(baud_bpr)) {
1968                 spd = 14;       /* 19200 */
1969                 badspeed = 1;   /* Failed to identify speed */
1970         }
1971         initial_console_speed = spd;
1972
1973         /* OK, we have chosen a speed, now reset and reinitialise */
1974
1975         my_udelay(20000L);      /* Allow time for any active o/p to complete */
1976         if (base_addr[CyCCR] != 0x00) {
1977                 local_irq_restore(flags);
1978                 /* printk(" chip is never idle (CCR != 0)\n"); */
1979                 return;
1980         }
1981
1982         base_addr[CyCCR] = CyCHIP_RESET;        /* Reset the chip */
1983         my_udelay(1000L);
1984
1985         if (base_addr[CyGFRCR] == 0x00) {
1986                 local_irq_restore(flags);
1987                 /* printk(" chip is not responding (GFRCR stayed 0)\n"); */
1988                 return;
1989         }
1990
1991         /*
1992          * System clock is 20Mhz, divided by 2048, so divide by 10 for a 1.0ms
1993          * tick
1994          */
1995
1996         base_addr[CyTPR] = 10;
1997
1998         base_addr[CyPILR1] = 0x01;      /* Interrupt level for modem change */
1999         base_addr[CyPILR2] = 0x02;      /* Interrupt level for tx ints */
2000         base_addr[CyPILR3] = 0x03;      /* Interrupt level for rx ints */
2001
2002         /*
2003          * Attempt to set up all channels to something reasonable, and
2004          * bang out a INIT_CHAN command.  We should then be able to limit
2005          * the ammount of fiddling we have to do in normal running.
2006          */
2007
2008         for (ch = 3; ch >= 0; ch--) {
2009                 base_addr[CyCAR] = (u_char) ch;
2010                 base_addr[CyIER] = 0;
2011                 base_addr[CyCMR] = CyASYNC;
2012                 base_addr[CyLICR] = (u_char) ch << 2;
2013                 base_addr[CyLIVR] = 0x5c;
2014                 base_addr[CyTCOR] = baud_co[spd];
2015                 base_addr[CyTBPR] = baud_bpr[spd];
2016                 base_addr[CyRCOR] = baud_co[spd] >> 5;
2017                 base_addr[CyRBPR] = baud_bpr[spd];
2018                 base_addr[CySCHR1] = 'Q' & 0x1f;
2019                 base_addr[CySCHR2] = 'X' & 0x1f;
2020                 base_addr[CySCRL] = 0;
2021                 base_addr[CySCRH] = 0;
2022                 base_addr[CyCOR1] = Cy_8_BITS | CyPARITY_NONE;
2023                 base_addr[CyCOR2] = 0;
2024                 base_addr[CyCOR3] = Cy_1_STOP;
2025                 base_addr[CyCOR4] = baud_cor4[spd];
2026                 base_addr[CyCOR5] = 0;
2027                 base_addr[CyCOR6] = 0;
2028                 base_addr[CyCOR7] = 0;
2029                 base_addr[CyRTPRL] = 2;
2030                 base_addr[CyRTPRH] = 0;
2031                 base_addr[CyMSVR1] = 0;
2032                 base_addr[CyMSVR2] = 0;
2033                 write_cy_cmd(base_addr, CyINIT_CHAN | CyDIS_RCVR | CyDIS_XMTR);
2034         }
2035
2036         /*
2037          * Now do specials for channel zero....
2038          */
2039
2040         base_addr[CyMSVR1] = CyRTS;
2041         base_addr[CyMSVR2] = CyDTR;
2042         base_addr[CyIER] = CyRxData;
2043         write_cy_cmd(base_addr, CyENB_RCVR | CyENB_XMTR);
2044
2045         local_irq_restore(flags);
2046
2047         my_udelay(20000L);      /* Let it all settle down */
2048
2049         printk("CD2401 initialised,  chip is rev 0x%02x\n", base_addr[CyGFRCR]);
2050         if (badspeed)
2051                 printk
2052                     ("  WARNING:  Failed to identify line speed, rcor=%02x,rbpr=%02x\n",
2053                      rcor >> 5, rbpr);
2054 }                               /* serial_console_init */
2055
2056 static const struct tty_operations cy_ops = {
2057         .open = cy_open,
2058         .close = cy_close,
2059         .write = cy_write,
2060         .put_char = cy_put_char,
2061         .flush_chars = cy_flush_chars,
2062         .write_room = cy_write_room,
2063         .chars_in_buffer = cy_chars_in_buffer,
2064         .flush_buffer = cy_flush_buffer,
2065         .ioctl = cy_ioctl,
2066         .throttle = cy_throttle,
2067         .unthrottle = cy_unthrottle,
2068         .set_termios = cy_set_termios,
2069         .stop = cy_stop,
2070         .start = cy_start,
2071         .hangup = cy_hangup,
2072         .tiocmget = cy_tiocmget,
2073         .tiocmset = cy_tiocmset,
2074 };
2075
2076 /* The serial driver boot-time initialization code!
2077     Hardware I/O ports are mapped to character special devices on a
2078     first found, first allocated manner.  That is, this code searches
2079     for Cyclom cards in the system.  As each is found, it is probed
2080     to discover how many chips (and thus how many ports) are present.
2081     These ports are mapped to the tty ports 64 and upward in monotonic
2082     fashion.  If an 8-port card is replaced with a 16-port card, the
2083     port mapping on a following card will shift.
2084
2085     This approach is different from what is used in the other serial
2086     device driver because the Cyclom is more properly a multiplexer,
2087     not just an aggregation of serial ports on one card.
2088
2089     If there are more cards with more ports than have been statically
2090     allocated above, a warning is printed and the extra ports are ignored.
2091  */
2092 static int __init serial167_init(void)
2093 {
2094         struct cyclades_port *info;
2095         int ret = 0;
2096         int good_ports = 0;
2097         int port_num = 0;
2098         int index;
2099         int DefSpeed;
2100 #ifdef notyet
2101         struct sigaction sa;
2102 #endif
2103
2104         if (!(mvme16x_config & MVME16x_CONFIG_GOT_CD2401))
2105                 return 0;
2106
2107         cy_serial_driver = alloc_tty_driver(NR_PORTS);
2108         if (!cy_serial_driver)
2109                 return -ENOMEM;
2110
2111 #if 0
2112         scrn[1] = '\0';
2113 #endif
2114
2115         show_version();
2116
2117         /* Has "console=0,9600n8" been used in bootinfo to change speed? */
2118         if (serial_console_cflag)
2119                 DefSpeed = serial_console_cflag & 0017;
2120         else {
2121                 DefSpeed = initial_console_speed;
2122                 serial_console_info = &cy_port[0];
2123                 serial_console_cflag = DefSpeed | CS8;
2124 #if 0
2125                 serial_console = 64;    /*callout_driver.minor_start */
2126 #endif
2127         }
2128
2129         /* Initialize the tty_driver structure */
2130
2131         cy_serial_driver->owner = THIS_MODULE;
2132         cy_serial_driver->name = "ttyS";
2133         cy_serial_driver->major = TTY_MAJOR;
2134         cy_serial_driver->minor_start = 64;
2135         cy_serial_driver->type = TTY_DRIVER_TYPE_SERIAL;
2136         cy_serial_driver->subtype = SERIAL_TYPE_NORMAL;
2137         cy_serial_driver->init_termios = tty_std_termios;
2138         cy_serial_driver->init_termios.c_cflag =
2139             B9600 | CS8 | CREAD | HUPCL | CLOCAL;
2140         cy_serial_driver->flags = TTY_DRIVER_REAL_RAW;
2141         tty_set_operations(cy_serial_driver, &cy_ops);
2142
2143         ret = tty_register_driver(cy_serial_driver);
2144         if (ret) {
2145                 printk(KERN_ERR "Couldn't register MVME166/7 serial driver\n");
2146                 put_tty_driver(cy_serial_driver);
2147                 return ret;
2148         }
2149
2150         port_num = 0;
2151         info = cy_port;
2152         for (index = 0; index < 1; index++) {
2153
2154                 good_ports = 4;
2155
2156                 if (port_num < NR_PORTS) {
2157                         while (good_ports-- && port_num < NR_PORTS) {
2158                 /*** initialize port ***/
2159                                 info->magic = CYCLADES_MAGIC;
2160                                 info->type = PORT_CIRRUS;
2161                                 info->card = index;
2162                                 info->line = port_num;
2163                                 info->flags = STD_COM_FLAGS;
2164                                 info->tty = NULL;
2165                                 info->xmit_fifo_size = 12;
2166                                 info->cor1 = CyPARITY_NONE | Cy_8_BITS;
2167                                 info->cor2 = CyETC;
2168                                 info->cor3 = Cy_1_STOP;
2169                                 info->cor4 = 0x08;      /* _very_ small receive threshold */
2170                                 info->cor5 = 0;
2171                                 info->cor6 = 0;
2172                                 info->cor7 = 0;
2173                                 info->tbpr = baud_bpr[DefSpeed];        /* Tx BPR */
2174                                 info->tco = baud_co[DefSpeed];  /* Tx CO */
2175                                 info->rbpr = baud_bpr[DefSpeed];        /* Rx BPR */
2176                                 info->rco = baud_co[DefSpeed] >> 5;     /* Rx CO */
2177                                 info->close_delay = 0;
2178                                 info->x_char = 0;
2179                                 info->count = 0;
2180 #ifdef SERIAL_DEBUG_COUNT
2181                                 printk("cyc: %d: setting count to 0\n",
2182                                        __LINE__);
2183 #endif
2184                                 info->blocked_open = 0;
2185                                 info->default_threshold = 0;
2186                                 info->default_timeout = 0;
2187                                 init_waitqueue_head(&info->open_wait);
2188                                 init_waitqueue_head(&info->close_wait);
2189                                 /* info->session */
2190                                 /* info->pgrp */
2191 /*** !!!!!!!! this may expose new bugs !!!!!!!!! *********/
2192                                 info->read_status_mask =
2193                                     CyTIMEOUT | CySPECHAR | CyBREAK | CyPARITY |
2194                                     CyFRAME | CyOVERRUN;
2195                                 /* info->timeout */
2196
2197                                 printk("ttyS%d ", info->line);
2198                                 port_num++;
2199                                 info++;
2200                                 if (!(port_num & 7)) {
2201                                         printk("\n               ");
2202                                 }
2203                         }
2204                 }
2205                 printk("\n");
2206         }
2207         while (port_num < NR_PORTS) {
2208                 info->line = -1;
2209                 port_num++;
2210                 info++;
2211         }
2212 #ifdef CONFIG_REMOTE_DEBUG
2213         debug_setup();
2214 #endif
2215         ret = request_irq(MVME167_IRQ_SER_ERR, cd2401_rxerr_interrupt, 0,
2216                           "cd2401_errors", cd2401_rxerr_interrupt);
2217         if (ret) {
2218                 printk(KERN_ERR "Could't get cd2401_errors IRQ");
2219                 goto cleanup_serial_driver;
2220         }
2221
2222         ret = request_irq(MVME167_IRQ_SER_MODEM, cd2401_modem_interrupt, 0,
2223                           "cd2401_modem", cd2401_modem_interrupt);
2224         if (ret) {
2225                 printk(KERN_ERR "Could't get cd2401_modem IRQ");
2226                 goto cleanup_irq_cd2401_errors;
2227         }
2228
2229         ret = request_irq(MVME167_IRQ_SER_TX, cd2401_tx_interrupt, 0,
2230                           "cd2401_txints", cd2401_tx_interrupt);
2231         if (ret) {
2232                 printk(KERN_ERR "Could't get cd2401_txints IRQ");
2233                 goto cleanup_irq_cd2401_modem;
2234         }
2235
2236         ret = request_irq(MVME167_IRQ_SER_RX, cd2401_rx_interrupt, 0,
2237                           "cd2401_rxints", cd2401_rx_interrupt);
2238         if (ret) {
2239                 printk(KERN_ERR "Could't get cd2401_rxints IRQ");
2240                 goto cleanup_irq_cd2401_txints;
2241         }
2242
2243         /* Now we have registered the interrupt handlers, allow the interrupts */
2244
2245         pcc2chip[PccSCCMICR] = 0x15;    /* Serial ints are level 5 */
2246         pcc2chip[PccSCCTICR] = 0x15;
2247         pcc2chip[PccSCCRICR] = 0x15;
2248
2249         pcc2chip[PccIMLR] = 3;  /* Allow PCC2 ints above 3!? */
2250
2251         return 0;
2252 cleanup_irq_cd2401_txints:
2253         free_irq(MVME167_IRQ_SER_TX, cd2401_tx_interrupt);
2254 cleanup_irq_cd2401_modem:
2255         free_irq(MVME167_IRQ_SER_MODEM, cd2401_modem_interrupt);
2256 cleanup_irq_cd2401_errors:
2257         free_irq(MVME167_IRQ_SER_ERR, cd2401_rxerr_interrupt);
2258 cleanup_serial_driver:
2259         if (tty_unregister_driver(cy_serial_driver))
2260                 printk(KERN_ERR
2261                        "Couldn't unregister MVME166/7 serial driver\n");
2262         put_tty_driver(cy_serial_driver);
2263         return ret;
2264 }                               /* serial167_init */
2265
2266 module_init(serial167_init);
2267
2268 #ifdef CYCLOM_SHOW_STATUS
2269 static void show_status(int line_num)
2270 {
2271         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
2272         int channel;
2273         struct cyclades_port *info;
2274         unsigned long flags;
2275
2276         info = &cy_port[line_num];
2277         channel = info->line;
2278         printk("  channel %d\n", channel);
2279         /**/ printk(" cy_port\n");
2280         printk("  card line flags = %d %d %x\n",
2281                info->card, info->line, info->flags);
2282         printk
2283             ("  *tty read_status_mask timeout xmit_fifo_size = %lx %x %x %x\n",
2284              (long)info->tty, info->read_status_mask, info->timeout,
2285              info->xmit_fifo_size);
2286         printk("  cor1,cor2,cor3,cor4,cor5,cor6,cor7 = %x %x %x %x %x %x %x\n",
2287                info->cor1, info->cor2, info->cor3, info->cor4, info->cor5,
2288                info->cor6, info->cor7);
2289         printk("  tbpr,tco,rbpr,rco = %d %d %d %d\n", info->tbpr, info->tco,
2290                info->rbpr, info->rco);
2291         printk("  close_delay event count = %d %d %d\n", info->close_delay,
2292                info->event, info->count);
2293         printk("  x_char blocked_open = %x %x\n", info->x_char,
2294                info->blocked_open);
2295         printk("  open_wait = %lx %lx %lx\n", (long)info->open_wait);
2296
2297         local_irq_save(flags);
2298
2299 /* Global Registers */
2300
2301         printk(" CyGFRCR %x\n", base_addr[CyGFRCR]);
2302         printk(" CyCAR %x\n", base_addr[CyCAR]);
2303         printk(" CyRISR %x\n", base_addr[CyRISR]);
2304         printk(" CyTISR %x\n", base_addr[CyTISR]);
2305         printk(" CyMISR %x\n", base_addr[CyMISR]);
2306         printk(" CyRIR %x\n", base_addr[CyRIR]);
2307         printk(" CyTIR %x\n", base_addr[CyTIR]);
2308         printk(" CyMIR %x\n", base_addr[CyMIR]);
2309         printk(" CyTPR %x\n", base_addr[CyTPR]);
2310
2311         base_addr[CyCAR] = (u_char) channel;
2312
2313 /* Virtual Registers */
2314
2315 #if 0
2316         printk(" CyRIVR %x\n", base_addr[CyRIVR]);
2317         printk(" CyTIVR %x\n", base_addr[CyTIVR]);
2318         printk(" CyMIVR %x\n", base_addr[CyMIVR]);
2319         printk(" CyMISR %x\n", base_addr[CyMISR]);
2320 #endif
2321
2322 /* Channel Registers */
2323
2324         printk(" CyCCR %x\n", base_addr[CyCCR]);
2325         printk(" CyIER %x\n", base_addr[CyIER]);
2326         printk(" CyCOR1 %x\n", base_addr[CyCOR1]);
2327         printk(" CyCOR2 %x\n", base_addr[CyCOR2]);
2328         printk(" CyCOR3 %x\n", base_addr[CyCOR3]);
2329         printk(" CyCOR4 %x\n", base_addr[CyCOR4]);
2330         printk(" CyCOR5 %x\n", base_addr[CyCOR5]);
2331 #if 0
2332         printk(" CyCCSR %x\n", base_addr[CyCCSR]);
2333         printk(" CyRDCR %x\n", base_addr[CyRDCR]);
2334 #endif
2335         printk(" CySCHR1 %x\n", base_addr[CySCHR1]);
2336         printk(" CySCHR2 %x\n", base_addr[CySCHR2]);
2337 #if 0
2338         printk(" CySCHR3 %x\n", base_addr[CySCHR3]);
2339         printk(" CySCHR4 %x\n", base_addr[CySCHR4]);
2340         printk(" CySCRL %x\n", base_addr[CySCRL]);
2341         printk(" CySCRH %x\n", base_addr[CySCRH]);
2342         printk(" CyLNC %x\n", base_addr[CyLNC]);
2343         printk(" CyMCOR1 %x\n", base_addr[CyMCOR1]);
2344         printk(" CyMCOR2 %x\n", base_addr[CyMCOR2]);
2345 #endif
2346         printk(" CyRTPRL %x\n", base_addr[CyRTPRL]);
2347         printk(" CyRTPRH %x\n", base_addr[CyRTPRH]);
2348         printk(" CyMSVR1 %x\n", base_addr[CyMSVR1]);
2349         printk(" CyMSVR2 %x\n", base_addr[CyMSVR2]);
2350         printk(" CyRBPR %x\n", base_addr[CyRBPR]);
2351         printk(" CyRCOR %x\n", base_addr[CyRCOR]);
2352         printk(" CyTBPR %x\n", base_addr[CyTBPR]);
2353         printk(" CyTCOR %x\n", base_addr[CyTCOR]);
2354
2355         local_irq_restore(flags);
2356 }                               /* show_status */
2357 #endif
2358
2359 #if 0
2360 /* Dummy routine in mvme16x/config.c for now */
2361
2362 /* Serial console setup. Called from linux/init/main.c */
2363
2364 void console_setup(char *str, int *ints)
2365 {
2366         char *s;
2367         int baud, bits, parity;
2368         int cflag = 0;
2369
2370         /* Sanity check. */
2371         if (ints[0] > 3 || ints[1] > 3)
2372                 return;
2373
2374         /* Get baud, bits and parity */
2375         baud = 2400;
2376         bits = 8;
2377         parity = 'n';
2378         if (ints[2])
2379                 baud = ints[2];
2380         if ((s = strchr(str, ','))) {
2381                 do {
2382                         s++;
2383                 } while (*s >= '0' && *s <= '9');
2384                 if (*s)
2385                         parity = *s++;
2386                 if (*s)
2387                         bits = *s - '0';
2388         }
2389
2390         /* Now construct a cflag setting. */
2391         switch (baud) {
2392         case 1200:
2393                 cflag |= B1200;
2394                 break;
2395         case 9600:
2396                 cflag |= B9600;
2397                 break;
2398         case 19200:
2399                 cflag |= B19200;
2400                 break;
2401         case 38400:
2402                 cflag |= B38400;
2403                 break;
2404         case 2400:
2405         default:
2406                 cflag |= B2400;
2407                 break;
2408         }
2409         switch (bits) {
2410         case 7:
2411                 cflag |= CS7;
2412                 break;
2413         default:
2414         case 8:
2415                 cflag |= CS8;
2416                 break;
2417         }
2418         switch (parity) {
2419         case 'o':
2420         case 'O':
2421                 cflag |= PARODD;
2422                 break;
2423         case 'e':
2424         case 'E':
2425                 cflag |= PARENB;
2426                 break;
2427         }
2428
2429         serial_console_info = &cy_port[ints[1]];
2430         serial_console_cflag = cflag;
2431         serial_console = ints[1] + 64;  /*callout_driver.minor_start */
2432 }
2433 #endif
2434
2435 /*
2436  * The following is probably out of date for 2.1.x serial console stuff.
2437  *
2438  * The console is registered early on from arch/m68k/kernel/setup.c, and
2439  * it therefore relies on the chip being setup correctly by 166-Bug.  This
2440  * seems reasonable, as the serial port has been used to invoke the system
2441  * boot.  It also means that this function must not rely on any data
2442  * initialisation performed by serial167_init() etc.
2443  *
2444  * Of course, once the console has been registered, we had better ensure
2445  * that serial167_init() doesn't leave the chip non-functional.
2446  *
2447  * The console must be locked when we get here.
2448  */
2449
2450 void serial167_console_write(struct console *co, const char *str,
2451                              unsigned count)
2452 {
2453         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
2454         unsigned long flags;
2455         volatile u_char sink;
2456         u_char ier;
2457         int port;
2458         u_char do_lf = 0;
2459         int i = 0;
2460
2461         local_irq_save(flags);
2462
2463         /* Ensure transmitter is enabled! */
2464
2465         port = 0;
2466         base_addr[CyCAR] = (u_char) port;
2467         while (base_addr[CyCCR])
2468                 ;
2469         base_addr[CyCCR] = CyENB_XMTR;
2470
2471         ier = base_addr[CyIER];
2472         base_addr[CyIER] = CyTxMpty;
2473
2474         while (1) {
2475                 if (pcc2chip[PccSCCTICR] & 0x20) {
2476                         /* We have a Tx int. Acknowledge it */
2477                         sink = pcc2chip[PccTPIACKR];
2478                         if ((base_addr[CyLICR] >> 2) == port) {
2479                                 if (i == count) {
2480                                         /* Last char of string is now output */
2481                                         base_addr[CyTEOIR] = CyNOTRANS;
2482                                         break;
2483                                 }
2484                                 if (do_lf) {
2485                                         base_addr[CyTDR] = '\n';
2486                                         str++;
2487                                         i++;
2488                                         do_lf = 0;
2489                                 } else if (*str == '\n') {
2490                                         base_addr[CyTDR] = '\r';
2491                                         do_lf = 1;
2492                                 } else {
2493                                         base_addr[CyTDR] = *str++;
2494                                         i++;
2495                                 }
2496                                 base_addr[CyTEOIR] = 0;
2497                         } else
2498                                 base_addr[CyTEOIR] = CyNOTRANS;
2499                 }
2500         }
2501
2502         base_addr[CyIER] = ier;
2503
2504         local_irq_restore(flags);
2505 }
2506
2507 static struct tty_driver *serial167_console_device(struct console *c,
2508                                                    int *index)
2509 {
2510         *index = c->index;
2511         return cy_serial_driver;
2512 }
2513
2514 static struct console sercons = {
2515         .name = "ttyS",
2516         .write = serial167_console_write,
2517         .device = serial167_console_device,
2518         .flags = CON_PRINTBUFFER,
2519         .index = -1,
2520 };
2521
2522 static int __init serial167_console_init(void)
2523 {
2524         if (vme_brdtype == VME_TYPE_MVME166 ||
2525             vme_brdtype == VME_TYPE_MVME167 ||
2526             vme_brdtype == VME_TYPE_MVME177) {
2527                 mvme167_serial_console_setup(0);
2528                 register_console(&sercons);
2529         }
2530         return 0;
2531 }
2532
2533 console_initcall(serial167_console_init);
2534
2535 #ifdef CONFIG_REMOTE_DEBUG
2536 void putDebugChar(int c)
2537 {
2538         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
2539         unsigned long flags;
2540         volatile u_char sink;
2541         u_char ier;
2542         int port;
2543
2544         local_irq_save(flags);
2545
2546         /* Ensure transmitter is enabled! */
2547
2548         port = DEBUG_PORT;
2549         base_addr[CyCAR] = (u_char) port;
2550         while (base_addr[CyCCR])
2551                 ;
2552         base_addr[CyCCR] = CyENB_XMTR;
2553
2554         ier = base_addr[CyIER];
2555         base_addr[CyIER] = CyTxMpty;
2556
2557         while (1) {
2558                 if (pcc2chip[PccSCCTICR] & 0x20) {
2559                         /* We have a Tx int. Acknowledge it */
2560                         sink = pcc2chip[PccTPIACKR];
2561                         if ((base_addr[CyLICR] >> 2) == port) {
2562                                 base_addr[CyTDR] = c;
2563                                 base_addr[CyTEOIR] = 0;
2564                                 break;
2565                         } else
2566                                 base_addr[CyTEOIR] = CyNOTRANS;
2567                 }
2568         }
2569
2570         base_addr[CyIER] = ier;
2571
2572         local_irq_restore(flags);
2573 }
2574
2575 int getDebugChar()
2576 {
2577         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
2578         unsigned long flags;
2579         volatile u_char sink;
2580         u_char ier;
2581         int port;
2582         int i, c;
2583
2584         i = debugiq.out;
2585         if (i != debugiq.in) {
2586                 c = debugiq.buf[i];
2587                 if (++i == DEBUG_LEN)
2588                         i = 0;
2589                 debugiq.out = i;
2590                 return c;
2591         }
2592         /* OK, nothing in queue, wait in poll loop */
2593
2594         local_irq_save(flags);
2595
2596         /* Ensure receiver is enabled! */
2597
2598         port = DEBUG_PORT;
2599         base_addr[CyCAR] = (u_char) port;
2600 #if 0
2601         while (base_addr[CyCCR])
2602                 ;
2603         base_addr[CyCCR] = CyENB_RCVR;
2604 #endif
2605         ier = base_addr[CyIER];
2606         base_addr[CyIER] = CyRxData;
2607
2608         while (1) {
2609                 if (pcc2chip[PccSCCRICR] & 0x20) {
2610                         /* We have a Rx int. Acknowledge it */
2611                         sink = pcc2chip[PccRPIACKR];
2612                         if ((base_addr[CyLICR] >> 2) == port) {
2613                                 int cnt = base_addr[CyRFOC];
2614                                 while (cnt-- > 0) {
2615                                         c = base_addr[CyRDR];
2616                                         if (c == 0)
2617                                                 printk
2618                                                     ("!! debug char is null (cnt=%d) !!",
2619                                                      cnt);
2620                                         else
2621                                                 queueDebugChar(c);
2622                                 }
2623                                 base_addr[CyREOIR] = 0;
2624                                 i = debugiq.out;
2625                                 if (i == debugiq.in)
2626                                         panic("Debug input queue empty!");
2627                                 c = debugiq.buf[i];
2628                                 if (++i == DEBUG_LEN)
2629                                         i = 0;
2630                                 debugiq.out = i;
2631                                 break;
2632                         } else
2633                                 base_addr[CyREOIR] = CyNOTRANS;
2634                 }
2635         }
2636
2637         base_addr[CyIER] = ier;
2638
2639         local_irq_restore(flags);
2640
2641         return (c);
2642 }
2643
2644 void queueDebugChar(int c)
2645 {
2646         int i;
2647
2648         i = debugiq.in;
2649         debugiq.buf[i] = c;
2650         if (++i == DEBUG_LEN)
2651                 i = 0;
2652         if (i != debugiq.out)
2653                 debugiq.in = i;
2654 }
2655
2656 static void debug_setup()
2657 {
2658         unsigned long flags;
2659         volatile unsigned char *base_addr = (u_char *) BASE_ADDR;
2660         int i, cflag;
2661
2662         cflag = B19200;
2663
2664         local_irq_save(flags);
2665
2666         for (i = 0; i < 4; i++) {
2667                 base_addr[CyCAR] = i;
2668                 base_addr[CyLICR] = i << 2;
2669         }
2670
2671         debugiq.in = debugiq.out = 0;
2672
2673         base_addr[CyCAR] = DEBUG_PORT;
2674
2675         /* baud rate */
2676         i = cflag & CBAUD;
2677
2678         base_addr[CyIER] = 0;
2679
2680         base_addr[CyCMR] = CyASYNC;
2681         base_addr[CyLICR] = DEBUG_PORT << 2;
2682         base_addr[CyLIVR] = 0x5c;
2683
2684         /* tx and rx baud rate */
2685
2686         base_addr[CyTCOR] = baud_co[i];
2687         base_addr[CyTBPR] = baud_bpr[i];
2688         base_addr[CyRCOR] = baud_co[i] >> 5;
2689         base_addr[CyRBPR] = baud_bpr[i];
2690
2691         /* set line characteristics  according configuration */
2692
2693         base_addr[CySCHR1] = 0;
2694         base_addr[CySCHR2] = 0;
2695         base_addr[CySCRL] = 0;
2696         base_addr[CySCRH] = 0;
2697         base_addr[CyCOR1] = Cy_8_BITS | CyPARITY_NONE;
2698         base_addr[CyCOR2] = 0;
2699         base_addr[CyCOR3] = Cy_1_STOP;
2700         base_addr[CyCOR4] = baud_cor4[i];
2701         base_addr[CyCOR5] = 0;
2702         base_addr[CyCOR6] = 0;
2703         base_addr[CyCOR7] = 0;
2704
2705         write_cy_cmd(base_addr, CyINIT_CHAN);
2706         write_cy_cmd(base_addr, CyENB_RCVR);
2707
2708         base_addr[CyCAR] = DEBUG_PORT;  /* !!! Is this needed? */
2709
2710         base_addr[CyRTPRL] = 2;
2711         base_addr[CyRTPRH] = 0;
2712
2713         base_addr[CyMSVR1] = CyRTS;
2714         base_addr[CyMSVR2] = CyDTR;
2715
2716         base_addr[CyIER] = CyRxData;
2717
2718         local_irq_restore(flags);
2719
2720 }                               /* debug_setup */
2721
2722 #endif
2723
2724 MODULE_LICENSE("GPL");