Merge branch 'for-linus' of master.kernel.org:/home/rmk/linux-2.6-arm
[sfrench/cifs-2.6.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");