blob: 854e96dfb070504d641b3b5401b7f82b3c932597 [file] [log] [blame]
Bryan Wu194de562007-05-06 14:50:30 -07001/*
Mike Frysinger1ba7a3e2008-01-11 15:56:26 +08002 * Blackfin On-Chip Serial Driver
Bryan Wu194de562007-05-06 14:50:30 -07003 *
Mike Frysingerd273e2012008-10-13 10:33:06 +01004 * Copyright 2006-2008 Analog Devices Inc.
Bryan Wu194de562007-05-06 14:50:30 -07005 *
Mike Frysinger1ba7a3e2008-01-11 15:56:26 +08006 * Enter bugs at http://blackfin.uclinux.org/
Bryan Wu194de562007-05-06 14:50:30 -07007 *
Mike Frysinger1ba7a3e2008-01-11 15:56:26 +08008 * Licensed under the GPL-2 or later.
Bryan Wu194de562007-05-06 14:50:30 -07009 */
10
11#if defined(CONFIG_SERIAL_BFIN_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
12#define SUPPORT_SYSRQ
13#endif
14
15#include <linux/module.h>
16#include <linux/ioport.h>
17#include <linux/init.h>
18#include <linux/console.h>
19#include <linux/sysrq.h>
20#include <linux/platform_device.h>
21#include <linux/tty.h>
22#include <linux/tty_flip.h>
23#include <linux/serial_core.h>
24
Sonic Zhang52e15f0e2009-01-02 13:40:14 +000025#if defined(CONFIG_KGDB_SERIAL_CONSOLE) || \
26 defined(CONFIG_KGDB_SERIAL_CONSOLE_MODULE)
Sonic Zhang474f1a62007-06-29 16:35:17 +080027#include <linux/kgdb.h>
28#include <asm/irq_regs.h>
29#endif
30
Bryan Wu194de562007-05-06 14:50:30 -070031#include <asm/gpio.h>
Bryan Wu639f6572008-08-27 10:51:02 +080032#include <mach/bfin_serial_5xx.h>
Bryan Wu194de562007-05-06 14:50:30 -070033
34#ifdef CONFIG_SERIAL_BFIN_DMA
35#include <linux/dma-mapping.h>
36#include <asm/io.h>
37#include <asm/irq.h>
38#include <asm/cacheflush.h>
39#endif
40
41/* UART name and device definitions */
42#define BFIN_SERIAL_NAME "ttyBF"
43#define BFIN_SERIAL_MAJOR 204
44#define BFIN_SERIAL_MINOR 64
45
Mike Frysingerc9607ec2008-10-13 10:33:16 +010046static struct bfin_serial_port bfin_serial_ports[BFIN_UART_NR_PORTS];
47static int nr_active_ports = ARRAY_SIZE(bfin_serial_resource);
48
Sonic Zhang52e15f0e2009-01-02 13:40:14 +000049#if defined(CONFIG_KGDB_SERIAL_CONSOLE) || \
50 defined(CONFIG_KGDB_SERIAL_CONSOLE_MODULE)
51
52# ifndef CONFIG_SERIAL_BFIN_PIO
53# error KGDB only support UART in PIO mode.
54# endif
55
56static int kgdboc_port_line;
57static int kgdboc_break_enabled;
58#endif
Bryan Wu194de562007-05-06 14:50:30 -070059/*
60 * Setup for console. Argument comes from the menuconfig
61 */
62#define DMA_RX_XCOUNT 512
63#define DMA_RX_YCOUNT (PAGE_SIZE / DMA_RX_XCOUNT)
64
Sonic Zhang0aef4562008-02-29 12:08:42 +080065#define DMA_RX_FLUSH_JIFFIES (HZ / 50)
Bryan Wu194de562007-05-06 14:50:30 -070066
67#ifdef CONFIG_SERIAL_BFIN_DMA
68static void bfin_serial_dma_tx_chars(struct bfin_serial_port *uart);
69#else
Bryan Wu194de562007-05-06 14:50:30 -070070static void bfin_serial_tx_chars(struct bfin_serial_port *uart);
Bryan Wu194de562007-05-06 14:50:30 -070071#endif
72
Graf Yang80d5c472009-01-02 13:40:22 +000073static void bfin_serial_reset_irda(struct uart_port *port);
74
Sonic Zhangd307d362009-04-07 16:52:26 +010075#if defined(CONFIG_SERIAL_BFIN_CTSRTS) || \
76 defined(CONFIG_SERIAL_BFIN_HARD_CTSRTS)
77static unsigned int bfin_serial_get_mctrl(struct uart_port *port)
78{
79 struct bfin_serial_port *uart = (struct bfin_serial_port *)port;
80 if (uart->cts_pin < 0)
81 return TIOCM_CTS | TIOCM_DSR | TIOCM_CAR;
82
83 /* CTS PIN is negative assertive. */
84 if (UART_GET_CTS(uart))
85 return TIOCM_CTS | TIOCM_DSR | TIOCM_CAR;
86 else
87 return TIOCM_DSR | TIOCM_CAR;
88}
89
90static void bfin_serial_set_mctrl(struct uart_port *port, unsigned int mctrl)
91{
92 struct bfin_serial_port *uart = (struct bfin_serial_port *)port;
93 if (uart->rts_pin < 0)
94 return;
95
96 /* RTS PIN is negative assertive. */
97 if (mctrl & TIOCM_RTS)
98 UART_ENABLE_RTS(uart);
99 else
100 UART_DISABLE_RTS(uart);
101}
102
103/*
104 * Handle any change of modem status signal.
105 */
106static irqreturn_t bfin_serial_mctrl_cts_int(int irq, void *dev_id)
107{
108 struct bfin_serial_port *uart = dev_id;
109 unsigned int status;
110
111 status = bfin_serial_get_mctrl(&uart->port);
112 uart_handle_cts_change(&uart->port, status & TIOCM_CTS);
113#ifdef CONFIG_SERIAL_BFIN_HARD_CTSRTS
114 uart->scts = 1;
115 UART_CLEAR_SCTS(uart);
116 UART_CLEAR_IER(uart, EDSSI);
117#endif
118
119 return IRQ_HANDLED;
120}
121#else
122static unsigned int bfin_serial_get_mctrl(struct uart_port *port)
123{
124 return TIOCM_CTS | TIOCM_DSR | TIOCM_CAR;
125}
126
127static void bfin_serial_set_mctrl(struct uart_port *port, unsigned int mctrl)
128{
129}
130#endif
131
Bryan Wu194de562007-05-06 14:50:30 -0700132/*
133 * interrupts are disabled on entry
134 */
135static void bfin_serial_stop_tx(struct uart_port *port)
136{
137 struct bfin_serial_port *uart = (struct bfin_serial_port *)port;
Sonic Zhang68a784c2009-01-02 13:40:38 +0000138#ifdef CONFIG_SERIAL_BFIN_DMA
Sonic Zhang0711d852008-02-25 15:16:50 +0800139 struct circ_buf *xmit = &uart->port.info->xmit;
Sonic Zhang68a784c2009-01-02 13:40:38 +0000140#endif
Bryan Wu194de562007-05-06 14:50:30 -0700141
Roy Huangf4d640c92007-07-12 16:43:46 +0800142 while (!(UART_GET_LSR(uart) & TEMT))
Sonic Zhang0711d852008-02-25 15:16:50 +0800143 cpu_relax();
Roy Huangf4d640c92007-07-12 16:43:46 +0800144
Bryan Wu194de562007-05-06 14:50:30 -0700145#ifdef CONFIG_SERIAL_BFIN_DMA
146 disable_dma(uart->tx_dma_channel);
Sonic Zhang0711d852008-02-25 15:16:50 +0800147 xmit->tail = (xmit->tail + uart->tx_count) & (UART_XMIT_SIZE - 1);
148 uart->port.icount.tx += uart->tx_count;
149 uart->tx_count = 0;
150 uart->tx_done = 1;
Bryan Wu194de562007-05-06 14:50:30 -0700151#else
Roy Huangf4d640c92007-07-12 16:43:46 +0800152#ifdef CONFIG_BF54x
Roy Huangf4d640c92007-07-12 16:43:46 +0800153 /* Clear TFI bit */
154 UART_PUT_LSR(uart, TFI);
Bryan Wu194de562007-05-06 14:50:30 -0700155#endif
Mike Frysinger89bf6dc52008-05-07 11:41:26 +0800156 UART_CLEAR_IER(uart, ETBEI);
Roy Huangf4d640c92007-07-12 16:43:46 +0800157#endif
Bryan Wu194de562007-05-06 14:50:30 -0700158}
159
160/*
161 * port is locked and interrupts are disabled
162 */
163static void bfin_serial_start_tx(struct uart_port *port)
164{
165 struct bfin_serial_port *uart = (struct bfin_serial_port *)port;
Graf Yang80d5c472009-01-02 13:40:22 +0000166 struct tty_struct *tty = uart->port.info->port.tty;
167
Sonic Zhangd307d362009-04-07 16:52:26 +0100168#ifdef CONFIG_SERIAL_BFIN_HARD_CTSRTS
Roel Kluindaba0282009-04-21 12:24:58 -0700169 if (uart->scts && !(bfin_serial_get_mctrl(&uart->port) & TIOCM_CTS)) {
Sonic Zhangd307d362009-04-07 16:52:26 +0100170 uart->scts = 0;
171 uart_handle_cts_change(&uart->port, uart->scts);
172 }
173#endif
174
Graf Yang80d5c472009-01-02 13:40:22 +0000175 /*
176 * To avoid losting RX interrupt, we reset IR function
177 * before sending data.
178 */
179 if (tty->termios->c_line == N_IRDA)
180 bfin_serial_reset_irda(port);
Bryan Wu194de562007-05-06 14:50:30 -0700181
182#ifdef CONFIG_SERIAL_BFIN_DMA
Sonic Zhang0711d852008-02-25 15:16:50 +0800183 if (uart->tx_done)
184 bfin_serial_dma_tx_chars(uart);
Bryan Wu194de562007-05-06 14:50:30 -0700185#else
Roy Huangf4d640c92007-07-12 16:43:46 +0800186 UART_SET_IER(uart, ETBEI);
Sonic Zhanga359cca2007-10-10 16:47:58 +0800187 bfin_serial_tx_chars(uart);
Roy Huangf4d640c92007-07-12 16:43:46 +0800188#endif
Bryan Wu194de562007-05-06 14:50:30 -0700189}
190
191/*
192 * Interrupts are enabled
193 */
194static void bfin_serial_stop_rx(struct uart_port *port)
195{
196 struct bfin_serial_port *uart = (struct bfin_serial_port *)port;
Sonic Zhang52e15f0e2009-01-02 13:40:14 +0000197
Roy Huangf4d640c92007-07-12 16:43:46 +0800198 UART_CLEAR_IER(uart, ERBFI);
Bryan Wu194de562007-05-06 14:50:30 -0700199}
200
201/*
202 * Set the modem control timer to fire immediately.
203 */
204static void bfin_serial_enable_ms(struct uart_port *port)
205{
206}
207
Sonic Zhang474f1a62007-06-29 16:35:17 +0800208
Mike Frysinger50e2e152008-04-25 03:03:03 +0800209#if ANOMALY_05000363 && defined(CONFIG_SERIAL_BFIN_PIO)
Mike Frysinger8851c712007-12-24 19:48:04 +0800210# define UART_GET_ANOMALY_THRESHOLD(uart) ((uart)->anomaly_threshold)
211# define UART_SET_ANOMALY_THRESHOLD(uart, v) ((uart)->anomaly_threshold = (v))
212#else
213# define UART_GET_ANOMALY_THRESHOLD(uart) 0
214# define UART_SET_ANOMALY_THRESHOLD(uart, v)
215#endif
216
Bryan Wu194de562007-05-06 14:50:30 -0700217#ifdef CONFIG_SERIAL_BFIN_PIO
Bryan Wu194de562007-05-06 14:50:30 -0700218static void bfin_serial_rx_chars(struct bfin_serial_port *uart)
219{
Sonic Zhang52e15f0e2009-01-02 13:40:14 +0000220 struct tty_struct *tty = NULL;
Bryan Wu194de562007-05-06 14:50:30 -0700221 unsigned int status, ch, flg;
Mike Frysinger8851c712007-12-24 19:48:04 +0800222 static struct timeval anomaly_start = { .tv_sec = 0 };
Bryan Wu194de562007-05-06 14:50:30 -0700223
Sonic Zhang759eb042007-11-21 17:00:32 +0800224 status = UART_GET_LSR(uart);
Mike Frysinger0bcfd702007-12-24 19:40:05 +0800225 UART_CLEAR_LSR(uart);
226
227 ch = UART_GET_CHAR(uart);
Bryan Wu194de562007-05-06 14:50:30 -0700228 uart->port.icount.rx++;
229
Sonic Zhang52e15f0e2009-01-02 13:40:14 +0000230#if defined(CONFIG_KGDB_SERIAL_CONSOLE) || \
231 defined(CONFIG_KGDB_SERIAL_CONSOLE_MODULE)
232 if (kgdb_connected && kgdboc_port_line == uart->port.line)
233 if (ch == 0x3) {/* Ctrl + C */
234 kgdb_breakpoint();
Sonic Zhang474f1a62007-06-29 16:35:17 +0800235 return;
Sonic Zhang474f1a62007-06-29 16:35:17 +0800236 }
Sonic Zhang52e15f0e2009-01-02 13:40:14 +0000237
Sonic Zhangdf04baf2009-04-06 17:32:35 +0100238 if (!uart->port.info || !uart->port.info->port.tty)
Sonic Zhang52e15f0e2009-01-02 13:40:14 +0000239 return;
Sonic Zhang474f1a62007-06-29 16:35:17 +0800240#endif
Sonic Zhangdf04baf2009-04-06 17:32:35 +0100241 tty = uart->port.info->port.tty;
Mike Frysingerbbf275f2007-08-05 16:48:08 +0800242
Mike Frysinger50e2e152008-04-25 03:03:03 +0800243 if (ANOMALY_05000363) {
Mike Frysinger8851c712007-12-24 19:48:04 +0800244 /* The BF533 (and BF561) family of processors have a nice anomaly
245 * where they continuously generate characters for a "single" break.
Mike Frysingerbbf275f2007-08-05 16:48:08 +0800246 * We have to basically ignore this flood until the "next" valid
Mike Frysinger8851c712007-12-24 19:48:04 +0800247 * character comes across. Due to the nature of the flood, it is
248 * not possible to reliably catch bytes that are sent too quickly
249 * after this break. So application code talking to the Blackfin
250 * which sends a break signal must allow at least 1.5 character
251 * times after the end of the break for things to stabilize. This
252 * timeout was picked as it must absolutely be larger than 1
253 * character time +/- some percent. So 1.5 sounds good. All other
254 * Blackfin families operate properly. Woo.
Mike Frysingerbbf275f2007-08-05 16:48:08 +0800255 */
Mike Frysinger8851c712007-12-24 19:48:04 +0800256 if (anomaly_start.tv_sec) {
257 struct timeval curr;
258 suseconds_t usecs;
259
260 if ((~ch & (~ch + 1)) & 0xff)
261 goto known_good_char;
262
263 do_gettimeofday(&curr);
264 if (curr.tv_sec - anomaly_start.tv_sec > 1)
265 goto known_good_char;
266
267 usecs = 0;
268 if (curr.tv_sec != anomaly_start.tv_sec)
269 usecs += USEC_PER_SEC;
270 usecs += curr.tv_usec - anomaly_start.tv_usec;
271
272 if (usecs > UART_GET_ANOMALY_THRESHOLD(uart))
273 goto known_good_char;
274
275 if (ch)
276 anomaly_start.tv_sec = 0;
277 else
278 anomaly_start = curr;
279
280 return;
281
282 known_good_char:
Sonic Zhange482a232009-01-02 13:40:45 +0000283 status &= ~BI;
Mike Frysinger8851c712007-12-24 19:48:04 +0800284 anomaly_start.tv_sec = 0;
Mike Frysingerbbf275f2007-08-05 16:48:08 +0800285 }
Bryan Wu194de562007-05-06 14:50:30 -0700286 }
Bryan Wu194de562007-05-06 14:50:30 -0700287
288 if (status & BI) {
Mike Frysinger50e2e152008-04-25 03:03:03 +0800289 if (ANOMALY_05000363)
Mike Frysinger8851c712007-12-24 19:48:04 +0800290 if (bfin_revid() < 5)
291 do_gettimeofday(&anomaly_start);
Bryan Wu194de562007-05-06 14:50:30 -0700292 uart->port.icount.brk++;
293 if (uart_handle_break(&uart->port))
294 goto ignore_char;
Mike Frysinger98089012007-06-11 15:31:30 +0800295 status &= ~(PE | FE);
Mike Frysinger2ac5ee42007-05-21 18:09:39 +0800296 }
297 if (status & PE)
Bryan Wu194de562007-05-06 14:50:30 -0700298 uart->port.icount.parity++;
Mike Frysinger2ac5ee42007-05-21 18:09:39 +0800299 if (status & OE)
Bryan Wu194de562007-05-06 14:50:30 -0700300 uart->port.icount.overrun++;
Mike Frysinger2ac5ee42007-05-21 18:09:39 +0800301 if (status & FE)
Bryan Wu194de562007-05-06 14:50:30 -0700302 uart->port.icount.frame++;
Mike Frysinger2ac5ee42007-05-21 18:09:39 +0800303
304 status &= uart->port.read_status_mask;
305
306 if (status & BI)
307 flg = TTY_BREAK;
308 else if (status & PE)
309 flg = TTY_PARITY;
310 else if (status & FE)
311 flg = TTY_FRAME;
312 else
Bryan Wu194de562007-05-06 14:50:30 -0700313 flg = TTY_NORMAL;
314
315 if (uart_handle_sysrq_char(&uart->port, ch))
316 goto ignore_char;
Bryan Wu194de562007-05-06 14:50:30 -0700317
Mike Frysinger2ac5ee42007-05-21 18:09:39 +0800318 uart_insert_char(&uart->port, status, OE, ch, flg);
319
320 ignore_char:
321 tty_flip_buffer_push(tty);
Bryan Wu194de562007-05-06 14:50:30 -0700322}
323
324static void bfin_serial_tx_chars(struct bfin_serial_port *uart)
325{
326 struct circ_buf *xmit = &uart->port.info->xmit;
327
Bryan Wu194de562007-05-06 14:50:30 -0700328 if (uart_circ_empty(xmit) || uart_tx_stopped(&uart->port)) {
Sonic Zhang5ffdeea22008-10-13 10:33:33 +0100329#ifdef CONFIG_BF54x
330 /* Clear TFI bit */
331 UART_PUT_LSR(uart, TFI);
332#endif
333 UART_CLEAR_IER(uart, ETBEI);
Bryan Wu194de562007-05-06 14:50:30 -0700334 return;
335 }
336
Sonic Zhangf30ac0c2008-06-19 17:46:39 +0800337 if (uart->port.x_char) {
338 UART_PUT_CHAR(uart, uart->port.x_char);
339 uart->port.icount.tx++;
340 uart->port.x_char = 0;
341 }
342
Sonic Zhang759eb042007-11-21 17:00:32 +0800343 while ((UART_GET_LSR(uart) & THRE) && xmit->tail != xmit->head) {
344 UART_PUT_CHAR(uart, xmit->buf[xmit->tail]);
345 xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
346 uart->port.icount.tx++;
347 SSYNC();
348 }
Bryan Wu194de562007-05-06 14:50:30 -0700349
350 if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
351 uart_write_wakeup(&uart->port);
Bryan Wu194de562007-05-06 14:50:30 -0700352}
353
Aubrey Li5c4e4722007-05-21 18:09:38 +0800354static irqreturn_t bfin_serial_rx_int(int irq, void *dev_id)
355{
356 struct bfin_serial_port *uart = dev_id;
357
Roy Huangf4d640c92007-07-12 16:43:46 +0800358 spin_lock(&uart->port.lock);
Mike Frysinger0bcfd702007-12-24 19:40:05 +0800359 while (UART_GET_LSR(uart) & DR)
Aubrey Li5c4e4722007-05-21 18:09:38 +0800360 bfin_serial_rx_chars(uart);
361 spin_unlock(&uart->port.lock);
Sonic Zhang759eb042007-11-21 17:00:32 +0800362
Aubrey Li5c4e4722007-05-21 18:09:38 +0800363 return IRQ_HANDLED;
364}
365
366static irqreturn_t bfin_serial_tx_int(int irq, void *dev_id)
Bryan Wu194de562007-05-06 14:50:30 -0700367{
368 struct bfin_serial_port *uart = dev_id;
Bryan Wu194de562007-05-06 14:50:30 -0700369
Sonic Zhangd307d362009-04-07 16:52:26 +0100370#ifdef CONFIG_SERIAL_BFIN_HARD_CTSRTS
Roel Kluindaba0282009-04-21 12:24:58 -0700371 if (uart->scts && !(bfin_serial_get_mctrl(&uart->port) & TIOCM_CTS)) {
Sonic Zhangd307d362009-04-07 16:52:26 +0100372 uart->scts = 0;
373 uart_handle_cts_change(&uart->port, uart->scts);
374 }
375#endif
Roy Huangf4d640c92007-07-12 16:43:46 +0800376 spin_lock(&uart->port.lock);
Mike Frysinger0bcfd702007-12-24 19:40:05 +0800377 if (UART_GET_LSR(uart) & THRE)
Aubrey Li5c4e4722007-05-21 18:09:38 +0800378 bfin_serial_tx_chars(uart);
Bryan Wu194de562007-05-06 14:50:30 -0700379 spin_unlock(&uart->port.lock);
Sonic Zhang759eb042007-11-21 17:00:32 +0800380
Bryan Wu194de562007-05-06 14:50:30 -0700381 return IRQ_HANDLED;
382}
Sonic Zhang4cb4f222008-02-02 14:29:25 +0800383#endif
Bryan Wu194de562007-05-06 14:50:30 -0700384
Bryan Wu194de562007-05-06 14:50:30 -0700385#ifdef CONFIG_SERIAL_BFIN_DMA
386static void bfin_serial_dma_tx_chars(struct bfin_serial_port *uart)
387{
388 struct circ_buf *xmit = &uart->port.info->xmit;
Bryan Wu194de562007-05-06 14:50:30 -0700389
Bryan Wu194de562007-05-06 14:50:30 -0700390 uart->tx_done = 0;
391
Bryan Wu194de562007-05-06 14:50:30 -0700392 if (uart_circ_empty(xmit) || uart_tx_stopped(&uart->port)) {
Sonic Zhang0711d852008-02-25 15:16:50 +0800393 uart->tx_count = 0;
Bryan Wu194de562007-05-06 14:50:30 -0700394 uart->tx_done = 1;
395 return;
396 }
397
Sonic Zhang1b733512007-12-21 16:45:12 +0800398 if (uart->port.x_char) {
399 UART_PUT_CHAR(uart, uart->port.x_char);
400 uart->port.icount.tx++;
401 uart->port.x_char = 0;
402 }
403
Bryan Wu194de562007-05-06 14:50:30 -0700404 uart->tx_count = CIRC_CNT(xmit->head, xmit->tail, UART_XMIT_SIZE);
405 if (uart->tx_count > (UART_XMIT_SIZE - xmit->tail))
406 uart->tx_count = UART_XMIT_SIZE - xmit->tail;
407 blackfin_dcache_flush_range((unsigned long)(xmit->buf+xmit->tail),
408 (unsigned long)(xmit->buf+xmit->tail+uart->tx_count));
409 set_dma_config(uart->tx_dma_channel,
410 set_bfin_dma_config(DIR_READ, DMA_FLOW_STOP,
411 INTR_ON_BUF,
412 DIMENSION_LINEAR,
Michael Hennerich2047e402008-01-22 15:29:18 +0800413 DATA_SIZE_8,
414 DMA_SYNC_RESTART));
Bryan Wu194de562007-05-06 14:50:30 -0700415 set_dma_start_addr(uart->tx_dma_channel, (unsigned long)(xmit->buf+xmit->tail));
416 set_dma_x_count(uart->tx_dma_channel, uart->tx_count);
417 set_dma_x_modify(uart->tx_dma_channel, 1);
Graf Yangf9d36da2009-06-11 13:42:17 +0100418 SSYNC();
Bryan Wu194de562007-05-06 14:50:30 -0700419 enable_dma(uart->tx_dma_channel);
Sonic Zhang99ee7b52007-12-21 17:12:55 +0800420
Roy Huangf4d640c92007-07-12 16:43:46 +0800421 UART_SET_IER(uart, ETBEI);
Bryan Wu194de562007-05-06 14:50:30 -0700422}
423
Mike Frysinger2ac5ee42007-05-21 18:09:39 +0800424static void bfin_serial_dma_rx_chars(struct bfin_serial_port *uart)
Bryan Wu194de562007-05-06 14:50:30 -0700425{
Takashi Iwaia88487c2008-07-16 21:54:42 +0100426 struct tty_struct *tty = uart->port.info->port.tty;
Bryan Wu194de562007-05-06 14:50:30 -0700427 int i, flg, status;
428
429 status = UART_GET_LSR(uart);
Mike Frysinger0bcfd702007-12-24 19:40:05 +0800430 UART_CLEAR_LSR(uart);
431
Sonic Zhang56f5de82008-02-25 15:19:09 +0800432 uart->port.icount.rx +=
433 CIRC_CNT(uart->rx_dma_buf.head, uart->rx_dma_buf.tail,
434 UART_XMIT_SIZE);
Bryan Wu194de562007-05-06 14:50:30 -0700435
436 if (status & BI) {
437 uart->port.icount.brk++;
438 if (uart_handle_break(&uart->port))
439 goto dma_ignore_char;
Mike Frysinger98089012007-06-11 15:31:30 +0800440 status &= ~(PE | FE);
Mike Frysinger2ac5ee42007-05-21 18:09:39 +0800441 }
442 if (status & PE)
Bryan Wu194de562007-05-06 14:50:30 -0700443 uart->port.icount.parity++;
Mike Frysinger2ac5ee42007-05-21 18:09:39 +0800444 if (status & OE)
Bryan Wu194de562007-05-06 14:50:30 -0700445 uart->port.icount.overrun++;
Mike Frysinger2ac5ee42007-05-21 18:09:39 +0800446 if (status & FE)
Bryan Wu194de562007-05-06 14:50:30 -0700447 uart->port.icount.frame++;
Mike Frysinger2ac5ee42007-05-21 18:09:39 +0800448
449 status &= uart->port.read_status_mask;
450
451 if (status & BI)
452 flg = TTY_BREAK;
453 else if (status & PE)
454 flg = TTY_PARITY;
455 else if (status & FE)
456 flg = TTY_FRAME;
457 else
Bryan Wu194de562007-05-06 14:50:30 -0700458 flg = TTY_NORMAL;
459
Sonic Zhang8c4210e2009-04-06 17:32:42 +0100460 for (i = uart->rx_dma_buf.tail; ; i++) {
Sonic Zhang56f5de82008-02-25 15:19:09 +0800461 if (i >= UART_XMIT_SIZE)
462 i = 0;
Sonic Zhang8c4210e2009-04-06 17:32:42 +0100463 if (i == uart->rx_dma_buf.head)
464 break;
Sonic Zhang56f5de82008-02-25 15:19:09 +0800465 if (!uart_handle_sysrq_char(&uart->port, uart->rx_dma_buf.buf[i]))
466 uart_insert_char(&uart->port, status, OE,
467 uart->rx_dma_buf.buf[i], flg);
Bryan Wu194de562007-05-06 14:50:30 -0700468 }
Mike Frysinger2ac5ee42007-05-21 18:09:39 +0800469
470 dma_ignore_char:
Bryan Wu194de562007-05-06 14:50:30 -0700471 tty_flip_buffer_push(tty);
472}
473
474void bfin_serial_rx_dma_timeout(struct bfin_serial_port *uart)
475{
Mike Frysinger59e4e3e2009-04-06 17:32:28 +0100476 int x_pos, pos;
477 unsigned long flags;
Sonic Zhang68a784c2009-01-02 13:40:38 +0000478
479 spin_lock_irqsave(&uart->port.lock, flags);
Bryan Wu194de562007-05-06 14:50:30 -0700480
Sonic Zhang8516c562009-06-11 13:38:16 +0100481 /* 2D DMA RX buffer ring is used. Because curr_y_count and
482 * curr_x_count can't be read as an atomic operation,
483 * curr_y_count should be read before curr_x_count. When
484 * curr_x_count is read, curr_y_count may already indicate
485 * next buffer line. But, the position calculated here is
486 * still indicate the old line. The wrong position data may
487 * be smaller than current buffer tail, which cause garbages
488 * are received if it is not prohibit.
489 */
Sonic Zhang56f5de82008-02-25 15:19:09 +0800490 uart->rx_dma_nrows = get_dma_curr_ycount(uart->rx_dma_channel);
491 x_pos = get_dma_curr_xcount(uart->rx_dma_channel);
492 uart->rx_dma_nrows = DMA_RX_YCOUNT - uart->rx_dma_nrows;
Sonic Zhang35ff6932009-06-11 13:42:57 +0100493 if (uart->rx_dma_nrows == DMA_RX_YCOUNT || x_pos == 0)
Sonic Zhang56f5de82008-02-25 15:19:09 +0800494 uart->rx_dma_nrows = 0;
495 x_pos = DMA_RX_XCOUNT - x_pos;
Bryan Wu194de562007-05-06 14:50:30 -0700496 if (x_pos == DMA_RX_XCOUNT)
497 x_pos = 0;
498
499 pos = uart->rx_dma_nrows * DMA_RX_XCOUNT + x_pos;
Sonic Zhang8516c562009-06-11 13:38:16 +0100500 /* Ignore receiving data if new position is in the same line of
501 * current buffer tail and small.
502 */
503 if (pos > uart->rx_dma_buf.tail ||
504 uart->rx_dma_nrows < (uart->rx_dma_buf.tail/DMA_RX_XCOUNT)) {
Sonic Zhang56f5de82008-02-25 15:19:09 +0800505 uart->rx_dma_buf.head = pos;
Bryan Wu194de562007-05-06 14:50:30 -0700506 bfin_serial_dma_rx_chars(uart);
Sonic Zhang56f5de82008-02-25 15:19:09 +0800507 uart->rx_dma_buf.tail = uart->rx_dma_buf.head;
Bryan Wu194de562007-05-06 14:50:30 -0700508 }
Sonic Zhang0aef4562008-02-29 12:08:42 +0800509
Sonic Zhang68a784c2009-01-02 13:40:38 +0000510 spin_unlock_irqrestore(&uart->port.lock, flags);
511
Sonic Zhang0a278422008-04-25 04:36:47 +0800512 mod_timer(&(uart->rx_dma_timer), jiffies + DMA_RX_FLUSH_JIFFIES);
Bryan Wu194de562007-05-06 14:50:30 -0700513}
514
515static irqreturn_t bfin_serial_dma_tx_int(int irq, void *dev_id)
516{
517 struct bfin_serial_port *uart = dev_id;
518 struct circ_buf *xmit = &uart->port.info->xmit;
Bryan Wu194de562007-05-06 14:50:30 -0700519
Sonic Zhangd307d362009-04-07 16:52:26 +0100520#ifdef CONFIG_SERIAL_BFIN_HARD_CTSRTS
Roel Kluindaba0282009-04-21 12:24:58 -0700521 if (uart->scts && !(bfin_serial_get_mctrl(&uart->port)&TIOCM_CTS)) {
Sonic Zhangd307d362009-04-07 16:52:26 +0100522 uart->scts = 0;
523 uart_handle_cts_change(&uart->port, uart->scts);
524 }
525#endif
526
Bryan Wu194de562007-05-06 14:50:30 -0700527 spin_lock(&uart->port.lock);
528 if (!(get_dma_curr_irqstat(uart->tx_dma_channel)&DMA_RUN)) {
Bryan Wu194de562007-05-06 14:50:30 -0700529 disable_dma(uart->tx_dma_channel);
Sonic Zhang0711d852008-02-25 15:16:50 +0800530 clear_dma_irqstat(uart->tx_dma_channel);
Roy Huangf4d640c92007-07-12 16:43:46 +0800531 UART_CLEAR_IER(uart, ETBEI);
Sonic Zhang0711d852008-02-25 15:16:50 +0800532 xmit->tail = (xmit->tail + uart->tx_count) & (UART_XMIT_SIZE - 1);
533 uart->port.icount.tx += uart->tx_count;
Sonic Zhang1b733512007-12-21 16:45:12 +0800534
Sonic Zhang56f5de82008-02-25 15:19:09 +0800535 if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
536 uart_write_wakeup(&uart->port);
537
Sonic Zhang1b733512007-12-21 16:45:12 +0800538 bfin_serial_dma_tx_chars(uart);
Bryan Wu194de562007-05-06 14:50:30 -0700539 }
540
541 spin_unlock(&uart->port.lock);
542 return IRQ_HANDLED;
543}
544
545static irqreturn_t bfin_serial_dma_rx_int(int irq, void *dev_id)
546{
547 struct bfin_serial_port *uart = dev_id;
548 unsigned short irqstat;
Sonic Zhang35ff6932009-06-11 13:42:57 +0100549 int x_pos, pos;
Sonic Zhang0711d852008-02-25 15:16:50 +0800550
Bryan Wu194de562007-05-06 14:50:30 -0700551 spin_lock(&uart->port.lock);
552 irqstat = get_dma_curr_irqstat(uart->rx_dma_channel);
553 clear_dma_irqstat(uart->rx_dma_channel);
Sonic Zhang8516c562009-06-11 13:38:16 +0100554
555 uart->rx_dma_nrows = get_dma_curr_ycount(uart->rx_dma_channel);
Sonic Zhang35ff6932009-06-11 13:42:57 +0100556 x_pos = get_dma_curr_xcount(uart->rx_dma_channel);
Sonic Zhang8516c562009-06-11 13:38:16 +0100557 uart->rx_dma_nrows = DMA_RX_YCOUNT - uart->rx_dma_nrows;
Sonic Zhang35ff6932009-06-11 13:42:57 +0100558 if (uart->rx_dma_nrows == DMA_RX_YCOUNT || x_pos == 0)
Sonic Zhang8516c562009-06-11 13:38:16 +0100559 uart->rx_dma_nrows = 0;
560
561 pos = uart->rx_dma_nrows * DMA_RX_XCOUNT;
562 if (pos > uart->rx_dma_buf.tail ||
563 uart->rx_dma_nrows < (uart->rx_dma_buf.tail/DMA_RX_XCOUNT)) {
564 uart->rx_dma_buf.head = pos;
565 bfin_serial_dma_rx_chars(uart);
566 uart->rx_dma_buf.tail = uart->rx_dma_buf.head;
567 }
568
Bryan Wu194de562007-05-06 14:50:30 -0700569 spin_unlock(&uart->port.lock);
Sonic Zhang0aef4562008-02-29 12:08:42 +0800570
Bryan Wu194de562007-05-06 14:50:30 -0700571 return IRQ_HANDLED;
572}
573#endif
574
575/*
576 * Return TIOCSER_TEMT when transmitter is not busy.
577 */
578static unsigned int bfin_serial_tx_empty(struct uart_port *port)
579{
580 struct bfin_serial_port *uart = (struct bfin_serial_port *)port;
581 unsigned short lsr;
582
583 lsr = UART_GET_LSR(uart);
584 if (lsr & TEMT)
585 return TIOCSER_TEMT;
586 else
587 return 0;
588}
589
Bryan Wu194de562007-05-06 14:50:30 -0700590static void bfin_serial_break_ctl(struct uart_port *port, int break_state)
591{
Mike Frysingercf686762007-06-11 16:12:49 +0800592 struct bfin_serial_port *uart = (struct bfin_serial_port *)port;
593 u16 lcr = UART_GET_LCR(uart);
594 if (break_state)
595 lcr |= SB;
596 else
597 lcr &= ~SB;
598 UART_PUT_LCR(uart, lcr);
599 SSYNC();
Bryan Wu194de562007-05-06 14:50:30 -0700600}
601
602static int bfin_serial_startup(struct uart_port *port)
603{
604 struct bfin_serial_port *uart = (struct bfin_serial_port *)port;
605
606#ifdef CONFIG_SERIAL_BFIN_DMA
607 dma_addr_t dma_handle;
608
609 if (request_dma(uart->rx_dma_channel, "BFIN_UART_RX") < 0) {
610 printk(KERN_NOTICE "Unable to attach Blackfin UART RX DMA channel\n");
611 return -EBUSY;
612 }
613
614 if (request_dma(uart->tx_dma_channel, "BFIN_UART_TX") < 0) {
615 printk(KERN_NOTICE "Unable to attach Blackfin UART TX DMA channel\n");
616 free_dma(uart->rx_dma_channel);
617 return -EBUSY;
618 }
619
620 set_dma_callback(uart->rx_dma_channel, bfin_serial_dma_rx_int, uart);
621 set_dma_callback(uart->tx_dma_channel, bfin_serial_dma_tx_int, uart);
622
623 uart->rx_dma_buf.buf = (unsigned char *)dma_alloc_coherent(NULL, PAGE_SIZE, &dma_handle, GFP_DMA);
624 uart->rx_dma_buf.head = 0;
625 uart->rx_dma_buf.tail = 0;
626 uart->rx_dma_nrows = 0;
627
628 set_dma_config(uart->rx_dma_channel,
629 set_bfin_dma_config(DIR_WRITE, DMA_FLOW_AUTO,
630 INTR_ON_ROW, DIMENSION_2D,
Michael Hennerich2047e402008-01-22 15:29:18 +0800631 DATA_SIZE_8,
632 DMA_SYNC_RESTART));
Bryan Wu194de562007-05-06 14:50:30 -0700633 set_dma_x_count(uart->rx_dma_channel, DMA_RX_XCOUNT);
634 set_dma_x_modify(uart->rx_dma_channel, 1);
635 set_dma_y_count(uart->rx_dma_channel, DMA_RX_YCOUNT);
636 set_dma_y_modify(uart->rx_dma_channel, 1);
637 set_dma_start_addr(uart->rx_dma_channel, (unsigned long)uart->rx_dma_buf.buf);
638 enable_dma(uart->rx_dma_channel);
639
640 uart->rx_dma_timer.data = (unsigned long)(uart);
641 uart->rx_dma_timer.function = (void *)bfin_serial_rx_dma_timeout;
642 uart->rx_dma_timer.expires = jiffies + DMA_RX_FLUSH_JIFFIES;
643 add_timer(&(uart->rx_dma_timer));
644#else
Sonic Zhang6f955702009-04-07 16:51:15 +0100645# if defined(CONFIG_KGDB_SERIAL_CONSOLE) || \
Sonic Zhang52e15f0e2009-01-02 13:40:14 +0000646 defined(CONFIG_KGDB_SERIAL_CONSOLE_MODULE)
647 if (kgdboc_port_line == uart->port.line && kgdboc_break_enabled)
648 kgdboc_break_enabled = 0;
649 else {
650# endif
Sonic Zhanga359cca2007-10-10 16:47:58 +0800651 if (request_irq(uart->port.irq, bfin_serial_rx_int, IRQF_DISABLED,
Bryan Wu194de562007-05-06 14:50:30 -0700652 "BFIN_UART_RX", uart)) {
653 printk(KERN_NOTICE "Unable to attach BlackFin UART RX interrupt\n");
654 return -EBUSY;
655 }
656
657 if (request_irq
Aubrey Li5c4e4722007-05-21 18:09:38 +0800658 (uart->port.irq+1, bfin_serial_tx_int, IRQF_DISABLED,
Bryan Wu194de562007-05-06 14:50:30 -0700659 "BFIN_UART_TX", uart)) {
660 printk(KERN_NOTICE "Unable to attach BlackFin UART TX interrupt\n");
661 free_irq(uart->port.irq, uart);
662 return -EBUSY;
663 }
Sonic Zhangab2375f2008-10-13 10:33:51 +0100664
665# ifdef CONFIG_BF54x
666 {
667 unsigned uart_dma_ch_rx, uart_dma_ch_tx;
668
669 switch (uart->port.irq) {
670 case IRQ_UART3_RX:
671 uart_dma_ch_rx = CH_UART3_RX;
672 uart_dma_ch_tx = CH_UART3_TX;
673 break;
674 case IRQ_UART2_RX:
675 uart_dma_ch_rx = CH_UART2_RX;
676 uart_dma_ch_tx = CH_UART2_TX;
677 break;
678 default:
679 uart_dma_ch_rx = uart_dma_ch_tx = 0;
680 break;
681 };
682
683 if (uart_dma_ch_rx &&
684 request_dma(uart_dma_ch_rx, "BFIN_UART_RX") < 0) {
685 printk(KERN_NOTICE"Fail to attach UART interrupt\n");
686 free_irq(uart->port.irq, uart);
687 free_irq(uart->port.irq + 1, uart);
688 return -EBUSY;
689 }
690 if (uart_dma_ch_tx &&
691 request_dma(uart_dma_ch_tx, "BFIN_UART_TX") < 0) {
692 printk(KERN_NOTICE "Fail to attach UART interrupt\n");
693 free_dma(uart_dma_ch_rx);
694 free_irq(uart->port.irq, uart);
695 free_irq(uart->port.irq + 1, uart);
696 return -EBUSY;
697 }
698 }
699# endif
Sonic Zhang6f955702009-04-07 16:51:15 +0100700# if defined(CONFIG_KGDB_SERIAL_CONSOLE) || \
Sonic Zhang52e15f0e2009-01-02 13:40:14 +0000701 defined(CONFIG_KGDB_SERIAL_CONSOLE_MODULE)
702 }
703# endif
Bryan Wu194de562007-05-06 14:50:30 -0700704#endif
Sonic Zhang6f955702009-04-07 16:51:15 +0100705
706#ifdef CONFIG_SERIAL_BFIN_CTSRTS
707 if (uart->cts_pin >= 0) {
708 if (request_irq(gpio_to_irq(uart->cts_pin),
709 bfin_serial_mctrl_cts_int,
710 IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING |
711 IRQF_DISABLED, "BFIN_UART_CTS", uart)) {
712 uart->cts_pin = -1;
713 pr_info("Unable to attach BlackFin UART CTS interrupt.\
714 So, disable it.\n");
715 }
716 }
717 if (uart->rts_pin >= 0) {
718 gpio_request(uart->rts_pin, DRIVER_NAME);
719 gpio_direction_output(uart->rts_pin, 0);
720 }
721#endif
Sonic Zhangd307d362009-04-07 16:52:26 +0100722#ifdef CONFIG_SERIAL_BFIN_HARD_CTSRTS
723 if (request_irq(uart->status_irq,
724 bfin_serial_mctrl_cts_int,
725 IRQF_DISABLED, "BFIN_UART_MODEM_STATUS", uart)) {
726 pr_info("Unable to attach BlackFin UART Modem \
727 Status interrupt.\n");
728 }
729
730 if (uart->cts_pin >= 0) {
731 gpio_request(uart->cts_pin, DRIVER_NAME);
732 gpio_direction_output(uart->cts_pin, 1);
733 }
734 if (uart->rts_pin >= 0) {
735 gpio_request(uart->rts_pin, DRIVER_NAME);
736 gpio_direction_output(uart->rts_pin, 0);
737 }
738
739 /* CTS RTS PINs are negative assertive. */
740 UART_PUT_MCR(uart, ACTS);
741 UART_SET_IER(uart, EDSSI);
742#endif
743
Roy Huangf4d640c92007-07-12 16:43:46 +0800744 UART_SET_IER(uart, ERBFI);
Bryan Wu194de562007-05-06 14:50:30 -0700745 return 0;
746}
747
748static void bfin_serial_shutdown(struct uart_port *port)
749{
750 struct bfin_serial_port *uart = (struct bfin_serial_port *)port;
751
752#ifdef CONFIG_SERIAL_BFIN_DMA
753 disable_dma(uart->tx_dma_channel);
754 free_dma(uart->tx_dma_channel);
755 disable_dma(uart->rx_dma_channel);
756 free_dma(uart->rx_dma_channel);
757 del_timer(&(uart->rx_dma_timer));
Sonic Zhang75b780b2007-12-21 17:03:39 +0800758 dma_free_coherent(NULL, PAGE_SIZE, uart->rx_dma_buf.buf, 0);
Bryan Wu194de562007-05-06 14:50:30 -0700759#else
Sonic Zhangab2375f2008-10-13 10:33:51 +0100760#ifdef CONFIG_BF54x
761 switch (uart->port.irq) {
762 case IRQ_UART3_RX:
763 free_dma(CH_UART3_RX);
764 free_dma(CH_UART3_TX);
765 break;
766 case IRQ_UART2_RX:
767 free_dma(CH_UART2_RX);
768 free_dma(CH_UART2_TX);
769 break;
770 default:
771 break;
772 };
773#endif
Bryan Wu194de562007-05-06 14:50:30 -0700774 free_irq(uart->port.irq, uart);
775 free_irq(uart->port.irq+1, uart);
776#endif
Sonic Zhang6f955702009-04-07 16:51:15 +0100777
Sonic Zhangd307d362009-04-07 16:52:26 +0100778#ifdef CONFIG_SERIAL_BFIN_CTSRTS
Sonic Zhang6f955702009-04-07 16:51:15 +0100779 if (uart->cts_pin >= 0)
780 free_irq(gpio_to_irq(uart->cts_pin), uart);
781 if (uart->rts_pin >= 0)
782 gpio_free(uart->rts_pin);
Sonic Zhangd307d362009-04-07 16:52:26 +0100783#endif
784#ifdef CONFIG_SERIAL_BFIN_HARD_CTSRTS
785 if (uart->cts_pin >= 0)
786 gpio_free(uart->cts_pin);
787 if (uart->rts_pin >= 0)
788 gpio_free(uart->rts_pin);
789 if (UART_GET_IER(uart) && EDSSI)
790 free_irq(uart->status_irq, uart);
791#endif
Bryan Wu194de562007-05-06 14:50:30 -0700792}
793
794static void
795bfin_serial_set_termios(struct uart_port *port, struct ktermios *termios,
796 struct ktermios *old)
797{
798 struct bfin_serial_port *uart = (struct bfin_serial_port *)port;
799 unsigned long flags;
800 unsigned int baud, quot;
Mike Frysinger0c44a862008-04-24 04:56:02 +0800801 unsigned short val, ier, lcr = 0;
Bryan Wu194de562007-05-06 14:50:30 -0700802
803 switch (termios->c_cflag & CSIZE) {
804 case CS8:
805 lcr = WLS(8);
806 break;
807 case CS7:
808 lcr = WLS(7);
809 break;
810 case CS6:
811 lcr = WLS(6);
812 break;
813 case CS5:
814 lcr = WLS(5);
815 break;
816 default:
817 printk(KERN_ERR "%s: word lengh not supported\n",
Harvey Harrison71cc2c22008-04-30 00:55:10 -0700818 __func__);
Bryan Wu194de562007-05-06 14:50:30 -0700819 }
820
821 if (termios->c_cflag & CSTOPB)
822 lcr |= STB;
Mike Frysinger19aa6382007-06-11 16:16:45 +0800823 if (termios->c_cflag & PARENB)
Bryan Wu194de562007-05-06 14:50:30 -0700824 lcr |= PEN;
Mike Frysinger19aa6382007-06-11 16:16:45 +0800825 if (!(termios->c_cflag & PARODD))
826 lcr |= EPS;
827 if (termios->c_cflag & CMSPAR)
828 lcr |= STP;
Bryan Wu194de562007-05-06 14:50:30 -0700829
Mike Frysinger2ac5ee42007-05-21 18:09:39 +0800830 port->read_status_mask = OE;
831 if (termios->c_iflag & INPCK)
832 port->read_status_mask |= (FE | PE);
833 if (termios->c_iflag & (BRKINT | PARMRK))
834 port->read_status_mask |= BI;
Bryan Wu194de562007-05-06 14:50:30 -0700835
Mike Frysinger2ac5ee42007-05-21 18:09:39 +0800836 /*
837 * Characters to ignore
838 */
839 port->ignore_status_mask = 0;
840 if (termios->c_iflag & IGNPAR)
841 port->ignore_status_mask |= FE | PE;
842 if (termios->c_iflag & IGNBRK) {
843 port->ignore_status_mask |= BI;
844 /*
845 * If we're ignoring parity and break indicators,
846 * ignore overruns too (for real raw support).
847 */
848 if (termios->c_iflag & IGNPAR)
849 port->ignore_status_mask |= OE;
850 }
Bryan Wu194de562007-05-06 14:50:30 -0700851
852 baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/16);
Graf Yangf4487102009-04-06 17:32:49 +0100853 quot = uart_get_divisor(port, baud) - ANOMALY_05000230;
Bryan Wu194de562007-05-06 14:50:30 -0700854 spin_lock_irqsave(&uart->port.lock, flags);
855
Mike Frysinger8851c712007-12-24 19:48:04 +0800856 UART_SET_ANOMALY_THRESHOLD(uart, USEC_PER_SEC / baud * 15);
857
Bryan Wu194de562007-05-06 14:50:30 -0700858 /* Disable UART */
859 ier = UART_GET_IER(uart);
Sonic Zhang1feaa512008-06-03 12:19:45 +0800860 UART_DISABLE_INTS(uart);
Bryan Wu194de562007-05-06 14:50:30 -0700861
862 /* Set DLAB in LCR to Access DLL and DLH */
Mike Frysinger45828b82008-05-07 11:41:26 +0800863 UART_SET_DLAB(uart);
Bryan Wu194de562007-05-06 14:50:30 -0700864
865 UART_PUT_DLL(uart, quot & 0xFF);
Bryan Wu194de562007-05-06 14:50:30 -0700866 UART_PUT_DLH(uart, (quot >> 8) & 0xFF);
867 SSYNC();
868
869 /* Clear DLAB in LCR to Access THR RBR IER */
Mike Frysinger45828b82008-05-07 11:41:26 +0800870 UART_CLEAR_DLAB(uart);
Bryan Wu194de562007-05-06 14:50:30 -0700871
872 UART_PUT_LCR(uart, lcr);
873
874 /* Enable UART */
Sonic Zhang1feaa512008-06-03 12:19:45 +0800875 UART_ENABLE_INTS(uart, ier);
Bryan Wu194de562007-05-06 14:50:30 -0700876
877 val = UART_GET_GCTL(uart);
878 val |= UCEN;
879 UART_PUT_GCTL(uart, val);
880
Graf Yangb3ef5ab2008-10-13 10:33:42 +0100881 /* Port speed changed, update the per-port timeout. */
882 uart_update_timeout(port, termios->c_cflag, baud);
883
Bryan Wu194de562007-05-06 14:50:30 -0700884 spin_unlock_irqrestore(&uart->port.lock, flags);
885}
886
887static const char *bfin_serial_type(struct uart_port *port)
888{
889 struct bfin_serial_port *uart = (struct bfin_serial_port *)port;
890
891 return uart->port.type == PORT_BFIN ? "BFIN-UART" : NULL;
892}
893
894/*
895 * Release the memory region(s) being used by 'port'.
896 */
897static void bfin_serial_release_port(struct uart_port *port)
898{
899}
900
901/*
902 * Request the memory region(s) being used by 'port'.
903 */
904static int bfin_serial_request_port(struct uart_port *port)
905{
906 return 0;
907}
908
909/*
910 * Configure/autoconfigure the port.
911 */
912static void bfin_serial_config_port(struct uart_port *port, int flags)
913{
914 struct bfin_serial_port *uart = (struct bfin_serial_port *)port;
915
916 if (flags & UART_CONFIG_TYPE &&
917 bfin_serial_request_port(&uart->port) == 0)
918 uart->port.type = PORT_BFIN;
919}
920
921/*
922 * Verify the new serial_struct (for TIOCSSERIAL).
923 * The only change we allow are to the flags and type, and
924 * even then only between PORT_BFIN and PORT_UNKNOWN
925 */
926static int
927bfin_serial_verify_port(struct uart_port *port, struct serial_struct *ser)
928{
929 return 0;
930}
931
Graf Yang7d01b472008-02-29 11:31:08 +0800932/*
933 * Enable the IrDA function if tty->ldisc.num is N_IRDA.
934 * In other cases, disable IrDA function.
935 */
Graf Yang3b8458a2008-06-07 15:36:33 +0800936static void bfin_serial_set_ldisc(struct uart_port *port)
Graf Yang7d01b472008-02-29 11:31:08 +0800937{
Graf Yang3b8458a2008-06-07 15:36:33 +0800938 int line = port->line;
Graf Yang7d01b472008-02-29 11:31:08 +0800939 unsigned short val;
940
Takashi Iwaia88487c2008-07-16 21:54:42 +0100941 if (line >= port->info->port.tty->driver->num)
Graf Yang7d01b472008-02-29 11:31:08 +0800942 return;
943
Alan Coxb1cbefe2008-08-04 17:22:11 +0100944 switch (port->info->port.tty->termios->c_line) {
Graf Yang7d01b472008-02-29 11:31:08 +0800945 case N_IRDA:
946 val = UART_GET_GCTL(&bfin_serial_ports[line]);
947 val |= (IREN | RPOLC);
948 UART_PUT_GCTL(&bfin_serial_ports[line], val);
949 break;
950 default:
951 val = UART_GET_GCTL(&bfin_serial_ports[line]);
952 val &= ~(IREN | RPOLC);
953 UART_PUT_GCTL(&bfin_serial_ports[line], val);
954 }
955}
956
Sonic Zhang6f955702009-04-07 16:51:15 +0100957static void bfin_serial_reset_irda(struct uart_port *port)
958{
959 int line = port->line;
960 unsigned short val;
961
962 val = UART_GET_GCTL(&bfin_serial_ports[line]);
963 val &= ~(IREN | RPOLC);
964 UART_PUT_GCTL(&bfin_serial_ports[line], val);
965 SSYNC();
966 val |= (IREN | RPOLC);
967 UART_PUT_GCTL(&bfin_serial_ports[line], val);
968 SSYNC();
969}
970
Sonic Zhang52e15f0e2009-01-02 13:40:14 +0000971#ifdef CONFIG_CONSOLE_POLL
972static void bfin_serial_poll_put_char(struct uart_port *port, unsigned char chr)
973{
974 struct bfin_serial_port *uart = (struct bfin_serial_port *)port;
975
976 while (!(UART_GET_LSR(uart) & THRE))
977 cpu_relax();
978
979 UART_CLEAR_DLAB(uart);
980 UART_PUT_CHAR(uart, (unsigned char)chr);
981}
982
983static int bfin_serial_poll_get_char(struct uart_port *port)
984{
985 struct bfin_serial_port *uart = (struct bfin_serial_port *)port;
986 unsigned char chr;
987
988 while (!(UART_GET_LSR(uart) & DR))
989 cpu_relax();
990
991 UART_CLEAR_DLAB(uart);
992 chr = UART_GET_CHAR(uart);
993
994 return chr;
995}
996#endif
997
998#if defined(CONFIG_KGDB_SERIAL_CONSOLE) || \
999 defined(CONFIG_KGDB_SERIAL_CONSOLE_MODULE)
1000static void bfin_kgdboc_port_shutdown(struct uart_port *port)
1001{
1002 if (kgdboc_break_enabled) {
1003 kgdboc_break_enabled = 0;
1004 bfin_serial_shutdown(port);
1005 }
1006}
1007
1008static int bfin_kgdboc_port_startup(struct uart_port *port)
1009{
1010 kgdboc_port_line = port->line;
1011 kgdboc_break_enabled = !bfin_serial_startup(port);
1012 return 0;
1013}
1014#endif
1015
Bryan Wu194de562007-05-06 14:50:30 -07001016static struct uart_ops bfin_serial_pops = {
1017 .tx_empty = bfin_serial_tx_empty,
1018 .set_mctrl = bfin_serial_set_mctrl,
1019 .get_mctrl = bfin_serial_get_mctrl,
1020 .stop_tx = bfin_serial_stop_tx,
1021 .start_tx = bfin_serial_start_tx,
1022 .stop_rx = bfin_serial_stop_rx,
1023 .enable_ms = bfin_serial_enable_ms,
1024 .break_ctl = bfin_serial_break_ctl,
1025 .startup = bfin_serial_startup,
1026 .shutdown = bfin_serial_shutdown,
1027 .set_termios = bfin_serial_set_termios,
Graf Yang3b8458a2008-06-07 15:36:33 +08001028 .set_ldisc = bfin_serial_set_ldisc,
Bryan Wu194de562007-05-06 14:50:30 -07001029 .type = bfin_serial_type,
1030 .release_port = bfin_serial_release_port,
1031 .request_port = bfin_serial_request_port,
1032 .config_port = bfin_serial_config_port,
1033 .verify_port = bfin_serial_verify_port,
Sonic Zhang52e15f0e2009-01-02 13:40:14 +00001034#if defined(CONFIG_KGDB_SERIAL_CONSOLE) || \
1035 defined(CONFIG_KGDB_SERIAL_CONSOLE_MODULE)
1036 .kgdboc_port_startup = bfin_kgdboc_port_startup,
1037 .kgdboc_port_shutdown = bfin_kgdboc_port_shutdown,
1038#endif
1039#ifdef CONFIG_CONSOLE_POLL
1040 .poll_put_char = bfin_serial_poll_put_char,
1041 .poll_get_char = bfin_serial_poll_get_char,
1042#endif
Bryan Wu194de562007-05-06 14:50:30 -07001043};
1044
Sonic Zhang6f955702009-04-07 16:51:15 +01001045static void __init bfin_serial_hw_init(void)
1046{
1047#ifdef CONFIG_SERIAL_BFIN_UART0
1048 peripheral_request(P_UART0_TX, DRIVER_NAME);
1049 peripheral_request(P_UART0_RX, DRIVER_NAME);
1050#endif
1051
1052#ifdef CONFIG_SERIAL_BFIN_UART1
1053 peripheral_request(P_UART1_TX, DRIVER_NAME);
1054 peripheral_request(P_UART1_RX, DRIVER_NAME);
1055
1056# if defined(CONFIG_BFIN_UART1_CTSRTS) && defined(CONFIG_BF54x)
1057 peripheral_request(P_UART1_RTS, DRIVER_NAME);
1058 peripheral_request(P_UART1_CTS, DRIVER_NAME);
1059# endif
1060#endif
1061
1062#ifdef CONFIG_SERIAL_BFIN_UART2
1063 peripheral_request(P_UART2_TX, DRIVER_NAME);
1064 peripheral_request(P_UART2_RX, DRIVER_NAME);
1065#endif
1066
1067#ifdef CONFIG_SERIAL_BFIN_UART3
1068 peripheral_request(P_UART3_TX, DRIVER_NAME);
1069 peripheral_request(P_UART3_RX, DRIVER_NAME);
1070
1071# if defined(CONFIG_BFIN_UART3_CTSRTS) && defined(CONFIG_BF54x)
1072 peripheral_request(P_UART3_RTS, DRIVER_NAME);
1073 peripheral_request(P_UART3_CTS, DRIVER_NAME);
1074# endif
1075#endif
1076}
1077
Bryan Wu194de562007-05-06 14:50:30 -07001078static void __init bfin_serial_init_ports(void)
1079{
1080 static int first = 1;
1081 int i;
1082
1083 if (!first)
1084 return;
1085 first = 0;
1086
Sonic Zhang6f955702009-04-07 16:51:15 +01001087 bfin_serial_hw_init();
1088
Mike Frysingerc9607ec2008-10-13 10:33:16 +01001089 for (i = 0; i < nr_active_ports; i++) {
Bryan Wu194de562007-05-06 14:50:30 -07001090 bfin_serial_ports[i].port.uartclk = get_sclk();
Graf Yangb3ef5ab2008-10-13 10:33:42 +01001091 bfin_serial_ports[i].port.fifosize = BFIN_UART_TX_FIFO_SIZE;
Bryan Wu194de562007-05-06 14:50:30 -07001092 bfin_serial_ports[i].port.ops = &bfin_serial_pops;
1093 bfin_serial_ports[i].port.line = i;
1094 bfin_serial_ports[i].port.iotype = UPIO_MEM;
1095 bfin_serial_ports[i].port.membase =
1096 (void __iomem *)bfin_serial_resource[i].uart_base_addr;
1097 bfin_serial_ports[i].port.mapbase =
1098 bfin_serial_resource[i].uart_base_addr;
1099 bfin_serial_ports[i].port.irq =
1100 bfin_serial_resource[i].uart_irq;
Sonic Zhangd307d362009-04-07 16:52:26 +01001101 bfin_serial_ports[i].status_irq =
1102 bfin_serial_resource[i].uart_status_irq;
Bryan Wu194de562007-05-06 14:50:30 -07001103 bfin_serial_ports[i].port.flags = UPF_BOOT_AUTOCONF;
1104#ifdef CONFIG_SERIAL_BFIN_DMA
1105 bfin_serial_ports[i].tx_done = 1;
1106 bfin_serial_ports[i].tx_count = 0;
1107 bfin_serial_ports[i].tx_dma_channel =
1108 bfin_serial_resource[i].uart_tx_dma_channel;
1109 bfin_serial_ports[i].rx_dma_channel =
1110 bfin_serial_resource[i].uart_rx_dma_channel;
1111 init_timer(&(bfin_serial_ports[i].rx_dma_timer));
Bryan Wu194de562007-05-06 14:50:30 -07001112#endif
Sonic Zhangd307d362009-04-07 16:52:26 +01001113#if defined(CONFIG_SERIAL_BFIN_CTSRTS) || \
1114 defined(CONFIG_SERIAL_BFIN_HARD_CTSRTS)
Bryan Wu194de562007-05-06 14:50:30 -07001115 bfin_serial_ports[i].cts_pin =
1116 bfin_serial_resource[i].uart_cts_pin;
1117 bfin_serial_ports[i].rts_pin =
1118 bfin_serial_resource[i].uart_rts_pin;
1119#endif
Bryan Wu194de562007-05-06 14:50:30 -07001120 }
1121}
1122
Sonic Zhangb6efa1e2009-01-02 13:40:31 +00001123#if defined(CONFIG_SERIAL_BFIN_CONSOLE) || defined(CONFIG_EARLY_PRINTK)
Bryan Wu194de562007-05-06 14:50:30 -07001124/*
1125 * If the port was already initialised (eg, by a boot loader),
1126 * try to determine the current setup.
1127 */
1128static void __init
1129bfin_serial_console_get_options(struct bfin_serial_port *uart, int *baud,
1130 int *parity, int *bits)
1131{
1132 unsigned short status;
1133
1134 status = UART_GET_IER(uart) & (ERBFI | ETBEI);
1135 if (status == (ERBFI | ETBEI)) {
1136 /* ok, the port was enabled */
Mike Frysinger45828b82008-05-07 11:41:26 +08001137 u16 lcr, dlh, dll;
Bryan Wu194de562007-05-06 14:50:30 -07001138
1139 lcr = UART_GET_LCR(uart);
1140
1141 *parity = 'n';
1142 if (lcr & PEN) {
1143 if (lcr & EPS)
1144 *parity = 'e';
1145 else
1146 *parity = 'o';
1147 }
1148 switch (lcr & 0x03) {
1149 case 0: *bits = 5; break;
1150 case 1: *bits = 6; break;
1151 case 2: *bits = 7; break;
1152 case 3: *bits = 8; break;
1153 }
1154 /* Set DLAB in LCR to Access DLL and DLH */
Mike Frysinger45828b82008-05-07 11:41:26 +08001155 UART_SET_DLAB(uart);
Bryan Wu194de562007-05-06 14:50:30 -07001156
1157 dll = UART_GET_DLL(uart);
1158 dlh = UART_GET_DLH(uart);
1159
1160 /* Clear DLAB in LCR to Access THR RBR IER */
Mike Frysinger45828b82008-05-07 11:41:26 +08001161 UART_CLEAR_DLAB(uart);
Bryan Wu194de562007-05-06 14:50:30 -07001162
1163 *baud = get_sclk() / (16*(dll | dlh << 8));
1164 }
Harvey Harrison71cc2c22008-04-30 00:55:10 -07001165 pr_debug("%s:baud = %d, parity = %c, bits= %d\n", __func__, *baud, *parity, *bits);
Bryan Wu194de562007-05-06 14:50:30 -07001166}
Robin Getz0ae53642007-10-09 17:24:49 +08001167
Robin Getz0ae53642007-10-09 17:24:49 +08001168static struct uart_driver bfin_serial_reg;
Bryan Wu194de562007-05-06 14:50:30 -07001169
1170static int __init
1171bfin_serial_console_setup(struct console *co, char *options)
1172{
1173 struct bfin_serial_port *uart;
1174 int baud = 57600;
1175 int bits = 8;
1176 int parity = 'n';
Sonic Zhangd307d362009-04-07 16:52:26 +01001177# if defined(CONFIG_SERIAL_BFIN_CTSRTS) || \
1178 defined(CONFIG_SERIAL_BFIN_HARD_CTSRTS)
Bryan Wu194de562007-05-06 14:50:30 -07001179 int flow = 'r';
Sonic Zhangb6efa1e2009-01-02 13:40:31 +00001180# else
Bryan Wu194de562007-05-06 14:50:30 -07001181 int flow = 'n';
Robin Getz0ae53642007-10-09 17:24:49 +08001182# endif
Bryan Wu194de562007-05-06 14:50:30 -07001183
1184 /*
1185 * Check whether an invalid uart number has been specified, and
1186 * if so, search for the first available port that does have
1187 * console support.
1188 */
Mike Frysingerc9607ec2008-10-13 10:33:16 +01001189 if (co->index == -1 || co->index >= nr_active_ports)
Bryan Wu194de562007-05-06 14:50:30 -07001190 co->index = 0;
1191 uart = &bfin_serial_ports[co->index];
1192
1193 if (options)
1194 uart_parse_options(options, &baud, &parity, &bits, &flow);
1195 else
1196 bfin_serial_console_get_options(uart, &baud, &parity, &bits);
1197
1198 return uart_set_options(&uart->port, co, baud, parity, bits, flow);
Robin Getz0ae53642007-10-09 17:24:49 +08001199}
1200#endif /* defined (CONFIG_SERIAL_BFIN_CONSOLE) ||
1201 defined (CONFIG_EARLY_PRINTK) */
1202
1203#ifdef CONFIG_SERIAL_BFIN_CONSOLE
1204static void bfin_serial_console_putchar(struct uart_port *port, int ch)
1205{
1206 struct bfin_serial_port *uart = (struct bfin_serial_port *)port;
1207 while (!(UART_GET_LSR(uart) & THRE))
1208 barrier();
1209 UART_PUT_CHAR(uart, ch);
1210 SSYNC();
Bryan Wu194de562007-05-06 14:50:30 -07001211}
1212
Robin Getz0ae53642007-10-09 17:24:49 +08001213/*
1214 * Interrupts are disabled on entering
1215 */
1216static void
1217bfin_serial_console_write(struct console *co, const char *s, unsigned int count)
1218{
1219 struct bfin_serial_port *uart = &bfin_serial_ports[co->index];
Mike Frysinger59e4e3e2009-04-06 17:32:28 +01001220 unsigned long flags;
Robin Getz0ae53642007-10-09 17:24:49 +08001221
1222 spin_lock_irqsave(&uart->port.lock, flags);
1223 uart_console_write(&uart->port, s, count, bfin_serial_console_putchar);
1224 spin_unlock_irqrestore(&uart->port.lock, flags);
1225
1226}
1227
Bryan Wu194de562007-05-06 14:50:30 -07001228static struct console bfin_serial_console = {
1229 .name = BFIN_SERIAL_NAME,
1230 .write = bfin_serial_console_write,
1231 .device = uart_console_device,
1232 .setup = bfin_serial_console_setup,
1233 .flags = CON_PRINTBUFFER,
1234 .index = -1,
1235 .data = &bfin_serial_reg,
1236};
1237
1238static int __init bfin_serial_rs_console_init(void)
1239{
1240 bfin_serial_init_ports();
1241 register_console(&bfin_serial_console);
Sonic Zhang52e15f0e2009-01-02 13:40:14 +00001242
Bryan Wu194de562007-05-06 14:50:30 -07001243 return 0;
1244}
1245console_initcall(bfin_serial_rs_console_init);
1246
1247#define BFIN_SERIAL_CONSOLE &bfin_serial_console
1248#else
1249#define BFIN_SERIAL_CONSOLE NULL
Robin Getz0ae53642007-10-09 17:24:49 +08001250#endif /* CONFIG_SERIAL_BFIN_CONSOLE */
1251
1252
1253#ifdef CONFIG_EARLY_PRINTK
1254static __init void early_serial_putc(struct uart_port *port, int ch)
1255{
1256 unsigned timeout = 0xffff;
1257 struct bfin_serial_port *uart = (struct bfin_serial_port *)port;
1258
1259 while ((!(UART_GET_LSR(uart) & THRE)) && --timeout)
1260 cpu_relax();
1261 UART_PUT_CHAR(uart, ch);
1262}
1263
1264static __init void early_serial_write(struct console *con, const char *s,
1265 unsigned int n)
1266{
1267 struct bfin_serial_port *uart = &bfin_serial_ports[con->index];
1268 unsigned int i;
1269
1270 for (i = 0; i < n; i++, s++) {
1271 if (*s == '\n')
1272 early_serial_putc(&uart->port, '\r');
1273 early_serial_putc(&uart->port, *s);
1274 }
1275}
1276
Robin Getz7de7c552009-06-11 13:38:57 +01001277/*
1278 * This should have a .setup or .early_setup in it, but then things get called
1279 * without the command line options, and the baud rate gets messed up - so
1280 * don't let the common infrastructure play with things. (see calls to setup
1281 * & earlysetup in ./kernel/printk.c:register_console()
1282 */
Mike Frysingerc1113402008-10-13 10:32:35 +01001283static struct __initdata console bfin_early_serial_console = {
Robin Getz0ae53642007-10-09 17:24:49 +08001284 .name = "early_BFuart",
1285 .write = early_serial_write,
1286 .device = uart_console_device,
1287 .flags = CON_PRINTBUFFER,
Robin Getz0ae53642007-10-09 17:24:49 +08001288 .index = -1,
1289 .data = &bfin_serial_reg,
1290};
1291
1292struct console __init *bfin_earlyserial_init(unsigned int port,
1293 unsigned int cflag)
1294{
1295 struct bfin_serial_port *uart;
1296 struct ktermios t;
1297
Mike Frysingerc9607ec2008-10-13 10:33:16 +01001298 if (port == -1 || port >= nr_active_ports)
Robin Getz0ae53642007-10-09 17:24:49 +08001299 port = 0;
1300 bfin_serial_init_ports();
1301 bfin_early_serial_console.index = port;
Robin Getz0ae53642007-10-09 17:24:49 +08001302 uart = &bfin_serial_ports[port];
1303 t.c_cflag = cflag;
1304 t.c_iflag = 0;
1305 t.c_oflag = 0;
1306 t.c_lflag = ICANON;
1307 t.c_line = port;
1308 bfin_serial_set_termios(&uart->port, &t, &t);
1309 return &bfin_early_serial_console;
1310}
1311
Sonic Zhangb6efa1e2009-01-02 13:40:31 +00001312#endif /* CONFIG_EARLY_PRINTK */
Bryan Wu194de562007-05-06 14:50:30 -07001313
1314static struct uart_driver bfin_serial_reg = {
1315 .owner = THIS_MODULE,
1316 .driver_name = "bfin-uart",
1317 .dev_name = BFIN_SERIAL_NAME,
1318 .major = BFIN_SERIAL_MAJOR,
1319 .minor = BFIN_SERIAL_MINOR,
Graf Yang2ade9722008-04-25 02:55:49 +08001320 .nr = BFIN_UART_NR_PORTS,
Bryan Wu194de562007-05-06 14:50:30 -07001321 .cons = BFIN_SERIAL_CONSOLE,
1322};
1323
1324static int bfin_serial_suspend(struct platform_device *dev, pm_message_t state)
1325{
Sonic Zhangccfbc3e2008-10-13 10:32:44 +01001326 int i;
Bryan Wu194de562007-05-06 14:50:30 -07001327
Mike Frysingerc9607ec2008-10-13 10:33:16 +01001328 for (i = 0; i < nr_active_ports; i++) {
Sonic Zhangccfbc3e2008-10-13 10:32:44 +01001329 if (bfin_serial_ports[i].port.dev != &dev->dev)
1330 continue;
1331 uart_suspend_port(&bfin_serial_reg, &bfin_serial_ports[i].port);
1332 }
Bryan Wu194de562007-05-06 14:50:30 -07001333
1334 return 0;
1335}
1336
1337static int bfin_serial_resume(struct platform_device *dev)
1338{
Sonic Zhangccfbc3e2008-10-13 10:32:44 +01001339 int i;
Bryan Wu194de562007-05-06 14:50:30 -07001340
Mike Frysingerc9607ec2008-10-13 10:33:16 +01001341 for (i = 0; i < nr_active_ports; i++) {
Sonic Zhangccfbc3e2008-10-13 10:32:44 +01001342 if (bfin_serial_ports[i].port.dev != &dev->dev)
1343 continue;
1344 uart_resume_port(&bfin_serial_reg, &bfin_serial_ports[i].port);
1345 }
Bryan Wu194de562007-05-06 14:50:30 -07001346
1347 return 0;
1348}
1349
1350static int bfin_serial_probe(struct platform_device *dev)
1351{
1352 struct resource *res = dev->resource;
1353 int i;
1354
1355 for (i = 0; i < dev->num_resources; i++, res++)
1356 if (res->flags & IORESOURCE_MEM)
1357 break;
1358
1359 if (i < dev->num_resources) {
Mike Frysingerc9607ec2008-10-13 10:33:16 +01001360 for (i = 0; i < nr_active_ports; i++, res++) {
Bryan Wu194de562007-05-06 14:50:30 -07001361 if (bfin_serial_ports[i].port.mapbase != res->start)
1362 continue;
1363 bfin_serial_ports[i].port.dev = &dev->dev;
1364 uart_add_one_port(&bfin_serial_reg, &bfin_serial_ports[i].port);
Bryan Wu194de562007-05-06 14:50:30 -07001365 }
1366 }
1367
1368 return 0;
1369}
1370
Sonic Zhangccfbc3e2008-10-13 10:32:44 +01001371static int bfin_serial_remove(struct platform_device *dev)
Bryan Wu194de562007-05-06 14:50:30 -07001372{
Sonic Zhangccfbc3e2008-10-13 10:32:44 +01001373 int i;
Bryan Wu194de562007-05-06 14:50:30 -07001374
Mike Frysingerc9607ec2008-10-13 10:33:16 +01001375 for (i = 0; i < nr_active_ports; i++) {
Sonic Zhangccfbc3e2008-10-13 10:32:44 +01001376 if (bfin_serial_ports[i].port.dev != &dev->dev)
1377 continue;
1378 uart_remove_one_port(&bfin_serial_reg, &bfin_serial_ports[i].port);
1379 bfin_serial_ports[i].port.dev = NULL;
Sonic Zhangd307d362009-04-07 16:52:26 +01001380#if defined(CONFIG_SERIAL_BFIN_CTSRTS) || \
1381 defined(CONFIG_SERIAL_BFIN_HARD_CTSRTS)
Sonic Zhangccfbc3e2008-10-13 10:32:44 +01001382 gpio_free(bfin_serial_ports[i].cts_pin);
1383 gpio_free(bfin_serial_ports[i].rts_pin);
Bryan Wu194de562007-05-06 14:50:30 -07001384#endif
Sonic Zhangccfbc3e2008-10-13 10:32:44 +01001385 }
Bryan Wu194de562007-05-06 14:50:30 -07001386
1387 return 0;
1388}
1389
1390static struct platform_driver bfin_serial_driver = {
1391 .probe = bfin_serial_probe,
1392 .remove = bfin_serial_remove,
1393 .suspend = bfin_serial_suspend,
1394 .resume = bfin_serial_resume,
1395 .driver = {
1396 .name = "bfin-uart",
Kay Sieverse169c132008-04-15 14:34:35 -07001397 .owner = THIS_MODULE,
Bryan Wu194de562007-05-06 14:50:30 -07001398 },
1399};
1400
1401static int __init bfin_serial_init(void)
1402{
1403 int ret;
1404
1405 pr_info("Serial: Blackfin serial driver\n");
1406
1407 bfin_serial_init_ports();
1408
1409 ret = uart_register_driver(&bfin_serial_reg);
1410 if (ret == 0) {
1411 ret = platform_driver_register(&bfin_serial_driver);
1412 if (ret) {
1413 pr_debug("uart register failed\n");
1414 uart_unregister_driver(&bfin_serial_reg);
1415 }
1416 }
Bryan Wu194de562007-05-06 14:50:30 -07001417 return ret;
1418}
1419
1420static void __exit bfin_serial_exit(void)
1421{
1422 platform_driver_unregister(&bfin_serial_driver);
1423 uart_unregister_driver(&bfin_serial_reg);
1424}
1425
Sonic Zhang52e15f0e2009-01-02 13:40:14 +00001426
Bryan Wu194de562007-05-06 14:50:30 -07001427module_init(bfin_serial_init);
1428module_exit(bfin_serial_exit);
1429
1430MODULE_AUTHOR("Aubrey.Li <aubrey.li@analog.com>");
1431MODULE_DESCRIPTION("Blackfin generic serial port driver");
1432MODULE_LICENSE("GPL");
1433MODULE_ALIAS_CHARDEV_MAJOR(BFIN_SERIAL_MAJOR);
Kay Sieverse169c132008-04-15 14:34:35 -07001434MODULE_ALIAS("platform:bfin-uart");