Commit | Line | Data |
---|---|---|
e3b3d0f5 | 1 | // SPDX-License-Identifier: GPL-2.0+ |
49aa49bf GU |
2 | /****************************************************************************/ |
3 | ||
4 | /* | |
5 | * mcf.c -- Freescale ColdFire UART driver | |
6 | * | |
6a1c34f4 | 7 | * (C) Copyright 2003-2007, Greg Ungerer <gerg@uclinux.org> |
49aa49bf GU |
8 | */ |
9 | ||
10 | /****************************************************************************/ | |
11 | ||
12 | #include <linux/kernel.h> | |
13 | #include <linux/init.h> | |
14 | #include <linux/interrupt.h> | |
15 | #include <linux/module.h> | |
16 | #include <linux/console.h> | |
17 | #include <linux/tty.h> | |
18 | #include <linux/tty_flip.h> | |
19 | #include <linux/serial.h> | |
20 | #include <linux/serial_core.h> | |
21 | #include <linux/io.h> | |
496c9077 | 22 | #include <linux/uaccess.h> |
574de559 | 23 | #include <linux/platform_device.h> |
49aa49bf GU |
24 | #include <asm/coldfire.h> |
25 | #include <asm/mcfsim.h> | |
26 | #include <asm/mcfuart.h> | |
27 | #include <asm/nettel.h> | |
28 | ||
29 | /****************************************************************************/ | |
30 | ||
31 | /* | |
32 | * Some boards implement the DTR/DCD lines using GPIO lines, most | |
33 | * don't. Dummy out the access macros for those that don't. Those | |
34 | * that do should define these macros somewhere in there board | |
35 | * specific inlude files. | |
36 | */ | |
37 | #if !defined(mcf_getppdcd) | |
38 | #define mcf_getppdcd(p) (1) | |
39 | #endif | |
40 | #if !defined(mcf_getppdtr) | |
41 | #define mcf_getppdtr(p) (1) | |
42 | #endif | |
43 | #if !defined(mcf_setppdtr) | |
44 | #define mcf_setppdtr(p, v) do { } while (0) | |
45 | #endif | |
46 | ||
47 | /****************************************************************************/ | |
48 | ||
49 | /* | |
50 | * Local per-uart structure. | |
51 | */ | |
52 | struct mcf_uart { | |
53 | struct uart_port port; | |
54 | unsigned int sigs; /* Local copy of line sigs */ | |
55 | unsigned char imr; /* Local IMR mirror */ | |
56 | }; | |
57 | ||
58 | /****************************************************************************/ | |
59 | ||
60 | static unsigned int mcf_tx_empty(struct uart_port *port) | |
61 | { | |
62 | return (readb(port->membase + MCFUART_USR) & MCFUART_USR_TXEMPTY) ? | |
63 | TIOCSER_TEMT : 0; | |
64 | } | |
65 | ||
66 | /****************************************************************************/ | |
67 | ||
68 | static unsigned int mcf_get_mctrl(struct uart_port *port) | |
69 | { | |
9f69ba86 | 70 | struct mcf_uart *pp = container_of(port, struct mcf_uart, port); |
49aa49bf GU |
71 | unsigned int sigs; |
72 | ||
49aa49bf GU |
73 | sigs = (readb(port->membase + MCFUART_UIPR) & MCFUART_UIPR_CTS) ? |
74 | 0 : TIOCM_CTS; | |
75 | sigs |= (pp->sigs & TIOCM_RTS); | |
76 | sigs |= (mcf_getppdcd(port->line) ? TIOCM_CD : 0); | |
77 | sigs |= (mcf_getppdtr(port->line) ? TIOCM_DTR : 0); | |
0ac8382e | 78 | |
49aa49bf GU |
79 | return sigs; |
80 | } | |
81 | ||
82 | /****************************************************************************/ | |
83 | ||
84 | static void mcf_set_mctrl(struct uart_port *port, unsigned int sigs) | |
85 | { | |
9f69ba86 | 86 | struct mcf_uart *pp = container_of(port, struct mcf_uart, port); |
49aa49bf | 87 | |
49aa49bf GU |
88 | pp->sigs = sigs; |
89 | mcf_setppdtr(port->line, (sigs & TIOCM_DTR)); | |
90 | if (sigs & TIOCM_RTS) | |
91 | writeb(MCFUART_UOP_RTS, port->membase + MCFUART_UOP1); | |
92 | else | |
93 | writeb(MCFUART_UOP_RTS, port->membase + MCFUART_UOP0); | |
49aa49bf GU |
94 | } |
95 | ||
96 | /****************************************************************************/ | |
97 | ||
98 | static void mcf_start_tx(struct uart_port *port) | |
99 | { | |
9f69ba86 | 100 | struct mcf_uart *pp = container_of(port, struct mcf_uart, port); |
49aa49bf | 101 | |
2fc0184d | 102 | if (port->rs485.flags & SER_RS485_ENABLED) { |
496c9077 QVN |
103 | /* Enable Transmitter */ |
104 | writeb(MCFUART_UCR_TXENABLE, port->membase + MCFUART_UCR); | |
105 | /* Manually assert RTS */ | |
106 | writeb(MCFUART_UOP_RTS, port->membase + MCFUART_UOP1); | |
107 | } | |
49aa49bf GU |
108 | pp->imr |= MCFUART_UIR_TXREADY; |
109 | writeb(pp->imr, port->membase + MCFUART_UIMR); | |
49aa49bf GU |
110 | } |
111 | ||
112 | /****************************************************************************/ | |
113 | ||
114 | static void mcf_stop_tx(struct uart_port *port) | |
115 | { | |
9f69ba86 | 116 | struct mcf_uart *pp = container_of(port, struct mcf_uart, port); |
49aa49bf | 117 | |
49aa49bf GU |
118 | pp->imr &= ~MCFUART_UIR_TXREADY; |
119 | writeb(pp->imr, port->membase + MCFUART_UIMR); | |
49aa49bf GU |
120 | } |
121 | ||
122 | /****************************************************************************/ | |
123 | ||
124 | static void mcf_stop_rx(struct uart_port *port) | |
125 | { | |
9f69ba86 | 126 | struct mcf_uart *pp = container_of(port, struct mcf_uart, port); |
49aa49bf | 127 | |
49aa49bf GU |
128 | pp->imr &= ~MCFUART_UIR_RXREADY; |
129 | writeb(pp->imr, port->membase + MCFUART_UIMR); | |
49aa49bf GU |
130 | } |
131 | ||
132 | /****************************************************************************/ | |
133 | ||
134 | static void mcf_break_ctl(struct uart_port *port, int break_state) | |
135 | { | |
136 | unsigned long flags; | |
137 | ||
138 | spin_lock_irqsave(&port->lock, flags); | |
139 | if (break_state == -1) | |
140 | writeb(MCFUART_UCR_CMDBREAKSTART, port->membase + MCFUART_UCR); | |
141 | else | |
142 | writeb(MCFUART_UCR_CMDBREAKSTOP, port->membase + MCFUART_UCR); | |
143 | spin_unlock_irqrestore(&port->lock, flags); | |
144 | } | |
145 | ||
146 | /****************************************************************************/ | |
147 | ||
49aa49bf GU |
148 | static int mcf_startup(struct uart_port *port) |
149 | { | |
9f69ba86 | 150 | struct mcf_uart *pp = container_of(port, struct mcf_uart, port); |
49aa49bf GU |
151 | unsigned long flags; |
152 | ||
153 | spin_lock_irqsave(&port->lock, flags); | |
154 | ||
155 | /* Reset UART, get it into known state... */ | |
156 | writeb(MCFUART_UCR_CMDRESETRX, port->membase + MCFUART_UCR); | |
157 | writeb(MCFUART_UCR_CMDRESETTX, port->membase + MCFUART_UCR); | |
158 | ||
159 | /* Enable the UART transmitter and receiver */ | |
160 | writeb(MCFUART_UCR_RXENABLE | MCFUART_UCR_TXENABLE, | |
161 | port->membase + MCFUART_UCR); | |
162 | ||
163 | /* Enable RX interrupts now */ | |
164 | pp->imr = MCFUART_UIR_RXREADY; | |
165 | writeb(pp->imr, port->membase + MCFUART_UIMR); | |
166 | ||
167 | spin_unlock_irqrestore(&port->lock, flags); | |
168 | ||
169 | return 0; | |
170 | } | |
171 | ||
172 | /****************************************************************************/ | |
173 | ||
174 | static void mcf_shutdown(struct uart_port *port) | |
175 | { | |
9f69ba86 | 176 | struct mcf_uart *pp = container_of(port, struct mcf_uart, port); |
49aa49bf GU |
177 | unsigned long flags; |
178 | ||
179 | spin_lock_irqsave(&port->lock, flags); | |
180 | ||
181 | /* Disable all interrupts now */ | |
182 | pp->imr = 0; | |
183 | writeb(pp->imr, port->membase + MCFUART_UIMR); | |
184 | ||
185 | /* Disable UART transmitter and receiver */ | |
186 | writeb(MCFUART_UCR_CMDRESETRX, port->membase + MCFUART_UCR); | |
187 | writeb(MCFUART_UCR_CMDRESETTX, port->membase + MCFUART_UCR); | |
188 | ||
189 | spin_unlock_irqrestore(&port->lock, flags); | |
190 | } | |
191 | ||
192 | /****************************************************************************/ | |
193 | ||
194 | static void mcf_set_termios(struct uart_port *port, struct ktermios *termios, | |
195 | struct ktermios *old) | |
196 | { | |
197 | unsigned long flags; | |
198 | unsigned int baud, baudclk; | |
26a4bc66 JA |
199 | #if defined(CONFIG_M5272) |
200 | unsigned int baudfr; | |
201 | #endif | |
49aa49bf GU |
202 | unsigned char mr1, mr2; |
203 | ||
204 | baud = uart_get_baud_rate(port, termios, old, 0, 230400); | |
26a4bc66 JA |
205 | #if defined(CONFIG_M5272) |
206 | baudclk = (MCF_BUSCLK / baud) / 32; | |
207 | baudfr = (((MCF_BUSCLK / baud) + 1) / 2) % 16; | |
208 | #else | |
49aa49bf | 209 | baudclk = ((MCF_BUSCLK / baud) + 16) / 32; |
26a4bc66 | 210 | #endif |
49aa49bf GU |
211 | |
212 | mr1 = MCFUART_MR1_RXIRQRDY | MCFUART_MR1_RXERRCHAR; | |
213 | mr2 = 0; | |
214 | ||
215 | switch (termios->c_cflag & CSIZE) { | |
216 | case CS5: mr1 |= MCFUART_MR1_CS5; break; | |
217 | case CS6: mr1 |= MCFUART_MR1_CS6; break; | |
218 | case CS7: mr1 |= MCFUART_MR1_CS7; break; | |
219 | case CS8: | |
220 | default: mr1 |= MCFUART_MR1_CS8; break; | |
221 | } | |
222 | ||
223 | if (termios->c_cflag & PARENB) { | |
224 | if (termios->c_cflag & CMSPAR) { | |
225 | if (termios->c_cflag & PARODD) | |
226 | mr1 |= MCFUART_MR1_PARITYMARK; | |
227 | else | |
228 | mr1 |= MCFUART_MR1_PARITYSPACE; | |
229 | } else { | |
230 | if (termios->c_cflag & PARODD) | |
231 | mr1 |= MCFUART_MR1_PARITYODD; | |
232 | else | |
233 | mr1 |= MCFUART_MR1_PARITYEVEN; | |
234 | } | |
235 | } else { | |
236 | mr1 |= MCFUART_MR1_PARITYNONE; | |
237 | } | |
238 | ||
ef8b9ddc PH |
239 | /* |
240 | * FIXME: port->read_status_mask and port->ignore_status_mask | |
241 | * need to be initialized based on termios settings for | |
242 | * INPCK, IGNBRK, IGNPAR, PARMRK, BRKINT | |
243 | */ | |
244 | ||
49aa49bf GU |
245 | if (termios->c_cflag & CSTOPB) |
246 | mr2 |= MCFUART_MR2_STOP2; | |
247 | else | |
248 | mr2 |= MCFUART_MR2_STOP1; | |
249 | ||
250 | if (termios->c_cflag & CRTSCTS) { | |
251 | mr1 |= MCFUART_MR1_RXRTS; | |
252 | mr2 |= MCFUART_MR2_TXCTS; | |
253 | } | |
254 | ||
bd737f87 | 255 | spin_lock_irqsave(&port->lock, flags); |
2fc0184d | 256 | if (port->rs485.flags & SER_RS485_ENABLED) { |
496c9077 QVN |
257 | dev_dbg(port->dev, "Setting UART to RS485\n"); |
258 | mr2 |= MCFUART_MR2_TXRTS; | |
259 | } | |
260 | ||
3732b68f | 261 | uart_update_timeout(port, termios->c_cflag, baud); |
49aa49bf GU |
262 | writeb(MCFUART_UCR_CMDRESETRX, port->membase + MCFUART_UCR); |
263 | writeb(MCFUART_UCR_CMDRESETTX, port->membase + MCFUART_UCR); | |
264 | writeb(MCFUART_UCR_CMDRESETMRPTR, port->membase + MCFUART_UCR); | |
265 | writeb(mr1, port->membase + MCFUART_UMR); | |
266 | writeb(mr2, port->membase + MCFUART_UMR); | |
267 | writeb((baudclk & 0xff00) >> 8, port->membase + MCFUART_UBG1); | |
268 | writeb((baudclk & 0xff), port->membase + MCFUART_UBG2); | |
26a4bc66 JA |
269 | #if defined(CONFIG_M5272) |
270 | writeb((baudfr & 0x0f), port->membase + MCFUART_UFPD); | |
271 | #endif | |
49aa49bf GU |
272 | writeb(MCFUART_UCSR_RXCLKTIMER | MCFUART_UCSR_TXCLKTIMER, |
273 | port->membase + MCFUART_UCSR); | |
274 | writeb(MCFUART_UCR_RXENABLE | MCFUART_UCR_TXENABLE, | |
275 | port->membase + MCFUART_UCR); | |
276 | spin_unlock_irqrestore(&port->lock, flags); | |
277 | } | |
278 | ||
279 | /****************************************************************************/ | |
280 | ||
281 | static void mcf_rx_chars(struct mcf_uart *pp) | |
282 | { | |
9f69ba86 | 283 | struct uart_port *port = &pp->port; |
49aa49bf GU |
284 | unsigned char status, ch, flag; |
285 | ||
286 | while ((status = readb(port->membase + MCFUART_USR)) & MCFUART_USR_RXREADY) { | |
287 | ch = readb(port->membase + MCFUART_URB); | |
288 | flag = TTY_NORMAL; | |
289 | port->icount.rx++; | |
290 | ||
291 | if (status & MCFUART_USR_RXERR) { | |
292 | writeb(MCFUART_UCR_CMDRESETERR, | |
293 | port->membase + MCFUART_UCR); | |
294 | ||
295 | if (status & MCFUART_USR_RXBREAK) { | |
296 | port->icount.brk++; | |
297 | if (uart_handle_break(port)) | |
298 | continue; | |
299 | } else if (status & MCFUART_USR_RXPARITY) { | |
300 | port->icount.parity++; | |
301 | } else if (status & MCFUART_USR_RXOVERRUN) { | |
302 | port->icount.overrun++; | |
303 | } else if (status & MCFUART_USR_RXFRAMING) { | |
304 | port->icount.frame++; | |
305 | } | |
306 | ||
307 | status &= port->read_status_mask; | |
308 | ||
309 | if (status & MCFUART_USR_RXBREAK) | |
310 | flag = TTY_BREAK; | |
311 | else if (status & MCFUART_USR_RXPARITY) | |
312 | flag = TTY_PARITY; | |
313 | else if (status & MCFUART_USR_RXFRAMING) | |
314 | flag = TTY_FRAME; | |
315 | } | |
316 | ||
317 | if (uart_handle_sysrq_char(port, ch)) | |
318 | continue; | |
319 | uart_insert_char(port, status, MCFUART_USR_RXOVERRUN, ch, flag); | |
320 | } | |
321 | ||
5275ad70 | 322 | spin_unlock(&port->lock); |
2e124b4a | 323 | tty_flip_buffer_push(&port->state->port); |
5275ad70 | 324 | spin_lock(&port->lock); |
49aa49bf GU |
325 | } |
326 | ||
327 | /****************************************************************************/ | |
328 | ||
329 | static void mcf_tx_chars(struct mcf_uart *pp) | |
330 | { | |
9f69ba86 | 331 | struct uart_port *port = &pp->port; |
ebd2c8f6 | 332 | struct circ_buf *xmit = &port->state->xmit; |
49aa49bf GU |
333 | |
334 | if (port->x_char) { | |
335 | /* Send special char - probably flow control */ | |
336 | writeb(port->x_char, port->membase + MCFUART_UTB); | |
337 | port->x_char = 0; | |
338 | port->icount.tx++; | |
339 | return; | |
340 | } | |
341 | ||
342 | while (readb(port->membase + MCFUART_USR) & MCFUART_USR_TXREADY) { | |
343 | if (xmit->head == xmit->tail) | |
344 | break; | |
345 | writeb(xmit->buf[xmit->tail], port->membase + MCFUART_UTB); | |
346 | xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE -1); | |
347 | port->icount.tx++; | |
348 | } | |
349 | ||
350 | if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS) | |
351 | uart_write_wakeup(port); | |
352 | ||
353 | if (xmit->head == xmit->tail) { | |
354 | pp->imr &= ~MCFUART_UIR_TXREADY; | |
355 | writeb(pp->imr, port->membase + MCFUART_UIMR); | |
496c9077 | 356 | /* Disable TX to negate RTS automatically */ |
2fc0184d | 357 | if (port->rs485.flags & SER_RS485_ENABLED) |
496c9077 QVN |
358 | writeb(MCFUART_UCR_TXDISABLE, |
359 | port->membase + MCFUART_UCR); | |
49aa49bf GU |
360 | } |
361 | } | |
362 | ||
363 | /****************************************************************************/ | |
364 | ||
365 | static irqreturn_t mcf_interrupt(int irq, void *data) | |
366 | { | |
367 | struct uart_port *port = data; | |
9f69ba86 | 368 | struct mcf_uart *pp = container_of(port, struct mcf_uart, port); |
49aa49bf | 369 | unsigned int isr; |
0ac8382e | 370 | irqreturn_t ret = IRQ_NONE; |
49aa49bf GU |
371 | |
372 | isr = readb(port->membase + MCFUART_UISR) & pp->imr; | |
0ac8382e YG |
373 | |
374 | spin_lock(&port->lock); | |
375 | if (isr & MCFUART_UIR_RXREADY) { | |
49aa49bf | 376 | mcf_rx_chars(pp); |
0ac8382e YG |
377 | ret = IRQ_HANDLED; |
378 | } | |
379 | if (isr & MCFUART_UIR_TXREADY) { | |
49aa49bf | 380 | mcf_tx_chars(pp); |
0ac8382e YG |
381 | ret = IRQ_HANDLED; |
382 | } | |
383 | spin_unlock(&port->lock); | |
384 | ||
385 | return ret; | |
49aa49bf GU |
386 | } |
387 | ||
388 | /****************************************************************************/ | |
389 | ||
390 | static void mcf_config_port(struct uart_port *port, int flags) | |
391 | { | |
392 | port->type = PORT_MCF; | |
3732b68f | 393 | port->fifosize = MCFUART_TXFIFOSIZE; |
49aa49bf GU |
394 | |
395 | /* Clear mask, so no surprise interrupts. */ | |
396 | writeb(0, port->membase + MCFUART_UIMR); | |
397 | ||
9cfb5c05 | 398 | if (request_irq(port->irq, mcf_interrupt, 0, "UART", port)) |
49aa49bf GU |
399 | printk(KERN_ERR "MCF: unable to attach ColdFire UART %d " |
400 | "interrupt vector=%d\n", port->line, port->irq); | |
401 | } | |
402 | ||
403 | /****************************************************************************/ | |
404 | ||
405 | static const char *mcf_type(struct uart_port *port) | |
406 | { | |
407 | return (port->type == PORT_MCF) ? "ColdFire UART" : NULL; | |
408 | } | |
409 | ||
410 | /****************************************************************************/ | |
411 | ||
412 | static int mcf_request_port(struct uart_port *port) | |
413 | { | |
414 | /* UARTs always present */ | |
415 | return 0; | |
416 | } | |
417 | ||
418 | /****************************************************************************/ | |
419 | ||
420 | static void mcf_release_port(struct uart_port *port) | |
421 | { | |
422 | /* Nothing to release... */ | |
423 | } | |
424 | ||
425 | /****************************************************************************/ | |
426 | ||
427 | static int mcf_verify_port(struct uart_port *port, struct serial_struct *ser) | |
428 | { | |
429 | if ((ser->type != PORT_UNKNOWN) && (ser->type != PORT_MCF)) | |
430 | return -EINVAL; | |
431 | return 0; | |
432 | } | |
433 | ||
434 | /****************************************************************************/ | |
435 | ||
496c9077 | 436 | /* Enable or disable the RS485 support */ |
2fc0184d | 437 | static int mcf_config_rs485(struct uart_port *port, struct serial_rs485 *rs485) |
496c9077 | 438 | { |
496c9077 QVN |
439 | unsigned char mr1, mr2; |
440 | ||
496c9077 QVN |
441 | /* Get mode registers */ |
442 | mr1 = readb(port->membase + MCFUART_UMR); | |
443 | mr2 = readb(port->membase + MCFUART_UMR); | |
444 | if (rs485->flags & SER_RS485_ENABLED) { | |
445 | dev_dbg(port->dev, "Setting UART to RS485\n"); | |
446 | /* Automatically negate RTS after TX completes */ | |
447 | mr2 |= MCFUART_MR2_TXRTS; | |
448 | } else { | |
449 | dev_dbg(port->dev, "Setting UART to RS232\n"); | |
450 | mr2 &= ~MCFUART_MR2_TXRTS; | |
451 | } | |
452 | writeb(mr1, port->membase + MCFUART_UMR); | |
453 | writeb(mr2, port->membase + MCFUART_UMR); | |
2fc0184d | 454 | port->rs485 = *rs485; |
496c9077 | 455 | |
496c9077 QVN |
456 | return 0; |
457 | } | |
458 | ||
459 | /****************************************************************************/ | |
460 | ||
49aa49bf GU |
461 | /* |
462 | * Define the basic serial functions we support. | |
463 | */ | |
3732b68f | 464 | static const struct uart_ops mcf_uart_ops = { |
49aa49bf GU |
465 | .tx_empty = mcf_tx_empty, |
466 | .get_mctrl = mcf_get_mctrl, | |
467 | .set_mctrl = mcf_set_mctrl, | |
468 | .start_tx = mcf_start_tx, | |
469 | .stop_tx = mcf_stop_tx, | |
470 | .stop_rx = mcf_stop_rx, | |
49aa49bf GU |
471 | .break_ctl = mcf_break_ctl, |
472 | .startup = mcf_startup, | |
473 | .shutdown = mcf_shutdown, | |
474 | .set_termios = mcf_set_termios, | |
475 | .type = mcf_type, | |
476 | .request_port = mcf_request_port, | |
477 | .release_port = mcf_release_port, | |
478 | .config_port = mcf_config_port, | |
479 | .verify_port = mcf_verify_port, | |
480 | }; | |
481 | ||
2545cf6e | 482 | static struct mcf_uart mcf_ports[4]; |
49aa49bf | 483 | |
16791963 | 484 | #define MCF_MAXPORTS ARRAY_SIZE(mcf_ports) |
49aa49bf GU |
485 | |
486 | /****************************************************************************/ | |
487 | #if defined(CONFIG_SERIAL_MCF_CONSOLE) | |
488 | /****************************************************************************/ | |
489 | ||
490 | int __init early_mcf_setup(struct mcf_platform_uart *platp) | |
491 | { | |
492 | struct uart_port *port; | |
493 | int i; | |
494 | ||
495 | for (i = 0; ((i < MCF_MAXPORTS) && (platp[i].mapbase)); i++) { | |
496 | port = &mcf_ports[i].port; | |
497 | ||
498 | port->line = i; | |
499 | port->type = PORT_MCF; | |
500 | port->mapbase = platp[i].mapbase; | |
501 | port->membase = (platp[i].membase) ? platp[i].membase : | |
502 | (unsigned char __iomem *) port->mapbase; | |
503 | port->iotype = SERIAL_IO_MEM; | |
504 | port->irq = platp[i].irq; | |
505 | port->uartclk = MCF_BUSCLK; | |
5fda7a0e | 506 | port->flags = UPF_BOOT_AUTOCONF; |
2fc0184d | 507 | port->rs485_config = mcf_config_rs485; |
49aa49bf GU |
508 | port->ops = &mcf_uart_ops; |
509 | } | |
510 | ||
511 | return 0; | |
512 | } | |
513 | ||
514 | /****************************************************************************/ | |
515 | ||
516 | static void mcf_console_putc(struct console *co, const char c) | |
517 | { | |
518 | struct uart_port *port = &(mcf_ports + co->index)->port; | |
519 | int i; | |
520 | ||
521 | for (i = 0; (i < 0x10000); i++) { | |
522 | if (readb(port->membase + MCFUART_USR) & MCFUART_USR_TXREADY) | |
523 | break; | |
524 | } | |
525 | writeb(c, port->membase + MCFUART_UTB); | |
526 | for (i = 0; (i < 0x10000); i++) { | |
527 | if (readb(port->membase + MCFUART_USR) & MCFUART_USR_TXREADY) | |
528 | break; | |
529 | } | |
530 | } | |
531 | ||
532 | /****************************************************************************/ | |
533 | ||
534 | static void mcf_console_write(struct console *co, const char *s, unsigned int count) | |
535 | { | |
536 | for (; (count); count--, s++) { | |
537 | mcf_console_putc(co, *s); | |
538 | if (*s == '\n') | |
539 | mcf_console_putc(co, '\r'); | |
540 | } | |
541 | } | |
542 | ||
543 | /****************************************************************************/ | |
544 | ||
545 | static int __init mcf_console_setup(struct console *co, char *options) | |
546 | { | |
547 | struct uart_port *port; | |
548 | int baud = CONFIG_SERIAL_MCF_BAUDRATE; | |
549 | int bits = 8; | |
550 | int parity = 'n'; | |
551 | int flow = 'n'; | |
552 | ||
4330e179 | 553 | if ((co->index < 0) || (co->index >= MCF_MAXPORTS)) |
49aa49bf GU |
554 | co->index = 0; |
555 | port = &mcf_ports[co->index].port; | |
556 | if (port->membase == 0) | |
557 | return -ENODEV; | |
558 | ||
559 | if (options) | |
560 | uart_parse_options(options, &baud, &parity, &bits, &flow); | |
561 | ||
562 | return uart_set_options(port, co, baud, parity, bits, flow); | |
563 | } | |
564 | ||
565 | /****************************************************************************/ | |
566 | ||
567 | static struct uart_driver mcf_driver; | |
568 | ||
569 | static struct console mcf_console = { | |
570 | .name = "ttyS", | |
571 | .write = mcf_console_write, | |
572 | .device = uart_console_device, | |
573 | .setup = mcf_console_setup, | |
574 | .flags = CON_PRINTBUFFER, | |
575 | .index = -1, | |
576 | .data = &mcf_driver, | |
577 | }; | |
578 | ||
579 | static int __init mcf_console_init(void) | |
580 | { | |
581 | register_console(&mcf_console); | |
582 | return 0; | |
583 | } | |
584 | ||
585 | console_initcall(mcf_console_init); | |
586 | ||
587 | #define MCF_CONSOLE &mcf_console | |
588 | ||
589 | /****************************************************************************/ | |
590 | #else | |
591 | /****************************************************************************/ | |
592 | ||
593 | #define MCF_CONSOLE NULL | |
594 | ||
595 | /****************************************************************************/ | |
bbdfe620 | 596 | #endif /* CONFIG_SERIAL_MCF_CONSOLE */ |
49aa49bf GU |
597 | /****************************************************************************/ |
598 | ||
599 | /* | |
600 | * Define the mcf UART driver structure. | |
601 | */ | |
602 | static struct uart_driver mcf_driver = { | |
603 | .owner = THIS_MODULE, | |
604 | .driver_name = "mcf", | |
605 | .dev_name = "ttyS", | |
606 | .major = TTY_MAJOR, | |
607 | .minor = 64, | |
608 | .nr = MCF_MAXPORTS, | |
609 | .cons = MCF_CONSOLE, | |
610 | }; | |
611 | ||
612 | /****************************************************************************/ | |
613 | ||
9671f099 | 614 | static int mcf_probe(struct platform_device *pdev) |
49aa49bf | 615 | { |
574de559 | 616 | struct mcf_platform_uart *platp = dev_get_platdata(&pdev->dev); |
49aa49bf GU |
617 | struct uart_port *port; |
618 | int i; | |
619 | ||
620 | for (i = 0; ((i < MCF_MAXPORTS) && (platp[i].mapbase)); i++) { | |
621 | port = &mcf_ports[i].port; | |
622 | ||
623 | port->line = i; | |
624 | port->type = PORT_MCF; | |
625 | port->mapbase = platp[i].mapbase; | |
626 | port->membase = (platp[i].membase) ? platp[i].membase : | |
627 | (unsigned char __iomem *) platp[i].mapbase; | |
201d8975 | 628 | port->dev = &pdev->dev; |
49aa49bf GU |
629 | port->iotype = SERIAL_IO_MEM; |
630 | port->irq = platp[i].irq; | |
631 | port->uartclk = MCF_BUSCLK; | |
632 | port->ops = &mcf_uart_ops; | |
5fda7a0e | 633 | port->flags = UPF_BOOT_AUTOCONF; |
2fc0184d | 634 | port->rs485_config = mcf_config_rs485; |
49aa49bf GU |
635 | |
636 | uart_add_one_port(&mcf_driver, port); | |
637 | } | |
638 | ||
639 | return 0; | |
640 | } | |
641 | ||
642 | /****************************************************************************/ | |
643 | ||
ae8d8a14 | 644 | static int mcf_remove(struct platform_device *pdev) |
49aa49bf GU |
645 | { |
646 | struct uart_port *port; | |
647 | int i; | |
648 | ||
649 | for (i = 0; (i < MCF_MAXPORTS); i++) { | |
650 | port = &mcf_ports[i].port; | |
651 | if (port) | |
652 | uart_remove_one_port(&mcf_driver, port); | |
653 | } | |
654 | ||
655 | return 0; | |
656 | } | |
657 | ||
658 | /****************************************************************************/ | |
659 | ||
660 | static struct platform_driver mcf_platform_driver = { | |
661 | .probe = mcf_probe, | |
2d47b716 | 662 | .remove = mcf_remove, |
49aa49bf GU |
663 | .driver = { |
664 | .name = "mcfuart", | |
49aa49bf GU |
665 | }, |
666 | }; | |
667 | ||
668 | /****************************************************************************/ | |
669 | ||
670 | static int __init mcf_init(void) | |
671 | { | |
672 | int rc; | |
673 | ||
674 | printk("ColdFire internal UART serial driver\n"); | |
675 | ||
676 | rc = uart_register_driver(&mcf_driver); | |
677 | if (rc) | |
678 | return rc; | |
679 | rc = platform_driver_register(&mcf_platform_driver); | |
2b359172 WY |
680 | if (rc) { |
681 | uart_unregister_driver(&mcf_driver); | |
49aa49bf | 682 | return rc; |
2b359172 | 683 | } |
49aa49bf GU |
684 | return 0; |
685 | } | |
686 | ||
687 | /****************************************************************************/ | |
688 | ||
689 | static void __exit mcf_exit(void) | |
690 | { | |
691 | platform_driver_unregister(&mcf_platform_driver); | |
692 | uart_unregister_driver(&mcf_driver); | |
693 | } | |
694 | ||
695 | /****************************************************************************/ | |
696 | ||
697 | module_init(mcf_init); | |
698 | module_exit(mcf_exit); | |
699 | ||
6a1c34f4 | 700 | MODULE_AUTHOR("Greg Ungerer <gerg@uclinux.org>"); |
49aa49bf GU |
701 | MODULE_DESCRIPTION("Freescale ColdFire UART driver"); |
702 | MODULE_LICENSE("GPL"); | |
e169c139 | 703 | MODULE_ALIAS("platform:mcfuart"); |
49aa49bf GU |
704 | |
705 | /****************************************************************************/ |