Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
xilinx_uartps.c
Go to the documentation of this file.
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>
15 #include <linux/serial.h>
16 #include <linux/serial_core.h>
17 #include <linux/tty.h>
18 #include <linux/tty_flip.h>
19 #include <linux/console.h>
20 #include <linux/irq.h>
21 #include <linux/io.h>
22 #include <linux/of.h>
23 #include <linux/module.h>
24 
25 #define XUARTPS_TTY_NAME "ttyPS"
26 #define XUARTPS_NAME "xuartps"
27 #define XUARTPS_MAJOR 0 /* use dynamic node allocation */
28 #define XUARTPS_MINOR 0 /* works best with devtmpfs */
29 #define XUARTPS_NR_PORTS 2
30 #define XUARTPS_FIFO_SIZE 16 /* FIFO size */
31 #define XUARTPS_REGISTER_SPACE 0xFFF
32 
33 #define xuartps_readl(offset) ioread32(port->membase + offset)
34 #define xuartps_writel(val, offset) iowrite32(val, port->membase + offset)
35 
36 /********************************Register Map********************************/
42 #define XUARTPS_CR_OFFSET 0x00 /* Control Register [8:0] */
43 #define XUARTPS_MR_OFFSET 0x04 /* Mode Register [10:0] */
44 #define XUARTPS_IER_OFFSET 0x08 /* Interrupt Enable [10:0] */
45 #define XUARTPS_IDR_OFFSET 0x0C /* Interrupt Disable [10:0] */
46 #define XUARTPS_IMR_OFFSET 0x10 /* Interrupt Mask [10:0] */
47 #define XUARTPS_ISR_OFFSET 0x14 /* Interrupt Status [10:0]*/
48 #define XUARTPS_BAUDGEN_OFFSET 0x18 /* Baud Rate Generator [15:0] */
49 #define XUARTPS_RXTOUT_OFFSET 0x1C /* RX Timeout [7:0] */
50 #define XUARTPS_RXWM_OFFSET 0x20 /* RX FIFO Trigger Level [5:0] */
51 #define XUARTPS_MODEMCR_OFFSET 0x24 /* Modem Control [5:0] */
52 #define XUARTPS_MODEMSR_OFFSET 0x28 /* Modem Status [8:0] */
53 #define XUARTPS_SR_OFFSET 0x2C /* Channel Status [11:0] */
54 #define XUARTPS_FIFO_OFFSET 0x30 /* FIFO [15:0] or [7:0] */
55 #define XUARTPS_BAUDDIV_OFFSET 0x34 /* Baud Rate Divider [7:0] */
56 #define XUARTPS_FLOWDEL_OFFSET 0x38 /* Flow Delay [15:0] */
57 #define XUARTPS_IRRX_PWIDTH_OFFSET 0x3C /* IR Minimum Received Pulse
58  Width [15:0] */
59 #define XUARTPS_IRTX_PWIDTH_OFFSET 0x40 /* IR Transmitted pulse
60  Width [7:0] */
61 #define XUARTPS_TXWM_OFFSET 0x44 /* TX FIFO Trigger Level [5:0] */
62 
69 #define XUARTPS_CR_STOPBRK 0x00000100 /* Stop TX break */
70 #define XUARTPS_CR_STARTBRK 0x00000080 /* Set TX break */
71 #define XUARTPS_CR_TX_DIS 0x00000020 /* TX disabled. */
72 #define XUARTPS_CR_TX_EN 0x00000010 /* TX enabled */
73 #define XUARTPS_CR_RX_DIS 0x00000008 /* RX disabled. */
74 #define XUARTPS_CR_RX_EN 0x00000004 /* RX enabled */
75 #define XUARTPS_CR_TXRST 0x00000002 /* TX logic reset */
76 #define XUARTPS_CR_RXRST 0x00000001 /* RX logic reset */
77 #define XUARTPS_CR_RST_TO 0x00000040 /* Restart Timeout Counter */
78 
88 #define XUARTPS_MR_CLKSEL 0x00000001 /* Pre-scalar selection */
89 #define XUARTPS_MR_CHMODE_L_LOOP 0x00000200 /* Local loop back mode */
90 #define XUARTPS_MR_CHMODE_NORM 0x00000000 /* Normal mode */
91 
92 #define XUARTPS_MR_STOPMODE_2_BIT 0x00000080 /* 2 stop bits */
93 #define XUARTPS_MR_STOPMODE_1_BIT 0x00000000 /* 1 stop bit */
94 
95 #define XUARTPS_MR_PARITY_NONE 0x00000020 /* No parity mode */
96 #define XUARTPS_MR_PARITY_MARK 0x00000018 /* Mark parity mode */
97 #define XUARTPS_MR_PARITY_SPACE 0x00000010 /* Space parity mode */
98 #define XUARTPS_MR_PARITY_ODD 0x00000008 /* Odd parity mode */
99 #define XUARTPS_MR_PARITY_EVEN 0x00000000 /* Even parity mode */
101 #define XUARTPS_MR_CHARLEN_6_BIT 0x00000006 /* 6 bits data */
102 #define XUARTPS_MR_CHARLEN_7_BIT 0x00000004 /* 7 bits data */
103 #define XUARTPS_MR_CHARLEN_8_BIT 0x00000000 /* 8 bits data */
104 
117 #define XUARTPS_IXR_TOUT 0x00000100 /* RX Timeout error interrupt */
118 #define XUARTPS_IXR_PARITY 0x00000080 /* Parity error interrupt */
119 #define XUARTPS_IXR_FRAMING 0x00000040 /* Framing error interrupt */
120 #define XUARTPS_IXR_OVERRUN 0x00000020 /* Overrun error interrupt */
121 #define XUARTPS_IXR_TXFULL 0x00000010 /* TX FIFO Full interrupt */
122 #define XUARTPS_IXR_TXEMPTY 0x00000008 /* TX FIFO empty interrupt */
123 #define XUARTPS_ISR_RXEMPTY 0x00000002 /* RX FIFO empty interrupt */
124 #define XUARTPS_IXR_RXTRIG 0x00000001 /* RX FIFO trigger interrupt */
125 #define XUARTPS_IXR_RXFULL 0x00000004 /* RX FIFO full interrupt. */
126 #define XUARTPS_IXR_RXEMPTY 0x00000002 /* RX FIFO empty interrupt. */
127 #define XUARTPS_IXR_MASK 0x00001FFF /* Valid bit mask */
128 
135 #define XUARTPS_SR_RXEMPTY 0x00000002 /* RX FIFO empty */
136 #define XUARTPS_SR_TXEMPTY 0x00000008 /* TX FIFO empty */
137 #define XUARTPS_SR_TXFULL 0x00000010 /* TX FIFO full */
138 #define XUARTPS_SR_RXTRIG 0x00000001 /* Rx Trigger */
139 
147 static irqreturn_t xuartps_isr(int irq, void *dev_id)
148 {
149  struct uart_port *port = (struct uart_port *)dev_id;
150  struct tty_struct *tty;
151  unsigned long flags;
152  unsigned int isrstatus, numbytes;
153  unsigned int data;
154  char status = TTY_NORMAL;
155 
156  /* Get the tty which could be NULL so don't assume it's valid */
157  tty = tty_port_tty_get(&port->state->port);
158 
159  spin_lock_irqsave(&port->lock, flags);
160 
161  /* Read the interrupt status register to determine which
162  * interrupt(s) is/are active.
163  */
164  isrstatus = xuartps_readl(XUARTPS_ISR_OFFSET);
165 
166  /* drop byte with parity error if IGNPAR specified */
167  if (isrstatus & port->ignore_status_mask & XUARTPS_IXR_PARITY)
168  isrstatus &= ~(XUARTPS_IXR_RXTRIG | XUARTPS_IXR_TOUT);
169 
170  isrstatus &= port->read_status_mask;
171  isrstatus &= ~port->ignore_status_mask;
172 
173  if ((isrstatus & XUARTPS_IXR_TOUT) ||
174  (isrstatus & XUARTPS_IXR_RXTRIG)) {
175  /* Receive Timeout Interrupt */
179  port->icount.rx++;
180 
181  if (isrstatus & XUARTPS_IXR_PARITY) {
182  port->icount.parity++;
183  status = TTY_PARITY;
184  } else if (isrstatus & XUARTPS_IXR_FRAMING) {
185  port->icount.frame++;
186  status = TTY_FRAME;
187  } else if (isrstatus & XUARTPS_IXR_OVERRUN)
188  port->icount.overrun++;
189 
190  if (tty)
191  uart_insert_char(port, isrstatus,
192  XUARTPS_IXR_OVERRUN, data,
193  status);
194  }
195  spin_unlock(&port->lock);
196  if (tty)
198  spin_lock(&port->lock);
199  }
200 
201  /* Dispatch an appropriate handler */
202  if ((isrstatus & XUARTPS_IXR_TXEMPTY) == XUARTPS_IXR_TXEMPTY) {
203  if (uart_circ_empty(&port->state->xmit)) {
204  xuartps_writel(XUARTPS_IXR_TXEMPTY,
206  } else {
207  numbytes = port->fifosize;
208  /* Break if no more data available in the UART buffer */
209  while (numbytes--) {
210  if (uart_circ_empty(&port->state->xmit))
211  break;
212  /* Get the data from the UART circular buffer
213  * and write it to the xuartps's TX_FIFO
214  * register.
215  */
217  port->state->xmit.buf[port->state->xmit.
219 
220  port->icount.tx++;
221 
222  /* Adjust the tail of the UART buffer and wrap
223  * the buffer if it reaches limit.
224  */
225  port->state->xmit.tail =
226  (port->state->xmit.tail + 1) & \
227  (UART_XMIT_SIZE - 1);
228  }
229 
231  &port->state->xmit) < WAKEUP_CHARS)
232  uart_write_wakeup(port);
233  }
234  }
235 
237 
238  /* be sure to release the lock and tty before leaving */
239  spin_unlock_irqrestore(&port->lock, flags);
240  tty_kref_put(tty);
241 
242  return IRQ_HANDLED;
243 }
244 
253 static unsigned int xuartps_set_baud_rate(struct uart_port *port,
254  unsigned int baud)
255 {
256  unsigned int sel_clk;
257  unsigned int calc_baud = 0;
258  unsigned int brgr_val, brdiv_val;
259  unsigned int bauderror;
260 
261  /* Formula to obtain baud rate is
262  * baud_tx/rx rate = sel_clk/CD * (BDIV + 1)
263  * input_clk = (Uart User Defined Clock or Apb Clock)
264  * depends on UCLKEN in MR Reg
265  * sel_clk = input_clk or input_clk/8;
266  * depends on CLKS in MR reg
267  * CD and BDIV depends on values in
268  * baud rate generate register
269  * baud rate clock divisor register
270  */
271  sel_clk = port->uartclk;
273  sel_clk = sel_clk / 8;
274 
275  /* Find the best values for baud generation */
276  for (brdiv_val = 4; brdiv_val < 255; brdiv_val++) {
277 
278  brgr_val = sel_clk / (baud * (brdiv_val + 1));
279  if (brgr_val < 2 || brgr_val > 65535)
280  continue;
281 
282  calc_baud = sel_clk / (brgr_val * (brdiv_val + 1));
283 
284  if (baud > calc_baud)
285  bauderror = baud - calc_baud;
286  else
287  bauderror = calc_baud - baud;
288 
289  /* use the values when percent error is acceptable */
290  if (((bauderror * 100) / baud) < 3) {
291  calc_baud = baud;
292  break;
293  }
294  }
295 
296  /* Set the values for the new baud rate */
299 
300  return calc_baud;
301 }
302 
303 /*----------------------Uart Operations---------------------------*/
304 
310 static void xuartps_start_tx(struct uart_port *port)
311 {
312  unsigned int status, numbytes = port->fifosize;
313 
314  if (uart_circ_empty(&port->state->xmit) || uart_tx_stopped(port))
315  return;
316 
318  /* Set the TX enable bit and clear the TX disable bit to enable the
319  * transmitter.
320  */
323 
324  while (numbytes-- && ((xuartps_readl(XUARTPS_SR_OFFSET)
325  & XUARTPS_SR_TXFULL)) != XUARTPS_SR_TXFULL) {
326 
327  /* Break if no more data available in the UART buffer */
328  if (uart_circ_empty(&port->state->xmit))
329  break;
330 
331  /* Get the data from the UART circular buffer and
332  * write it to the xuartps's TX_FIFO register.
333  */
335  port->state->xmit.buf[port->state->xmit.tail],
337  port->icount.tx++;
338 
339  /* Adjust the tail of the UART buffer and wrap
340  * the buffer if it reaches limit.
341  */
342  port->state->xmit.tail = (port->state->xmit.tail + 1) &
343  (UART_XMIT_SIZE - 1);
344  }
345 
346  /* Enable the TX Empty interrupt */
348 
349  if (uart_circ_chars_pending(&port->state->xmit) < WAKEUP_CHARS)
350  uart_write_wakeup(port);
351 }
352 
358 static void xuartps_stop_tx(struct uart_port *port)
359 {
360  unsigned int regval;
361 
363  regval |= XUARTPS_CR_TX_DIS;
364  /* Disable the transmitter */
366 }
367 
373 static void xuartps_stop_rx(struct uart_port *port)
374 {
375  unsigned int regval;
376 
378  regval |= XUARTPS_CR_RX_DIS;
379  /* Disable the receiver */
381 }
382 
389 static unsigned int xuartps_tx_empty(struct uart_port *port)
390 {
391  unsigned int status;
392 
394  return status ? TIOCSER_TEMT : 0;
395 }
396 
404 static void xuartps_break_ctl(struct uart_port *port, int ctl)
405 {
406  unsigned int status;
407  unsigned long flags;
408 
409  spin_lock_irqsave(&port->lock, flags);
410 
412 
413  if (ctl == -1)
416  else {
417  if ((status & XUARTPS_CR_STOPBRK) == 0)
418  xuartps_writel(XUARTPS_CR_STOPBRK | status,
420  }
421  spin_unlock_irqrestore(&port->lock, flags);
422 }
423 
432 static void xuartps_set_termios(struct uart_port *port,
433  struct ktermios *termios, struct ktermios *old)
434 {
435  unsigned int cval = 0;
436  unsigned int baud;
437  unsigned long flags;
438  unsigned int ctrl_reg, mode_reg;
439 
440  spin_lock_irqsave(&port->lock, flags);
441 
442  /* Empty the receive FIFO 1st before making changes */
444  XUARTPS_SR_RXEMPTY) != XUARTPS_SR_RXEMPTY) {
446  }
447 
448  /* Disable the TX and RX to set baud rate */
452 
453  /* Min baud rate = 6bps and Max Baud Rate is 10Mbps for 100Mhz clk */
454  baud = uart_get_baud_rate(port, termios, old, 0, 10000000);
455  baud = xuartps_set_baud_rate(port, baud);
456  if (tty_termios_baud_rate(termios))
457  tty_termios_encode_baud_rate(termios, baud, baud);
458 
459  /*
460  * Update the per-port timeout.
461  */
462  uart_update_timeout(port, termios->c_cflag, baud);
463 
464  /* Set TX/RX Reset */
468 
469  ctrl_reg = xuartps_readl(XUARTPS_CR_OFFSET);
470 
471  /* Clear the RX disable and TX disable bits and then set the TX enable
472  * bit and RX enable bit to enable the transmitter and receiver.
473  */
475  (ctrl_reg & ~(XUARTPS_CR_TX_DIS | XUARTPS_CR_RX_DIS))
478 
480 
483  port->ignore_status_mask = 0;
484 
485  if (termios->c_iflag & INPCK)
488 
489  if (termios->c_iflag & IGNPAR)
492 
493  /* ignore all characters if CREAD is not set */
494  if ((termios->c_cflag & CREAD) == 0)
498 
499  mode_reg = xuartps_readl(XUARTPS_MR_OFFSET);
500 
501  /* Handling Data Size */
502  switch (termios->c_cflag & CSIZE) {
503  case CS6:
504  cval |= XUARTPS_MR_CHARLEN_6_BIT;
505  break;
506  case CS7:
507  cval |= XUARTPS_MR_CHARLEN_7_BIT;
508  break;
509  default:
510  case CS8:
511  cval |= XUARTPS_MR_CHARLEN_8_BIT;
512  termios->c_cflag &= ~CSIZE;
513  termios->c_cflag |= CS8;
514  break;
515  }
516 
517  /* Handling Parity and Stop Bits length */
518  if (termios->c_cflag & CSTOPB)
519  cval |= XUARTPS_MR_STOPMODE_2_BIT; /* 2 STOP bits */
520  else
521  cval |= XUARTPS_MR_STOPMODE_1_BIT; /* 1 STOP bit */
522 
523  if (termios->c_cflag & PARENB) {
524  /* Mark or Space parity */
525  if (termios->c_cflag & CMSPAR) {
526  if (termios->c_cflag & PARODD)
527  cval |= XUARTPS_MR_PARITY_MARK;
528  else
529  cval |= XUARTPS_MR_PARITY_SPACE;
530  } else if (termios->c_cflag & PARODD)
531  cval |= XUARTPS_MR_PARITY_ODD;
532  else
533  cval |= XUARTPS_MR_PARITY_EVEN;
534  } else
535  cval |= XUARTPS_MR_PARITY_NONE;
537 
538  spin_unlock_irqrestore(&port->lock, flags);
539 }
540 
547 static int xuartps_startup(struct uart_port *port)
548 {
549  unsigned int retval = 0, status = 0;
550 
551  retval = request_irq(port->irq, xuartps_isr, 0, XUARTPS_NAME,
552  (void *)port);
553  if (retval)
554  return retval;
555 
556  /* Disable the TX and RX */
559 
560  /* Set the Control Register with TX/RX Enable, TX/RX Reset,
561  * no break chars.
562  */
565 
567 
568  /* Clear the RX disable and TX disable bits and then set the TX enable
569  * bit and RX enable bit to enable the transmitter and receiver.
570  */
574 
575  /* Set the Mode Register with normal mode,8 data bits,1 stop bit,
576  * no parity.
577  */
581 
582  /* Set the RX FIFO Trigger level to 14 assuming FIFO size as 16 */
584 
585  /* Receive Timeout register is enabled with value of 10 */
587 
588 
589  /* Set the Interrupt Registers with desired interrupts */
596 
597  return retval;
598 }
599 
605 static void xuartps_shutdown(struct uart_port *port)
606 {
607  int status;
608 
609  /* Disable interrupts */
612 
613  /* Disable the TX and RX */
616  free_irq(port->irq, port);
617 }
618 
625 static const char *xuartps_type(struct uart_port *port)
626 {
627  return port->type == PORT_XUARTPS ? XUARTPS_NAME : NULL;
628 }
629 
637 static int xuartps_verify_port(struct uart_port *port,
638  struct serial_struct *ser)
639 {
640  if (ser->type != PORT_UNKNOWN && ser->type != PORT_XUARTPS)
641  return -EINVAL;
642  if (port->irq != ser->irq)
643  return -EINVAL;
644  if (ser->io_type != UPIO_MEM)
645  return -EINVAL;
646  if (port->iobase != ser->port)
647  return -EINVAL;
648  if (ser->hub6 != 0)
649  return -EINVAL;
650  return 0;
651 }
652 
661 static int xuartps_request_port(struct uart_port *port)
662 {
664  XUARTPS_NAME)) {
665  return -ENOMEM;
666  }
667 
669  if (!port->membase) {
670  dev_err(port->dev, "Unable to map registers\n");
672  return -ENOMEM;
673  }
674  return 0;
675 }
676 
684 static void xuartps_release_port(struct uart_port *port)
685 {
687  iounmap(port->membase);
688  port->membase = NULL;
689 }
690 
698 static void xuartps_config_port(struct uart_port *port, int flags)
699 {
700  if (flags & UART_CONFIG_TYPE && xuartps_request_port(port) == 0)
701  port->type = PORT_XUARTPS;
702 }
703 
712 static unsigned int xuartps_get_mctrl(struct uart_port *port)
713 {
714  return TIOCM_CTS | TIOCM_DSR | TIOCM_CAR;
715 }
716 
717 static void xuartps_set_mctrl(struct uart_port *port, unsigned int mctrl)
718 {
719  /* N/A */
720 }
721 
722 static void xuartps_enable_ms(struct uart_port *port)
723 {
724  /* N/A */
725 }
726 
729 static struct uart_ops xuartps_ops = {
730  .set_mctrl = xuartps_set_mctrl,
731  .get_mctrl = xuartps_get_mctrl,
732  .enable_ms = xuartps_enable_ms,
733 
734  .start_tx = xuartps_start_tx, /* Start transmitting */
735  .stop_tx = xuartps_stop_tx, /* Stop transmission */
736  .stop_rx = xuartps_stop_rx, /* Stop reception */
737  .tx_empty = xuartps_tx_empty, /* Transmitter busy? */
738  .break_ctl = xuartps_break_ctl, /* Start/stop
739  * transmitting break
740  */
741  .set_termios = xuartps_set_termios, /* Set termios */
742  .startup = xuartps_startup, /* App opens xuartps */
743  .shutdown = xuartps_shutdown, /* App closes xuartps */
744  .type = xuartps_type, /* Set UART type */
745  .verify_port = xuartps_verify_port, /* Verification of port
746  * params
747  */
748  .request_port = xuartps_request_port, /* Claim resources
749  * associated with a
750  * xuartps port
751  */
752  .release_port = xuartps_release_port, /* Release resources
753  * associated with a
754  * xuartps port
755  */
756  .config_port = xuartps_config_port, /* Configure when driver
757  * adds a xuartps port
758  */
759 };
760 
761 static struct uart_port xuartps_port[2];
762 
769 static struct uart_port *xuartps_get_port(void)
770 {
771  struct uart_port *port;
772  int id;
773 
774  /* Find the next unused port */
775  for (id = 0; id < XUARTPS_NR_PORTS; id++)
776  if (xuartps_port[id].mapbase == 0)
777  break;
778 
779  if (id >= XUARTPS_NR_PORTS)
780  return NULL;
781 
782  port = &xuartps_port[id];
783 
784  /* At this point, we've got an empty uart_port struct, initialize it */
785  spin_lock_init(&port->lock);
786  port->membase = NULL;
787  port->iobase = 1; /* mark port in use */
788  port->irq = 0;
789  port->type = PORT_UNKNOWN;
790  port->iotype = UPIO_MEM32;
791  port->flags = UPF_BOOT_AUTOCONF;
792  port->ops = &xuartps_ops;
793  port->fifosize = XUARTPS_FIFO_SIZE;
794  port->line = id;
795  port->dev = NULL;
796  return port;
797 }
798 
799 /*-----------------------Console driver operations--------------------------*/
800 
801 #ifdef CONFIG_SERIAL_XILINX_PS_UART_CONSOLE
802 
807 static void xuartps_console_wait_tx(struct uart_port *port)
808 {
810  != XUARTPS_SR_TXEMPTY)
811  barrier();
812 }
813 
820 static void xuartps_console_putchar(struct uart_port *port, int ch)
821 {
822  xuartps_console_wait_tx(port);
824 }
825 
832 static void xuartps_console_write(struct console *co, const char *s,
833  unsigned int count)
834 {
835  struct uart_port *port = &xuartps_port[co->index];
836  unsigned long flags;
837  unsigned int imr;
838  int locked = 1;
839 
840  if (oops_in_progress)
841  locked = spin_trylock_irqsave(&port->lock, flags);
842  else
843  spin_lock_irqsave(&port->lock, flags);
844 
845  /* save and disable interrupt */
848 
849  uart_console_write(port, s, count, xuartps_console_putchar);
850  xuartps_console_wait_tx(port);
851 
852  /* restore interrupt state, it seems like there may be a h/w bug
853  * in that the interrupt enable register should not need to be
854  * written based on the data sheet
855  */
858 
859  if (locked)
860  spin_unlock_irqrestore(&port->lock, flags);
861 }
862 
870 static int __init xuartps_console_setup(struct console *co, char *options)
871 {
872  struct uart_port *port = &xuartps_port[co->index];
873  int baud = 9600;
874  int bits = 8;
875  int parity = 'n';
876  int flow = 'n';
877 
878  if (co->index < 0 || co->index >= XUARTPS_NR_PORTS)
879  return -EINVAL;
880 
881  if (!port->mapbase) {
882  pr_debug("console on ttyPS%i not present\n", co->index);
883  return -ENODEV;
884  }
885 
886  if (options)
887  uart_parse_options(options, &baud, &parity, &bits, &flow);
888 
889  return uart_set_options(port, co, baud, parity, bits, flow);
890 }
891 
892 static struct uart_driver xuartps_uart_driver;
893 
894 static struct console xuartps_console = {
896  .write = xuartps_console_write,
897  .device = uart_console_device,
898  .setup = xuartps_console_setup,
899  .flags = CON_PRINTBUFFER,
900  .index = -1, /* Specified on the cmdline (e.g. console=ttyPS ) */
901  .data = &xuartps_uart_driver,
902 };
903 
909 static int __init xuartps_console_init(void)
910 {
911  register_console(&xuartps_console);
912  return 0;
913 }
914 
915 console_initcall(xuartps_console_init);
916 
917 #endif /* CONFIG_SERIAL_XILINX_PS_UART_CONSOLE */
918 
921 static struct uart_driver xuartps_uart_driver = {
922  .owner = THIS_MODULE, /* Owner */
923  .driver_name = XUARTPS_NAME, /* Driver name */
924  .dev_name = XUARTPS_TTY_NAME, /* Node name */
925  .major = XUARTPS_MAJOR, /* Major number */
926  .minor = XUARTPS_MINOR, /* Minor number */
927  .nr = XUARTPS_NR_PORTS, /* Number of UART ports */
928 #ifdef CONFIG_SERIAL_XILINX_PS_UART_CONSOLE
929  .cons = &xuartps_console, /* Console */
930 #endif
931 };
932 
933 /* ---------------------------------------------------------------------
934  * Platform bus binding
935  */
942 static int __devinit xuartps_probe(struct platform_device *pdev)
943 {
944  int rc;
945  struct uart_port *port;
946  struct resource *res, *res2;
947  int clk = 0;
948 
949 #ifdef CONFIG_OF
950  const unsigned int *prop;
951 
952  prop = of_get_property(pdev->dev.of_node, "clock", NULL);
953  if (prop)
954  clk = be32_to_cpup(prop);
955 #else
956  clk = *((unsigned int *)(pdev->dev.platform_data));
957 #endif
958  if (!clk) {
959  dev_err(&pdev->dev, "no clock specified\n");
960  return -ENODEV;
961  }
962 
963  res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
964  if (!res)
965  return -ENODEV;
966 
967  res2 = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
968  if (!res2)
969  return -ENODEV;
970 
971  /* Initialize the port structure */
972  port = xuartps_get_port();
973 
974  if (!port) {
975  dev_err(&pdev->dev, "Cannot get uart_port structure\n");
976  return -ENODEV;
977  } else {
978  /* Register the port.
979  * This function also registers this device with the tty layer
980  * and triggers invocation of the config_port() entry point.
981  */
982  port->mapbase = res->start;
983  port->irq = res2->start;
984  port->dev = &pdev->dev;
985  port->uartclk = clk;
986  dev_set_drvdata(&pdev->dev, port);
987  rc = uart_add_one_port(&xuartps_uart_driver, port);
988  if (rc) {
989  dev_err(&pdev->dev,
990  "uart_add_one_port() failed; err=%i\n", rc);
991  dev_set_drvdata(&pdev->dev, NULL);
992  return rc;
993  }
994  return 0;
995  }
996 }
997 
1004 static int __devexit xuartps_remove(struct platform_device *pdev)
1005 {
1006  struct uart_port *port = dev_get_drvdata(&pdev->dev);
1007  int rc = 0;
1008 
1009  /* Remove the xuartps port from the serial core */
1010  if (port) {
1011  rc = uart_remove_one_port(&xuartps_uart_driver, port);
1012  dev_set_drvdata(&pdev->dev, NULL);
1013  port->mapbase = 0;
1014  }
1015  return rc;
1016 }
1017 
1025 static int xuartps_suspend(struct platform_device *pdev, pm_message_t state)
1026 {
1027  /* Call the API provided in serial_core.c file which handles
1028  * the suspend.
1029  */
1030  uart_suspend_port(&xuartps_uart_driver, &xuartps_port[pdev->id]);
1031  return 0;
1032 }
1033 
1040 static int xuartps_resume(struct platform_device *pdev)
1041 {
1042  uart_resume_port(&xuartps_uart_driver, &xuartps_port[pdev->id]);
1043  return 0;
1044 }
1045 
1046 /* Match table for of_platform binding */
1047 
1048 #ifdef CONFIG_OF
1049 static struct of_device_id xuartps_of_match[] __devinitdata = {
1050  { .compatible = "xlnx,xuartps", },
1051  {}
1052 };
1054 #else
1055 #define xuartps_of_match NULL
1056 #endif
1057 
1058 static struct platform_driver xuartps_platform_driver = {
1059  .probe = xuartps_probe, /* Probe method */
1060  .remove = __exit_p(xuartps_remove), /* Detach method */
1061  .suspend = xuartps_suspend, /* Suspend */
1062  .resume = xuartps_resume, /* Resume after a suspend */
1063  .driver = {
1064  .owner = THIS_MODULE,
1065  .name = XUARTPS_NAME, /* Driver name */
1066  .of_match_table = xuartps_of_match,
1067  },
1068 };
1069 
1070 /* ---------------------------------------------------------------------
1071  * Module Init and Exit
1072  */
1078 static int __init xuartps_init(void)
1079 {
1080  int retval = 0;
1081 
1082  /* Register the xuartps driver with the serial core */
1083  retval = uart_register_driver(&xuartps_uart_driver);
1084  if (retval)
1085  return retval;
1086 
1087  /* Register the platform driver */
1088  retval = platform_driver_register(&xuartps_platform_driver);
1089  if (retval)
1090  uart_unregister_driver(&xuartps_uart_driver);
1091 
1092  return retval;
1093 }
1094 
1098 static void __exit xuartps_exit(void)
1099 {
1100  /* The order of unregistration is important. Unregister the
1101  * UART driver before the platform driver crashes the system.
1102  */
1103 
1104  /* Unregister the platform driver */
1105  platform_driver_unregister(&xuartps_platform_driver);
1106 
1107  /* Unregister the xuartps driver */
1108  uart_unregister_driver(&xuartps_uart_driver);
1109 }
1110 
1111 module_init(xuartps_init);
1112 module_exit(xuartps_exit);
1113 
1114 MODULE_DESCRIPTION("Driver for PS UART");
1115 MODULE_AUTHOR("Xilinx Inc.");
1116 MODULE_LICENSE("GPL");