Merge master.kernel.org:/pub/scm/linux/kernel/git/jejb/scsi-misc-2.6
[deliverable/linux.git] / drivers / serial / atmel_serial.c
1 /*
2 * linux/drivers/char/atmel_serial.c
3 *
4 * Driver for Atmel AT91 / AT32 Serial ports
5 * Copyright (C) 2003 Rick Bronson
6 *
7 * Based on drivers/char/serial_sa1100.c, by Deep Blue Solutions Ltd.
8 * Based on drivers/char/serial.c, by Linus Torvalds, Theodore Ts'o.
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; either version 2 of the License, or
13 * (at your option) any later version.
14 *
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
23 *
24 */
25 #include <linux/module.h>
26 #include <linux/tty.h>
27 #include <linux/ioport.h>
28 #include <linux/slab.h>
29 #include <linux/init.h>
30 #include <linux/serial.h>
31 #include <linux/clk.h>
32 #include <linux/console.h>
33 #include <linux/sysrq.h>
34 #include <linux/tty_flip.h>
35 #include <linux/platform_device.h>
36 #include <linux/atmel_pdc.h>
37
38 #include <asm/io.h>
39
40 #include <asm/mach/serial_at91.h>
41 #include <asm/arch/board.h>
42
43 #ifdef CONFIG_ARM
44 #include <asm/arch/cpu.h>
45 #include <asm/arch/gpio.h>
46 #endif
47
48 #include "atmel_serial.h"
49
50 #if defined(CONFIG_SERIAL_ATMEL_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
51 #define SUPPORT_SYSRQ
52 #endif
53
54 #include <linux/serial_core.h>
55
56 #ifdef CONFIG_SERIAL_ATMEL_TTYAT
57
58 /* Use device name ttyAT, major 204 and minor 154-169. This is necessary if we
59 * should coexist with the 8250 driver, such as if we have an external 16C550
60 * UART. */
61 #define SERIAL_ATMEL_MAJOR 204
62 #define MINOR_START 154
63 #define ATMEL_DEVICENAME "ttyAT"
64
65 #else
66
67 /* Use device name ttyS, major 4, minor 64-68. This is the usual serial port
68 * name, but it is legally reserved for the 8250 driver. */
69 #define SERIAL_ATMEL_MAJOR TTY_MAJOR
70 #define MINOR_START 64
71 #define ATMEL_DEVICENAME "ttyS"
72
73 #endif
74
75 #define ATMEL_ISR_PASS_LIMIT 256
76
77 #define UART_PUT_CR(port,v) __raw_writel(v, (port)->membase + ATMEL_US_CR)
78 #define UART_GET_MR(port) __raw_readl((port)->membase + ATMEL_US_MR)
79 #define UART_PUT_MR(port,v) __raw_writel(v, (port)->membase + ATMEL_US_MR)
80 #define UART_PUT_IER(port,v) __raw_writel(v, (port)->membase + ATMEL_US_IER)
81 #define UART_PUT_IDR(port,v) __raw_writel(v, (port)->membase + ATMEL_US_IDR)
82 #define UART_GET_IMR(port) __raw_readl((port)->membase + ATMEL_US_IMR)
83 #define UART_GET_CSR(port) __raw_readl((port)->membase + ATMEL_US_CSR)
84 #define UART_GET_CHAR(port) __raw_readl((port)->membase + ATMEL_US_RHR)
85 #define UART_PUT_CHAR(port,v) __raw_writel(v, (port)->membase + ATMEL_US_THR)
86 #define UART_GET_BRGR(port) __raw_readl((port)->membase + ATMEL_US_BRGR)
87 #define UART_PUT_BRGR(port,v) __raw_writel(v, (port)->membase + ATMEL_US_BRGR)
88 #define UART_PUT_RTOR(port,v) __raw_writel(v, (port)->membase + ATMEL_US_RTOR)
89
90 // #define UART_GET_CR(port) __raw_readl((port)->membase + ATMEL_US_CR) // is write-only
91
92 /* PDC registers */
93 #define UART_PUT_PTCR(port,v) __raw_writel(v, (port)->membase + ATMEL_PDC_PTCR)
94 #define UART_GET_PTSR(port) __raw_readl((port)->membase + ATMEL_PDC_PTSR)
95
96 #define UART_PUT_RPR(port,v) __raw_writel(v, (port)->membase + ATMEL_PDC_RPR)
97 #define UART_GET_RPR(port) __raw_readl((port)->membase + ATMEL_PDC_RPR)
98 #define UART_PUT_RCR(port,v) __raw_writel(v, (port)->membase + ATMEL_PDC_RCR)
99 #define UART_PUT_RNPR(port,v) __raw_writel(v, (port)->membase + ATMEL_PDC_RNPR)
100 #define UART_PUT_RNCR(port,v) __raw_writel(v, (port)->membase + ATMEL_PDC_RNCR)
101
102 #define UART_PUT_TPR(port,v) __raw_writel(v, (port)->membase + ATMEL_PDC_TPR)
103 #define UART_PUT_TCR(port,v) __raw_writel(v, (port)->membase + ATMEL_PDC_TCR)
104 //#define UART_PUT_TNPR(port,v) __raw_writel(v, (port)->membase + ATMEL_PDC_TNPR)
105 //#define UART_PUT_TNCR(port,v) __raw_writel(v, (port)->membase + ATMEL_PDC_TNCR)
106
107 static int (*atmel_open_hook)(struct uart_port *);
108 static void (*atmel_close_hook)(struct uart_port *);
109
110 /*
111 * We wrap our port structure around the generic uart_port.
112 */
113 struct atmel_uart_port {
114 struct uart_port uart; /* uart */
115 struct clk *clk; /* uart clock */
116 unsigned short suspended; /* is port suspended? */
117 };
118
119 static struct atmel_uart_port atmel_ports[ATMEL_MAX_UART];
120
121 #ifdef SUPPORT_SYSRQ
122 static struct console atmel_console;
123 #endif
124
125 /*
126 * Return TIOCSER_TEMT when transmitter FIFO and Shift register is empty.
127 */
128 static u_int atmel_tx_empty(struct uart_port *port)
129 {
130 return (UART_GET_CSR(port) & ATMEL_US_TXEMPTY) ? TIOCSER_TEMT : 0;
131 }
132
133 /*
134 * Set state of the modem control output lines
135 */
136 static void atmel_set_mctrl(struct uart_port *port, u_int mctrl)
137 {
138 unsigned int control = 0;
139 unsigned int mode;
140
141 #ifdef CONFIG_ARCH_AT91RM9200
142 if (cpu_is_at91rm9200()) {
143 /*
144 * AT91RM9200 Errata #39: RTS0 is not internally connected to PA21.
145 * We need to drive the pin manually.
146 */
147 if (port->mapbase == AT91RM9200_BASE_US0) {
148 if (mctrl & TIOCM_RTS)
149 at91_set_gpio_value(AT91_PIN_PA21, 0);
150 else
151 at91_set_gpio_value(AT91_PIN_PA21, 1);
152 }
153 }
154 #endif
155
156 if (mctrl & TIOCM_RTS)
157 control |= ATMEL_US_RTSEN;
158 else
159 control |= ATMEL_US_RTSDIS;
160
161 if (mctrl & TIOCM_DTR)
162 control |= ATMEL_US_DTREN;
163 else
164 control |= ATMEL_US_DTRDIS;
165
166 UART_PUT_CR(port, control);
167
168 /* Local loopback mode? */
169 mode = UART_GET_MR(port) & ~ATMEL_US_CHMODE;
170 if (mctrl & TIOCM_LOOP)
171 mode |= ATMEL_US_CHMODE_LOC_LOOP;
172 else
173 mode |= ATMEL_US_CHMODE_NORMAL;
174 UART_PUT_MR(port, mode);
175 }
176
177 /*
178 * Get state of the modem control input lines
179 */
180 static u_int atmel_get_mctrl(struct uart_port *port)
181 {
182 unsigned int status, ret = 0;
183
184 status = UART_GET_CSR(port);
185
186 /*
187 * The control signals are active low.
188 */
189 if (!(status & ATMEL_US_DCD))
190 ret |= TIOCM_CD;
191 if (!(status & ATMEL_US_CTS))
192 ret |= TIOCM_CTS;
193 if (!(status & ATMEL_US_DSR))
194 ret |= TIOCM_DSR;
195 if (!(status & ATMEL_US_RI))
196 ret |= TIOCM_RI;
197
198 return ret;
199 }
200
201 /*
202 * Stop transmitting.
203 */
204 static void atmel_stop_tx(struct uart_port *port)
205 {
206 struct atmel_uart_port *atmel_port = (struct atmel_uart_port *) port;
207
208 UART_PUT_IDR(port, ATMEL_US_TXRDY);
209 }
210
211 /*
212 * Start transmitting.
213 */
214 static void atmel_start_tx(struct uart_port *port)
215 {
216 struct atmel_uart_port *atmel_port = (struct atmel_uart_port *) port;
217
218 UART_PUT_IER(port, ATMEL_US_TXRDY);
219 }
220
221 /*
222 * Stop receiving - port is in process of being closed.
223 */
224 static void atmel_stop_rx(struct uart_port *port)
225 {
226 struct atmel_uart_port *atmel_port = (struct atmel_uart_port *) port;
227
228 UART_PUT_IDR(port, ATMEL_US_RXRDY);
229 }
230
231 /*
232 * Enable modem status interrupts
233 */
234 static void atmel_enable_ms(struct uart_port *port)
235 {
236 UART_PUT_IER(port, ATMEL_US_RIIC | ATMEL_US_DSRIC | ATMEL_US_DCDIC | ATMEL_US_CTSIC);
237 }
238
239 /*
240 * Control the transmission of a break signal
241 */
242 static void atmel_break_ctl(struct uart_port *port, int break_state)
243 {
244 if (break_state != 0)
245 UART_PUT_CR(port, ATMEL_US_STTBRK); /* start break */
246 else
247 UART_PUT_CR(port, ATMEL_US_STPBRK); /* stop break */
248 }
249
250 /*
251 * Characters received (called from interrupt handler)
252 */
253 static void atmel_rx_chars(struct uart_port *port)
254 {
255 struct tty_struct *tty = port->info->tty;
256 unsigned int status, ch, flg;
257
258 status = UART_GET_CSR(port);
259 while (status & ATMEL_US_RXRDY) {
260 ch = UART_GET_CHAR(port);
261
262 port->icount.rx++;
263
264 flg = TTY_NORMAL;
265
266 /*
267 * note that the error handling code is
268 * out of the main execution path
269 */
270 if (unlikely(status & (ATMEL_US_PARE | ATMEL_US_FRAME | ATMEL_US_OVRE | ATMEL_US_RXBRK))) {
271 UART_PUT_CR(port, ATMEL_US_RSTSTA); /* clear error */
272 if (status & ATMEL_US_RXBRK) {
273 status &= ~(ATMEL_US_PARE | ATMEL_US_FRAME); /* ignore side-effect */
274 port->icount.brk++;
275 if (uart_handle_break(port))
276 goto ignore_char;
277 }
278 if (status & ATMEL_US_PARE)
279 port->icount.parity++;
280 if (status & ATMEL_US_FRAME)
281 port->icount.frame++;
282 if (status & ATMEL_US_OVRE)
283 port->icount.overrun++;
284
285 status &= port->read_status_mask;
286
287 if (status & ATMEL_US_RXBRK)
288 flg = TTY_BREAK;
289 else if (status & ATMEL_US_PARE)
290 flg = TTY_PARITY;
291 else if (status & ATMEL_US_FRAME)
292 flg = TTY_FRAME;
293 }
294
295 if (uart_handle_sysrq_char(port, ch))
296 goto ignore_char;
297
298 uart_insert_char(port, status, ATMEL_US_OVRE, ch, flg);
299
300 ignore_char:
301 status = UART_GET_CSR(port);
302 }
303
304 tty_flip_buffer_push(tty);
305 }
306
307 /*
308 * Transmit characters (called from interrupt handler)
309 */
310 static void atmel_tx_chars(struct uart_port *port)
311 {
312 struct circ_buf *xmit = &port->info->xmit;
313
314 if (port->x_char) {
315 UART_PUT_CHAR(port, port->x_char);
316 port->icount.tx++;
317 port->x_char = 0;
318 return;
319 }
320 if (uart_circ_empty(xmit) || uart_tx_stopped(port)) {
321 atmel_stop_tx(port);
322 return;
323 }
324
325 while (UART_GET_CSR(port) & ATMEL_US_TXRDY) {
326 UART_PUT_CHAR(port, xmit->buf[xmit->tail]);
327 xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
328 port->icount.tx++;
329 if (uart_circ_empty(xmit))
330 break;
331 }
332
333 if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
334 uart_write_wakeup(port);
335
336 if (uart_circ_empty(xmit))
337 atmel_stop_tx(port);
338 }
339
340 /*
341 * Interrupt handler
342 */
343 static irqreturn_t atmel_interrupt(int irq, void *dev_id)
344 {
345 struct uart_port *port = dev_id;
346 struct atmel_uart_port *atmel_port = (struct atmel_uart_port *) port;
347 unsigned int status, pending, pass_counter = 0;
348
349 status = UART_GET_CSR(port);
350 pending = status & UART_GET_IMR(port);
351 while (pending) {
352 /* Interrupt receive */
353 if (pending & ATMEL_US_RXRDY)
354 atmel_rx_chars(port);
355
356 // TODO: All reads to CSR will clear these interrupts!
357 if (pending & ATMEL_US_RIIC) port->icount.rng++;
358 if (pending & ATMEL_US_DSRIC) port->icount.dsr++;
359 if (pending & ATMEL_US_DCDIC)
360 uart_handle_dcd_change(port, !(status & ATMEL_US_DCD));
361 if (pending & ATMEL_US_CTSIC)
362 uart_handle_cts_change(port, !(status & ATMEL_US_CTS));
363 if (pending & (ATMEL_US_RIIC | ATMEL_US_DSRIC | ATMEL_US_DCDIC | ATMEL_US_CTSIC))
364 wake_up_interruptible(&port->info->delta_msr_wait);
365
366 /* Interrupt transmit */
367 if (pending & ATMEL_US_TXRDY)
368 atmel_tx_chars(port);
369
370 if (pass_counter++ > ATMEL_ISR_PASS_LIMIT)
371 break;
372
373 status = UART_GET_CSR(port);
374 pending = status & UART_GET_IMR(port);
375 }
376 return IRQ_HANDLED;
377 }
378
379 /*
380 * Perform initialization and enable port for reception
381 */
382 static int atmel_startup(struct uart_port *port)
383 {
384 struct atmel_uart_port *atmel_port = (struct atmel_uart_port *) port;
385 int retval;
386
387 /*
388 * Ensure that no interrupts are enabled otherwise when
389 * request_irq() is called we could get stuck trying to
390 * handle an unexpected interrupt
391 */
392 UART_PUT_IDR(port, -1);
393
394 /*
395 * Allocate the IRQ
396 */
397 retval = request_irq(port->irq, atmel_interrupt, IRQF_SHARED, "atmel_serial", port);
398 if (retval) {
399 printk("atmel_serial: atmel_startup - Can't get irq\n");
400 return retval;
401 }
402
403 /*
404 * If there is a specific "open" function (to register
405 * control line interrupts)
406 */
407 if (atmel_open_hook) {
408 retval = atmel_open_hook(port);
409 if (retval) {
410 free_irq(port->irq, port);
411 return retval;
412 }
413 }
414
415 /*
416 * Finally, enable the serial port
417 */
418 UART_PUT_CR(port, ATMEL_US_RSTSTA | ATMEL_US_RSTRX);
419 UART_PUT_CR(port, ATMEL_US_TXEN | ATMEL_US_RXEN); /* enable xmit & rcvr */
420
421 UART_PUT_IER(port, ATMEL_US_RXRDY); /* enable receive only */
422
423 return 0;
424 }
425
426 /*
427 * Disable the port
428 */
429 static void atmel_shutdown(struct uart_port *port)
430 {
431 struct atmel_uart_port *atmel_port = (struct atmel_uart_port *) port;
432
433 /*
434 * Disable all interrupts, port and break condition.
435 */
436 UART_PUT_CR(port, ATMEL_US_RSTSTA);
437 UART_PUT_IDR(port, -1);
438
439 /*
440 * Free the interrupt
441 */
442 free_irq(port->irq, port);
443
444 /*
445 * If there is a specific "close" function (to unregister
446 * control line interrupts)
447 */
448 if (atmel_close_hook)
449 atmel_close_hook(port);
450 }
451
452 /*
453 * Power / Clock management.
454 */
455 static void atmel_serial_pm(struct uart_port *port, unsigned int state, unsigned int oldstate)
456 {
457 struct atmel_uart_port *atmel_port = (struct atmel_uart_port *) port;
458
459 switch (state) {
460 case 0:
461 /*
462 * Enable the peripheral clock for this serial port.
463 * This is called on uart_open() or a resume event.
464 */
465 clk_enable(atmel_port->clk);
466 break;
467 case 3:
468 /*
469 * Disable the peripheral clock for this serial port.
470 * This is called on uart_close() or a suspend event.
471 */
472 clk_disable(atmel_port->clk);
473 break;
474 default:
475 printk(KERN_ERR "atmel_serial: unknown pm %d\n", state);
476 }
477 }
478
479 /*
480 * Change the port parameters
481 */
482 static void atmel_set_termios(struct uart_port *port, struct ktermios * termios, struct ktermios * old)
483 {
484 unsigned long flags;
485 unsigned int mode, imr, quot, baud;
486
487 baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/16);
488 quot = uart_get_divisor(port, baud);
489
490 /* Get current mode register */
491 mode = UART_GET_MR(port) & ~(ATMEL_US_CHRL | ATMEL_US_NBSTOP | ATMEL_US_PAR);
492
493 /* byte size */
494 switch (termios->c_cflag & CSIZE) {
495 case CS5:
496 mode |= ATMEL_US_CHRL_5;
497 break;
498 case CS6:
499 mode |= ATMEL_US_CHRL_6;
500 break;
501 case CS7:
502 mode |= ATMEL_US_CHRL_7;
503 break;
504 default:
505 mode |= ATMEL_US_CHRL_8;
506 break;
507 }
508
509 /* stop bits */
510 if (termios->c_cflag & CSTOPB)
511 mode |= ATMEL_US_NBSTOP_2;
512
513 /* parity */
514 if (termios->c_cflag & PARENB) {
515 if (termios->c_cflag & CMSPAR) { /* Mark or Space parity */
516 if (termios->c_cflag & PARODD)
517 mode |= ATMEL_US_PAR_MARK;
518 else
519 mode |= ATMEL_US_PAR_SPACE;
520 }
521 else if (termios->c_cflag & PARODD)
522 mode |= ATMEL_US_PAR_ODD;
523 else
524 mode |= ATMEL_US_PAR_EVEN;
525 }
526 else
527 mode |= ATMEL_US_PAR_NONE;
528
529 spin_lock_irqsave(&port->lock, flags);
530
531 port->read_status_mask = ATMEL_US_OVRE;
532 if (termios->c_iflag & INPCK)
533 port->read_status_mask |= (ATMEL_US_FRAME | ATMEL_US_PARE);
534 if (termios->c_iflag & (BRKINT | PARMRK))
535 port->read_status_mask |= ATMEL_US_RXBRK;
536
537 /*
538 * Characters to ignore
539 */
540 port->ignore_status_mask = 0;
541 if (termios->c_iflag & IGNPAR)
542 port->ignore_status_mask |= (ATMEL_US_FRAME | ATMEL_US_PARE);
543 if (termios->c_iflag & IGNBRK) {
544 port->ignore_status_mask |= ATMEL_US_RXBRK;
545 /*
546 * If we're ignoring parity and break indicators,
547 * ignore overruns too (for real raw support).
548 */
549 if (termios->c_iflag & IGNPAR)
550 port->ignore_status_mask |= ATMEL_US_OVRE;
551 }
552
553 // TODO: Ignore all characters if CREAD is set.
554
555 /* update the per-port timeout */
556 uart_update_timeout(port, termios->c_cflag, baud);
557
558 /* disable interrupts and drain transmitter */
559 imr = UART_GET_IMR(port); /* get interrupt mask */
560 UART_PUT_IDR(port, -1); /* disable all interrupts */
561 while (!(UART_GET_CSR(port) & ATMEL_US_TXEMPTY)) { barrier(); }
562
563 /* disable receiver and transmitter */
564 UART_PUT_CR(port, ATMEL_US_TXDIS | ATMEL_US_RXDIS);
565
566 /* set the parity, stop bits and data size */
567 UART_PUT_MR(port, mode);
568
569 /* set the baud rate */
570 UART_PUT_BRGR(port, quot);
571 UART_PUT_CR(port, ATMEL_US_RSTSTA | ATMEL_US_RSTRX);
572 UART_PUT_CR(port, ATMEL_US_TXEN | ATMEL_US_RXEN);
573
574 /* restore interrupts */
575 UART_PUT_IER(port, imr);
576
577 /* CTS flow-control and modem-status interrupts */
578 if (UART_ENABLE_MS(port, termios->c_cflag))
579 port->ops->enable_ms(port);
580
581 spin_unlock_irqrestore(&port->lock, flags);
582 }
583
584 /*
585 * Return string describing the specified port
586 */
587 static const char *atmel_type(struct uart_port *port)
588 {
589 return (port->type == PORT_ATMEL) ? "ATMEL_SERIAL" : NULL;
590 }
591
592 /*
593 * Release the memory region(s) being used by 'port'.
594 */
595 static void atmel_release_port(struct uart_port *port)
596 {
597 struct platform_device *pdev = to_platform_device(port->dev);
598 int size = pdev->resource[0].end - pdev->resource[0].start + 1;
599
600 release_mem_region(port->mapbase, size);
601
602 if (port->flags & UPF_IOREMAP) {
603 iounmap(port->membase);
604 port->membase = NULL;
605 }
606 }
607
608 /*
609 * Request the memory region(s) being used by 'port'.
610 */
611 static int atmel_request_port(struct uart_port *port)
612 {
613 struct platform_device *pdev = to_platform_device(port->dev);
614 int size = pdev->resource[0].end - pdev->resource[0].start + 1;
615
616 if (!request_mem_region(port->mapbase, size, "atmel_serial"))
617 return -EBUSY;
618
619 if (port->flags & UPF_IOREMAP) {
620 port->membase = ioremap(port->mapbase, size);
621 if (port->membase == NULL) {
622 release_mem_region(port->mapbase, size);
623 return -ENOMEM;
624 }
625 }
626
627 return 0;
628 }
629
630 /*
631 * Configure/autoconfigure the port.
632 */
633 static void atmel_config_port(struct uart_port *port, int flags)
634 {
635 if (flags & UART_CONFIG_TYPE) {
636 port->type = PORT_ATMEL;
637 atmel_request_port(port);
638 }
639 }
640
641 /*
642 * Verify the new serial_struct (for TIOCSSERIAL).
643 */
644 static int atmel_verify_port(struct uart_port *port, struct serial_struct *ser)
645 {
646 int ret = 0;
647 if (ser->type != PORT_UNKNOWN && ser->type != PORT_ATMEL)
648 ret = -EINVAL;
649 if (port->irq != ser->irq)
650 ret = -EINVAL;
651 if (ser->io_type != SERIAL_IO_MEM)
652 ret = -EINVAL;
653 if (port->uartclk / 16 != ser->baud_base)
654 ret = -EINVAL;
655 if ((void *)port->mapbase != ser->iomem_base)
656 ret = -EINVAL;
657 if (port->iobase != ser->port)
658 ret = -EINVAL;
659 if (ser->hub6 != 0)
660 ret = -EINVAL;
661 return ret;
662 }
663
664 static struct uart_ops atmel_pops = {
665 .tx_empty = atmel_tx_empty,
666 .set_mctrl = atmel_set_mctrl,
667 .get_mctrl = atmel_get_mctrl,
668 .stop_tx = atmel_stop_tx,
669 .start_tx = atmel_start_tx,
670 .stop_rx = atmel_stop_rx,
671 .enable_ms = atmel_enable_ms,
672 .break_ctl = atmel_break_ctl,
673 .startup = atmel_startup,
674 .shutdown = atmel_shutdown,
675 .set_termios = atmel_set_termios,
676 .type = atmel_type,
677 .release_port = atmel_release_port,
678 .request_port = atmel_request_port,
679 .config_port = atmel_config_port,
680 .verify_port = atmel_verify_port,
681 .pm = atmel_serial_pm,
682 };
683
684 /*
685 * Configure the port from the platform device resource info.
686 */
687 static void __devinit atmel_init_port(struct atmel_uart_port *atmel_port, struct platform_device *pdev)
688 {
689 struct uart_port *port = &atmel_port->uart;
690 struct atmel_uart_data *data = pdev->dev.platform_data;
691
692 port->iotype = UPIO_MEM;
693 port->flags = UPF_BOOT_AUTOCONF;
694 port->ops = &atmel_pops;
695 port->fifosize = 1;
696 port->line = pdev->id;
697 port->dev = &pdev->dev;
698
699 port->mapbase = pdev->resource[0].start;
700 port->irq = pdev->resource[1].start;
701
702 if (data->regs)
703 /* Already mapped by setup code */
704 port->membase = data->regs;
705 else {
706 port->flags |= UPF_IOREMAP;
707 port->membase = NULL;
708 }
709
710 if (!atmel_port->clk) { /* for console, the clock could already be configured */
711 atmel_port->clk = clk_get(&pdev->dev, "usart");
712 clk_enable(atmel_port->clk);
713 port->uartclk = clk_get_rate(atmel_port->clk);
714 }
715 }
716
717 /*
718 * Register board-specific modem-control line handlers.
719 */
720 void __init atmel_register_uart_fns(struct atmel_port_fns *fns)
721 {
722 if (fns->enable_ms)
723 atmel_pops.enable_ms = fns->enable_ms;
724 if (fns->get_mctrl)
725 atmel_pops.get_mctrl = fns->get_mctrl;
726 if (fns->set_mctrl)
727 atmel_pops.set_mctrl = fns->set_mctrl;
728 atmel_open_hook = fns->open;
729 atmel_close_hook = fns->close;
730 atmel_pops.pm = fns->pm;
731 atmel_pops.set_wake = fns->set_wake;
732 }
733
734
735 #ifdef CONFIG_SERIAL_ATMEL_CONSOLE
736 static void atmel_console_putchar(struct uart_port *port, int ch)
737 {
738 while (!(UART_GET_CSR(port) & ATMEL_US_TXRDY))
739 barrier();
740 UART_PUT_CHAR(port, ch);
741 }
742
743 /*
744 * Interrupts are disabled on entering
745 */
746 static void atmel_console_write(struct console *co, const char *s, u_int count)
747 {
748 struct uart_port *port = &atmel_ports[co->index].uart;
749 unsigned int status, imr;
750
751 /*
752 * First, save IMR and then disable interrupts
753 */
754 imr = UART_GET_IMR(port); /* get interrupt mask */
755 UART_PUT_IDR(port, ATMEL_US_RXRDY | ATMEL_US_TXRDY);
756
757 uart_console_write(port, s, count, atmel_console_putchar);
758
759 /*
760 * Finally, wait for transmitter to become empty
761 * and restore IMR
762 */
763 do {
764 status = UART_GET_CSR(port);
765 } while (!(status & ATMEL_US_TXRDY));
766 UART_PUT_IER(port, imr); /* set interrupts back the way they were */
767 }
768
769 /*
770 * If the port was already initialised (eg, by a boot loader), try to determine
771 * the current setup.
772 */
773 static void __init atmel_console_get_options(struct uart_port *port, int *baud, int *parity, int *bits)
774 {
775 unsigned int mr, quot;
776
777 // TODO: CR is a write-only register
778 // unsigned int cr;
779 //
780 // cr = UART_GET_CR(port) & (ATMEL_US_RXEN | ATMEL_US_TXEN);
781 // if (cr == (ATMEL_US_RXEN | ATMEL_US_TXEN)) {
782 // /* ok, the port was enabled */
783 // }
784
785 mr = UART_GET_MR(port) & ATMEL_US_CHRL;
786 if (mr == ATMEL_US_CHRL_8)
787 *bits = 8;
788 else
789 *bits = 7;
790
791 mr = UART_GET_MR(port) & ATMEL_US_PAR;
792 if (mr == ATMEL_US_PAR_EVEN)
793 *parity = 'e';
794 else if (mr == ATMEL_US_PAR_ODD)
795 *parity = 'o';
796
797 /*
798 * The serial core only rounds down when matching this to a
799 * supported baud rate. Make sure we don't end up slightly
800 * lower than one of those, as it would make us fall through
801 * to a much lower baud rate than we really want.
802 */
803 quot = UART_GET_BRGR(port);
804 *baud = port->uartclk / (16 * (quot - 1));
805 }
806
807 static int __init atmel_console_setup(struct console *co, char *options)
808 {
809 struct uart_port *port = &atmel_ports[co->index].uart;
810 int baud = 115200;
811 int bits = 8;
812 int parity = 'n';
813 int flow = 'n';
814
815 if (port->membase == 0) /* Port not initialized yet - delay setup */
816 return -ENODEV;
817
818 UART_PUT_IDR(port, -1); /* disable interrupts */
819 UART_PUT_CR(port, ATMEL_US_RSTSTA | ATMEL_US_RSTRX);
820 UART_PUT_CR(port, ATMEL_US_TXEN | ATMEL_US_RXEN);
821
822 if (options)
823 uart_parse_options(options, &baud, &parity, &bits, &flow);
824 else
825 atmel_console_get_options(port, &baud, &parity, &bits);
826
827 return uart_set_options(port, co, baud, parity, bits, flow);
828 }
829
830 static struct uart_driver atmel_uart;
831
832 static struct console atmel_console = {
833 .name = ATMEL_DEVICENAME,
834 .write = atmel_console_write,
835 .device = uart_console_device,
836 .setup = atmel_console_setup,
837 .flags = CON_PRINTBUFFER,
838 .index = -1,
839 .data = &atmel_uart,
840 };
841
842 #define ATMEL_CONSOLE_DEVICE &atmel_console
843
844 /*
845 * Early console initialization (before VM subsystem initialized).
846 */
847 static int __init atmel_console_init(void)
848 {
849 if (atmel_default_console_device) {
850 add_preferred_console(ATMEL_DEVICENAME, atmel_default_console_device->id, NULL);
851 atmel_init_port(&(atmel_ports[atmel_default_console_device->id]), atmel_default_console_device);
852 register_console(&atmel_console);
853 }
854
855 return 0;
856 }
857 console_initcall(atmel_console_init);
858
859 /*
860 * Late console initialization.
861 */
862 static int __init atmel_late_console_init(void)
863 {
864 if (atmel_default_console_device && !(atmel_console.flags & CON_ENABLED))
865 register_console(&atmel_console);
866
867 return 0;
868 }
869 core_initcall(atmel_late_console_init);
870
871 #else
872 #define ATMEL_CONSOLE_DEVICE NULL
873 #endif
874
875 static struct uart_driver atmel_uart = {
876 .owner = THIS_MODULE,
877 .driver_name = "atmel_serial",
878 .dev_name = ATMEL_DEVICENAME,
879 .major = SERIAL_ATMEL_MAJOR,
880 .minor = MINOR_START,
881 .nr = ATMEL_MAX_UART,
882 .cons = ATMEL_CONSOLE_DEVICE,
883 };
884
885 #ifdef CONFIG_PM
886 static int atmel_serial_suspend(struct platform_device *pdev, pm_message_t state)
887 {
888 struct uart_port *port = platform_get_drvdata(pdev);
889 struct atmel_uart_port *atmel_port = (struct atmel_uart_port *) port;
890
891 if (device_may_wakeup(&pdev->dev) && !at91_suspend_entering_slow_clock())
892 enable_irq_wake(port->irq);
893 else {
894 uart_suspend_port(&atmel_uart, port);
895 atmel_port->suspended = 1;
896 }
897
898 return 0;
899 }
900
901 static int atmel_serial_resume(struct platform_device *pdev)
902 {
903 struct uart_port *port = platform_get_drvdata(pdev);
904 struct atmel_uart_port *atmel_port = (struct atmel_uart_port *) port;
905
906 if (atmel_port->suspended) {
907 uart_resume_port(&atmel_uart, port);
908 atmel_port->suspended = 0;
909 }
910 else
911 disable_irq_wake(port->irq);
912
913 return 0;
914 }
915 #else
916 #define atmel_serial_suspend NULL
917 #define atmel_serial_resume NULL
918 #endif
919
920 static int __devinit atmel_serial_probe(struct platform_device *pdev)
921 {
922 struct atmel_uart_port *port;
923 int ret;
924
925 port = &atmel_ports[pdev->id];
926 atmel_init_port(port, pdev);
927
928 ret = uart_add_one_port(&atmel_uart, &port->uart);
929 if (!ret) {
930 device_init_wakeup(&pdev->dev, 1);
931 platform_set_drvdata(pdev, port);
932 }
933
934 return ret;
935 }
936
937 static int __devexit atmel_serial_remove(struct platform_device *pdev)
938 {
939 struct uart_port *port = platform_get_drvdata(pdev);
940 struct atmel_uart_port *atmel_port = (struct atmel_uart_port *) port;
941 int ret = 0;
942
943 clk_disable(atmel_port->clk);
944 clk_put(atmel_port->clk);
945
946 device_init_wakeup(&pdev->dev, 0);
947 platform_set_drvdata(pdev, NULL);
948
949 if (port) {
950 ret = uart_remove_one_port(&atmel_uart, port);
951 kfree(port);
952 }
953
954 return ret;
955 }
956
957 static struct platform_driver atmel_serial_driver = {
958 .probe = atmel_serial_probe,
959 .remove = __devexit_p(atmel_serial_remove),
960 .suspend = atmel_serial_suspend,
961 .resume = atmel_serial_resume,
962 .driver = {
963 .name = "atmel_usart",
964 .owner = THIS_MODULE,
965 },
966 };
967
968 static int __init atmel_serial_init(void)
969 {
970 int ret;
971
972 ret = uart_register_driver(&atmel_uart);
973 if (ret)
974 return ret;
975
976 ret = platform_driver_register(&atmel_serial_driver);
977 if (ret)
978 uart_unregister_driver(&atmel_uart);
979
980 return ret;
981 }
982
983 static void __exit atmel_serial_exit(void)
984 {
985 platform_driver_unregister(&atmel_serial_driver);
986 uart_unregister_driver(&atmel_uart);
987 }
988
989 module_init(atmel_serial_init);
990 module_exit(atmel_serial_exit);
991
992 MODULE_AUTHOR("Rick Bronson");
993 MODULE_DESCRIPTION("Atmel AT91 / AT32 serial port driver");
994 MODULE_LICENSE("GPL");
This page took 0.098811 seconds and 5 git commands to generate.