2 * linux/drivers/serial/pxa.c
4 * Based on drivers/serial/8250.c by Russell King.
6 * Author: Nicolas Pitre
7 * Created: Feb 20, 2003
8 * Copyright: (C) 2003 Monta Vista Software, Inc.
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; either version 2 of the License, or
13 * (at your option) any later version.
15 * Note 1: This driver is made separate from the already too overloaded
16 * 8250.c because it needs some kirks of its own and that'll make it
17 * easier to add DMA support.
19 * Note 2: I'm too sick of device allocation policies for serial ports.
20 * If someone else wants to request an "official" allocation of major/minor
21 * for this driver please be my guest. And don't forget that new hardware
22 * to come from Intel might have more than 3 or 4 of those UARTs. Let's
23 * hope for a better port registration and dynamic device allocation scheme
24 * with the serial core maintainer satisfaction to appear soon.
27 #include <linux/config.h>
28 #include <linux/module.h>
29 #include <linux/tty.h>
30 #include <linux/ioport.h>
31 #include <linux/init.h>
32 #include <linux/console.h>
33 #include <linux/sysrq.h>
34 #include <linux/serial_reg.h>
35 #include <linux/circ_buf.h>
36 #include <linux/delay.h>
37 #include <linux/interrupt.h>
38 #include <linux/device.h>
41 #include <asm/hardware.h>
43 #include <asm/arch/pxa-regs.h>
45 #if defined(CONFIG_SERIAL_PXA_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
49 #include <linux/serial_core.h>
52 struct uart_pxa_port
{
53 struct uart_port port
;
57 unsigned int lsr_break_flag
;
62 static inline unsigned int serial_in(struct uart_pxa_port
*up
, int offset
)
65 return readl(up
->port
.membase
+ offset
);
68 static inline void serial_out(struct uart_pxa_port
*up
, int offset
, int value
)
71 writel(value
, up
->port
.membase
+ offset
);
74 static void serial_pxa_enable_ms(struct uart_port
*port
)
76 struct uart_pxa_port
*up
= (struct uart_pxa_port
*)port
;
78 up
->ier
|= UART_IER_MSI
;
79 serial_out(up
, UART_IER
, up
->ier
);
82 static void serial_pxa_stop_tx(struct uart_port
*port
, unsigned int tty_stop
)
84 struct uart_pxa_port
*up
= (struct uart_pxa_port
*)port
;
86 if (up
->ier
& UART_IER_THRI
) {
87 up
->ier
&= ~UART_IER_THRI
;
88 serial_out(up
, UART_IER
, up
->ier
);
92 static void serial_pxa_stop_rx(struct uart_port
*port
)
94 struct uart_pxa_port
*up
= (struct uart_pxa_port
*)port
;
96 up
->ier
&= ~UART_IER_RLSI
;
97 up
->port
.read_status_mask
&= ~UART_LSR_DR
;
98 serial_out(up
, UART_IER
, up
->ier
);
102 receive_chars(struct uart_pxa_port
*up
, int *status
, struct pt_regs
*regs
)
104 struct tty_struct
*tty
= up
->port
.info
->tty
;
109 if (unlikely(tty
->flip
.count
>= TTY_FLIPBUF_SIZE
)) {
111 * FIXME: Deadlock can happen here if we're a
112 * low-latency port. We're holding the per-port
113 * spinlock, and we call flush_to_ldisc->
114 * n_tty_receive_buf->n_tty_receive_char->
115 * opost->uart_put_char.
117 tty
->flip
.work
.func((void *)tty
);
118 if (tty
->flip
.count
>= TTY_FLIPBUF_SIZE
)
119 return; // if TTY_DONT_FLIP is set
121 ch
= serial_in(up
, UART_RX
);
122 *tty
->flip
.char_buf_ptr
= ch
;
123 *tty
->flip
.flag_buf_ptr
= TTY_NORMAL
;
124 up
->port
.icount
.rx
++;
126 if (unlikely(*status
& (UART_LSR_BI
| UART_LSR_PE
|
127 UART_LSR_FE
| UART_LSR_OE
))) {
129 * For statistics only
131 if (*status
& UART_LSR_BI
) {
132 *status
&= ~(UART_LSR_FE
| UART_LSR_PE
);
133 up
->port
.icount
.brk
++;
135 * We do the SysRQ and SAK checking
136 * here because otherwise the break
137 * may get masked by ignore_status_mask
138 * or read_status_mask.
140 if (uart_handle_break(&up
->port
))
142 } else if (*status
& UART_LSR_PE
)
143 up
->port
.icount
.parity
++;
144 else if (*status
& UART_LSR_FE
)
145 up
->port
.icount
.frame
++;
146 if (*status
& UART_LSR_OE
)
147 up
->port
.icount
.overrun
++;
150 * Mask off conditions which should be ignored.
152 *status
&= up
->port
.read_status_mask
;
154 #ifdef CONFIG_SERIAL_PXA_CONSOLE
155 if (up
->port
.line
== up
->port
.cons
->index
) {
156 /* Recover the break flag from console xmit */
157 *status
|= up
->lsr_break_flag
;
158 up
->lsr_break_flag
= 0;
161 if (*status
& UART_LSR_BI
) {
162 *tty
->flip
.flag_buf_ptr
= TTY_BREAK
;
163 } else if (*status
& UART_LSR_PE
)
164 *tty
->flip
.flag_buf_ptr
= TTY_PARITY
;
165 else if (*status
& UART_LSR_FE
)
166 *tty
->flip
.flag_buf_ptr
= TTY_FRAME
;
168 if (uart_handle_sysrq_char(&up
->port
, ch
, regs
))
170 if ((*status
& up
->port
.ignore_status_mask
) == 0) {
171 tty
->flip
.flag_buf_ptr
++;
172 tty
->flip
.char_buf_ptr
++;
175 if ((*status
& UART_LSR_OE
) &&
176 tty
->flip
.count
< TTY_FLIPBUF_SIZE
) {
178 * Overrun is special, since it's reported
179 * immediately, and doesn't affect the current
182 *tty
->flip
.flag_buf_ptr
= TTY_OVERRUN
;
183 tty
->flip
.flag_buf_ptr
++;
184 tty
->flip
.char_buf_ptr
++;
188 *status
= serial_in(up
, UART_LSR
);
189 } while ((*status
& UART_LSR_DR
) && (max_count
-- > 0));
190 tty_flip_buffer_push(tty
);
193 static void transmit_chars(struct uart_pxa_port
*up
)
195 struct circ_buf
*xmit
= &up
->port
.info
->xmit
;
198 if (up
->port
.x_char
) {
199 serial_out(up
, UART_TX
, up
->port
.x_char
);
200 up
->port
.icount
.tx
++;
204 if (uart_circ_empty(xmit
) || uart_tx_stopped(&up
->port
)) {
205 serial_pxa_stop_tx(&up
->port
, 0);
209 count
= up
->port
.fifosize
/ 2;
211 serial_out(up
, UART_TX
, xmit
->buf
[xmit
->tail
]);
212 xmit
->tail
= (xmit
->tail
+ 1) & (UART_XMIT_SIZE
- 1);
213 up
->port
.icount
.tx
++;
214 if (uart_circ_empty(xmit
))
216 } while (--count
> 0);
218 if (uart_circ_chars_pending(xmit
) < WAKEUP_CHARS
)
219 uart_write_wakeup(&up
->port
);
222 if (uart_circ_empty(xmit
))
223 serial_pxa_stop_tx(&up
->port
, 0);
226 static void serial_pxa_start_tx(struct uart_port
*port
, unsigned int tty_start
)
228 struct uart_pxa_port
*up
= (struct uart_pxa_port
*)port
;
230 if (!(up
->ier
& UART_IER_THRI
)) {
231 up
->ier
|= UART_IER_THRI
;
232 serial_out(up
, UART_IER
, up
->ier
);
236 static inline void check_modem_status(struct uart_pxa_port
*up
)
240 status
= serial_in(up
, UART_MSR
);
242 if ((status
& UART_MSR_ANY_DELTA
) == 0)
245 if (status
& UART_MSR_TERI
)
246 up
->port
.icount
.rng
++;
247 if (status
& UART_MSR_DDSR
)
248 up
->port
.icount
.dsr
++;
249 if (status
& UART_MSR_DDCD
)
250 uart_handle_dcd_change(&up
->port
, status
& UART_MSR_DCD
);
251 if (status
& UART_MSR_DCTS
)
252 uart_handle_cts_change(&up
->port
, status
& UART_MSR_CTS
);
254 wake_up_interruptible(&up
->port
.info
->delta_msr_wait
);
258 * This handles the interrupt from one port.
260 static inline irqreturn_t
261 serial_pxa_irq(int irq
, void *dev_id
, struct pt_regs
*regs
)
263 struct uart_pxa_port
*up
= (struct uart_pxa_port
*)dev_id
;
264 unsigned int iir
, lsr
;
266 iir
= serial_in(up
, UART_IIR
);
267 if (iir
& UART_IIR_NO_INT
)
269 lsr
= serial_in(up
, UART_LSR
);
270 if (lsr
& UART_LSR_DR
)
271 receive_chars(up
, &lsr
, regs
);
272 check_modem_status(up
);
273 if (lsr
& UART_LSR_THRE
)
278 static unsigned int serial_pxa_tx_empty(struct uart_port
*port
)
280 struct uart_pxa_port
*up
= (struct uart_pxa_port
*)port
;
284 spin_lock_irqsave(&up
->port
.lock
, flags
);
285 ret
= serial_in(up
, UART_LSR
) & UART_LSR_TEMT
? TIOCSER_TEMT
: 0;
286 spin_unlock_irqrestore(&up
->port
.lock
, flags
);
291 static unsigned int serial_pxa_get_mctrl(struct uart_port
*port
)
293 struct uart_pxa_port
*up
= (struct uart_pxa_port
*)port
;
295 unsigned char status
;
298 return TIOCM_CTS
| TIOCM_DSR
| TIOCM_CAR
;
299 spin_lock_irqsave(&up
->port
.lock
, flags
);
300 status
= serial_in(up
, UART_MSR
);
301 spin_unlock_irqrestore(&up
->port
.lock
, flags
);
304 if (status
& UART_MSR_DCD
)
306 if (status
& UART_MSR_RI
)
308 if (status
& UART_MSR_DSR
)
310 if (status
& UART_MSR_CTS
)
315 static void serial_pxa_set_mctrl(struct uart_port
*port
, unsigned int mctrl
)
317 struct uart_pxa_port
*up
= (struct uart_pxa_port
*)port
;
318 unsigned char mcr
= 0;
320 if (mctrl
& TIOCM_RTS
)
322 if (mctrl
& TIOCM_DTR
)
324 if (mctrl
& TIOCM_OUT1
)
325 mcr
|= UART_MCR_OUT1
;
326 if (mctrl
& TIOCM_OUT2
)
327 mcr
|= UART_MCR_OUT2
;
328 if (mctrl
& TIOCM_LOOP
)
329 mcr
|= UART_MCR_LOOP
;
333 serial_out(up
, UART_MCR
, mcr
);
336 static void serial_pxa_break_ctl(struct uart_port
*port
, int break_state
)
338 struct uart_pxa_port
*up
= (struct uart_pxa_port
*)port
;
341 spin_lock_irqsave(&up
->port
.lock
, flags
);
342 if (break_state
== -1)
343 up
->lcr
|= UART_LCR_SBC
;
345 up
->lcr
&= ~UART_LCR_SBC
;
346 serial_out(up
, UART_LCR
, up
->lcr
);
347 spin_unlock_irqrestore(&up
->port
.lock
, flags
);
351 static void serial_pxa_dma_init(struct pxa_uart
*up
)
354 pxa_request_dma(up
->name
, DMA_PRIO_LOW
, pxa_receive_dma
, up
);
358 pxa_request_dma(up
->name
, DMA_PRIO_LOW
, pxa_transmit_dma
, up
);
361 up
->dmadesc
= kmalloc(4 * sizeof(pxa_dma_desc
), GFP_KERNEL
);
367 pxa_free_dma(up
->txdma
);
369 pxa_free_dma(up
->rxdma
);
375 static int serial_pxa_startup(struct uart_port
*port
)
377 struct uart_pxa_port
*up
= (struct uart_pxa_port
*)port
;
386 retval
= request_irq(up
->port
.irq
, serial_pxa_irq
, 0, up
->name
, up
);
391 * Clear the FIFO buffers and disable them.
392 * (they will be reenabled in set_termios())
394 serial_out(up
, UART_FCR
, UART_FCR_ENABLE_FIFO
);
395 serial_out(up
, UART_FCR
, UART_FCR_ENABLE_FIFO
|
396 UART_FCR_CLEAR_RCVR
| UART_FCR_CLEAR_XMIT
);
397 serial_out(up
, UART_FCR
, 0);
400 * Clear the interrupt registers.
402 (void) serial_in(up
, UART_LSR
);
403 (void) serial_in(up
, UART_RX
);
404 (void) serial_in(up
, UART_IIR
);
405 (void) serial_in(up
, UART_MSR
);
408 * Now, initialize the UART
410 serial_out(up
, UART_LCR
, UART_LCR_WLEN8
);
412 spin_lock_irqsave(&up
->port
.lock
, flags
);
413 up
->port
.mctrl
|= TIOCM_OUT2
;
414 serial_pxa_set_mctrl(&up
->port
, up
->port
.mctrl
);
415 spin_unlock_irqrestore(&up
->port
.lock
, flags
);
418 * Finally, enable interrupts. Note: Modem status interrupts
419 * are set via set_termios(), which will be occuring imminently
420 * anyway, so we don't enable them here.
422 up
->ier
= UART_IER_RLSI
| UART_IER_RDI
| UART_IER_RTOIE
| UART_IER_UUE
;
423 serial_out(up
, UART_IER
, up
->ier
);
426 * And clear the interrupt registers again for luck.
428 (void) serial_in(up
, UART_LSR
);
429 (void) serial_in(up
, UART_RX
);
430 (void) serial_in(up
, UART_IIR
);
431 (void) serial_in(up
, UART_MSR
);
436 static void serial_pxa_shutdown(struct uart_port
*port
)
438 struct uart_pxa_port
*up
= (struct uart_pxa_port
*)port
;
441 free_irq(up
->port
.irq
, up
);
444 * Disable interrupts from this port
447 serial_out(up
, UART_IER
, 0);
449 spin_lock_irqsave(&up
->port
.lock
, flags
);
450 up
->port
.mctrl
&= ~TIOCM_OUT2
;
451 serial_pxa_set_mctrl(&up
->port
, up
->port
.mctrl
);
452 spin_unlock_irqrestore(&up
->port
.lock
, flags
);
455 * Disable break condition and FIFOs
457 serial_out(up
, UART_LCR
, serial_in(up
, UART_LCR
) & ~UART_LCR_SBC
);
458 serial_out(up
, UART_FCR
, UART_FCR_ENABLE_FIFO
|
459 UART_FCR_CLEAR_RCVR
|
460 UART_FCR_CLEAR_XMIT
);
461 serial_out(up
, UART_FCR
, 0);
465 serial_pxa_set_termios(struct uart_port
*port
, struct termios
*termios
,
468 struct uart_pxa_port
*up
= (struct uart_pxa_port
*)port
;
469 unsigned char cval
, fcr
= 0;
471 unsigned int baud
, quot
;
473 switch (termios
->c_cflag
& CSIZE
) {
489 if (termios
->c_cflag
& CSTOPB
)
491 if (termios
->c_cflag
& PARENB
)
492 cval
|= UART_LCR_PARITY
;
493 if (!(termios
->c_cflag
& PARODD
))
494 cval
|= UART_LCR_EPAR
;
497 * Ask the core to calculate the divisor for us.
499 baud
= uart_get_baud_rate(port
, termios
, old
, 0, port
->uartclk
/16);
500 quot
= uart_get_divisor(port
, baud
);
502 if ((up
->port
.uartclk
/ quot
) < (2400 * 16))
503 fcr
= UART_FCR_ENABLE_FIFO
| UART_FCR_PXAR1
;
505 fcr
= UART_FCR_ENABLE_FIFO
| UART_FCR_PXAR8
;
508 * Ok, we're now changing the port state. Do it with
509 * interrupts disabled.
511 spin_lock_irqsave(&up
->port
.lock
, flags
);
514 * Ensure the port will be enabled.
515 * This is required especially for serial console.
520 * Update the per-port timeout.
522 uart_update_timeout(port
, termios
->c_cflag
, quot
);
524 up
->port
.read_status_mask
= UART_LSR_OE
| UART_LSR_THRE
| UART_LSR_DR
;
525 if (termios
->c_iflag
& INPCK
)
526 up
->port
.read_status_mask
|= UART_LSR_FE
| UART_LSR_PE
;
527 if (termios
->c_iflag
& (BRKINT
| PARMRK
))
528 up
->port
.read_status_mask
|= UART_LSR_BI
;
531 * Characters to ignore
533 up
->port
.ignore_status_mask
= 0;
534 if (termios
->c_iflag
& IGNPAR
)
535 up
->port
.ignore_status_mask
|= UART_LSR_PE
| UART_LSR_FE
;
536 if (termios
->c_iflag
& IGNBRK
) {
537 up
->port
.ignore_status_mask
|= UART_LSR_BI
;
539 * If we're ignoring parity and break indicators,
540 * ignore overruns too (for real raw support).
542 if (termios
->c_iflag
& IGNPAR
)
543 up
->port
.ignore_status_mask
|= UART_LSR_OE
;
547 * ignore all characters if CREAD is not set
549 if ((termios
->c_cflag
& CREAD
) == 0)
550 up
->port
.ignore_status_mask
|= UART_LSR_DR
;
553 * CTS flow control flag and modem status interrupts
555 up
->ier
&= ~UART_IER_MSI
;
556 if (UART_ENABLE_MS(&up
->port
, termios
->c_cflag
))
557 up
->ier
|= UART_IER_MSI
;
559 serial_out(up
, UART_IER
, up
->ier
);
561 serial_out(up
, UART_LCR
, cval
| UART_LCR_DLAB
);/* set DLAB */
562 serial_out(up
, UART_DLL
, quot
& 0xff); /* LS of divisor */
563 serial_out(up
, UART_DLM
, quot
>> 8); /* MS of divisor */
564 serial_out(up
, UART_LCR
, cval
); /* reset DLAB */
565 up
->lcr
= cval
; /* Save LCR */
566 serial_pxa_set_mctrl(&up
->port
, up
->port
.mctrl
);
567 serial_out(up
, UART_FCR
, fcr
);
568 spin_unlock_irqrestore(&up
->port
.lock
, flags
);
572 serial_pxa_pm(struct uart_port
*port
, unsigned int state
,
573 unsigned int oldstate
)
575 struct uart_pxa_port
*up
= (struct uart_pxa_port
*)port
;
576 pxa_set_cken(up
->cken
, !state
);
581 static void serial_pxa_release_port(struct uart_port
*port
)
585 static int serial_pxa_request_port(struct uart_port
*port
)
590 static void serial_pxa_config_port(struct uart_port
*port
, int flags
)
592 struct uart_pxa_port
*up
= (struct uart_pxa_port
*)port
;
593 up
->port
.type
= PORT_PXA
;
597 serial_pxa_verify_port(struct uart_port
*port
, struct serial_struct
*ser
)
599 /* we don't want the core code to modify any port params */
604 serial_pxa_type(struct uart_port
*port
)
606 struct uart_pxa_port
*up
= (struct uart_pxa_port
*)port
;
610 #ifdef CONFIG_SERIAL_PXA_CONSOLE
612 extern struct uart_pxa_port serial_pxa_ports
[];
613 extern struct uart_driver serial_pxa_reg
;
615 #define BOTH_EMPTY (UART_LSR_TEMT | UART_LSR_THRE)
618 * Wait for transmitter & holding register to empty
620 static inline void wait_for_xmitr(struct uart_pxa_port
*up
)
622 unsigned int status
, tmout
= 10000;
624 /* Wait up to 10ms for the character(s) to be sent. */
626 status
= serial_in(up
, UART_LSR
);
628 if (status
& UART_LSR_BI
)
629 up
->lsr_break_flag
= UART_LSR_BI
;
634 } while ((status
& BOTH_EMPTY
) != BOTH_EMPTY
);
636 /* Wait up to 1s for flow control if necessary */
637 if (up
->port
.flags
& UPF_CONS_FLOW
) {
640 ((serial_in(up
, UART_MSR
) & UART_MSR_CTS
) == 0))
646 * Print a string to the serial port trying not to disturb
647 * any possible real use of the port...
649 * The console_lock must be held when we get here.
652 serial_pxa_console_write(struct console
*co
, const char *s
, unsigned int count
)
654 struct uart_pxa_port
*up
= &serial_pxa_ports
[co
->index
];
659 * First save the UER then disable the interrupts
661 ier
= serial_in(up
, UART_IER
);
662 serial_out(up
, UART_IER
, UART_IER_UUE
);
665 * Now, do each character
667 for (i
= 0; i
< count
; i
++, s
++) {
671 * Send the character out.
672 * If a LF, also do CR...
674 serial_out(up
, UART_TX
, *s
);
677 serial_out(up
, UART_TX
, 13);
682 * Finally, wait for transmitter to become empty
683 * and restore the IER
686 serial_out(up
, UART_IER
, ier
);
690 serial_pxa_console_setup(struct console
*co
, char *options
)
692 struct uart_pxa_port
*up
;
698 if (co
->index
== -1 || co
->index
>= serial_pxa_reg
.nr
)
700 up
= &serial_pxa_ports
[co
->index
];
703 uart_parse_options(options
, &baud
, &parity
, &bits
, &flow
);
705 return uart_set_options(&up
->port
, co
, baud
, parity
, bits
, flow
);
708 static struct console serial_pxa_console
= {
710 .write
= serial_pxa_console_write
,
711 .device
= uart_console_device
,
712 .setup
= serial_pxa_console_setup
,
713 .flags
= CON_PRINTBUFFER
,
715 .data
= &serial_pxa_reg
,
719 serial_pxa_console_init(void)
721 register_console(&serial_pxa_console
);
725 console_initcall(serial_pxa_console_init
);
727 #define PXA_CONSOLE &serial_pxa_console
729 #define PXA_CONSOLE NULL
732 struct uart_ops serial_pxa_pops
= {
733 .tx_empty
= serial_pxa_tx_empty
,
734 .set_mctrl
= serial_pxa_set_mctrl
,
735 .get_mctrl
= serial_pxa_get_mctrl
,
736 .stop_tx
= serial_pxa_stop_tx
,
737 .start_tx
= serial_pxa_start_tx
,
738 .stop_rx
= serial_pxa_stop_rx
,
739 .enable_ms
= serial_pxa_enable_ms
,
740 .break_ctl
= serial_pxa_break_ctl
,
741 .startup
= serial_pxa_startup
,
742 .shutdown
= serial_pxa_shutdown
,
743 .set_termios
= serial_pxa_set_termios
,
745 .type
= serial_pxa_type
,
746 .release_port
= serial_pxa_release_port
,
747 .request_port
= serial_pxa_request_port
,
748 .config_port
= serial_pxa_config_port
,
749 .verify_port
= serial_pxa_verify_port
,
752 static struct uart_pxa_port serial_pxa_ports
[] = {
755 .cken
= CKEN6_FFUART
,
759 .membase
= (void *)&FFUART
,
760 .mapbase
= __PREG(FFUART
),
762 .uartclk
= 921600 * 16,
764 .ops
= &serial_pxa_pops
,
769 .cken
= CKEN7_BTUART
,
773 .membase
= (void *)&BTUART
,
774 .mapbase
= __PREG(BTUART
),
776 .uartclk
= 921600 * 16,
778 .ops
= &serial_pxa_pops
,
783 .cken
= CKEN5_STUART
,
787 .membase
= (void *)&STUART
,
788 .mapbase
= __PREG(STUART
),
790 .uartclk
= 921600 * 16,
792 .ops
= &serial_pxa_pops
,
798 static struct uart_driver serial_pxa_reg
= {
799 .owner
= THIS_MODULE
,
800 .driver_name
= "PXA serial",
801 .devfs_name
= "tts/",
805 .nr
= ARRAY_SIZE(serial_pxa_ports
),
809 static int serial_pxa_suspend(struct device
*_dev
, u32 state
, u32 level
)
811 struct uart_pxa_port
*sport
= dev_get_drvdata(_dev
);
813 if (sport
&& level
== SUSPEND_DISABLE
)
814 uart_suspend_port(&serial_pxa_reg
, &sport
->port
);
819 static int serial_pxa_resume(struct device
*_dev
, u32 level
)
821 struct uart_pxa_port
*sport
= dev_get_drvdata(_dev
);
823 if (sport
&& level
== RESUME_ENABLE
)
824 uart_resume_port(&serial_pxa_reg
, &sport
->port
);
829 static int serial_pxa_probe(struct device
*_dev
)
831 struct platform_device
*dev
= to_platform_device(_dev
);
833 serial_pxa_ports
[dev
->id
].port
.dev
= _dev
;
834 uart_add_one_port(&serial_pxa_reg
, &serial_pxa_ports
[dev
->id
].port
);
835 dev_set_drvdata(_dev
, &serial_pxa_ports
[dev
->id
]);
839 static int serial_pxa_remove(struct device
*_dev
)
841 struct uart_pxa_port
*sport
= dev_get_drvdata(_dev
);
843 dev_set_drvdata(_dev
, NULL
);
846 uart_remove_one_port(&serial_pxa_reg
, &sport
->port
);
851 static struct device_driver serial_pxa_driver
= {
852 .name
= "pxa2xx-uart",
853 .bus
= &platform_bus_type
,
854 .probe
= serial_pxa_probe
,
855 .remove
= serial_pxa_remove
,
857 .suspend
= serial_pxa_suspend
,
858 .resume
= serial_pxa_resume
,
861 int __init
serial_pxa_init(void)
865 ret
= uart_register_driver(&serial_pxa_reg
);
869 ret
= driver_register(&serial_pxa_driver
);
871 uart_unregister_driver(&serial_pxa_reg
);
876 void __exit
serial_pxa_exit(void)
878 driver_unregister(&serial_pxa_driver
);
879 uart_unregister_driver(&serial_pxa_reg
);
882 module_init(serial_pxa_init
);
883 module_exit(serial_pxa_exit
);
885 MODULE_LICENSE("GPL");