diff options
Diffstat (limited to 'drivers/tty/serial/imx.c')
| -rw-r--r-- | drivers/tty/serial/imx.c | 1380 | 
1 files changed, 1380 insertions, 0 deletions
diff --git a/drivers/tty/serial/imx.c b/drivers/tty/serial/imx.c new file mode 100644 index 000000000000..dfcf4b1878aa --- /dev/null +++ b/drivers/tty/serial/imx.c  | |||
| @@ -0,0 +1,1380 @@ | |||
| 1 | /* | ||
| 2 | * linux/drivers/serial/imx.c | ||
| 3 | * | ||
| 4 | * Driver for Motorola IMX serial ports | ||
| 5 | * | ||
| 6 | * Based on drivers/char/serial.c, by Linus Torvalds, Theodore Ts'o. | ||
| 7 | * | ||
| 8 | * Author: Sascha Hauer <sascha@saschahauer.de> | ||
| 9 | * Copyright (C) 2004 Pengutronix | ||
| 10 | * | ||
| 11 | * Copyright (C) 2009 emlix GmbH | ||
| 12 | * Author: Fabian Godehardt (added IrDA support for iMX) | ||
| 13 | * | ||
| 14 | * This program is free software; you can redistribute it and/or modify | ||
| 15 | * it under the terms of the GNU General Public License as published by | ||
| 16 | * the Free Software Foundation; either version 2 of the License, or | ||
| 17 | * (at your option) any later version. | ||
| 18 | * | ||
| 19 | * This program is distributed in the hope that it will be useful, | ||
| 20 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 21 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 22 | * GNU General Public License for more details. | ||
| 23 | * | ||
| 24 | * You should have received a copy of the GNU General Public License | ||
| 25 | * along with this program; if not, write to the Free Software | ||
| 26 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
| 27 | * | ||
| 28 | * [29-Mar-2005] Mike Lee | ||
| 29 | * Added hardware handshake | ||
| 30 | */ | ||
| 31 | |||
| 32 | #if defined(CONFIG_SERIAL_IMX_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ) | ||
| 33 | #define SUPPORT_SYSRQ | ||
| 34 | #endif | ||
| 35 | |||
| 36 | #include <linux/module.h> | ||
| 37 | #include <linux/ioport.h> | ||
| 38 | #include <linux/init.h> | ||
| 39 | #include <linux/console.h> | ||
| 40 | #include <linux/sysrq.h> | ||
| 41 | #include <linux/platform_device.h> | ||
| 42 | #include <linux/tty.h> | ||
| 43 | #include <linux/tty_flip.h> | ||
| 44 | #include <linux/serial_core.h> | ||
| 45 | #include <linux/serial.h> | ||
| 46 | #include <linux/clk.h> | ||
| 47 | #include <linux/delay.h> | ||
| 48 | #include <linux/rational.h> | ||
| 49 | #include <linux/slab.h> | ||
| 50 | |||
| 51 | #include <asm/io.h> | ||
| 52 | #include <asm/irq.h> | ||
| 53 | #include <mach/hardware.h> | ||
| 54 | #include <mach/imx-uart.h> | ||
| 55 | |||
| 56 | /* Register definitions */ | ||
| 57 | #define URXD0 0x0 /* Receiver Register */ | ||
| 58 | #define URTX0 0x40 /* Transmitter Register */ | ||
| 59 | #define UCR1 0x80 /* Control Register 1 */ | ||
| 60 | #define UCR2 0x84 /* Control Register 2 */ | ||
| 61 | #define UCR3 0x88 /* Control Register 3 */ | ||
| 62 | #define UCR4 0x8c /* Control Register 4 */ | ||
| 63 | #define UFCR 0x90 /* FIFO Control Register */ | ||
| 64 | #define USR1 0x94 /* Status Register 1 */ | ||
| 65 | #define USR2 0x98 /* Status Register 2 */ | ||
| 66 | #define UESC 0x9c /* Escape Character Register */ | ||
| 67 | #define UTIM 0xa0 /* Escape Timer Register */ | ||
| 68 | #define UBIR 0xa4 /* BRM Incremental Register */ | ||
| 69 | #define UBMR 0xa8 /* BRM Modulator Register */ | ||
| 70 | #define UBRC 0xac /* Baud Rate Count Register */ | ||
| 71 | #define MX2_ONEMS 0xb0 /* One Millisecond register */ | ||
| 72 | #define UTS (cpu_is_mx1() ? 0xd0 : 0xb4) /* UART Test Register */ | ||
| 73 | |||
| 74 | /* UART Control Register Bit Fields.*/ | ||
| 75 | #define URXD_CHARRDY (1<<15) | ||
| 76 | #define URXD_ERR (1<<14) | ||
| 77 | #define URXD_OVRRUN (1<<13) | ||
| 78 | #define URXD_FRMERR (1<<12) | ||
| 79 | #define URXD_BRK (1<<11) | ||
| 80 | #define URXD_PRERR (1<<10) | ||
| 81 | #define UCR1_ADEN (1<<15) /* Auto dectect interrupt */ | ||
| 82 | #define UCR1_ADBR (1<<14) /* Auto detect baud rate */ | ||
| 83 | #define UCR1_TRDYEN (1<<13) /* Transmitter ready interrupt enable */ | ||
| 84 | #define UCR1_IDEN (1<<12) /* Idle condition interrupt */ | ||
| 85 | #define UCR1_RRDYEN (1<<9) /* Recv ready interrupt enable */ | ||
| 86 | #define UCR1_RDMAEN (1<<8) /* Recv ready DMA enable */ | ||
| 87 | #define UCR1_IREN (1<<7) /* Infrared interface enable */ | ||
| 88 | #define UCR1_TXMPTYEN (1<<6) /* Transimitter empty interrupt enable */ | ||
| 89 | #define UCR1_RTSDEN (1<<5) /* RTS delta interrupt enable */ | ||
| 90 | #define UCR1_SNDBRK (1<<4) /* Send break */ | ||
| 91 | #define UCR1_TDMAEN (1<<3) /* Transmitter ready DMA enable */ | ||
| 92 | #define MX1_UCR1_UARTCLKEN (1<<2) /* UART clock enabled, mx1 only */ | ||
| 93 | #define UCR1_DOZE (1<<1) /* Doze */ | ||
| 94 | #define UCR1_UARTEN (1<<0) /* UART enabled */ | ||
| 95 | #define UCR2_ESCI (1<<15) /* Escape seq interrupt enable */ | ||
| 96 | #define UCR2_IRTS (1<<14) /* Ignore RTS pin */ | ||
| 97 | #define UCR2_CTSC (1<<13) /* CTS pin control */ | ||
| 98 | #define UCR2_CTS (1<<12) /* Clear to send */ | ||
| 99 | #define UCR2_ESCEN (1<<11) /* Escape enable */ | ||
| 100 | #define UCR2_PREN (1<<8) /* Parity enable */ | ||
| 101 | #define UCR2_PROE (1<<7) /* Parity odd/even */ | ||
| 102 | #define UCR2_STPB (1<<6) /* Stop */ | ||
| 103 | #define UCR2_WS (1<<5) /* Word size */ | ||
| 104 | #define UCR2_RTSEN (1<<4) /* Request to send interrupt enable */ | ||
| 105 | #define UCR2_TXEN (1<<2) /* Transmitter enabled */ | ||
| 106 | #define UCR2_RXEN (1<<1) /* Receiver enabled */ | ||
| 107 | #define UCR2_SRST (1<<0) /* SW reset */ | ||
| 108 | #define UCR3_DTREN (1<<13) /* DTR interrupt enable */ | ||
| 109 | #define UCR3_PARERREN (1<<12) /* Parity enable */ | ||
| 110 | #define UCR3_FRAERREN (1<<11) /* Frame error interrupt enable */ | ||
| 111 | #define UCR3_DSR (1<<10) /* Data set ready */ | ||
| 112 | #define UCR3_DCD (1<<9) /* Data carrier detect */ | ||
| 113 | #define UCR3_RI (1<<8) /* Ring indicator */ | ||
| 114 | #define UCR3_TIMEOUTEN (1<<7) /* Timeout interrupt enable */ | ||
| 115 | #define UCR3_RXDSEN (1<<6) /* Receive status interrupt enable */ | ||
| 116 | #define UCR3_AIRINTEN (1<<5) /* Async IR wake interrupt enable */ | ||
| 117 | #define UCR3_AWAKEN (1<<4) /* Async wake interrupt enable */ | ||
| 118 | #define MX1_UCR3_REF25 (1<<3) /* Ref freq 25 MHz, only on mx1 */ | ||
| 119 | #define MX1_UCR3_REF30 (1<<2) /* Ref Freq 30 MHz, only on mx1 */ | ||
| 120 | #define MX2_UCR3_RXDMUXSEL (1<<2) /* RXD Muxed Input Select, on mx2/mx3 */ | ||
| 121 | #define UCR3_INVT (1<<1) /* Inverted Infrared transmission */ | ||
| 122 | #define UCR3_BPEN (1<<0) /* Preset registers enable */ | ||
| 123 | #define UCR4_CTSTL_SHF 10 /* CTS trigger level shift */ | ||
| 124 | #define UCR4_CTSTL_MASK 0x3F /* CTS trigger is 6 bits wide */ | ||
| 125 | #define UCR4_INVR (1<<9) /* Inverted infrared reception */ | ||
| 126 | #define UCR4_ENIRI (1<<8) /* Serial infrared interrupt enable */ | ||
| 127 | #define UCR4_WKEN (1<<7) /* Wake interrupt enable */ | ||
| 128 | #define UCR4_REF16 (1<<6) /* Ref freq 16 MHz */ | ||
| 129 | #define UCR4_IRSC (1<<5) /* IR special case */ | ||
| 130 | #define UCR4_TCEN (1<<3) /* Transmit complete interrupt enable */ | ||
| 131 | #define UCR4_BKEN (1<<2) /* Break condition interrupt enable */ | ||
| 132 | #define UCR4_OREN (1<<1) /* Receiver overrun interrupt enable */ | ||
| 133 | #define UCR4_DREN (1<<0) /* Recv data ready interrupt enable */ | ||
| 134 | #define UFCR_RXTL_SHF 0 /* Receiver trigger level shift */ | ||
| 135 | #define UFCR_RFDIV (7<<7) /* Reference freq divider mask */ | ||
| 136 | #define UFCR_RFDIV_REG(x) (((x) < 7 ? 6 - (x) : 6) << 7) | ||
| 137 | #define UFCR_TXTL_SHF 10 /* Transmitter trigger level shift */ | ||
| 138 | #define USR1_PARITYERR (1<<15) /* Parity error interrupt flag */ | ||
| 139 | #define USR1_RTSS (1<<14) /* RTS pin status */ | ||
| 140 | #define USR1_TRDY (1<<13) /* Transmitter ready interrupt/dma flag */ | ||
| 141 | #define USR1_RTSD (1<<12) /* RTS delta */ | ||
| 142 | #define USR1_ESCF (1<<11) /* Escape seq interrupt flag */ | ||
| 143 | #define USR1_FRAMERR (1<<10) /* Frame error interrupt flag */ | ||
| 144 | #define USR1_RRDY (1<<9) /* Receiver ready interrupt/dma flag */ | ||
| 145 | #define USR1_TIMEOUT (1<<7) /* Receive timeout interrupt status */ | ||
| 146 | #define USR1_RXDS (1<<6) /* Receiver idle interrupt flag */ | ||
| 147 | #define USR1_AIRINT (1<<5) /* Async IR wake interrupt flag */ | ||
| 148 | #define USR1_AWAKE (1<<4) /* Aysnc wake interrupt flag */ | ||
| 149 | #define USR2_ADET (1<<15) /* Auto baud rate detect complete */ | ||
| 150 | #define USR2_TXFE (1<<14) /* Transmit buffer FIFO empty */ | ||
| 151 | #define USR2_DTRF (1<<13) /* DTR edge interrupt flag */ | ||
| 152 | #define USR2_IDLE (1<<12) /* Idle condition */ | ||
| 153 | #define USR2_IRINT (1<<8) /* Serial infrared interrupt flag */ | ||
| 154 | #define USR2_WAKE (1<<7) /* Wake */ | ||
| 155 | #define USR2_RTSF (1<<4) /* RTS edge interrupt flag */ | ||
| 156 | #define USR2_TXDC (1<<3) /* Transmitter complete */ | ||
| 157 | #define USR2_BRCD (1<<2) /* Break condition */ | ||
| 158 | #define USR2_ORE (1<<1) /* Overrun error */ | ||
| 159 | #define USR2_RDR (1<<0) /* Recv data ready */ | ||
| 160 | #define UTS_FRCPERR (1<<13) /* Force parity error */ | ||
| 161 | #define UTS_LOOP (1<<12) /* Loop tx and rx */ | ||
| 162 | #define UTS_TXEMPTY (1<<6) /* TxFIFO empty */ | ||
| 163 | #define UTS_RXEMPTY (1<<5) /* RxFIFO empty */ | ||
| 164 | #define UTS_TXFULL (1<<4) /* TxFIFO full */ | ||
| 165 | #define UTS_RXFULL (1<<3) /* RxFIFO full */ | ||
| 166 | #define UTS_SOFTRST (1<<0) /* Software reset */ | ||
| 167 | |||
| 168 | /* We've been assigned a range on the "Low-density serial ports" major */ | ||
| 169 | #define SERIAL_IMX_MAJOR 207 | ||
| 170 | #define MINOR_START 16 | ||
| 171 | #define DEV_NAME "ttymxc" | ||
| 172 | #define MAX_INTERNAL_IRQ MXC_INTERNAL_IRQS | ||
| 173 | |||
| 174 | /* | ||
| 175 | * This determines how often we check the modem status signals | ||
| 176 | * for any change. They generally aren't connected to an IRQ | ||
| 177 | * so we have to poll them. We also check immediately before | ||
| 178 | * filling the TX fifo incase CTS has been dropped. | ||
| 179 | */ | ||
| 180 | #define MCTRL_TIMEOUT (250*HZ/1000) | ||
| 181 | |||
| 182 | #define DRIVER_NAME "IMX-uart" | ||
| 183 | |||
| 184 | #define UART_NR 8 | ||
| 185 | |||
| 186 | struct imx_port { | ||
| 187 | struct uart_port port; | ||
| 188 | struct timer_list timer; | ||
| 189 | unsigned int old_status; | ||
| 190 | int txirq,rxirq,rtsirq; | ||
| 191 | unsigned int have_rtscts:1; | ||
| 192 | unsigned int use_irda:1; | ||
| 193 | unsigned int irda_inv_rx:1; | ||
| 194 | unsigned int irda_inv_tx:1; | ||
| 195 | unsigned short trcv_delay; /* transceiver delay */ | ||
| 196 | struct clk *clk; | ||
| 197 | }; | ||
| 198 | |||
| 199 | #ifdef CONFIG_IRDA | ||
| 200 | #define USE_IRDA(sport) ((sport)->use_irda) | ||
| 201 | #else | ||
| 202 | #define USE_IRDA(sport) (0) | ||
| 203 | #endif | ||
| 204 | |||
| 205 | /* | ||
| 206 | * Handle any change of modem status signal since we were last called. | ||
| 207 | */ | ||
| 208 | static void imx_mctrl_check(struct imx_port *sport) | ||
| 209 | { | ||
| 210 | unsigned int status, changed; | ||
| 211 | |||
| 212 | status = sport->port.ops->get_mctrl(&sport->port); | ||
| 213 | changed = status ^ sport->old_status; | ||
| 214 | |||
| 215 | if (changed == 0) | ||
| 216 | return; | ||
| 217 | |||
| 218 | sport->old_status = status; | ||
| 219 | |||
| 220 | if (changed & TIOCM_RI) | ||
| 221 | sport->port.icount.rng++; | ||
| 222 | if (changed & TIOCM_DSR) | ||
| 223 | sport->port.icount.dsr++; | ||
| 224 | if (changed & TIOCM_CAR) | ||
| 225 | uart_handle_dcd_change(&sport->port, status & TIOCM_CAR); | ||
| 226 | if (changed & TIOCM_CTS) | ||
| 227 | uart_handle_cts_change(&sport->port, status & TIOCM_CTS); | ||
| 228 | |||
| 229 | wake_up_interruptible(&sport->port.state->port.delta_msr_wait); | ||
| 230 | } | ||
| 231 | |||
| 232 | /* | ||
| 233 | * This is our per-port timeout handler, for checking the | ||
| 234 | * modem status signals. | ||
| 235 | */ | ||
| 236 | static void imx_timeout(unsigned long data) | ||
| 237 | { | ||
| 238 | struct imx_port *sport = (struct imx_port *)data; | ||
| 239 | unsigned long flags; | ||
| 240 | |||
| 241 | if (sport->port.state) { | ||
| 242 | spin_lock_irqsave(&sport->port.lock, flags); | ||
| 243 | imx_mctrl_check(sport); | ||
| 244 | spin_unlock_irqrestore(&sport->port.lock, flags); | ||
| 245 | |||
| 246 | mod_timer(&sport->timer, jiffies + MCTRL_TIMEOUT); | ||
| 247 | } | ||
| 248 | } | ||
| 249 | |||
| 250 | /* | ||
| 251 | * interrupts disabled on entry | ||
| 252 | */ | ||
| 253 | static void imx_stop_tx(struct uart_port *port) | ||
| 254 | { | ||
| 255 | struct imx_port *sport = (struct imx_port *)port; | ||
| 256 | unsigned long temp; | ||
| 257 | |||
| 258 | if (USE_IRDA(sport)) { | ||
| 259 | /* half duplex - wait for end of transmission */ | ||
| 260 | int n = 256; | ||
| 261 | while ((--n > 0) && | ||
| 262 | !(readl(sport->port.membase + USR2) & USR2_TXDC)) { | ||
| 263 | udelay(5); | ||
| 264 | barrier(); | ||
| 265 | } | ||
| 266 | /* | ||
| 267 | * irda transceiver - wait a bit more to avoid | ||
| 268 | * cutoff, hardware dependent | ||
| 269 | */ | ||
| 270 | udelay(sport->trcv_delay); | ||
| 271 | |||
| 272 | /* | ||
| 273 | * half duplex - reactivate receive mode, | ||
| 274 | * flush receive pipe echo crap | ||
| 275 | */ | ||
| 276 | if (readl(sport->port.membase + USR2) & USR2_TXDC) { | ||
| 277 | temp = readl(sport->port.membase + UCR1); | ||
| 278 | temp &= ~(UCR1_TXMPTYEN | UCR1_TRDYEN); | ||
| 279 | writel(temp, sport->port.membase + UCR1); | ||
| 280 | |||
| 281 | temp = readl(sport->port.membase + UCR4); | ||
| 282 | temp &= ~(UCR4_TCEN); | ||
| 283 | writel(temp, sport->port.membase + UCR4); | ||
| 284 | |||
| 285 | while (readl(sport->port.membase + URXD0) & | ||
| 286 | URXD_CHARRDY) | ||
| 287 | barrier(); | ||
| 288 | |||
| 289 | temp = readl(sport->port.membase + UCR1); | ||
| 290 | temp |= UCR1_RRDYEN; | ||
| 291 | writel(temp, sport->port.membase + UCR1); | ||
| 292 | |||
| 293 | temp = readl(sport->port.membase + UCR4); | ||
| 294 | temp |= UCR4_DREN; | ||
| 295 | writel(temp, sport->port.membase + UCR4); | ||
| 296 | } | ||
| 297 | return; | ||
| 298 | } | ||
| 299 | |||
| 300 | temp = readl(sport->port.membase + UCR1); | ||
| 301 | writel(temp & ~UCR1_TXMPTYEN, sport->port.membase + UCR1); | ||
| 302 | } | ||
| 303 | |||
| 304 | /* | ||
| 305 | * interrupts disabled on entry | ||
| 306 | */ | ||
| 307 | static void imx_stop_rx(struct uart_port *port) | ||
| 308 | { | ||
| 309 | struct imx_port *sport = (struct imx_port *)port; | ||
| 310 | unsigned long temp; | ||
| 311 | |||
| 312 | temp = readl(sport->port.membase + UCR2); | ||
| 313 | writel(temp &~ UCR2_RXEN, sport->port.membase + UCR2); | ||
| 314 | } | ||
| 315 | |||
| 316 | /* | ||
| 317 | * Set the modem control timer to fire immediately. | ||
| 318 | */ | ||
| 319 | static void imx_enable_ms(struct uart_port *port) | ||
| 320 | { | ||
| 321 | struct imx_port *sport = (struct imx_port *)port; | ||
| 322 | |||
| 323 | mod_timer(&sport->timer, jiffies); | ||
| 324 | } | ||
| 325 | |||
| 326 | static inline void imx_transmit_buffer(struct imx_port *sport) | ||
| 327 | { | ||
| 328 | struct circ_buf *xmit = &sport->port.state->xmit; | ||
| 329 | |||
| 330 | while (!uart_circ_empty(xmit) && | ||
| 331 | !(readl(sport->port.membase + UTS) & UTS_TXFULL)) { | ||
| 332 | /* send xmit->buf[xmit->tail] | ||
| 333 | * out the port here */ | ||
| 334 | writel(xmit->buf[xmit->tail], sport->port.membase + URTX0); | ||
| 335 | xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1); | ||
| 336 | sport->port.icount.tx++; | ||
| 337 | } | ||
| 338 | |||
| 339 | if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS) | ||
| 340 | uart_write_wakeup(&sport->port); | ||
| 341 | |||
| 342 | if (uart_circ_empty(xmit)) | ||
| 343 | imx_stop_tx(&sport->port); | ||
| 344 | } | ||
| 345 | |||
| 346 | /* | ||
| 347 | * interrupts disabled on entry | ||
| 348 | */ | ||
| 349 | static void imx_start_tx(struct uart_port *port) | ||
| 350 | { | ||
| 351 | struct imx_port *sport = (struct imx_port *)port; | ||
| 352 | unsigned long temp; | ||
| 353 | |||
| 354 | if (USE_IRDA(sport)) { | ||
| 355 | /* half duplex in IrDA mode; have to disable receive mode */ | ||
| 356 | temp = readl(sport->port.membase + UCR4); | ||
| 357 | temp &= ~(UCR4_DREN); | ||
| 358 | writel(temp, sport->port.membase + UCR4); | ||
| 359 | |||
| 360 | temp = readl(sport->port.membase + UCR1); | ||
| 361 | temp &= ~(UCR1_RRDYEN); | ||
| 362 | writel(temp, sport->port.membase + UCR1); | ||
| 363 | } | ||
| 364 | |||
| 365 | temp = readl(sport->port.membase + UCR1); | ||
| 366 | writel(temp | UCR1_TXMPTYEN, sport->port.membase + UCR1); | ||
| 367 | |||
| 368 | if (USE_IRDA(sport)) { | ||
| 369 | temp = readl(sport->port.membase + UCR1); | ||
| 370 | temp |= UCR1_TRDYEN; | ||
| 371 | writel(temp, sport->port.membase + UCR1); | ||
| 372 | |||
| 373 | temp = readl(sport->port.membase + UCR4); | ||
| 374 | temp |= UCR4_TCEN; | ||
| 375 | writel(temp, sport->port.membase + UCR4); | ||
| 376 | } | ||
| 377 | |||
| 378 | if (readl(sport->port.membase + UTS) & UTS_TXEMPTY) | ||
| 379 | imx_transmit_buffer(sport); | ||
| 380 | } | ||
| 381 | |||
| 382 | static irqreturn_t imx_rtsint(int irq, void *dev_id) | ||
| 383 | { | ||
| 384 | struct imx_port *sport = dev_id; | ||
| 385 | unsigned int val = readl(sport->port.membase + USR1) & USR1_RTSS; | ||
| 386 | unsigned long flags; | ||
| 387 | |||
| 388 | spin_lock_irqsave(&sport->port.lock, flags); | ||
| 389 | |||
| 390 | writel(USR1_RTSD, sport->port.membase + USR1); | ||
| 391 | uart_handle_cts_change(&sport->port, !!val); | ||
| 392 | wake_up_interruptible(&sport->port.state->port.delta_msr_wait); | ||
| 393 | |||
| 394 | spin_unlock_irqrestore(&sport->port.lock, flags); | ||
| 395 | return IRQ_HANDLED; | ||
| 396 | } | ||
| 397 | |||
| 398 | static irqreturn_t imx_txint(int irq, void *dev_id) | ||
| 399 | { | ||
| 400 | struct imx_port *sport = dev_id; | ||
| 401 | struct circ_buf *xmit = &sport->port.state->xmit; | ||
| 402 | unsigned long flags; | ||
| 403 | |||
| 404 | spin_lock_irqsave(&sport->port.lock,flags); | ||
| 405 | if (sport->port.x_char) | ||
| 406 | { | ||
| 407 | /* Send next char */ | ||
| 408 | writel(sport->port.x_char, sport->port.membase + URTX0); | ||
| 409 | goto out; | ||
| 410 | } | ||
| 411 | |||
| 412 | if (uart_circ_empty(xmit) || uart_tx_stopped(&sport->port)) { | ||
| 413 | imx_stop_tx(&sport->port); | ||
| 414 | goto out; | ||
| 415 | } | ||
| 416 | |||
| 417 | imx_transmit_buffer(sport); | ||
| 418 | |||
| 419 | if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS) | ||
| 420 | uart_write_wakeup(&sport->port); | ||
| 421 | |||
| 422 | out: | ||
| 423 | spin_unlock_irqrestore(&sport->port.lock,flags); | ||
| 424 | return IRQ_HANDLED; | ||
| 425 | } | ||
| 426 | |||
| 427 | static irqreturn_t imx_rxint(int irq, void *dev_id) | ||
| 428 | { | ||
| 429 | struct imx_port *sport = dev_id; | ||
| 430 | unsigned int rx,flg,ignored = 0; | ||
| 431 | struct tty_struct *tty = sport->port.state->port.tty; | ||
| 432 | unsigned long flags, temp; | ||
| 433 | |||
| 434 | spin_lock_irqsave(&sport->port.lock,flags); | ||
| 435 | |||
| 436 | while (readl(sport->port.membase + USR2) & USR2_RDR) { | ||
| 437 | flg = TTY_NORMAL; | ||
| 438 | sport->port.icount.rx++; | ||
| 439 | |||
| 440 | rx = readl(sport->port.membase + URXD0); | ||
| 441 | |||
| 442 | temp = readl(sport->port.membase + USR2); | ||
| 443 | if (temp & USR2_BRCD) { | ||
| 444 | writel(USR2_BRCD, sport->port.membase + USR2); | ||
| 445 | if (uart_handle_break(&sport->port)) | ||
| 446 | continue; | ||
| 447 | } | ||
| 448 | |||
| 449 | if (uart_handle_sysrq_char(&sport->port, (unsigned char)rx)) | ||
| 450 | continue; | ||
| 451 | |||
| 452 | if (rx & (URXD_PRERR | URXD_OVRRUN | URXD_FRMERR) ) { | ||
| 453 | if (rx & URXD_PRERR) | ||
| 454 | sport->port.icount.parity++; | ||
| 455 | else if (rx & URXD_FRMERR) | ||
| 456 | sport->port.icount.frame++; | ||
| 457 | if (rx & URXD_OVRRUN) | ||
| 458 | sport->port.icount.overrun++; | ||
| 459 | |||
| 460 | if (rx & sport->port.ignore_status_mask) { | ||
| 461 | if (++ignored > 100) | ||
| 462 | goto out; | ||
| 463 | continue; | ||
| 464 | } | ||
| 465 | |||
| 466 | rx &= sport->port.read_status_mask; | ||
| 467 | |||
| 468 | if (rx & URXD_PRERR) | ||
| 469 | flg = TTY_PARITY; | ||
| 470 | else if (rx & URXD_FRMERR) | ||
| 471 | flg = TTY_FRAME; | ||
| 472 | if (rx & URXD_OVRRUN) | ||
| 473 | flg = TTY_OVERRUN; | ||
| 474 | |||
| 475 | #ifdef SUPPORT_SYSRQ | ||
| 476 | sport->port.sysrq = 0; | ||
| 477 | #endif | ||
| 478 | } | ||
| 479 | |||
| 480 | tty_insert_flip_char(tty, rx, flg); | ||
| 481 | } | ||
| 482 | |||
| 483 | out: | ||
| 484 | spin_unlock_irqrestore(&sport->port.lock,flags); | ||
| 485 | tty_flip_buffer_push(tty); | ||
| 486 | return IRQ_HANDLED; | ||
| 487 | } | ||
| 488 | |||
| 489 | static irqreturn_t imx_int(int irq, void *dev_id) | ||
| 490 | { | ||
| 491 | struct imx_port *sport = dev_id; | ||
| 492 | unsigned int sts; | ||
| 493 | |||
| 494 | sts = readl(sport->port.membase + USR1); | ||
| 495 | |||
| 496 | if (sts & USR1_RRDY) | ||
| 497 | imx_rxint(irq, dev_id); | ||
| 498 | |||
| 499 | if (sts & USR1_TRDY && | ||
| 500 | readl(sport->port.membase + UCR1) & UCR1_TXMPTYEN) | ||
| 501 | imx_txint(irq, dev_id); | ||
| 502 | |||
| 503 | if (sts & USR1_RTSD) | ||
| 504 | imx_rtsint(irq, dev_id); | ||
| 505 | |||
| 506 | return IRQ_HANDLED; | ||
| 507 | } | ||
| 508 | |||
| 509 | /* | ||
| 510 | * Return TIOCSER_TEMT when transmitter is not busy. | ||
| 511 | */ | ||
| 512 | static unsigned int imx_tx_empty(struct uart_port *port) | ||
| 513 | { | ||
| 514 | struct imx_port *sport = (struct imx_port *)port; | ||
| 515 | |||
| 516 | return (readl(sport->port.membase + USR2) & USR2_TXDC) ? TIOCSER_TEMT : 0; | ||
| 517 | } | ||
| 518 | |||
| 519 | /* | ||
| 520 | * We have a modem side uart, so the meanings of RTS and CTS are inverted. | ||
| 521 | */ | ||
| 522 | static unsigned int imx_get_mctrl(struct uart_port *port) | ||
| 523 | { | ||
| 524 | struct imx_port *sport = (struct imx_port *)port; | ||
| 525 | unsigned int tmp = TIOCM_DSR | TIOCM_CAR; | ||
| 526 | |||
| 527 | if (readl(sport->port.membase + USR1) & USR1_RTSS) | ||
| 528 | tmp |= TIOCM_CTS; | ||
| 529 | |||
| 530 | if (readl(sport->port.membase + UCR2) & UCR2_CTS) | ||
| 531 | tmp |= TIOCM_RTS; | ||
| 532 | |||
| 533 | return tmp; | ||
| 534 | } | ||
| 535 | |||
| 536 | static void imx_set_mctrl(struct uart_port *port, unsigned int mctrl) | ||
| 537 | { | ||
| 538 | struct imx_port *sport = (struct imx_port *)port; | ||
| 539 | unsigned long temp; | ||
| 540 | |||
| 541 | temp = readl(sport->port.membase + UCR2) & ~UCR2_CTS; | ||
| 542 | |||
| 543 | if (mctrl & TIOCM_RTS) | ||
| 544 | temp |= UCR2_CTS; | ||
| 545 | |||
| 546 | writel(temp, sport->port.membase + UCR2); | ||
| 547 | } | ||
| 548 | |||
| 549 | /* | ||
| 550 | * Interrupts always disabled. | ||
| 551 | */ | ||
| 552 | static void imx_break_ctl(struct uart_port *port, int break_state) | ||
| 553 | { | ||
| 554 | struct imx_port *sport = (struct imx_port *)port; | ||
| 555 | unsigned long flags, temp; | ||
| 556 | |||
| 557 | spin_lock_irqsave(&sport->port.lock, flags); | ||
| 558 | |||
| 559 | temp = readl(sport->port.membase + UCR1) & ~UCR1_SNDBRK; | ||
| 560 | |||
| 561 | if ( break_state != 0 ) | ||
| 562 | temp |= UCR1_SNDBRK; | ||
| 563 | |||
| 564 | writel(temp, sport->port.membase + UCR1); | ||
| 565 | |||
| 566 | spin_unlock_irqrestore(&sport->port.lock, flags); | ||
| 567 | } | ||
| 568 | |||
| 569 | #define TXTL 2 /* reset default */ | ||
| 570 | #define RXTL 1 /* reset default */ | ||
| 571 | |||
| 572 | static int imx_setup_ufcr(struct imx_port *sport, unsigned int mode) | ||
| 573 | { | ||
| 574 | unsigned int val; | ||
| 575 | unsigned int ufcr_rfdiv; | ||
| 576 | |||
| 577 | /* set receiver / transmitter trigger level. | ||
| 578 | * RFDIV is set such way to satisfy requested uartclk value | ||
| 579 | */ | ||
| 580 | val = TXTL << 10 | RXTL; | ||
| 581 | ufcr_rfdiv = (clk_get_rate(sport->clk) + sport->port.uartclk / 2) | ||
| 582 | / sport->port.uartclk; | ||
| 583 | |||
| 584 | if(!ufcr_rfdiv) | ||
| 585 | ufcr_rfdiv = 1; | ||
| 586 | |||
| 587 | val |= UFCR_RFDIV_REG(ufcr_rfdiv); | ||
| 588 | |||
| 589 | writel(val, sport->port.membase + UFCR); | ||
| 590 | |||
| 591 | return 0; | ||
| 592 | } | ||
| 593 | |||
| 594 | /* half the RX buffer size */ | ||
| 595 | #define CTSTL 16 | ||
| 596 | |||
| 597 | static int imx_startup(struct uart_port *port) | ||
| 598 | { | ||
| 599 | struct imx_port *sport = (struct imx_port *)port; | ||
| 600 | int retval; | ||
| 601 | unsigned long flags, temp; | ||
| 602 | |||
| 603 | imx_setup_ufcr(sport, 0); | ||
| 604 | |||
| 605 | /* disable the DREN bit (Data Ready interrupt enable) before | ||
| 606 | * requesting IRQs | ||
| 607 | */ | ||
| 608 | temp = readl(sport->port.membase + UCR4); | ||
| 609 | |||
| 610 | if (USE_IRDA(sport)) | ||
| 611 | temp |= UCR4_IRSC; | ||
| 612 | |||
| 613 | /* set the trigger level for CTS */ | ||
| 614 | temp &= ~(UCR4_CTSTL_MASK<< UCR4_CTSTL_SHF); | ||
| 615 | temp |= CTSTL<< UCR4_CTSTL_SHF; | ||
| 616 | |||
| 617 | writel(temp & ~UCR4_DREN, sport->port.membase + UCR4); | ||
| 618 | |||
| 619 | if (USE_IRDA(sport)) { | ||
| 620 | /* reset fifo's and state machines */ | ||
| 621 | int i = 100; | ||
| 622 | temp = readl(sport->port.membase + UCR2); | ||
| 623 | temp &= ~UCR2_SRST; | ||
| 624 | writel(temp, sport->port.membase + UCR2); | ||
| 625 | while (!(readl(sport->port.membase + UCR2) & UCR2_SRST) && | ||
| 626 | (--i > 0)) { | ||
| 627 | udelay(1); | ||
| 628 | } | ||
| 629 | } | ||
| 630 | |||
| 631 | /* | ||
| 632 | * Allocate the IRQ(s) i.MX1 has three interrupts whereas later | ||
| 633 | * chips only have one interrupt. | ||
| 634 | */ | ||
| 635 | if (sport->txirq > 0) { | ||
| 636 | retval = request_irq(sport->rxirq, imx_rxint, 0, | ||
| 637 | DRIVER_NAME, sport); | ||
| 638 | if (retval) | ||
| 639 | goto error_out1; | ||
| 640 | |||
| 641 | retval = request_irq(sport->txirq, imx_txint, 0, | ||
| 642 | DRIVER_NAME, sport); | ||
| 643 | if (retval) | ||
| 644 | goto error_out2; | ||
| 645 | |||
| 646 | /* do not use RTS IRQ on IrDA */ | ||
| 647 | if (!USE_IRDA(sport)) { | ||
| 648 | retval = request_irq(sport->rtsirq, imx_rtsint, | ||
| 649 | (sport->rtsirq < MAX_INTERNAL_IRQ) ? 0 : | ||
| 650 | IRQF_TRIGGER_FALLING | | ||
| 651 | IRQF_TRIGGER_RISING, | ||
| 652 | DRIVER_NAME, sport); | ||
| 653 | if (retval) | ||
| 654 | goto error_out3; | ||
| 655 | } | ||
| 656 | } else { | ||
| 657 | retval = request_irq(sport->port.irq, imx_int, 0, | ||
| 658 | DRIVER_NAME, sport); | ||
| 659 | if (retval) { | ||
| 660 | free_irq(sport->port.irq, sport); | ||
| 661 | goto error_out1; | ||
| 662 | } | ||
| 663 | } | ||
| 664 | |||
| 665 | /* | ||
| 666 | * Finally, clear and enable interrupts | ||
| 667 | */ | ||
| 668 | writel(USR1_RTSD, sport->port.membase + USR1); | ||
| 669 | |||
| 670 | temp = readl(sport->port.membase + UCR1); | ||
| 671 | temp |= UCR1_RRDYEN | UCR1_RTSDEN | UCR1_UARTEN; | ||
| 672 | |||
| 673 | if (USE_IRDA(sport)) { | ||
| 674 | temp |= UCR1_IREN; | ||
| 675 | temp &= ~(UCR1_RTSDEN); | ||
| 676 | } | ||
| 677 | |||
| 678 | writel(temp, sport->port.membase + UCR1); | ||
| 679 | |||
| 680 | temp = readl(sport->port.membase + UCR2); | ||
| 681 | temp |= (UCR2_RXEN | UCR2_TXEN); | ||
| 682 | writel(temp, sport->port.membase + UCR2); | ||
| 683 | |||
| 684 | if (USE_IRDA(sport)) { | ||
| 685 | /* clear RX-FIFO */ | ||
| 686 | int i = 64; | ||
| 687 | while ((--i > 0) && | ||
| 688 | (readl(sport->port.membase + URXD0) & URXD_CHARRDY)) { | ||
| 689 | barrier(); | ||
| 690 | } | ||
| 691 | } | ||
| 692 | |||
| 693 | if (!cpu_is_mx1()) { | ||
| 694 | temp = readl(sport->port.membase + UCR3); | ||
| 695 | temp |= MX2_UCR3_RXDMUXSEL; | ||
| 696 | writel(temp, sport->port.membase + UCR3); | ||
| 697 | } | ||
| 698 | |||
| 699 | if (USE_IRDA(sport)) { | ||
| 700 | temp = readl(sport->port.membase + UCR4); | ||
| 701 | if (sport->irda_inv_rx) | ||
| 702 | temp |= UCR4_INVR; | ||
| 703 | else | ||
| 704 | temp &= ~(UCR4_INVR); | ||
| 705 | writel(temp | UCR4_DREN, sport->port.membase + UCR4); | ||
| 706 | |||
| 707 | temp = readl(sport->port.membase + UCR3); | ||
| 708 | if (sport->irda_inv_tx) | ||
| 709 | temp |= UCR3_INVT; | ||
| 710 | else | ||
| 711 | temp &= ~(UCR3_INVT); | ||
| 712 | writel(temp, sport->port.membase + UCR3); | ||
| 713 | } | ||
| 714 | |||
| 715 | /* | ||
| 716 | * Enable modem status interrupts | ||
| 717 | */ | ||
| 718 | spin_lock_irqsave(&sport->port.lock,flags); | ||
| 719 | imx_enable_ms(&sport->port); | ||
| 720 | spin_unlock_irqrestore(&sport->port.lock,flags); | ||
| 721 | |||
| 722 | if (USE_IRDA(sport)) { | ||
| 723 | struct imxuart_platform_data *pdata; | ||
| 724 | pdata = sport->port.dev->platform_data; | ||
| 725 | sport->irda_inv_rx = pdata->irda_inv_rx; | ||
| 726 | sport->irda_inv_tx = pdata->irda_inv_tx; | ||
| 727 | sport->trcv_delay = pdata->transceiver_delay; | ||
| 728 | if (pdata->irda_enable) | ||
| 729 | pdata->irda_enable(1); | ||
| 730 | } | ||
| 731 | |||
| 732 | return 0; | ||
| 733 | |||
| 734 | error_out3: | ||
| 735 | if (sport->txirq) | ||
| 736 | free_irq(sport->txirq, sport); | ||
| 737 | error_out2: | ||
| 738 | if (sport->rxirq) | ||
| 739 | free_irq(sport->rxirq, sport); | ||
| 740 | error_out1: | ||
| 741 | return retval; | ||
| 742 | } | ||
| 743 | |||
| 744 | static void imx_shutdown(struct uart_port *port) | ||
| 745 | { | ||
| 746 | struct imx_port *sport = (struct imx_port *)port; | ||
| 747 | unsigned long temp; | ||
| 748 | |||
| 749 | temp = readl(sport->port.membase + UCR2); | ||
| 750 | temp &= ~(UCR2_TXEN); | ||
| 751 | writel(temp, sport->port.membase + UCR2); | ||
| 752 | |||
| 753 | if (USE_IRDA(sport)) { | ||
| 754 | struct imxuart_platform_data *pdata; | ||
| 755 | pdata = sport->port.dev->platform_data; | ||
| 756 | if (pdata->irda_enable) | ||
| 757 | pdata->irda_enable(0); | ||
| 758 | } | ||
| 759 | |||
| 760 | /* | ||
| 761 | * Stop our timer. | ||
| 762 | */ | ||
| 763 | del_timer_sync(&sport->timer); | ||
| 764 | |||
| 765 | /* | ||
| 766 | * Free the interrupts | ||
| 767 | */ | ||
| 768 | if (sport->txirq > 0) { | ||
| 769 | if (!USE_IRDA(sport)) | ||
| 770 | free_irq(sport->rtsirq, sport); | ||
| 771 | free_irq(sport->txirq, sport); | ||
| 772 | free_irq(sport->rxirq, sport); | ||
| 773 | } else | ||
| 774 | free_irq(sport->port.irq, sport); | ||
| 775 | |||
| 776 | /* | ||
| 777 | * Disable all interrupts, port and break condition. | ||
| 778 | */ | ||
| 779 | |||
| 780 | temp = readl(sport->port.membase + UCR1); | ||
| 781 | temp &= ~(UCR1_TXMPTYEN | UCR1_RRDYEN | UCR1_RTSDEN | UCR1_UARTEN); | ||
| 782 | if (USE_IRDA(sport)) | ||
| 783 | temp &= ~(UCR1_IREN); | ||
| 784 | |||
| 785 | writel(temp, sport->port.membase + UCR1); | ||
| 786 | } | ||
| 787 | |||
| 788 | static void | ||
| 789 | imx_set_termios(struct uart_port *port, struct ktermios *termios, | ||
| 790 | struct ktermios *old) | ||
| 791 | { | ||
| 792 | struct imx_port *sport = (struct imx_port *)port; | ||
| 793 | unsigned long flags; | ||
| 794 | unsigned int ucr2, old_ucr1, old_txrxen, baud, quot; | ||
| 795 | unsigned int old_csize = old ? old->c_cflag & CSIZE : CS8; | ||
| 796 | unsigned int div, ufcr; | ||
| 797 | unsigned long num, denom; | ||
| 798 | uint64_t tdiv64; | ||
| 799 | |||
| 800 | /* | ||
| 801 | * If we don't support modem control lines, don't allow | ||
| 802 | * these to be set. | ||
| 803 | */ | ||
| 804 | if (0) { | ||
| 805 | termios->c_cflag &= ~(HUPCL | CRTSCTS | CMSPAR); | ||
| 806 | termios->c_cflag |= CLOCAL; | ||
| 807 | } | ||
| 808 | |||
| 809 | /* | ||
| 810 | * We only support CS7 and CS8. | ||
| 811 | */ | ||
| 812 | while ((termios->c_cflag & CSIZE) != CS7 && | ||
| 813 | (termios->c_cflag & CSIZE) != CS8) { | ||
| 814 | termios->c_cflag &= ~CSIZE; | ||
| 815 | termios->c_cflag |= old_csize; | ||
| 816 | old_csize = CS8; | ||
| 817 | } | ||
| 818 | |||
| 819 | if ((termios->c_cflag & CSIZE) == CS8) | ||
| 820 | ucr2 = UCR2_WS | UCR2_SRST | UCR2_IRTS; | ||
| 821 | else | ||
| 822 | ucr2 = UCR2_SRST | UCR2_IRTS; | ||
| 823 | |||
| 824 | if (termios->c_cflag & CRTSCTS) { | ||
| 825 | if( sport->have_rtscts ) { | ||
| 826 | ucr2 &= ~UCR2_IRTS; | ||
| 827 | ucr2 |= UCR2_CTSC; | ||
| 828 | } else { | ||
| 829 | termios->c_cflag &= ~CRTSCTS; | ||
| 830 | } | ||
| 831 | } | ||
| 832 | |||
| 833 | if (termios->c_cflag & CSTOPB) | ||
| 834 | ucr2 |= UCR2_STPB; | ||
| 835 | if (termios->c_cflag & PARENB) { | ||
| 836 | ucr2 |= UCR2_PREN; | ||
| 837 | if (termios->c_cflag & PARODD) | ||
| 838 | ucr2 |= UCR2_PROE; | ||
| 839 | } | ||
| 840 | |||
| 841 | /* | ||
| 842 | * Ask the core to calculate the divisor for us. | ||
| 843 | */ | ||
| 844 | baud = uart_get_baud_rate(port, termios, old, 50, port->uartclk / 16); | ||
| 845 | quot = uart_get_divisor(port, baud); | ||
| 846 | |||
| 847 | spin_lock_irqsave(&sport->port.lock, flags); | ||
| 848 | |||
| 849 | sport->port.read_status_mask = 0; | ||
| 850 | if (termios->c_iflag & INPCK) | ||
| 851 | sport->port.read_status_mask |= (URXD_FRMERR | URXD_PRERR); | ||
| 852 | if (termios->c_iflag & (BRKINT | PARMRK)) | ||
| 853 | sport->port.read_status_mask |= URXD_BRK; | ||
| 854 | |||
| 855 | /* | ||
| 856 | * Characters to ignore | ||
| 857 | */ | ||
| 858 | sport->port.ignore_status_mask = 0; | ||
| 859 | if (termios->c_iflag & IGNPAR) | ||
| 860 | sport->port.ignore_status_mask |= URXD_PRERR; | ||
| 861 | if (termios->c_iflag & IGNBRK) { | ||
| 862 | sport->port.ignore_status_mask |= URXD_BRK; | ||
| 863 | /* | ||
| 864 | * If we're ignoring parity and break indicators, | ||
| 865 | * ignore overruns too (for real raw support). | ||
| 866 | */ | ||
| 867 | if (termios->c_iflag & IGNPAR) | ||
| 868 | sport->port.ignore_status_mask |= URXD_OVRRUN; | ||
| 869 | } | ||
| 870 | |||
| 871 | del_timer_sync(&sport->timer); | ||
| 872 | |||
| 873 | /* | ||
| 874 | * Update the per-port timeout. | ||
| 875 | */ | ||
| 876 | uart_update_timeout(port, termios->c_cflag, baud); | ||
| 877 | |||
| 878 | /* | ||
| 879 | * disable interrupts and drain transmitter | ||
| 880 | */ | ||
| 881 | old_ucr1 = readl(sport->port.membase + UCR1); | ||
| 882 | writel(old_ucr1 & ~(UCR1_TXMPTYEN | UCR1_RRDYEN | UCR1_RTSDEN), | ||
| 883 | sport->port.membase + UCR1); | ||
| 884 | |||
| 885 | while ( !(readl(sport->port.membase + USR2) & USR2_TXDC)) | ||
| 886 | barrier(); | ||
| 887 | |||
| 888 | /* then, disable everything */ | ||
| 889 | old_txrxen = readl(sport->port.membase + UCR2); | ||
| 890 | writel(old_txrxen & ~( UCR2_TXEN | UCR2_RXEN), | ||
| 891 | sport->port.membase + UCR2); | ||
| 892 | old_txrxen &= (UCR2_TXEN | UCR2_RXEN); | ||
| 893 | |||
| 894 | if (USE_IRDA(sport)) { | ||
| 895 | /* | ||
| 896 | * use maximum available submodule frequency to | ||
| 897 | * avoid missing short pulses due to low sampling rate | ||
| 898 | */ | ||
| 899 | div = 1; | ||
| 900 | } else { | ||
| 901 | div = sport->port.uartclk / (baud * 16); | ||
| 902 | if (div > 7) | ||
| 903 | div = 7; | ||
| 904 | if (!div) | ||
| 905 | div = 1; | ||
| 906 | } | ||
| 907 | |||
| 908 | rational_best_approximation(16 * div * baud, sport->port.uartclk, | ||
| 909 | 1 << 16, 1 << 16, &num, &denom); | ||
| 910 | |||
| 911 | tdiv64 = sport->port.uartclk; | ||
| 912 | tdiv64 *= num; | ||
| 913 | do_div(tdiv64, denom * 16 * div); | ||
| 914 | tty_termios_encode_baud_rate(termios, | ||
| 915 | (speed_t)tdiv64, (speed_t)tdiv64); | ||
| 916 | |||
| 917 | num -= 1; | ||
| 918 | denom -= 1; | ||
| 919 | |||
| 920 | ufcr = readl(sport->port.membase + UFCR); | ||
| 921 | ufcr = (ufcr & (~UFCR_RFDIV)) | UFCR_RFDIV_REG(div); | ||
| 922 | writel(ufcr, sport->port.membase + UFCR); | ||
| 923 | |||
| 924 | writel(num, sport->port.membase + UBIR); | ||
| 925 | writel(denom, sport->port.membase + UBMR); | ||
| 926 | |||
| 927 | if (!cpu_is_mx1()) | ||
| 928 | writel(sport->port.uartclk / div / 1000, | ||
| 929 | sport->port.membase + MX2_ONEMS); | ||
| 930 | |||
| 931 | writel(old_ucr1, sport->port.membase + UCR1); | ||
| 932 | |||
| 933 | /* set the parity, stop bits and data size */ | ||
| 934 | writel(ucr2 | old_txrxen, sport->port.membase + UCR2); | ||
| 935 | |||
| 936 | if (UART_ENABLE_MS(&sport->port, termios->c_cflag)) | ||
| 937 | imx_enable_ms(&sport->port); | ||
| 938 | |||
| 939 | spin_unlock_irqrestore(&sport->port.lock, flags); | ||
| 940 | } | ||
| 941 | |||
| 942 | static const char *imx_type(struct uart_port *port) | ||
| 943 | { | ||
| 944 | struct imx_port *sport = (struct imx_port *)port; | ||
| 945 | |||
| 946 | return sport->port.type == PORT_IMX ? "IMX" : NULL; | ||
| 947 | } | ||
| 948 | |||
| 949 | /* | ||
| 950 | * Release the memory region(s) being used by 'port'. | ||
| 951 | */ | ||
| 952 | static void imx_release_port(struct uart_port *port) | ||
| 953 | { | ||
| 954 | struct platform_device *pdev = to_platform_device(port->dev); | ||
| 955 | struct resource *mmres; | ||
| 956 | |||
| 957 | mmres = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
| 958 | release_mem_region(mmres->start, mmres->end - mmres->start + 1); | ||
| 959 | } | ||
| 960 | |||
| 961 | /* | ||
| 962 | * Request the memory region(s) being used by 'port'. | ||
| 963 | */ | ||
| 964 | static int imx_request_port(struct uart_port *port) | ||
| 965 | { | ||
| 966 | struct platform_device *pdev = to_platform_device(port->dev); | ||
| 967 | struct resource *mmres; | ||
| 968 | void *ret; | ||
| 969 | |||
| 970 | mmres = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
| 971 | if (!mmres) | ||
| 972 | return -ENODEV; | ||
| 973 | |||
| 974 | ret = request_mem_region(mmres->start, mmres->end - mmres->start + 1, | ||
| 975 | "imx-uart"); | ||
| 976 | |||
| 977 | return ret ? 0 : -EBUSY; | ||
| 978 | } | ||
| 979 | |||
| 980 | /* | ||
| 981 | * Configure/autoconfigure the port. | ||
| 982 | */ | ||
| 983 | static void imx_config_port(struct uart_port *port, int flags) | ||
| 984 | { | ||
| 985 | struct imx_port *sport = (struct imx_port *)port; | ||
| 986 | |||
| 987 | if (flags & UART_CONFIG_TYPE && | ||
| 988 | imx_request_port(&sport->port) == 0) | ||
| 989 | sport->port.type = PORT_IMX; | ||
| 990 | } | ||
| 991 | |||
| 992 | /* | ||
| 993 | * Verify the new serial_struct (for TIOCSSERIAL). | ||
| 994 | * The only change we allow are to the flags and type, and | ||
| 995 | * even then only between PORT_IMX and PORT_UNKNOWN | ||
| 996 | */ | ||
| 997 | static int | ||
| 998 | imx_verify_port(struct uart_port *port, struct serial_struct *ser) | ||
| 999 | { | ||
| 1000 | struct imx_port *sport = (struct imx_port *)port; | ||
| 1001 | int ret = 0; | ||
| 1002 | |||
| 1003 | if (ser->type != PORT_UNKNOWN && ser->type != PORT_IMX) | ||
| 1004 | ret = -EINVAL; | ||
| 1005 | if (sport->port.irq != ser->irq) | ||
| 1006 | ret = -EINVAL; | ||
| 1007 | if (ser->io_type != UPIO_MEM) | ||
| 1008 | ret = -EINVAL; | ||
| 1009 | if (sport->port.uartclk / 16 != ser->baud_base) | ||
| 1010 | ret = -EINVAL; | ||
| 1011 | if ((void *)sport->port.mapbase != ser->iomem_base) | ||
| 1012 | ret = -EINVAL; | ||
| 1013 | if (sport->port.iobase != ser->port) | ||
| 1014 | ret = -EINVAL; | ||
| 1015 | if (ser->hub6 != 0) | ||
| 1016 | ret = -EINVAL; | ||
| 1017 | return ret; | ||
| 1018 | } | ||
| 1019 | |||
| 1020 | static struct uart_ops imx_pops = { | ||
| 1021 | .tx_empty = imx_tx_empty, | ||
| 1022 | .set_mctrl = imx_set_mctrl, | ||
| 1023 | .get_mctrl = imx_get_mctrl, | ||
| 1024 | .stop_tx = imx_stop_tx, | ||
| 1025 | .start_tx = imx_start_tx, | ||
| 1026 | .stop_rx = imx_stop_rx, | ||
| 1027 | .enable_ms = imx_enable_ms, | ||
| 1028 | .break_ctl = imx_break_ctl, | ||
| 1029 | .startup = imx_startup, | ||
| 1030 | .shutdown = imx_shutdown, | ||
| 1031 | .set_termios = imx_set_termios, | ||
| 1032 | .type = imx_type, | ||
| 1033 | .release_port = imx_release_port, | ||
| 1034 | .request_port = imx_request_port, | ||
| 1035 | .config_port = imx_config_port, | ||
| 1036 | .verify_port = imx_verify_port, | ||
| 1037 | }; | ||
| 1038 | |||
| 1039 | static struct imx_port *imx_ports[UART_NR]; | ||
| 1040 | |||
| 1041 | #ifdef CONFIG_SERIAL_IMX_CONSOLE | ||
| 1042 | static void imx_console_putchar(struct uart_port *port, int ch) | ||
| 1043 | { | ||
| 1044 | struct imx_port *sport = (struct imx_port *)port; | ||
| 1045 | |||
| 1046 | while (readl(sport->port.membase + UTS) & UTS_TXFULL) | ||
| 1047 | barrier(); | ||
| 1048 | |||
| 1049 | writel(ch, sport->port.membase + URTX0); | ||
| 1050 | } | ||
| 1051 | |||
| 1052 | /* | ||
| 1053 | * Interrupts are disabled on entering | ||
| 1054 | */ | ||
| 1055 | static void | ||
| 1056 | imx_console_write(struct console *co, const char *s, unsigned int count) | ||
| 1057 | { | ||
| 1058 | struct imx_port *sport = imx_ports[co->index]; | ||
| 1059 | unsigned int old_ucr1, old_ucr2, ucr1; | ||
| 1060 | |||
| 1061 | /* | ||
| 1062 | * First, save UCR1/2 and then disable interrupts | ||
| 1063 | */ | ||
| 1064 | ucr1 = old_ucr1 = readl(sport->port.membase + UCR1); | ||
| 1065 | old_ucr2 = readl(sport->port.membase + UCR2); | ||
| 1066 | |||
| 1067 | if (cpu_is_mx1()) | ||
| 1068 | ucr1 |= MX1_UCR1_UARTCLKEN; | ||
| 1069 | ucr1 |= UCR1_UARTEN; | ||
| 1070 | ucr1 &= ~(UCR1_TXMPTYEN | UCR1_RRDYEN | UCR1_RTSDEN); | ||
| 1071 | |||
| 1072 | writel(ucr1, sport->port.membase + UCR1); | ||
| 1073 | |||
| 1074 | writel(old_ucr2 | UCR2_TXEN, sport->port.membase + UCR2); | ||
| 1075 | |||
| 1076 | uart_console_write(&sport->port, s, count, imx_console_putchar); | ||
| 1077 | |||
| 1078 | /* | ||
| 1079 | * Finally, wait for transmitter to become empty | ||
| 1080 | * and restore UCR1/2 | ||
| 1081 | */ | ||
| 1082 | while (!(readl(sport->port.membase + USR2) & USR2_TXDC)); | ||
| 1083 | |||
| 1084 | writel(old_ucr1, sport->port.membase + UCR1); | ||
| 1085 | writel(old_ucr2, sport->port.membase + UCR2); | ||
| 1086 | } | ||
| 1087 | |||
| 1088 | /* | ||
| 1089 | * If the port was already initialised (eg, by a boot loader), | ||
| 1090 | * try to determine the current setup. | ||
| 1091 | */ | ||
| 1092 | static void __init | ||
| 1093 | imx_console_get_options(struct imx_port *sport, int *baud, | ||
| 1094 | int *parity, int *bits) | ||
| 1095 | { | ||
| 1096 | |||
| 1097 | if (readl(sport->port.membase + UCR1) & UCR1_UARTEN) { | ||
| 1098 | /* ok, the port was enabled */ | ||
| 1099 | unsigned int ucr2, ubir,ubmr, uartclk; | ||
| 1100 | unsigned int baud_raw; | ||
| 1101 | unsigned int ucfr_rfdiv; | ||
| 1102 | |||
| 1103 | ucr2 = readl(sport->port.membase + UCR2); | ||
| 1104 | |||
| 1105 | *parity = 'n'; | ||
| 1106 | if (ucr2 & UCR2_PREN) { | ||
| 1107 | if (ucr2 & UCR2_PROE) | ||
| 1108 | *parity = 'o'; | ||
| 1109 | else | ||
| 1110 | *parity = 'e'; | ||
| 1111 | } | ||
| 1112 | |||
| 1113 | if (ucr2 & UCR2_WS) | ||
| 1114 | *bits = 8; | ||
| 1115 | else | ||
| 1116 | *bits = 7; | ||
| 1117 | |||
| 1118 | ubir = readl(sport->port.membase + UBIR) & 0xffff; | ||
| 1119 | ubmr = readl(sport->port.membase + UBMR) & 0xffff; | ||
| 1120 | |||
| 1121 | ucfr_rfdiv = (readl(sport->port.membase + UFCR) & UFCR_RFDIV) >> 7; | ||
| 1122 | if (ucfr_rfdiv == 6) | ||
| 1123 | ucfr_rfdiv = 7; | ||
| 1124 | else | ||
| 1125 | ucfr_rfdiv = 6 - ucfr_rfdiv; | ||
| 1126 | |||
| 1127 | uartclk = clk_get_rate(sport->clk); | ||
| 1128 | uartclk /= ucfr_rfdiv; | ||
| 1129 | |||
| 1130 | { /* | ||
| 1131 | * The next code provides exact computation of | ||
| 1132 | * baud_raw = round(((uartclk/16) * (ubir + 1)) / (ubmr + 1)) | ||
| 1133 | * without need of float support or long long division, | ||
| 1134 | * which would be required to prevent 32bit arithmetic overflow | ||
| 1135 | */ | ||
| 1136 | unsigned int mul = ubir + 1; | ||
| 1137 | unsigned int div = 16 * (ubmr + 1); | ||
| 1138 | unsigned int rem = uartclk % div; | ||
| 1139 | |||
| 1140 | baud_raw = (uartclk / div) * mul; | ||
| 1141 | baud_raw += (rem * mul + div / 2) / div; | ||
| 1142 | *baud = (baud_raw + 50) / 100 * 100; | ||
| 1143 | } | ||
| 1144 | |||
| 1145 | if(*baud != baud_raw) | ||
| 1146 | printk(KERN_INFO "Serial: Console IMX rounded baud rate from %d to %d\n", | ||
| 1147 | baud_raw, *baud); | ||
| 1148 | } | ||
| 1149 | } | ||
| 1150 | |||
| 1151 | static int __init | ||
| 1152 | imx_console_setup(struct console *co, char *options) | ||
| 1153 | { | ||
| 1154 | struct imx_port *sport; | ||
| 1155 | int baud = 9600; | ||
| 1156 | int bits = 8; | ||
| 1157 | int parity = 'n'; | ||
| 1158 | int flow = 'n'; | ||
| 1159 | |||
| 1160 | /* | ||
| 1161 | * Check whether an invalid uart number has been specified, and | ||
| 1162 | * if so, search for the first available port that does have | ||
| 1163 | * console support. | ||
| 1164 | */ | ||
| 1165 | if (co->index == -1 || co->index >= ARRAY_SIZE(imx_ports)) | ||
| 1166 | co->index = 0; | ||
| 1167 | sport = imx_ports[co->index]; | ||
| 1168 | if(sport == NULL) | ||
| 1169 | return -ENODEV; | ||
| 1170 | |||
| 1171 | if (options) | ||
| 1172 | uart_parse_options(options, &baud, &parity, &bits, &flow); | ||
| 1173 | else | ||
| 1174 | imx_console_get_options(sport, &baud, &parity, &bits); | ||
| 1175 | |||
| 1176 | imx_setup_ufcr(sport, 0); | ||
| 1177 | |||
| 1178 | return uart_set_options(&sport->port, co, baud, parity, bits, flow); | ||
| 1179 | } | ||
| 1180 | |||
| 1181 | static struct uart_driver imx_reg; | ||
| 1182 | static struct console imx_console = { | ||
| 1183 | .name = DEV_NAME, | ||
| 1184 | .write = imx_console_write, | ||
| 1185 | .device = uart_console_device, | ||
| 1186 | .setup = imx_console_setup, | ||
| 1187 | .flags = CON_PRINTBUFFER, | ||
| 1188 | .index = -1, | ||
| 1189 | .data = &imx_reg, | ||
| 1190 | }; | ||
| 1191 | |||
| 1192 | #define IMX_CONSOLE &imx_console | ||
| 1193 | #else | ||
| 1194 | #define IMX_CONSOLE NULL | ||
| 1195 | #endif | ||
| 1196 | |||
| 1197 | static struct uart_driver imx_reg = { | ||
| 1198 | .owner = THIS_MODULE, | ||
| 1199 | .driver_name = DRIVER_NAME, | ||
| 1200 | .dev_name = DEV_NAME, | ||
| 1201 | .major = SERIAL_IMX_MAJOR, | ||
| 1202 | .minor = MINOR_START, | ||
| 1203 | .nr = ARRAY_SIZE(imx_ports), | ||
| 1204 | .cons = IMX_CONSOLE, | ||
| 1205 | }; | ||
| 1206 | |||
| 1207 | static int serial_imx_suspend(struct platform_device *dev, pm_message_t state) | ||
| 1208 | { | ||
| 1209 | struct imx_port *sport = platform_get_drvdata(dev); | ||
| 1210 | |||
| 1211 | if (sport) | ||
| 1212 | uart_suspend_port(&imx_reg, &sport->port); | ||
| 1213 | |||
| 1214 | return 0; | ||
| 1215 | } | ||
| 1216 | |||
| 1217 | static int serial_imx_resume(struct platform_device *dev) | ||
| 1218 | { | ||
| 1219 | struct imx_port *sport = platform_get_drvdata(dev); | ||
| 1220 | |||
| 1221 | if (sport) | ||
| 1222 | uart_resume_port(&imx_reg, &sport->port); | ||
| 1223 | |||
| 1224 | return 0; | ||
| 1225 | } | ||
| 1226 | |||
| 1227 | static int serial_imx_probe(struct platform_device *pdev) | ||
| 1228 | { | ||
| 1229 | struct imx_port *sport; | ||
| 1230 | struct imxuart_platform_data *pdata; | ||
| 1231 | void __iomem *base; | ||
| 1232 | int ret = 0; | ||
| 1233 | struct resource *res; | ||
| 1234 | |||
| 1235 | sport = kzalloc(sizeof(*sport), GFP_KERNEL); | ||
| 1236 | if (!sport) | ||
| 1237 | return -ENOMEM; | ||
| 1238 | |||
| 1239 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | ||
| 1240 | if (!res) { | ||
| 1241 | ret = -ENODEV; | ||
| 1242 | goto free; | ||
| 1243 | } | ||
| 1244 | |||
| 1245 | base = ioremap(res->start, PAGE_SIZE); | ||
| 1246 | if (!base) { | ||
| 1247 | ret = -ENOMEM; | ||
| 1248 | goto free; | ||
| 1249 | } | ||
| 1250 | |||
| 1251 | sport->port.dev = &pdev->dev; | ||
| 1252 | sport->port.mapbase = res->start; | ||
| 1253 | sport->port.membase = base; | ||
| 1254 | sport->port.type = PORT_IMX, | ||
| 1255 | sport->port.iotype = UPIO_MEM; | ||
| 1256 | sport->port.irq = platform_get_irq(pdev, 0); | ||
| 1257 | sport->rxirq = platform_get_irq(pdev, 0); | ||
| 1258 | sport->txirq = platform_get_irq(pdev, 1); | ||
| 1259 | sport->rtsirq = platform_get_irq(pdev, 2); | ||
| 1260 | sport->port.fifosize = 32; | ||
| 1261 | sport->port.ops = &imx_pops; | ||
| 1262 | sport->port.flags = UPF_BOOT_AUTOCONF; | ||
| 1263 | sport->port.line = pdev->id; | ||
| 1264 | init_timer(&sport->timer); | ||
| 1265 | sport->timer.function = imx_timeout; | ||
| 1266 | sport->timer.data = (unsigned long)sport; | ||
| 1267 | |||
| 1268 | sport->clk = clk_get(&pdev->dev, "uart"); | ||
| 1269 | if (IS_ERR(sport->clk)) { | ||
| 1270 | ret = PTR_ERR(sport->clk); | ||
| 1271 | goto unmap; | ||
| 1272 | } | ||
| 1273 | clk_enable(sport->clk); | ||
| 1274 | |||
| 1275 | sport->port.uartclk = clk_get_rate(sport->clk); | ||
| 1276 | |||
| 1277 | imx_ports[pdev->id] = sport; | ||
| 1278 | |||
| 1279 | pdata = pdev->dev.platform_data; | ||
| 1280 | if (pdata && (pdata->flags & IMXUART_HAVE_RTSCTS)) | ||
| 1281 | sport->have_rtscts = 1; | ||
| 1282 | |||
| 1283 | #ifdef CONFIG_IRDA | ||
| 1284 | if (pdata && (pdata->flags & IMXUART_IRDA)) | ||
| 1285 | sport->use_irda = 1; | ||
| 1286 | #endif | ||
| 1287 | |||
| 1288 | if (pdata && pdata->init) { | ||
| 1289 | ret = pdata->init(pdev); | ||
| 1290 | if (ret) | ||
| 1291 | goto clkput; | ||
| 1292 | } | ||
| 1293 | |||
| 1294 | ret = uart_add_one_port(&imx_reg, &sport->port); | ||
| 1295 | if (ret) | ||
| 1296 | goto deinit; | ||
| 1297 | platform_set_drvdata(pdev, &sport->port); | ||
| 1298 | |||
| 1299 | return 0; | ||
| 1300 | deinit: | ||
| 1301 | if (pdata && pdata->exit) | ||
| 1302 | pdata->exit(pdev); | ||
| 1303 | clkput: | ||
| 1304 | clk_put(sport->clk); | ||
| 1305 | clk_disable(sport->clk); | ||
| 1306 | unmap: | ||
| 1307 | iounmap(sport->port.membase); | ||
| 1308 | free: | ||
| 1309 | kfree(sport); | ||
| 1310 | |||
| 1311 | return ret; | ||
| 1312 | } | ||
| 1313 | |||
| 1314 | static int serial_imx_remove(struct platform_device *pdev) | ||
| 1315 | { | ||
| 1316 | struct imxuart_platform_data *pdata; | ||
| 1317 | struct imx_port *sport = platform_get_drvdata(pdev); | ||
| 1318 | |||
| 1319 | pdata = pdev->dev.platform_data; | ||
| 1320 | |||
| 1321 | platform_set_drvdata(pdev, NULL); | ||
| 1322 | |||
| 1323 | if (sport) { | ||
| 1324 | uart_remove_one_port(&imx_reg, &sport->port); | ||
| 1325 | clk_put(sport->clk); | ||
| 1326 | } | ||
| 1327 | |||
| 1328 | clk_disable(sport->clk); | ||
| 1329 | |||
| 1330 | if (pdata && pdata->exit) | ||
| 1331 | pdata->exit(pdev); | ||
| 1332 | |||
| 1333 | iounmap(sport->port.membase); | ||
| 1334 | kfree(sport); | ||
| 1335 | |||
| 1336 | return 0; | ||
| 1337 | } | ||
| 1338 | |||
| 1339 | static struct platform_driver serial_imx_driver = { | ||
| 1340 | .probe = serial_imx_probe, | ||
| 1341 | .remove = serial_imx_remove, | ||
| 1342 | |||
| 1343 | .suspend = serial_imx_suspend, | ||
| 1344 | .resume = serial_imx_resume, | ||
| 1345 | .driver = { | ||
| 1346 | .name = "imx-uart", | ||
| 1347 | .owner = THIS_MODULE, | ||
| 1348 | }, | ||
| 1349 | }; | ||
| 1350 | |||
| 1351 | static int __init imx_serial_init(void) | ||
| 1352 | { | ||
| 1353 | int ret; | ||
| 1354 | |||
| 1355 | printk(KERN_INFO "Serial: IMX driver\n"); | ||
| 1356 | |||
| 1357 | ret = uart_register_driver(&imx_reg); | ||
| 1358 | if (ret) | ||
| 1359 | return ret; | ||
| 1360 | |||
| 1361 | ret = platform_driver_register(&serial_imx_driver); | ||
| 1362 | if (ret != 0) | ||
| 1363 | uart_unregister_driver(&imx_reg); | ||
| 1364 | |||
| 1365 | return 0; | ||
| 1366 | } | ||
| 1367 | |||
| 1368 | static void __exit imx_serial_exit(void) | ||
| 1369 | { | ||
| 1370 | platform_driver_unregister(&serial_imx_driver); | ||
| 1371 | uart_unregister_driver(&imx_reg); | ||
| 1372 | } | ||
| 1373 | |||
| 1374 | module_init(imx_serial_init); | ||
| 1375 | module_exit(imx_serial_exit); | ||
| 1376 | |||
| 1377 | MODULE_AUTHOR("Sascha Hauer"); | ||
| 1378 | MODULE_DESCRIPTION("IMX generic serial port driver"); | ||
| 1379 | MODULE_LICENSE("GPL"); | ||
| 1380 | MODULE_ALIAS("platform:imx-uart"); | ||
