Merge 3.9-rc7 intp tty-next
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / tty / serial / xilinx_uartps.c
CommitLineData
61ec9016
JL
1/*
2 * Xilinx PS UART driver
3 *
4 * 2011 (c) Xilinx Inc.
5 *
6 * This program is free software; you can redistribute it
7 * and/or modify it under the terms of the GNU General Public
8 * License as published by the Free Software Foundation;
9 * either version 2 of the License, or (at your option) any
10 * later version.
11 *
12 */
13
14#include <linux/platform_device.h>
ee160a38 15#include <linux/serial.h>
61ec9016 16#include <linux/serial_core.h>
ee160a38
JS
17#include <linux/tty.h>
18#include <linux/tty_flip.h>
61ec9016 19#include <linux/console.h>
2326669c 20#include <linux/clk.h>
61ec9016
JL
21#include <linux/irq.h>
22#include <linux/io.h>
23#include <linux/of.h>
578b9ce0 24#include <linux/module.h>
61ec9016
JL
25
26#define XUARTPS_TTY_NAME "ttyPS"
27#define XUARTPS_NAME "xuartps"
28#define XUARTPS_MAJOR 0 /* use dynamic node allocation */
29#define XUARTPS_MINOR 0 /* works best with devtmpfs */
30#define XUARTPS_NR_PORTS 2
31#define XUARTPS_FIFO_SIZE 16 /* FIFO size */
32#define XUARTPS_REGISTER_SPACE 0xFFF
33
34#define xuartps_readl(offset) ioread32(port->membase + offset)
35#define xuartps_writel(val, offset) iowrite32(val, port->membase + offset)
36
37/********************************Register Map********************************/
38/** UART
39 *
40 * Register offsets for the UART.
41 *
42 */
43#define XUARTPS_CR_OFFSET 0x00 /* Control Register [8:0] */
44#define XUARTPS_MR_OFFSET 0x04 /* Mode Register [10:0] */
45#define XUARTPS_IER_OFFSET 0x08 /* Interrupt Enable [10:0] */
46#define XUARTPS_IDR_OFFSET 0x0C /* Interrupt Disable [10:0] */
47#define XUARTPS_IMR_OFFSET 0x10 /* Interrupt Mask [10:0] */
48#define XUARTPS_ISR_OFFSET 0x14 /* Interrupt Status [10:0]*/
49#define XUARTPS_BAUDGEN_OFFSET 0x18 /* Baud Rate Generator [15:0] */
50#define XUARTPS_RXTOUT_OFFSET 0x1C /* RX Timeout [7:0] */
51#define XUARTPS_RXWM_OFFSET 0x20 /* RX FIFO Trigger Level [5:0] */
52#define XUARTPS_MODEMCR_OFFSET 0x24 /* Modem Control [5:0] */
53#define XUARTPS_MODEMSR_OFFSET 0x28 /* Modem Status [8:0] */
54#define XUARTPS_SR_OFFSET 0x2C /* Channel Status [11:0] */
55#define XUARTPS_FIFO_OFFSET 0x30 /* FIFO [15:0] or [7:0] */
56#define XUARTPS_BAUDDIV_OFFSET 0x34 /* Baud Rate Divider [7:0] */
57#define XUARTPS_FLOWDEL_OFFSET 0x38 /* Flow Delay [15:0] */
58#define XUARTPS_IRRX_PWIDTH_OFFSET 0x3C /* IR Minimum Received Pulse
59 Width [15:0] */
60#define XUARTPS_IRTX_PWIDTH_OFFSET 0x40 /* IR Transmitted pulse
61 Width [7:0] */
62#define XUARTPS_TXWM_OFFSET 0x44 /* TX FIFO Trigger Level [5:0] */
63
64/** Control Register
65 *
66 * The Control register (CR) controls the major functions of the device.
67 *
68 * Control Register Bit Definitions
69 */
70#define XUARTPS_CR_STOPBRK 0x00000100 /* Stop TX break */
71#define XUARTPS_CR_STARTBRK 0x00000080 /* Set TX break */
72#define XUARTPS_CR_TX_DIS 0x00000020 /* TX disabled. */
73#define XUARTPS_CR_TX_EN 0x00000010 /* TX enabled */
74#define XUARTPS_CR_RX_DIS 0x00000008 /* RX disabled. */
75#define XUARTPS_CR_RX_EN 0x00000004 /* RX enabled */
76#define XUARTPS_CR_TXRST 0x00000002 /* TX logic reset */
77#define XUARTPS_CR_RXRST 0x00000001 /* RX logic reset */
78#define XUARTPS_CR_RST_TO 0x00000040 /* Restart Timeout Counter */
79
80/** Mode Register
81 *
82 * The mode register (MR) defines the mode of transfer as well as the data
83 * format. If this register is modified during transmission or reception,
84 * data validity cannot be guaranteed.
85 *
86 * Mode Register Bit Definitions
87 *
88 */
89#define XUARTPS_MR_CLKSEL 0x00000001 /* Pre-scalar selection */
90#define XUARTPS_MR_CHMODE_L_LOOP 0x00000200 /* Local loop back mode */
91#define XUARTPS_MR_CHMODE_NORM 0x00000000 /* Normal mode */
92
93#define XUARTPS_MR_STOPMODE_2_BIT 0x00000080 /* 2 stop bits */
94#define XUARTPS_MR_STOPMODE_1_BIT 0x00000000 /* 1 stop bit */
95
96#define XUARTPS_MR_PARITY_NONE 0x00000020 /* No parity mode */
97#define XUARTPS_MR_PARITY_MARK 0x00000018 /* Mark parity mode */
98#define XUARTPS_MR_PARITY_SPACE 0x00000010 /* Space parity mode */
99#define XUARTPS_MR_PARITY_ODD 0x00000008 /* Odd parity mode */
100#define XUARTPS_MR_PARITY_EVEN 0x00000000 /* Even parity mode */
101
102#define XUARTPS_MR_CHARLEN_6_BIT 0x00000006 /* 6 bits data */
103#define XUARTPS_MR_CHARLEN_7_BIT 0x00000004 /* 7 bits data */
104#define XUARTPS_MR_CHARLEN_8_BIT 0x00000000 /* 8 bits data */
105
106/** Interrupt Registers
107 *
108 * Interrupt control logic uses the interrupt enable register (IER) and the
109 * interrupt disable register (IDR) to set the value of the bits in the
110 * interrupt mask register (IMR). The IMR determines whether to pass an
111 * interrupt to the interrupt status register (ISR).
112 * Writing a 1 to IER Enables an interrupt, writing a 1 to IDR disables an
113 * interrupt. IMR and ISR are read only, and IER and IDR are write only.
114 * Reading either IER or IDR returns 0x00.
115 *
116 * All four registers have the same bit definitions.
117 */
118#define XUARTPS_IXR_TOUT 0x00000100 /* RX Timeout error interrupt */
119#define XUARTPS_IXR_PARITY 0x00000080 /* Parity error interrupt */
120#define XUARTPS_IXR_FRAMING 0x00000040 /* Framing error interrupt */
121#define XUARTPS_IXR_OVERRUN 0x00000020 /* Overrun error interrupt */
122#define XUARTPS_IXR_TXFULL 0x00000010 /* TX FIFO Full interrupt */
123#define XUARTPS_IXR_TXEMPTY 0x00000008 /* TX FIFO empty interrupt */
124#define XUARTPS_ISR_RXEMPTY 0x00000002 /* RX FIFO empty interrupt */
125#define XUARTPS_IXR_RXTRIG 0x00000001 /* RX FIFO trigger interrupt */
126#define XUARTPS_IXR_RXFULL 0x00000004 /* RX FIFO full interrupt. */
127#define XUARTPS_IXR_RXEMPTY 0x00000002 /* RX FIFO empty interrupt. */
128#define XUARTPS_IXR_MASK 0x00001FFF /* Valid bit mask */
129
130/** Channel Status Register
131 *
132 * The channel status register (CSR) is provided to enable the control logic
133 * to monitor the status of bits in the channel interrupt status register,
134 * even if these are masked out by the interrupt mask register.
135 */
136#define XUARTPS_SR_RXEMPTY 0x00000002 /* RX FIFO empty */
137#define XUARTPS_SR_TXEMPTY 0x00000008 /* TX FIFO empty */
138#define XUARTPS_SR_TXFULL 0x00000010 /* TX FIFO full */
139#define XUARTPS_SR_RXTRIG 0x00000001 /* Rx Trigger */
140
141/**
142 * xuartps_isr - Interrupt handler
143 * @irq: Irq number
144 * @dev_id: Id of the port
145 *
146 * Returns IRQHANDLED
147 **/
148static irqreturn_t xuartps_isr(int irq, void *dev_id)
149{
150 struct uart_port *port = (struct uart_port *)dev_id;
61ec9016
JL
151 unsigned long flags;
152 unsigned int isrstatus, numbytes;
153 unsigned int data;
154 char status = TTY_NORMAL;
155
61ec9016
JL
156 spin_lock_irqsave(&port->lock, flags);
157
158 /* Read the interrupt status register to determine which
159 * interrupt(s) is/are active.
160 */
161 isrstatus = xuartps_readl(XUARTPS_ISR_OFFSET);
162
163 /* drop byte with parity error if IGNPAR specified */
164 if (isrstatus & port->ignore_status_mask & XUARTPS_IXR_PARITY)
165 isrstatus &= ~(XUARTPS_IXR_RXTRIG | XUARTPS_IXR_TOUT);
166
167 isrstatus &= port->read_status_mask;
168 isrstatus &= ~port->ignore_status_mask;
169
170 if ((isrstatus & XUARTPS_IXR_TOUT) ||
171 (isrstatus & XUARTPS_IXR_RXTRIG)) {
172 /* Receive Timeout Interrupt */
173 while ((xuartps_readl(XUARTPS_SR_OFFSET) &
174 XUARTPS_SR_RXEMPTY) != XUARTPS_SR_RXEMPTY) {
175 data = xuartps_readl(XUARTPS_FIFO_OFFSET);
176 port->icount.rx++;
177
178 if (isrstatus & XUARTPS_IXR_PARITY) {
179 port->icount.parity++;
180 status = TTY_PARITY;
181 } else if (isrstatus & XUARTPS_IXR_FRAMING) {
182 port->icount.frame++;
183 status = TTY_FRAME;
184 } else if (isrstatus & XUARTPS_IXR_OVERRUN)
185 port->icount.overrun++;
186
2e124b4a
JS
187 uart_insert_char(port, isrstatus, XUARTPS_IXR_OVERRUN,
188 data, status);
61ec9016
JL
189 }
190 spin_unlock(&port->lock);
2e124b4a 191 tty_flip_buffer_push(&port->state->port);
61ec9016
JL
192 spin_lock(&port->lock);
193 }
194
195 /* Dispatch an appropriate handler */
196 if ((isrstatus & XUARTPS_IXR_TXEMPTY) == XUARTPS_IXR_TXEMPTY) {
197 if (uart_circ_empty(&port->state->xmit)) {
198 xuartps_writel(XUARTPS_IXR_TXEMPTY,
199 XUARTPS_IDR_OFFSET);
200 } else {
201 numbytes = port->fifosize;
202 /* Break if no more data available in the UART buffer */
203 while (numbytes--) {
204 if (uart_circ_empty(&port->state->xmit))
205 break;
206 /* Get the data from the UART circular buffer
207 * and write it to the xuartps's TX_FIFO
208 * register.
209 */
210 xuartps_writel(
211 port->state->xmit.buf[port->state->xmit.
212 tail], XUARTPS_FIFO_OFFSET);
213
214 port->icount.tx++;
215
216 /* Adjust the tail of the UART buffer and wrap
217 * the buffer if it reaches limit.
218 */
219 port->state->xmit.tail =
220 (port->state->xmit.tail + 1) & \
221 (UART_XMIT_SIZE - 1);
222 }
223
224 if (uart_circ_chars_pending(
225 &port->state->xmit) < WAKEUP_CHARS)
226 uart_write_wakeup(port);
227 }
228 }
229
230 xuartps_writel(isrstatus, XUARTPS_ISR_OFFSET);
231
232 /* be sure to release the lock and tty before leaving */
233 spin_unlock_irqrestore(&port->lock, flags);
61ec9016
JL
234
235 return IRQ_HANDLED;
236}
237
238/**
239 * xuartps_set_baud_rate - Calculate and set the baud rate
240 * @port: Handle to the uart port structure
241 * @baud: Baud rate to set
242 *
243 * Returns baud rate, requested baud when possible, or actual baud when there
244 * was too much error
245 **/
246static unsigned int xuartps_set_baud_rate(struct uart_port *port,
247 unsigned int baud)
248{
249 unsigned int sel_clk;
250 unsigned int calc_baud = 0;
251 unsigned int brgr_val, brdiv_val;
252 unsigned int bauderror;
253
254 /* Formula to obtain baud rate is
255 * baud_tx/rx rate = sel_clk/CD * (BDIV + 1)
256 * input_clk = (Uart User Defined Clock or Apb Clock)
257 * depends on UCLKEN in MR Reg
258 * sel_clk = input_clk or input_clk/8;
259 * depends on CLKS in MR reg
260 * CD and BDIV depends on values in
261 * baud rate generate register
262 * baud rate clock divisor register
263 */
264 sel_clk = port->uartclk;
265 if (xuartps_readl(XUARTPS_MR_OFFSET) & XUARTPS_MR_CLKSEL)
266 sel_clk = sel_clk / 8;
267
268 /* Find the best values for baud generation */
269 for (brdiv_val = 4; brdiv_val < 255; brdiv_val++) {
270
271 brgr_val = sel_clk / (baud * (brdiv_val + 1));
272 if (brgr_val < 2 || brgr_val > 65535)
273 continue;
274
275 calc_baud = sel_clk / (brgr_val * (brdiv_val + 1));
276
277 if (baud > calc_baud)
278 bauderror = baud - calc_baud;
279 else
280 bauderror = calc_baud - baud;
281
282 /* use the values when percent error is acceptable */
283 if (((bauderror * 100) / baud) < 3) {
284 calc_baud = baud;
285 break;
286 }
287 }
288
289 /* Set the values for the new baud rate */
290 xuartps_writel(brgr_val, XUARTPS_BAUDGEN_OFFSET);
291 xuartps_writel(brdiv_val, XUARTPS_BAUDDIV_OFFSET);
292
293 return calc_baud;
294}
295
296/*----------------------Uart Operations---------------------------*/
297
298/**
299 * xuartps_start_tx - Start transmitting bytes
300 * @port: Handle to the uart port structure
301 *
302 **/
303static void xuartps_start_tx(struct uart_port *port)
304{
305 unsigned int status, numbytes = port->fifosize;
306
307 if (uart_circ_empty(&port->state->xmit) || uart_tx_stopped(port))
308 return;
309
310 status = xuartps_readl(XUARTPS_CR_OFFSET);
311 /* Set the TX enable bit and clear the TX disable bit to enable the
312 * transmitter.
313 */
314 xuartps_writel((status & ~XUARTPS_CR_TX_DIS) | XUARTPS_CR_TX_EN,
315 XUARTPS_CR_OFFSET);
316
317 while (numbytes-- && ((xuartps_readl(XUARTPS_SR_OFFSET)
318 & XUARTPS_SR_TXFULL)) != XUARTPS_SR_TXFULL) {
319
320 /* Break if no more data available in the UART buffer */
321 if (uart_circ_empty(&port->state->xmit))
322 break;
323
324 /* Get the data from the UART circular buffer and
325 * write it to the xuartps's TX_FIFO register.
326 */
327 xuartps_writel(
328 port->state->xmit.buf[port->state->xmit.tail],
329 XUARTPS_FIFO_OFFSET);
330 port->icount.tx++;
331
332 /* Adjust the tail of the UART buffer and wrap
333 * the buffer if it reaches limit.
334 */
335 port->state->xmit.tail = (port->state->xmit.tail + 1) &
336 (UART_XMIT_SIZE - 1);
337 }
338
339 /* Enable the TX Empty interrupt */
340 xuartps_writel(XUARTPS_IXR_TXEMPTY, XUARTPS_IER_OFFSET);
341
342 if (uart_circ_chars_pending(&port->state->xmit) < WAKEUP_CHARS)
343 uart_write_wakeup(port);
344}
345
346/**
347 * xuartps_stop_tx - Stop TX
348 * @port: Handle to the uart port structure
349 *
350 **/
351static void xuartps_stop_tx(struct uart_port *port)
352{
353 unsigned int regval;
354
355 regval = xuartps_readl(XUARTPS_CR_OFFSET);
356 regval |= XUARTPS_CR_TX_DIS;
357 /* Disable the transmitter */
358 xuartps_writel(regval, XUARTPS_CR_OFFSET);
359}
360
361/**
362 * xuartps_stop_rx - Stop RX
363 * @port: Handle to the uart port structure
364 *
365 **/
366static void xuartps_stop_rx(struct uart_port *port)
367{
368 unsigned int regval;
369
370 regval = xuartps_readl(XUARTPS_CR_OFFSET);
371 regval |= XUARTPS_CR_RX_DIS;
372 /* Disable the receiver */
373 xuartps_writel(regval, XUARTPS_CR_OFFSET);
374}
375
376/**
377 * xuartps_tx_empty - Check whether TX is empty
378 * @port: Handle to the uart port structure
379 *
380 * Returns TIOCSER_TEMT on success, 0 otherwise
381 **/
382static unsigned int xuartps_tx_empty(struct uart_port *port)
383{
384 unsigned int status;
385
386 status = xuartps_readl(XUARTPS_ISR_OFFSET) & XUARTPS_IXR_TXEMPTY;
387 return status ? TIOCSER_TEMT : 0;
388}
389
390/**
391 * xuartps_break_ctl - Based on the input ctl we have to start or stop
392 * transmitting char breaks
393 * @port: Handle to the uart port structure
394 * @ctl: Value based on which start or stop decision is taken
395 *
396 **/
397static void xuartps_break_ctl(struct uart_port *port, int ctl)
398{
399 unsigned int status;
400 unsigned long flags;
401
402 spin_lock_irqsave(&port->lock, flags);
403
404 status = xuartps_readl(XUARTPS_CR_OFFSET);
405
406 if (ctl == -1)
407 xuartps_writel(XUARTPS_CR_STARTBRK | status,
408 XUARTPS_CR_OFFSET);
409 else {
410 if ((status & XUARTPS_CR_STOPBRK) == 0)
411 xuartps_writel(XUARTPS_CR_STOPBRK | status,
412 XUARTPS_CR_OFFSET);
413 }
414 spin_unlock_irqrestore(&port->lock, flags);
415}
416
417/**
418 * xuartps_set_termios - termios operations, handling data length, parity,
419 * stop bits, flow control, baud rate
420 * @port: Handle to the uart port structure
421 * @termios: Handle to the input termios structure
422 * @old: Values of the previously saved termios structure
423 *
424 **/
425static void xuartps_set_termios(struct uart_port *port,
426 struct ktermios *termios, struct ktermios *old)
427{
428 unsigned int cval = 0;
429 unsigned int baud;
430 unsigned long flags;
431 unsigned int ctrl_reg, mode_reg;
432
433 spin_lock_irqsave(&port->lock, flags);
434
435 /* Empty the receive FIFO 1st before making changes */
436 while ((xuartps_readl(XUARTPS_SR_OFFSET) &
437 XUARTPS_SR_RXEMPTY) != XUARTPS_SR_RXEMPTY) {
438 xuartps_readl(XUARTPS_FIFO_OFFSET);
439 }
440
441 /* Disable the TX and RX to set baud rate */
442 xuartps_writel(xuartps_readl(XUARTPS_CR_OFFSET) |
443 (XUARTPS_CR_TX_DIS | XUARTPS_CR_RX_DIS),
444 XUARTPS_CR_OFFSET);
445
446 /* Min baud rate = 6bps and Max Baud Rate is 10Mbps for 100Mhz clk */
447 baud = uart_get_baud_rate(port, termios, old, 0, 10000000);
448 baud = xuartps_set_baud_rate(port, baud);
449 if (tty_termios_baud_rate(termios))
450 tty_termios_encode_baud_rate(termios, baud, baud);
451
452 /*
453 * Update the per-port timeout.
454 */
455 uart_update_timeout(port, termios->c_cflag, baud);
456
457 /* Set TX/RX Reset */
458 xuartps_writel(xuartps_readl(XUARTPS_CR_OFFSET) |
459 (XUARTPS_CR_TXRST | XUARTPS_CR_RXRST),
460 XUARTPS_CR_OFFSET);
461
462 ctrl_reg = xuartps_readl(XUARTPS_CR_OFFSET);
463
464 /* Clear the RX disable and TX disable bits and then set the TX enable
465 * bit and RX enable bit to enable the transmitter and receiver.
466 */
467 xuartps_writel(
468 (ctrl_reg & ~(XUARTPS_CR_TX_DIS | XUARTPS_CR_RX_DIS))
469 | (XUARTPS_CR_TX_EN | XUARTPS_CR_RX_EN),
470 XUARTPS_CR_OFFSET);
471
472 xuartps_writel(10, XUARTPS_RXTOUT_OFFSET);
473
474 port->read_status_mask = XUARTPS_IXR_TXEMPTY | XUARTPS_IXR_RXTRIG |
475 XUARTPS_IXR_OVERRUN | XUARTPS_IXR_TOUT;
476 port->ignore_status_mask = 0;
477
478 if (termios->c_iflag & INPCK)
479 port->read_status_mask |= XUARTPS_IXR_PARITY |
480 XUARTPS_IXR_FRAMING;
481
482 if (termios->c_iflag & IGNPAR)
483 port->ignore_status_mask |= XUARTPS_IXR_PARITY |
484 XUARTPS_IXR_FRAMING | XUARTPS_IXR_OVERRUN;
485
486 /* ignore all characters if CREAD is not set */
487 if ((termios->c_cflag & CREAD) == 0)
488 port->ignore_status_mask |= XUARTPS_IXR_RXTRIG |
489 XUARTPS_IXR_TOUT | XUARTPS_IXR_PARITY |
490 XUARTPS_IXR_FRAMING | XUARTPS_IXR_OVERRUN;
491
492 mode_reg = xuartps_readl(XUARTPS_MR_OFFSET);
493
494 /* Handling Data Size */
495 switch (termios->c_cflag & CSIZE) {
496 case CS6:
497 cval |= XUARTPS_MR_CHARLEN_6_BIT;
498 break;
499 case CS7:
500 cval |= XUARTPS_MR_CHARLEN_7_BIT;
501 break;
502 default:
503 case CS8:
504 cval |= XUARTPS_MR_CHARLEN_8_BIT;
505 termios->c_cflag &= ~CSIZE;
506 termios->c_cflag |= CS8;
507 break;
508 }
509
510 /* Handling Parity and Stop Bits length */
511 if (termios->c_cflag & CSTOPB)
512 cval |= XUARTPS_MR_STOPMODE_2_BIT; /* 2 STOP bits */
513 else
514 cval |= XUARTPS_MR_STOPMODE_1_BIT; /* 1 STOP bit */
515
516 if (termios->c_cflag & PARENB) {
517 /* Mark or Space parity */
518 if (termios->c_cflag & CMSPAR) {
519 if (termios->c_cflag & PARODD)
520 cval |= XUARTPS_MR_PARITY_MARK;
521 else
522 cval |= XUARTPS_MR_PARITY_SPACE;
523 } else if (termios->c_cflag & PARODD)
524 cval |= XUARTPS_MR_PARITY_ODD;
525 else
526 cval |= XUARTPS_MR_PARITY_EVEN;
527 } else
528 cval |= XUARTPS_MR_PARITY_NONE;
529 xuartps_writel(cval , XUARTPS_MR_OFFSET);
530
531 spin_unlock_irqrestore(&port->lock, flags);
532}
533
534/**
535 * xuartps_startup - Called when an application opens a xuartps port
536 * @port: Handle to the uart port structure
537 *
538 * Returns 0 on success, negative error otherwise
539 **/
540static int xuartps_startup(struct uart_port *port)
541{
542 unsigned int retval = 0, status = 0;
543
544 retval = request_irq(port->irq, xuartps_isr, 0, XUARTPS_NAME,
545 (void *)port);
546 if (retval)
547 return retval;
548
549 /* Disable the TX and RX */
550 xuartps_writel(XUARTPS_CR_TX_DIS | XUARTPS_CR_RX_DIS,
551 XUARTPS_CR_OFFSET);
552
553 /* Set the Control Register with TX/RX Enable, TX/RX Reset,
554 * no break chars.
555 */
556 xuartps_writel(XUARTPS_CR_TXRST | XUARTPS_CR_RXRST,
557 XUARTPS_CR_OFFSET);
558
559 status = xuartps_readl(XUARTPS_CR_OFFSET);
560
561 /* Clear the RX disable and TX disable bits and then set the TX enable
562 * bit and RX enable bit to enable the transmitter and receiver.
563 */
564 xuartps_writel((status & ~(XUARTPS_CR_TX_DIS | XUARTPS_CR_RX_DIS))
565 | (XUARTPS_CR_TX_EN | XUARTPS_CR_RX_EN |
566 XUARTPS_CR_STOPBRK), XUARTPS_CR_OFFSET);
567
568 /* Set the Mode Register with normal mode,8 data bits,1 stop bit,
569 * no parity.
570 */
571 xuartps_writel(XUARTPS_MR_CHMODE_NORM | XUARTPS_MR_STOPMODE_1_BIT
572 | XUARTPS_MR_PARITY_NONE | XUARTPS_MR_CHARLEN_8_BIT,
573 XUARTPS_MR_OFFSET);
574
575 /* Set the RX FIFO Trigger level to 14 assuming FIFO size as 16 */
576 xuartps_writel(14, XUARTPS_RXWM_OFFSET);
577
578 /* Receive Timeout register is enabled with value of 10 */
579 xuartps_writel(10, XUARTPS_RXTOUT_OFFSET);
580
855f6fd9
JL
581 /* Clear out any pending interrupts before enabling them */
582 xuartps_writel(xuartps_readl(XUARTPS_ISR_OFFSET), XUARTPS_ISR_OFFSET);
61ec9016
JL
583
584 /* Set the Interrupt Registers with desired interrupts */
585 xuartps_writel(XUARTPS_IXR_TXEMPTY | XUARTPS_IXR_PARITY |
586 XUARTPS_IXR_FRAMING | XUARTPS_IXR_OVERRUN |
587 XUARTPS_IXR_RXTRIG | XUARTPS_IXR_TOUT, XUARTPS_IER_OFFSET);
61ec9016
JL
588
589 return retval;
590}
591
592/**
593 * xuartps_shutdown - Called when an application closes a xuartps port
594 * @port: Handle to the uart port structure
595 *
596 **/
597static void xuartps_shutdown(struct uart_port *port)
598{
599 int status;
600
601 /* Disable interrupts */
602 status = xuartps_readl(XUARTPS_IMR_OFFSET);
603 xuartps_writel(status, XUARTPS_IDR_OFFSET);
604
605 /* Disable the TX and RX */
606 xuartps_writel(XUARTPS_CR_TX_DIS | XUARTPS_CR_RX_DIS,
607 XUARTPS_CR_OFFSET);
608 free_irq(port->irq, port);
609}
610
611/**
612 * xuartps_type - Set UART type to xuartps port
613 * @port: Handle to the uart port structure
614 *
615 * Returns string on success, NULL otherwise
616 **/
617static const char *xuartps_type(struct uart_port *port)
618{
619 return port->type == PORT_XUARTPS ? XUARTPS_NAME : NULL;
620}
621
622/**
623 * xuartps_verify_port - Verify the port params
624 * @port: Handle to the uart port structure
625 * @ser: Handle to the structure whose members are compared
626 *
627 * Returns 0 if success otherwise -EINVAL
628 **/
629static int xuartps_verify_port(struct uart_port *port,
630 struct serial_struct *ser)
631{
632 if (ser->type != PORT_UNKNOWN && ser->type != PORT_XUARTPS)
633 return -EINVAL;
634 if (port->irq != ser->irq)
635 return -EINVAL;
636 if (ser->io_type != UPIO_MEM)
637 return -EINVAL;
638 if (port->iobase != ser->port)
639 return -EINVAL;
640 if (ser->hub6 != 0)
641 return -EINVAL;
642 return 0;
643}
644
645/**
646 * xuartps_request_port - Claim the memory region attached to xuartps port,
647 * called when the driver adds a xuartps port via
648 * uart_add_one_port()
649 * @port: Handle to the uart port structure
650 *
651 * Returns 0, -ENOMEM if request fails
652 **/
653static int xuartps_request_port(struct uart_port *port)
654{
655 if (!request_mem_region(port->mapbase, XUARTPS_REGISTER_SPACE,
656 XUARTPS_NAME)) {
657 return -ENOMEM;
658 }
659
660 port->membase = ioremap(port->mapbase, XUARTPS_REGISTER_SPACE);
661 if (!port->membase) {
662 dev_err(port->dev, "Unable to map registers\n");
663 release_mem_region(port->mapbase, XUARTPS_REGISTER_SPACE);
664 return -ENOMEM;
665 }
666 return 0;
667}
668
669/**
670 * xuartps_release_port - Release the memory region attached to a xuartps
671 * port, called when the driver removes a xuartps
672 * port via uart_remove_one_port().
673 * @port: Handle to the uart port structure
674 *
675 **/
676static void xuartps_release_port(struct uart_port *port)
677{
678 release_mem_region(port->mapbase, XUARTPS_REGISTER_SPACE);
679 iounmap(port->membase);
680 port->membase = NULL;
681}
682
683/**
684 * xuartps_config_port - Configure xuartps, called when the driver adds a
685 * xuartps port
686 * @port: Handle to the uart port structure
687 * @flags: If any
688 *
689 **/
690static void xuartps_config_port(struct uart_port *port, int flags)
691{
692 if (flags & UART_CONFIG_TYPE && xuartps_request_port(port) == 0)
693 port->type = PORT_XUARTPS;
694}
695
696/**
697 * xuartps_get_mctrl - Get the modem control state
698 *
699 * @port: Handle to the uart port structure
700 *
701 * Returns the modem control state
702 *
703 **/
704static unsigned int xuartps_get_mctrl(struct uart_port *port)
705{
706 return TIOCM_CTS | TIOCM_DSR | TIOCM_CAR;
707}
708
709static void xuartps_set_mctrl(struct uart_port *port, unsigned int mctrl)
710{
711 /* N/A */
712}
713
714static void xuartps_enable_ms(struct uart_port *port)
715{
716 /* N/A */
717}
718
719/** The UART operations structure
720 */
721static struct uart_ops xuartps_ops = {
722 .set_mctrl = xuartps_set_mctrl,
723 .get_mctrl = xuartps_get_mctrl,
724 .enable_ms = xuartps_enable_ms,
725
726 .start_tx = xuartps_start_tx, /* Start transmitting */
727 .stop_tx = xuartps_stop_tx, /* Stop transmission */
728 .stop_rx = xuartps_stop_rx, /* Stop reception */
729 .tx_empty = xuartps_tx_empty, /* Transmitter busy? */
730 .break_ctl = xuartps_break_ctl, /* Start/stop
731 * transmitting break
732 */
733 .set_termios = xuartps_set_termios, /* Set termios */
734 .startup = xuartps_startup, /* App opens xuartps */
735 .shutdown = xuartps_shutdown, /* App closes xuartps */
736 .type = xuartps_type, /* Set UART type */
737 .verify_port = xuartps_verify_port, /* Verification of port
738 * params
739 */
740 .request_port = xuartps_request_port, /* Claim resources
741 * associated with a
742 * xuartps port
743 */
744 .release_port = xuartps_release_port, /* Release resources
745 * associated with a
746 * xuartps port
747 */
748 .config_port = xuartps_config_port, /* Configure when driver
749 * adds a xuartps port
750 */
751};
752
753static struct uart_port xuartps_port[2];
754
755/**
756 * xuartps_get_port - Configure the port from the platform device resource
757 * info
758 *
759 * Returns a pointer to a uart_port or NULL for failure
760 **/
761static struct uart_port *xuartps_get_port(void)
762{
763 struct uart_port *port;
764 int id;
765
766 /* Find the next unused port */
767 for (id = 0; id < XUARTPS_NR_PORTS; id++)
768 if (xuartps_port[id].mapbase == 0)
769 break;
770
771 if (id >= XUARTPS_NR_PORTS)
772 return NULL;
773
774 port = &xuartps_port[id];
775
776 /* At this point, we've got an empty uart_port struct, initialize it */
777 spin_lock_init(&port->lock);
778 port->membase = NULL;
779 port->iobase = 1; /* mark port in use */
780 port->irq = 0;
781 port->type = PORT_UNKNOWN;
782 port->iotype = UPIO_MEM32;
783 port->flags = UPF_BOOT_AUTOCONF;
784 port->ops = &xuartps_ops;
785 port->fifosize = XUARTPS_FIFO_SIZE;
786 port->line = id;
787 port->dev = NULL;
788 return port;
789}
790
791/*-----------------------Console driver operations--------------------------*/
792
793#ifdef CONFIG_SERIAL_XILINX_PS_UART_CONSOLE
794/**
795 * xuartps_console_wait_tx - Wait for the TX to be full
796 * @port: Handle to the uart port structure
797 *
798 **/
799static void xuartps_console_wait_tx(struct uart_port *port)
800{
801 while ((xuartps_readl(XUARTPS_SR_OFFSET) & XUARTPS_SR_TXEMPTY)
802 != XUARTPS_SR_TXEMPTY)
803 barrier();
804}
805
806/**
807 * xuartps_console_putchar - write the character to the FIFO buffer
808 * @port: Handle to the uart port structure
809 * @ch: Character to be written
810 *
811 **/
812static void xuartps_console_putchar(struct uart_port *port, int ch)
813{
814 xuartps_console_wait_tx(port);
815 xuartps_writel(ch, XUARTPS_FIFO_OFFSET);
816}
817
818/**
819 * xuartps_console_write - perform write operation
820 * @port: Handle to the uart port structure
821 * @s: Pointer to character array
822 * @count: No of characters
823 **/
824static void xuartps_console_write(struct console *co, const char *s,
825 unsigned int count)
826{
827 struct uart_port *port = &xuartps_port[co->index];
828 unsigned long flags;
829 unsigned int imr;
830 int locked = 1;
831
832 if (oops_in_progress)
833 locked = spin_trylock_irqsave(&port->lock, flags);
834 else
835 spin_lock_irqsave(&port->lock, flags);
836
837 /* save and disable interrupt */
838 imr = xuartps_readl(XUARTPS_IMR_OFFSET);
839 xuartps_writel(imr, XUARTPS_IDR_OFFSET);
840
841 uart_console_write(port, s, count, xuartps_console_putchar);
842 xuartps_console_wait_tx(port);
843
844 /* restore interrupt state, it seems like there may be a h/w bug
845 * in that the interrupt enable register should not need to be
846 * written based on the data sheet
847 */
848 xuartps_writel(~imr, XUARTPS_IDR_OFFSET);
849 xuartps_writel(imr, XUARTPS_IER_OFFSET);
850
851 if (locked)
852 spin_unlock_irqrestore(&port->lock, flags);
853}
854
855/**
856 * xuartps_console_setup - Initialize the uart to default config
857 * @co: Console handle
858 * @options: Initial settings of uart
859 *
860 * Returns 0, -ENODEV if no device
861 **/
862static int __init xuartps_console_setup(struct console *co, char *options)
863{
864 struct uart_port *port = &xuartps_port[co->index];
865 int baud = 9600;
866 int bits = 8;
867 int parity = 'n';
868 int flow = 'n';
869
870 if (co->index < 0 || co->index >= XUARTPS_NR_PORTS)
871 return -EINVAL;
872
873 if (!port->mapbase) {
874 pr_debug("console on ttyPS%i not present\n", co->index);
875 return -ENODEV;
876 }
877
878 if (options)
879 uart_parse_options(options, &baud, &parity, &bits, &flow);
880
881 return uart_set_options(port, co, baud, parity, bits, flow);
882}
883
884static struct uart_driver xuartps_uart_driver;
885
886static struct console xuartps_console = {
887 .name = XUARTPS_TTY_NAME,
888 .write = xuartps_console_write,
889 .device = uart_console_device,
890 .setup = xuartps_console_setup,
891 .flags = CON_PRINTBUFFER,
892 .index = -1, /* Specified on the cmdline (e.g. console=ttyPS ) */
893 .data = &xuartps_uart_driver,
894};
895
896/**
897 * xuartps_console_init - Initialization call
898 *
899 * Returns 0 on success, negative error otherwise
900 **/
901static int __init xuartps_console_init(void)
902{
903 register_console(&xuartps_console);
904 return 0;
905}
906
907console_initcall(xuartps_console_init);
908
909#endif /* CONFIG_SERIAL_XILINX_PS_UART_CONSOLE */
910
911/** Structure Definitions
912 */
913static struct uart_driver xuartps_uart_driver = {
914 .owner = THIS_MODULE, /* Owner */
915 .driver_name = XUARTPS_NAME, /* Driver name */
916 .dev_name = XUARTPS_TTY_NAME, /* Node name */
917 .major = XUARTPS_MAJOR, /* Major number */
918 .minor = XUARTPS_MINOR, /* Minor number */
919 .nr = XUARTPS_NR_PORTS, /* Number of UART ports */
920#ifdef CONFIG_SERIAL_XILINX_PS_UART_CONSOLE
921 .cons = &xuartps_console, /* Console */
922#endif
923};
924
925/* ---------------------------------------------------------------------
926 * Platform bus binding
927 */
928/**
929 * xuartps_probe - Platform driver probe
930 * @pdev: Pointer to the platform device structure
931 *
932 * Returns 0 on success, negative error otherwise
933 **/
9671f099 934static int xuartps_probe(struct platform_device *pdev)
61ec9016
JL
935{
936 int rc;
937 struct uart_port *port;
938 struct resource *res, *res2;
2326669c 939 struct clk *clk;
61ec9016 940
2326669c
JC
941 clk = of_clk_get(pdev->dev.of_node, 0);
942 if (IS_ERR(clk)) {
61ec9016 943 dev_err(&pdev->dev, "no clock specified\n");
2326669c
JC
944 return PTR_ERR(clk);
945 }
946
947 rc = clk_prepare_enable(clk);
948 if (rc) {
949 dev_err(&pdev->dev, "could not enable clock\n");
950 return -EBUSY;
61ec9016
JL
951 }
952
953 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
954 if (!res)
955 return -ENODEV;
956
957 res2 = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
958 if (!res2)
959 return -ENODEV;
960
961 /* Initialize the port structure */
962 port = xuartps_get_port();
963
964 if (!port) {
965 dev_err(&pdev->dev, "Cannot get uart_port structure\n");
966 return -ENODEV;
967 } else {
968 /* Register the port.
969 * This function also registers this device with the tty layer
970 * and triggers invocation of the config_port() entry point.
971 */
972 port->mapbase = res->start;
973 port->irq = res2->start;
974 port->dev = &pdev->dev;
2326669c
JC
975 port->uartclk = clk_get_rate(clk);
976 port->private_data = clk;
61ec9016
JL
977 dev_set_drvdata(&pdev->dev, port);
978 rc = uart_add_one_port(&xuartps_uart_driver, port);
979 if (rc) {
980 dev_err(&pdev->dev,
981 "uart_add_one_port() failed; err=%i\n", rc);
982 dev_set_drvdata(&pdev->dev, NULL);
983 return rc;
984 }
985 return 0;
986 }
987}
988
989/**
990 * xuartps_remove - called when the platform driver is unregistered
991 * @pdev: Pointer to the platform device structure
992 *
993 * Returns 0 on success, negative error otherwise
994 **/
ae8d8a14 995static int xuartps_remove(struct platform_device *pdev)
61ec9016
JL
996{
997 struct uart_port *port = dev_get_drvdata(&pdev->dev);
2326669c
JC
998 struct clk *clk = port->private_data;
999 int rc;
61ec9016
JL
1000
1001 /* Remove the xuartps port from the serial core */
2326669c
JC
1002 rc = uart_remove_one_port(&xuartps_uart_driver, port);
1003 dev_set_drvdata(&pdev->dev, NULL);
1004 port->mapbase = 0;
1005 clk_disable_unprepare(clk);
61ec9016
JL
1006 return rc;
1007}
1008
1009/**
1010 * xuartps_suspend - suspend event
1011 * @pdev: Pointer to the platform device structure
1012 * @state: State of the device
1013 *
1014 * Returns 0
1015 **/
1016static int xuartps_suspend(struct platform_device *pdev, pm_message_t state)
1017{
1018 /* Call the API provided in serial_core.c file which handles
1019 * the suspend.
1020 */
1021 uart_suspend_port(&xuartps_uart_driver, &xuartps_port[pdev->id]);
1022 return 0;
1023}
1024
1025/**
1026 * xuartps_resume - Resume after a previous suspend
1027 * @pdev: Pointer to the platform device structure
1028 *
1029 * Returns 0
1030 **/
1031static int xuartps_resume(struct platform_device *pdev)
1032{
1033 uart_resume_port(&xuartps_uart_driver, &xuartps_port[pdev->id]);
1034 return 0;
1035}
1036
1037/* Match table for of_platform binding */
de88b340 1038static struct of_device_id xuartps_of_match[] = {
61ec9016
JL
1039 { .compatible = "xlnx,xuartps", },
1040 {}
1041};
1042MODULE_DEVICE_TABLE(of, xuartps_of_match);
61ec9016
JL
1043
1044static struct platform_driver xuartps_platform_driver = {
1045 .probe = xuartps_probe, /* Probe method */
eb51d917 1046 .remove = xuartps_remove, /* Detach method */
61ec9016
JL
1047 .suspend = xuartps_suspend, /* Suspend */
1048 .resume = xuartps_resume, /* Resume after a suspend */
1049 .driver = {
1050 .owner = THIS_MODULE,
1051 .name = XUARTPS_NAME, /* Driver name */
1052 .of_match_table = xuartps_of_match,
1053 },
1054};
1055
1056/* ---------------------------------------------------------------------
1057 * Module Init and Exit
1058 */
1059/**
1060 * xuartps_init - Initial driver registration call
1061 *
1062 * Returns whether the registration was successful or not
1063 **/
1064static int __init xuartps_init(void)
1065{
1066 int retval = 0;
1067
1068 /* Register the xuartps driver with the serial core */
1069 retval = uart_register_driver(&xuartps_uart_driver);
1070 if (retval)
1071 return retval;
1072
1073 /* Register the platform driver */
1074 retval = platform_driver_register(&xuartps_platform_driver);
1075 if (retval)
1076 uart_unregister_driver(&xuartps_uart_driver);
1077
1078 return retval;
1079}
1080
1081/**
1082 * xuartps_exit - Driver unregistration call
1083 **/
1084static void __exit xuartps_exit(void)
1085{
1086 /* The order of unregistration is important. Unregister the
1087 * UART driver before the platform driver crashes the system.
1088 */
1089
1090 /* Unregister the platform driver */
1091 platform_driver_unregister(&xuartps_platform_driver);
1092
1093 /* Unregister the xuartps driver */
1094 uart_unregister_driver(&xuartps_uart_driver);
1095}
1096
1097module_init(xuartps_init);
1098module_exit(xuartps_exit);
1099
1100MODULE_DESCRIPTION("Driver for PS UART");
1101MODULE_AUTHOR("Xilinx Inc.");
1102MODULE_LICENSE("GPL");