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
6 * Derived from many drivers using generic_serial interface.
8 * Copyright (C) 2008 Maxime Bizon <mbizon@freebox.fr>
10 * Serial driver for BCM63xx integrated UART.
12 * Hardware flow control was _not_ tested since I only have RX/TX on
16 #if defined(CONFIG_SERIAL_BCM63XX_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
20 #include <linux/kernel.h>
21 #include <linux/platform_device.h>
22 #include <linux/init.h>
23 #include <linux/delay.h>
24 #include <linux/module.h>
25 #include <linux/console.h>
26 #include <linux/clk.h>
27 #include <linux/tty.h>
28 #include <linux/tty_flip.h>
29 #include <linux/sysrq.h>
30 #include <linux/serial.h>
31 #include <linux/serial_core.h>
33 #include <bcm63xx_clk.h>
34 #include <bcm63xx_irq.h>
35 #include <bcm63xx_regs.h>
36 #include <bcm63xx_io.h>
38 #define BCM63XX_NR_UARTS 2
40 static struct uart_port ports
[BCM63XX_NR_UARTS
];
43 * rx interrupt mask / stat
47 * - rx fifo above threshold
48 * - rx fifo not empty for too long
50 #define UART_RX_INT_MASK (UART_IR_MASK(UART_IR_RXOVER) | \
51 UART_IR_MASK(UART_IR_RXTHRESH) | \
52 UART_IR_MASK(UART_IR_RXTIMEOUT))
54 #define UART_RX_INT_STAT (UART_IR_STAT(UART_IR_RXOVER) | \
55 UART_IR_STAT(UART_IR_RXTHRESH) | \
56 UART_IR_STAT(UART_IR_RXTIMEOUT))
59 * tx interrupt mask / stat
63 * - tx fifo below threshold
65 #define UART_TX_INT_MASK (UART_IR_MASK(UART_IR_TXEMPTY) | \
66 UART_IR_MASK(UART_IR_TXTRESH))
68 #define UART_TX_INT_STAT (UART_IR_STAT(UART_IR_TXEMPTY) | \
69 UART_IR_STAT(UART_IR_TXTRESH))
72 * external input interrupt
74 * mask: any edge on CTS, DCD
76 #define UART_EXTINP_INT_MASK (UART_EXTINP_IRMASK(UART_EXTINP_IR_CTS) | \
77 UART_EXTINP_IRMASK(UART_EXTINP_IR_DCD))
80 * handy uart register accessor
82 static inline unsigned int bcm_uart_readl(struct uart_port
*port
,
85 return bcm_readl(port
->membase
+ offset
);
88 static inline void bcm_uart_writel(struct uart_port
*port
,
89 unsigned int value
, unsigned int offset
)
91 bcm_writel(value
, port
->membase
+ offset
);
95 * serial core request to check if uart tx fifo is empty
97 static unsigned int bcm_uart_tx_empty(struct uart_port
*port
)
101 val
= bcm_uart_readl(port
, UART_IR_REG
);
102 return (val
& UART_IR_STAT(UART_IR_TXEMPTY
)) ? 1 : 0;
106 * serial core request to set RTS and DTR pin state and loopback mode
108 static void bcm_uart_set_mctrl(struct uart_port
*port
, unsigned int mctrl
)
112 val
= bcm_uart_readl(port
, UART_MCTL_REG
);
113 val
&= ~(UART_MCTL_DTR_MASK
| UART_MCTL_RTS_MASK
);
114 /* invert of written value is reflected on the pin */
115 if (!(mctrl
& TIOCM_DTR
))
116 val
|= UART_MCTL_DTR_MASK
;
117 if (!(mctrl
& TIOCM_RTS
))
118 val
|= UART_MCTL_RTS_MASK
;
119 bcm_uart_writel(port
, val
, UART_MCTL_REG
);
121 val
= bcm_uart_readl(port
, UART_CTL_REG
);
122 if (mctrl
& TIOCM_LOOP
)
123 val
|= UART_CTL_LOOPBACK_MASK
;
125 val
&= ~UART_CTL_LOOPBACK_MASK
;
126 bcm_uart_writel(port
, val
, UART_CTL_REG
);
130 * serial core request to return RI, CTS, DCD and DSR pin state
132 static unsigned int bcm_uart_get_mctrl(struct uart_port
*port
)
134 unsigned int val
, mctrl
;
137 val
= bcm_uart_readl(port
, UART_EXTINP_REG
);
138 if (val
& UART_EXTINP_RI_MASK
)
140 if (val
& UART_EXTINP_CTS_MASK
)
142 if (val
& UART_EXTINP_DCD_MASK
)
144 if (val
& UART_EXTINP_DSR_MASK
)
150 * serial core request to disable tx ASAP (used for flow control)
152 static void bcm_uart_stop_tx(struct uart_port
*port
)
156 val
= bcm_uart_readl(port
, UART_CTL_REG
);
157 val
&= ~(UART_CTL_TXEN_MASK
);
158 bcm_uart_writel(port
, val
, UART_CTL_REG
);
160 val
= bcm_uart_readl(port
, UART_IR_REG
);
161 val
&= ~UART_TX_INT_MASK
;
162 bcm_uart_writel(port
, val
, UART_IR_REG
);
166 * serial core request to (re)enable tx
168 static void bcm_uart_start_tx(struct uart_port
*port
)
172 val
= bcm_uart_readl(port
, UART_IR_REG
);
173 val
|= UART_TX_INT_MASK
;
174 bcm_uart_writel(port
, val
, UART_IR_REG
);
176 val
= bcm_uart_readl(port
, UART_CTL_REG
);
177 val
|= UART_CTL_TXEN_MASK
;
178 bcm_uart_writel(port
, val
, UART_CTL_REG
);
182 * serial core request to stop rx, called before port shutdown
184 static void bcm_uart_stop_rx(struct uart_port
*port
)
188 val
= bcm_uart_readl(port
, UART_IR_REG
);
189 val
&= ~UART_RX_INT_MASK
;
190 bcm_uart_writel(port
, val
, UART_IR_REG
);
194 * serial core request to enable modem status interrupt reporting
196 static void bcm_uart_enable_ms(struct uart_port
*port
)
200 val
= bcm_uart_readl(port
, UART_IR_REG
);
201 val
|= UART_IR_MASK(UART_IR_EXTIP
);
202 bcm_uart_writel(port
, val
, UART_IR_REG
);
206 * serial core request to start/stop emitting break char
208 static void bcm_uart_break_ctl(struct uart_port
*port
, int ctl
)
213 spin_lock_irqsave(&port
->lock
, flags
);
215 val
= bcm_uart_readl(port
, UART_CTL_REG
);
217 val
|= UART_CTL_XMITBRK_MASK
;
219 val
&= ~UART_CTL_XMITBRK_MASK
;
220 bcm_uart_writel(port
, val
, UART_CTL_REG
);
222 spin_unlock_irqrestore(&port
->lock
, flags
);
226 * return port type in string format
228 static const char *bcm_uart_type(struct uart_port
*port
)
230 return (port
->type
== PORT_BCM63XX
) ? "bcm63xx_uart" : NULL
;
234 * read all chars in rx fifo and send them to core
236 static void bcm_uart_do_rx(struct uart_port
*port
)
238 struct tty_struct
*tty
;
239 unsigned int max_count
;
241 /* limit number of char read in interrupt, should not be
242 * higher than fifo size anyway since we're much faster than
245 tty
= port
->state
->port
.tty
;
247 unsigned int iestat
, c
, cstat
;
250 /* get overrun/fifo empty information from ier
252 iestat
= bcm_uart_readl(port
, UART_IR_REG
);
254 if (unlikely(iestat
& UART_IR_STAT(UART_IR_RXOVER
))) {
257 /* fifo reset is required to clear
259 val
= bcm_uart_readl(port
, UART_CTL_REG
);
260 val
|= UART_CTL_RSTRXFIFO_MASK
;
261 bcm_uart_writel(port
, val
, UART_CTL_REG
);
263 port
->icount
.overrun
++;
264 tty_insert_flip_char(tty
, 0, TTY_OVERRUN
);
267 if (!(iestat
& UART_IR_STAT(UART_IR_RXNOTEMPTY
)))
270 cstat
= c
= bcm_uart_readl(port
, UART_FIFO_REG
);
275 if (unlikely((cstat
& UART_FIFO_ANYERR_MASK
))) {
277 if (cstat
& UART_FIFO_BRKDET_MASK
) {
279 if (uart_handle_break(port
))
283 if (cstat
& UART_FIFO_PARERR_MASK
)
284 port
->icount
.parity
++;
285 if (cstat
& UART_FIFO_FRAMEERR_MASK
)
286 port
->icount
.frame
++;
288 /* update flag wrt read_status_mask */
289 cstat
&= port
->read_status_mask
;
290 if (cstat
& UART_FIFO_BRKDET_MASK
)
292 if (cstat
& UART_FIFO_FRAMEERR_MASK
)
294 if (cstat
& UART_FIFO_PARERR_MASK
)
298 if (uart_handle_sysrq_char(port
, c
))
302 if ((cstat
& port
->ignore_status_mask
) == 0)
303 tty_insert_flip_char(tty
, c
, flag
);
305 } while (--max_count
);
307 tty_flip_buffer_push(tty
);
311 * fill tx fifo with chars to send, stop when fifo is about to be full
312 * or when all chars have been sent.
314 static void bcm_uart_do_tx(struct uart_port
*port
)
316 struct circ_buf
*xmit
;
317 unsigned int val
, max_count
;
320 bcm_uart_writel(port
, port
->x_char
, UART_FIFO_REG
);
326 if (uart_tx_stopped(port
)) {
327 bcm_uart_stop_tx(port
);
331 xmit
= &port
->state
->xmit
;
332 if (uart_circ_empty(xmit
))
335 val
= bcm_uart_readl(port
, UART_MCTL_REG
);
336 val
= (val
& UART_MCTL_TXFIFOFILL_MASK
) >> UART_MCTL_TXFIFOFILL_SHIFT
;
337 max_count
= port
->fifosize
- val
;
339 while (max_count
--) {
342 c
= xmit
->buf
[xmit
->tail
];
343 bcm_uart_writel(port
, c
, UART_FIFO_REG
);
344 xmit
->tail
= (xmit
->tail
+ 1) & (UART_XMIT_SIZE
- 1);
346 if (uart_circ_empty(xmit
))
350 if (uart_circ_chars_pending(xmit
) < WAKEUP_CHARS
)
351 uart_write_wakeup(port
);
353 if (uart_circ_empty(xmit
))
358 /* nothing to send, disable transmit interrupt */
359 val
= bcm_uart_readl(port
, UART_IR_REG
);
360 val
&= ~UART_TX_INT_MASK
;
361 bcm_uart_writel(port
, val
, UART_IR_REG
);
366 * process uart interrupt
368 static irqreturn_t
bcm_uart_interrupt(int irq
, void *dev_id
)
370 struct uart_port
*port
;
371 unsigned int irqstat
;
374 spin_lock(&port
->lock
);
376 irqstat
= bcm_uart_readl(port
, UART_IR_REG
);
377 if (irqstat
& UART_RX_INT_STAT
)
378 bcm_uart_do_rx(port
);
380 if (irqstat
& UART_TX_INT_STAT
)
381 bcm_uart_do_tx(port
);
383 if (irqstat
& UART_IR_MASK(UART_IR_EXTIP
)) {
386 estat
= bcm_uart_readl(port
, UART_EXTINP_REG
);
387 if (estat
& UART_EXTINP_IRSTAT(UART_EXTINP_IR_CTS
))
388 uart_handle_cts_change(port
,
389 estat
& UART_EXTINP_CTS_MASK
);
390 if (estat
& UART_EXTINP_IRSTAT(UART_EXTINP_IR_DCD
))
391 uart_handle_dcd_change(port
,
392 estat
& UART_EXTINP_DCD_MASK
);
395 spin_unlock(&port
->lock
);
400 * enable rx & tx operation on uart
402 static void bcm_uart_enable(struct uart_port
*port
)
406 val
= bcm_uart_readl(port
, UART_CTL_REG
);
407 val
|= (UART_CTL_BRGEN_MASK
| UART_CTL_TXEN_MASK
| UART_CTL_RXEN_MASK
);
408 bcm_uart_writel(port
, val
, UART_CTL_REG
);
412 * disable rx & tx operation on uart
414 static void bcm_uart_disable(struct uart_port
*port
)
418 val
= bcm_uart_readl(port
, UART_CTL_REG
);
419 val
&= ~(UART_CTL_BRGEN_MASK
| UART_CTL_TXEN_MASK
|
421 bcm_uart_writel(port
, val
, UART_CTL_REG
);
425 * clear all unread data in rx fifo and unsent data in tx fifo
427 static void bcm_uart_flush(struct uart_port
*port
)
431 /* empty rx and tx fifo */
432 val
= bcm_uart_readl(port
, UART_CTL_REG
);
433 val
|= UART_CTL_RSTRXFIFO_MASK
| UART_CTL_RSTTXFIFO_MASK
;
434 bcm_uart_writel(port
, val
, UART_CTL_REG
);
436 /* read any pending char to make sure all irq status are
438 (void)bcm_uart_readl(port
, UART_FIFO_REG
);
442 * serial core request to initialize uart and start rx operation
444 static int bcm_uart_startup(struct uart_port
*port
)
449 /* mask all irq and flush port */
450 bcm_uart_disable(port
);
451 bcm_uart_writel(port
, 0, UART_IR_REG
);
452 bcm_uart_flush(port
);
454 /* clear any pending external input interrupt */
455 (void)bcm_uart_readl(port
, UART_EXTINP_REG
);
457 /* set rx/tx fifo thresh to fifo half size */
458 val
= bcm_uart_readl(port
, UART_MCTL_REG
);
459 val
&= ~(UART_MCTL_RXFIFOTHRESH_MASK
| UART_MCTL_TXFIFOTHRESH_MASK
);
460 val
|= (port
->fifosize
/ 2) << UART_MCTL_RXFIFOTHRESH_SHIFT
;
461 val
|= (port
->fifosize
/ 2) << UART_MCTL_TXFIFOTHRESH_SHIFT
;
462 bcm_uart_writel(port
, val
, UART_MCTL_REG
);
464 /* set rx fifo timeout to 1 char time */
465 val
= bcm_uart_readl(port
, UART_CTL_REG
);
466 val
&= ~UART_CTL_RXTMOUTCNT_MASK
;
467 val
|= 1 << UART_CTL_RXTMOUTCNT_SHIFT
;
468 bcm_uart_writel(port
, val
, UART_CTL_REG
);
470 /* report any edge on dcd and cts */
471 val
= UART_EXTINP_INT_MASK
;
472 val
|= UART_EXTINP_DCD_NOSENSE_MASK
;
473 val
|= UART_EXTINP_CTS_NOSENSE_MASK
;
474 bcm_uart_writel(port
, val
, UART_EXTINP_REG
);
476 /* register irq and enable rx interrupts */
477 ret
= request_irq(port
->irq
, bcm_uart_interrupt
, 0,
478 bcm_uart_type(port
), port
);
481 bcm_uart_writel(port
, UART_RX_INT_MASK
, UART_IR_REG
);
482 bcm_uart_enable(port
);
487 * serial core request to flush & disable uart
489 static void bcm_uart_shutdown(struct uart_port
*port
)
493 spin_lock_irqsave(&port
->lock
, flags
);
494 bcm_uart_writel(port
, 0, UART_IR_REG
);
495 spin_unlock_irqrestore(&port
->lock
, flags
);
497 bcm_uart_disable(port
);
498 bcm_uart_flush(port
);
499 free_irq(port
->irq
, port
);
503 * serial core request to change current uart setting
505 static void bcm_uart_set_termios(struct uart_port
*port
,
506 struct ktermios
*new,
507 struct ktermios
*old
)
509 unsigned int ctl
, baud
, quot
, ier
;
512 spin_lock_irqsave(&port
->lock
, flags
);
514 /* disable uart while changing speed */
515 bcm_uart_disable(port
);
516 bcm_uart_flush(port
);
518 /* update Control register */
519 ctl
= bcm_uart_readl(port
, UART_CTL_REG
);
520 ctl
&= ~UART_CTL_BITSPERSYM_MASK
;
522 switch (new->c_cflag
& CSIZE
) {
524 ctl
|= (0 << UART_CTL_BITSPERSYM_SHIFT
);
527 ctl
|= (1 << UART_CTL_BITSPERSYM_SHIFT
);
530 ctl
|= (2 << UART_CTL_BITSPERSYM_SHIFT
);
533 ctl
|= (3 << UART_CTL_BITSPERSYM_SHIFT
);
537 ctl
&= ~UART_CTL_STOPBITS_MASK
;
538 if (new->c_cflag
& CSTOPB
)
539 ctl
|= UART_CTL_STOPBITS_2
;
541 ctl
|= UART_CTL_STOPBITS_1
;
543 ctl
&= ~(UART_CTL_RXPAREN_MASK
| UART_CTL_TXPAREN_MASK
);
544 if (new->c_cflag
& PARENB
)
545 ctl
|= (UART_CTL_RXPAREN_MASK
| UART_CTL_TXPAREN_MASK
);
546 ctl
&= ~(UART_CTL_RXPAREVEN_MASK
| UART_CTL_TXPAREVEN_MASK
);
547 if (new->c_cflag
& PARODD
)
548 ctl
|= (UART_CTL_RXPAREVEN_MASK
| UART_CTL_TXPAREVEN_MASK
);
549 bcm_uart_writel(port
, ctl
, UART_CTL_REG
);
551 /* update Baudword register */
552 baud
= uart_get_baud_rate(port
, new, old
, 0, port
->uartclk
/ 16);
553 quot
= uart_get_divisor(port
, baud
) - 1;
554 bcm_uart_writel(port
, quot
, UART_BAUD_REG
);
556 /* update Interrupt register */
557 ier
= bcm_uart_readl(port
, UART_IR_REG
);
559 ier
&= ~UART_IR_MASK(UART_IR_EXTIP
);
560 if (UART_ENABLE_MS(port
, new->c_cflag
))
561 ier
|= UART_IR_MASK(UART_IR_EXTIP
);
563 bcm_uart_writel(port
, ier
, UART_IR_REG
);
565 /* update read/ignore mask */
566 port
->read_status_mask
= UART_FIFO_VALID_MASK
;
567 if (new->c_iflag
& INPCK
) {
568 port
->read_status_mask
|= UART_FIFO_FRAMEERR_MASK
;
569 port
->read_status_mask
|= UART_FIFO_PARERR_MASK
;
571 if (new->c_iflag
& (BRKINT
))
572 port
->read_status_mask
|= UART_FIFO_BRKDET_MASK
;
574 port
->ignore_status_mask
= 0;
575 if (new->c_iflag
& IGNPAR
)
576 port
->ignore_status_mask
|= UART_FIFO_PARERR_MASK
;
577 if (new->c_iflag
& IGNBRK
)
578 port
->ignore_status_mask
|= UART_FIFO_BRKDET_MASK
;
579 if (!(new->c_cflag
& CREAD
))
580 port
->ignore_status_mask
|= UART_FIFO_VALID_MASK
;
582 uart_update_timeout(port
, new->c_cflag
, baud
);
583 bcm_uart_enable(port
);
584 spin_unlock_irqrestore(&port
->lock
, flags
);
588 * serial core request to claim uart iomem
590 static int bcm_uart_request_port(struct uart_port
*port
)
594 size
= RSET_UART_SIZE
;
595 if (!request_mem_region(port
->mapbase
, size
, "bcm63xx")) {
596 dev_err(port
->dev
, "Memory region busy\n");
600 port
->membase
= ioremap(port
->mapbase
, size
);
601 if (!port
->membase
) {
602 dev_err(port
->dev
, "Unable to map registers\n");
603 release_mem_region(port
->mapbase
, size
);
610 * serial core request to release uart iomem
612 static void bcm_uart_release_port(struct uart_port
*port
)
614 release_mem_region(port
->mapbase
, RSET_UART_SIZE
);
615 iounmap(port
->membase
);
619 * serial core request to do any port required autoconfiguration
621 static void bcm_uart_config_port(struct uart_port
*port
, int flags
)
623 if (flags
& UART_CONFIG_TYPE
) {
624 if (bcm_uart_request_port(port
))
626 port
->type
= PORT_BCM63XX
;
631 * serial core request to check that port information in serinfo are
634 static int bcm_uart_verify_port(struct uart_port
*port
,
635 struct serial_struct
*serinfo
)
637 if (port
->type
!= PORT_BCM63XX
)
639 if (port
->irq
!= serinfo
->irq
)
641 if (port
->iotype
!= serinfo
->io_type
)
643 if (port
->mapbase
!= (unsigned long)serinfo
->iomem_base
)
648 /* serial core callbacks */
649 static struct uart_ops bcm_uart_ops
= {
650 .tx_empty
= bcm_uart_tx_empty
,
651 .get_mctrl
= bcm_uart_get_mctrl
,
652 .set_mctrl
= bcm_uart_set_mctrl
,
653 .start_tx
= bcm_uart_start_tx
,
654 .stop_tx
= bcm_uart_stop_tx
,
655 .stop_rx
= bcm_uart_stop_rx
,
656 .enable_ms
= bcm_uart_enable_ms
,
657 .break_ctl
= bcm_uart_break_ctl
,
658 .startup
= bcm_uart_startup
,
659 .shutdown
= bcm_uart_shutdown
,
660 .set_termios
= bcm_uart_set_termios
,
661 .type
= bcm_uart_type
,
662 .release_port
= bcm_uart_release_port
,
663 .request_port
= bcm_uart_request_port
,
664 .config_port
= bcm_uart_config_port
,
665 .verify_port
= bcm_uart_verify_port
,
670 #ifdef CONFIG_SERIAL_BCM63XX_CONSOLE
671 static inline void wait_for_xmitr(struct uart_port
*port
)
675 /* Wait up to 10ms for the character(s) to be sent. */
680 val
= bcm_uart_readl(port
, UART_IR_REG
);
681 if (val
& UART_IR_STAT(UART_IR_TXEMPTY
))
686 /* Wait up to 1s for flow control if necessary */
687 if (port
->flags
& UPF_CONS_FLOW
) {
692 val
= bcm_uart_readl(port
, UART_EXTINP_REG
);
693 if (val
& UART_EXTINP_CTS_MASK
)
703 static void bcm_console_putchar(struct uart_port
*port
, int ch
)
705 wait_for_xmitr(port
);
706 bcm_uart_writel(port
, ch
, UART_FIFO_REG
);
710 * console core request to output given string
712 static void bcm_console_write(struct console
*co
, const char *s
,
715 struct uart_port
*port
;
719 port
= &ports
[co
->index
];
721 local_irq_save(flags
);
723 /* bcm_uart_interrupt() already took the lock */
725 } else if (oops_in_progress
) {
726 locked
= spin_trylock(&port
->lock
);
728 spin_lock(&port
->lock
);
732 /* call helper to deal with \r\n */
733 uart_console_write(port
, s
, count
, bcm_console_putchar
);
735 /* and wait for char to be transmitted */
736 wait_for_xmitr(port
);
739 spin_unlock(&port
->lock
);
740 local_irq_restore(flags
);
744 * console core request to setup given console, find matching uart
747 static int bcm_console_setup(struct console
*co
, char *options
)
749 struct uart_port
*port
;
755 if (co
->index
< 0 || co
->index
>= BCM63XX_NR_UARTS
)
757 port
= &ports
[co
->index
];
761 uart_parse_options(options
, &baud
, &parity
, &bits
, &flow
);
763 return uart_set_options(port
, co
, baud
, parity
, bits
, flow
);
766 static struct uart_driver bcm_uart_driver
;
768 static struct console bcm63xx_console
= {
770 .write
= bcm_console_write
,
771 .device
= uart_console_device
,
772 .setup
= bcm_console_setup
,
773 .flags
= CON_PRINTBUFFER
,
775 .data
= &bcm_uart_driver
,
778 static int __init
bcm63xx_console_init(void)
780 register_console(&bcm63xx_console
);
784 console_initcall(bcm63xx_console_init
);
786 #define BCM63XX_CONSOLE (&bcm63xx_console)
788 #define BCM63XX_CONSOLE NULL
789 #endif /* CONFIG_SERIAL_BCM63XX_CONSOLE */
791 static struct uart_driver bcm_uart_driver
= {
792 .owner
= THIS_MODULE
,
793 .driver_name
= "bcm63xx_uart",
797 .nr
= BCM63XX_NR_UARTS
,
798 .cons
= BCM63XX_CONSOLE
,
802 * platform driver probe/remove callback
804 static int __devinit
bcm_uart_probe(struct platform_device
*pdev
)
806 struct resource
*res_mem
, *res_irq
;
807 struct uart_port
*port
;
811 if (pdev
->id
< 0 || pdev
->id
>= BCM63XX_NR_UARTS
)
814 if (ports
[pdev
->id
].membase
)
817 res_mem
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
821 res_irq
= platform_get_resource(pdev
, IORESOURCE_IRQ
, 0);
825 clk
= clk_get(&pdev
->dev
, "periph");
829 port
= &ports
[pdev
->id
];
830 memset(port
, 0, sizeof(*port
));
831 port
->iotype
= UPIO_MEM
;
832 port
->mapbase
= res_mem
->start
;
833 port
->irq
= res_irq
->start
;
834 port
->ops
= &bcm_uart_ops
;
835 port
->flags
= UPF_BOOT_AUTOCONF
;
836 port
->dev
= &pdev
->dev
;
838 port
->uartclk
= clk_get_rate(clk
) / 2;
839 port
->line
= pdev
->id
;
842 ret
= uart_add_one_port(&bcm_uart_driver
, port
);
844 ports
[pdev
->id
].membase
= 0;
847 platform_set_drvdata(pdev
, port
);
851 static int __devexit
bcm_uart_remove(struct platform_device
*pdev
)
853 struct uart_port
*port
;
855 port
= platform_get_drvdata(pdev
);
856 uart_remove_one_port(&bcm_uart_driver
, port
);
857 platform_set_drvdata(pdev
, NULL
);
858 /* mark port as free */
859 ports
[pdev
->id
].membase
= 0;
864 * platform driver stuff
866 static struct platform_driver bcm_uart_platform_driver
= {
867 .probe
= bcm_uart_probe
,
868 .remove
= __devexit_p(bcm_uart_remove
),
870 .owner
= THIS_MODULE
,
871 .name
= "bcm63xx_uart",
875 static int __init
bcm_uart_init(void)
879 ret
= uart_register_driver(&bcm_uart_driver
);
883 ret
= platform_driver_register(&bcm_uart_platform_driver
);
885 uart_unregister_driver(&bcm_uart_driver
);
890 static void __exit
bcm_uart_exit(void)
892 platform_driver_unregister(&bcm_uart_platform_driver
);
893 uart_unregister_driver(&bcm_uart_driver
);
896 module_init(bcm_uart_init
);
897 module_exit(bcm_uart_exit
);
899 MODULE_AUTHOR("Maxime Bizon <mbizon@freebox.fr>");
900 MODULE_DESCRIPTION("Broadcom 63<xx integrated uart driver");
901 MODULE_LICENSE("GPL");