include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit...
[safe/jmp/linux-2.6] / drivers / serial / ioc4_serial.c
1 /*
2  * This file is subject to the terms and conditions of the GNU General Public
3  * License.  See the file "COPYING" in the main directory of this archive
4  * for more details.
5  *
6  * Copyright (C) 2003-2006 Silicon Graphics, Inc.  All Rights Reserved.
7  */
8
9
10 /*
11  * This file contains a module version of the ioc4 serial driver. This
12  * includes all the support functions needed (support functions, etc.)
13  * and the serial driver itself.
14  */
15 #include <linux/errno.h>
16 #include <linux/tty.h>
17 #include <linux/serial.h>
18 #include <linux/serialP.h>
19 #include <linux/circ_buf.h>
20 #include <linux/serial_reg.h>
21 #include <linux/module.h>
22 #include <linux/pci.h>
23 #include <linux/ioc4.h>
24 #include <linux/serial_core.h>
25 #include <linux/slab.h>
26
27 /*
28  * interesting things about the ioc4
29  */
30
31 #define IOC4_NUM_SERIAL_PORTS   4       /* max ports per card */
32 #define IOC4_NUM_CARDS          8       /* max cards per partition */
33
34 #define GET_SIO_IR(_n)  (_n == 0) ? (IOC4_SIO_IR_S0) : \
35                                 (_n == 1) ? (IOC4_SIO_IR_S1) : \
36                                 (_n == 2) ? (IOC4_SIO_IR_S2) : \
37                                 (IOC4_SIO_IR_S3)
38
39 #define GET_OTHER_IR(_n)  (_n == 0) ? (IOC4_OTHER_IR_S0_MEMERR) : \
40                                 (_n == 1) ? (IOC4_OTHER_IR_S1_MEMERR) : \
41                                 (_n == 2) ? (IOC4_OTHER_IR_S2_MEMERR) : \
42                                 (IOC4_OTHER_IR_S3_MEMERR)
43
44
45 /*
46  * All IOC4 registers are 32 bits wide.
47  */
48
49 /*
50  * PCI Memory Space Map
51  */
52 #define IOC4_PCI_ERR_ADDR_L     0x000   /* Low Error Address */
53 #define IOC4_PCI_ERR_ADDR_VLD           (0x1 << 0)
54 #define IOC4_PCI_ERR_ADDR_MST_ID_MSK    (0xf << 1)
55 #define IOC4_PCI_ERR_ADDR_MST_NUM_MSK   (0xe << 1)
56 #define IOC4_PCI_ERR_ADDR_MST_TYP_MSK   (0x1 << 1)
57 #define IOC4_PCI_ERR_ADDR_MUL_ERR       (0x1 << 5)
58 #define IOC4_PCI_ERR_ADDR_ADDR_MSK      (0x3ffffff << 6)
59
60 /* Interrupt types */
61 #define IOC4_SIO_INTR_TYPE      0
62 #define IOC4_OTHER_INTR_TYPE    1
63 #define IOC4_NUM_INTR_TYPES     2
64
65 /* Bitmasks for IOC4_SIO_IR, IOC4_SIO_IEC, and IOC4_SIO_IES  */
66 #define IOC4_SIO_IR_S0_TX_MT       0x00000001   /* Serial port 0 TX empty */
67 #define IOC4_SIO_IR_S0_RX_FULL     0x00000002   /* Port 0 RX buf full */
68 #define IOC4_SIO_IR_S0_RX_HIGH     0x00000004   /* Port 0 RX hiwat */
69 #define IOC4_SIO_IR_S0_RX_TIMER    0x00000008   /* Port 0 RX timeout */
70 #define IOC4_SIO_IR_S0_DELTA_DCD   0x00000010   /* Port 0 delta DCD */
71 #define IOC4_SIO_IR_S0_DELTA_CTS   0x00000020   /* Port 0 delta CTS */
72 #define IOC4_SIO_IR_S0_INT         0x00000040   /* Port 0 pass-thru intr */
73 #define IOC4_SIO_IR_S0_TX_EXPLICIT 0x00000080   /* Port 0 explicit TX thru */
74 #define IOC4_SIO_IR_S1_TX_MT       0x00000100   /* Serial port 1 */
75 #define IOC4_SIO_IR_S1_RX_FULL     0x00000200   /* */
76 #define IOC4_SIO_IR_S1_RX_HIGH     0x00000400   /* */
77 #define IOC4_SIO_IR_S1_RX_TIMER    0x00000800   /* */
78 #define IOC4_SIO_IR_S1_DELTA_DCD   0x00001000   /* */
79 #define IOC4_SIO_IR_S1_DELTA_CTS   0x00002000   /* */
80 #define IOC4_SIO_IR_S1_INT         0x00004000   /* */
81 #define IOC4_SIO_IR_S1_TX_EXPLICIT 0x00008000   /* */
82 #define IOC4_SIO_IR_S2_TX_MT       0x00010000   /* Serial port 2 */
83 #define IOC4_SIO_IR_S2_RX_FULL     0x00020000   /* */
84 #define IOC4_SIO_IR_S2_RX_HIGH     0x00040000   /* */
85 #define IOC4_SIO_IR_S2_RX_TIMER    0x00080000   /* */
86 #define IOC4_SIO_IR_S2_DELTA_DCD   0x00100000   /* */
87 #define IOC4_SIO_IR_S2_DELTA_CTS   0x00200000   /* */
88 #define IOC4_SIO_IR_S2_INT         0x00400000   /* */
89 #define IOC4_SIO_IR_S2_TX_EXPLICIT 0x00800000   /* */
90 #define IOC4_SIO_IR_S3_TX_MT       0x01000000   /* Serial port 3 */
91 #define IOC4_SIO_IR_S3_RX_FULL     0x02000000   /* */
92 #define IOC4_SIO_IR_S3_RX_HIGH     0x04000000   /* */
93 #define IOC4_SIO_IR_S3_RX_TIMER    0x08000000   /* */
94 #define IOC4_SIO_IR_S3_DELTA_DCD   0x10000000   /* */
95 #define IOC4_SIO_IR_S3_DELTA_CTS   0x20000000   /* */
96 #define IOC4_SIO_IR_S3_INT         0x40000000   /* */
97 #define IOC4_SIO_IR_S3_TX_EXPLICIT 0x80000000   /* */
98
99 /* Per device interrupt masks */
100 #define IOC4_SIO_IR_S0          (IOC4_SIO_IR_S0_TX_MT | \
101                                  IOC4_SIO_IR_S0_RX_FULL | \
102                                  IOC4_SIO_IR_S0_RX_HIGH | \
103                                  IOC4_SIO_IR_S0_RX_TIMER | \
104                                  IOC4_SIO_IR_S0_DELTA_DCD | \
105                                  IOC4_SIO_IR_S0_DELTA_CTS | \
106                                  IOC4_SIO_IR_S0_INT | \
107                                  IOC4_SIO_IR_S0_TX_EXPLICIT)
108 #define IOC4_SIO_IR_S1          (IOC4_SIO_IR_S1_TX_MT | \
109                                  IOC4_SIO_IR_S1_RX_FULL | \
110                                  IOC4_SIO_IR_S1_RX_HIGH | \
111                                  IOC4_SIO_IR_S1_RX_TIMER | \
112                                  IOC4_SIO_IR_S1_DELTA_DCD | \
113                                  IOC4_SIO_IR_S1_DELTA_CTS | \
114                                  IOC4_SIO_IR_S1_INT | \
115                                  IOC4_SIO_IR_S1_TX_EXPLICIT)
116 #define IOC4_SIO_IR_S2          (IOC4_SIO_IR_S2_TX_MT | \
117                                  IOC4_SIO_IR_S2_RX_FULL | \
118                                  IOC4_SIO_IR_S2_RX_HIGH | \
119                                  IOC4_SIO_IR_S2_RX_TIMER | \
120                                  IOC4_SIO_IR_S2_DELTA_DCD | \
121                                  IOC4_SIO_IR_S2_DELTA_CTS | \
122                                  IOC4_SIO_IR_S2_INT | \
123                                  IOC4_SIO_IR_S2_TX_EXPLICIT)
124 #define IOC4_SIO_IR_S3          (IOC4_SIO_IR_S3_TX_MT | \
125                                  IOC4_SIO_IR_S3_RX_FULL | \
126                                  IOC4_SIO_IR_S3_RX_HIGH | \
127                                  IOC4_SIO_IR_S3_RX_TIMER | \
128                                  IOC4_SIO_IR_S3_DELTA_DCD | \
129                                  IOC4_SIO_IR_S3_DELTA_CTS | \
130                                  IOC4_SIO_IR_S3_INT | \
131                                  IOC4_SIO_IR_S3_TX_EXPLICIT)
132
133 /* Bitmasks for IOC4_OTHER_IR, IOC4_OTHER_IEC, and IOC4_OTHER_IES  */
134 #define IOC4_OTHER_IR_ATA_INT           0x00000001  /* ATAPI intr pass-thru */
135 #define IOC4_OTHER_IR_ATA_MEMERR        0x00000002  /* ATAPI DMA PCI error */
136 #define IOC4_OTHER_IR_S0_MEMERR         0x00000004  /* Port 0 PCI error */
137 #define IOC4_OTHER_IR_S1_MEMERR         0x00000008  /* Port 1 PCI error */
138 #define IOC4_OTHER_IR_S2_MEMERR         0x00000010  /* Port 2 PCI error */
139 #define IOC4_OTHER_IR_S3_MEMERR         0x00000020  /* Port 3 PCI error */
140 #define IOC4_OTHER_IR_KBD_INT           0x00000040  /* Keyboard/mouse */
141 #define IOC4_OTHER_IR_RESERVED          0x007fff80  /* Reserved */
142 #define IOC4_OTHER_IR_RT_INT            0x00800000  /* INT_OUT section output */
143 #define IOC4_OTHER_IR_GEN_INT           0xff000000  /* Generic pins */
144
145 #define IOC4_OTHER_IR_SER_MEMERR (IOC4_OTHER_IR_S0_MEMERR | IOC4_OTHER_IR_S1_MEMERR | \
146                                   IOC4_OTHER_IR_S2_MEMERR | IOC4_OTHER_IR_S3_MEMERR)
147
148 /* Bitmasks for IOC4_SIO_CR */
149 #define IOC4_SIO_CR_CMD_PULSE_SHIFT              0  /* byte bus strobe shift */
150 #define IOC4_SIO_CR_ARB_DIAG_TX0        0x00000000
151 #define IOC4_SIO_CR_ARB_DIAG_RX0        0x00000010
152 #define IOC4_SIO_CR_ARB_DIAG_TX1        0x00000020
153 #define IOC4_SIO_CR_ARB_DIAG_RX1        0x00000030
154 #define IOC4_SIO_CR_ARB_DIAG_TX2        0x00000040
155 #define IOC4_SIO_CR_ARB_DIAG_RX2        0x00000050
156 #define IOC4_SIO_CR_ARB_DIAG_TX3        0x00000060
157 #define IOC4_SIO_CR_ARB_DIAG_RX3        0x00000070
158 #define IOC4_SIO_CR_SIO_DIAG_IDLE       0x00000080  /* 0 -> active request among
159                                                            serial ports (ro) */
160 /* Defs for some of the generic I/O pins */
161 #define IOC4_GPCR_UART0_MODESEL    0x10 /* Pin is output to port 0
162                                                    mode sel */
163 #define IOC4_GPCR_UART1_MODESEL    0x20 /* Pin is output to port 1
164                                                    mode sel */
165 #define IOC4_GPCR_UART2_MODESEL    0x40 /* Pin is output to port 2
166                                                    mode sel */
167 #define IOC4_GPCR_UART3_MODESEL    0x80 /* Pin is output to port 3
168                                                    mode sel */
169
170 #define IOC4_GPPR_UART0_MODESEL_PIN   4 /* GIO pin controlling
171                                            uart 0 mode select */
172 #define IOC4_GPPR_UART1_MODESEL_PIN   5 /* GIO pin controlling
173                                            uart 1 mode select */
174 #define IOC4_GPPR_UART2_MODESEL_PIN   6 /* GIO pin controlling
175                                            uart 2 mode select */
176 #define IOC4_GPPR_UART3_MODESEL_PIN   7 /* GIO pin controlling
177                                            uart 3 mode select */
178
179 /* Bitmasks for serial RX status byte */
180 #define IOC4_RXSB_OVERRUN       0x01    /* Char(s) lost */
181 #define IOC4_RXSB_PAR_ERR       0x02    /* Parity error */
182 #define IOC4_RXSB_FRAME_ERR     0x04    /* Framing error */
183 #define IOC4_RXSB_BREAK         0x08    /* Break character */
184 #define IOC4_RXSB_CTS           0x10    /* State of CTS */
185 #define IOC4_RXSB_DCD           0x20    /* State of DCD */
186 #define IOC4_RXSB_MODEM_VALID   0x40    /* DCD, CTS, and OVERRUN are valid */
187 #define IOC4_RXSB_DATA_VALID    0x80    /* Data byte, FRAME_ERR PAR_ERR
188                                          * & BREAK valid */
189
190 /* Bitmasks for serial TX control byte */
191 #define IOC4_TXCB_INT_WHEN_DONE 0x20    /* Interrupt after this byte is sent */
192 #define IOC4_TXCB_INVALID       0x00    /* Byte is invalid */
193 #define IOC4_TXCB_VALID         0x40    /* Byte is valid */
194 #define IOC4_TXCB_MCR           0x80    /* Data<7:0> to modem control reg */
195 #define IOC4_TXCB_DELAY         0xc0    /* Delay data<7:0> mSec */
196
197 /* Bitmasks for IOC4_SBBR_L */
198 #define IOC4_SBBR_L_SIZE        0x00000001  /* 0 == 1KB rings, 1 == 4KB rings */
199
200 /* Bitmasks for IOC4_SSCR_<3:0> */
201 #define IOC4_SSCR_RX_THRESHOLD  0x000001ff  /* Hiwater mark */
202 #define IOC4_SSCR_TX_TIMER_BUSY 0x00010000  /* TX timer in progress */
203 #define IOC4_SSCR_HFC_EN        0x00020000  /* Hardware flow control enabled */
204 #define IOC4_SSCR_RX_RING_DCD   0x00040000  /* Post RX record on delta-DCD */
205 #define IOC4_SSCR_RX_RING_CTS   0x00080000  /* Post RX record on delta-CTS */
206 #define IOC4_SSCR_DIAG          0x00200000  /* Bypass clock divider for sim */
207 #define IOC4_SSCR_RX_DRAIN      0x08000000  /* Drain RX buffer to memory */
208 #define IOC4_SSCR_DMA_EN        0x10000000  /* Enable ring buffer DMA */
209 #define IOC4_SSCR_DMA_PAUSE     0x20000000  /* Pause DMA */
210 #define IOC4_SSCR_PAUSE_STATE   0x40000000  /* Sets when PAUSE takes effect */
211 #define IOC4_SSCR_RESET         0x80000000  /* Reset DMA channels */
212
213 /* All producer/comsumer pointers are the same bitfield */
214 #define IOC4_PROD_CONS_PTR_4K   0x00000ff8      /* For 4K buffers */
215 #define IOC4_PROD_CONS_PTR_1K   0x000003f8      /* For 1K buffers */
216 #define IOC4_PROD_CONS_PTR_OFF           3
217
218 /* Bitmasks for IOC4_SRCIR_<3:0> */
219 #define IOC4_SRCIR_ARM          0x80000000      /* Arm RX timer */
220
221 /* Bitmasks for IOC4_SHADOW_<3:0> */
222 #define IOC4_SHADOW_DR   0x00000001     /* Data ready */
223 #define IOC4_SHADOW_OE   0x00000002     /* Overrun error */
224 #define IOC4_SHADOW_PE   0x00000004     /* Parity error */
225 #define IOC4_SHADOW_FE   0x00000008     /* Framing error */
226 #define IOC4_SHADOW_BI   0x00000010     /* Break interrupt */
227 #define IOC4_SHADOW_THRE 0x00000020     /* Xmit holding register empty */
228 #define IOC4_SHADOW_TEMT 0x00000040     /* Xmit shift register empty */
229 #define IOC4_SHADOW_RFCE 0x00000080     /* Char in RX fifo has an error */
230 #define IOC4_SHADOW_DCTS 0x00010000     /* Delta clear to send */
231 #define IOC4_SHADOW_DDCD 0x00080000     /* Delta data carrier detect */
232 #define IOC4_SHADOW_CTS  0x00100000     /* Clear to send */
233 #define IOC4_SHADOW_DCD  0x00800000     /* Data carrier detect */
234 #define IOC4_SHADOW_DTR  0x01000000     /* Data terminal ready */
235 #define IOC4_SHADOW_RTS  0x02000000     /* Request to send */
236 #define IOC4_SHADOW_OUT1 0x04000000     /* 16550 OUT1 bit */
237 #define IOC4_SHADOW_OUT2 0x08000000     /* 16550 OUT2 bit */
238 #define IOC4_SHADOW_LOOP 0x10000000     /* Loopback enabled */
239
240 /* Bitmasks for IOC4_SRTR_<3:0> */
241 #define IOC4_SRTR_CNT           0x00000fff      /* Reload value for RX timer */
242 #define IOC4_SRTR_CNT_VAL       0x0fff0000      /* Current value of RX timer */
243 #define IOC4_SRTR_CNT_VAL_SHIFT         16
244 #define IOC4_SRTR_HZ                 16000      /* SRTR clock frequency */
245
246 /* Serial port register map used for DMA and PIO serial I/O */
247 struct ioc4_serialregs {
248         uint32_t sscr;
249         uint32_t stpir;
250         uint32_t stcir;
251         uint32_t srpir;
252         uint32_t srcir;
253         uint32_t srtr;
254         uint32_t shadow;
255 };
256
257 /* IOC4 UART register map */
258 struct ioc4_uartregs {
259         char i4u_lcr;
260         union {
261                 char iir;       /* read only */
262                 char fcr;       /* write only */
263         } u3;
264         union {
265                 char ier;       /* DLAB == 0 */
266                 char dlm;       /* DLAB == 1 */
267         } u2;
268         union {
269                 char rbr;       /* read only, DLAB == 0 */
270                 char thr;       /* write only, DLAB == 0 */
271                 char dll;       /* DLAB == 1 */
272         } u1;
273         char i4u_scr;
274         char i4u_msr;
275         char i4u_lsr;
276         char i4u_mcr;
277 };
278
279 /* short names */
280 #define i4u_dll u1.dll
281 #define i4u_ier u2.ier
282 #define i4u_dlm u2.dlm
283 #define i4u_fcr u3.fcr
284
285 /* Serial port registers used for DMA serial I/O */
286 struct ioc4_serial {
287         uint32_t sbbr01_l;
288         uint32_t sbbr01_h;
289         uint32_t sbbr23_l;
290         uint32_t sbbr23_h;
291
292         struct ioc4_serialregs port_0;
293         struct ioc4_serialregs port_1;
294         struct ioc4_serialregs port_2;
295         struct ioc4_serialregs port_3;
296         struct ioc4_uartregs uart_0;
297         struct ioc4_uartregs uart_1;
298         struct ioc4_uartregs uart_2;
299         struct ioc4_uartregs uart_3;
300 } ioc4_serial;
301
302 /* UART clock speed */
303 #define IOC4_SER_XIN_CLK_66     66666667
304 #define IOC4_SER_XIN_CLK_33     33333333
305
306 #define IOC4_W_IES              0
307 #define IOC4_W_IEC              1
308
309 typedef void ioc4_intr_func_f(void *, uint32_t);
310 typedef ioc4_intr_func_f *ioc4_intr_func_t;
311
312 static unsigned int Num_of_ioc4_cards;
313
314 /* defining this will get you LOTS of great debug info */
315 //#define DEBUG_INTERRUPTS
316 #define DPRINT_CONFIG(_x...)    ;
317 //#define DPRINT_CONFIG(_x...)  printk _x
318
319 /* number of characters left in xmit buffer before we ask for more */
320 #define WAKEUP_CHARS    256
321
322 /* number of characters we want to transmit to the lower level at a time */
323 #define IOC4_MAX_CHARS  256
324 #define IOC4_FIFO_CHARS 255
325
326 /* Device name we're using */
327 #define DEVICE_NAME_RS232  "ttyIOC"
328 #define DEVICE_NAME_RS422  "ttyAIOC"
329 #define DEVICE_MAJOR       204
330 #define DEVICE_MINOR_RS232 50
331 #define DEVICE_MINOR_RS422 84
332
333
334 /* register offsets */
335 #define IOC4_SERIAL_OFFSET      0x300
336
337 /* flags for next_char_state */
338 #define NCS_BREAK       0x1
339 #define NCS_PARITY      0x2
340 #define NCS_FRAMING     0x4
341 #define NCS_OVERRUN     0x8
342
343 /* cause we need SOME parameters ... */
344 #define MIN_BAUD_SUPPORTED      1200
345 #define MAX_BAUD_SUPPORTED      115200
346
347 /* protocol types supported */
348 #define PROTO_RS232     3
349 #define PROTO_RS422     7
350
351 /* Notification types */
352 #define N_DATA_READY    0x01
353 #define N_OUTPUT_LOWAT  0x02
354 #define N_BREAK         0x04
355 #define N_PARITY_ERROR  0x08
356 #define N_FRAMING_ERROR 0x10
357 #define N_OVERRUN_ERROR 0x20
358 #define N_DDCD          0x40
359 #define N_DCTS          0x80
360
361 #define N_ALL_INPUT     (N_DATA_READY | N_BREAK |                       \
362                          N_PARITY_ERROR | N_FRAMING_ERROR |             \
363                          N_OVERRUN_ERROR | N_DDCD | N_DCTS)
364
365 #define N_ALL_OUTPUT    N_OUTPUT_LOWAT
366
367 #define N_ALL_ERRORS    (N_PARITY_ERROR | N_FRAMING_ERROR | N_OVERRUN_ERROR)
368
369 #define N_ALL           (N_DATA_READY | N_OUTPUT_LOWAT | N_BREAK |      \
370                          N_PARITY_ERROR | N_FRAMING_ERROR |             \
371                          N_OVERRUN_ERROR | N_DDCD | N_DCTS)
372
373 #define SER_DIVISOR(_x, clk)            (((clk) + (_x) * 8) / ((_x) * 16))
374 #define DIVISOR_TO_BAUD(div, clk)       ((clk) / 16 / (div))
375
376 /* Some masks */
377 #define LCR_MASK_BITS_CHAR      (UART_LCR_WLEN5 | UART_LCR_WLEN6 \
378                                         | UART_LCR_WLEN7 | UART_LCR_WLEN8)
379 #define LCR_MASK_STOP_BITS      (UART_LCR_STOP)
380
381 #define PENDING(_p)     (readl(&(_p)->ip_mem->sio_ir.raw) & _p->ip_ienb)
382 #define READ_SIO_IR(_p) readl(&(_p)->ip_mem->sio_ir.raw)
383
384 /* Default to 4k buffers */
385 #ifdef IOC4_1K_BUFFERS
386 #define RING_BUF_SIZE 1024
387 #define IOC4_BUF_SIZE_BIT 0
388 #define PROD_CONS_MASK IOC4_PROD_CONS_PTR_1K
389 #else
390 #define RING_BUF_SIZE 4096
391 #define IOC4_BUF_SIZE_BIT IOC4_SBBR_L_SIZE
392 #define PROD_CONS_MASK IOC4_PROD_CONS_PTR_4K
393 #endif
394
395 #define TOTAL_RING_BUF_SIZE (RING_BUF_SIZE * 4)
396
397 /*
398  * This is the entry saved by the driver - one per card
399  */
400
401 #define UART_PORT_MIN           0
402 #define UART_PORT_RS232         UART_PORT_MIN
403 #define UART_PORT_RS422         1
404 #define UART_PORT_COUNT         2       /* one for each mode */
405
406 struct ioc4_control {
407         int ic_irq;
408         struct {
409                 /* uart ports are allocated here - 1 for rs232, 1 for rs422 */
410                 struct uart_port icp_uart_port[UART_PORT_COUNT];
411                 /* Handy reference material */
412                 struct ioc4_port *icp_port;
413         } ic_port[IOC4_NUM_SERIAL_PORTS];
414         struct ioc4_soft *ic_soft;
415 };
416
417 /*
418  * per-IOC4 data structure
419  */
420 #define MAX_IOC4_INTR_ENTS      (8 * sizeof(uint32_t))
421 struct ioc4_soft {
422         struct ioc4_misc_regs __iomem *is_ioc4_misc_addr;
423         struct ioc4_serial __iomem *is_ioc4_serial_addr;
424
425         /* Each interrupt type has an entry in the array */
426         struct ioc4_intr_type {
427
428                 /*
429                  * Each in-use entry in this array contains at least
430                  * one nonzero bit in sd_bits; no two entries in this
431                  * array have overlapping sd_bits values.
432                  */
433                 struct ioc4_intr_info {
434                         uint32_t sd_bits;
435                         ioc4_intr_func_f *sd_intr;
436                         void *sd_info;
437                 } is_intr_info[MAX_IOC4_INTR_ENTS];
438
439                 /* Number of entries active in the above array */
440                 atomic_t is_num_intrs;
441         } is_intr_type[IOC4_NUM_INTR_TYPES];
442
443         /* is_ir_lock must be held while
444          * modifying sio_ie values, so
445          * we can be sure that sio_ie is
446          * not changing when we read it
447          * along with sio_ir.
448          */
449         spinlock_t is_ir_lock;  /* SIO_IE[SC] mod lock */
450 };
451
452 /* Local port info for each IOC4 serial ports */
453 struct ioc4_port {
454         struct uart_port *ip_port;      /* current active port ptr */
455         /* Ptrs for all ports */
456         struct uart_port *ip_all_ports[UART_PORT_COUNT];
457         /* Back ptrs for this port */
458         struct ioc4_control *ip_control;
459         struct pci_dev *ip_pdev;
460         struct ioc4_soft *ip_ioc4_soft;
461
462         /* pci mem addresses */
463         struct ioc4_misc_regs __iomem *ip_mem;
464         struct ioc4_serial __iomem *ip_serial;
465         struct ioc4_serialregs __iomem *ip_serial_regs;
466         struct ioc4_uartregs __iomem *ip_uart_regs;
467
468         /* Ring buffer page for this port */
469         dma_addr_t ip_dma_ringbuf;
470         /* vaddr of ring buffer */
471         struct ring_buffer *ip_cpu_ringbuf;
472
473         /* Rings for this port */
474         struct ring *ip_inring;
475         struct ring *ip_outring;
476
477         /* Hook to port specific values */
478         struct hooks *ip_hooks;
479
480         spinlock_t ip_lock;
481
482         /* Various rx/tx parameters */
483         int ip_baud;
484         int ip_tx_lowat;
485         int ip_rx_timeout;
486
487         /* Copy of notification bits */
488         int ip_notify;
489
490         /* Shadow copies of various registers so we don't need to PIO
491          * read them constantly
492          */
493         uint32_t ip_ienb;       /* Enabled interrupts */
494         uint32_t ip_sscr;
495         uint32_t ip_tx_prod;
496         uint32_t ip_rx_cons;
497         int ip_pci_bus_speed;
498         unsigned char ip_flags;
499 };
500
501 /* tx low water mark.  We need to notify the driver whenever tx is getting
502  * close to empty so it can refill the tx buffer and keep things going.
503  * Let's assume that if we interrupt 1 ms before the tx goes idle, we'll
504  * have no trouble getting in more chars in time (I certainly hope so).
505  */
506 #define TX_LOWAT_LATENCY      1000
507 #define TX_LOWAT_HZ          (1000000 / TX_LOWAT_LATENCY)
508 #define TX_LOWAT_CHARS(baud) (baud / 10 / TX_LOWAT_HZ)
509
510 /* Flags per port */
511 #define INPUT_HIGH      0x01
512 #define DCD_ON          0x02
513 #define LOWAT_WRITTEN   0x04
514 #define READ_ABORTED    0x08
515 #define PORT_ACTIVE     0x10
516 #define PORT_INACTIVE   0       /* This is the value when "off" */
517
518
519 /* Since each port has different register offsets and bitmasks
520  * for everything, we'll store those that we need in tables so we
521  * don't have to be constantly checking the port we are dealing with.
522  */
523 struct hooks {
524         uint32_t intr_delta_dcd;
525         uint32_t intr_delta_cts;
526         uint32_t intr_tx_mt;
527         uint32_t intr_rx_timer;
528         uint32_t intr_rx_high;
529         uint32_t intr_tx_explicit;
530         uint32_t intr_dma_error;
531         uint32_t intr_clear;
532         uint32_t intr_all;
533         int rs422_select_pin;
534 };
535
536 static struct hooks hooks_array[IOC4_NUM_SERIAL_PORTS] = {
537         /* Values for port 0 */
538         {
539          IOC4_SIO_IR_S0_DELTA_DCD, IOC4_SIO_IR_S0_DELTA_CTS,
540          IOC4_SIO_IR_S0_TX_MT, IOC4_SIO_IR_S0_RX_TIMER,
541          IOC4_SIO_IR_S0_RX_HIGH, IOC4_SIO_IR_S0_TX_EXPLICIT,
542          IOC4_OTHER_IR_S0_MEMERR,
543          (IOC4_SIO_IR_S0_TX_MT | IOC4_SIO_IR_S0_RX_FULL |
544           IOC4_SIO_IR_S0_RX_HIGH | IOC4_SIO_IR_S0_RX_TIMER |
545           IOC4_SIO_IR_S0_DELTA_DCD | IOC4_SIO_IR_S0_DELTA_CTS |
546           IOC4_SIO_IR_S0_INT | IOC4_SIO_IR_S0_TX_EXPLICIT),
547          IOC4_SIO_IR_S0, IOC4_GPPR_UART0_MODESEL_PIN,
548          },
549
550         /* Values for port 1 */
551         {
552          IOC4_SIO_IR_S1_DELTA_DCD, IOC4_SIO_IR_S1_DELTA_CTS,
553          IOC4_SIO_IR_S1_TX_MT, IOC4_SIO_IR_S1_RX_TIMER,
554          IOC4_SIO_IR_S1_RX_HIGH, IOC4_SIO_IR_S1_TX_EXPLICIT,
555          IOC4_OTHER_IR_S1_MEMERR,
556          (IOC4_SIO_IR_S1_TX_MT | IOC4_SIO_IR_S1_RX_FULL |
557           IOC4_SIO_IR_S1_RX_HIGH | IOC4_SIO_IR_S1_RX_TIMER |
558           IOC4_SIO_IR_S1_DELTA_DCD | IOC4_SIO_IR_S1_DELTA_CTS |
559           IOC4_SIO_IR_S1_INT | IOC4_SIO_IR_S1_TX_EXPLICIT),
560          IOC4_SIO_IR_S1, IOC4_GPPR_UART1_MODESEL_PIN,
561          },
562
563         /* Values for port 2 */
564         {
565          IOC4_SIO_IR_S2_DELTA_DCD, IOC4_SIO_IR_S2_DELTA_CTS,
566          IOC4_SIO_IR_S2_TX_MT, IOC4_SIO_IR_S2_RX_TIMER,
567          IOC4_SIO_IR_S2_RX_HIGH, IOC4_SIO_IR_S2_TX_EXPLICIT,
568          IOC4_OTHER_IR_S2_MEMERR,
569          (IOC4_SIO_IR_S2_TX_MT | IOC4_SIO_IR_S2_RX_FULL |
570           IOC4_SIO_IR_S2_RX_HIGH | IOC4_SIO_IR_S2_RX_TIMER |
571           IOC4_SIO_IR_S2_DELTA_DCD | IOC4_SIO_IR_S2_DELTA_CTS |
572           IOC4_SIO_IR_S2_INT | IOC4_SIO_IR_S2_TX_EXPLICIT),
573          IOC4_SIO_IR_S2, IOC4_GPPR_UART2_MODESEL_PIN,
574          },
575
576         /* Values for port 3 */
577         {
578          IOC4_SIO_IR_S3_DELTA_DCD, IOC4_SIO_IR_S3_DELTA_CTS,
579          IOC4_SIO_IR_S3_TX_MT, IOC4_SIO_IR_S3_RX_TIMER,
580          IOC4_SIO_IR_S3_RX_HIGH, IOC4_SIO_IR_S3_TX_EXPLICIT,
581          IOC4_OTHER_IR_S3_MEMERR,
582          (IOC4_SIO_IR_S3_TX_MT | IOC4_SIO_IR_S3_RX_FULL |
583           IOC4_SIO_IR_S3_RX_HIGH | IOC4_SIO_IR_S3_RX_TIMER |
584           IOC4_SIO_IR_S3_DELTA_DCD | IOC4_SIO_IR_S3_DELTA_CTS |
585           IOC4_SIO_IR_S3_INT | IOC4_SIO_IR_S3_TX_EXPLICIT),
586          IOC4_SIO_IR_S3, IOC4_GPPR_UART3_MODESEL_PIN,
587          }
588 };
589
590 /* A ring buffer entry */
591 struct ring_entry {
592         union {
593                 struct {
594                         uint32_t alldata;
595                         uint32_t allsc;
596                 } all;
597                 struct {
598                         char data[4];   /* data bytes */
599                         char sc[4];     /* status/control */
600                 } s;
601         } u;
602 };
603
604 /* Test the valid bits in any of the 4 sc chars using "allsc" member */
605 #define RING_ANY_VALID \
606         ((uint32_t)(IOC4_RXSB_MODEM_VALID | IOC4_RXSB_DATA_VALID) * 0x01010101)
607
608 #define ring_sc     u.s.sc
609 #define ring_data   u.s.data
610 #define ring_allsc  u.all.allsc
611
612 /* Number of entries per ring buffer. */
613 #define ENTRIES_PER_RING (RING_BUF_SIZE / (int) sizeof(struct ring_entry))
614
615 /* An individual ring */
616 struct ring {
617         struct ring_entry entries[ENTRIES_PER_RING];
618 };
619
620 /* The whole enchilada */
621 struct ring_buffer {
622         struct ring TX_0_OR_2;
623         struct ring RX_0_OR_2;
624         struct ring TX_1_OR_3;
625         struct ring RX_1_OR_3;
626 };
627
628 /* Get a ring from a port struct */
629 #define RING(_p, _wh)   &(((struct ring_buffer *)((_p)->ip_cpu_ringbuf))->_wh)
630
631 /* Infinite loop detection.
632  */
633 #define MAXITER 10000000
634
635 /* Prototypes */
636 static void receive_chars(struct uart_port *);
637 static void handle_intr(void *arg, uint32_t sio_ir);
638
639 /*
640  * port_is_active - determines if this port is currently active
641  * @port: ptr to soft struct for this port
642  * @uart_port: uart port to test for
643  */
644 static inline int port_is_active(struct ioc4_port *port,
645                 struct uart_port *uart_port)
646 {
647         if (port) {
648                 if ((port->ip_flags & PORT_ACTIVE)
649                                         && (port->ip_port == uart_port))
650                         return 1;
651         }
652         return 0;
653 }
654
655
656 /**
657  * write_ireg - write the interrupt regs
658  * @ioc4_soft: ptr to soft struct for this port
659  * @val: value to write
660  * @which: which register
661  * @type: which ireg set
662  */
663 static inline void
664 write_ireg(struct ioc4_soft *ioc4_soft, uint32_t val, int which, int type)
665 {
666         struct ioc4_misc_regs __iomem *mem = ioc4_soft->is_ioc4_misc_addr;
667         unsigned long flags;
668
669         spin_lock_irqsave(&ioc4_soft->is_ir_lock, flags);
670
671         switch (type) {
672         case IOC4_SIO_INTR_TYPE:
673                 switch (which) {
674                 case IOC4_W_IES:
675                         writel(val, &mem->sio_ies.raw);
676                         break;
677
678                 case IOC4_W_IEC:
679                         writel(val, &mem->sio_iec.raw);
680                         break;
681                 }
682                 break;
683
684         case IOC4_OTHER_INTR_TYPE:
685                 switch (which) {
686                 case IOC4_W_IES:
687                         writel(val, &mem->other_ies.raw);
688                         break;
689
690                 case IOC4_W_IEC:
691                         writel(val, &mem->other_iec.raw);
692                         break;
693                 }
694                 break;
695
696         default:
697                 break;
698         }
699         spin_unlock_irqrestore(&ioc4_soft->is_ir_lock, flags);
700 }
701
702 /**
703  * set_baud - Baud rate setting code
704  * @port: port to set
705  * @baud: baud rate to use
706  */
707 static int set_baud(struct ioc4_port *port, int baud)
708 {
709         int actual_baud;
710         int diff;
711         int lcr;
712         unsigned short divisor;
713         struct ioc4_uartregs __iomem *uart;
714
715         divisor = SER_DIVISOR(baud, port->ip_pci_bus_speed);
716         if (!divisor)
717                 return 1;
718         actual_baud = DIVISOR_TO_BAUD(divisor, port->ip_pci_bus_speed);
719
720         diff = actual_baud - baud;
721         if (diff < 0)
722                 diff = -diff;
723
724         /* If we're within 1%, we've found a match */
725         if (diff * 100 > actual_baud)
726                 return 1;
727
728         uart = port->ip_uart_regs;
729         lcr = readb(&uart->i4u_lcr);
730         writeb(lcr | UART_LCR_DLAB, &uart->i4u_lcr);
731         writeb((unsigned char)divisor, &uart->i4u_dll);
732         writeb((unsigned char)(divisor >> 8), &uart->i4u_dlm);
733         writeb(lcr, &uart->i4u_lcr);
734         return 0;
735 }
736
737
738 /**
739  * get_ioc4_port - given a uart port, return the control structure
740  * @port: uart port
741  * @set: set this port as current
742  */
743 static struct ioc4_port *get_ioc4_port(struct uart_port *the_port, int set)
744 {
745         struct ioc4_driver_data *idd = dev_get_drvdata(the_port->dev);
746         struct ioc4_control *control = idd->idd_serial_data;
747         struct ioc4_port *port;
748         int port_num, port_type;
749
750         if (control) {
751                 for ( port_num = 0; port_num < IOC4_NUM_SERIAL_PORTS;
752                                                         port_num++ ) {
753                         port = control->ic_port[port_num].icp_port;
754                         if (!port)
755                                 continue;
756                         for (port_type = UART_PORT_MIN;
757                                                 port_type < UART_PORT_COUNT;
758                                                 port_type++) {
759                                 if (the_port == port->ip_all_ports
760                                                         [port_type]) {
761                                         /* set local copy */
762                                         if (set) {
763                                                 port->ip_port = the_port;
764                                         }
765                                         return port;
766                                 }
767                         }
768                 }
769         }
770         return NULL;
771 }
772
773 /* The IOC4 hardware provides no atomic way to determine if interrupts
774  * are pending since two reads are required to do so.  The handler must
775  * read the SIO_IR and the SIO_IES, and take the logical and of the
776  * two.  When this value is zero, all interrupts have been serviced and
777  * the handler may return.
778  *
779  * This has the unfortunate "hole" that, if some other CPU or
780  * some other thread or some higher level interrupt manages to
781  * modify SIO_IE between our reads of SIO_IR and SIO_IE, we may
782  * think we have observed SIO_IR&SIO_IE==0 when in fact this
783  * condition never really occurred.
784  *
785  * To solve this, we use a simple spinlock that must be held
786  * whenever modifying SIO_IE; holding this lock while observing
787  * both SIO_IR and SIO_IE guarantees that we do not falsely
788  * conclude that no enabled interrupts are pending.
789  */
790
791 static inline uint32_t
792 pending_intrs(struct ioc4_soft *soft, int type)
793 {
794         struct ioc4_misc_regs __iomem *mem = soft->is_ioc4_misc_addr;
795         unsigned long flag;
796         uint32_t intrs = 0;
797
798         BUG_ON(!((type == IOC4_SIO_INTR_TYPE)
799                || (type == IOC4_OTHER_INTR_TYPE)));
800
801         spin_lock_irqsave(&soft->is_ir_lock, flag);
802
803         switch (type) {
804         case IOC4_SIO_INTR_TYPE:
805                 intrs = readl(&mem->sio_ir.raw) & readl(&mem->sio_ies.raw);
806                 break;
807
808         case IOC4_OTHER_INTR_TYPE:
809                 intrs = readl(&mem->other_ir.raw) & readl(&mem->other_ies.raw);
810
811                 /* Don't process any ATA interrupte */
812                 intrs &= ~(IOC4_OTHER_IR_ATA_INT | IOC4_OTHER_IR_ATA_MEMERR);
813                 break;
814
815         default:
816                 break;
817         }
818         spin_unlock_irqrestore(&soft->is_ir_lock, flag);
819         return intrs;
820 }
821
822 /**
823  * port_init - Initialize the sio and ioc4 hardware for a given port
824  *                      called per port from attach...
825  * @port: port to initialize
826  */
827 static int inline port_init(struct ioc4_port *port)
828 {
829         uint32_t sio_cr;
830         struct hooks *hooks = port->ip_hooks;
831         struct ioc4_uartregs __iomem *uart;
832
833         /* Idle the IOC4 serial interface */
834         writel(IOC4_SSCR_RESET, &port->ip_serial_regs->sscr);
835
836         /* Wait until any pending bus activity for this port has ceased */
837         do
838                 sio_cr = readl(&port->ip_mem->sio_cr.raw);
839         while (!(sio_cr & IOC4_SIO_CR_SIO_DIAG_IDLE));
840
841         /* Finish reset sequence */
842         writel(0, &port->ip_serial_regs->sscr);
843
844         /* Once RESET is done, reload cached tx_prod and rx_cons values
845          * and set rings to empty by making prod == cons
846          */
847         port->ip_tx_prod = readl(&port->ip_serial_regs->stcir) & PROD_CONS_MASK;
848         writel(port->ip_tx_prod, &port->ip_serial_regs->stpir);
849         port->ip_rx_cons = readl(&port->ip_serial_regs->srpir) & PROD_CONS_MASK;
850         writel(port->ip_rx_cons | IOC4_SRCIR_ARM, &port->ip_serial_regs->srcir);
851
852         /* Disable interrupts for this 16550 */
853         uart = port->ip_uart_regs;
854         writeb(0, &uart->i4u_lcr);
855         writeb(0, &uart->i4u_ier);
856
857         /* Set the default baud */
858         set_baud(port, port->ip_baud);
859
860         /* Set line control to 8 bits no parity */
861         writeb(UART_LCR_WLEN8 | 0, &uart->i4u_lcr);
862                                         /* UART_LCR_STOP == 1 stop */
863
864         /* Enable the FIFOs */
865         writeb(UART_FCR_ENABLE_FIFO, &uart->i4u_fcr);
866         /* then reset 16550 FIFOs */
867         writeb(UART_FCR_ENABLE_FIFO | UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT,
868                         &uart->i4u_fcr);
869
870         /* Clear modem control register */
871         writeb(0, &uart->i4u_mcr);
872
873         /* Clear deltas in modem status register */
874         readb(&uart->i4u_msr);
875
876         /* Only do this once per port pair */
877         if (port->ip_hooks == &hooks_array[0]
878                             || port->ip_hooks == &hooks_array[2]) {
879                 unsigned long ring_pci_addr;
880                 uint32_t __iomem *sbbr_l;
881                 uint32_t __iomem *sbbr_h;
882
883                 if (port->ip_hooks == &hooks_array[0]) {
884                         sbbr_l = &port->ip_serial->sbbr01_l;
885                         sbbr_h = &port->ip_serial->sbbr01_h;
886                 } else {
887                         sbbr_l = &port->ip_serial->sbbr23_l;
888                         sbbr_h = &port->ip_serial->sbbr23_h;
889                 }
890
891                 ring_pci_addr = (unsigned long __iomem)port->ip_dma_ringbuf;
892                 DPRINT_CONFIG(("%s: ring_pci_addr 0x%lx\n",
893                                         __func__, ring_pci_addr));
894
895                 writel((unsigned int)((uint64_t)ring_pci_addr >> 32), sbbr_h);
896                 writel((unsigned int)ring_pci_addr | IOC4_BUF_SIZE_BIT, sbbr_l);
897         }
898
899         /* Set the receive timeout value to 10 msec */
900         writel(IOC4_SRTR_HZ / 100, &port->ip_serial_regs->srtr);
901
902         /* Set rx threshold, enable DMA */
903         /* Set high water mark at 3/4 of full ring */
904         port->ip_sscr = (ENTRIES_PER_RING * 3 / 4);
905         writel(port->ip_sscr, &port->ip_serial_regs->sscr);
906
907         /* Disable and clear all serial related interrupt bits */
908         write_ireg(port->ip_ioc4_soft, hooks->intr_clear,
909                        IOC4_W_IEC, IOC4_SIO_INTR_TYPE);
910         port->ip_ienb &= ~hooks->intr_clear;
911         writel(hooks->intr_clear, &port->ip_mem->sio_ir.raw);
912         return 0;
913 }
914
915 /**
916  * handle_dma_error_intr - service any pending DMA error interrupts for the
917  *                      given port - 2nd level called via sd_intr
918  * @arg: handler arg
919  * @other_ir: ioc4regs
920  */
921 static void handle_dma_error_intr(void *arg, uint32_t other_ir)
922 {
923         struct ioc4_port *port = (struct ioc4_port *)arg;
924         struct hooks *hooks = port->ip_hooks;
925         unsigned long flags;
926
927         spin_lock_irqsave(&port->ip_lock, flags);
928
929         /* ACK the interrupt */
930         writel(hooks->intr_dma_error, &port->ip_mem->other_ir.raw);
931
932         if (readl(&port->ip_mem->pci_err_addr_l.raw) & IOC4_PCI_ERR_ADDR_VLD) {
933                 printk(KERN_ERR
934                         "PCI error address is 0x%llx, "
935                                 "master is serial port %c %s\n",
936                      (((uint64_t)readl(&port->ip_mem->pci_err_addr_h)
937                                                          << 32)
938                                 | readl(&port->ip_mem->pci_err_addr_l.raw))
939                                         & IOC4_PCI_ERR_ADDR_ADDR_MSK, '1' +
940                      ((char)(readl(&port->ip_mem->pci_err_addr_l.raw) &
941                              IOC4_PCI_ERR_ADDR_MST_NUM_MSK) >> 1),
942                      (readl(&port->ip_mem->pci_err_addr_l.raw)
943                                 & IOC4_PCI_ERR_ADDR_MST_TYP_MSK)
944                                 ? "RX" : "TX");
945
946                 if (readl(&port->ip_mem->pci_err_addr_l.raw)
947                                                 & IOC4_PCI_ERR_ADDR_MUL_ERR) {
948                         printk(KERN_ERR
949                                 "Multiple errors occurred\n");
950                 }
951         }
952         spin_unlock_irqrestore(&port->ip_lock, flags);
953
954         /* Re-enable DMA error interrupts */
955         write_ireg(port->ip_ioc4_soft, hooks->intr_dma_error, IOC4_W_IES,
956                                                 IOC4_OTHER_INTR_TYPE);
957 }
958
959 /**
960  * intr_connect - interrupt connect function
961  * @soft: soft struct for this card
962  * @type: interrupt type
963  * @intrbits: bit pattern to set
964  * @intr: handler function
965  * @info: handler arg
966  */
967 static void
968 intr_connect(struct ioc4_soft *soft, int type,
969                   uint32_t intrbits, ioc4_intr_func_f * intr, void *info)
970 {
971         int i;
972         struct ioc4_intr_info *intr_ptr;
973
974         BUG_ON(!((type == IOC4_SIO_INTR_TYPE)
975                || (type == IOC4_OTHER_INTR_TYPE)));
976
977         i = atomic_inc(&soft-> is_intr_type[type].is_num_intrs) - 1;
978         BUG_ON(!(i < MAX_IOC4_INTR_ENTS || (printk("i %d\n", i), 0)));
979
980         /* Save off the lower level interrupt handler */
981         intr_ptr = &soft->is_intr_type[type].is_intr_info[i];
982         intr_ptr->sd_bits = intrbits;
983         intr_ptr->sd_intr = intr;
984         intr_ptr->sd_info = info;
985 }
986
987 /**
988  * ioc4_intr - Top level IOC4 interrupt handler.
989  * @irq: irq value
990  * @arg: handler arg
991  */
992
993 static irqreturn_t ioc4_intr(int irq, void *arg)
994 {
995         struct ioc4_soft *soft;
996         uint32_t this_ir, this_mir;
997         int xx, num_intrs = 0;
998         int intr_type;
999         int handled = 0;
1000         struct ioc4_intr_info *intr_info;
1001
1002         soft = arg;
1003         for (intr_type = 0; intr_type < IOC4_NUM_INTR_TYPES; intr_type++) {
1004                 num_intrs = (int)atomic_read(
1005                                 &soft->is_intr_type[intr_type].is_num_intrs);
1006
1007                 this_mir = this_ir = pending_intrs(soft, intr_type);
1008
1009                 /* Farm out the interrupt to the various drivers depending on
1010                  * which interrupt bits are set.
1011                  */
1012                 for (xx = 0; xx < num_intrs; xx++) {
1013                         intr_info = &soft->is_intr_type[intr_type].is_intr_info[xx];
1014                         if ((this_mir = this_ir & intr_info->sd_bits)) {
1015                                 /* Disable owned interrupts, call handler */
1016                                 handled++;
1017                                 write_ireg(soft, intr_info->sd_bits, IOC4_W_IEC,
1018                                                                 intr_type);
1019                                 intr_info->sd_intr(intr_info->sd_info, this_mir);
1020                                 this_ir &= ~this_mir;
1021                         }
1022                 }
1023         }
1024 #ifdef DEBUG_INTERRUPTS
1025         {
1026                 struct ioc4_misc_regs __iomem *mem = soft->is_ioc4_misc_addr;
1027                 unsigned long flag;
1028
1029                 spin_lock_irqsave(&soft->is_ir_lock, flag);
1030                 printk ("%s : %d : mem 0x%p sio_ir 0x%x sio_ies 0x%x "
1031                                 "other_ir 0x%x other_ies 0x%x mask 0x%x\n",
1032                      __func__, __LINE__,
1033                      (void *)mem, readl(&mem->sio_ir.raw),
1034                      readl(&mem->sio_ies.raw),
1035                      readl(&mem->other_ir.raw),
1036                      readl(&mem->other_ies.raw),
1037                      IOC4_OTHER_IR_ATA_INT | IOC4_OTHER_IR_ATA_MEMERR);
1038                 spin_unlock_irqrestore(&soft->is_ir_lock, flag);
1039         }
1040 #endif
1041         return handled ? IRQ_HANDLED : IRQ_NONE;
1042 }
1043
1044 /**
1045  * ioc4_attach_local - Device initialization.
1046  *                      Called at *_attach() time for each
1047  *                      IOC4 with serial ports in the system.
1048  * @idd: Master module data for this IOC4
1049  */
1050 static int inline ioc4_attach_local(struct ioc4_driver_data *idd)
1051 {
1052         struct ioc4_port *port;
1053         struct ioc4_port *ports[IOC4_NUM_SERIAL_PORTS];
1054         int port_number;
1055         uint16_t ioc4_revid_min = 62;
1056         uint16_t ioc4_revid;
1057         struct pci_dev *pdev = idd->idd_pdev;
1058         struct ioc4_control* control = idd->idd_serial_data;
1059         struct ioc4_soft *soft = control->ic_soft;
1060         void __iomem *ioc4_misc = idd->idd_misc_regs;
1061         void __iomem *ioc4_serial = soft->is_ioc4_serial_addr;
1062
1063         /* IOC4 firmware must be at least rev 62 */
1064         pci_read_config_word(pdev, PCI_COMMAND_SPECIAL, &ioc4_revid);
1065
1066         printk(KERN_INFO "IOC4 firmware revision %d\n", ioc4_revid);
1067         if (ioc4_revid < ioc4_revid_min) {
1068                 printk(KERN_WARNING
1069                     "IOC4 serial not supported on firmware rev %d, "
1070                                 "please upgrade to rev %d or higher\n",
1071                                 ioc4_revid, ioc4_revid_min);
1072                 return -EPERM;
1073         }
1074         BUG_ON(ioc4_misc == NULL);
1075         BUG_ON(ioc4_serial == NULL);
1076
1077         /* Create port structures for each port */
1078         for (port_number = 0; port_number < IOC4_NUM_SERIAL_PORTS;
1079                                                         port_number++) {
1080                 port = kzalloc(sizeof(struct ioc4_port), GFP_KERNEL);
1081                 if (!port) {
1082                         printk(KERN_WARNING
1083                                 "IOC4 serial memory not available for port\n");
1084                         return -ENOMEM;
1085                 }
1086                 spin_lock_init(&port->ip_lock);
1087
1088                 /* we need to remember the previous ones, to point back to
1089                  * them farther down - setting up the ring buffers.
1090                  */
1091                 ports[port_number] = port;
1092
1093                 /* Allocate buffers and jumpstart the hardware.  */
1094                 control->ic_port[port_number].icp_port = port;
1095                 port->ip_ioc4_soft = soft;
1096                 port->ip_pdev = pdev;
1097                 port->ip_ienb = 0;
1098                 /* Use baud rate calculations based on detected PCI
1099                  * bus speed.  Simply test whether the PCI clock is
1100                  * running closer to 66MHz or 33MHz.
1101                  */
1102                 if (idd->count_period/IOC4_EXTINT_COUNT_DIVISOR < 20) {
1103                         port->ip_pci_bus_speed = IOC4_SER_XIN_CLK_66;
1104                 } else {
1105                         port->ip_pci_bus_speed = IOC4_SER_XIN_CLK_33;
1106                 }
1107                 port->ip_baud = 9600;
1108                 port->ip_control = control;
1109                 port->ip_mem = ioc4_misc;
1110                 port->ip_serial = ioc4_serial;
1111
1112                 /* point to the right hook */
1113                 port->ip_hooks = &hooks_array[port_number];
1114
1115                 /* Get direct hooks to the serial regs and uart regs
1116                  * for this port
1117                  */
1118                 switch (port_number) {
1119                 case 0:
1120                         port->ip_serial_regs = &(port->ip_serial->port_0);
1121                         port->ip_uart_regs = &(port->ip_serial->uart_0);
1122                         break;
1123                 case 1:
1124                         port->ip_serial_regs = &(port->ip_serial->port_1);
1125                         port->ip_uart_regs = &(port->ip_serial->uart_1);
1126                         break;
1127                 case 2:
1128                         port->ip_serial_regs = &(port->ip_serial->port_2);
1129                         port->ip_uart_regs = &(port->ip_serial->uart_2);
1130                         break;
1131                 default:
1132                 case 3:
1133                         port->ip_serial_regs = &(port->ip_serial->port_3);
1134                         port->ip_uart_regs = &(port->ip_serial->uart_3);
1135                         break;
1136                 }
1137
1138                 /* ring buffers are 1 to a pair of ports */
1139                 if (port_number && (port_number & 1)) {
1140                         /* odd use the evens buffer */
1141                         port->ip_dma_ringbuf =
1142                                         ports[port_number - 1]->ip_dma_ringbuf;
1143                         port->ip_cpu_ringbuf =
1144                                         ports[port_number - 1]->ip_cpu_ringbuf;
1145                         port->ip_inring = RING(port, RX_1_OR_3);
1146                         port->ip_outring = RING(port, TX_1_OR_3);
1147
1148                 } else {
1149                         if (port->ip_dma_ringbuf == 0) {
1150                                 port->ip_cpu_ringbuf = pci_alloc_consistent
1151                                         (pdev, TOTAL_RING_BUF_SIZE,
1152                                         &port->ip_dma_ringbuf);
1153
1154                         }
1155                         BUG_ON(!((((int64_t)port->ip_dma_ringbuf) &
1156                                 (TOTAL_RING_BUF_SIZE - 1)) == 0));
1157                         DPRINT_CONFIG(("%s : ip_cpu_ringbuf 0x%p "
1158                                                 "ip_dma_ringbuf 0x%p\n",
1159                                         __func__,
1160                                         (void *)port->ip_cpu_ringbuf,
1161                                         (void *)port->ip_dma_ringbuf));
1162                         port->ip_inring = RING(port, RX_0_OR_2);
1163                         port->ip_outring = RING(port, TX_0_OR_2);
1164                 }
1165                 DPRINT_CONFIG(("%s : port %d [addr 0x%p] control 0x%p",
1166                                 __func__,
1167                                 port_number, (void *)port, (void *)control));
1168                 DPRINT_CONFIG((" ip_serial_regs 0x%p ip_uart_regs 0x%p\n",
1169                                 (void *)port->ip_serial_regs,
1170                                 (void *)port->ip_uart_regs));
1171
1172                 /* Initialize the hardware for IOC4 */
1173                 port_init(port);
1174
1175                 DPRINT_CONFIG(("%s: port_number %d port 0x%p inring 0x%p "
1176                                                 "outring 0x%p\n",
1177                                 __func__,
1178                                 port_number, (void *)port,
1179                                 (void *)port->ip_inring,
1180                                 (void *)port->ip_outring));
1181
1182                 /* Attach interrupt handlers */
1183                 intr_connect(soft, IOC4_SIO_INTR_TYPE,
1184                                 GET_SIO_IR(port_number),
1185                                 handle_intr, port);
1186
1187                 intr_connect(soft, IOC4_OTHER_INTR_TYPE,
1188                                 GET_OTHER_IR(port_number),
1189                                 handle_dma_error_intr, port);
1190         }
1191         return 0;
1192 }
1193
1194 /**
1195  * enable_intrs - enable interrupts
1196  * @port: port to enable
1197  * @mask: mask to use
1198  */
1199 static void enable_intrs(struct ioc4_port *port, uint32_t mask)
1200 {
1201         struct hooks *hooks = port->ip_hooks;
1202
1203         if ((port->ip_ienb & mask) != mask) {
1204                 write_ireg(port->ip_ioc4_soft, mask, IOC4_W_IES,
1205                                                 IOC4_SIO_INTR_TYPE);
1206                 port->ip_ienb |= mask;
1207         }
1208
1209         if (port->ip_ienb)
1210                 write_ireg(port->ip_ioc4_soft, hooks->intr_dma_error,
1211                                 IOC4_W_IES, IOC4_OTHER_INTR_TYPE);
1212 }
1213
1214 /**
1215  * local_open - local open a port
1216  * @port: port to open
1217  */
1218 static inline int local_open(struct ioc4_port *port)
1219 {
1220         int spiniter = 0;
1221
1222         port->ip_flags = PORT_ACTIVE;
1223
1224         /* Pause the DMA interface if necessary */
1225         if (port->ip_sscr & IOC4_SSCR_DMA_EN) {
1226                 writel(port->ip_sscr | IOC4_SSCR_DMA_PAUSE,
1227                         &port->ip_serial_regs->sscr);
1228                 while((readl(&port->ip_serial_regs-> sscr)
1229                                 & IOC4_SSCR_PAUSE_STATE) == 0) {
1230                         spiniter++;
1231                         if (spiniter > MAXITER) {
1232                                 port->ip_flags = PORT_INACTIVE;
1233                                 return -1;
1234                         }
1235                 }
1236         }
1237
1238         /* Reset the input fifo.  If the uart received chars while the port
1239          * was closed and DMA is not enabled, the uart may have a bunch of
1240          * chars hanging around in its rx fifo which will not be discarded
1241          * by rclr in the upper layer. We must get rid of them here.
1242          */
1243         writeb(UART_FCR_ENABLE_FIFO | UART_FCR_CLEAR_RCVR,
1244                                 &port->ip_uart_regs->i4u_fcr);
1245
1246         writeb(UART_LCR_WLEN8, &port->ip_uart_regs->i4u_lcr);
1247                                         /* UART_LCR_STOP == 1 stop */
1248
1249         /* Re-enable DMA, set default threshold to intr whenever there is
1250          * data available.
1251          */
1252         port->ip_sscr &= ~IOC4_SSCR_RX_THRESHOLD;
1253         port->ip_sscr |= 1;     /* default threshold */
1254
1255         /* Plug in the new sscr.  This implicitly clears the DMA_PAUSE
1256          * flag if it was set above
1257          */
1258         writel(port->ip_sscr, &port->ip_serial_regs->sscr);
1259         port->ip_tx_lowat = 1;
1260         return 0;
1261 }
1262
1263 /**
1264  * set_rx_timeout - Set rx timeout and threshold values.
1265  * @port: port to use
1266  * @timeout: timeout value in ticks
1267  */
1268 static inline int set_rx_timeout(struct ioc4_port *port, int timeout)
1269 {
1270         int threshold;
1271
1272         port->ip_rx_timeout = timeout;
1273
1274         /* Timeout is in ticks.  Let's figure out how many chars we
1275          * can receive at the current baud rate in that interval
1276          * and set the rx threshold to that amount.  There are 4 chars
1277          * per ring entry, so we'll divide the number of chars that will
1278          * arrive in timeout by 4.
1279          * So .... timeout * baud / 10 / HZ / 4, with HZ = 100.
1280          */
1281         threshold = timeout * port->ip_baud / 4000;
1282         if (threshold == 0)
1283                 threshold = 1;  /* otherwise we'll intr all the time! */
1284
1285         if ((unsigned)threshold > (unsigned)IOC4_SSCR_RX_THRESHOLD)
1286                 return 1;
1287
1288         port->ip_sscr &= ~IOC4_SSCR_RX_THRESHOLD;
1289         port->ip_sscr |= threshold;
1290
1291         writel(port->ip_sscr, &port->ip_serial_regs->sscr);
1292
1293         /* Now set the rx timeout to the given value
1294          * again timeout * IOC4_SRTR_HZ / HZ
1295          */
1296         timeout = timeout * IOC4_SRTR_HZ / 100;
1297         if (timeout > IOC4_SRTR_CNT)
1298                 timeout = IOC4_SRTR_CNT;
1299
1300         writel(timeout, &port->ip_serial_regs->srtr);
1301         return 0;
1302 }
1303
1304 /**
1305  * config_port - config the hardware
1306  * @port: port to config
1307  * @baud: baud rate for the port
1308  * @byte_size: data size
1309  * @stop_bits: number of stop bits
1310  * @parenb: parity enable ?
1311  * @parodd: odd parity ?
1312  */
1313 static inline int
1314 config_port(struct ioc4_port *port,
1315             int baud, int byte_size, int stop_bits, int parenb, int parodd)
1316 {
1317         char lcr, sizebits;
1318         int spiniter = 0;
1319
1320         DPRINT_CONFIG(("%s: baud %d byte_size %d stop %d parenb %d parodd %d\n",
1321                 __func__, baud, byte_size, stop_bits, parenb, parodd));
1322
1323         if (set_baud(port, baud))
1324                 return 1;
1325
1326         switch (byte_size) {
1327         case 5:
1328                 sizebits = UART_LCR_WLEN5;
1329                 break;
1330         case 6:
1331                 sizebits = UART_LCR_WLEN6;
1332                 break;
1333         case 7:
1334                 sizebits = UART_LCR_WLEN7;
1335                 break;
1336         case 8:
1337                 sizebits = UART_LCR_WLEN8;
1338                 break;
1339         default:
1340                 return 1;
1341         }
1342
1343         /* Pause the DMA interface if necessary */
1344         if (port->ip_sscr & IOC4_SSCR_DMA_EN) {
1345                 writel(port->ip_sscr | IOC4_SSCR_DMA_PAUSE,
1346                         &port->ip_serial_regs->sscr);
1347                 while((readl(&port->ip_serial_regs->sscr)
1348                                                 & IOC4_SSCR_PAUSE_STATE) == 0) {
1349                         spiniter++;
1350                         if (spiniter > MAXITER)
1351                                 return -1;
1352                 }
1353         }
1354
1355         /* Clear relevant fields in lcr */
1356         lcr = readb(&port->ip_uart_regs->i4u_lcr);
1357         lcr &= ~(LCR_MASK_BITS_CHAR | UART_LCR_EPAR |
1358                  UART_LCR_PARITY | LCR_MASK_STOP_BITS);
1359
1360         /* Set byte size in lcr */
1361         lcr |= sizebits;
1362
1363         /* Set parity */
1364         if (parenb) {
1365                 lcr |= UART_LCR_PARITY;
1366                 if (!parodd)
1367                         lcr |= UART_LCR_EPAR;
1368         }
1369
1370         /* Set stop bits */
1371         if (stop_bits)
1372                 lcr |= UART_LCR_STOP /* 2 stop bits */ ;
1373
1374         writeb(lcr, &port->ip_uart_regs->i4u_lcr);
1375
1376         /* Re-enable the DMA interface if necessary */
1377         if (port->ip_sscr & IOC4_SSCR_DMA_EN) {
1378                 writel(port->ip_sscr, &port->ip_serial_regs->sscr);
1379         }
1380         port->ip_baud = baud;
1381
1382         /* When we get within this number of ring entries of filling the
1383          * entire ring on tx, place an EXPLICIT intr to generate a lowat
1384          * notification when output has drained.
1385          */
1386         port->ip_tx_lowat = (TX_LOWAT_CHARS(baud) + 3) / 4;
1387         if (port->ip_tx_lowat == 0)
1388                 port->ip_tx_lowat = 1;
1389
1390         set_rx_timeout(port, 2);
1391
1392         return 0;
1393 }
1394
1395 /**
1396  * do_write - Write bytes to the port.  Returns the number of bytes
1397  *                      actually written. Called from transmit_chars
1398  * @port: port to use
1399  * @buf: the stuff to write
1400  * @len: how many bytes in 'buf'
1401  */
1402 static inline int do_write(struct ioc4_port *port, char *buf, int len)
1403 {
1404         int prod_ptr, cons_ptr, total = 0;
1405         struct ring *outring;
1406         struct ring_entry *entry;
1407         struct hooks *hooks = port->ip_hooks;
1408
1409         BUG_ON(!(len >= 0));
1410
1411         prod_ptr = port->ip_tx_prod;
1412         cons_ptr = readl(&port->ip_serial_regs->stcir) & PROD_CONS_MASK;
1413         outring = port->ip_outring;
1414
1415         /* Maintain a 1-entry red-zone.  The ring buffer is full when
1416          * (cons - prod) % ring_size is 1.  Rather than do this subtraction
1417          * in the body of the loop, I'll do it now.
1418          */
1419         cons_ptr = (cons_ptr - (int)sizeof(struct ring_entry)) & PROD_CONS_MASK;
1420
1421         /* Stuff the bytes into the output */
1422         while ((prod_ptr != cons_ptr) && (len > 0)) {
1423                 int xx;
1424
1425                 /* Get 4 bytes (one ring entry) at a time */
1426                 entry = (struct ring_entry *)((caddr_t) outring + prod_ptr);
1427
1428                 /* Invalidate all entries */
1429                 entry->ring_allsc = 0;
1430
1431                 /* Copy in some bytes */
1432                 for (xx = 0; (xx < 4) && (len > 0); xx++) {
1433                         entry->ring_data[xx] = *buf++;
1434                         entry->ring_sc[xx] = IOC4_TXCB_VALID;
1435                         len--;
1436                         total++;
1437                 }
1438
1439                 /* If we are within some small threshold of filling up the
1440                  * entire ring buffer, we must place an EXPLICIT intr here
1441                  * to generate a lowat interrupt in case we subsequently
1442                  * really do fill up the ring and the caller goes to sleep.
1443                  * No need to place more than one though.
1444                  */
1445                 if (!(port->ip_flags & LOWAT_WRITTEN) &&
1446                         ((cons_ptr - prod_ptr) & PROD_CONS_MASK)
1447                                 <= port->ip_tx_lowat
1448                                         * (int)sizeof(struct ring_entry)) {
1449                         port->ip_flags |= LOWAT_WRITTEN;
1450                         entry->ring_sc[0] |= IOC4_TXCB_INT_WHEN_DONE;
1451                 }
1452
1453                 /* Go on to next entry */
1454                 prod_ptr += sizeof(struct ring_entry);
1455                 prod_ptr &= PROD_CONS_MASK;
1456         }
1457
1458         /* If we sent something, start DMA if necessary */
1459         if (total > 0 && !(port->ip_sscr & IOC4_SSCR_DMA_EN)) {
1460                 port->ip_sscr |= IOC4_SSCR_DMA_EN;
1461                 writel(port->ip_sscr, &port->ip_serial_regs->sscr);
1462         }
1463
1464         /* Store the new producer pointer.  If tx is disabled, we stuff the
1465          * data into the ring buffer, but we don't actually start tx.
1466          */
1467         if (!uart_tx_stopped(port->ip_port)) {
1468                 writel(prod_ptr, &port->ip_serial_regs->stpir);
1469
1470                 /* If we are now transmitting, enable tx_mt interrupt so we
1471                  * can disable DMA if necessary when the tx finishes.
1472                  */
1473                 if (total > 0)
1474                         enable_intrs(port, hooks->intr_tx_mt);
1475         }
1476         port->ip_tx_prod = prod_ptr;
1477         return total;
1478 }
1479
1480 /**
1481  * disable_intrs - disable interrupts
1482  * @port: port to enable
1483  * @mask: mask to use
1484  */
1485 static void disable_intrs(struct ioc4_port *port, uint32_t mask)
1486 {
1487         struct hooks *hooks = port->ip_hooks;
1488
1489         if (port->ip_ienb & mask) {
1490                 write_ireg(port->ip_ioc4_soft, mask, IOC4_W_IEC,
1491                                         IOC4_SIO_INTR_TYPE);
1492                 port->ip_ienb &= ~mask;
1493         }
1494
1495         if (!port->ip_ienb)
1496                 write_ireg(port->ip_ioc4_soft, hooks->intr_dma_error,
1497                                 IOC4_W_IEC, IOC4_OTHER_INTR_TYPE);
1498 }
1499
1500 /**
1501  * set_notification - Modify event notification
1502  * @port: port to use
1503  * @mask: events mask
1504  * @set_on: set ?
1505  */
1506 static int set_notification(struct ioc4_port *port, int mask, int set_on)
1507 {
1508         struct hooks *hooks = port->ip_hooks;
1509         uint32_t intrbits, sscrbits;
1510
1511         BUG_ON(!mask);
1512
1513         intrbits = sscrbits = 0;
1514
1515         if (mask & N_DATA_READY)
1516                 intrbits |= (hooks->intr_rx_timer | hooks->intr_rx_high);
1517         if (mask & N_OUTPUT_LOWAT)
1518                 intrbits |= hooks->intr_tx_explicit;
1519         if (mask & N_DDCD) {
1520                 intrbits |= hooks->intr_delta_dcd;
1521                 sscrbits |= IOC4_SSCR_RX_RING_DCD;
1522         }
1523         if (mask & N_DCTS)
1524                 intrbits |= hooks->intr_delta_cts;
1525
1526         if (set_on) {
1527                 enable_intrs(port, intrbits);
1528                 port->ip_notify |= mask;
1529                 port->ip_sscr |= sscrbits;
1530         } else {
1531                 disable_intrs(port, intrbits);
1532                 port->ip_notify &= ~mask;
1533                 port->ip_sscr &= ~sscrbits;
1534         }
1535
1536         /* We require DMA if either DATA_READY or DDCD notification is
1537          * currently requested. If neither of these is requested and
1538          * there is currently no tx in progress, DMA may be disabled.
1539          */
1540         if (port->ip_notify & (N_DATA_READY | N_DDCD))
1541                 port->ip_sscr |= IOC4_SSCR_DMA_EN;
1542         else if (!(port->ip_ienb & hooks->intr_tx_mt))
1543                 port->ip_sscr &= ~IOC4_SSCR_DMA_EN;
1544
1545         writel(port->ip_sscr, &port->ip_serial_regs->sscr);
1546         return 0;
1547 }
1548
1549 /**
1550  * set_mcr - set the master control reg
1551  * @the_port: port to use
1552  * @mask1: mcr mask
1553  * @mask2: shadow mask
1554  */
1555 static inline int set_mcr(struct uart_port *the_port,
1556                 int mask1, int mask2)
1557 {
1558         struct ioc4_port *port = get_ioc4_port(the_port, 0);
1559         uint32_t shadow;
1560         int spiniter = 0;
1561         char mcr;
1562
1563         if (!port)
1564                 return -1;
1565
1566         /* Pause the DMA interface if necessary */
1567         if (port->ip_sscr & IOC4_SSCR_DMA_EN) {
1568                 writel(port->ip_sscr | IOC4_SSCR_DMA_PAUSE,
1569                         &port->ip_serial_regs->sscr);
1570                 while ((readl(&port->ip_serial_regs->sscr)
1571                                         & IOC4_SSCR_PAUSE_STATE) == 0) {
1572                         spiniter++;
1573                         if (spiniter > MAXITER)
1574                                 return -1;
1575                 }
1576         }
1577         shadow = readl(&port->ip_serial_regs->shadow);
1578         mcr = (shadow & 0xff000000) >> 24;
1579
1580         /* Set new value */
1581         mcr |= mask1;
1582         shadow |= mask2;
1583
1584         writeb(mcr, &port->ip_uart_regs->i4u_mcr);
1585         writel(shadow, &port->ip_serial_regs->shadow);
1586
1587         /* Re-enable the DMA interface if necessary */
1588         if (port->ip_sscr & IOC4_SSCR_DMA_EN) {
1589                 writel(port->ip_sscr, &port->ip_serial_regs->sscr);
1590         }
1591         return 0;
1592 }
1593
1594 /**
1595  * ioc4_set_proto - set the protocol for the port
1596  * @port: port to use
1597  * @proto: protocol to use
1598  */
1599 static int ioc4_set_proto(struct ioc4_port *port, int proto)
1600 {
1601         struct hooks *hooks = port->ip_hooks;
1602
1603         switch (proto) {
1604         case PROTO_RS232:
1605                 /* Clear the appropriate GIO pin */
1606                 writel(0, (&port->ip_mem->gppr[hooks->rs422_select_pin].raw));
1607                 break;
1608
1609         case PROTO_RS422:
1610                 /* Set the appropriate GIO pin */
1611                 writel(1, (&port->ip_mem->gppr[hooks->rs422_select_pin].raw));
1612                 break;
1613
1614         default:
1615                 return 1;
1616         }
1617         return 0;
1618 }
1619
1620 /**
1621  * transmit_chars - upper level write, called with ip_lock
1622  * @the_port: port to write
1623  */
1624 static void transmit_chars(struct uart_port *the_port)
1625 {
1626         int xmit_count, tail, head;
1627         int result;
1628         char *start;
1629         struct tty_struct *tty;
1630         struct ioc4_port *port = get_ioc4_port(the_port, 0);
1631         struct uart_state *state;
1632
1633         if (!the_port)
1634                 return;
1635         if (!port)
1636                 return;
1637
1638         state = the_port->state;
1639         tty = state->port.tty;
1640
1641         if (uart_circ_empty(&state->xmit) || uart_tx_stopped(the_port)) {
1642                 /* Nothing to do or hw stopped */
1643                 set_notification(port, N_ALL_OUTPUT, 0);
1644                 return;
1645         }
1646
1647         head = state->xmit.head;
1648         tail = state->xmit.tail;
1649         start = (char *)&state->xmit.buf[tail];
1650
1651         /* write out all the data or until the end of the buffer */
1652         xmit_count = (head < tail) ? (UART_XMIT_SIZE - tail) : (head - tail);
1653         if (xmit_count > 0) {
1654                 result = do_write(port, start, xmit_count);
1655                 if (result > 0) {
1656                         /* booking */
1657                         xmit_count -= result;
1658                         the_port->icount.tx += result;
1659                         /* advance the pointers */
1660                         tail += result;
1661                         tail &= UART_XMIT_SIZE - 1;
1662                         state->xmit.tail = tail;
1663                         start = (char *)&state->xmit.buf[tail];
1664                 }
1665         }
1666         if (uart_circ_chars_pending(&state->xmit) < WAKEUP_CHARS)
1667                 uart_write_wakeup(the_port);
1668
1669         if (uart_circ_empty(&state->xmit)) {
1670                 set_notification(port, N_OUTPUT_LOWAT, 0);
1671         } else {
1672                 set_notification(port, N_OUTPUT_LOWAT, 1);
1673         }
1674 }
1675
1676 /**
1677  * ioc4_change_speed - change the speed of the port
1678  * @the_port: port to change
1679  * @new_termios: new termios settings
1680  * @old_termios: old termios settings
1681  */
1682 static void
1683 ioc4_change_speed(struct uart_port *the_port,
1684                   struct ktermios *new_termios, struct ktermios *old_termios)
1685 {
1686         struct ioc4_port *port = get_ioc4_port(the_port, 0);
1687         int baud, bits;
1688         unsigned cflag;
1689         int new_parity = 0, new_parity_enable = 0, new_stop = 0, new_data = 8;
1690         struct uart_state *state = the_port->state;
1691
1692         cflag = new_termios->c_cflag;
1693
1694         switch (cflag & CSIZE) {
1695         case CS5:
1696                 new_data = 5;
1697                 bits = 7;
1698                 break;
1699         case CS6:
1700                 new_data = 6;
1701                 bits = 8;
1702                 break;
1703         case CS7:
1704                 new_data = 7;
1705                 bits = 9;
1706                 break;
1707         case CS8:
1708                 new_data = 8;
1709                 bits = 10;
1710                 break;
1711         default:
1712                 /* cuz we always need a default ... */
1713                 new_data = 5;
1714                 bits = 7;
1715                 break;
1716         }
1717         if (cflag & CSTOPB) {
1718                 bits++;
1719                 new_stop = 1;
1720         }
1721         if (cflag & PARENB) {
1722                 bits++;
1723                 new_parity_enable = 1;
1724                 if (cflag & PARODD)
1725                         new_parity = 1;
1726         }
1727         baud = uart_get_baud_rate(the_port, new_termios, old_termios,
1728                                 MIN_BAUD_SUPPORTED, MAX_BAUD_SUPPORTED);
1729         DPRINT_CONFIG(("%s: returned baud %d\n", __func__, baud));
1730
1731         /* default is 9600 */
1732         if (!baud)
1733                 baud = 9600;
1734
1735         if (!the_port->fifosize)
1736                 the_port->fifosize = IOC4_FIFO_CHARS;
1737         the_port->timeout = ((the_port->fifosize * HZ * bits) / (baud / 10));
1738         the_port->timeout += HZ / 50;   /* Add .02 seconds of slop */
1739
1740         the_port->ignore_status_mask = N_ALL_INPUT;
1741
1742         state->port.tty->low_latency = 1;
1743
1744         if (I_IGNPAR(state->port.tty))
1745                 the_port->ignore_status_mask &= ~(N_PARITY_ERROR
1746                                                 | N_FRAMING_ERROR);
1747         if (I_IGNBRK(state->port.tty)) {
1748                 the_port->ignore_status_mask &= ~N_BREAK;
1749                 if (I_IGNPAR(state->port.tty))
1750                         the_port->ignore_status_mask &= ~N_OVERRUN_ERROR;
1751         }
1752         if (!(cflag & CREAD)) {
1753                 /* ignore everything */
1754                 the_port->ignore_status_mask &= ~N_DATA_READY;
1755         }
1756
1757         if (cflag & CRTSCTS) {
1758                 port->ip_sscr |= IOC4_SSCR_HFC_EN;
1759         }
1760         else {
1761                 port->ip_sscr &= ~IOC4_SSCR_HFC_EN;
1762         }
1763         writel(port->ip_sscr, &port->ip_serial_regs->sscr);
1764
1765         /* Set the configuration and proper notification call */
1766         DPRINT_CONFIG(("%s : port 0x%p cflag 0%o "
1767                 "config_port(baud %d data %d stop %d p enable %d parity %d),"
1768                 " notification 0x%x\n",
1769              __func__, (void *)port, cflag, baud, new_data, new_stop,
1770              new_parity_enable, new_parity, the_port->ignore_status_mask));
1771
1772         if ((config_port(port, baud,            /* baud */
1773                          new_data,              /* byte size */
1774                          new_stop,              /* stop bits */
1775                          new_parity_enable,     /* set parity */
1776                          new_parity)) >= 0) {   /* parity 1==odd */
1777                 set_notification(port, the_port->ignore_status_mask, 1);
1778         }
1779 }
1780
1781 /**
1782  * ic4_startup_local - Start up the serial port - returns >= 0 if no errors
1783  * @the_port: Port to operate on
1784  */
1785 static inline int ic4_startup_local(struct uart_port *the_port)
1786 {
1787         struct ioc4_port *port;
1788         struct uart_state *state;
1789
1790         if (!the_port)
1791                 return -1;
1792
1793         port = get_ioc4_port(the_port, 0);
1794         if (!port)
1795                 return -1;
1796
1797         state = the_port->state;
1798
1799         local_open(port);
1800
1801         /* set the protocol - mapbase has the port type */
1802         ioc4_set_proto(port, the_port->mapbase);
1803
1804         /* set the speed of the serial port */
1805         ioc4_change_speed(the_port, state->port.tty->termios,
1806                           (struct ktermios *)0);
1807
1808         return 0;
1809 }
1810
1811 /*
1812  * ioc4_cb_output_lowat - called when the output low water mark is hit
1813  * @the_port: port to output
1814  */
1815 static void ioc4_cb_output_lowat(struct uart_port *the_port)
1816 {
1817         unsigned long pflags;
1818
1819         /* ip_lock is set on the call here */
1820         if (the_port) {
1821                 spin_lock_irqsave(&the_port->lock, pflags);
1822                 transmit_chars(the_port);
1823                 spin_unlock_irqrestore(&the_port->lock, pflags);
1824         }
1825 }
1826
1827 /**
1828  * handle_intr - service any interrupts for the given port - 2nd level
1829  *                      called via sd_intr
1830  * @arg: handler arg
1831  * @sio_ir: ioc4regs
1832  */
1833 static void handle_intr(void *arg, uint32_t sio_ir)
1834 {
1835         struct ioc4_port *port = (struct ioc4_port *)arg;
1836         struct hooks *hooks = port->ip_hooks;
1837         unsigned int rx_high_rd_aborted = 0;
1838         unsigned long flags;
1839         struct uart_port *the_port;
1840         int loop_counter;
1841
1842         /* Possible race condition here: The tx_mt interrupt bit may be
1843          * cleared without the intervention of the interrupt handler,
1844          * e.g. by a write.  If the top level interrupt handler reads a
1845          * tx_mt, then some other processor does a write, starting up
1846          * output, then we come in here, see the tx_mt and stop DMA, the
1847          * output started by the other processor will hang.  Thus we can
1848          * only rely on tx_mt being legitimate if it is read while the
1849          * port lock is held.  Therefore this bit must be ignored in the
1850          * passed in interrupt mask which was read by the top level
1851          * interrupt handler since the port lock was not held at the time
1852          * it was read.  We can only rely on this bit being accurate if it
1853          * is read while the port lock is held.  So we'll clear it for now,
1854          * and reload it later once we have the port lock.
1855          */
1856         sio_ir &= ~(hooks->intr_tx_mt);
1857
1858         spin_lock_irqsave(&port->ip_lock, flags);
1859
1860         loop_counter = MAXITER; /* to avoid hangs */
1861
1862         do {
1863                 uint32_t shadow;
1864
1865                 if ( loop_counter-- <= 0 ) {
1866                         printk(KERN_WARNING "IOC4 serial: "
1867                                         "possible hang condition/"
1868                                         "port stuck on interrupt.\n");
1869                         break;
1870                 }
1871
1872                 /* Handle a DCD change */
1873                 if (sio_ir & hooks->intr_delta_dcd) {
1874                         /* ACK the interrupt */
1875                         writel(hooks->intr_delta_dcd,
1876                                 &port->ip_mem->sio_ir.raw);
1877
1878                         shadow = readl(&port->ip_serial_regs->shadow);
1879
1880                         if ((port->ip_notify & N_DDCD)
1881                                         && (shadow & IOC4_SHADOW_DCD)
1882                                         && (port->ip_port)) {
1883                                 the_port = port->ip_port;
1884                                 the_port->icount.dcd = 1;
1885                                 wake_up_interruptible
1886                                             (&the_port->state->port.delta_msr_wait);
1887                         } else if ((port->ip_notify & N_DDCD)
1888                                         && !(shadow & IOC4_SHADOW_DCD)) {
1889                                 /* Flag delta DCD/no DCD */
1890                                 port->ip_flags |= DCD_ON;
1891                         }
1892                 }
1893
1894                 /* Handle a CTS change */
1895                 if (sio_ir & hooks->intr_delta_cts) {
1896                         /* ACK the interrupt */
1897                         writel(hooks->intr_delta_cts,
1898                                         &port->ip_mem->sio_ir.raw);
1899
1900                         shadow = readl(&port->ip_serial_regs->shadow);
1901
1902                         if ((port->ip_notify & N_DCTS)
1903                                         && (port->ip_port)) {
1904                                 the_port = port->ip_port;
1905                                 the_port->icount.cts =
1906                                         (shadow & IOC4_SHADOW_CTS) ? 1 : 0;
1907                                 wake_up_interruptible
1908                                         (&the_port->state->port.delta_msr_wait);
1909                         }
1910                 }
1911
1912                 /* rx timeout interrupt.  Must be some data available.  Put this
1913                  * before the check for rx_high since servicing this condition
1914                  * may cause that condition to clear.
1915                  */
1916                 if (sio_ir & hooks->intr_rx_timer) {
1917                         /* ACK the interrupt */
1918                         writel(hooks->intr_rx_timer,
1919                                 &port->ip_mem->sio_ir.raw);
1920
1921                         if ((port->ip_notify & N_DATA_READY)
1922                                         && (port->ip_port)) {
1923                                 /* ip_lock is set on call here */
1924                                 receive_chars(port->ip_port);
1925                         }
1926                 }
1927
1928                 /* rx high interrupt. Must be after rx_timer.  */
1929                 else if (sio_ir & hooks->intr_rx_high) {
1930                         /* Data available, notify upper layer */
1931                         if ((port->ip_notify & N_DATA_READY)
1932                                                 && port->ip_port) {
1933                                 /* ip_lock is set on call here */
1934                                 receive_chars(port->ip_port);
1935                         }
1936
1937                         /* We can't ACK this interrupt.  If receive_chars didn't
1938                          * cause the condition to clear, we'll have to disable
1939                          * the interrupt until the data is drained.
1940                          * If the read was aborted, don't disable the interrupt
1941                          * as this may cause us to hang indefinitely.  An
1942                          * aborted read generally means that this interrupt
1943                          * hasn't been delivered to the cpu yet anyway, even
1944                          * though we see it as asserted when we read the sio_ir.
1945                          */
1946                         if ((sio_ir = PENDING(port)) & hooks->intr_rx_high) {
1947                                 if ((port->ip_flags & READ_ABORTED) == 0) {
1948                                         port->ip_ienb &= ~hooks->intr_rx_high;
1949                                         port->ip_flags |= INPUT_HIGH;
1950                                 } else {
1951                                         rx_high_rd_aborted++;
1952                                 }
1953                         }
1954                 }
1955
1956                 /* We got a low water interrupt: notify upper layer to
1957                  * send more data.  Must come before tx_mt since servicing
1958                  * this condition may cause that condition to clear.
1959                  */
1960                 if (sio_ir & hooks->intr_tx_explicit) {
1961                         port->ip_flags &= ~LOWAT_WRITTEN;
1962
1963                         /* ACK the interrupt */
1964                         writel(hooks->intr_tx_explicit,
1965                                         &port->ip_mem->sio_ir.raw);
1966
1967                         if (port->ip_notify & N_OUTPUT_LOWAT)
1968                                 ioc4_cb_output_lowat(port->ip_port);
1969                 }
1970
1971                 /* Handle tx_mt.  Must come after tx_explicit.  */
1972                 else if (sio_ir & hooks->intr_tx_mt) {
1973                         /* If we are expecting a lowat notification
1974                          * and we get to this point it probably means that for
1975                          * some reason the tx_explicit didn't work as expected
1976                          * (that can legitimately happen if the output buffer is
1977                          * filled up in just the right way).
1978                          * So send the notification now.
1979                          */
1980                         if (port->ip_notify & N_OUTPUT_LOWAT) {
1981                                 ioc4_cb_output_lowat(port->ip_port);
1982
1983                                 /* We need to reload the sio_ir since the lowat
1984                                  * call may have caused another write to occur,
1985                                  * clearing the tx_mt condition.
1986                                  */
1987                                 sio_ir = PENDING(port);
1988                         }
1989
1990                         /* If the tx_mt condition still persists even after the
1991                          * lowat call, we've got some work to do.
1992                          */
1993                         if (sio_ir & hooks->intr_tx_mt) {
1994
1995                                 /* If we are not currently expecting DMA input,
1996                                  * and the transmitter has just gone idle,
1997                                  * there is no longer any reason for DMA, so
1998                                  * disable it.
1999                                  */
2000                                 if (!(port->ip_notify
2001                                                 & (N_DATA_READY | N_DDCD))) {
2002                                         BUG_ON(!(port->ip_sscr
2003                                                         & IOC4_SSCR_DMA_EN));
2004                                         port->ip_sscr &= ~IOC4_SSCR_DMA_EN;
2005                                         writel(port->ip_sscr,
2006                                            &port->ip_serial_regs->sscr);
2007                                 }
2008
2009                                 /* Prevent infinite tx_mt interrupt */
2010                                 port->ip_ienb &= ~hooks->intr_tx_mt;
2011                         }
2012                 }
2013                 sio_ir = PENDING(port);
2014
2015                 /* if the read was aborted and only hooks->intr_rx_high,
2016                  * clear hooks->intr_rx_high, so we do not loop forever.
2017                  */
2018
2019                 if (rx_high_rd_aborted && (sio_ir == hooks->intr_rx_high)) {
2020                         sio_ir &= ~hooks->intr_rx_high;
2021                 }
2022         } while (sio_ir & hooks->intr_all);
2023
2024         spin_unlock_irqrestore(&port->ip_lock, flags);
2025
2026         /* Re-enable interrupts before returning from interrupt handler.
2027          * Getting interrupted here is okay.  It'll just v() our semaphore, and
2028          * we'll come through the loop again.
2029          */
2030
2031         write_ireg(port->ip_ioc4_soft, port->ip_ienb, IOC4_W_IES,
2032                                                         IOC4_SIO_INTR_TYPE);
2033 }
2034
2035 /*
2036  * ioc4_cb_post_ncs - called for some basic errors
2037  * @port: port to use
2038  * @ncs: event
2039  */
2040 static void ioc4_cb_post_ncs(struct uart_port *the_port, int ncs)
2041 {
2042         struct uart_icount *icount;
2043
2044         icount = &the_port->icount;
2045
2046         if (ncs & NCS_BREAK)
2047                 icount->brk++;
2048         if (ncs & NCS_FRAMING)
2049                 icount->frame++;
2050         if (ncs & NCS_OVERRUN)
2051                 icount->overrun++;
2052         if (ncs & NCS_PARITY)
2053                 icount->parity++;
2054 }
2055
2056 /**
2057  * do_read - Read in bytes from the port.  Return the number of bytes
2058  *                      actually read.
2059  * @the_port: port to use
2060  * @buf: place to put the stuff we read
2061  * @len: how big 'buf' is
2062  */
2063
2064 static inline int do_read(struct uart_port *the_port, unsigned char *buf,
2065                                 int len)
2066 {
2067         int prod_ptr, cons_ptr, total;
2068         struct ioc4_port *port = get_ioc4_port(the_port, 0);
2069         struct ring *inring;
2070         struct ring_entry *entry;
2071         struct hooks *hooks = port->ip_hooks;
2072         int byte_num;
2073         char *sc;
2074         int loop_counter;
2075
2076         BUG_ON(!(len >= 0));
2077         BUG_ON(!port);
2078
2079         /* There is a nasty timing issue in the IOC4. When the rx_timer
2080          * expires or the rx_high condition arises, we take an interrupt.
2081          * At some point while servicing the interrupt, we read bytes from
2082          * the ring buffer and re-arm the rx_timer.  However the rx_timer is
2083          * not started until the first byte is received *after* it is armed,
2084          * and any bytes pending in the rx construction buffers are not drained
2085          * to memory until either there are 4 bytes available or the rx_timer
2086          * expires.  This leads to a potential situation where data is left
2087          * in the construction buffers forever - 1 to 3 bytes were received
2088          * after the interrupt was generated but before the rx_timer was
2089          * re-armed. At that point as long as no subsequent bytes are received
2090          * the timer will never be started and the bytes will remain in the
2091          * construction buffer forever.  The solution is to execute a DRAIN
2092          * command after rearming the timer.  This way any bytes received before
2093          * the DRAIN will be drained to memory, and any bytes received after
2094          * the DRAIN will start the TIMER and be drained when it expires.
2095          * Luckily, this only needs to be done when the DMA buffer is empty
2096          * since there is no requirement that this function return all
2097          * available data as long as it returns some.
2098          */
2099         /* Re-arm the timer */
2100         writel(port->ip_rx_cons | IOC4_SRCIR_ARM, &port->ip_serial_regs->srcir);
2101
2102         prod_ptr = readl(&port->ip_serial_regs->srpir) & PROD_CONS_MASK;
2103         cons_ptr = port->ip_rx_cons;
2104
2105         if (prod_ptr == cons_ptr) {
2106                 int reset_dma = 0;
2107
2108                 /* Input buffer appears empty, do a flush. */
2109
2110                 /* DMA must be enabled for this to work. */
2111                 if (!(port->ip_sscr & IOC4_SSCR_DMA_EN)) {
2112                         port->ip_sscr |= IOC4_SSCR_DMA_EN;
2113                         reset_dma = 1;
2114                 }
2115
2116                 /* Potential race condition: we must reload the srpir after
2117                  * issuing the drain command, otherwise we could think the rx
2118                  * buffer is empty, then take a very long interrupt, and when
2119                  * we come back it's full and we wait forever for the drain to
2120                  * complete.
2121                  */
2122                 writel(port->ip_sscr | IOC4_SSCR_RX_DRAIN,
2123                                 &port->ip_serial_regs->sscr);
2124                 prod_ptr = readl(&port->ip_serial_regs->srpir)
2125                                 & PROD_CONS_MASK;
2126
2127                 /* We must not wait for the DRAIN to complete unless there are
2128                  * at least 8 bytes (2 ring entries) available to receive the
2129                  * data otherwise the DRAIN will never complete and we'll
2130                  * deadlock here.
2131                  * In fact, to make things easier, I'll just ignore the flush if
2132                  * there is any data at all now available.
2133                  */
2134                 if (prod_ptr == cons_ptr) {
2135                         loop_counter = 0;
2136                         while (readl(&port->ip_serial_regs->sscr) &
2137                                                 IOC4_SSCR_RX_DRAIN) {
2138                                 loop_counter++;
2139                                 if (loop_counter > MAXITER)
2140                                         return -1;
2141                         }
2142
2143                         /* SIGH. We have to reload the prod_ptr *again* since
2144                          * the drain may have caused it to change
2145                          */
2146                         prod_ptr = readl(&port->ip_serial_regs->srpir)
2147                                                         & PROD_CONS_MASK;
2148                 }
2149                 if (reset_dma) {
2150                         port->ip_sscr &= ~IOC4_SSCR_DMA_EN;
2151                         writel(port->ip_sscr, &port->ip_serial_regs->sscr);
2152                 }
2153         }
2154         inring = port->ip_inring;
2155         port->ip_flags &= ~READ_ABORTED;
2156
2157         total = 0;
2158         loop_counter = 0xfffff; /* to avoid hangs */
2159
2160         /* Grab bytes from the hardware */
2161         while ((prod_ptr != cons_ptr) && (len > 0)) {
2162                 entry = (struct ring_entry *)((caddr_t)inring + cons_ptr);
2163
2164                 if ( loop_counter-- <= 0 ) {
2165                         printk(KERN_WARNING "IOC4 serial: "
2166                                         "possible hang condition/"
2167                                         "port stuck on read.\n");
2168                         break;
2169                 }
2170
2171                 /* According to the producer pointer, this ring entry
2172                  * must contain some data.  But if the PIO happened faster
2173                  * than the DMA, the data may not be available yet, so let's
2174                  * wait until it arrives.
2175                  */
2176                 if ((entry->ring_allsc & RING_ANY_VALID) == 0) {
2177                         /* Indicate the read is aborted so we don't disable
2178                          * the interrupt thinking that the consumer is
2179                          * congested.
2180                          */
2181                         port->ip_flags |= READ_ABORTED;
2182                         len = 0;
2183                         break;
2184                 }
2185
2186                 /* Load the bytes/status out of the ring entry */
2187                 for (byte_num = 0; byte_num < 4 && len > 0; byte_num++) {
2188                         sc = &(entry->ring_sc[byte_num]);
2189
2190                         /* Check for change in modem state or overrun */
2191                         if ((*sc & IOC4_RXSB_MODEM_VALID)
2192                                                 && (port->ip_notify & N_DDCD)) {
2193                                 /* Notify upper layer if DCD dropped */
2194
2195                                 if ((port->ip_flags & DCD_ON)
2196                                                 && !(*sc & IOC4_RXSB_DCD)) {
2197
2198                                         /* If we have already copied some data,
2199                                          * return it.  We'll pick up the carrier
2200                                          * drop on the next pass.  That way we
2201                                          * don't throw away the data that has
2202                                          * already been copied back to
2203                                          * the caller's buffer.
2204                                          */
2205                                         if (total > 0) {
2206                                                 len = 0;
2207                                                 break;
2208                                         }
2209                                         port->ip_flags &= ~DCD_ON;
2210
2211                                         /* Turn off this notification so the
2212                                          * carrier drop protocol won't see it
2213                                          * again when it does a read.
2214                                          */
2215                                         *sc &= ~IOC4_RXSB_MODEM_VALID;
2216
2217                                         /* To keep things consistent, we need
2218                                          * to update the consumer pointer so
2219                                          * the next reader won't come in and
2220                                          * try to read the same ring entries
2221                                          * again. This must be done here before
2222                                          * the dcd change.
2223                                          */
2224
2225                                         if ((entry->ring_allsc & RING_ANY_VALID)
2226                                                                         == 0) {
2227                                                 cons_ptr += (int)sizeof
2228                                                         (struct ring_entry);
2229                                                 cons_ptr &= PROD_CONS_MASK;
2230                                         }
2231                                         writel(cons_ptr,
2232                                                 &port->ip_serial_regs->srcir);
2233                                         port->ip_rx_cons = cons_ptr;
2234
2235                                         /* Notify upper layer of carrier drop */
2236                                         if ((port->ip_notify & N_DDCD)
2237                                                    && port->ip_port) {
2238                                                 the_port->icount.dcd = 0;
2239                                                 wake_up_interruptible
2240                                                     (&the_port->state->
2241                                                         port.delta_msr_wait);
2242                                         }
2243
2244                                         /* If we had any data to return, we
2245                                          * would have returned it above.
2246                                          */
2247                                         return 0;
2248                                 }
2249                         }
2250                         if (*sc & IOC4_RXSB_MODEM_VALID) {
2251                                 /* Notify that an input overrun occurred */
2252                                 if ((*sc & IOC4_RXSB_OVERRUN)
2253                                     && (port->ip_notify & N_OVERRUN_ERROR)) {
2254                                         ioc4_cb_post_ncs(the_port, NCS_OVERRUN);
2255                                 }
2256                                 /* Don't look at this byte again */
2257                                 *sc &= ~IOC4_RXSB_MODEM_VALID;
2258                         }
2259
2260                         /* Check for valid data or RX errors */
2261                         if ((*sc & IOC4_RXSB_DATA_VALID) &&
2262                                         ((*sc & (IOC4_RXSB_PAR_ERR
2263                                                         | IOC4_RXSB_FRAME_ERR
2264                                                         | IOC4_RXSB_BREAK))
2265                                         && (port->ip_notify & (N_PARITY_ERROR
2266                                                         | N_FRAMING_ERROR
2267                                                         | N_BREAK)))) {
2268                                 /* There is an error condition on the next byte.
2269                                  * If we have already transferred some bytes,
2270                                  * we'll stop here. Otherwise if this is the
2271                                  * first byte to be read, we'll just transfer
2272                                  * it alone after notifying the
2273                                  * upper layer of its status.
2274                                  */
2275                                 if (total > 0) {
2276                                         len = 0;
2277                                         break;
2278                                 } else {
2279                                         if ((*sc & IOC4_RXSB_PAR_ERR) &&
2280                                            (port->ip_notify & N_PARITY_ERROR)) {
2281                                                 ioc4_cb_post_ncs(the_port,
2282                                                                 NCS_PARITY);
2283                                         }
2284                                         if ((*sc & IOC4_RXSB_FRAME_ERR) &&
2285                                            (port->ip_notify & N_FRAMING_ERROR)){
2286                                                 ioc4_cb_post_ncs(the_port,
2287                                                                 NCS_FRAMING);
2288                                         }
2289                                         if ((*sc & IOC4_RXSB_BREAK)
2290                                             && (port->ip_notify & N_BREAK)) {
2291                                                         ioc4_cb_post_ncs
2292                                                                     (the_port,
2293                                                                      NCS_BREAK);
2294                                         }
2295                                         len = 1;
2296                                 }
2297                         }
2298                         if (*sc & IOC4_RXSB_DATA_VALID) {
2299                                 *sc &= ~IOC4_RXSB_DATA_VALID;
2300                                 *buf = entry->ring_data[byte_num];
2301                                 buf++;
2302                                 len--;
2303                                 total++;
2304                         }
2305                 }
2306
2307                 /* If we used up this entry entirely, go on to the next one,
2308                  * otherwise we must have run out of buffer space, so
2309                  * leave the consumer pointer here for the next read in case
2310                  * there are still unread bytes in this entry.
2311                  */
2312                 if ((entry->ring_allsc & RING_ANY_VALID) == 0) {
2313                         cons_ptr += (int)sizeof(struct ring_entry);
2314                         cons_ptr &= PROD_CONS_MASK;
2315                 }
2316         }
2317
2318         /* Update consumer pointer and re-arm rx timer interrupt */
2319         writel(cons_ptr, &port->ip_serial_regs->srcir);
2320         port->ip_rx_cons = cons_ptr;
2321
2322         /* If we have now dipped below the rx high water mark and we have
2323          * rx_high interrupt turned off, we can now turn it back on again.
2324          */
2325         if ((port->ip_flags & INPUT_HIGH) && (((prod_ptr - cons_ptr)
2326                         & PROD_CONS_MASK) < ((port->ip_sscr &
2327                                 IOC4_SSCR_RX_THRESHOLD)
2328                                         << IOC4_PROD_CONS_PTR_OFF))) {
2329                 port->ip_flags &= ~INPUT_HIGH;
2330                 enable_intrs(port, hooks->intr_rx_high);
2331         }
2332         return total;
2333 }
2334
2335 /**
2336  * receive_chars - upper level read. Called with ip_lock.
2337  * @the_port: port to read from
2338  */
2339 static void receive_chars(struct uart_port *the_port)
2340 {
2341         struct tty_struct *tty;
2342         unsigned char ch[IOC4_MAX_CHARS];
2343         int read_count, request_count = IOC4_MAX_CHARS;
2344         struct uart_icount *icount;
2345         struct uart_state *state = the_port->state;
2346         unsigned long pflags;
2347
2348         /* Make sure all the pointers are "good" ones */
2349         if (!state)
2350                 return;
2351         if (!state->port.tty)
2352                 return;
2353
2354         spin_lock_irqsave(&the_port->lock, pflags);
2355         tty = state->port.tty;
2356
2357         request_count = tty_buffer_request_room(tty, IOC4_MAX_CHARS);
2358
2359         if (request_count > 0) {
2360                 icount = &the_port->icount;
2361                 read_count = do_read(the_port, ch, request_count);
2362                 if (read_count > 0) {
2363                         tty_insert_flip_string(tty, ch, read_count);
2364                         icount->rx += read_count;
2365                 }
2366         }
2367
2368         spin_unlock_irqrestore(&the_port->lock, pflags);
2369
2370         tty_flip_buffer_push(tty);
2371 }
2372
2373 /**
2374  * ic4_type - What type of console are we?
2375  * @port: Port to operate with (we ignore since we only have one port)
2376  *
2377  */
2378 static const char *ic4_type(struct uart_port *the_port)
2379 {
2380         if (the_port->mapbase == PROTO_RS232)
2381                 return "SGI IOC4 Serial [rs232]";
2382         else
2383                 return "SGI IOC4 Serial [rs422]";
2384 }
2385
2386 /**
2387  * ic4_tx_empty - Is the transmitter empty?
2388  * @port: Port to operate on
2389  *
2390  */
2391 static unsigned int ic4_tx_empty(struct uart_port *the_port)
2392 {
2393         struct ioc4_port *port = get_ioc4_port(the_port, 0);
2394         unsigned int ret = 0;
2395
2396         if (port_is_active(port, the_port)) {
2397                 if (readl(&port->ip_serial_regs->shadow) & IOC4_SHADOW_TEMT)
2398                         ret = TIOCSER_TEMT;
2399         }
2400         return ret;
2401 }
2402
2403 /**
2404  * ic4_stop_tx - stop the transmitter
2405  * @port: Port to operate on
2406  *
2407  */
2408 static void ic4_stop_tx(struct uart_port *the_port)
2409 {
2410         struct ioc4_port *port = get_ioc4_port(the_port, 0);
2411
2412         if (port_is_active(port, the_port))
2413                 set_notification(port, N_OUTPUT_LOWAT, 0);
2414 }
2415
2416 /**
2417  * null_void_function -
2418  * @port: Port to operate on
2419  *
2420  */
2421 static void null_void_function(struct uart_port *the_port)
2422 {
2423 }
2424
2425 /**
2426  * ic4_shutdown - shut down the port - free irq and disable
2427  * @port: Port to shut down
2428  *
2429  */
2430 static void ic4_shutdown(struct uart_port *the_port)
2431 {
2432         unsigned long port_flags;
2433         struct ioc4_port *port;
2434         struct uart_state *state;
2435
2436         port = get_ioc4_port(the_port, 0);
2437         if (!port)
2438                 return;
2439
2440         state = the_port->state;
2441         port->ip_port = NULL;
2442
2443         wake_up_interruptible(&state->port.delta_msr_wait);
2444
2445         if (state->port.tty)
2446                 set_bit(TTY_IO_ERROR, &state->port.tty->flags);
2447
2448         spin_lock_irqsave(&the_port->lock, port_flags);
2449         set_notification(port, N_ALL, 0);
2450         port->ip_flags = PORT_INACTIVE;
2451         spin_unlock_irqrestore(&the_port->lock, port_flags);
2452 }
2453
2454 /**
2455  * ic4_set_mctrl - set control lines (dtr, rts, etc)
2456  * @port: Port to operate on
2457  * @mctrl: Lines to set/unset
2458  *
2459  */
2460 static void ic4_set_mctrl(struct uart_port *the_port, unsigned int mctrl)
2461 {
2462         unsigned char mcr = 0;
2463         struct ioc4_port *port;
2464
2465         port = get_ioc4_port(the_port, 0);
2466         if (!port_is_active(port, the_port))
2467                 return;
2468
2469         if (mctrl & TIOCM_RTS)
2470                 mcr |= UART_MCR_RTS;
2471         if (mctrl & TIOCM_DTR)
2472                 mcr |= UART_MCR_DTR;
2473         if (mctrl & TIOCM_OUT1)
2474                 mcr |= UART_MCR_OUT1;
2475         if (mctrl & TIOCM_OUT2)
2476                 mcr |= UART_MCR_OUT2;
2477         if (mctrl & TIOCM_LOOP)
2478                 mcr |= UART_MCR_LOOP;
2479
2480         set_mcr(the_port, mcr, IOC4_SHADOW_DTR);
2481 }
2482
2483 /**
2484  * ic4_get_mctrl - get control line info
2485  * @port: port to operate on
2486  *
2487  */
2488 static unsigned int ic4_get_mctrl(struct uart_port *the_port)
2489 {
2490         struct ioc4_port *port = get_ioc4_port(the_port, 0);
2491         uint32_t shadow;
2492         unsigned int ret = 0;
2493
2494         if (!port_is_active(port, the_port))
2495                 return 0;
2496
2497         shadow = readl(&port->ip_serial_regs->shadow);
2498         if (shadow & IOC4_SHADOW_DCD)
2499                 ret |= TIOCM_CAR;
2500         if (shadow & IOC4_SHADOW_DR)
2501                 ret |= TIOCM_DSR;
2502         if (shadow & IOC4_SHADOW_CTS)
2503                 ret |= TIOCM_CTS;
2504         return ret;
2505 }
2506
2507 /**
2508  * ic4_start_tx - Start transmitter, flush any output
2509  * @port: Port to operate on
2510  *
2511  */
2512 static void ic4_start_tx(struct uart_port *the_port)
2513 {
2514         struct ioc4_port *port = get_ioc4_port(the_port, 0);
2515
2516         if (port_is_active(port, the_port)) {
2517                 set_notification(port, N_OUTPUT_LOWAT, 1);
2518                 enable_intrs(port, port->ip_hooks->intr_tx_mt);
2519         }
2520 }
2521
2522 /**
2523  * ic4_break_ctl - handle breaks
2524  * @port: Port to operate on
2525  * @break_state: Break state
2526  *
2527  */
2528 static void ic4_break_ctl(struct uart_port *the_port, int break_state)
2529 {
2530 }
2531
2532 /**
2533  * ic4_startup - Start up the serial port
2534  * @port: Port to operate on
2535  *
2536  */
2537 static int ic4_startup(struct uart_port *the_port)
2538 {
2539         int retval;
2540         struct ioc4_port *port;
2541         struct ioc4_control *control;
2542         struct uart_state *state;
2543         unsigned long port_flags;
2544
2545         if (!the_port)
2546                 return -ENODEV;
2547         port = get_ioc4_port(the_port, 1);
2548         if (!port)
2549                 return -ENODEV;
2550         state = the_port->state;
2551
2552         control = port->ip_control;
2553         if (!control) {
2554                 port->ip_port = NULL;
2555                 return -ENODEV;
2556         }
2557
2558         /* Start up the serial port */
2559         spin_lock_irqsave(&the_port->lock, port_flags);
2560         retval = ic4_startup_local(the_port);
2561         spin_unlock_irqrestore(&the_port->lock, port_flags);
2562         return retval;
2563 }
2564
2565 /**
2566  * ic4_set_termios - set termios stuff
2567  * @port: port to operate on
2568  * @termios: New settings
2569  * @termios: Old
2570  *
2571  */
2572 static void
2573 ic4_set_termios(struct uart_port *the_port,
2574                 struct ktermios *termios, struct ktermios *old_termios)
2575 {
2576         unsigned long port_flags;
2577
2578         spin_lock_irqsave(&the_port->lock, port_flags);
2579         ioc4_change_speed(the_port, termios, old_termios);
2580         spin_unlock_irqrestore(&the_port->lock, port_flags);
2581 }
2582
2583 /**
2584  * ic4_request_port - allocate resources for port - no op....
2585  * @port: port to operate on
2586  *
2587  */
2588 static int ic4_request_port(struct uart_port *port)
2589 {
2590         return 0;
2591 }
2592
2593 /* Associate the uart functions above - given to serial core */
2594
2595 static struct uart_ops ioc4_ops = {
2596         .tx_empty       = ic4_tx_empty,
2597         .set_mctrl      = ic4_set_mctrl,
2598         .get_mctrl      = ic4_get_mctrl,
2599         .stop_tx        = ic4_stop_tx,
2600         .start_tx       = ic4_start_tx,
2601         .stop_rx        = null_void_function,
2602         .enable_ms      = null_void_function,
2603         .break_ctl      = ic4_break_ctl,
2604         .startup        = ic4_startup,
2605         .shutdown       = ic4_shutdown,
2606         .set_termios    = ic4_set_termios,
2607         .type           = ic4_type,
2608         .release_port   = null_void_function,
2609         .request_port   = ic4_request_port,
2610 };
2611
2612 /*
2613  * Boot-time initialization code
2614  */
2615
2616 static struct uart_driver ioc4_uart_rs232 = {
2617         .owner          = THIS_MODULE,
2618         .driver_name    = "ioc4_serial_rs232",
2619         .dev_name       = DEVICE_NAME_RS232,
2620         .major          = DEVICE_MAJOR,
2621         .minor          = DEVICE_MINOR_RS232,
2622         .nr             = IOC4_NUM_CARDS * IOC4_NUM_SERIAL_PORTS,
2623 };
2624
2625 static struct uart_driver ioc4_uart_rs422 = {
2626         .owner          = THIS_MODULE,
2627         .driver_name    = "ioc4_serial_rs422",
2628         .dev_name       = DEVICE_NAME_RS422,
2629         .major          = DEVICE_MAJOR,
2630         .minor          = DEVICE_MINOR_RS422,
2631         .nr             = IOC4_NUM_CARDS * IOC4_NUM_SERIAL_PORTS,
2632 };
2633
2634
2635 /**
2636  * ioc4_serial_remove_one - detach function
2637  *
2638  * @idd: IOC4 master module data for this IOC4
2639  */
2640
2641 static int ioc4_serial_remove_one(struct ioc4_driver_data *idd)
2642 {
2643         int port_num, port_type;
2644         struct ioc4_control *control;
2645         struct uart_port *the_port;
2646         struct ioc4_port *port;
2647         struct ioc4_soft *soft;
2648
2649         /* If serial driver did not attach, don't try to detach */
2650         control = idd->idd_serial_data;
2651         if (!control)
2652                 return 0;
2653
2654         for (port_num = 0; port_num < IOC4_NUM_SERIAL_PORTS; port_num++) {
2655                 for (port_type = UART_PORT_MIN;
2656                                         port_type < UART_PORT_COUNT;
2657                                         port_type++) {
2658                         the_port = &control->ic_port[port_num].icp_uart_port
2659                                                         [port_type];
2660                         if (the_port) {
2661                                 switch (port_type) {
2662                                 case UART_PORT_RS422:
2663                                         uart_remove_one_port(&ioc4_uart_rs422,
2664                                                         the_port);
2665                                         break;
2666                                 default:
2667                                 case UART_PORT_RS232:
2668                                         uart_remove_one_port(&ioc4_uart_rs232,
2669                                                         the_port);
2670                                         break;
2671                                 }
2672                         }
2673                 }
2674                 port = control->ic_port[port_num].icp_port;
2675                 /* we allocate in pairs */
2676                 if (!(port_num & 1) && port) {
2677                         pci_free_consistent(port->ip_pdev,
2678                                         TOTAL_RING_BUF_SIZE,
2679                                         port->ip_cpu_ringbuf,
2680                                         port->ip_dma_ringbuf);
2681                         kfree(port);
2682                 }
2683         }
2684         soft = control->ic_soft;
2685         if (soft) {
2686                 free_irq(control->ic_irq, soft);
2687                 if (soft->is_ioc4_serial_addr) {
2688                         iounmap(soft->is_ioc4_serial_addr);
2689                         release_mem_region((unsigned long)
2690                              soft->is_ioc4_serial_addr,
2691                                 sizeof(struct ioc4_serial));
2692                 }
2693                 kfree(soft);
2694         }
2695         kfree(control);
2696         idd->idd_serial_data = NULL;
2697
2698         return 0;
2699 }
2700
2701
2702 /**
2703  * ioc4_serial_core_attach_rs232 - register with serial core
2704  *              This is done during pci probing
2705  * @pdev: handle for this card
2706  */
2707 static inline int
2708 ioc4_serial_core_attach(struct pci_dev *pdev, int port_type)
2709 {
2710         struct ioc4_port *port;
2711         struct uart_port *the_port;
2712         struct ioc4_driver_data *idd = pci_get_drvdata(pdev);
2713         struct ioc4_control *control = idd->idd_serial_data;
2714         int port_num;
2715         int port_type_idx;
2716         struct uart_driver *u_driver;
2717
2718
2719         DPRINT_CONFIG(("%s: attach pdev 0x%p - control 0x%p\n",
2720                         __func__, pdev, (void *)control));
2721
2722         if (!control)
2723                 return -ENODEV;
2724
2725         port_type_idx = (port_type == PROTO_RS232) ? UART_PORT_RS232
2726                                                 : UART_PORT_RS422;
2727
2728         u_driver = (port_type == PROTO_RS232)   ? &ioc4_uart_rs232
2729                                                 : &ioc4_uart_rs422;
2730
2731         /* once around for each port on this card */
2732         for (port_num = 0; port_num < IOC4_NUM_SERIAL_PORTS; port_num++) {
2733                 the_port = &control->ic_port[port_num].icp_uart_port
2734                                                         [port_type_idx];
2735                 port = control->ic_port[port_num].icp_port;
2736                 port->ip_all_ports[port_type_idx] = the_port;
2737
2738                 DPRINT_CONFIG(("%s: attach the_port 0x%p / port 0x%p : type %s\n",
2739                                 __func__, (void *)the_port,
2740                                 (void *)port,
2741                                 port_type == PROTO_RS232 ? "rs232" : "rs422"));
2742
2743                 /* membase, iobase and mapbase just need to be non-0 */
2744                 the_port->membase = (unsigned char __iomem *)1;
2745                 the_port->iobase = (pdev->bus->number << 16) |  port_num;
2746                 the_port->line = (Num_of_ioc4_cards << 2) | port_num;
2747                 the_port->mapbase = port_type;
2748                 the_port->type = PORT_16550A;
2749                 the_port->fifosize = IOC4_FIFO_CHARS;
2750                 the_port->ops = &ioc4_ops;
2751                 the_port->irq = control->ic_irq;
2752                 the_port->dev = &pdev->dev;
2753                 spin_lock_init(&the_port->lock);
2754                 if (uart_add_one_port(u_driver, the_port) < 0) {
2755                         printk(KERN_WARNING
2756                            "%s: unable to add port %d bus %d\n",
2757                                __func__, the_port->line, pdev->bus->number);
2758                 } else {
2759                         DPRINT_CONFIG(
2760                             ("IOC4 serial port %d irq = %d, bus %d\n",
2761                                the_port->line, the_port->irq, pdev->bus->number));
2762                 }
2763         }
2764         return 0;
2765 }
2766
2767 /**
2768  * ioc4_serial_attach_one - register attach function
2769  *              called per card found from IOC4 master module.
2770  * @idd: Master module data for this IOC4
2771  */
2772 int
2773 ioc4_serial_attach_one(struct ioc4_driver_data *idd)
2774 {
2775         unsigned long tmp_addr1;
2776         struct ioc4_serial __iomem *serial;
2777         struct ioc4_soft *soft;
2778         struct ioc4_control *control;
2779         int ret = 0;
2780
2781
2782         DPRINT_CONFIG(("%s (0x%p, 0x%p)\n", __func__, idd->idd_pdev,
2783                                                         idd->idd_pci_id));
2784
2785         /* PCI-RT does not bring out serial connections.
2786          * Do not attach to this particular IOC4.
2787          */
2788         if (idd->idd_variant == IOC4_VARIANT_PCI_RT)
2789                 return 0;
2790
2791         /* request serial registers */
2792         tmp_addr1 = idd->idd_bar0 + IOC4_SERIAL_OFFSET;
2793
2794         if (!request_mem_region(tmp_addr1, sizeof(struct ioc4_serial),
2795                                         "sioc4_uart")) {
2796                 printk(KERN_WARNING
2797                         "ioc4 (%p): unable to get request region for "
2798                                 "uart space\n", (void *)idd->idd_pdev);
2799                 ret = -ENODEV;
2800                 goto out1;
2801         }
2802         serial = ioremap(tmp_addr1, sizeof(struct ioc4_serial));
2803         if (!serial) {
2804                 printk(KERN_WARNING
2805                          "ioc4 (%p) : unable to remap ioc4 serial register\n",
2806                                 (void *)idd->idd_pdev);
2807                 ret = -ENODEV;
2808                 goto out2;
2809         }
2810         DPRINT_CONFIG(("%s : mem 0x%p, serial 0x%p\n",
2811                                 __func__, (void *)idd->idd_misc_regs,
2812                                 (void *)serial));
2813
2814         /* Get memory for the new card */
2815         control = kzalloc(sizeof(struct ioc4_control), GFP_KERNEL);
2816
2817         if (!control) {
2818                 printk(KERN_WARNING "ioc4_attach_one"
2819                        ": unable to get memory for the IOC4\n");
2820                 ret = -ENOMEM;
2821                 goto out2;
2822         }
2823         idd->idd_serial_data = control;
2824
2825         /* Allocate the soft structure */
2826         soft = kzalloc(sizeof(struct ioc4_soft), GFP_KERNEL);
2827         if (!soft) {
2828                 printk(KERN_WARNING
2829                        "ioc4 (%p): unable to get memory for the soft struct\n",
2830                        (void *)idd->idd_pdev);
2831                 ret = -ENOMEM;
2832                 goto out3;
2833         }
2834
2835         spin_lock_init(&soft->is_ir_lock);
2836         soft->is_ioc4_misc_addr = idd->idd_misc_regs;
2837         soft->is_ioc4_serial_addr = serial;
2838
2839         /* Init the IOC4 */
2840         writel(0xf << IOC4_SIO_CR_CMD_PULSE_SHIFT,
2841                &idd->idd_misc_regs->sio_cr.raw);
2842
2843         /* Enable serial port mode select generic PIO pins as outputs */
2844         writel(IOC4_GPCR_UART0_MODESEL | IOC4_GPCR_UART1_MODESEL
2845                 | IOC4_GPCR_UART2_MODESEL | IOC4_GPCR_UART3_MODESEL,
2846                 &idd->idd_misc_regs->gpcr_s.raw);
2847
2848         /* Clear and disable all serial interrupts */
2849         write_ireg(soft, ~0, IOC4_W_IEC, IOC4_SIO_INTR_TYPE);
2850         writel(~0, &idd->idd_misc_regs->sio_ir.raw);
2851         write_ireg(soft, IOC4_OTHER_IR_SER_MEMERR, IOC4_W_IEC,
2852                    IOC4_OTHER_INTR_TYPE);
2853         writel(IOC4_OTHER_IR_SER_MEMERR, &idd->idd_misc_regs->other_ir.raw);
2854         control->ic_soft = soft;
2855
2856         /* Hook up interrupt handler */
2857         if (!request_irq(idd->idd_pdev->irq, ioc4_intr, IRQF_SHARED,
2858                                 "sgi-ioc4serial", soft)) {
2859                 control->ic_irq = idd->idd_pdev->irq;
2860         } else {
2861                 printk(KERN_WARNING
2862                     "%s : request_irq fails for IRQ 0x%x\n ",
2863                         __func__, idd->idd_pdev->irq);
2864         }
2865         ret = ioc4_attach_local(idd);
2866         if (ret)
2867                 goto out4;
2868
2869         /* register port with the serial core - 1 rs232, 1 rs422 */
2870
2871         if ((ret = ioc4_serial_core_attach(idd->idd_pdev, PROTO_RS232)))
2872                 goto out4;
2873
2874         if ((ret = ioc4_serial_core_attach(idd->idd_pdev, PROTO_RS422)))
2875                 goto out5;
2876
2877         Num_of_ioc4_cards++;
2878
2879         return ret;
2880
2881         /* error exits that give back resources */
2882 out5:
2883         ioc4_serial_remove_one(idd);
2884 out4:
2885         kfree(soft);
2886 out3:
2887         kfree(control);
2888 out2:
2889         if (serial)
2890                 iounmap(serial);
2891         release_mem_region(tmp_addr1, sizeof(struct ioc4_serial));
2892 out1:
2893
2894         return ret;
2895 }
2896
2897
2898 static struct ioc4_submodule ioc4_serial_submodule = {
2899         .is_name = "IOC4_serial",
2900         .is_owner = THIS_MODULE,
2901         .is_probe = ioc4_serial_attach_one,
2902         .is_remove = ioc4_serial_remove_one,
2903 };
2904
2905 /**
2906  * ioc4_serial_init - module init
2907  */
2908 static int __init ioc4_serial_init(void)
2909 {
2910         int ret;
2911
2912         /* register with serial core */
2913         if ((ret = uart_register_driver(&ioc4_uart_rs232)) < 0) {
2914                 printk(KERN_WARNING
2915                         "%s: Couldn't register rs232 IOC4 serial driver\n",
2916                         __func__);
2917                 goto out;
2918         }
2919         if ((ret = uart_register_driver(&ioc4_uart_rs422)) < 0) {
2920                 printk(KERN_WARNING
2921                         "%s: Couldn't register rs422 IOC4 serial driver\n",
2922                         __func__);
2923                 goto out_uart_rs232;
2924         }
2925
2926         /* register with IOC4 main module */
2927         ret = ioc4_register_submodule(&ioc4_serial_submodule);
2928         if (ret)
2929                 goto out_uart_rs422;
2930         return 0;
2931
2932 out_uart_rs422:
2933         uart_unregister_driver(&ioc4_uart_rs422);
2934 out_uart_rs232:
2935         uart_unregister_driver(&ioc4_uart_rs232);
2936 out:
2937         return ret;
2938 }
2939
2940 static void __exit ioc4_serial_exit(void)
2941 {
2942         ioc4_unregister_submodule(&ioc4_serial_submodule);
2943         uart_unregister_driver(&ioc4_uart_rs232);
2944         uart_unregister_driver(&ioc4_uart_rs422);
2945 }
2946
2947 late_initcall(ioc4_serial_init); /* Call only after tty init is done */
2948 module_exit(ioc4_serial_exit);
2949
2950 MODULE_AUTHOR("Pat Gefre - Silicon Graphics Inc. (SGI) <pfg@sgi.com>");
2951 MODULE_DESCRIPTION("Serial PCI driver module for SGI IOC4 Base-IO Card");
2952 MODULE_LICENSE("GPL");