Merge tag 'dm-3.6-changes' of git://git.kernel.org/pub/scm/linux/kernel/git/agk/linux-dm
[deliverable/linux.git] / drivers / tty / serial / ioc3_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) 2005 Silicon Graphics, Inc. All Rights Reserved.
7 */
8
9 /*
10 * This file contains a module version of the ioc3 serial driver. This
11 * includes all the support functions needed (support functions, etc.)
12 * and the serial driver itself.
13 */
14 #include <linux/errno.h>
15 #include <linux/tty.h>
16 #include <linux/tty_flip.h>
17 #include <linux/serial.h>
18 #include <linux/circ_buf.h>
19 #include <linux/serial_reg.h>
20 #include <linux/module.h>
21 #include <linux/pci.h>
22 #include <linux/serial_core.h>
23 #include <linux/ioc3.h>
24 #include <linux/slab.h>
25
26 /*
27 * Interesting things about the ioc3
28 */
29
30 #define LOGICAL_PORTS 2 /* rs232(0) and rs422(1) */
31 #define PORTS_PER_CARD 2
32 #define LOGICAL_PORTS_PER_CARD (PORTS_PER_CARD * LOGICAL_PORTS)
33 #define MAX_CARDS 8
34 #define MAX_LOGICAL_PORTS (LOGICAL_PORTS_PER_CARD * MAX_CARDS)
35
36 /* determine given the sio_ir what port it applies to */
37 #define GET_PORT_FROM_SIO_IR(_x) (_x & SIO_IR_SA) ? 0 : 1
38
39
40 /*
41 * we have 2 logical ports (rs232, rs422) for each physical port
42 * evens are rs232, odds are rs422
43 */
44 #define GET_PHYSICAL_PORT(_x) ((_x) >> 1)
45 #define GET_LOGICAL_PORT(_x) ((_x) & 1)
46 #define IS_PHYSICAL_PORT(_x) !((_x) & 1)
47 #define IS_RS232(_x) !((_x) & 1)
48
49 static unsigned int Num_of_ioc3_cards;
50 static unsigned int Submodule_slot;
51
52 /* defining this will get you LOTS of great debug info */
53 //#define DEBUG_INTERRUPTS
54 #define DPRINT_CONFIG(_x...) ;
55 //#define DPRINT_CONFIG(_x...) printk _x
56 #define NOT_PROGRESS() ;
57 //#define NOT_PROGRESS() printk("%s : fails %d\n", __func__, __LINE__)
58
59 /* number of characters we want to transmit to the lower level at a time */
60 #define MAX_CHARS 256
61 #define FIFO_SIZE (MAX_CHARS-1) /* it's a uchar */
62
63 /* Device name we're using */
64 #define DEVICE_NAME "ttySIOC"
65 #define DEVICE_MAJOR 204
66 #define DEVICE_MINOR 116
67
68 /* flags for next_char_state */
69 #define NCS_BREAK 0x1
70 #define NCS_PARITY 0x2
71 #define NCS_FRAMING 0x4
72 #define NCS_OVERRUN 0x8
73
74 /* cause we need SOME parameters ... */
75 #define MIN_BAUD_SUPPORTED 1200
76 #define MAX_BAUD_SUPPORTED 115200
77
78 /* protocol types supported */
79 #define PROTO_RS232 0
80 #define PROTO_RS422 1
81
82 /* Notification types */
83 #define N_DATA_READY 0x01
84 #define N_OUTPUT_LOWAT 0x02
85 #define N_BREAK 0x04
86 #define N_PARITY_ERROR 0x08
87 #define N_FRAMING_ERROR 0x10
88 #define N_OVERRUN_ERROR 0x20
89 #define N_DDCD 0x40
90 #define N_DCTS 0x80
91
92 #define N_ALL_INPUT (N_DATA_READY | N_BREAK \
93 | N_PARITY_ERROR | N_FRAMING_ERROR \
94 | N_OVERRUN_ERROR | N_DDCD | N_DCTS)
95
96 #define N_ALL_OUTPUT N_OUTPUT_LOWAT
97
98 #define N_ALL_ERRORS (N_PARITY_ERROR | N_FRAMING_ERROR \
99 | N_OVERRUN_ERROR)
100
101 #define N_ALL (N_DATA_READY | N_OUTPUT_LOWAT | N_BREAK \
102 | N_PARITY_ERROR | N_FRAMING_ERROR \
103 | N_OVERRUN_ERROR | N_DDCD | N_DCTS)
104
105 #define SER_CLK_SPEED(prediv) ((22000000 << 1) / prediv)
106 #define SER_DIVISOR(x, clk) (((clk) + (x) * 8) / ((x) * 16))
107 #define DIVISOR_TO_BAUD(div, clk) ((clk) / 16 / (div))
108
109 /* Some masks */
110 #define LCR_MASK_BITS_CHAR (UART_LCR_WLEN5 | UART_LCR_WLEN6 \
111 | UART_LCR_WLEN7 | UART_LCR_WLEN8)
112 #define LCR_MASK_STOP_BITS (UART_LCR_STOP)
113
114 #define PENDING(_a, _p) (readl(&(_p)->vma->sio_ir) & (_a)->ic_enable)
115
116 #define RING_BUF_SIZE 4096
117 #define BUF_SIZE_BIT SBBR_L_SIZE
118 #define PROD_CONS_MASK PROD_CONS_PTR_4K
119
120 #define TOTAL_RING_BUF_SIZE (RING_BUF_SIZE * 4)
121
122 /* driver specific - one per card */
123 struct ioc3_card {
124 struct {
125 /* uart ports are allocated here */
126 struct uart_port icp_uart_port[LOGICAL_PORTS];
127 /* the ioc3_port used for this port */
128 struct ioc3_port *icp_port;
129 } ic_port[PORTS_PER_CARD];
130 /* currently enabled interrupts */
131 uint32_t ic_enable;
132 };
133
134 /* Local port info for each IOC3 serial port */
135 struct ioc3_port {
136 /* handy reference material */
137 struct uart_port *ip_port;
138 struct ioc3_card *ip_card;
139 struct ioc3_driver_data *ip_idd;
140 struct ioc3_submodule *ip_is;
141
142 /* pci mem addresses for this port */
143 struct ioc3_serialregs __iomem *ip_serial_regs;
144 struct ioc3_uartregs __iomem *ip_uart_regs;
145
146 /* Ring buffer page for this port */
147 dma_addr_t ip_dma_ringbuf;
148 /* vaddr of ring buffer */
149 struct ring_buffer *ip_cpu_ringbuf;
150
151 /* Rings for this port */
152 struct ring *ip_inring;
153 struct ring *ip_outring;
154
155 /* Hook to port specific values */
156 struct port_hooks *ip_hooks;
157
158 spinlock_t ip_lock;
159
160 /* Various rx/tx parameters */
161 int ip_baud;
162 int ip_tx_lowat;
163 int ip_rx_timeout;
164
165 /* Copy of notification bits */
166 int ip_notify;
167
168 /* Shadow copies of various registers so we don't need to PIO
169 * read them constantly
170 */
171 uint32_t ip_sscr;
172 uint32_t ip_tx_prod;
173 uint32_t ip_rx_cons;
174 unsigned char ip_flags;
175 };
176
177 /* tx low water mark. We need to notify the driver whenever tx is getting
178 * close to empty so it can refill the tx buffer and keep things going.
179 * Let's assume that if we interrupt 1 ms before the tx goes idle, we'll
180 * have no trouble getting in more chars in time (I certainly hope so).
181 */
182 #define TX_LOWAT_LATENCY 1000
183 #define TX_LOWAT_HZ (1000000 / TX_LOWAT_LATENCY)
184 #define TX_LOWAT_CHARS(baud) (baud / 10 / TX_LOWAT_HZ)
185
186 /* Flags per port */
187 #define INPUT_HIGH 0x01
188 /* used to signify that we have turned off the rx_high
189 * temporarily - we need to drain the fifo and don't
190 * want to get blasted with interrupts.
191 */
192 #define DCD_ON 0x02
193 /* DCD state is on */
194 #define LOWAT_WRITTEN 0x04
195 #define READ_ABORTED 0x08
196 /* the read was aborted - used to avaoid infinate looping
197 * in the interrupt handler
198 */
199 #define INPUT_ENABLE 0x10
200
201 /* Since each port has different register offsets and bitmasks
202 * for everything, we'll store those that we need in tables so we
203 * don't have to be constantly checking the port we are dealing with.
204 */
205 struct port_hooks {
206 uint32_t intr_delta_dcd;
207 uint32_t intr_delta_cts;
208 uint32_t intr_tx_mt;
209 uint32_t intr_rx_timer;
210 uint32_t intr_rx_high;
211 uint32_t intr_tx_explicit;
212 uint32_t intr_clear;
213 uint32_t intr_all;
214 char rs422_select_pin;
215 };
216
217 static struct port_hooks hooks_array[PORTS_PER_CARD] = {
218 /* values for port A */
219 {
220 .intr_delta_dcd = SIO_IR_SA_DELTA_DCD,
221 .intr_delta_cts = SIO_IR_SA_DELTA_CTS,
222 .intr_tx_mt = SIO_IR_SA_TX_MT,
223 .intr_rx_timer = SIO_IR_SA_RX_TIMER,
224 .intr_rx_high = SIO_IR_SA_RX_HIGH,
225 .intr_tx_explicit = SIO_IR_SA_TX_EXPLICIT,
226 .intr_clear = (SIO_IR_SA_TX_MT | SIO_IR_SA_RX_FULL
227 | SIO_IR_SA_RX_HIGH
228 | SIO_IR_SA_RX_TIMER
229 | SIO_IR_SA_DELTA_DCD
230 | SIO_IR_SA_DELTA_CTS
231 | SIO_IR_SA_INT
232 | SIO_IR_SA_TX_EXPLICIT
233 | SIO_IR_SA_MEMERR),
234 .intr_all = SIO_IR_SA,
235 .rs422_select_pin = GPPR_UARTA_MODESEL_PIN,
236 },
237
238 /* values for port B */
239 {
240 .intr_delta_dcd = SIO_IR_SB_DELTA_DCD,
241 .intr_delta_cts = SIO_IR_SB_DELTA_CTS,
242 .intr_tx_mt = SIO_IR_SB_TX_MT,
243 .intr_rx_timer = SIO_IR_SB_RX_TIMER,
244 .intr_rx_high = SIO_IR_SB_RX_HIGH,
245 .intr_tx_explicit = SIO_IR_SB_TX_EXPLICIT,
246 .intr_clear = (SIO_IR_SB_TX_MT | SIO_IR_SB_RX_FULL
247 | SIO_IR_SB_RX_HIGH
248 | SIO_IR_SB_RX_TIMER
249 | SIO_IR_SB_DELTA_DCD
250 | SIO_IR_SB_DELTA_CTS
251 | SIO_IR_SB_INT
252 | SIO_IR_SB_TX_EXPLICIT
253 | SIO_IR_SB_MEMERR),
254 .intr_all = SIO_IR_SB,
255 .rs422_select_pin = GPPR_UARTB_MODESEL_PIN,
256 }
257 };
258
259 struct ring_entry {
260 union {
261 struct {
262 uint32_t alldata;
263 uint32_t allsc;
264 } all;
265 struct {
266 char data[4]; /* data bytes */
267 char sc[4]; /* status/control */
268 } s;
269 } u;
270 };
271
272 /* Test the valid bits in any of the 4 sc chars using "allsc" member */
273 #define RING_ANY_VALID \
274 ((uint32_t)(RXSB_MODEM_VALID | RXSB_DATA_VALID) * 0x01010101)
275
276 #define ring_sc u.s.sc
277 #define ring_data u.s.data
278 #define ring_allsc u.all.allsc
279
280 /* Number of entries per ring buffer. */
281 #define ENTRIES_PER_RING (RING_BUF_SIZE / (int) sizeof(struct ring_entry))
282
283 /* An individual ring */
284 struct ring {
285 struct ring_entry entries[ENTRIES_PER_RING];
286 };
287
288 /* The whole enchilada */
289 struct ring_buffer {
290 struct ring TX_A;
291 struct ring RX_A;
292 struct ring TX_B;
293 struct ring RX_B;
294 };
295
296 /* Get a ring from a port struct */
297 #define RING(_p, _wh) &(((struct ring_buffer *)((_p)->ip_cpu_ringbuf))->_wh)
298
299 /* for Infinite loop detection */
300 #define MAXITER 10000000
301
302
303 /**
304 * set_baud - Baud rate setting code
305 * @port: port to set
306 * @baud: baud rate to use
307 */
308 static int set_baud(struct ioc3_port *port, int baud)
309 {
310 int divisor;
311 int actual_baud;
312 int diff;
313 int lcr, prediv;
314 struct ioc3_uartregs __iomem *uart;
315
316 for (prediv = 6; prediv < 64; prediv++) {
317 divisor = SER_DIVISOR(baud, SER_CLK_SPEED(prediv));
318 if (!divisor)
319 continue; /* invalid divisor */
320 actual_baud = DIVISOR_TO_BAUD(divisor, SER_CLK_SPEED(prediv));
321
322 diff = actual_baud - baud;
323 if (diff < 0)
324 diff = -diff;
325
326 /* if we're within 1% we've found a match */
327 if (diff * 100 <= actual_baud)
328 break;
329 }
330
331 /* if the above loop completed, we didn't match
332 * the baud rate. give up.
333 */
334 if (prediv == 64) {
335 NOT_PROGRESS();
336 return 1;
337 }
338
339 uart = port->ip_uart_regs;
340 lcr = readb(&uart->iu_lcr);
341
342 writeb(lcr | UART_LCR_DLAB, &uart->iu_lcr);
343 writeb((unsigned char)divisor, &uart->iu_dll);
344 writeb((unsigned char)(divisor >> 8), &uart->iu_dlm);
345 writeb((unsigned char)prediv, &uart->iu_scr);
346 writeb((unsigned char)lcr, &uart->iu_lcr);
347
348 return 0;
349 }
350
351 /**
352 * get_ioc3_port - given a uart port, return the control structure
353 * @the_port: uart port to find
354 */
355 static struct ioc3_port *get_ioc3_port(struct uart_port *the_port)
356 {
357 struct ioc3_driver_data *idd = dev_get_drvdata(the_port->dev);
358 struct ioc3_card *card_ptr = idd->data[Submodule_slot];
359 int ii, jj;
360
361 if (!card_ptr) {
362 NOT_PROGRESS();
363 return NULL;
364 }
365 for (ii = 0; ii < PORTS_PER_CARD; ii++) {
366 for (jj = 0; jj < LOGICAL_PORTS; jj++) {
367 if (the_port == &card_ptr->ic_port[ii].icp_uart_port[jj])
368 return card_ptr->ic_port[ii].icp_port;
369 }
370 }
371 NOT_PROGRESS();
372 return NULL;
373 }
374
375 /**
376 * port_init - Initialize the sio and ioc3 hardware for a given port
377 * called per port from attach...
378 * @port: port to initialize
379 */
380 static int inline port_init(struct ioc3_port *port)
381 {
382 uint32_t sio_cr;
383 struct port_hooks *hooks = port->ip_hooks;
384 struct ioc3_uartregs __iomem *uart;
385 int reset_loop_counter = 0xfffff;
386 struct ioc3_driver_data *idd = port->ip_idd;
387
388 /* Idle the IOC3 serial interface */
389 writel(SSCR_RESET, &port->ip_serial_regs->sscr);
390
391 /* Wait until any pending bus activity for this port has ceased */
392 do {
393 sio_cr = readl(&idd->vma->sio_cr);
394 if (reset_loop_counter-- <= 0) {
395 printk(KERN_WARNING
396 "IOC3 unable to come out of reset"
397 " scr 0x%x\n", sio_cr);
398 return -1;
399 }
400 } while (!(sio_cr & SIO_CR_ARB_DIAG_IDLE) &&
401 (((sio_cr &= SIO_CR_ARB_DIAG) == SIO_CR_ARB_DIAG_TXA)
402 || sio_cr == SIO_CR_ARB_DIAG_TXB
403 || sio_cr == SIO_CR_ARB_DIAG_RXA
404 || sio_cr == SIO_CR_ARB_DIAG_RXB));
405
406 /* Finish reset sequence */
407 writel(0, &port->ip_serial_regs->sscr);
408
409 /* Once RESET is done, reload cached tx_prod and rx_cons values
410 * and set rings to empty by making prod == cons
411 */
412 port->ip_tx_prod = readl(&port->ip_serial_regs->stcir) & PROD_CONS_MASK;
413 writel(port->ip_tx_prod, &port->ip_serial_regs->stpir);
414 port->ip_rx_cons = readl(&port->ip_serial_regs->srpir) & PROD_CONS_MASK;
415 writel(port->ip_rx_cons | SRCIR_ARM, &port->ip_serial_regs->srcir);
416
417 /* Disable interrupts for this 16550 */
418 uart = port->ip_uart_regs;
419 writeb(0, &uart->iu_lcr);
420 writeb(0, &uart->iu_ier);
421
422 /* Set the default baud */
423 set_baud(port, port->ip_baud);
424
425 /* Set line control to 8 bits no parity */
426 writeb(UART_LCR_WLEN8 | 0, &uart->iu_lcr);
427 /* UART_LCR_STOP == 1 stop */
428
429 /* Enable the FIFOs */
430 writeb(UART_FCR_ENABLE_FIFO, &uart->iu_fcr);
431 /* then reset 16550 FIFOs */
432 writeb(UART_FCR_ENABLE_FIFO | UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT,
433 &uart->iu_fcr);
434
435 /* Clear modem control register */
436 writeb(0, &uart->iu_mcr);
437
438 /* Clear deltas in modem status register */
439 writel(0, &port->ip_serial_regs->shadow);
440
441 /* Only do this once per port pair */
442 if (port->ip_hooks == &hooks_array[0]) {
443 unsigned long ring_pci_addr;
444 uint32_t __iomem *sbbr_l, *sbbr_h;
445
446 sbbr_l = &idd->vma->sbbr_l;
447 sbbr_h = &idd->vma->sbbr_h;
448 ring_pci_addr = (unsigned long __iomem)port->ip_dma_ringbuf;
449 DPRINT_CONFIG(("%s: ring_pci_addr 0x%p\n",
450 __func__, (void *)ring_pci_addr));
451
452 writel((unsigned int)((uint64_t) ring_pci_addr >> 32), sbbr_h);
453 writel((unsigned int)ring_pci_addr | BUF_SIZE_BIT, sbbr_l);
454 }
455
456 /* Set the receive timeout value to 10 msec */
457 writel(SRTR_HZ / 100, &port->ip_serial_regs->srtr);
458
459 /* Set rx threshold, enable DMA */
460 /* Set high water mark at 3/4 of full ring */
461 port->ip_sscr = (ENTRIES_PER_RING * 3 / 4);
462
463 /* uart experiences pauses at high baud rate reducing actual
464 * throughput by 10% or so unless we enable high speed polling
465 * XXX when this hardware bug is resolved we should revert to
466 * normal polling speed
467 */
468 port->ip_sscr |= SSCR_HIGH_SPD;
469
470 writel(port->ip_sscr, &port->ip_serial_regs->sscr);
471
472 /* Disable and clear all serial related interrupt bits */
473 port->ip_card->ic_enable &= ~hooks->intr_clear;
474 ioc3_disable(port->ip_is, idd, hooks->intr_clear);
475 ioc3_ack(port->ip_is, idd, hooks->intr_clear);
476 return 0;
477 }
478
479 /**
480 * enable_intrs - enable interrupts
481 * @port: port to enable
482 * @mask: mask to use
483 */
484 static void enable_intrs(struct ioc3_port *port, uint32_t mask)
485 {
486 if ((port->ip_card->ic_enable & mask) != mask) {
487 port->ip_card->ic_enable |= mask;
488 ioc3_enable(port->ip_is, port->ip_idd, mask);
489 }
490 }
491
492 /**
493 * local_open - local open a port
494 * @port: port to open
495 */
496 static inline int local_open(struct ioc3_port *port)
497 {
498 int spiniter = 0;
499
500 port->ip_flags = INPUT_ENABLE;
501
502 /* Pause the DMA interface if necessary */
503 if (port->ip_sscr & SSCR_DMA_EN) {
504 writel(port->ip_sscr | SSCR_DMA_PAUSE,
505 &port->ip_serial_regs->sscr);
506 while ((readl(&port->ip_serial_regs->sscr)
507 & SSCR_PAUSE_STATE) == 0) {
508 spiniter++;
509 if (spiniter > MAXITER) {
510 NOT_PROGRESS();
511 return -1;
512 }
513 }
514 }
515
516 /* Reset the input fifo. If the uart received chars while the port
517 * was closed and DMA is not enabled, the uart may have a bunch of
518 * chars hanging around in its rx fifo which will not be discarded
519 * by rclr in the upper layer. We must get rid of them here.
520 */
521 writeb(UART_FCR_ENABLE_FIFO | UART_FCR_CLEAR_RCVR,
522 &port->ip_uart_regs->iu_fcr);
523
524 writeb(UART_LCR_WLEN8, &port->ip_uart_regs->iu_lcr);
525 /* UART_LCR_STOP == 1 stop */
526
527 /* Re-enable DMA, set default threshold to intr whenever there is
528 * data available.
529 */
530 port->ip_sscr &= ~SSCR_RX_THRESHOLD;
531 port->ip_sscr |= 1; /* default threshold */
532
533 /* Plug in the new sscr. This implicitly clears the DMA_PAUSE
534 * flag if it was set above
535 */
536 writel(port->ip_sscr, &port->ip_serial_regs->sscr);
537 port->ip_tx_lowat = 1;
538 return 0;
539 }
540
541 /**
542 * set_rx_timeout - Set rx timeout and threshold values.
543 * @port: port to use
544 * @timeout: timeout value in ticks
545 */
546 static inline int set_rx_timeout(struct ioc3_port *port, int timeout)
547 {
548 int threshold;
549
550 port->ip_rx_timeout = timeout;
551
552 /* Timeout is in ticks. Let's figure out how many chars we
553 * can receive at the current baud rate in that interval
554 * and set the rx threshold to that amount. There are 4 chars
555 * per ring entry, so we'll divide the number of chars that will
556 * arrive in timeout by 4.
557 * So .... timeout * baud / 10 / HZ / 4, with HZ = 100.
558 */
559 threshold = timeout * port->ip_baud / 4000;
560 if (threshold == 0)
561 threshold = 1; /* otherwise we'll intr all the time! */
562
563 if ((unsigned)threshold > (unsigned)SSCR_RX_THRESHOLD)
564 return 1;
565
566 port->ip_sscr &= ~SSCR_RX_THRESHOLD;
567 port->ip_sscr |= threshold;
568 writel(port->ip_sscr, &port->ip_serial_regs->sscr);
569
570 /* Now set the rx timeout to the given value
571 * again timeout * SRTR_HZ / HZ
572 */
573 timeout = timeout * SRTR_HZ / 100;
574 if (timeout > SRTR_CNT)
575 timeout = SRTR_CNT;
576 writel(timeout, &port->ip_serial_regs->srtr);
577 return 0;
578 }
579
580 /**
581 * config_port - config the hardware
582 * @port: port to config
583 * @baud: baud rate for the port
584 * @byte_size: data size
585 * @stop_bits: number of stop bits
586 * @parenb: parity enable ?
587 * @parodd: odd parity ?
588 */
589 static inline int
590 config_port(struct ioc3_port *port,
591 int baud, int byte_size, int stop_bits, int parenb, int parodd)
592 {
593 char lcr, sizebits;
594 int spiniter = 0;
595
596 DPRINT_CONFIG(("%s: line %d baud %d byte_size %d stop %d parenb %d "
597 "parodd %d\n",
598 __func__, ((struct uart_port *)port->ip_port)->line,
599 baud, byte_size, stop_bits, parenb, parodd));
600
601 if (set_baud(port, baud))
602 return 1;
603
604 switch (byte_size) {
605 case 5:
606 sizebits = UART_LCR_WLEN5;
607 break;
608 case 6:
609 sizebits = UART_LCR_WLEN6;
610 break;
611 case 7:
612 sizebits = UART_LCR_WLEN7;
613 break;
614 case 8:
615 sizebits = UART_LCR_WLEN8;
616 break;
617 default:
618 return 1;
619 }
620
621 /* Pause the DMA interface if necessary */
622 if (port->ip_sscr & SSCR_DMA_EN) {
623 writel(port->ip_sscr | SSCR_DMA_PAUSE,
624 &port->ip_serial_regs->sscr);
625 while ((readl(&port->ip_serial_regs->sscr)
626 & SSCR_PAUSE_STATE) == 0) {
627 spiniter++;
628 if (spiniter > MAXITER)
629 return -1;
630 }
631 }
632
633 /* Clear relevant fields in lcr */
634 lcr = readb(&port->ip_uart_regs->iu_lcr);
635 lcr &= ~(LCR_MASK_BITS_CHAR | UART_LCR_EPAR |
636 UART_LCR_PARITY | LCR_MASK_STOP_BITS);
637
638 /* Set byte size in lcr */
639 lcr |= sizebits;
640
641 /* Set parity */
642 if (parenb) {
643 lcr |= UART_LCR_PARITY;
644 if (!parodd)
645 lcr |= UART_LCR_EPAR;
646 }
647
648 /* Set stop bits */
649 if (stop_bits)
650 lcr |= UART_LCR_STOP /* 2 stop bits */ ;
651
652 writeb(lcr, &port->ip_uart_regs->iu_lcr);
653
654 /* Re-enable the DMA interface if necessary */
655 if (port->ip_sscr & SSCR_DMA_EN) {
656 writel(port->ip_sscr, &port->ip_serial_regs->sscr);
657 }
658 port->ip_baud = baud;
659
660 /* When we get within this number of ring entries of filling the
661 * entire ring on tx, place an EXPLICIT intr to generate a lowat
662 * notification when output has drained.
663 */
664 port->ip_tx_lowat = (TX_LOWAT_CHARS(baud) + 3) / 4;
665 if (port->ip_tx_lowat == 0)
666 port->ip_tx_lowat = 1;
667
668 set_rx_timeout(port, 2);
669 return 0;
670 }
671
672 /**
673 * do_write - Write bytes to the port. Returns the number of bytes
674 * actually written. Called from transmit_chars
675 * @port: port to use
676 * @buf: the stuff to write
677 * @len: how many bytes in 'buf'
678 */
679 static inline int do_write(struct ioc3_port *port, char *buf, int len)
680 {
681 int prod_ptr, cons_ptr, total = 0;
682 struct ring *outring;
683 struct ring_entry *entry;
684 struct port_hooks *hooks = port->ip_hooks;
685
686 BUG_ON(!(len >= 0));
687
688 prod_ptr = port->ip_tx_prod;
689 cons_ptr = readl(&port->ip_serial_regs->stcir) & PROD_CONS_MASK;
690 outring = port->ip_outring;
691
692 /* Maintain a 1-entry red-zone. The ring buffer is full when
693 * (cons - prod) % ring_size is 1. Rather than do this subtraction
694 * in the body of the loop, I'll do it now.
695 */
696 cons_ptr = (cons_ptr - (int)sizeof(struct ring_entry)) & PROD_CONS_MASK;
697
698 /* Stuff the bytes into the output */
699 while ((prod_ptr != cons_ptr) && (len > 0)) {
700 int xx;
701
702 /* Get 4 bytes (one ring entry) at a time */
703 entry = (struct ring_entry *)((caddr_t) outring + prod_ptr);
704
705 /* Invalidate all entries */
706 entry->ring_allsc = 0;
707
708 /* Copy in some bytes */
709 for (xx = 0; (xx < 4) && (len > 0); xx++) {
710 entry->ring_data[xx] = *buf++;
711 entry->ring_sc[xx] = TXCB_VALID;
712 len--;
713 total++;
714 }
715
716 /* If we are within some small threshold of filling up the
717 * entire ring buffer, we must place an EXPLICIT intr here
718 * to generate a lowat interrupt in case we subsequently
719 * really do fill up the ring and the caller goes to sleep.
720 * No need to place more than one though.
721 */
722 if (!(port->ip_flags & LOWAT_WRITTEN) &&
723 ((cons_ptr - prod_ptr) & PROD_CONS_MASK)
724 <= port->ip_tx_lowat * (int)sizeof(struct ring_entry)) {
725 port->ip_flags |= LOWAT_WRITTEN;
726 entry->ring_sc[0] |= TXCB_INT_WHEN_DONE;
727 }
728
729 /* Go on to next entry */
730 prod_ptr += sizeof(struct ring_entry);
731 prod_ptr &= PROD_CONS_MASK;
732 }
733
734 /* If we sent something, start DMA if necessary */
735 if (total > 0 && !(port->ip_sscr & SSCR_DMA_EN)) {
736 port->ip_sscr |= SSCR_DMA_EN;
737 writel(port->ip_sscr, &port->ip_serial_regs->sscr);
738 }
739
740 /* Store the new producer pointer. If tx is disabled, we stuff the
741 * data into the ring buffer, but we don't actually start tx.
742 */
743 if (!uart_tx_stopped(port->ip_port)) {
744 writel(prod_ptr, &port->ip_serial_regs->stpir);
745
746 /* If we are now transmitting, enable tx_mt interrupt so we
747 * can disable DMA if necessary when the tx finishes.
748 */
749 if (total > 0)
750 enable_intrs(port, hooks->intr_tx_mt);
751 }
752 port->ip_tx_prod = prod_ptr;
753
754 return total;
755 }
756
757 /**
758 * disable_intrs - disable interrupts
759 * @port: port to enable
760 * @mask: mask to use
761 */
762 static inline void disable_intrs(struct ioc3_port *port, uint32_t mask)
763 {
764 if (port->ip_card->ic_enable & mask) {
765 ioc3_disable(port->ip_is, port->ip_idd, mask);
766 port->ip_card->ic_enable &= ~mask;
767 }
768 }
769
770 /**
771 * set_notification - Modify event notification
772 * @port: port to use
773 * @mask: events mask
774 * @set_on: set ?
775 */
776 static int set_notification(struct ioc3_port *port, int mask, int set_on)
777 {
778 struct port_hooks *hooks = port->ip_hooks;
779 uint32_t intrbits, sscrbits;
780
781 BUG_ON(!mask);
782
783 intrbits = sscrbits = 0;
784
785 if (mask & N_DATA_READY)
786 intrbits |= (hooks->intr_rx_timer | hooks->intr_rx_high);
787 if (mask & N_OUTPUT_LOWAT)
788 intrbits |= hooks->intr_tx_explicit;
789 if (mask & N_DDCD) {
790 intrbits |= hooks->intr_delta_dcd;
791 sscrbits |= SSCR_RX_RING_DCD;
792 }
793 if (mask & N_DCTS)
794 intrbits |= hooks->intr_delta_cts;
795
796 if (set_on) {
797 enable_intrs(port, intrbits);
798 port->ip_notify |= mask;
799 port->ip_sscr |= sscrbits;
800 } else {
801 disable_intrs(port, intrbits);
802 port->ip_notify &= ~mask;
803 port->ip_sscr &= ~sscrbits;
804 }
805
806 /* We require DMA if either DATA_READY or DDCD notification is
807 * currently requested. If neither of these is requested and
808 * there is currently no tx in progress, DMA may be disabled.
809 */
810 if (port->ip_notify & (N_DATA_READY | N_DDCD))
811 port->ip_sscr |= SSCR_DMA_EN;
812 else if (!(port->ip_card->ic_enable & hooks->intr_tx_mt))
813 port->ip_sscr &= ~SSCR_DMA_EN;
814
815 writel(port->ip_sscr, &port->ip_serial_regs->sscr);
816 return 0;
817 }
818
819 /**
820 * set_mcr - set the master control reg
821 * @the_port: port to use
822 * @mask1: mcr mask
823 * @mask2: shadow mask
824 */
825 static inline int set_mcr(struct uart_port *the_port,
826 int mask1, int mask2)
827 {
828 struct ioc3_port *port = get_ioc3_port(the_port);
829 uint32_t shadow;
830 int spiniter = 0;
831 char mcr;
832
833 if (!port)
834 return -1;
835
836 /* Pause the DMA interface if necessary */
837 if (port->ip_sscr & SSCR_DMA_EN) {
838 writel(port->ip_sscr | SSCR_DMA_PAUSE,
839 &port->ip_serial_regs->sscr);
840 while ((readl(&port->ip_serial_regs->sscr)
841 & SSCR_PAUSE_STATE) == 0) {
842 spiniter++;
843 if (spiniter > MAXITER)
844 return -1;
845 }
846 }
847 shadow = readl(&port->ip_serial_regs->shadow);
848 mcr = (shadow & 0xff000000) >> 24;
849
850 /* Set new value */
851 mcr |= mask1;
852 shadow |= mask2;
853 writeb(mcr, &port->ip_uart_regs->iu_mcr);
854 writel(shadow, &port->ip_serial_regs->shadow);
855
856 /* Re-enable the DMA interface if necessary */
857 if (port->ip_sscr & SSCR_DMA_EN) {
858 writel(port->ip_sscr, &port->ip_serial_regs->sscr);
859 }
860 return 0;
861 }
862
863 /**
864 * ioc3_set_proto - set the protocol for the port
865 * @port: port to use
866 * @proto: protocol to use
867 */
868 static int ioc3_set_proto(struct ioc3_port *port, int proto)
869 {
870 struct port_hooks *hooks = port->ip_hooks;
871
872 switch (proto) {
873 default:
874 case PROTO_RS232:
875 /* Clear the appropriate GIO pin */
876 DPRINT_CONFIG(("%s: rs232\n", __func__));
877 writel(0, (&port->ip_idd->vma->gppr[0]
878 + hooks->rs422_select_pin));
879 break;
880
881 case PROTO_RS422:
882 /* Set the appropriate GIO pin */
883 DPRINT_CONFIG(("%s: rs422\n", __func__));
884 writel(1, (&port->ip_idd->vma->gppr[0]
885 + hooks->rs422_select_pin));
886 break;
887 }
888 return 0;
889 }
890
891 /**
892 * transmit_chars - upper level write, called with the_port->lock
893 * @the_port: port to write
894 */
895 static void transmit_chars(struct uart_port *the_port)
896 {
897 int xmit_count, tail, head;
898 int result;
899 char *start;
900 struct tty_struct *tty;
901 struct ioc3_port *port = get_ioc3_port(the_port);
902 struct uart_state *state;
903
904 if (!the_port)
905 return;
906 if (!port)
907 return;
908
909 state = the_port->state;
910 tty = state->port.tty;
911
912 if (uart_circ_empty(&state->xmit) || uart_tx_stopped(the_port)) {
913 /* Nothing to do or hw stopped */
914 set_notification(port, N_ALL_OUTPUT, 0);
915 return;
916 }
917
918 head = state->xmit.head;
919 tail = state->xmit.tail;
920 start = (char *)&state->xmit.buf[tail];
921
922 /* write out all the data or until the end of the buffer */
923 xmit_count = (head < tail) ? (UART_XMIT_SIZE - tail) : (head - tail);
924 if (xmit_count > 0) {
925 result = do_write(port, start, xmit_count);
926 if (result > 0) {
927 /* booking */
928 xmit_count -= result;
929 the_port->icount.tx += result;
930 /* advance the pointers */
931 tail += result;
932 tail &= UART_XMIT_SIZE - 1;
933 state->xmit.tail = tail;
934 start = (char *)&state->xmit.buf[tail];
935 }
936 }
937 if (uart_circ_chars_pending(&state->xmit) < WAKEUP_CHARS)
938 uart_write_wakeup(the_port);
939
940 if (uart_circ_empty(&state->xmit)) {
941 set_notification(port, N_OUTPUT_LOWAT, 0);
942 } else {
943 set_notification(port, N_OUTPUT_LOWAT, 1);
944 }
945 }
946
947 /**
948 * ioc3_change_speed - change the speed of the port
949 * @the_port: port to change
950 * @new_termios: new termios settings
951 * @old_termios: old termios settings
952 */
953 static void
954 ioc3_change_speed(struct uart_port *the_port,
955 struct ktermios *new_termios, struct ktermios *old_termios)
956 {
957 struct ioc3_port *port = get_ioc3_port(the_port);
958 unsigned int cflag, iflag;
959 int baud;
960 int new_parity = 0, new_parity_enable = 0, new_stop = 0, new_data = 8;
961 struct uart_state *state = the_port->state;
962
963 cflag = new_termios->c_cflag;
964 iflag = new_termios->c_iflag;
965
966 switch (cflag & CSIZE) {
967 case CS5:
968 new_data = 5;
969 break;
970 case CS6:
971 new_data = 6;
972 break;
973 case CS7:
974 new_data = 7;
975 break;
976 case CS8:
977 new_data = 8;
978 break;
979 default:
980 /* cuz we always need a default ... */
981 new_data = 5;
982 break;
983 }
984 if (cflag & CSTOPB) {
985 new_stop = 1;
986 }
987 if (cflag & PARENB) {
988 new_parity_enable = 1;
989 if (cflag & PARODD)
990 new_parity = 1;
991 }
992 baud = uart_get_baud_rate(the_port, new_termios, old_termios,
993 MIN_BAUD_SUPPORTED, MAX_BAUD_SUPPORTED);
994 DPRINT_CONFIG(("%s: returned baud %d for line %d\n", __func__, baud,
995 the_port->line));
996
997 if (!the_port->fifosize)
998 the_port->fifosize = FIFO_SIZE;
999 uart_update_timeout(the_port, cflag, baud);
1000
1001 the_port->ignore_status_mask = N_ALL_INPUT;
1002
1003 state->port.tty->low_latency = 1;
1004
1005 if (iflag & IGNPAR)
1006 the_port->ignore_status_mask &= ~(N_PARITY_ERROR
1007 | N_FRAMING_ERROR);
1008 if (iflag & IGNBRK) {
1009 the_port->ignore_status_mask &= ~N_BREAK;
1010 if (iflag & IGNPAR)
1011 the_port->ignore_status_mask &= ~N_OVERRUN_ERROR;
1012 }
1013 if (!(cflag & CREAD)) {
1014 /* ignore everything */
1015 the_port->ignore_status_mask &= ~N_DATA_READY;
1016 }
1017
1018 if (cflag & CRTSCTS) {
1019 /* enable hardware flow control */
1020 port->ip_sscr |= SSCR_HFC_EN;
1021 }
1022 else {
1023 /* disable hardware flow control */
1024 port->ip_sscr &= ~SSCR_HFC_EN;
1025 }
1026 writel(port->ip_sscr, &port->ip_serial_regs->sscr);
1027
1028 /* Set the configuration and proper notification call */
1029 DPRINT_CONFIG(("%s : port 0x%p line %d cflag 0%o "
1030 "config_port(baud %d data %d stop %d penable %d "
1031 " parity %d), notification 0x%x\n",
1032 __func__, (void *)port, the_port->line, cflag, baud,
1033 new_data, new_stop, new_parity_enable, new_parity,
1034 the_port->ignore_status_mask));
1035
1036 if ((config_port(port, baud, /* baud */
1037 new_data, /* byte size */
1038 new_stop, /* stop bits */
1039 new_parity_enable, /* set parity */
1040 new_parity)) >= 0) { /* parity 1==odd */
1041 set_notification(port, the_port->ignore_status_mask, 1);
1042 }
1043 }
1044
1045 /**
1046 * ic3_startup_local - Start up the serial port - returns >= 0 if no errors
1047 * @the_port: Port to operate on
1048 */
1049 static inline int ic3_startup_local(struct uart_port *the_port)
1050 {
1051 struct ioc3_port *port;
1052
1053 if (!the_port) {
1054 NOT_PROGRESS();
1055 return -1;
1056 }
1057
1058 port = get_ioc3_port(the_port);
1059 if (!port) {
1060 NOT_PROGRESS();
1061 return -1;
1062 }
1063
1064 local_open(port);
1065
1066 /* set the protocol */
1067 ioc3_set_proto(port, IS_RS232(the_port->line) ? PROTO_RS232 :
1068 PROTO_RS422);
1069 return 0;
1070 }
1071
1072 /*
1073 * ioc3_cb_output_lowat - called when the output low water mark is hit
1074 * @port: port to output
1075 */
1076 static void ioc3_cb_output_lowat(struct ioc3_port *port)
1077 {
1078 unsigned long pflags;
1079
1080 /* the_port->lock is set on the call here */
1081 if (port->ip_port) {
1082 spin_lock_irqsave(&port->ip_port->lock, pflags);
1083 transmit_chars(port->ip_port);
1084 spin_unlock_irqrestore(&port->ip_port->lock, pflags);
1085 }
1086 }
1087
1088 /*
1089 * ioc3_cb_post_ncs - called for some basic errors
1090 * @port: port to use
1091 * @ncs: event
1092 */
1093 static void ioc3_cb_post_ncs(struct uart_port *the_port, int ncs)
1094 {
1095 struct uart_icount *icount;
1096
1097 icount = &the_port->icount;
1098
1099 if (ncs & NCS_BREAK)
1100 icount->brk++;
1101 if (ncs & NCS_FRAMING)
1102 icount->frame++;
1103 if (ncs & NCS_OVERRUN)
1104 icount->overrun++;
1105 if (ncs & NCS_PARITY)
1106 icount->parity++;
1107 }
1108
1109 /**
1110 * do_read - Read in bytes from the port. Return the number of bytes
1111 * actually read.
1112 * @the_port: port to use
1113 * @buf: place to put the stuff we read
1114 * @len: how big 'buf' is
1115 */
1116
1117 static inline int do_read(struct uart_port *the_port, char *buf, int len)
1118 {
1119 int prod_ptr, cons_ptr, total;
1120 struct ioc3_port *port = get_ioc3_port(the_port);
1121 struct ring *inring;
1122 struct ring_entry *entry;
1123 struct port_hooks *hooks = port->ip_hooks;
1124 int byte_num;
1125 char *sc;
1126 int loop_counter;
1127
1128 BUG_ON(!(len >= 0));
1129 BUG_ON(!port);
1130
1131 /* There is a nasty timing issue in the IOC3. When the rx_timer
1132 * expires or the rx_high condition arises, we take an interrupt.
1133 * At some point while servicing the interrupt, we read bytes from
1134 * the ring buffer and re-arm the rx_timer. However the rx_timer is
1135 * not started until the first byte is received *after* it is armed,
1136 * and any bytes pending in the rx construction buffers are not drained
1137 * to memory until either there are 4 bytes available or the rx_timer
1138 * expires. This leads to a potential situation where data is left
1139 * in the construction buffers forever - 1 to 3 bytes were received
1140 * after the interrupt was generated but before the rx_timer was
1141 * re-armed. At that point as long as no subsequent bytes are received
1142 * the timer will never be started and the bytes will remain in the
1143 * construction buffer forever. The solution is to execute a DRAIN
1144 * command after rearming the timer. This way any bytes received before
1145 * the DRAIN will be drained to memory, and any bytes received after
1146 * the DRAIN will start the TIMER and be drained when it expires.
1147 * Luckily, this only needs to be done when the DMA buffer is empty
1148 * since there is no requirement that this function return all
1149 * available data as long as it returns some.
1150 */
1151 /* Re-arm the timer */
1152
1153 writel(port->ip_rx_cons | SRCIR_ARM, &port->ip_serial_regs->srcir);
1154
1155 prod_ptr = readl(&port->ip_serial_regs->srpir) & PROD_CONS_MASK;
1156 cons_ptr = port->ip_rx_cons;
1157
1158 if (prod_ptr == cons_ptr) {
1159 int reset_dma = 0;
1160
1161 /* Input buffer appears empty, do a flush. */
1162
1163 /* DMA must be enabled for this to work. */
1164 if (!(port->ip_sscr & SSCR_DMA_EN)) {
1165 port->ip_sscr |= SSCR_DMA_EN;
1166 reset_dma = 1;
1167 }
1168
1169 /* Potential race condition: we must reload the srpir after
1170 * issuing the drain command, otherwise we could think the rx
1171 * buffer is empty, then take a very long interrupt, and when
1172 * we come back it's full and we wait forever for the drain to
1173 * complete.
1174 */
1175 writel(port->ip_sscr | SSCR_RX_DRAIN,
1176 &port->ip_serial_regs->sscr);
1177 prod_ptr = readl(&port->ip_serial_regs->srpir) & PROD_CONS_MASK;
1178
1179 /* We must not wait for the DRAIN to complete unless there are
1180 * at least 8 bytes (2 ring entries) available to receive the
1181 * data otherwise the DRAIN will never complete and we'll
1182 * deadlock here.
1183 * In fact, to make things easier, I'll just ignore the flush if
1184 * there is any data at all now available.
1185 */
1186 if (prod_ptr == cons_ptr) {
1187 loop_counter = 0;
1188 while (readl(&port->ip_serial_regs->sscr) &
1189 SSCR_RX_DRAIN) {
1190 loop_counter++;
1191 if (loop_counter > MAXITER)
1192 return -1;
1193 }
1194
1195 /* SIGH. We have to reload the prod_ptr *again* since
1196 * the drain may have caused it to change
1197 */
1198 prod_ptr = readl(&port->ip_serial_regs->srpir)
1199 & PROD_CONS_MASK;
1200 }
1201 if (reset_dma) {
1202 port->ip_sscr &= ~SSCR_DMA_EN;
1203 writel(port->ip_sscr, &port->ip_serial_regs->sscr);
1204 }
1205 }
1206 inring = port->ip_inring;
1207 port->ip_flags &= ~READ_ABORTED;
1208
1209 total = 0;
1210 loop_counter = 0xfffff; /* to avoid hangs */
1211
1212 /* Grab bytes from the hardware */
1213 while ((prod_ptr != cons_ptr) && (len > 0)) {
1214 entry = (struct ring_entry *)((caddr_t) inring + cons_ptr);
1215
1216 if (loop_counter-- <= 0) {
1217 printk(KERN_WARNING "IOC3 serial: "
1218 "possible hang condition/"
1219 "port stuck on read (line %d).\n",
1220 the_port->line);
1221 break;
1222 }
1223
1224 /* According to the producer pointer, this ring entry
1225 * must contain some data. But if the PIO happened faster
1226 * than the DMA, the data may not be available yet, so let's
1227 * wait until it arrives.
1228 */
1229 if ((entry->ring_allsc & RING_ANY_VALID) == 0) {
1230 /* Indicate the read is aborted so we don't disable
1231 * the interrupt thinking that the consumer is
1232 * congested.
1233 */
1234 port->ip_flags |= READ_ABORTED;
1235 len = 0;
1236 break;
1237 }
1238
1239 /* Load the bytes/status out of the ring entry */
1240 for (byte_num = 0; byte_num < 4 && len > 0; byte_num++) {
1241 sc = &(entry->ring_sc[byte_num]);
1242
1243 /* Check for change in modem state or overrun */
1244 if ((*sc & RXSB_MODEM_VALID)
1245 && (port->ip_notify & N_DDCD)) {
1246 /* Notify upper layer if DCD dropped */
1247 if ((port->ip_flags & DCD_ON)
1248 && !(*sc & RXSB_DCD)) {
1249 /* If we have already copied some data,
1250 * return it. We'll pick up the carrier
1251 * drop on the next pass. That way we
1252 * don't throw away the data that has
1253 * already been copied back to
1254 * the caller's buffer.
1255 */
1256 if (total > 0) {
1257 len = 0;
1258 break;
1259 }
1260 port->ip_flags &= ~DCD_ON;
1261
1262 /* Turn off this notification so the
1263 * carrier drop protocol won't see it
1264 * again when it does a read.
1265 */
1266 *sc &= ~RXSB_MODEM_VALID;
1267
1268 /* To keep things consistent, we need
1269 * to update the consumer pointer so
1270 * the next reader won't come in and
1271 * try to read the same ring entries
1272 * again. This must be done here before
1273 * the dcd change.
1274 */
1275
1276 if ((entry->ring_allsc & RING_ANY_VALID)
1277 == 0) {
1278 cons_ptr += (int)sizeof
1279 (struct ring_entry);
1280 cons_ptr &= PROD_CONS_MASK;
1281 }
1282 writel(cons_ptr,
1283 &port->ip_serial_regs->srcir);
1284 port->ip_rx_cons = cons_ptr;
1285
1286 /* Notify upper layer of carrier drop */
1287 if ((port->ip_notify & N_DDCD)
1288 && port->ip_port) {
1289 uart_handle_dcd_change
1290 (port->ip_port, 0);
1291 wake_up_interruptible
1292 (&the_port->state->
1293 port.delta_msr_wait);
1294 }
1295
1296 /* If we had any data to return, we
1297 * would have returned it above.
1298 */
1299 return 0;
1300 }
1301 }
1302 if (*sc & RXSB_MODEM_VALID) {
1303 /* Notify that an input overrun occurred */
1304 if ((*sc & RXSB_OVERRUN)
1305 && (port->ip_notify & N_OVERRUN_ERROR)) {
1306 ioc3_cb_post_ncs(the_port, NCS_OVERRUN);
1307 }
1308 /* Don't look at this byte again */
1309 *sc &= ~RXSB_MODEM_VALID;
1310 }
1311
1312 /* Check for valid data or RX errors */
1313 if ((*sc & RXSB_DATA_VALID) &&
1314 ((*sc & (RXSB_PAR_ERR
1315 | RXSB_FRAME_ERR | RXSB_BREAK))
1316 && (port->ip_notify & (N_PARITY_ERROR
1317 | N_FRAMING_ERROR
1318 | N_BREAK)))) {
1319 /* There is an error condition on the next byte.
1320 * If we have already transferred some bytes,
1321 * we'll stop here. Otherwise if this is the
1322 * first byte to be read, we'll just transfer
1323 * it alone after notifying the
1324 * upper layer of its status.
1325 */
1326 if (total > 0) {
1327 len = 0;
1328 break;
1329 } else {
1330 if ((*sc & RXSB_PAR_ERR) &&
1331 (port->
1332 ip_notify & N_PARITY_ERROR)) {
1333 ioc3_cb_post_ncs(the_port,
1334 NCS_PARITY);
1335 }
1336 if ((*sc & RXSB_FRAME_ERR) &&
1337 (port->
1338 ip_notify & N_FRAMING_ERROR)) {
1339 ioc3_cb_post_ncs(the_port,
1340 NCS_FRAMING);
1341 }
1342 if ((*sc & RXSB_BREAK)
1343 && (port->ip_notify & N_BREAK)) {
1344 ioc3_cb_post_ncs
1345 (the_port, NCS_BREAK);
1346 }
1347 len = 1;
1348 }
1349 }
1350 if (*sc & RXSB_DATA_VALID) {
1351 *sc &= ~RXSB_DATA_VALID;
1352 *buf = entry->ring_data[byte_num];
1353 buf++;
1354 len--;
1355 total++;
1356 }
1357 }
1358
1359 /* If we used up this entry entirely, go on to the next one,
1360 * otherwise we must have run out of buffer space, so
1361 * leave the consumer pointer here for the next read in case
1362 * there are still unread bytes in this entry.
1363 */
1364 if ((entry->ring_allsc & RING_ANY_VALID) == 0) {
1365 cons_ptr += (int)sizeof(struct ring_entry);
1366 cons_ptr &= PROD_CONS_MASK;
1367 }
1368 }
1369
1370 /* Update consumer pointer and re-arm rx timer interrupt */
1371 writel(cons_ptr, &port->ip_serial_regs->srcir);
1372 port->ip_rx_cons = cons_ptr;
1373
1374 /* If we have now dipped below the rx high water mark and we have
1375 * rx_high interrupt turned off, we can now turn it back on again.
1376 */
1377 if ((port->ip_flags & INPUT_HIGH) && (((prod_ptr - cons_ptr)
1378 & PROD_CONS_MASK) <
1379 ((port->
1380 ip_sscr &
1381 SSCR_RX_THRESHOLD)
1382 << PROD_CONS_PTR_OFF))) {
1383 port->ip_flags &= ~INPUT_HIGH;
1384 enable_intrs(port, hooks->intr_rx_high);
1385 }
1386 return total;
1387 }
1388
1389 /**
1390 * receive_chars - upper level read.
1391 * @the_port: port to read from
1392 */
1393 static int receive_chars(struct uart_port *the_port)
1394 {
1395 struct tty_struct *tty;
1396 unsigned char ch[MAX_CHARS];
1397 int read_count = 0, read_room, flip = 0;
1398 struct uart_state *state = the_port->state;
1399 struct ioc3_port *port = get_ioc3_port(the_port);
1400 unsigned long pflags;
1401
1402 /* Make sure all the pointers are "good" ones */
1403 if (!state)
1404 return 0;
1405 if (!state->port.tty)
1406 return 0;
1407
1408 if (!(port->ip_flags & INPUT_ENABLE))
1409 return 0;
1410
1411 spin_lock_irqsave(&the_port->lock, pflags);
1412 tty = state->port.tty;
1413
1414 read_count = do_read(the_port, ch, MAX_CHARS);
1415 if (read_count > 0) {
1416 flip = 1;
1417 read_room = tty_insert_flip_string(tty, ch, read_count);
1418 the_port->icount.rx += read_count;
1419 }
1420 spin_unlock_irqrestore(&the_port->lock, pflags);
1421
1422 if (flip)
1423 tty_flip_buffer_push(tty);
1424
1425 return read_count;
1426 }
1427
1428 /**
1429 * ioc3uart_intr_one - lowest level (per port) interrupt handler.
1430 * @is : submodule
1431 * @idd: driver data
1432 * @pending: interrupts to handle
1433 */
1434
1435 static int inline
1436 ioc3uart_intr_one(struct ioc3_submodule *is,
1437 struct ioc3_driver_data *idd,
1438 unsigned int pending)
1439 {
1440 int port_num = GET_PORT_FROM_SIO_IR(pending);
1441 struct port_hooks *hooks;
1442 unsigned int rx_high_rd_aborted = 0;
1443 unsigned long flags;
1444 struct uart_port *the_port;
1445 struct ioc3_port *port;
1446 int loop_counter;
1447 struct ioc3_card *card_ptr;
1448 unsigned int sio_ir;
1449
1450 card_ptr = idd->data[is->id];
1451 port = card_ptr->ic_port[port_num].icp_port;
1452 hooks = port->ip_hooks;
1453
1454 /* Possible race condition here: The tx_mt interrupt bit may be
1455 * cleared without the intervention of the interrupt handler,
1456 * e.g. by a write. If the top level interrupt handler reads a
1457 * tx_mt, then some other processor does a write, starting up
1458 * output, then we come in here, see the tx_mt and stop DMA, the
1459 * output started by the other processor will hang. Thus we can
1460 * only rely on tx_mt being legitimate if it is read while the
1461 * port lock is held. Therefore this bit must be ignored in the
1462 * passed in interrupt mask which was read by the top level
1463 * interrupt handler since the port lock was not held at the time
1464 * it was read. We can only rely on this bit being accurate if it
1465 * is read while the port lock is held. So we'll clear it for now,
1466 * and reload it later once we have the port lock.
1467 */
1468
1469 sio_ir = pending & ~(hooks->intr_tx_mt);
1470 spin_lock_irqsave(&port->ip_lock, flags);
1471
1472 loop_counter = MAXITER; /* to avoid hangs */
1473
1474 do {
1475 uint32_t shadow;
1476
1477 if (loop_counter-- <= 0) {
1478 printk(KERN_WARNING "IOC3 serial: "
1479 "possible hang condition/"
1480 "port stuck on interrupt (line %d).\n",
1481 ((struct uart_port *)port->ip_port)->line);
1482 break;
1483 }
1484 /* Handle a DCD change */
1485 if (sio_ir & hooks->intr_delta_dcd) {
1486 ioc3_ack(is, idd, hooks->intr_delta_dcd);
1487 shadow = readl(&port->ip_serial_regs->shadow);
1488
1489 if ((port->ip_notify & N_DDCD)
1490 && (shadow & SHADOW_DCD)
1491 && (port->ip_port)) {
1492 the_port = port->ip_port;
1493 uart_handle_dcd_change(the_port,
1494 shadow & SHADOW_DCD);
1495 wake_up_interruptible
1496 (&the_port->state->port.delta_msr_wait);
1497 } else if ((port->ip_notify & N_DDCD)
1498 && !(shadow & SHADOW_DCD)) {
1499 /* Flag delta DCD/no DCD */
1500 uart_handle_dcd_change(port->ip_port,
1501 shadow & SHADOW_DCD);
1502 port->ip_flags |= DCD_ON;
1503 }
1504 }
1505
1506 /* Handle a CTS change */
1507 if (sio_ir & hooks->intr_delta_cts) {
1508 ioc3_ack(is, idd, hooks->intr_delta_cts);
1509 shadow = readl(&port->ip_serial_regs->shadow);
1510
1511 if ((port->ip_notify & N_DCTS) && (port->ip_port)) {
1512 the_port = port->ip_port;
1513 uart_handle_cts_change(the_port, shadow
1514 & SHADOW_CTS);
1515 wake_up_interruptible
1516 (&the_port->state->port.delta_msr_wait);
1517 }
1518 }
1519
1520 /* rx timeout interrupt. Must be some data available. Put this
1521 * before the check for rx_high since servicing this condition
1522 * may cause that condition to clear.
1523 */
1524 if (sio_ir & hooks->intr_rx_timer) {
1525 ioc3_ack(is, idd, hooks->intr_rx_timer);
1526 if ((port->ip_notify & N_DATA_READY)
1527 && (port->ip_port)) {
1528 receive_chars(port->ip_port);
1529 }
1530 }
1531
1532 /* rx high interrupt. Must be after rx_timer. */
1533 else if (sio_ir & hooks->intr_rx_high) {
1534 /* Data available, notify upper layer */
1535 if ((port->ip_notify & N_DATA_READY) && port->ip_port) {
1536 receive_chars(port->ip_port);
1537 }
1538
1539 /* We can't ACK this interrupt. If receive_chars didn't
1540 * cause the condition to clear, we'll have to disable
1541 * the interrupt until the data is drained.
1542 * If the read was aborted, don't disable the interrupt
1543 * as this may cause us to hang indefinitely. An
1544 * aborted read generally means that this interrupt
1545 * hasn't been delivered to the cpu yet anyway, even
1546 * though we see it as asserted when we read the sio_ir.
1547 */
1548 if ((sio_ir = PENDING(card_ptr, idd))
1549 & hooks->intr_rx_high) {
1550 if (port->ip_flags & READ_ABORTED) {
1551 rx_high_rd_aborted++;
1552 }
1553 else {
1554 card_ptr->ic_enable &= ~hooks->intr_rx_high;
1555 port->ip_flags |= INPUT_HIGH;
1556 }
1557 }
1558 }
1559
1560 /* We got a low water interrupt: notify upper layer to
1561 * send more data. Must come before tx_mt since servicing
1562 * this condition may cause that condition to clear.
1563 */
1564 if (sio_ir & hooks->intr_tx_explicit) {
1565 port->ip_flags &= ~LOWAT_WRITTEN;
1566 ioc3_ack(is, idd, hooks->intr_tx_explicit);
1567 if (port->ip_notify & N_OUTPUT_LOWAT)
1568 ioc3_cb_output_lowat(port);
1569 }
1570
1571 /* Handle tx_mt. Must come after tx_explicit. */
1572 else if (sio_ir & hooks->intr_tx_mt) {
1573 /* If we are expecting a lowat notification
1574 * and we get to this point it probably means that for
1575 * some reason the tx_explicit didn't work as expected
1576 * (that can legitimately happen if the output buffer is
1577 * filled up in just the right way).
1578 * So send the notification now.
1579 */
1580 if (port->ip_notify & N_OUTPUT_LOWAT) {
1581 ioc3_cb_output_lowat(port);
1582
1583 /* We need to reload the sio_ir since the lowat
1584 * call may have caused another write to occur,
1585 * clearing the tx_mt condition.
1586 */
1587 sio_ir = PENDING(card_ptr, idd);
1588 }
1589
1590 /* If the tx_mt condition still persists even after the
1591 * lowat call, we've got some work to do.
1592 */
1593 if (sio_ir & hooks->intr_tx_mt) {
1594 /* If we are not currently expecting DMA input,
1595 * and the transmitter has just gone idle,
1596 * there is no longer any reason for DMA, so
1597 * disable it.
1598 */
1599 if (!(port->ip_notify
1600 & (N_DATA_READY | N_DDCD))) {
1601 BUG_ON(!(port->ip_sscr
1602 & SSCR_DMA_EN));
1603 port->ip_sscr &= ~SSCR_DMA_EN;
1604 writel(port->ip_sscr,
1605 &port->ip_serial_regs->sscr);
1606 }
1607 /* Prevent infinite tx_mt interrupt */
1608 card_ptr->ic_enable &= ~hooks->intr_tx_mt;
1609 }
1610 }
1611 sio_ir = PENDING(card_ptr, idd);
1612
1613 /* if the read was aborted and only hooks->intr_rx_high,
1614 * clear hooks->intr_rx_high, so we do not loop forever.
1615 */
1616
1617 if (rx_high_rd_aborted && (sio_ir == hooks->intr_rx_high)) {
1618 sio_ir &= ~hooks->intr_rx_high;
1619 }
1620 } while (sio_ir & hooks->intr_all);
1621
1622 spin_unlock_irqrestore(&port->ip_lock, flags);
1623 ioc3_enable(is, idd, card_ptr->ic_enable);
1624 return 0;
1625 }
1626
1627 /**
1628 * ioc3uart_intr - field all serial interrupts
1629 * @is : submodule
1630 * @idd: driver data
1631 * @pending: interrupts to handle
1632 *
1633 */
1634
1635 static int ioc3uart_intr(struct ioc3_submodule *is,
1636 struct ioc3_driver_data *idd,
1637 unsigned int pending)
1638 {
1639 int ret = 0;
1640
1641 /*
1642 * The upper level interrupt handler sends interrupts for both ports
1643 * here. So we need to call for each port with its interrupts.
1644 */
1645
1646 if (pending & SIO_IR_SA)
1647 ret |= ioc3uart_intr_one(is, idd, pending & SIO_IR_SA);
1648 if (pending & SIO_IR_SB)
1649 ret |= ioc3uart_intr_one(is, idd, pending & SIO_IR_SB);
1650
1651 return ret;
1652 }
1653
1654 /**
1655 * ic3_type
1656 * @port: Port to operate with (we ignore since we only have one port)
1657 *
1658 */
1659 static const char *ic3_type(struct uart_port *the_port)
1660 {
1661 if (IS_RS232(the_port->line))
1662 return "SGI IOC3 Serial [rs232]";
1663 else
1664 return "SGI IOC3 Serial [rs422]";
1665 }
1666
1667 /**
1668 * ic3_tx_empty - Is the transmitter empty?
1669 * @port: Port to operate on
1670 *
1671 */
1672 static unsigned int ic3_tx_empty(struct uart_port *the_port)
1673 {
1674 unsigned int ret = 0;
1675 struct ioc3_port *port = get_ioc3_port(the_port);
1676
1677 if (readl(&port->ip_serial_regs->shadow) & SHADOW_TEMT)
1678 ret = TIOCSER_TEMT;
1679 return ret;
1680 }
1681
1682 /**
1683 * ic3_stop_tx - stop the transmitter
1684 * @port: Port to operate on
1685 *
1686 */
1687 static void ic3_stop_tx(struct uart_port *the_port)
1688 {
1689 struct ioc3_port *port = get_ioc3_port(the_port);
1690
1691 if (port)
1692 set_notification(port, N_OUTPUT_LOWAT, 0);
1693 }
1694
1695 /**
1696 * ic3_stop_rx - stop the receiver
1697 * @port: Port to operate on
1698 *
1699 */
1700 static void ic3_stop_rx(struct uart_port *the_port)
1701 {
1702 struct ioc3_port *port = get_ioc3_port(the_port);
1703
1704 if (port)
1705 port->ip_flags &= ~INPUT_ENABLE;
1706 }
1707
1708 /**
1709 * null_void_function
1710 * @port: Port to operate on
1711 *
1712 */
1713 static void null_void_function(struct uart_port *the_port)
1714 {
1715 }
1716
1717 /**
1718 * ic3_shutdown - shut down the port - free irq and disable
1719 * @port: port to shut down
1720 *
1721 */
1722 static void ic3_shutdown(struct uart_port *the_port)
1723 {
1724 unsigned long port_flags;
1725 struct ioc3_port *port;
1726 struct uart_state *state;
1727
1728 port = get_ioc3_port(the_port);
1729 if (!port)
1730 return;
1731
1732 state = the_port->state;
1733 wake_up_interruptible(&state->port.delta_msr_wait);
1734
1735 spin_lock_irqsave(&the_port->lock, port_flags);
1736 set_notification(port, N_ALL, 0);
1737 spin_unlock_irqrestore(&the_port->lock, port_flags);
1738 }
1739
1740 /**
1741 * ic3_set_mctrl - set control lines (dtr, rts, etc)
1742 * @port: Port to operate on
1743 * @mctrl: Lines to set/unset
1744 *
1745 */
1746 static void ic3_set_mctrl(struct uart_port *the_port, unsigned int mctrl)
1747 {
1748 unsigned char mcr = 0;
1749
1750 if (mctrl & TIOCM_RTS)
1751 mcr |= UART_MCR_RTS;
1752 if (mctrl & TIOCM_DTR)
1753 mcr |= UART_MCR_DTR;
1754 if (mctrl & TIOCM_OUT1)
1755 mcr |= UART_MCR_OUT1;
1756 if (mctrl & TIOCM_OUT2)
1757 mcr |= UART_MCR_OUT2;
1758 if (mctrl & TIOCM_LOOP)
1759 mcr |= UART_MCR_LOOP;
1760
1761 set_mcr(the_port, mcr, SHADOW_DTR);
1762 }
1763
1764 /**
1765 * ic3_get_mctrl - get control line info
1766 * @port: port to operate on
1767 *
1768 */
1769 static unsigned int ic3_get_mctrl(struct uart_port *the_port)
1770 {
1771 struct ioc3_port *port = get_ioc3_port(the_port);
1772 uint32_t shadow;
1773 unsigned int ret = 0;
1774
1775 if (!port)
1776 return 0;
1777
1778 shadow = readl(&port->ip_serial_regs->shadow);
1779 if (shadow & SHADOW_DCD)
1780 ret |= TIOCM_CD;
1781 if (shadow & SHADOW_DR)
1782 ret |= TIOCM_DSR;
1783 if (shadow & SHADOW_CTS)
1784 ret |= TIOCM_CTS;
1785 return ret;
1786 }
1787
1788 /**
1789 * ic3_start_tx - Start transmitter. Called with the_port->lock
1790 * @port: Port to operate on
1791 *
1792 */
1793 static void ic3_start_tx(struct uart_port *the_port)
1794 {
1795 struct ioc3_port *port = get_ioc3_port(the_port);
1796
1797 if (port) {
1798 set_notification(port, N_OUTPUT_LOWAT, 1);
1799 enable_intrs(port, port->ip_hooks->intr_tx_mt);
1800 }
1801 }
1802
1803 /**
1804 * ic3_break_ctl - handle breaks
1805 * @port: Port to operate on
1806 * @break_state: Break state
1807 *
1808 */
1809 static void ic3_break_ctl(struct uart_port *the_port, int break_state)
1810 {
1811 }
1812
1813 /**
1814 * ic3_startup - Start up the serial port - always return 0 (We're always on)
1815 * @port: Port to operate on
1816 *
1817 */
1818 static int ic3_startup(struct uart_port *the_port)
1819 {
1820 int retval;
1821 struct ioc3_port *port;
1822 struct ioc3_card *card_ptr;
1823 unsigned long port_flags;
1824
1825 if (!the_port) {
1826 NOT_PROGRESS();
1827 return -ENODEV;
1828 }
1829 port = get_ioc3_port(the_port);
1830 if (!port) {
1831 NOT_PROGRESS();
1832 return -ENODEV;
1833 }
1834 card_ptr = port->ip_card;
1835 port->ip_port = the_port;
1836
1837 if (!card_ptr) {
1838 NOT_PROGRESS();
1839 return -ENODEV;
1840 }
1841
1842 /* Start up the serial port */
1843 spin_lock_irqsave(&the_port->lock, port_flags);
1844 retval = ic3_startup_local(the_port);
1845 spin_unlock_irqrestore(&the_port->lock, port_flags);
1846 return retval;
1847 }
1848
1849 /**
1850 * ic3_set_termios - set termios stuff
1851 * @port: port to operate on
1852 * @termios: New settings
1853 * @termios: Old
1854 *
1855 */
1856 static void
1857 ic3_set_termios(struct uart_port *the_port,
1858 struct ktermios *termios, struct ktermios *old_termios)
1859 {
1860 unsigned long port_flags;
1861
1862 spin_lock_irqsave(&the_port->lock, port_flags);
1863 ioc3_change_speed(the_port, termios, old_termios);
1864 spin_unlock_irqrestore(&the_port->lock, port_flags);
1865 }
1866
1867 /**
1868 * ic3_request_port - allocate resources for port - no op....
1869 * @port: port to operate on
1870 *
1871 */
1872 static int ic3_request_port(struct uart_port *port)
1873 {
1874 return 0;
1875 }
1876
1877 /* Associate the uart functions above - given to serial core */
1878 static struct uart_ops ioc3_ops = {
1879 .tx_empty = ic3_tx_empty,
1880 .set_mctrl = ic3_set_mctrl,
1881 .get_mctrl = ic3_get_mctrl,
1882 .stop_tx = ic3_stop_tx,
1883 .start_tx = ic3_start_tx,
1884 .stop_rx = ic3_stop_rx,
1885 .enable_ms = null_void_function,
1886 .break_ctl = ic3_break_ctl,
1887 .startup = ic3_startup,
1888 .shutdown = ic3_shutdown,
1889 .set_termios = ic3_set_termios,
1890 .type = ic3_type,
1891 .release_port = null_void_function,
1892 .request_port = ic3_request_port,
1893 };
1894
1895 /*
1896 * Boot-time initialization code
1897 */
1898
1899 static struct uart_driver ioc3_uart = {
1900 .owner = THIS_MODULE,
1901 .driver_name = "ioc3_serial",
1902 .dev_name = DEVICE_NAME,
1903 .major = DEVICE_MAJOR,
1904 .minor = DEVICE_MINOR,
1905 .nr = MAX_LOGICAL_PORTS
1906 };
1907
1908 /**
1909 * ioc3_serial_core_attach - register with serial core
1910 * This is done during pci probing
1911 * @is: submodule struct for this
1912 * @idd: handle for this card
1913 */
1914 static inline int ioc3_serial_core_attach( struct ioc3_submodule *is,
1915 struct ioc3_driver_data *idd)
1916 {
1917 struct ioc3_port *port;
1918 struct uart_port *the_port;
1919 struct ioc3_card *card_ptr = idd->data[is->id];
1920 int ii, phys_port;
1921 struct pci_dev *pdev = idd->pdev;
1922
1923 DPRINT_CONFIG(("%s: attach pdev 0x%p - card_ptr 0x%p\n",
1924 __func__, pdev, (void *)card_ptr));
1925
1926 if (!card_ptr)
1927 return -ENODEV;
1928
1929 /* once around for each logical port on this card */
1930 for (ii = 0; ii < LOGICAL_PORTS_PER_CARD; ii++) {
1931 phys_port = GET_PHYSICAL_PORT(ii);
1932 the_port = &card_ptr->ic_port[phys_port].
1933 icp_uart_port[GET_LOGICAL_PORT(ii)];
1934 port = card_ptr->ic_port[phys_port].icp_port;
1935 port->ip_port = the_port;
1936
1937 DPRINT_CONFIG(("%s: attach the_port 0x%p / port 0x%p [%d/%d]\n",
1938 __func__, (void *)the_port, (void *)port,
1939 phys_port, ii));
1940
1941 /* membase, iobase and mapbase just need to be non-0 */
1942 the_port->membase = (unsigned char __iomem *)1;
1943 the_port->iobase = (pdev->bus->number << 16) | ii;
1944 the_port->line = (Num_of_ioc3_cards << 2) | ii;
1945 the_port->mapbase = 1;
1946 the_port->type = PORT_16550A;
1947 the_port->fifosize = FIFO_SIZE;
1948 the_port->ops = &ioc3_ops;
1949 the_port->irq = idd->irq_io;
1950 the_port->dev = &pdev->dev;
1951
1952 if (uart_add_one_port(&ioc3_uart, the_port) < 0) {
1953 printk(KERN_WARNING
1954 "%s: unable to add port %d bus %d\n",
1955 __func__, the_port->line, pdev->bus->number);
1956 } else {
1957 DPRINT_CONFIG(("IOC3 serial port %d irq %d bus %d\n",
1958 the_port->line, the_port->irq, pdev->bus->number));
1959 }
1960
1961 /* all ports are rs232 for now */
1962 if (IS_PHYSICAL_PORT(ii))
1963 ioc3_set_proto(port, PROTO_RS232);
1964 }
1965 return 0;
1966 }
1967
1968 /**
1969 * ioc3uart_remove - register detach function
1970 * @is: submodule struct for this submodule
1971 * @idd: ioc3 driver data for this submodule
1972 */
1973
1974 static int ioc3uart_remove(struct ioc3_submodule *is,
1975 struct ioc3_driver_data *idd)
1976 {
1977 struct ioc3_card *card_ptr = idd->data[is->id];
1978 struct uart_port *the_port;
1979 struct ioc3_port *port;
1980 int ii;
1981
1982 if (card_ptr) {
1983 for (ii = 0; ii < LOGICAL_PORTS_PER_CARD; ii++) {
1984 the_port = &card_ptr->ic_port[GET_PHYSICAL_PORT(ii)].
1985 icp_uart_port[GET_LOGICAL_PORT(ii)];
1986 if (the_port)
1987 uart_remove_one_port(&ioc3_uart, the_port);
1988 port = card_ptr->ic_port[GET_PHYSICAL_PORT(ii)].icp_port;
1989 if (port && IS_PHYSICAL_PORT(ii)
1990 && (GET_PHYSICAL_PORT(ii) == 0)) {
1991 pci_free_consistent(port->ip_idd->pdev,
1992 TOTAL_RING_BUF_SIZE,
1993 (void *)port->ip_cpu_ringbuf,
1994 port->ip_dma_ringbuf);
1995 kfree(port);
1996 card_ptr->ic_port[GET_PHYSICAL_PORT(ii)].
1997 icp_port = NULL;
1998 }
1999 }
2000 kfree(card_ptr);
2001 idd->data[is->id] = NULL;
2002 }
2003 return 0;
2004 }
2005
2006 /**
2007 * ioc3uart_probe - card probe function called from shim driver
2008 * @is: submodule struct for this submodule
2009 * @idd: ioc3 driver data for this card
2010 */
2011
2012 static int __devinit
2013 ioc3uart_probe(struct ioc3_submodule *is, struct ioc3_driver_data *idd)
2014 {
2015 struct pci_dev *pdev = idd->pdev;
2016 struct ioc3_card *card_ptr;
2017 int ret = 0;
2018 struct ioc3_port *port;
2019 struct ioc3_port *ports[PORTS_PER_CARD];
2020 int phys_port;
2021 int cnt;
2022
2023 DPRINT_CONFIG(("%s (0x%p, 0x%p)\n", __func__, is, idd));
2024
2025 card_ptr = kzalloc(sizeof(struct ioc3_card), GFP_KERNEL);
2026 if (!card_ptr) {
2027 printk(KERN_WARNING "ioc3_attach_one"
2028 ": unable to get memory for the IOC3\n");
2029 return -ENOMEM;
2030 }
2031 idd->data[is->id] = card_ptr;
2032 Submodule_slot = is->id;
2033
2034 writel(((UARTA_BASE >> 3) << SIO_CR_SER_A_BASE_SHIFT) |
2035 ((UARTB_BASE >> 3) << SIO_CR_SER_B_BASE_SHIFT) |
2036 (0xf << SIO_CR_CMD_PULSE_SHIFT), &idd->vma->sio_cr);
2037
2038 pci_write_config_dword(pdev, PCI_LAT, 0xff00);
2039
2040 /* Enable serial port mode select generic PIO pins as outputs */
2041 ioc3_gpcr_set(idd, GPCR_UARTA_MODESEL | GPCR_UARTB_MODESEL);
2042
2043 /* Create port structures for each port */
2044 for (phys_port = 0; phys_port < PORTS_PER_CARD; phys_port++) {
2045 port = kzalloc(sizeof(struct ioc3_port), GFP_KERNEL);
2046 if (!port) {
2047 printk(KERN_WARNING
2048 "IOC3 serial memory not available for port\n");
2049 ret = -ENOMEM;
2050 goto out4;
2051 }
2052 spin_lock_init(&port->ip_lock);
2053
2054 /* we need to remember the previous ones, to point back to
2055 * them farther down - setting up the ring buffers.
2056 */
2057 ports[phys_port] = port;
2058
2059 /* init to something useful */
2060 card_ptr->ic_port[phys_port].icp_port = port;
2061 port->ip_is = is;
2062 port->ip_idd = idd;
2063 port->ip_baud = 9600;
2064 port->ip_card = card_ptr;
2065 port->ip_hooks = &hooks_array[phys_port];
2066
2067 /* Setup each port */
2068 if (phys_port == 0) {
2069 port->ip_serial_regs = &idd->vma->port_a;
2070 port->ip_uart_regs = &idd->vma->sregs.uarta;
2071
2072 DPRINT_CONFIG(("%s : Port A ip_serial_regs 0x%p "
2073 "ip_uart_regs 0x%p\n",
2074 __func__,
2075 (void *)port->ip_serial_regs,
2076 (void *)port->ip_uart_regs));
2077
2078 /* setup ring buffers */
2079 port->ip_cpu_ringbuf = pci_alloc_consistent(pdev,
2080 TOTAL_RING_BUF_SIZE, &port->ip_dma_ringbuf);
2081
2082 BUG_ON(!((((int64_t) port->ip_dma_ringbuf) &
2083 (TOTAL_RING_BUF_SIZE - 1)) == 0));
2084 port->ip_inring = RING(port, RX_A);
2085 port->ip_outring = RING(port, TX_A);
2086 DPRINT_CONFIG(("%s : Port A ip_cpu_ringbuf 0x%p "
2087 "ip_dma_ringbuf 0x%p, ip_inring 0x%p "
2088 "ip_outring 0x%p\n",
2089 __func__,
2090 (void *)port->ip_cpu_ringbuf,
2091 (void *)port->ip_dma_ringbuf,
2092 (void *)port->ip_inring,
2093 (void *)port->ip_outring));
2094 }
2095 else {
2096 port->ip_serial_regs = &idd->vma->port_b;
2097 port->ip_uart_regs = &idd->vma->sregs.uartb;
2098
2099 DPRINT_CONFIG(("%s : Port B ip_serial_regs 0x%p "
2100 "ip_uart_regs 0x%p\n",
2101 __func__,
2102 (void *)port->ip_serial_regs,
2103 (void *)port->ip_uart_regs));
2104
2105 /* share the ring buffers */
2106 port->ip_dma_ringbuf =
2107 ports[phys_port - 1]->ip_dma_ringbuf;
2108 port->ip_cpu_ringbuf =
2109 ports[phys_port - 1]->ip_cpu_ringbuf;
2110 port->ip_inring = RING(port, RX_B);
2111 port->ip_outring = RING(port, TX_B);
2112 DPRINT_CONFIG(("%s : Port B ip_cpu_ringbuf 0x%p "
2113 "ip_dma_ringbuf 0x%p, ip_inring 0x%p "
2114 "ip_outring 0x%p\n",
2115 __func__,
2116 (void *)port->ip_cpu_ringbuf,
2117 (void *)port->ip_dma_ringbuf,
2118 (void *)port->ip_inring,
2119 (void *)port->ip_outring));
2120 }
2121
2122 DPRINT_CONFIG(("%s : port %d [addr 0x%p] card_ptr 0x%p",
2123 __func__,
2124 phys_port, (void *)port, (void *)card_ptr));
2125 DPRINT_CONFIG((" ip_serial_regs 0x%p ip_uart_regs 0x%p\n",
2126 (void *)port->ip_serial_regs,
2127 (void *)port->ip_uart_regs));
2128
2129 /* Initialize the hardware for IOC3 */
2130 port_init(port);
2131
2132 DPRINT_CONFIG(("%s: phys_port %d port 0x%p inring 0x%p "
2133 "outring 0x%p\n",
2134 __func__,
2135 phys_port, (void *)port,
2136 (void *)port->ip_inring,
2137 (void *)port->ip_outring));
2138
2139 }
2140
2141 /* register port with the serial core */
2142
2143 if ((ret = ioc3_serial_core_attach(is, idd)))
2144 goto out4;
2145
2146 Num_of_ioc3_cards++;
2147
2148 return ret;
2149
2150 /* error exits that give back resources */
2151 out4:
2152 for (cnt = 0; cnt < phys_port; cnt++)
2153 kfree(ports[cnt]);
2154
2155 kfree(card_ptr);
2156 return ret;
2157 }
2158
2159 static struct ioc3_submodule ioc3uart_ops = {
2160 .name = "IOC3uart",
2161 .probe = ioc3uart_probe,
2162 .remove = ioc3uart_remove,
2163 /* call .intr for both ports initially */
2164 .irq_mask = SIO_IR_SA | SIO_IR_SB,
2165 .intr = ioc3uart_intr,
2166 .owner = THIS_MODULE,
2167 };
2168
2169 /**
2170 * ioc3_detect - module init called,
2171 */
2172 static int __init ioc3uart_init(void)
2173 {
2174 int ret;
2175
2176 /* register with serial core */
2177 if ((ret = uart_register_driver(&ioc3_uart)) < 0) {
2178 printk(KERN_WARNING
2179 "%s: Couldn't register IOC3 uart serial driver\n",
2180 __func__);
2181 return ret;
2182 }
2183 ret = ioc3_register_submodule(&ioc3uart_ops);
2184 if (ret)
2185 uart_unregister_driver(&ioc3_uart);
2186 return ret;
2187 }
2188
2189 static void __exit ioc3uart_exit(void)
2190 {
2191 ioc3_unregister_submodule(&ioc3uart_ops);
2192 uart_unregister_driver(&ioc3_uart);
2193 }
2194
2195 module_init(ioc3uart_init);
2196 module_exit(ioc3uart_exit);
2197
2198 MODULE_AUTHOR("Pat Gefre - Silicon Graphics Inc. (SGI) <pfg@sgi.com>");
2199 MODULE_DESCRIPTION("Serial PCI driver module for SGI IOC3 card");
2200 MODULE_LICENSE("GPL");
This page took 0.078332 seconds and 5 git commands to generate.