Merge git://git.kernel.org/pub/scm/linux/kernel/git/davem/sparc-2.6
[linux-2.6] / drivers / serial / pnx8xxx_uart.c
1 /*
2  * UART driver for PNX8XXX SoCs
3  *
4  * Author: Per Hallsmark per.hallsmark@mvista.com
5  * Ported to 2.6 kernel by EmbeddedAlley
6  * Reworked by Vitaly Wool <vitalywool@gmail.com>
7  *
8  * Based on drivers/char/serial.c, by Linus Torvalds, Theodore Ts'o.
9  * Copyright (C) 2000 Deep Blue Solutions Ltd.
10  *
11  * This file is licensed under the terms of the GNU General Public License
12  * version 2. This program is licensed "as is" without any warranty of
13  * any kind, whether express or implied.
14  *
15  */
16
17 #if defined(CONFIG_SERIAL_PNX8XXX_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
18 #define SUPPORT_SYSRQ
19 #endif
20
21 #include <linux/module.h>
22 #include <linux/ioport.h>
23 #include <linux/init.h>
24 #include <linux/console.h>
25 #include <linux/sysrq.h>
26 #include <linux/device.h>
27 #include <linux/platform_device.h>
28 #include <linux/tty.h>
29 #include <linux/tty_flip.h>
30 #include <linux/serial_core.h>
31 #include <linux/serial.h>
32 #include <linux/serial_pnx8xxx.h>
33
34 #include <asm/io.h>
35 #include <asm/irq.h>
36
37 /* We'll be using StrongARM sa1100 serial port major/minor */
38 #define SERIAL_PNX8XXX_MAJOR    204
39 #define MINOR_START             5
40
41 #define NR_PORTS                2
42
43 #define PNX8XXX_ISR_PASS_LIMIT  256
44
45 /*
46  * Convert from ignore_status_mask or read_status_mask to FIFO
47  * and interrupt status bits
48  */
49 #define SM_TO_FIFO(x)   ((x) >> 10)
50 #define SM_TO_ISTAT(x)  ((x) & 0x000001ff)
51 #define FIFO_TO_SM(x)   ((x) << 10)
52 #define ISTAT_TO_SM(x)  ((x) & 0x000001ff)
53
54 /*
55  * This is the size of our serial port register set.
56  */
57 #define UART_PORT_SIZE  0x1000
58
59 /*
60  * This determines how often we check the modem status signals
61  * for any change.  They generally aren't connected to an IRQ
62  * so we have to poll them.  We also check immediately before
63  * filling the TX fifo incase CTS has been dropped.
64  */
65 #define MCTRL_TIMEOUT   (250*HZ/1000)
66
67 extern struct pnx8xxx_port pnx8xxx_ports[];
68
69 static inline int serial_in(struct pnx8xxx_port *sport, int offset)
70 {
71         return (__raw_readl(sport->port.membase + offset));
72 }
73
74 static inline void serial_out(struct pnx8xxx_port *sport, int offset, int value)
75 {
76         __raw_writel(value, sport->port.membase + offset);
77 }
78
79 /*
80  * Handle any change of modem status signal since we were last called.
81  */
82 static void pnx8xxx_mctrl_check(struct pnx8xxx_port *sport)
83 {
84         unsigned int status, changed;
85
86         status = sport->port.ops->get_mctrl(&sport->port);
87         changed = status ^ sport->old_status;
88
89         if (changed == 0)
90                 return;
91
92         sport->old_status = status;
93
94         if (changed & TIOCM_RI)
95                 sport->port.icount.rng++;
96         if (changed & TIOCM_DSR)
97                 sport->port.icount.dsr++;
98         if (changed & TIOCM_CAR)
99                 uart_handle_dcd_change(&sport->port, status & TIOCM_CAR);
100         if (changed & TIOCM_CTS)
101                 uart_handle_cts_change(&sport->port, status & TIOCM_CTS);
102
103         wake_up_interruptible(&sport->port.info->delta_msr_wait);
104 }
105
106 /*
107  * This is our per-port timeout handler, for checking the
108  * modem status signals.
109  */
110 static void pnx8xxx_timeout(unsigned long data)
111 {
112         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)data;
113         unsigned long flags;
114
115         if (sport->port.info) {
116                 spin_lock_irqsave(&sport->port.lock, flags);
117                 pnx8xxx_mctrl_check(sport);
118                 spin_unlock_irqrestore(&sport->port.lock, flags);
119
120                 mod_timer(&sport->timer, jiffies + MCTRL_TIMEOUT);
121         }
122 }
123
124 /*
125  * interrupts disabled on entry
126  */
127 static void pnx8xxx_stop_tx(struct uart_port *port)
128 {
129         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
130         u32 ien;
131
132         /* Disable TX intr */
133         ien = serial_in(sport, PNX8XXX_IEN);
134         serial_out(sport, PNX8XXX_IEN, ien & ~PNX8XXX_UART_INT_ALLTX);
135
136         /* Clear all pending TX intr */
137         serial_out(sport, PNX8XXX_ICLR, PNX8XXX_UART_INT_ALLTX);
138 }
139
140 /*
141  * interrupts may not be disabled on entry
142  */
143 static void pnx8xxx_start_tx(struct uart_port *port)
144 {
145         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
146         u32 ien;
147
148         /* Clear all pending TX intr */
149         serial_out(sport, PNX8XXX_ICLR, PNX8XXX_UART_INT_ALLTX);
150
151         /* Enable TX intr */
152         ien = serial_in(sport, PNX8XXX_IEN);
153         serial_out(sport, PNX8XXX_IEN, ien | PNX8XXX_UART_INT_ALLTX);
154 }
155
156 /*
157  * Interrupts enabled
158  */
159 static void pnx8xxx_stop_rx(struct uart_port *port)
160 {
161         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
162         u32 ien;
163
164         /* Disable RX intr */
165         ien = serial_in(sport, PNX8XXX_IEN);
166         serial_out(sport, PNX8XXX_IEN, ien & ~PNX8XXX_UART_INT_ALLRX);
167
168         /* Clear all pending RX intr */
169         serial_out(sport, PNX8XXX_ICLR, PNX8XXX_UART_INT_ALLRX);
170 }
171
172 /*
173  * Set the modem control timer to fire immediately.
174  */
175 static void pnx8xxx_enable_ms(struct uart_port *port)
176 {
177         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
178
179         mod_timer(&sport->timer, jiffies);
180 }
181
182 static void pnx8xxx_rx_chars(struct pnx8xxx_port *sport)
183 {
184         struct tty_struct *tty = sport->port.info->port.tty;
185         unsigned int status, ch, flg;
186
187         status = FIFO_TO_SM(serial_in(sport, PNX8XXX_FIFO)) |
188                  ISTAT_TO_SM(serial_in(sport, PNX8XXX_ISTAT));
189         while (status & FIFO_TO_SM(PNX8XXX_UART_FIFO_RXFIFO)) {
190                 ch = serial_in(sport, PNX8XXX_FIFO) & 0xff;
191
192                 sport->port.icount.rx++;
193
194                 flg = TTY_NORMAL;
195
196                 /*
197                  * note that the error handling code is
198                  * out of the main execution path
199                  */
200                 if (status & (FIFO_TO_SM(PNX8XXX_UART_FIFO_RXFE |
201                                         PNX8XXX_UART_FIFO_RXPAR |
202                                         PNX8XXX_UART_FIFO_RXBRK) |
203                               ISTAT_TO_SM(PNX8XXX_UART_INT_RXOVRN))) {
204                         if (status & FIFO_TO_SM(PNX8XXX_UART_FIFO_RXBRK)) {
205                                 status &= ~(FIFO_TO_SM(PNX8XXX_UART_FIFO_RXFE) |
206                                         FIFO_TO_SM(PNX8XXX_UART_FIFO_RXPAR));
207                                 sport->port.icount.brk++;
208                                 if (uart_handle_break(&sport->port))
209                                         goto ignore_char;
210                         } else if (status & FIFO_TO_SM(PNX8XXX_UART_FIFO_RXPAR))
211                                 sport->port.icount.parity++;
212                         else if (status & FIFO_TO_SM(PNX8XXX_UART_FIFO_RXFE))
213                                 sport->port.icount.frame++;
214                         if (status & ISTAT_TO_SM(PNX8XXX_UART_INT_RXOVRN))
215                                 sport->port.icount.overrun++;
216
217                         status &= sport->port.read_status_mask;
218
219                         if (status & FIFO_TO_SM(PNX8XXX_UART_FIFO_RXPAR))
220                                 flg = TTY_PARITY;
221                         else if (status & FIFO_TO_SM(PNX8XXX_UART_FIFO_RXFE))
222                                 flg = TTY_FRAME;
223
224 #ifdef SUPPORT_SYSRQ
225                         sport->port.sysrq = 0;
226 #endif
227                 }
228
229                 if (uart_handle_sysrq_char(&sport->port, ch))
230                         goto ignore_char;
231
232                 uart_insert_char(&sport->port, status,
233                                 ISTAT_TO_SM(PNX8XXX_UART_INT_RXOVRN), ch, flg);
234
235         ignore_char:
236                 serial_out(sport, PNX8XXX_LCR, serial_in(sport, PNX8XXX_LCR) |
237                                 PNX8XXX_UART_LCR_RX_NEXT);
238                 status = FIFO_TO_SM(serial_in(sport, PNX8XXX_FIFO)) |
239                          ISTAT_TO_SM(serial_in(sport, PNX8XXX_ISTAT));
240         }
241         tty_flip_buffer_push(tty);
242 }
243
244 static void pnx8xxx_tx_chars(struct pnx8xxx_port *sport)
245 {
246         struct circ_buf *xmit = &sport->port.info->xmit;
247
248         if (sport->port.x_char) {
249                 serial_out(sport, PNX8XXX_FIFO, sport->port.x_char);
250                 sport->port.icount.tx++;
251                 sport->port.x_char = 0;
252                 return;
253         }
254
255         /*
256          * Check the modem control lines before
257          * transmitting anything.
258          */
259         pnx8xxx_mctrl_check(sport);
260
261         if (uart_circ_empty(xmit) || uart_tx_stopped(&sport->port)) {
262                 pnx8xxx_stop_tx(&sport->port);
263                 return;
264         }
265
266         /*
267          * TX while bytes available
268          */
269         while (((serial_in(sport, PNX8XXX_FIFO) &
270                                         PNX8XXX_UART_FIFO_TXFIFO) >> 16) < 16) {
271                 serial_out(sport, PNX8XXX_FIFO, xmit->buf[xmit->tail]);
272                 xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
273                 sport->port.icount.tx++;
274                 if (uart_circ_empty(xmit))
275                         break;
276         }
277
278         if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
279                 uart_write_wakeup(&sport->port);
280
281         if (uart_circ_empty(xmit))
282                 pnx8xxx_stop_tx(&sport->port);
283 }
284
285 static irqreturn_t pnx8xxx_int(int irq, void *dev_id)
286 {
287         struct pnx8xxx_port *sport = dev_id;
288         unsigned int status;
289
290         spin_lock(&sport->port.lock);
291         /* Get the interrupts */
292         status  = serial_in(sport, PNX8XXX_ISTAT) & serial_in(sport, PNX8XXX_IEN);
293
294         /* Byte or break signal received */
295         if (status & (PNX8XXX_UART_INT_RX | PNX8XXX_UART_INT_BREAK))
296                 pnx8xxx_rx_chars(sport);
297
298         /* TX holding register empty - transmit a byte */
299         if (status & PNX8XXX_UART_INT_TX)
300                 pnx8xxx_tx_chars(sport);
301
302         /* Clear the ISTAT register */
303         serial_out(sport, PNX8XXX_ICLR, status);
304
305         spin_unlock(&sport->port.lock);
306         return IRQ_HANDLED;
307 }
308
309 /*
310  * Return TIOCSER_TEMT when transmitter is not busy.
311  */
312 static unsigned int pnx8xxx_tx_empty(struct uart_port *port)
313 {
314         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
315
316         return serial_in(sport, PNX8XXX_FIFO) & PNX8XXX_UART_FIFO_TXFIFO_STA ? 0 : TIOCSER_TEMT;
317 }
318
319 static unsigned int pnx8xxx_get_mctrl(struct uart_port *port)
320 {
321         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
322         unsigned int mctrl = TIOCM_DSR;
323         unsigned int msr;
324
325         /* REVISIT */
326
327         msr = serial_in(sport, PNX8XXX_MCR);
328
329         mctrl |= msr & PNX8XXX_UART_MCR_CTS ? TIOCM_CTS : 0;
330         mctrl |= msr & PNX8XXX_UART_MCR_DCD ? TIOCM_CAR : 0;
331
332         return mctrl;
333 }
334
335 static void pnx8xxx_set_mctrl(struct uart_port *port, unsigned int mctrl)
336 {
337 #if     0       /* FIXME */
338         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
339         unsigned int msr;
340 #endif
341 }
342
343 /*
344  * Interrupts always disabled.
345  */
346 static void pnx8xxx_break_ctl(struct uart_port *port, int break_state)
347 {
348         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
349         unsigned long flags;
350         unsigned int lcr;
351
352         spin_lock_irqsave(&sport->port.lock, flags);
353         lcr = serial_in(sport, PNX8XXX_LCR);
354         if (break_state == -1)
355                 lcr |= PNX8XXX_UART_LCR_TXBREAK;
356         else
357                 lcr &= ~PNX8XXX_UART_LCR_TXBREAK;
358         serial_out(sport, PNX8XXX_LCR, lcr);
359         spin_unlock_irqrestore(&sport->port.lock, flags);
360 }
361
362 static int pnx8xxx_startup(struct uart_port *port)
363 {
364         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
365         int retval;
366
367         /*
368          * Allocate the IRQ
369          */
370         retval = request_irq(sport->port.irq, pnx8xxx_int, 0,
371                              "pnx8xxx-uart", sport);
372         if (retval)
373                 return retval;
374
375         /*
376          * Finally, clear and enable interrupts
377          */
378
379         serial_out(sport, PNX8XXX_ICLR, PNX8XXX_UART_INT_ALLRX |
380                              PNX8XXX_UART_INT_ALLTX);
381
382         serial_out(sport, PNX8XXX_IEN, serial_in(sport, PNX8XXX_IEN) |
383                             PNX8XXX_UART_INT_ALLRX |
384                             PNX8XXX_UART_INT_ALLTX);
385
386         /*
387          * Enable modem status interrupts
388          */
389         spin_lock_irq(&sport->port.lock);
390         pnx8xxx_enable_ms(&sport->port);
391         spin_unlock_irq(&sport->port.lock);
392
393         return 0;
394 }
395
396 static void pnx8xxx_shutdown(struct uart_port *port)
397 {
398         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
399         int lcr;
400
401         /*
402          * Stop our timer.
403          */
404         del_timer_sync(&sport->timer);
405
406         /*
407          * Disable all interrupts
408          */
409         serial_out(sport, PNX8XXX_IEN, 0);
410
411         /*
412          * Reset the Tx and Rx FIFOS, disable the break condition
413          */
414         lcr = serial_in(sport, PNX8XXX_LCR);
415         lcr &= ~PNX8XXX_UART_LCR_TXBREAK;
416         lcr |= PNX8XXX_UART_LCR_TX_RST | PNX8XXX_UART_LCR_RX_RST;
417         serial_out(sport, PNX8XXX_LCR, lcr);
418
419         /*
420          * Clear all interrupts
421          */
422         serial_out(sport, PNX8XXX_ICLR, PNX8XXX_UART_INT_ALLRX |
423                              PNX8XXX_UART_INT_ALLTX);
424
425         /*
426          * Free the interrupt
427          */
428         free_irq(sport->port.irq, sport);
429 }
430
431 static void
432 pnx8xxx_set_termios(struct uart_port *port, struct ktermios *termios,
433                    struct ktermios *old)
434 {
435         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
436         unsigned long flags;
437         unsigned int lcr_fcr, old_ien, baud, quot;
438         unsigned int old_csize = old ? old->c_cflag & CSIZE : CS8;
439
440         /*
441          * We only support CS7 and CS8.
442          */
443         while ((termios->c_cflag & CSIZE) != CS7 &&
444                (termios->c_cflag & CSIZE) != CS8) {
445                 termios->c_cflag &= ~CSIZE;
446                 termios->c_cflag |= old_csize;
447                 old_csize = CS8;
448         }
449
450         if ((termios->c_cflag & CSIZE) == CS8)
451                 lcr_fcr = PNX8XXX_UART_LCR_8BIT;
452         else
453                 lcr_fcr = 0;
454
455         if (termios->c_cflag & CSTOPB)
456                 lcr_fcr |= PNX8XXX_UART_LCR_2STOPB;
457         if (termios->c_cflag & PARENB) {
458                 lcr_fcr |= PNX8XXX_UART_LCR_PAREN;
459                 if (!(termios->c_cflag & PARODD))
460                         lcr_fcr |= PNX8XXX_UART_LCR_PAREVN;
461         }
462
463         /*
464          * Ask the core to calculate the divisor for us.
465          */
466         baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/16);
467         quot = uart_get_divisor(port, baud);
468
469         spin_lock_irqsave(&sport->port.lock, flags);
470
471         sport->port.read_status_mask = ISTAT_TO_SM(PNX8XXX_UART_INT_RXOVRN) |
472                                 ISTAT_TO_SM(PNX8XXX_UART_INT_EMPTY) |
473                                 ISTAT_TO_SM(PNX8XXX_UART_INT_RX);
474         if (termios->c_iflag & INPCK)
475                 sport->port.read_status_mask |=
476                         FIFO_TO_SM(PNX8XXX_UART_FIFO_RXFE) |
477                         FIFO_TO_SM(PNX8XXX_UART_FIFO_RXPAR);
478         if (termios->c_iflag & (BRKINT | PARMRK))
479                 sport->port.read_status_mask |=
480                         ISTAT_TO_SM(PNX8XXX_UART_INT_BREAK);
481
482         /*
483          * Characters to ignore
484          */
485         sport->port.ignore_status_mask = 0;
486         if (termios->c_iflag & IGNPAR)
487                 sport->port.ignore_status_mask |=
488                         FIFO_TO_SM(PNX8XXX_UART_FIFO_RXFE) |
489                         FIFO_TO_SM(PNX8XXX_UART_FIFO_RXPAR);
490         if (termios->c_iflag & IGNBRK) {
491                 sport->port.ignore_status_mask |=
492                         ISTAT_TO_SM(PNX8XXX_UART_INT_BREAK);
493                 /*
494                  * If we're ignoring parity and break indicators,
495                  * ignore overruns too (for real raw support).
496                  */
497                 if (termios->c_iflag & IGNPAR)
498                         sport->port.ignore_status_mask |=
499                                 ISTAT_TO_SM(PNX8XXX_UART_INT_RXOVRN);
500         }
501
502         /*
503          * ignore all characters if CREAD is not set
504          */
505         if ((termios->c_cflag & CREAD) == 0)
506                 sport->port.ignore_status_mask |=
507                         ISTAT_TO_SM(PNX8XXX_UART_INT_RX);
508
509         del_timer_sync(&sport->timer);
510
511         /*
512          * Update the per-port timeout.
513          */
514         uart_update_timeout(port, termios->c_cflag, baud);
515
516         /*
517          * disable interrupts and drain transmitter
518          */
519         old_ien = serial_in(sport, PNX8XXX_IEN);
520         serial_out(sport, PNX8XXX_IEN, old_ien & ~(PNX8XXX_UART_INT_ALLTX |
521                                         PNX8XXX_UART_INT_ALLRX));
522
523         while (serial_in(sport, PNX8XXX_FIFO) & PNX8XXX_UART_FIFO_TXFIFO_STA)
524                 barrier();
525
526         /* then, disable everything */
527         serial_out(sport, PNX8XXX_IEN, 0);
528
529         /* Reset the Rx and Tx FIFOs too */
530         lcr_fcr |= PNX8XXX_UART_LCR_TX_RST;
531         lcr_fcr |= PNX8XXX_UART_LCR_RX_RST;
532
533         /* set the parity, stop bits and data size */
534         serial_out(sport, PNX8XXX_LCR, lcr_fcr);
535
536         /* set the baud rate */
537         quot -= 1;
538         serial_out(sport, PNX8XXX_BAUD, quot);
539
540         serial_out(sport, PNX8XXX_ICLR, -1);
541
542         serial_out(sport, PNX8XXX_IEN, old_ien);
543
544         if (UART_ENABLE_MS(&sport->port, termios->c_cflag))
545                 pnx8xxx_enable_ms(&sport->port);
546
547         spin_unlock_irqrestore(&sport->port.lock, flags);
548 }
549
550 static const char *pnx8xxx_type(struct uart_port *port)
551 {
552         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
553
554         return sport->port.type == PORT_PNX8XXX ? "PNX8XXX" : NULL;
555 }
556
557 /*
558  * Release the memory region(s) being used by 'port'.
559  */
560 static void pnx8xxx_release_port(struct uart_port *port)
561 {
562         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
563
564         release_mem_region(sport->port.mapbase, UART_PORT_SIZE);
565 }
566
567 /*
568  * Request the memory region(s) being used by 'port'.
569  */
570 static int pnx8xxx_request_port(struct uart_port *port)
571 {
572         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
573         return request_mem_region(sport->port.mapbase, UART_PORT_SIZE,
574                         "pnx8xxx-uart") != NULL ? 0 : -EBUSY;
575 }
576
577 /*
578  * Configure/autoconfigure the port.
579  */
580 static void pnx8xxx_config_port(struct uart_port *port, int flags)
581 {
582         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
583
584         if (flags & UART_CONFIG_TYPE &&
585             pnx8xxx_request_port(&sport->port) == 0)
586                 sport->port.type = PORT_PNX8XXX;
587 }
588
589 /*
590  * Verify the new serial_struct (for TIOCSSERIAL).
591  * The only change we allow are to the flags and type, and
592  * even then only between PORT_PNX8XXX and PORT_UNKNOWN
593  */
594 static int
595 pnx8xxx_verify_port(struct uart_port *port, struct serial_struct *ser)
596 {
597         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
598         int ret = 0;
599
600         if (ser->type != PORT_UNKNOWN && ser->type != PORT_PNX8XXX)
601                 ret = -EINVAL;
602         if (sport->port.irq != ser->irq)
603                 ret = -EINVAL;
604         if (ser->io_type != SERIAL_IO_MEM)
605                 ret = -EINVAL;
606         if (sport->port.uartclk / 16 != ser->baud_base)
607                 ret = -EINVAL;
608         if ((void *)sport->port.mapbase != ser->iomem_base)
609                 ret = -EINVAL;
610         if (sport->port.iobase != ser->port)
611                 ret = -EINVAL;
612         if (ser->hub6 != 0)
613                 ret = -EINVAL;
614         return ret;
615 }
616
617 static struct uart_ops pnx8xxx_pops = {
618         .tx_empty       = pnx8xxx_tx_empty,
619         .set_mctrl      = pnx8xxx_set_mctrl,
620         .get_mctrl      = pnx8xxx_get_mctrl,
621         .stop_tx        = pnx8xxx_stop_tx,
622         .start_tx       = pnx8xxx_start_tx,
623         .stop_rx        = pnx8xxx_stop_rx,
624         .enable_ms      = pnx8xxx_enable_ms,
625         .break_ctl      = pnx8xxx_break_ctl,
626         .startup        = pnx8xxx_startup,
627         .shutdown       = pnx8xxx_shutdown,
628         .set_termios    = pnx8xxx_set_termios,
629         .type           = pnx8xxx_type,
630         .release_port   = pnx8xxx_release_port,
631         .request_port   = pnx8xxx_request_port,
632         .config_port    = pnx8xxx_config_port,
633         .verify_port    = pnx8xxx_verify_port,
634 };
635
636
637 /*
638  * Setup the PNX8XXX serial ports.
639  *
640  * Note also that we support "console=ttySx" where "x" is either 0 or 1.
641  */
642 static void __init pnx8xxx_init_ports(void)
643 {
644         static int first = 1;
645         int i;
646
647         if (!first)
648                 return;
649         first = 0;
650
651         for (i = 0; i < NR_PORTS; i++) {
652                 init_timer(&pnx8xxx_ports[i].timer);
653                 pnx8xxx_ports[i].timer.function = pnx8xxx_timeout;
654                 pnx8xxx_ports[i].timer.data     = (unsigned long)&pnx8xxx_ports[i];
655                 pnx8xxx_ports[i].port.ops = &pnx8xxx_pops;
656         }
657 }
658
659 #ifdef CONFIG_SERIAL_PNX8XXX_CONSOLE
660
661 static void pnx8xxx_console_putchar(struct uart_port *port, int ch)
662 {
663         struct pnx8xxx_port *sport = (struct pnx8xxx_port *)port;
664         int status;
665
666         do {
667                 /* Wait for UART_TX register to empty */
668                 status = serial_in(sport, PNX8XXX_FIFO);
669         } while (status & PNX8XXX_UART_FIFO_TXFIFO);
670         serial_out(sport, PNX8XXX_FIFO, ch);
671 }
672
673 /*
674  * Interrupts are disabled on entering
675  */static void
676 pnx8xxx_console_write(struct console *co, const char *s, unsigned int count)
677 {
678         struct pnx8xxx_port *sport = &pnx8xxx_ports[co->index];
679         unsigned int old_ien, status;
680
681         /*
682          *      First, save IEN and then disable interrupts
683          */
684         old_ien = serial_in(sport, PNX8XXX_IEN);
685         serial_out(sport, PNX8XXX_IEN, old_ien & ~(PNX8XXX_UART_INT_ALLTX |
686                                         PNX8XXX_UART_INT_ALLRX));
687
688         uart_console_write(&sport->port, s, count, pnx8xxx_console_putchar);
689
690         /*
691          *      Finally, wait for transmitter to become empty
692          *      and restore IEN
693          */
694         do {
695                 /* Wait for UART_TX register to empty */
696                 status = serial_in(sport, PNX8XXX_FIFO);
697         } while (status & PNX8XXX_UART_FIFO_TXFIFO);
698
699         /* Clear TX and EMPTY interrupt */
700         serial_out(sport, PNX8XXX_ICLR, PNX8XXX_UART_INT_TX |
701                              PNX8XXX_UART_INT_EMPTY);
702
703         serial_out(sport, PNX8XXX_IEN, old_ien);
704 }
705
706 static int __init
707 pnx8xxx_console_setup(struct console *co, char *options)
708 {
709         struct pnx8xxx_port *sport;
710         int baud = 38400;
711         int bits = 8;
712         int parity = 'n';
713         int flow = 'n';
714
715         /*
716          * Check whether an invalid uart number has been specified, and
717          * if so, search for the first available port that does have
718          * console support.
719          */
720         if (co->index == -1 || co->index >= NR_PORTS)
721                 co->index = 0;
722         sport = &pnx8xxx_ports[co->index];
723
724         if (options)
725                 uart_parse_options(options, &baud, &parity, &bits, &flow);
726
727         return uart_set_options(&sport->port, co, baud, parity, bits, flow);
728 }
729
730 static struct uart_driver pnx8xxx_reg;
731 static struct console pnx8xxx_console = {
732         .name           = "ttyS",
733         .write          = pnx8xxx_console_write,
734         .device         = uart_console_device,
735         .setup          = pnx8xxx_console_setup,
736         .flags          = CON_PRINTBUFFER,
737         .index          = -1,
738         .data           = &pnx8xxx_reg,
739 };
740
741 static int __init pnx8xxx_rs_console_init(void)
742 {
743         pnx8xxx_init_ports();
744         register_console(&pnx8xxx_console);
745         return 0;
746 }
747 console_initcall(pnx8xxx_rs_console_init);
748
749 #define PNX8XXX_CONSOLE &pnx8xxx_console
750 #else
751 #define PNX8XXX_CONSOLE NULL
752 #endif
753
754 static struct uart_driver pnx8xxx_reg = {
755         .owner                  = THIS_MODULE,
756         .driver_name            = "ttyS",
757         .dev_name               = "ttyS",
758         .major                  = SERIAL_PNX8XXX_MAJOR,
759         .minor                  = MINOR_START,
760         .nr                     = NR_PORTS,
761         .cons                   = PNX8XXX_CONSOLE,
762 };
763
764 static int pnx8xxx_serial_suspend(struct platform_device *pdev, pm_message_t state)
765 {
766         struct pnx8xxx_port *sport = platform_get_drvdata(pdev);
767
768         return uart_suspend_port(&pnx8xxx_reg, &sport->port);
769 }
770
771 static int pnx8xxx_serial_resume(struct platform_device *pdev)
772 {
773         struct pnx8xxx_port *sport = platform_get_drvdata(pdev);
774
775         return uart_resume_port(&pnx8xxx_reg, &sport->port);
776 }
777
778 static int pnx8xxx_serial_probe(struct platform_device *pdev)
779 {
780         struct resource *res = pdev->resource;
781         int i;
782
783         for (i = 0; i < pdev->num_resources; i++, res++) {
784                 if (!(res->flags & IORESOURCE_MEM))
785                         continue;
786
787                 for (i = 0; i < NR_PORTS; i++) {
788                         if (pnx8xxx_ports[i].port.mapbase != res->start)
789                                 continue;
790
791                         pnx8xxx_ports[i].port.dev = &pdev->dev;
792                         uart_add_one_port(&pnx8xxx_reg, &pnx8xxx_ports[i].port);
793                         platform_set_drvdata(pdev, &pnx8xxx_ports[i]);
794                         break;
795                 }
796         }
797
798         return 0;
799 }
800
801 static int pnx8xxx_serial_remove(struct platform_device *pdev)
802 {
803         struct pnx8xxx_port *sport = platform_get_drvdata(pdev);
804
805         platform_set_drvdata(pdev, NULL);
806
807         if (sport)
808                 uart_remove_one_port(&pnx8xxx_reg, &sport->port);
809
810         return 0;
811 }
812
813 static struct platform_driver pnx8xxx_serial_driver = {
814         .driver         = {
815                 .name   = "pnx8xxx-uart",
816                 .owner  = THIS_MODULE,
817         },
818         .probe          = pnx8xxx_serial_probe,
819         .remove         = pnx8xxx_serial_remove,
820         .suspend        = pnx8xxx_serial_suspend,
821         .resume         = pnx8xxx_serial_resume,
822 };
823
824 static int __init pnx8xxx_serial_init(void)
825 {
826         int ret;
827
828         printk(KERN_INFO "Serial: PNX8XXX driver\n");
829
830         pnx8xxx_init_ports();
831
832         ret = uart_register_driver(&pnx8xxx_reg);
833         if (ret == 0) {
834                 ret = platform_driver_register(&pnx8xxx_serial_driver);
835                 if (ret)
836                         uart_unregister_driver(&pnx8xxx_reg);
837         }
838         return ret;
839 }
840
841 static void __exit pnx8xxx_serial_exit(void)
842 {
843         platform_driver_unregister(&pnx8xxx_serial_driver);
844         uart_unregister_driver(&pnx8xxx_reg);
845 }
846
847 module_init(pnx8xxx_serial_init);
848 module_exit(pnx8xxx_serial_exit);
849
850 MODULE_AUTHOR("Embedded Alley Solutions, Inc.");
851 MODULE_DESCRIPTION("PNX8XXX SoCs serial port driver");
852 MODULE_LICENSE("GPL");
853 MODULE_ALIAS_CHARDEV_MAJOR(SERIAL_PNX8XXX_MAJOR);
854 MODULE_ALIAS("platform:pnx8xxx-uart");