2 * Blackfin On-Chip Serial Driver
4 * Copyright 2006-2011 Analog Devices Inc.
6 * Enter bugs at http://blackfin.uclinux.org/
8 * Licensed under the GPL-2 or later.
11 #if defined(CONFIG_SERIAL_BFIN_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
15 #define DRIVER_NAME "bfin-uart"
16 #define pr_fmt(fmt) DRIVER_NAME ": " fmt
18 #include <linux/module.h>
19 #include <linux/ioport.h>
20 #include <linux/gfp.h>
22 #include <linux/init.h>
23 #include <linux/console.h>
24 #include <linux/sysrq.h>
25 #include <linux/platform_device.h>
26 #include <linux/tty.h>
27 #include <linux/tty_flip.h>
28 #include <linux/serial_core.h>
29 #include <linux/gpio.h>
30 #include <linux/irq.h>
31 #include <linux/kgdb.h>
32 #include <linux/slab.h>
33 #include <linux/dma-mapping.h>
35 #include <asm/portmux.h>
36 #include <asm/cacheflush.h>
38 #include <asm/bfin_serial.h>
40 #ifdef CONFIG_SERIAL_BFIN_MODULE
41 # undef CONFIG_EARLY_PRINTK
44 #ifdef CONFIG_SERIAL_BFIN_MODULE
45 # undef CONFIG_EARLY_PRINTK
48 /* UART name and device definitions */
49 #define BFIN_SERIAL_DEV_NAME "ttyBF"
50 #define BFIN_SERIAL_MAJOR 204
51 #define BFIN_SERIAL_MINOR 64
53 static struct bfin_serial_port
*bfin_serial_ports
[BFIN_UART_NR_PORTS
];
55 #if defined(CONFIG_KGDB_SERIAL_CONSOLE) || \
56 defined(CONFIG_KGDB_SERIAL_CONSOLE_MODULE)
58 # ifndef CONFIG_SERIAL_BFIN_PIO
59 # error KGDB only support UART in PIO mode.
62 static int kgdboc_port_line
;
63 static int kgdboc_break_enabled
;
66 * Setup for console. Argument comes from the menuconfig
68 #define DMA_RX_XCOUNT 512
69 #define DMA_RX_YCOUNT (PAGE_SIZE / DMA_RX_XCOUNT)
71 #define DMA_RX_FLUSH_JIFFIES (HZ / 50)
73 #ifdef CONFIG_SERIAL_BFIN_DMA
74 static void bfin_serial_dma_tx_chars(struct bfin_serial_port
*uart
);
76 static void bfin_serial_tx_chars(struct bfin_serial_port
*uart
);
79 static void bfin_serial_reset_irda(struct uart_port
*port
);
81 #if defined(CONFIG_SERIAL_BFIN_CTSRTS) || \
82 defined(CONFIG_SERIAL_BFIN_HARD_CTSRTS)
83 static unsigned int bfin_serial_get_mctrl(struct uart_port
*port
)
85 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
86 if (uart
->cts_pin
< 0)
87 return TIOCM_CTS
| TIOCM_DSR
| TIOCM_CAR
;
89 /* CTS PIN is negative assertive. */
90 if (UART_GET_CTS(uart
))
91 return TIOCM_CTS
| TIOCM_DSR
| TIOCM_CAR
;
93 return TIOCM_DSR
| TIOCM_CAR
;
96 static void bfin_serial_set_mctrl(struct uart_port
*port
, unsigned int mctrl
)
98 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
99 if (uart
->rts_pin
< 0)
102 /* RTS PIN is negative assertive. */
103 if (mctrl
& TIOCM_RTS
)
104 UART_ENABLE_RTS(uart
);
106 UART_DISABLE_RTS(uart
);
110 * Handle any change of modem status signal.
112 static irqreturn_t
bfin_serial_mctrl_cts_int(int irq
, void *dev_id
)
114 struct bfin_serial_port
*uart
= dev_id
;
115 unsigned int status
= bfin_serial_get_mctrl(&uart
->port
);
116 #ifdef CONFIG_SERIAL_BFIN_HARD_CTSRTS
117 struct tty_struct
*tty
= uart
->port
.state
->port
.tty
;
119 UART_CLEAR_SCTS(uart
);
120 if (tty
->hw_stopped
) {
123 uart_write_wakeup(&uart
->port
);
130 uart_handle_cts_change(&uart
->port
, status
& TIOCM_CTS
);
135 static unsigned int bfin_serial_get_mctrl(struct uart_port
*port
)
137 return TIOCM_CTS
| TIOCM_DSR
| TIOCM_CAR
;
140 static void bfin_serial_set_mctrl(struct uart_port
*port
, unsigned int mctrl
)
146 * interrupts are disabled on entry
148 static void bfin_serial_stop_tx(struct uart_port
*port
)
150 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
151 #ifdef CONFIG_SERIAL_BFIN_DMA
152 struct circ_buf
*xmit
= &uart
->port
.state
->xmit
;
155 while (!(UART_GET_LSR(uart
) & TEMT
))
158 #ifdef CONFIG_SERIAL_BFIN_DMA
159 disable_dma(uart
->tx_dma_channel
);
160 xmit
->tail
= (xmit
->tail
+ uart
->tx_count
) & (UART_XMIT_SIZE
- 1);
161 uart
->port
.icount
.tx
+= uart
->tx_count
;
165 #if defined(CONFIG_BF54x) || defined(CONFIG_BF60x)
167 UART_PUT_LSR(uart
, TFI
);
169 UART_CLEAR_IER(uart
, ETBEI
);
174 * port is locked and interrupts are disabled
176 static void bfin_serial_start_tx(struct uart_port
*port
)
178 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
179 struct tty_struct
*tty
= uart
->port
.state
->port
.tty
;
182 * To avoid losting RX interrupt, we reset IR function
183 * before sending data.
185 if (tty
->termios
->c_line
== N_IRDA
)
186 bfin_serial_reset_irda(port
);
188 #ifdef CONFIG_SERIAL_BFIN_DMA
190 bfin_serial_dma_tx_chars(uart
);
192 UART_SET_IER(uart
, ETBEI
);
193 bfin_serial_tx_chars(uart
);
198 * Interrupts are enabled
200 static void bfin_serial_stop_rx(struct uart_port
*port
)
202 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
204 UART_CLEAR_IER(uart
, ERBFI
);
208 * Set the modem control timer to fire immediately.
210 static void bfin_serial_enable_ms(struct uart_port
*port
)
215 #if ANOMALY_05000363 && defined(CONFIG_SERIAL_BFIN_PIO)
216 # define UART_GET_ANOMALY_THRESHOLD(uart) ((uart)->anomaly_threshold)
217 # define UART_SET_ANOMALY_THRESHOLD(uart, v) ((uart)->anomaly_threshold = (v))
219 # define UART_GET_ANOMALY_THRESHOLD(uart) 0
220 # define UART_SET_ANOMALY_THRESHOLD(uart, v)
223 #ifdef CONFIG_SERIAL_BFIN_PIO
224 static void bfin_serial_rx_chars(struct bfin_serial_port
*uart
)
226 struct tty_struct
*tty
= NULL
;
227 unsigned int status
, ch
, flg
;
228 static struct timeval anomaly_start
= { .tv_sec
= 0 };
230 status
= UART_GET_LSR(uart
);
231 UART_CLEAR_LSR(uart
);
233 ch
= UART_GET_CHAR(uart
);
234 uart
->port
.icount
.rx
++;
236 #if defined(CONFIG_KGDB_SERIAL_CONSOLE) || \
237 defined(CONFIG_KGDB_SERIAL_CONSOLE_MODULE)
238 if (kgdb_connected
&& kgdboc_port_line
== uart
->port
.line
239 && kgdboc_break_enabled
)
240 if (ch
== 0x3) {/* Ctrl + C */
245 if (!uart
->port
.state
|| !uart
->port
.state
->port
.tty
)
248 tty
= uart
->port
.state
->port
.tty
;
250 if (ANOMALY_05000363
) {
251 /* The BF533 (and BF561) family of processors have a nice anomaly
252 * where they continuously generate characters for a "single" break.
253 * We have to basically ignore this flood until the "next" valid
254 * character comes across. Due to the nature of the flood, it is
255 * not possible to reliably catch bytes that are sent too quickly
256 * after this break. So application code talking to the Blackfin
257 * which sends a break signal must allow at least 1.5 character
258 * times after the end of the break for things to stabilize. This
259 * timeout was picked as it must absolutely be larger than 1
260 * character time +/- some percent. So 1.5 sounds good. All other
261 * Blackfin families operate properly. Woo.
263 if (anomaly_start
.tv_sec
) {
267 if ((~ch
& (~ch
+ 1)) & 0xff)
268 goto known_good_char
;
270 do_gettimeofday(&curr
);
271 if (curr
.tv_sec
- anomaly_start
.tv_sec
> 1)
272 goto known_good_char
;
275 if (curr
.tv_sec
!= anomaly_start
.tv_sec
)
276 usecs
+= USEC_PER_SEC
;
277 usecs
+= curr
.tv_usec
- anomaly_start
.tv_usec
;
279 if (usecs
> UART_GET_ANOMALY_THRESHOLD(uart
))
280 goto known_good_char
;
283 anomaly_start
.tv_sec
= 0;
285 anomaly_start
= curr
;
291 anomaly_start
.tv_sec
= 0;
296 if (ANOMALY_05000363
)
297 if (bfin_revid() < 5)
298 do_gettimeofday(&anomaly_start
);
299 uart
->port
.icount
.brk
++;
300 if (uart_handle_break(&uart
->port
))
302 status
&= ~(PE
| FE
);
305 uart
->port
.icount
.parity
++;
307 uart
->port
.icount
.overrun
++;
309 uart
->port
.icount
.frame
++;
311 status
&= uart
->port
.read_status_mask
;
315 else if (status
& PE
)
317 else if (status
& FE
)
322 if (uart_handle_sysrq_char(&uart
->port
, ch
))
325 uart_insert_char(&uart
->port
, status
, OE
, ch
, flg
);
328 tty_flip_buffer_push(tty
);
331 static void bfin_serial_tx_chars(struct bfin_serial_port
*uart
)
333 struct circ_buf
*xmit
= &uart
->port
.state
->xmit
;
335 if (uart_circ_empty(xmit
) || uart_tx_stopped(&uart
->port
)) {
336 #if defined(CONFIG_BF54x) || defined(CONFIG_BF60x)
338 UART_PUT_LSR(uart
, TFI
);
341 * 05000215 - we always clear ETBEI within last UART TX
342 * interrupt to end a string. It is always set
343 * when start a new tx.
345 UART_CLEAR_IER(uart
, ETBEI
);
349 if (uart
->port
.x_char
) {
350 UART_PUT_CHAR(uart
, uart
->port
.x_char
);
351 uart
->port
.icount
.tx
++;
352 uart
->port
.x_char
= 0;
355 while ((UART_GET_LSR(uart
) & THRE
) && xmit
->tail
!= xmit
->head
) {
356 UART_PUT_CHAR(uart
, xmit
->buf
[xmit
->tail
]);
357 xmit
->tail
= (xmit
->tail
+ 1) & (UART_XMIT_SIZE
- 1);
358 uart
->port
.icount
.tx
++;
361 if (uart_circ_chars_pending(xmit
) < WAKEUP_CHARS
)
362 uart_write_wakeup(&uart
->port
);
365 static irqreturn_t
bfin_serial_rx_int(int irq
, void *dev_id
)
367 struct bfin_serial_port
*uart
= dev_id
;
369 while (UART_GET_LSR(uart
) & DR
)
370 bfin_serial_rx_chars(uart
);
375 static irqreturn_t
bfin_serial_tx_int(int irq
, void *dev_id
)
377 struct bfin_serial_port
*uart
= dev_id
;
379 spin_lock(&uart
->port
.lock
);
380 if (UART_GET_LSR(uart
) & THRE
)
381 bfin_serial_tx_chars(uart
);
382 spin_unlock(&uart
->port
.lock
);
388 #ifdef CONFIG_SERIAL_BFIN_DMA
389 static void bfin_serial_dma_tx_chars(struct bfin_serial_port
*uart
)
391 struct circ_buf
*xmit
= &uart
->port
.state
->xmit
;
395 if (uart_circ_empty(xmit
) || uart_tx_stopped(&uart
->port
)) {
401 if (uart
->port
.x_char
) {
402 UART_PUT_CHAR(uart
, uart
->port
.x_char
);
403 uart
->port
.icount
.tx
++;
404 uart
->port
.x_char
= 0;
407 uart
->tx_count
= CIRC_CNT(xmit
->head
, xmit
->tail
, UART_XMIT_SIZE
);
408 if (uart
->tx_count
> (UART_XMIT_SIZE
- xmit
->tail
))
409 uart
->tx_count
= UART_XMIT_SIZE
- xmit
->tail
;
410 blackfin_dcache_flush_range((unsigned long)(xmit
->buf
+xmit
->tail
),
411 (unsigned long)(xmit
->buf
+xmit
->tail
+uart
->tx_count
));
412 set_dma_config(uart
->tx_dma_channel
,
413 set_bfin_dma_config(DIR_READ
, DMA_FLOW_STOP
,
418 set_dma_start_addr(uart
->tx_dma_channel
, (unsigned long)(xmit
->buf
+xmit
->tail
));
419 set_dma_x_count(uart
->tx_dma_channel
, uart
->tx_count
);
420 set_dma_x_modify(uart
->tx_dma_channel
, 1);
422 enable_dma(uart
->tx_dma_channel
);
424 UART_SET_IER(uart
, ETBEI
);
427 static void bfin_serial_dma_rx_chars(struct bfin_serial_port
*uart
)
429 struct tty_struct
*tty
= uart
->port
.state
->port
.tty
;
432 status
= UART_GET_LSR(uart
);
433 UART_CLEAR_LSR(uart
);
435 uart
->port
.icount
.rx
+=
436 CIRC_CNT(uart
->rx_dma_buf
.head
, uart
->rx_dma_buf
.tail
,
440 uart
->port
.icount
.brk
++;
441 if (uart_handle_break(&uart
->port
))
442 goto dma_ignore_char
;
443 status
&= ~(PE
| FE
);
446 uart
->port
.icount
.parity
++;
448 uart
->port
.icount
.overrun
++;
450 uart
->port
.icount
.frame
++;
452 status
&= uart
->port
.read_status_mask
;
456 else if (status
& PE
)
458 else if (status
& FE
)
463 for (i
= uart
->rx_dma_buf
.tail
; ; i
++) {
464 if (i
>= UART_XMIT_SIZE
)
466 if (i
== uart
->rx_dma_buf
.head
)
468 if (!uart_handle_sysrq_char(&uart
->port
, uart
->rx_dma_buf
.buf
[i
]))
469 uart_insert_char(&uart
->port
, status
, OE
,
470 uart
->rx_dma_buf
.buf
[i
], flg
);
474 tty_flip_buffer_push(tty
);
477 void bfin_serial_rx_dma_timeout(struct bfin_serial_port
*uart
)
481 dma_disable_irq_nosync(uart
->rx_dma_channel
);
482 spin_lock_bh(&uart
->rx_lock
);
484 /* 2D DMA RX buffer ring is used. Because curr_y_count and
485 * curr_x_count can't be read as an atomic operation,
486 * curr_y_count should be read before curr_x_count. When
487 * curr_x_count is read, curr_y_count may already indicate
488 * next buffer line. But, the position calculated here is
489 * still indicate the old line. The wrong position data may
490 * be smaller than current buffer tail, which cause garbages
491 * are received if it is not prohibit.
493 uart
->rx_dma_nrows
= get_dma_curr_ycount(uart
->rx_dma_channel
);
494 x_pos
= get_dma_curr_xcount(uart
->rx_dma_channel
);
495 uart
->rx_dma_nrows
= DMA_RX_YCOUNT
- uart
->rx_dma_nrows
;
496 if (uart
->rx_dma_nrows
== DMA_RX_YCOUNT
|| x_pos
== 0)
497 uart
->rx_dma_nrows
= 0;
498 x_pos
= DMA_RX_XCOUNT
- x_pos
;
499 if (x_pos
== DMA_RX_XCOUNT
)
502 pos
= uart
->rx_dma_nrows
* DMA_RX_XCOUNT
+ x_pos
;
503 /* Ignore receiving data if new position is in the same line of
504 * current buffer tail and small.
506 if (pos
> uart
->rx_dma_buf
.tail
||
507 uart
->rx_dma_nrows
< (uart
->rx_dma_buf
.tail
/DMA_RX_XCOUNT
)) {
508 uart
->rx_dma_buf
.head
= pos
;
509 bfin_serial_dma_rx_chars(uart
);
510 uart
->rx_dma_buf
.tail
= uart
->rx_dma_buf
.head
;
513 spin_unlock_bh(&uart
->rx_lock
);
514 dma_enable_irq(uart
->rx_dma_channel
);
516 mod_timer(&(uart
->rx_dma_timer
), jiffies
+ DMA_RX_FLUSH_JIFFIES
);
519 static irqreturn_t
bfin_serial_dma_tx_int(int irq
, void *dev_id
)
521 struct bfin_serial_port
*uart
= dev_id
;
522 struct circ_buf
*xmit
= &uart
->port
.state
->xmit
;
524 spin_lock(&uart
->port
.lock
);
525 if (!(get_dma_curr_irqstat(uart
->tx_dma_channel
)&DMA_RUN
)) {
526 disable_dma(uart
->tx_dma_channel
);
527 clear_dma_irqstat(uart
->tx_dma_channel
);
529 * 05000215 - we always clear ETBEI within last UART TX
530 * interrupt to end a string. It is always set
531 * when start a new tx.
533 UART_CLEAR_IER(uart
, ETBEI
);
534 uart
->port
.icount
.tx
+= uart
->tx_count
;
535 if (!(xmit
->tail
== 0 && xmit
->head
== 0)) {
536 xmit
->tail
= (xmit
->tail
+ uart
->tx_count
) & (UART_XMIT_SIZE
- 1);
538 if (uart_circ_chars_pending(xmit
) < WAKEUP_CHARS
)
539 uart_write_wakeup(&uart
->port
);
542 bfin_serial_dma_tx_chars(uart
);
545 spin_unlock(&uart
->port
.lock
);
549 static irqreturn_t
bfin_serial_dma_rx_int(int irq
, void *dev_id
)
551 struct bfin_serial_port
*uart
= dev_id
;
552 unsigned int irqstat
;
555 spin_lock(&uart
->rx_lock
);
556 irqstat
= get_dma_curr_irqstat(uart
->rx_dma_channel
);
557 clear_dma_irqstat(uart
->rx_dma_channel
);
559 uart
->rx_dma_nrows
= get_dma_curr_ycount(uart
->rx_dma_channel
);
560 x_pos
= get_dma_curr_xcount(uart
->rx_dma_channel
);
561 uart
->rx_dma_nrows
= DMA_RX_YCOUNT
- uart
->rx_dma_nrows
;
562 if (uart
->rx_dma_nrows
== DMA_RX_YCOUNT
|| x_pos
== 0)
563 uart
->rx_dma_nrows
= 0;
565 pos
= uart
->rx_dma_nrows
* DMA_RX_XCOUNT
;
566 if (pos
> uart
->rx_dma_buf
.tail
||
567 uart
->rx_dma_nrows
< (uart
->rx_dma_buf
.tail
/DMA_RX_XCOUNT
)) {
568 uart
->rx_dma_buf
.head
= pos
;
569 bfin_serial_dma_rx_chars(uart
);
570 uart
->rx_dma_buf
.tail
= uart
->rx_dma_buf
.head
;
573 spin_unlock(&uart
->rx_lock
);
580 * Return TIOCSER_TEMT when transmitter is not busy.
582 static unsigned int bfin_serial_tx_empty(struct uart_port
*port
)
584 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
587 lsr
= UART_GET_LSR(uart
);
594 static void bfin_serial_break_ctl(struct uart_port
*port
, int break_state
)
596 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
597 u32 lcr
= UART_GET_LCR(uart
);
602 UART_PUT_LCR(uart
, lcr
);
606 static int bfin_serial_startup(struct uart_port
*port
)
608 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
610 #ifdef CONFIG_SERIAL_BFIN_DMA
611 dma_addr_t dma_handle
;
613 if (request_dma(uart
->rx_dma_channel
, "BFIN_UART_RX") < 0) {
614 printk(KERN_NOTICE
"Unable to attach Blackfin UART RX DMA channel\n");
618 if (request_dma(uart
->tx_dma_channel
, "BFIN_UART_TX") < 0) {
619 printk(KERN_NOTICE
"Unable to attach Blackfin UART TX DMA channel\n");
620 free_dma(uart
->rx_dma_channel
);
624 set_dma_callback(uart
->rx_dma_channel
, bfin_serial_dma_rx_int
, uart
);
625 set_dma_callback(uart
->tx_dma_channel
, bfin_serial_dma_tx_int
, uart
);
627 uart
->rx_dma_buf
.buf
= (unsigned char *)dma_alloc_coherent(NULL
, PAGE_SIZE
, &dma_handle
, GFP_DMA
);
628 uart
->rx_dma_buf
.head
= 0;
629 uart
->rx_dma_buf
.tail
= 0;
630 uart
->rx_dma_nrows
= 0;
632 set_dma_config(uart
->rx_dma_channel
,
633 set_bfin_dma_config(DIR_WRITE
, DMA_FLOW_AUTO
,
634 INTR_ON_ROW
, DIMENSION_2D
,
637 set_dma_x_count(uart
->rx_dma_channel
, DMA_RX_XCOUNT
);
638 set_dma_x_modify(uart
->rx_dma_channel
, 1);
639 set_dma_y_count(uart
->rx_dma_channel
, DMA_RX_YCOUNT
);
640 set_dma_y_modify(uart
->rx_dma_channel
, 1);
641 set_dma_start_addr(uart
->rx_dma_channel
, (unsigned long)uart
->rx_dma_buf
.buf
);
642 enable_dma(uart
->rx_dma_channel
);
644 uart
->rx_dma_timer
.data
= (unsigned long)(uart
);
645 uart
->rx_dma_timer
.function
= (void *)bfin_serial_rx_dma_timeout
;
646 uart
->rx_dma_timer
.expires
= jiffies
+ DMA_RX_FLUSH_JIFFIES
;
647 add_timer(&(uart
->rx_dma_timer
));
649 # if defined(CONFIG_KGDB_SERIAL_CONSOLE) || \
650 defined(CONFIG_KGDB_SERIAL_CONSOLE_MODULE)
651 if (kgdboc_port_line
== uart
->port
.line
&& kgdboc_break_enabled
)
652 kgdboc_break_enabled
= 0;
655 if (request_irq(uart
->rx_irq
, bfin_serial_rx_int
, 0,
656 "BFIN_UART_RX", uart
)) {
657 printk(KERN_NOTICE
"Unable to attach BlackFin UART RX interrupt\n");
662 (uart
->tx_irq
, bfin_serial_tx_int
, 0,
663 "BFIN_UART_TX", uart
)) {
664 printk(KERN_NOTICE
"Unable to attach BlackFin UART TX interrupt\n");
665 free_irq(uart
->rx_irq
, uart
);
672 * UART2 and UART3 on BF548 share interrupt PINs and DMA
673 * controllers with SPORT2 and SPORT3. UART rx and tx
674 * interrupts are generated in PIO mode only when configure
675 * their peripheral mapping registers properly, which means
676 * request corresponding DMA channels in PIO mode as well.
678 unsigned uart_dma_ch_rx
, uart_dma_ch_tx
;
680 switch (uart
->rx_irq
) {
682 uart_dma_ch_rx
= CH_UART3_RX
;
683 uart_dma_ch_tx
= CH_UART3_TX
;
686 uart_dma_ch_rx
= CH_UART2_RX
;
687 uart_dma_ch_tx
= CH_UART2_TX
;
690 uart_dma_ch_rx
= uart_dma_ch_tx
= 0;
694 if (uart_dma_ch_rx
&&
695 request_dma(uart_dma_ch_rx
, "BFIN_UART_RX") < 0) {
696 printk(KERN_NOTICE
"Fail to attach UART interrupt\n");
697 free_irq(uart
->rx_irq
, uart
);
698 free_irq(uart
->tx_irq
, uart
);
701 if (uart_dma_ch_tx
&&
702 request_dma(uart_dma_ch_tx
, "BFIN_UART_TX") < 0) {
703 printk(KERN_NOTICE
"Fail to attach UART interrupt\n");
704 free_dma(uart_dma_ch_rx
);
705 free_irq(uart
->rx_irq
, uart
);
706 free_irq(uart
->tx_irq
, uart
);
711 # if defined(CONFIG_KGDB_SERIAL_CONSOLE) || \
712 defined(CONFIG_KGDB_SERIAL_CONSOLE_MODULE)
717 #ifdef CONFIG_SERIAL_BFIN_CTSRTS
718 if (uart
->cts_pin
>= 0) {
719 if (request_irq(gpio_to_irq(uart
->cts_pin
),
720 bfin_serial_mctrl_cts_int
,
721 IRQF_TRIGGER_RISING
| IRQF_TRIGGER_FALLING
|
722 0, "BFIN_UART_CTS", uart
)) {
724 pr_info("Unable to attach BlackFin UART CTS interrupt. So, disable it.\n");
727 if (uart
->rts_pin
>= 0) {
728 if (gpio_request(uart
->rts_pin
, DRIVER_NAME
)) {
729 pr_info("fail to request RTS PIN at GPIO_%d\n", uart
->rts_pin
);
732 gpio_direction_output(uart
->rts_pin
, 0);
735 #ifdef CONFIG_SERIAL_BFIN_HARD_CTSRTS
736 if (uart
->cts_pin
>= 0) {
737 if (request_irq(uart
->status_irq
, bfin_serial_mctrl_cts_int
,
738 IRQF_DISABLED
, "BFIN_UART_MODEM_STATUS", uart
)) {
740 dev_info(port
->dev
, "Unable to attach BlackFin UART Modem Status interrupt.\n");
743 /* CTS RTS PINs are negative assertive. */
744 UART_PUT_MCR(uart
, UART_GET_MCR(uart
) | ACTS
);
745 UART_SET_IER(uart
, EDSSI
);
749 UART_SET_IER(uart
, ERBFI
);
753 static void bfin_serial_shutdown(struct uart_port
*port
)
755 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
757 #ifdef CONFIG_SERIAL_BFIN_DMA
758 disable_dma(uart
->tx_dma_channel
);
759 free_dma(uart
->tx_dma_channel
);
760 disable_dma(uart
->rx_dma_channel
);
761 free_dma(uart
->rx_dma_channel
);
762 del_timer(&(uart
->rx_dma_timer
));
763 dma_free_coherent(NULL
, PAGE_SIZE
, uart
->rx_dma_buf
.buf
, 0);
766 switch (uart
->port
.irq
) {
768 free_dma(CH_UART3_RX
);
769 free_dma(CH_UART3_TX
);
772 free_dma(CH_UART2_RX
);
773 free_dma(CH_UART2_TX
);
779 free_irq(uart
->rx_irq
, uart
);
780 free_irq(uart
->tx_irq
, uart
);
783 #ifdef CONFIG_SERIAL_BFIN_CTSRTS
784 if (uart
->cts_pin
>= 0)
785 free_irq(gpio_to_irq(uart
->cts_pin
), uart
);
786 if (uart
->rts_pin
>= 0)
787 gpio_free(uart
->rts_pin
);
789 #ifdef CONFIG_SERIAL_BFIN_HARD_CTSRTS
790 if (uart
->cts_pin
>= 0)
791 free_irq(uart
->status_irq
, uart
);
796 bfin_serial_set_termios(struct uart_port
*port
, struct ktermios
*termios
,
797 struct ktermios
*old
)
799 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
801 unsigned int baud
, quot
;
802 unsigned int ier
, lcr
= 0;
804 switch (termios
->c_cflag
& CSIZE
) {
818 printk(KERN_ERR
"%s: word lengh not supported\n",
823 * 05000231 - STOP bit is always set to 1 whatever the user is set.
825 if (termios
->c_cflag
& CSTOPB
) {
826 if (ANOMALY_05000231
)
827 printk(KERN_WARNING
"STOP bits other than 1 is not "
828 "supported in case of anomaly 05000231.\n");
832 if (termios
->c_cflag
& PARENB
)
834 if (!(termios
->c_cflag
& PARODD
))
836 if (termios
->c_cflag
& CMSPAR
)
839 spin_lock_irqsave(&uart
->port
.lock
, flags
);
841 port
->read_status_mask
= OE
;
842 if (termios
->c_iflag
& INPCK
)
843 port
->read_status_mask
|= (FE
| PE
);
844 if (termios
->c_iflag
& (BRKINT
| PARMRK
))
845 port
->read_status_mask
|= BI
;
848 * Characters to ignore
850 port
->ignore_status_mask
= 0;
851 if (termios
->c_iflag
& IGNPAR
)
852 port
->ignore_status_mask
|= FE
| PE
;
853 if (termios
->c_iflag
& IGNBRK
) {
854 port
->ignore_status_mask
|= BI
;
856 * If we're ignoring parity and break indicators,
857 * ignore overruns too (for real raw support).
859 if (termios
->c_iflag
& IGNPAR
)
860 port
->ignore_status_mask
|= OE
;
863 baud
= uart_get_baud_rate(port
, termios
, old
, 0, port
->uartclk
/16);
864 quot
= uart_get_divisor(port
, baud
);
866 /* If discipline is not IRDA, apply ANOMALY_05000230 */
867 if (termios
->c_line
!= N_IRDA
)
868 quot
-= ANOMALY_05000230
;
870 UART_SET_ANOMALY_THRESHOLD(uart
, USEC_PER_SEC
/ baud
* 15);
873 ier
= UART_GET_IER(uart
);
874 UART_PUT_GCTL(uart
, UART_GET_GCTL(uart
) & ~UCEN
);
875 UART_DISABLE_INTS(uart
);
877 /* Set DLAB in LCR to Access CLK */
880 UART_PUT_CLK(uart
, quot
);
883 /* Clear DLAB in LCR to Access THR RBR IER */
884 UART_CLEAR_DLAB(uart
);
886 UART_PUT_LCR(uart
, (UART_GET_LCR(uart
) & ~LCR_MASK
) | lcr
);
889 UART_ENABLE_INTS(uart
, ier
);
890 UART_PUT_GCTL(uart
, UART_GET_GCTL(uart
) | UCEN
);
892 /* Port speed changed, update the per-port timeout. */
893 uart_update_timeout(port
, termios
->c_cflag
, baud
);
895 spin_unlock_irqrestore(&uart
->port
.lock
, flags
);
898 static const char *bfin_serial_type(struct uart_port
*port
)
900 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
902 return uart
->port
.type
== PORT_BFIN
? "BFIN-UART" : NULL
;
906 * Release the memory region(s) being used by 'port'.
908 static void bfin_serial_release_port(struct uart_port
*port
)
913 * Request the memory region(s) being used by 'port'.
915 static int bfin_serial_request_port(struct uart_port
*port
)
921 * Configure/autoconfigure the port.
923 static void bfin_serial_config_port(struct uart_port
*port
, int flags
)
925 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
927 if (flags
& UART_CONFIG_TYPE
&&
928 bfin_serial_request_port(&uart
->port
) == 0)
929 uart
->port
.type
= PORT_BFIN
;
933 * Verify the new serial_struct (for TIOCSSERIAL).
934 * The only change we allow are to the flags and type, and
935 * even then only between PORT_BFIN and PORT_UNKNOWN
938 bfin_serial_verify_port(struct uart_port
*port
, struct serial_struct
*ser
)
944 * Enable the IrDA function if tty->ldisc.num is N_IRDA.
945 * In other cases, disable IrDA function.
947 static void bfin_serial_set_ldisc(struct uart_port
*port
, int ld
)
949 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
954 val
= UART_GET_GCTL(uart
);
955 val
|= (UMOD_IRDA
| RPOLC
);
956 UART_PUT_GCTL(uart
, val
);
959 val
= UART_GET_GCTL(uart
);
960 val
&= ~(UMOD_MASK
| RPOLC
);
961 UART_PUT_GCTL(uart
, val
);
965 static void bfin_serial_reset_irda(struct uart_port
*port
)
967 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
970 val
= UART_GET_GCTL(uart
);
971 val
&= ~(UMOD_MASK
| RPOLC
);
972 UART_PUT_GCTL(uart
, val
);
974 val
|= (UMOD_IRDA
| RPOLC
);
975 UART_PUT_GCTL(uart
, val
);
979 #ifdef CONFIG_CONSOLE_POLL
981 * 05000099 - Because we only use THRE in poll_put and DR in poll_get,
982 * losing other bits of UART_LSR is not a problem here.
984 static void bfin_serial_poll_put_char(struct uart_port
*port
, unsigned char chr
)
986 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
988 while (!(UART_GET_LSR(uart
) & THRE
))
991 UART_CLEAR_DLAB(uart
);
992 UART_PUT_CHAR(uart
, (unsigned char)chr
);
995 static int bfin_serial_poll_get_char(struct uart_port
*port
)
997 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
1000 while (!(UART_GET_LSR(uart
) & DR
))
1003 UART_CLEAR_DLAB(uart
);
1004 chr
= UART_GET_CHAR(uart
);
1010 #if defined(CONFIG_KGDB_SERIAL_CONSOLE) || \
1011 defined(CONFIG_KGDB_SERIAL_CONSOLE_MODULE)
1012 static void bfin_kgdboc_port_shutdown(struct uart_port
*port
)
1014 if (kgdboc_break_enabled
) {
1015 kgdboc_break_enabled
= 0;
1016 bfin_serial_shutdown(port
);
1020 static int bfin_kgdboc_port_startup(struct uart_port
*port
)
1022 kgdboc_port_line
= port
->line
;
1023 kgdboc_break_enabled
= !bfin_serial_startup(port
);
1028 static struct uart_ops bfin_serial_pops
= {
1029 .tx_empty
= bfin_serial_tx_empty
,
1030 .set_mctrl
= bfin_serial_set_mctrl
,
1031 .get_mctrl
= bfin_serial_get_mctrl
,
1032 .stop_tx
= bfin_serial_stop_tx
,
1033 .start_tx
= bfin_serial_start_tx
,
1034 .stop_rx
= bfin_serial_stop_rx
,
1035 .enable_ms
= bfin_serial_enable_ms
,
1036 .break_ctl
= bfin_serial_break_ctl
,
1037 .startup
= bfin_serial_startup
,
1038 .shutdown
= bfin_serial_shutdown
,
1039 .set_termios
= bfin_serial_set_termios
,
1040 .set_ldisc
= bfin_serial_set_ldisc
,
1041 .type
= bfin_serial_type
,
1042 .release_port
= bfin_serial_release_port
,
1043 .request_port
= bfin_serial_request_port
,
1044 .config_port
= bfin_serial_config_port
,
1045 .verify_port
= bfin_serial_verify_port
,
1046 #if defined(CONFIG_KGDB_SERIAL_CONSOLE) || \
1047 defined(CONFIG_KGDB_SERIAL_CONSOLE_MODULE)
1048 .kgdboc_port_startup
= bfin_kgdboc_port_startup
,
1049 .kgdboc_port_shutdown
= bfin_kgdboc_port_shutdown
,
1051 #ifdef CONFIG_CONSOLE_POLL
1052 .poll_put_char
= bfin_serial_poll_put_char
,
1053 .poll_get_char
= bfin_serial_poll_get_char
,
1057 #if defined(CONFIG_SERIAL_BFIN_CONSOLE) || defined(CONFIG_EARLY_PRINTK)
1059 * If the port was already initialised (eg, by a boot loader),
1060 * try to determine the current setup.
1063 bfin_serial_console_get_options(struct bfin_serial_port
*uart
, int *baud
,
1064 int *parity
, int *bits
)
1066 unsigned int status
;
1068 status
= UART_GET_IER(uart
) & (ERBFI
| ETBEI
);
1069 if (status
== (ERBFI
| ETBEI
)) {
1070 /* ok, the port was enabled */
1073 lcr
= UART_GET_LCR(uart
);
1082 *bits
= ((lcr
& WLS_MASK
) >> WLS_OFFSET
) + 5;
1084 /* Set DLAB in LCR to Access CLK */
1085 UART_SET_DLAB(uart
);
1087 clk
= UART_GET_CLK(uart
);
1089 /* Clear DLAB in LCR to Access THR RBR IER */
1090 UART_CLEAR_DLAB(uart
);
1092 *baud
= get_sclk() / (16*clk
);
1094 pr_debug("%s:baud = %d, parity = %c, bits= %d\n", __func__
, *baud
, *parity
, *bits
);
1097 static struct uart_driver bfin_serial_reg
;
1099 static void bfin_serial_console_putchar(struct uart_port
*port
, int ch
)
1101 struct bfin_serial_port
*uart
= (struct bfin_serial_port
*)port
;
1102 while (!(UART_GET_LSR(uart
) & THRE
))
1104 UART_PUT_CHAR(uart
, ch
);
1107 #endif /* defined (CONFIG_SERIAL_BFIN_CONSOLE) ||
1108 defined (CONFIG_EARLY_PRINTK) */
1110 #ifdef CONFIG_SERIAL_BFIN_CONSOLE
1111 #define CLASS_BFIN_CONSOLE "bfin-console"
1113 * Interrupts are disabled on entering
1116 bfin_serial_console_write(struct console
*co
, const char *s
, unsigned int count
)
1118 struct bfin_serial_port
*uart
= bfin_serial_ports
[co
->index
];
1119 unsigned long flags
;
1121 spin_lock_irqsave(&uart
->port
.lock
, flags
);
1122 uart_console_write(&uart
->port
, s
, count
, bfin_serial_console_putchar
);
1123 spin_unlock_irqrestore(&uart
->port
.lock
, flags
);
1128 bfin_serial_console_setup(struct console
*co
, char *options
)
1130 struct bfin_serial_port
*uart
;
1134 # if defined(CONFIG_SERIAL_BFIN_CTSRTS) || \
1135 defined(CONFIG_SERIAL_BFIN_HARD_CTSRTS)
1142 * Check whether an invalid uart number has been specified, and
1143 * if so, search for the first available port that does have
1146 if (co
->index
< 0 || co
->index
>= BFIN_UART_NR_PORTS
)
1149 uart
= bfin_serial_ports
[co
->index
];
1154 uart_parse_options(options
, &baud
, &parity
, &bits
, &flow
);
1156 bfin_serial_console_get_options(uart
, &baud
, &parity
, &bits
);
1158 return uart_set_options(&uart
->port
, co
, baud
, parity
, bits
, flow
);
1161 static struct console bfin_serial_console
= {
1162 .name
= BFIN_SERIAL_DEV_NAME
,
1163 .write
= bfin_serial_console_write
,
1164 .device
= uart_console_device
,
1165 .setup
= bfin_serial_console_setup
,
1166 .flags
= CON_PRINTBUFFER
,
1168 .data
= &bfin_serial_reg
,
1170 #define BFIN_SERIAL_CONSOLE (&bfin_serial_console)
1172 #define BFIN_SERIAL_CONSOLE NULL
1173 #endif /* CONFIG_SERIAL_BFIN_CONSOLE */
1175 #ifdef CONFIG_EARLY_PRINTK
1176 static struct bfin_serial_port bfin_earlyprintk_port
;
1177 #define CLASS_BFIN_EARLYPRINTK "bfin-earlyprintk"
1180 * Interrupts are disabled on entering
1183 bfin_earlyprintk_console_write(struct console
*co
, const char *s
, unsigned int count
)
1185 unsigned long flags
;
1187 if (bfin_earlyprintk_port
.port
.line
!= co
->index
)
1190 spin_lock_irqsave(&bfin_earlyprintk_port
.port
.lock
, flags
);
1191 uart_console_write(&bfin_earlyprintk_port
.port
, s
, count
,
1192 bfin_serial_console_putchar
);
1193 spin_unlock_irqrestore(&bfin_earlyprintk_port
.port
.lock
, flags
);
1197 * This should have a .setup or .early_setup in it, but then things get called
1198 * without the command line options, and the baud rate gets messed up - so
1199 * don't let the common infrastructure play with things. (see calls to setup
1200 * & earlysetup in ./kernel/printk.c:register_console()
1202 static struct __initdata console bfin_early_serial_console
= {
1203 .name
= "early_BFuart",
1204 .write
= bfin_earlyprintk_console_write
,
1205 .device
= uart_console_device
,
1206 .flags
= CON_PRINTBUFFER
,
1208 .data
= &bfin_serial_reg
,
1212 static struct uart_driver bfin_serial_reg
= {
1213 .owner
= THIS_MODULE
,
1214 .driver_name
= DRIVER_NAME
,
1215 .dev_name
= BFIN_SERIAL_DEV_NAME
,
1216 .major
= BFIN_SERIAL_MAJOR
,
1217 .minor
= BFIN_SERIAL_MINOR
,
1218 .nr
= BFIN_UART_NR_PORTS
,
1219 .cons
= BFIN_SERIAL_CONSOLE
,
1222 static int bfin_serial_suspend(struct platform_device
*pdev
, pm_message_t state
)
1224 struct bfin_serial_port
*uart
= platform_get_drvdata(pdev
);
1226 return uart_suspend_port(&bfin_serial_reg
, &uart
->port
);
1229 static int bfin_serial_resume(struct platform_device
*pdev
)
1231 struct bfin_serial_port
*uart
= platform_get_drvdata(pdev
);
1233 return uart_resume_port(&bfin_serial_reg
, &uart
->port
);
1236 static int bfin_serial_probe(struct platform_device
*pdev
)
1238 struct resource
*res
;
1239 struct bfin_serial_port
*uart
= NULL
;
1242 if (pdev
->id
< 0 || pdev
->id
>= BFIN_UART_NR_PORTS
) {
1243 dev_err(&pdev
->dev
, "Wrong bfin uart platform device id.\n");
1247 if (bfin_serial_ports
[pdev
->id
] == NULL
) {
1249 uart
= kzalloc(sizeof(*uart
), GFP_KERNEL
);
1252 "fail to malloc bfin_serial_port\n");
1255 bfin_serial_ports
[pdev
->id
] = uart
;
1257 #ifdef CONFIG_EARLY_PRINTK
1258 if (!(bfin_earlyprintk_port
.port
.membase
1259 && bfin_earlyprintk_port
.port
.line
== pdev
->id
)) {
1261 * If the peripheral PINs of current port is allocated
1262 * in earlyprintk probe stage, don't do it again.
1265 ret
= peripheral_request_list(
1266 (unsigned short *)pdev
->dev
.platform_data
, DRIVER_NAME
);
1269 "fail to request bfin serial peripherals\n");
1270 goto out_error_free_mem
;
1272 #ifdef CONFIG_EARLY_PRINTK
1276 spin_lock_init(&uart
->port
.lock
);
1277 uart
->port
.uartclk
= get_sclk();
1278 uart
->port
.fifosize
= BFIN_UART_TX_FIFO_SIZE
;
1279 uart
->port
.ops
= &bfin_serial_pops
;
1280 uart
->port
.line
= pdev
->id
;
1281 uart
->port
.iotype
= UPIO_MEM
;
1282 uart
->port
.flags
= UPF_BOOT_AUTOCONF
;
1284 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
1286 dev_err(&pdev
->dev
, "Cannot get IORESOURCE_MEM\n");
1288 goto out_error_free_peripherals
;
1291 uart
->port
.membase
= ioremap(res
->start
, resource_size(res
));
1292 if (!uart
->port
.membase
) {
1293 dev_err(&pdev
->dev
, "Cannot map uart IO\n");
1295 goto out_error_free_peripherals
;
1297 uart
->port
.mapbase
= res
->start
;
1299 uart
->tx_irq
= platform_get_irq(pdev
, 0);
1300 if (uart
->tx_irq
< 0) {
1301 dev_err(&pdev
->dev
, "No uart TX IRQ specified\n");
1303 goto out_error_unmap
;
1306 uart
->rx_irq
= platform_get_irq(pdev
, 1);
1307 if (uart
->rx_irq
< 0) {
1308 dev_err(&pdev
->dev
, "No uart RX IRQ specified\n");
1310 goto out_error_unmap
;
1312 uart
->port
.irq
= uart
->rx_irq
;
1314 uart
->status_irq
= platform_get_irq(pdev
, 2);
1315 if (uart
->status_irq
< 0) {
1316 dev_err(&pdev
->dev
, "No uart status IRQ specified\n");
1318 goto out_error_unmap
;
1321 #ifdef CONFIG_SERIAL_BFIN_DMA
1322 spin_lock_init(&uart
->rx_lock
);
1326 res
= platform_get_resource(pdev
, IORESOURCE_DMA
, 0);
1328 dev_err(&pdev
->dev
, "No uart TX DMA channel specified\n");
1330 goto out_error_unmap
;
1332 uart
->tx_dma_channel
= res
->start
;
1334 res
= platform_get_resource(pdev
, IORESOURCE_DMA
, 1);
1336 dev_err(&pdev
->dev
, "No uart RX DMA channel specified\n");
1338 goto out_error_unmap
;
1340 uart
->rx_dma_channel
= res
->start
;
1342 init_timer(&(uart
->rx_dma_timer
));
1345 #if defined(CONFIG_SERIAL_BFIN_CTSRTS) || \
1346 defined(CONFIG_SERIAL_BFIN_HARD_CTSRTS)
1347 res
= platform_get_resource(pdev
, IORESOURCE_IO
, 0);
1351 uart
->cts_pin
= res
->start
;
1352 #ifdef CONFIG_SERIAL_BFIN_CTSRTS
1353 uart
->port
.flags
|= ASYNC_CTS_FLOW
;
1357 res
= platform_get_resource(pdev
, IORESOURCE_IO
, 1);
1361 uart
->rts_pin
= res
->start
;
1365 #ifdef CONFIG_SERIAL_BFIN_CONSOLE
1366 if (!is_early_platform_device(pdev
)) {
1368 uart
= bfin_serial_ports
[pdev
->id
];
1369 uart
->port
.dev
= &pdev
->dev
;
1370 dev_set_drvdata(&pdev
->dev
, uart
);
1371 ret
= uart_add_one_port(&bfin_serial_reg
, &uart
->port
);
1372 #ifdef CONFIG_SERIAL_BFIN_CONSOLE
1381 iounmap(uart
->port
.membase
);
1382 out_error_free_peripherals
:
1383 peripheral_free_list(
1384 (unsigned short *)pdev
->dev
.platform_data
);
1387 bfin_serial_ports
[pdev
->id
] = NULL
;
1393 static int __devexit
bfin_serial_remove(struct platform_device
*pdev
)
1395 struct bfin_serial_port
*uart
= platform_get_drvdata(pdev
);
1397 dev_set_drvdata(&pdev
->dev
, NULL
);
1400 uart_remove_one_port(&bfin_serial_reg
, &uart
->port
);
1401 iounmap(uart
->port
.membase
);
1402 peripheral_free_list(
1403 (unsigned short *)pdev
->dev
.platform_data
);
1405 bfin_serial_ports
[pdev
->id
] = NULL
;
1411 static struct platform_driver bfin_serial_driver
= {
1412 .probe
= bfin_serial_probe
,
1413 .remove
= __devexit_p(bfin_serial_remove
),
1414 .suspend
= bfin_serial_suspend
,
1415 .resume
= bfin_serial_resume
,
1417 .name
= DRIVER_NAME
,
1418 .owner
= THIS_MODULE
,
1422 #if defined(CONFIG_SERIAL_BFIN_CONSOLE)
1423 static __initdata
struct early_platform_driver early_bfin_serial_driver
= {
1424 .class_str
= CLASS_BFIN_CONSOLE
,
1425 .pdrv
= &bfin_serial_driver
,
1426 .requested_id
= EARLY_PLATFORM_ID_UNSET
,
1429 static int __init
bfin_serial_rs_console_init(void)
1431 early_platform_driver_register(&early_bfin_serial_driver
, DRIVER_NAME
);
1433 early_platform_driver_probe(CLASS_BFIN_CONSOLE
, BFIN_UART_NR_PORTS
, 0);
1435 register_console(&bfin_serial_console
);
1439 console_initcall(bfin_serial_rs_console_init
);
1442 #ifdef CONFIG_EARLY_PRINTK
1444 * Memory can't be allocated dynamically during earlyprink init stage.
1445 * So, do individual probe for earlyprink with a static uart port variable.
1447 static int bfin_earlyprintk_probe(struct platform_device
*pdev
)
1449 struct resource
*res
;
1452 if (pdev
->id
< 0 || pdev
->id
>= BFIN_UART_NR_PORTS
) {
1453 dev_err(&pdev
->dev
, "Wrong earlyprintk platform device id.\n");
1457 ret
= peripheral_request_list(
1458 (unsigned short *)pdev
->dev
.platform_data
, DRIVER_NAME
);
1461 "fail to request bfin serial peripherals\n");
1465 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
1467 dev_err(&pdev
->dev
, "Cannot get IORESOURCE_MEM\n");
1469 goto out_error_free_peripherals
;
1472 bfin_earlyprintk_port
.port
.membase
= ioremap(res
->start
,
1473 resource_size(res
));
1474 if (!bfin_earlyprintk_port
.port
.membase
) {
1475 dev_err(&pdev
->dev
, "Cannot map uart IO\n");
1477 goto out_error_free_peripherals
;
1479 bfin_earlyprintk_port
.port
.mapbase
= res
->start
;
1480 bfin_earlyprintk_port
.port
.line
= pdev
->id
;
1481 bfin_earlyprintk_port
.port
.uartclk
= get_sclk();
1482 bfin_earlyprintk_port
.port
.fifosize
= BFIN_UART_TX_FIFO_SIZE
;
1483 spin_lock_init(&bfin_earlyprintk_port
.port
.lock
);
1487 out_error_free_peripherals
:
1488 peripheral_free_list(
1489 (unsigned short *)pdev
->dev
.platform_data
);
1494 static struct platform_driver bfin_earlyprintk_driver
= {
1495 .probe
= bfin_earlyprintk_probe
,
1497 .name
= DRIVER_NAME
,
1498 .owner
= THIS_MODULE
,
1502 static __initdata
struct early_platform_driver early_bfin_earlyprintk_driver
= {
1503 .class_str
= CLASS_BFIN_EARLYPRINTK
,
1504 .pdrv
= &bfin_earlyprintk_driver
,
1505 .requested_id
= EARLY_PLATFORM_ID_UNSET
,
1508 struct console __init
*bfin_earlyserial_init(unsigned int port
,
1514 if (port
< 0 || port
>= BFIN_UART_NR_PORTS
)
1518 * Only probe resource of the given port in earlyprintk boot arg.
1519 * The expected port id should be indicated in port name string.
1521 snprintf(port_name
, 20, DRIVER_NAME
".%d", port
);
1522 early_platform_driver_register(&early_bfin_earlyprintk_driver
,
1524 early_platform_driver_probe(CLASS_BFIN_EARLYPRINTK
, 1, 0);
1526 if (!bfin_earlyprintk_port
.port
.membase
)
1529 #ifdef CONFIG_SERIAL_BFIN_CONSOLE
1531 * If we are using early serial, don't let the normal console rewind
1532 * log buffer, since that causes things to be printed multiple times
1534 bfin_serial_console
.flags
&= ~CON_PRINTBUFFER
;
1537 bfin_early_serial_console
.index
= port
;
1543 bfin_serial_set_termios(&bfin_earlyprintk_port
.port
, &t
, &t
);
1545 return &bfin_early_serial_console
;
1547 #endif /* CONFIG_EARLY_PRINTK */
1549 static int __init
bfin_serial_init(void)
1553 pr_info("Blackfin serial driver\n");
1555 ret
= uart_register_driver(&bfin_serial_reg
);
1557 pr_err("failed to register %s:%d\n",
1558 bfin_serial_reg
.driver_name
, ret
);
1561 ret
= platform_driver_register(&bfin_serial_driver
);
1563 pr_err("fail to register bfin uart\n");
1564 uart_unregister_driver(&bfin_serial_reg
);
1570 static void __exit
bfin_serial_exit(void)
1572 platform_driver_unregister(&bfin_serial_driver
);
1573 uart_unregister_driver(&bfin_serial_reg
);
1577 module_init(bfin_serial_init
);
1578 module_exit(bfin_serial_exit
);
1580 MODULE_AUTHOR("Sonic Zhang, Aubrey Li");
1581 MODULE_DESCRIPTION("Blackfin generic serial port driver");
1582 MODULE_LICENSE("GPL");
1583 MODULE_ALIAS_CHARDEV_MAJOR(BFIN_SERIAL_MAJOR
);
1584 MODULE_ALIAS("platform:bfin-uart");