1e3b3d0f5SGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0
2ab4382d2SGreg Kroah-Hartman /*
3ab4382d2SGreg Kroah-Hartman * Copyright (C) 2010 Alexey Charkov <alchark@gmail.com>
4ab4382d2SGreg Kroah-Hartman *
5ab4382d2SGreg Kroah-Hartman * Based on msm_serial.c, which is:
6ab4382d2SGreg Kroah-Hartman * Copyright (C) 2007 Google, Inc.
7ab4382d2SGreg Kroah-Hartman * Author: Robert Love <rlove@google.com>
8ab4382d2SGreg Kroah-Hartman */
9ab4382d2SGreg Kroah-Hartman
10ab4382d2SGreg Kroah-Hartman #include <linux/hrtimer.h>
11ab4382d2SGreg Kroah-Hartman #include <linux/delay.h>
12ab4382d2SGreg Kroah-Hartman #include <linux/io.h>
13ab4382d2SGreg Kroah-Hartman #include <linux/ioport.h>
14ab4382d2SGreg Kroah-Hartman #include <linux/irq.h>
15ab4382d2SGreg Kroah-Hartman #include <linux/init.h>
16ab4382d2SGreg Kroah-Hartman #include <linux/console.h>
1729e5c442SRob Herring #include <linux/platform_device.h>
18ab4382d2SGreg Kroah-Hartman #include <linux/tty.h>
19ab4382d2SGreg Kroah-Hartman #include <linux/tty_flip.h>
20ab4382d2SGreg Kroah-Hartman #include <linux/serial_core.h>
21ab4382d2SGreg Kroah-Hartman #include <linux/serial.h>
22ab4382d2SGreg Kroah-Hartman #include <linux/slab.h>
23ab4382d2SGreg Kroah-Hartman #include <linux/clk.h>
244001130dSTony Prisk #include <linux/of.h>
2582b23132SSachin Kamat #include <linux/err.h>
26ab4382d2SGreg Kroah-Hartman
27ab4382d2SGreg Kroah-Hartman /*
28ab4382d2SGreg Kroah-Hartman * UART Register offsets
29ab4382d2SGreg Kroah-Hartman */
30ab4382d2SGreg Kroah-Hartman
31ab4382d2SGreg Kroah-Hartman #define VT8500_URTDR 0x0000 /* Transmit data */
32ab4382d2SGreg Kroah-Hartman #define VT8500_URRDR 0x0004 /* Receive data */
33ab4382d2SGreg Kroah-Hartman #define VT8500_URDIV 0x0008 /* Clock/Baud rate divisor */
34ab4382d2SGreg Kroah-Hartman #define VT8500_URLCR 0x000C /* Line control */
35ab4382d2SGreg Kroah-Hartman #define VT8500_URICR 0x0010 /* IrDA control */
36ab4382d2SGreg Kroah-Hartman #define VT8500_URIER 0x0014 /* Interrupt enable */
37ab4382d2SGreg Kroah-Hartman #define VT8500_URISR 0x0018 /* Interrupt status */
38ab4382d2SGreg Kroah-Hartman #define VT8500_URUSR 0x001c /* UART status */
39ab4382d2SGreg Kroah-Hartman #define VT8500_URFCR 0x0020 /* FIFO control */
40ab4382d2SGreg Kroah-Hartman #define VT8500_URFIDX 0x0024 /* FIFO index */
41ab4382d2SGreg Kroah-Hartman #define VT8500_URBKR 0x0028 /* Break signal count */
42ab4382d2SGreg Kroah-Hartman #define VT8500_URTOD 0x002c /* Time out divisor */
43ab4382d2SGreg Kroah-Hartman #define VT8500_TXFIFO 0x1000 /* Transmit FIFO (16x8) */
44ab4382d2SGreg Kroah-Hartman #define VT8500_RXFIFO 0x1020 /* Receive FIFO (16x10) */
45ab4382d2SGreg Kroah-Hartman
46ab4382d2SGreg Kroah-Hartman /*
47ab4382d2SGreg Kroah-Hartman * Interrupt enable and status bits
48ab4382d2SGreg Kroah-Hartman */
49ab4382d2SGreg Kroah-Hartman
50ab4382d2SGreg Kroah-Hartman #define TXDE (1 << 0) /* Tx Data empty */
51ab4382d2SGreg Kroah-Hartman #define RXDF (1 << 1) /* Rx Data full */
52ab4382d2SGreg Kroah-Hartman #define TXFAE (1 << 2) /* Tx FIFO almost empty */
53ab4382d2SGreg Kroah-Hartman #define TXFE (1 << 3) /* Tx FIFO empty */
54ab4382d2SGreg Kroah-Hartman #define RXFAF (1 << 4) /* Rx FIFO almost full */
55ab4382d2SGreg Kroah-Hartman #define RXFF (1 << 5) /* Rx FIFO full */
56ab4382d2SGreg Kroah-Hartman #define TXUDR (1 << 6) /* Tx underrun */
57ab4382d2SGreg Kroah-Hartman #define RXOVER (1 << 7) /* Rx overrun */
58ab4382d2SGreg Kroah-Hartman #define PER (1 << 8) /* Parity error */
59ab4382d2SGreg Kroah-Hartman #define FER (1 << 9) /* Frame error */
60ab4382d2SGreg Kroah-Hartman #define TCTS (1 << 10) /* Toggle of CTS */
61ab4382d2SGreg Kroah-Hartman #define RXTOUT (1 << 11) /* Rx timeout */
62ab4382d2SGreg Kroah-Hartman #define BKDONE (1 << 12) /* Break signal done */
63ab4382d2SGreg Kroah-Hartman #define ERR (1 << 13) /* AHB error response */
64ab4382d2SGreg Kroah-Hartman
65ab4382d2SGreg Kroah-Hartman #define RX_FIFO_INTS (RXFAF | RXFF | RXOVER | PER | FER | RXTOUT)
66ab4382d2SGreg Kroah-Hartman #define TX_FIFO_INTS (TXFAE | TXFE | TXUDR)
67ab4382d2SGreg Kroah-Hartman
68ae382735SAlexey Charkov /*
69ae382735SAlexey Charkov * Line control bits
70ae382735SAlexey Charkov */
71ae382735SAlexey Charkov
72ae382735SAlexey Charkov #define VT8500_TXEN (1 << 0) /* Enable transmit logic */
73ae382735SAlexey Charkov #define VT8500_RXEN (1 << 1) /* Enable receive logic */
74ae382735SAlexey Charkov #define VT8500_CS8 (1 << 2) /* 8-bit data length (vs. 7-bit) */
75ae382735SAlexey Charkov #define VT8500_CSTOPB (1 << 3) /* 2 stop bits (vs. 1) */
76ae382735SAlexey Charkov #define VT8500_PARENB (1 << 4) /* Enable parity */
77ae382735SAlexey Charkov #define VT8500_PARODD (1 << 5) /* Odd parity (vs. even) */
78ae382735SAlexey Charkov #define VT8500_RTS (1 << 6) /* Ready to send */
79ae382735SAlexey Charkov #define VT8500_LOOPBK (1 << 7) /* Enable internal loopback */
80ae382735SAlexey Charkov #define VT8500_DMA (1 << 8) /* Enable DMA mode (needs FIFO) */
81ae382735SAlexey Charkov #define VT8500_BREAK (1 << 9) /* Initiate break signal */
82ae382735SAlexey Charkov #define VT8500_PSLVERR (1 << 10) /* APB error upon empty RX FIFO read */
83ae382735SAlexey Charkov #define VT8500_SWRTSCTS (1 << 11) /* Software-controlled RTS/CTS */
84ae382735SAlexey Charkov
85ae382735SAlexey Charkov /*
86ae382735SAlexey Charkov * Capability flags (driver-internal)
87ae382735SAlexey Charkov */
88ae382735SAlexey Charkov
89ae382735SAlexey Charkov #define VT8500_HAS_SWRTSCTS_SWITCH (1 << 1)
90ae382735SAlexey Charkov
915aa387c1SAlexey Charkov #define VT8500_RECOMMENDED_CLK 12000000
925aa387c1SAlexey Charkov #define VT8500_OVERSAMPLING_DIVISOR 13
934001130dSTony Prisk #define VT8500_MAX_PORTS 6
944001130dSTony Prisk
95ab4382d2SGreg Kroah-Hartman struct vt8500_port {
96ab4382d2SGreg Kroah-Hartman struct uart_port uart;
97ab4382d2SGreg Kroah-Hartman char name[16];
98ab4382d2SGreg Kroah-Hartman struct clk *clk;
995aa387c1SAlexey Charkov unsigned int clk_predivisor;
100ab4382d2SGreg Kroah-Hartman unsigned int ier;
101ae382735SAlexey Charkov unsigned int vt8500_uart_flags;
102ab4382d2SGreg Kroah-Hartman };
103ab4382d2SGreg Kroah-Hartman
1044001130dSTony Prisk /*
1054001130dSTony Prisk * we use this variable to keep track of which ports
1064001130dSTony Prisk * have been allocated as we can't use pdev->id in
1074001130dSTony Prisk * devicetree
1084001130dSTony Prisk */
1090b1221a3SChristophe JAILLET static DECLARE_BITMAP(vt8500_ports_in_use, VT8500_MAX_PORTS);
1104001130dSTony Prisk
vt8500_write(struct uart_port * port,unsigned int val,unsigned int off)111ab4382d2SGreg Kroah-Hartman static inline void vt8500_write(struct uart_port *port, unsigned int val,
112ab4382d2SGreg Kroah-Hartman unsigned int off)
113ab4382d2SGreg Kroah-Hartman {
114ab4382d2SGreg Kroah-Hartman writel(val, port->membase + off);
115ab4382d2SGreg Kroah-Hartman }
116ab4382d2SGreg Kroah-Hartman
vt8500_read(struct uart_port * port,unsigned int off)117ab4382d2SGreg Kroah-Hartman static inline unsigned int vt8500_read(struct uart_port *port, unsigned int off)
118ab4382d2SGreg Kroah-Hartman {
119ab4382d2SGreg Kroah-Hartman return readl(port->membase + off);
120ab4382d2SGreg Kroah-Hartman }
121ab4382d2SGreg Kroah-Hartman
vt8500_stop_tx(struct uart_port * port)122ab4382d2SGreg Kroah-Hartman static void vt8500_stop_tx(struct uart_port *port)
123ab4382d2SGreg Kroah-Hartman {
124ab4382d2SGreg Kroah-Hartman struct vt8500_port *vt8500_port = container_of(port,
125ab4382d2SGreg Kroah-Hartman struct vt8500_port,
126ab4382d2SGreg Kroah-Hartman uart);
127ab4382d2SGreg Kroah-Hartman
128ab4382d2SGreg Kroah-Hartman vt8500_port->ier &= ~TX_FIFO_INTS;
129ab4382d2SGreg Kroah-Hartman vt8500_write(port, vt8500_port->ier, VT8500_URIER);
130ab4382d2SGreg Kroah-Hartman }
131ab4382d2SGreg Kroah-Hartman
vt8500_stop_rx(struct uart_port * port)132ab4382d2SGreg Kroah-Hartman static void vt8500_stop_rx(struct uart_port *port)
133ab4382d2SGreg Kroah-Hartman {
134ab4382d2SGreg Kroah-Hartman struct vt8500_port *vt8500_port = container_of(port,
135ab4382d2SGreg Kroah-Hartman struct vt8500_port,
136ab4382d2SGreg Kroah-Hartman uart);
137ab4382d2SGreg Kroah-Hartman
138ab4382d2SGreg Kroah-Hartman vt8500_port->ier &= ~RX_FIFO_INTS;
139ab4382d2SGreg Kroah-Hartman vt8500_write(port, vt8500_port->ier, VT8500_URIER);
140ab4382d2SGreg Kroah-Hartman }
141ab4382d2SGreg Kroah-Hartman
vt8500_enable_ms(struct uart_port * port)142ab4382d2SGreg Kroah-Hartman static void vt8500_enable_ms(struct uart_port *port)
143ab4382d2SGreg Kroah-Hartman {
144ab4382d2SGreg Kroah-Hartman struct vt8500_port *vt8500_port = container_of(port,
145ab4382d2SGreg Kroah-Hartman struct vt8500_port,
146ab4382d2SGreg Kroah-Hartman uart);
147ab4382d2SGreg Kroah-Hartman
148ab4382d2SGreg Kroah-Hartman vt8500_port->ier |= TCTS;
149ab4382d2SGreg Kroah-Hartman vt8500_write(port, vt8500_port->ier, VT8500_URIER);
150ab4382d2SGreg Kroah-Hartman }
151ab4382d2SGreg Kroah-Hartman
handle_rx(struct uart_port * port)152ab4382d2SGreg Kroah-Hartman static void handle_rx(struct uart_port *port)
153ab4382d2SGreg Kroah-Hartman {
15492a19f9cSJiri Slaby struct tty_port *tport = &port->state->port;
155ab4382d2SGreg Kroah-Hartman
156ab4382d2SGreg Kroah-Hartman /*
157ab4382d2SGreg Kroah-Hartman * Handle overrun
158ab4382d2SGreg Kroah-Hartman */
159ab4382d2SGreg Kroah-Hartman if ((vt8500_read(port, VT8500_URISR) & RXOVER)) {
160ab4382d2SGreg Kroah-Hartman port->icount.overrun++;
16192a19f9cSJiri Slaby tty_insert_flip_char(tport, 0, TTY_OVERRUN);
162ab4382d2SGreg Kroah-Hartman }
163ab4382d2SGreg Kroah-Hartman
164ab4382d2SGreg Kroah-Hartman /* and now the main RX loop */
165ab4382d2SGreg Kroah-Hartman while (vt8500_read(port, VT8500_URFIDX) & 0x1f00) {
166ab4382d2SGreg Kroah-Hartman unsigned int c;
167ab4382d2SGreg Kroah-Hartman char flag = TTY_NORMAL;
168ab4382d2SGreg Kroah-Hartman
169ab4382d2SGreg Kroah-Hartman c = readw(port->membase + VT8500_RXFIFO) & 0x3ff;
170ab4382d2SGreg Kroah-Hartman
171c6d30576SJonathan Neuschäfer /* Mask conditions we're ignoring. */
172ab4382d2SGreg Kroah-Hartman c &= ~port->read_status_mask;
173ab4382d2SGreg Kroah-Hartman
174ab4382d2SGreg Kroah-Hartman if (c & FER) {
175ab4382d2SGreg Kroah-Hartman port->icount.frame++;
176ab4382d2SGreg Kroah-Hartman flag = TTY_FRAME;
177ab4382d2SGreg Kroah-Hartman } else if (c & PER) {
178ab4382d2SGreg Kroah-Hartman port->icount.parity++;
179ab4382d2SGreg Kroah-Hartman flag = TTY_PARITY;
180ab4382d2SGreg Kroah-Hartman }
181ab4382d2SGreg Kroah-Hartman port->icount.rx++;
182ab4382d2SGreg Kroah-Hartman
183ab4382d2SGreg Kroah-Hartman if (!uart_handle_sysrq_char(port, c))
18492a19f9cSJiri Slaby tty_insert_flip_char(tport, c, flag);
185ab4382d2SGreg Kroah-Hartman }
186ab4382d2SGreg Kroah-Hartman
1872e124b4aSJiri Slaby tty_flip_buffer_push(tport);
188ab4382d2SGreg Kroah-Hartman }
189ab4382d2SGreg Kroah-Hartman
vt8500_tx_empty(struct uart_port * port)1900c0bfc6bSJiri Slaby static unsigned int vt8500_tx_empty(struct uart_port *port)
1910c0bfc6bSJiri Slaby {
1920c0bfc6bSJiri Slaby unsigned int idx = vt8500_read(port, VT8500_URFIDX) & 0x1f;
1930c0bfc6bSJiri Slaby
1940c0bfc6bSJiri Slaby return idx < 16 ? TIOCSER_TEMT : 0;
1950c0bfc6bSJiri Slaby }
1960c0bfc6bSJiri Slaby
handle_tx(struct uart_port * port)197ab4382d2SGreg Kroah-Hartman static void handle_tx(struct uart_port *port)
198ab4382d2SGreg Kroah-Hartman {
1992d141e68SJiri Slaby (SUSE) u8 ch;
200ab4382d2SGreg Kroah-Hartman
2012d141e68SJiri Slaby (SUSE) uart_port_tx(port, ch,
2022d141e68SJiri Slaby (SUSE) vt8500_tx_empty(port),
2032d141e68SJiri Slaby (SUSE) writeb(ch, port->membase + VT8500_TXFIFO));
204ab4382d2SGreg Kroah-Hartman }
205ab4382d2SGreg Kroah-Hartman
vt8500_start_tx(struct uart_port * port)206ab4382d2SGreg Kroah-Hartman static void vt8500_start_tx(struct uart_port *port)
207ab4382d2SGreg Kroah-Hartman {
208ab4382d2SGreg Kroah-Hartman struct vt8500_port *vt8500_port = container_of(port,
209ab4382d2SGreg Kroah-Hartman struct vt8500_port,
210ab4382d2SGreg Kroah-Hartman uart);
211ab4382d2SGreg Kroah-Hartman
212ab4382d2SGreg Kroah-Hartman vt8500_port->ier &= ~TX_FIFO_INTS;
213ab4382d2SGreg Kroah-Hartman vt8500_write(port, vt8500_port->ier, VT8500_URIER);
214ab4382d2SGreg Kroah-Hartman handle_tx(port);
215ab4382d2SGreg Kroah-Hartman vt8500_port->ier |= TX_FIFO_INTS;
216ab4382d2SGreg Kroah-Hartman vt8500_write(port, vt8500_port->ier, VT8500_URIER);
217ab4382d2SGreg Kroah-Hartman }
218ab4382d2SGreg Kroah-Hartman
handle_delta_cts(struct uart_port * port)219ab4382d2SGreg Kroah-Hartman static void handle_delta_cts(struct uart_port *port)
220ab4382d2SGreg Kroah-Hartman {
221ab4382d2SGreg Kroah-Hartman port->icount.cts++;
222ab4382d2SGreg Kroah-Hartman wake_up_interruptible(&port->state->port.delta_msr_wait);
223ab4382d2SGreg Kroah-Hartman }
224ab4382d2SGreg Kroah-Hartman
vt8500_irq(int irq,void * dev_id)225ab4382d2SGreg Kroah-Hartman static irqreturn_t vt8500_irq(int irq, void *dev_id)
226ab4382d2SGreg Kroah-Hartman {
227ab4382d2SGreg Kroah-Hartman struct uart_port *port = dev_id;
228ab4382d2SGreg Kroah-Hartman unsigned long isr;
229ab4382d2SGreg Kroah-Hartman
230ab4382d2SGreg Kroah-Hartman spin_lock(&port->lock);
231ab4382d2SGreg Kroah-Hartman isr = vt8500_read(port, VT8500_URISR);
232ab4382d2SGreg Kroah-Hartman
233ab4382d2SGreg Kroah-Hartman /* Acknowledge active status bits */
234ab4382d2SGreg Kroah-Hartman vt8500_write(port, isr, VT8500_URISR);
235ab4382d2SGreg Kroah-Hartman
236ab4382d2SGreg Kroah-Hartman if (isr & RX_FIFO_INTS)
237ab4382d2SGreg Kroah-Hartman handle_rx(port);
238ab4382d2SGreg Kroah-Hartman if (isr & TX_FIFO_INTS)
239ab4382d2SGreg Kroah-Hartman handle_tx(port);
240ab4382d2SGreg Kroah-Hartman if (isr & TCTS)
241ab4382d2SGreg Kroah-Hartman handle_delta_cts(port);
242ab4382d2SGreg Kroah-Hartman
243ab4382d2SGreg Kroah-Hartman spin_unlock(&port->lock);
244ab4382d2SGreg Kroah-Hartman
245ab4382d2SGreg Kroah-Hartman return IRQ_HANDLED;
246ab4382d2SGreg Kroah-Hartman }
247ab4382d2SGreg Kroah-Hartman
vt8500_get_mctrl(struct uart_port * port)248ab4382d2SGreg Kroah-Hartman static unsigned int vt8500_get_mctrl(struct uart_port *port)
249ab4382d2SGreg Kroah-Hartman {
250ab4382d2SGreg Kroah-Hartman unsigned int usr;
251ab4382d2SGreg Kroah-Hartman
252ab4382d2SGreg Kroah-Hartman usr = vt8500_read(port, VT8500_URUSR);
253ab4382d2SGreg Kroah-Hartman if (usr & (1 << 4))
254ab4382d2SGreg Kroah-Hartman return TIOCM_CTS;
255ab4382d2SGreg Kroah-Hartman else
256ab4382d2SGreg Kroah-Hartman return 0;
257ab4382d2SGreg Kroah-Hartman }
258ab4382d2SGreg Kroah-Hartman
vt8500_set_mctrl(struct uart_port * port,unsigned int mctrl)259ab4382d2SGreg Kroah-Hartman static void vt8500_set_mctrl(struct uart_port *port, unsigned int mctrl)
260ab4382d2SGreg Kroah-Hartman {
2618c986d3eSAlexey Charkov unsigned int lcr = vt8500_read(port, VT8500_URLCR);
2628c986d3eSAlexey Charkov
2638c986d3eSAlexey Charkov if (mctrl & TIOCM_RTS)
2648c986d3eSAlexey Charkov lcr |= VT8500_RTS;
2658c986d3eSAlexey Charkov else
2668c986d3eSAlexey Charkov lcr &= ~VT8500_RTS;
2678c986d3eSAlexey Charkov
2688c986d3eSAlexey Charkov vt8500_write(port, lcr, VT8500_URLCR);
269ab4382d2SGreg Kroah-Hartman }
270ab4382d2SGreg Kroah-Hartman
vt8500_break_ctl(struct uart_port * port,int break_ctl)271ab4382d2SGreg Kroah-Hartman static void vt8500_break_ctl(struct uart_port *port, int break_ctl)
272ab4382d2SGreg Kroah-Hartman {
273ab4382d2SGreg Kroah-Hartman if (break_ctl)
274ae382735SAlexey Charkov vt8500_write(port,
275ae382735SAlexey Charkov vt8500_read(port, VT8500_URLCR) | VT8500_BREAK,
276ab4382d2SGreg Kroah-Hartman VT8500_URLCR);
277ab4382d2SGreg Kroah-Hartman }
278ab4382d2SGreg Kroah-Hartman
vt8500_set_baud_rate(struct uart_port * port,unsigned int baud)279ab4382d2SGreg Kroah-Hartman static int vt8500_set_baud_rate(struct uart_port *port, unsigned int baud)
280ab4382d2SGreg Kroah-Hartman {
2815aa387c1SAlexey Charkov struct vt8500_port *vt8500_port =
2825aa387c1SAlexey Charkov container_of(port, struct vt8500_port, uart);
283ab4382d2SGreg Kroah-Hartman unsigned long div;
284ab4382d2SGreg Kroah-Hartman unsigned int loops = 1000;
285ab4382d2SGreg Kroah-Hartman
2865aa387c1SAlexey Charkov div = ((vt8500_port->clk_predivisor - 1) & 0xf) << 16;
2875aa387c1SAlexey Charkov div |= (uart_get_divisor(port, baud) - 1) & 0x3ff;
288ab4382d2SGreg Kroah-Hartman
2895aa387c1SAlexey Charkov /* Effective baud rate */
2905aa387c1SAlexey Charkov baud = port->uartclk / 16 / ((div & 0x3ff) + 1);
291ab4382d2SGreg Kroah-Hartman
292ab4382d2SGreg Kroah-Hartman while ((vt8500_read(port, VT8500_URUSR) & (1 << 5)) && --loops)
293ab4382d2SGreg Kroah-Hartman cpu_relax();
2945aa387c1SAlexey Charkov
295ab4382d2SGreg Kroah-Hartman vt8500_write(port, div, VT8500_URDIV);
296ab4382d2SGreg Kroah-Hartman
2975aa387c1SAlexey Charkov /* Break signal timing depends on baud rate, update accordingly */
2985aa387c1SAlexey Charkov vt8500_write(port, mult_frac(baud, 4096, 1000000), VT8500_URBKR);
2995aa387c1SAlexey Charkov
300ab4382d2SGreg Kroah-Hartman return baud;
301ab4382d2SGreg Kroah-Hartman }
302ab4382d2SGreg Kroah-Hartman
vt8500_startup(struct uart_port * port)303ab4382d2SGreg Kroah-Hartman static int vt8500_startup(struct uart_port *port)
304ab4382d2SGreg Kroah-Hartman {
305ab4382d2SGreg Kroah-Hartman struct vt8500_port *vt8500_port =
306ab4382d2SGreg Kroah-Hartman container_of(port, struct vt8500_port, uart);
307ab4382d2SGreg Kroah-Hartman int ret;
308ab4382d2SGreg Kroah-Hartman
309ab4382d2SGreg Kroah-Hartman snprintf(vt8500_port->name, sizeof(vt8500_port->name),
310ab4382d2SGreg Kroah-Hartman "vt8500_serial%d", port->line);
311ab4382d2SGreg Kroah-Hartman
312ab4382d2SGreg Kroah-Hartman ret = request_irq(port->irq, vt8500_irq, IRQF_TRIGGER_HIGH,
313ab4382d2SGreg Kroah-Hartman vt8500_port->name, port);
314ab4382d2SGreg Kroah-Hartman if (unlikely(ret))
315ab4382d2SGreg Kroah-Hartman return ret;
316ab4382d2SGreg Kroah-Hartman
317ab4382d2SGreg Kroah-Hartman vt8500_write(port, 0x03, VT8500_URLCR); /* enable TX & RX */
318ab4382d2SGreg Kroah-Hartman
319ab4382d2SGreg Kroah-Hartman return 0;
320ab4382d2SGreg Kroah-Hartman }
321ab4382d2SGreg Kroah-Hartman
vt8500_shutdown(struct uart_port * port)322ab4382d2SGreg Kroah-Hartman static void vt8500_shutdown(struct uart_port *port)
323ab4382d2SGreg Kroah-Hartman {
324ab4382d2SGreg Kroah-Hartman struct vt8500_port *vt8500_port =
325ab4382d2SGreg Kroah-Hartman container_of(port, struct vt8500_port, uart);
326ab4382d2SGreg Kroah-Hartman
327ab4382d2SGreg Kroah-Hartman vt8500_port->ier = 0;
328ab4382d2SGreg Kroah-Hartman
329ab4382d2SGreg Kroah-Hartman /* disable interrupts and FIFOs */
330ab4382d2SGreg Kroah-Hartman vt8500_write(&vt8500_port->uart, 0, VT8500_URIER);
331ab4382d2SGreg Kroah-Hartman vt8500_write(&vt8500_port->uart, 0x880, VT8500_URFCR);
332ab4382d2SGreg Kroah-Hartman free_irq(port->irq, port);
333ab4382d2SGreg Kroah-Hartman }
334ab4382d2SGreg Kroah-Hartman
vt8500_set_termios(struct uart_port * port,struct ktermios * termios,const struct ktermios * old)335ab4382d2SGreg Kroah-Hartman static void vt8500_set_termios(struct uart_port *port,
336ab4382d2SGreg Kroah-Hartman struct ktermios *termios,
337bec5b814SIlpo Järvinen const struct ktermios *old)
338ab4382d2SGreg Kroah-Hartman {
339ab4382d2SGreg Kroah-Hartman struct vt8500_port *vt8500_port =
340ab4382d2SGreg Kroah-Hartman container_of(port, struct vt8500_port, uart);
341ab4382d2SGreg Kroah-Hartman unsigned long flags;
342ab4382d2SGreg Kroah-Hartman unsigned int baud, lcr;
343ab4382d2SGreg Kroah-Hartman unsigned int loops = 1000;
344ab4382d2SGreg Kroah-Hartman
345ab4382d2SGreg Kroah-Hartman spin_lock_irqsave(&port->lock, flags);
346ab4382d2SGreg Kroah-Hartman
347ab4382d2SGreg Kroah-Hartman /* calculate and set baud rate */
348ab4382d2SGreg Kroah-Hartman baud = uart_get_baud_rate(port, termios, old, 900, 921600);
349ab4382d2SGreg Kroah-Hartman baud = vt8500_set_baud_rate(port, baud);
350ab4382d2SGreg Kroah-Hartman if (tty_termios_baud_rate(termios))
351ab4382d2SGreg Kroah-Hartman tty_termios_encode_baud_rate(termios, baud, baud);
352ab4382d2SGreg Kroah-Hartman
353ab4382d2SGreg Kroah-Hartman /* calculate parity */
354ab4382d2SGreg Kroah-Hartman lcr = vt8500_read(&vt8500_port->uart, VT8500_URLCR);
355ae382735SAlexey Charkov lcr &= ~(VT8500_PARENB | VT8500_PARODD);
356ab4382d2SGreg Kroah-Hartman if (termios->c_cflag & PARENB) {
357ae382735SAlexey Charkov lcr |= VT8500_PARENB;
358ab4382d2SGreg Kroah-Hartman termios->c_cflag &= ~CMSPAR;
359ab4382d2SGreg Kroah-Hartman if (termios->c_cflag & PARODD)
360ae382735SAlexey Charkov lcr |= VT8500_PARODD;
361ab4382d2SGreg Kroah-Hartman }
362ab4382d2SGreg Kroah-Hartman
363ab4382d2SGreg Kroah-Hartman /* calculate bits per char */
364ae382735SAlexey Charkov lcr &= ~VT8500_CS8;
365ab4382d2SGreg Kroah-Hartman switch (termios->c_cflag & CSIZE) {
366ab4382d2SGreg Kroah-Hartman case CS7:
367ab4382d2SGreg Kroah-Hartman break;
368ab4382d2SGreg Kroah-Hartman case CS8:
369ab4382d2SGreg Kroah-Hartman default:
370ae382735SAlexey Charkov lcr |= VT8500_CS8;
371ab4382d2SGreg Kroah-Hartman termios->c_cflag &= ~CSIZE;
372ab4382d2SGreg Kroah-Hartman termios->c_cflag |= CS8;
373ab4382d2SGreg Kroah-Hartman break;
374ab4382d2SGreg Kroah-Hartman }
375ab4382d2SGreg Kroah-Hartman
376ab4382d2SGreg Kroah-Hartman /* calculate stop bits */
377ae382735SAlexey Charkov lcr &= ~VT8500_CSTOPB;
378ab4382d2SGreg Kroah-Hartman if (termios->c_cflag & CSTOPB)
379ae382735SAlexey Charkov lcr |= VT8500_CSTOPB;
380ae382735SAlexey Charkov
381ae382735SAlexey Charkov lcr &= ~VT8500_SWRTSCTS;
382ae382735SAlexey Charkov if (vt8500_port->vt8500_uart_flags & VT8500_HAS_SWRTSCTS_SWITCH)
383ae382735SAlexey Charkov lcr |= VT8500_SWRTSCTS;
384ab4382d2SGreg Kroah-Hartman
385ab4382d2SGreg Kroah-Hartman /* set parity, bits per char, and stop bit */
386ab4382d2SGreg Kroah-Hartman vt8500_write(&vt8500_port->uart, lcr, VT8500_URLCR);
387ab4382d2SGreg Kroah-Hartman
388ab4382d2SGreg Kroah-Hartman /* Configure status bits to ignore based on termio flags. */
389ab4382d2SGreg Kroah-Hartman port->read_status_mask = 0;
390ab4382d2SGreg Kroah-Hartman if (termios->c_iflag & IGNPAR)
391ab4382d2SGreg Kroah-Hartman port->read_status_mask = FER | PER;
392ab4382d2SGreg Kroah-Hartman
393ab4382d2SGreg Kroah-Hartman uart_update_timeout(port, termios->c_cflag, baud);
394ab4382d2SGreg Kroah-Hartman
395ab4382d2SGreg Kroah-Hartman /* Reset FIFOs */
396ab4382d2SGreg Kroah-Hartman vt8500_write(&vt8500_port->uart, 0x88c, VT8500_URFCR);
397ab4382d2SGreg Kroah-Hartman while ((vt8500_read(&vt8500_port->uart, VT8500_URFCR) & 0xc)
398ab4382d2SGreg Kroah-Hartman && --loops)
399ab4382d2SGreg Kroah-Hartman cpu_relax();
400ab4382d2SGreg Kroah-Hartman
401ab4382d2SGreg Kroah-Hartman /* Every possible FIFO-related interrupt */
402ab4382d2SGreg Kroah-Hartman vt8500_port->ier = RX_FIFO_INTS | TX_FIFO_INTS;
403ab4382d2SGreg Kroah-Hartman
404ab4382d2SGreg Kroah-Hartman /*
405ab4382d2SGreg Kroah-Hartman * CTS flow control
406ab4382d2SGreg Kroah-Hartman */
407ab4382d2SGreg Kroah-Hartman if (UART_ENABLE_MS(&vt8500_port->uart, termios->c_cflag))
408ab4382d2SGreg Kroah-Hartman vt8500_port->ier |= TCTS;
409ab4382d2SGreg Kroah-Hartman
410ab4382d2SGreg Kroah-Hartman vt8500_write(&vt8500_port->uart, 0x881, VT8500_URFCR);
411ab4382d2SGreg Kroah-Hartman vt8500_write(&vt8500_port->uart, vt8500_port->ier, VT8500_URIER);
412ab4382d2SGreg Kroah-Hartman
413ab4382d2SGreg Kroah-Hartman spin_unlock_irqrestore(&port->lock, flags);
414ab4382d2SGreg Kroah-Hartman }
415ab4382d2SGreg Kroah-Hartman
vt8500_type(struct uart_port * port)416ab4382d2SGreg Kroah-Hartman static const char *vt8500_type(struct uart_port *port)
417ab4382d2SGreg Kroah-Hartman {
418ab4382d2SGreg Kroah-Hartman struct vt8500_port *vt8500_port =
419ab4382d2SGreg Kroah-Hartman container_of(port, struct vt8500_port, uart);
420ab4382d2SGreg Kroah-Hartman return vt8500_port->name;
421ab4382d2SGreg Kroah-Hartman }
422ab4382d2SGreg Kroah-Hartman
vt8500_release_port(struct uart_port * port)423ab4382d2SGreg Kroah-Hartman static void vt8500_release_port(struct uart_port *port)
424ab4382d2SGreg Kroah-Hartman {
425ab4382d2SGreg Kroah-Hartman }
426ab4382d2SGreg Kroah-Hartman
vt8500_request_port(struct uart_port * port)427ab4382d2SGreg Kroah-Hartman static int vt8500_request_port(struct uart_port *port)
428ab4382d2SGreg Kroah-Hartman {
429ab4382d2SGreg Kroah-Hartman return 0;
430ab4382d2SGreg Kroah-Hartman }
431ab4382d2SGreg Kroah-Hartman
vt8500_config_port(struct uart_port * port,int flags)432ab4382d2SGreg Kroah-Hartman static void vt8500_config_port(struct uart_port *port, int flags)
433ab4382d2SGreg Kroah-Hartman {
434ab4382d2SGreg Kroah-Hartman port->type = PORT_VT8500;
435ab4382d2SGreg Kroah-Hartman }
436ab4382d2SGreg Kroah-Hartman
vt8500_verify_port(struct uart_port * port,struct serial_struct * ser)437ab4382d2SGreg Kroah-Hartman static int vt8500_verify_port(struct uart_port *port,
438ab4382d2SGreg Kroah-Hartman struct serial_struct *ser)
439ab4382d2SGreg Kroah-Hartman {
440ab4382d2SGreg Kroah-Hartman if (unlikely(ser->type != PORT_UNKNOWN && ser->type != PORT_VT8500))
441ab4382d2SGreg Kroah-Hartman return -EINVAL;
442ab4382d2SGreg Kroah-Hartman if (unlikely(port->irq != ser->irq))
443ab4382d2SGreg Kroah-Hartman return -EINVAL;
444ab4382d2SGreg Kroah-Hartman return 0;
445ab4382d2SGreg Kroah-Hartman }
446ab4382d2SGreg Kroah-Hartman
4474001130dSTony Prisk static struct vt8500_port *vt8500_uart_ports[VT8500_MAX_PORTS];
448ab4382d2SGreg Kroah-Hartman static struct uart_driver vt8500_uart_driver;
449ab4382d2SGreg Kroah-Hartman
450ab4382d2SGreg Kroah-Hartman #ifdef CONFIG_SERIAL_VT8500_CONSOLE
451ab4382d2SGreg Kroah-Hartman
wait_for_xmitr(struct uart_port * port)452eba3b47bSDenys Vlasenko static void wait_for_xmitr(struct uart_port *port)
453ab4382d2SGreg Kroah-Hartman {
454ab4382d2SGreg Kroah-Hartman unsigned int status, tmout = 10000;
455ab4382d2SGreg Kroah-Hartman
456ab4382d2SGreg Kroah-Hartman /* Wait up to 10ms for the character(s) to be sent. */
457ab4382d2SGreg Kroah-Hartman do {
458ab4382d2SGreg Kroah-Hartman status = vt8500_read(port, VT8500_URFIDX);
459ab4382d2SGreg Kroah-Hartman
460ab4382d2SGreg Kroah-Hartman if (--tmout == 0)
461ab4382d2SGreg Kroah-Hartman break;
462ab4382d2SGreg Kroah-Hartman udelay(1);
463ab4382d2SGreg Kroah-Hartman } while (status & 0x10);
464ab4382d2SGreg Kroah-Hartman }
465ab4382d2SGreg Kroah-Hartman
vt8500_console_putchar(struct uart_port * port,unsigned char c)4663f8bab17SJiri Slaby static void vt8500_console_putchar(struct uart_port *port, unsigned char c)
467ab4382d2SGreg Kroah-Hartman {
468ab4382d2SGreg Kroah-Hartman wait_for_xmitr(port);
469ab4382d2SGreg Kroah-Hartman writeb(c, port->membase + VT8500_TXFIFO);
470ab4382d2SGreg Kroah-Hartman }
471ab4382d2SGreg Kroah-Hartman
vt8500_console_write(struct console * co,const char * s,unsigned int count)472ab4382d2SGreg Kroah-Hartman static void vt8500_console_write(struct console *co, const char *s,
473ab4382d2SGreg Kroah-Hartman unsigned int count)
474ab4382d2SGreg Kroah-Hartman {
475ab4382d2SGreg Kroah-Hartman struct vt8500_port *vt8500_port = vt8500_uart_ports[co->index];
476ab4382d2SGreg Kroah-Hartman unsigned long ier;
477ab4382d2SGreg Kroah-Hartman
478ab4382d2SGreg Kroah-Hartman BUG_ON(co->index < 0 || co->index >= vt8500_uart_driver.nr);
479ab4382d2SGreg Kroah-Hartman
480ab4382d2SGreg Kroah-Hartman ier = vt8500_read(&vt8500_port->uart, VT8500_URIER);
481ab4382d2SGreg Kroah-Hartman vt8500_write(&vt8500_port->uart, VT8500_URIER, 0);
482ab4382d2SGreg Kroah-Hartman
483ab4382d2SGreg Kroah-Hartman uart_console_write(&vt8500_port->uart, s, count,
484ab4382d2SGreg Kroah-Hartman vt8500_console_putchar);
485ab4382d2SGreg Kroah-Hartman
486ab4382d2SGreg Kroah-Hartman /*
487ab4382d2SGreg Kroah-Hartman * Finally, wait for transmitter to become empty
488ab4382d2SGreg Kroah-Hartman * and switch back to FIFO
489ab4382d2SGreg Kroah-Hartman */
490ab4382d2SGreg Kroah-Hartman wait_for_xmitr(&vt8500_port->uart);
491ab4382d2SGreg Kroah-Hartman vt8500_write(&vt8500_port->uart, VT8500_URIER, ier);
492ab4382d2SGreg Kroah-Hartman }
493ab4382d2SGreg Kroah-Hartman
vt8500_console_setup(struct console * co,char * options)494ab4382d2SGreg Kroah-Hartman static int __init vt8500_console_setup(struct console *co, char *options)
495ab4382d2SGreg Kroah-Hartman {
496ab4382d2SGreg Kroah-Hartman struct vt8500_port *vt8500_port;
497ab4382d2SGreg Kroah-Hartman int baud = 9600;
498ab4382d2SGreg Kroah-Hartman int bits = 8;
499ab4382d2SGreg Kroah-Hartman int parity = 'n';
500ab4382d2SGreg Kroah-Hartman int flow = 'n';
501ab4382d2SGreg Kroah-Hartman
502ab4382d2SGreg Kroah-Hartman if (unlikely(co->index >= vt8500_uart_driver.nr || co->index < 0))
503ab4382d2SGreg Kroah-Hartman return -ENXIO;
504ab4382d2SGreg Kroah-Hartman
505ab4382d2SGreg Kroah-Hartman vt8500_port = vt8500_uart_ports[co->index];
506ab4382d2SGreg Kroah-Hartman
507ab4382d2SGreg Kroah-Hartman if (!vt8500_port)
508ab4382d2SGreg Kroah-Hartman return -ENODEV;
509ab4382d2SGreg Kroah-Hartman
510ab4382d2SGreg Kroah-Hartman if (options)
511ab4382d2SGreg Kroah-Hartman uart_parse_options(options, &baud, &parity, &bits, &flow);
512ab4382d2SGreg Kroah-Hartman
513ab4382d2SGreg Kroah-Hartman return uart_set_options(&vt8500_port->uart,
514ab4382d2SGreg Kroah-Hartman co, baud, parity, bits, flow);
515ab4382d2SGreg Kroah-Hartman }
516ab4382d2SGreg Kroah-Hartman
517ab4382d2SGreg Kroah-Hartman static struct console vt8500_console = {
518ab4382d2SGreg Kroah-Hartman .name = "ttyWMT",
519ab4382d2SGreg Kroah-Hartman .write = vt8500_console_write,
520ab4382d2SGreg Kroah-Hartman .device = uart_console_device,
521ab4382d2SGreg Kroah-Hartman .setup = vt8500_console_setup,
522ab4382d2SGreg Kroah-Hartman .flags = CON_PRINTBUFFER,
523ab4382d2SGreg Kroah-Hartman .index = -1,
524ab4382d2SGreg Kroah-Hartman .data = &vt8500_uart_driver,
525ab4382d2SGreg Kroah-Hartman };
526ab4382d2SGreg Kroah-Hartman
527ab4382d2SGreg Kroah-Hartman #define VT8500_CONSOLE (&vt8500_console)
528ab4382d2SGreg Kroah-Hartman
529ab4382d2SGreg Kroah-Hartman #else
530ab4382d2SGreg Kroah-Hartman #define VT8500_CONSOLE NULL
531ab4382d2SGreg Kroah-Hartman #endif
532ab4382d2SGreg Kroah-Hartman
5331db894ecSAlexey Charkov #ifdef CONFIG_CONSOLE_POLL
vt8500_get_poll_char(struct uart_port * port)5341db894ecSAlexey Charkov static int vt8500_get_poll_char(struct uart_port *port)
5351db894ecSAlexey Charkov {
5361db894ecSAlexey Charkov unsigned int status = vt8500_read(port, VT8500_URFIDX);
5371db894ecSAlexey Charkov
5381db894ecSAlexey Charkov if (!(status & 0x1f00))
5391db894ecSAlexey Charkov return NO_POLL_CHAR;
5401db894ecSAlexey Charkov
5411db894ecSAlexey Charkov return vt8500_read(port, VT8500_RXFIFO) & 0xff;
5421db894ecSAlexey Charkov }
5431db894ecSAlexey Charkov
vt8500_put_poll_char(struct uart_port * port,unsigned char c)5441db894ecSAlexey Charkov static void vt8500_put_poll_char(struct uart_port *port, unsigned char c)
5451db894ecSAlexey Charkov {
5461db894ecSAlexey Charkov unsigned int status, tmout = 10000;
5471db894ecSAlexey Charkov
5481db894ecSAlexey Charkov do {
5491db894ecSAlexey Charkov status = vt8500_read(port, VT8500_URFIDX);
5501db894ecSAlexey Charkov
5511db894ecSAlexey Charkov if (--tmout == 0)
5521db894ecSAlexey Charkov break;
5531db894ecSAlexey Charkov udelay(1);
5541db894ecSAlexey Charkov } while (status & 0x10);
5551db894ecSAlexey Charkov
5561db894ecSAlexey Charkov vt8500_write(port, c, VT8500_TXFIFO);
5571db894ecSAlexey Charkov }
5581db894ecSAlexey Charkov #endif
5591db894ecSAlexey Charkov
5602331e068SBhumika Goyal static const struct uart_ops vt8500_uart_pops = {
561ab4382d2SGreg Kroah-Hartman .tx_empty = vt8500_tx_empty,
562ab4382d2SGreg Kroah-Hartman .set_mctrl = vt8500_set_mctrl,
563ab4382d2SGreg Kroah-Hartman .get_mctrl = vt8500_get_mctrl,
564ab4382d2SGreg Kroah-Hartman .stop_tx = vt8500_stop_tx,
565ab4382d2SGreg Kroah-Hartman .start_tx = vt8500_start_tx,
566ab4382d2SGreg Kroah-Hartman .stop_rx = vt8500_stop_rx,
567ab4382d2SGreg Kroah-Hartman .enable_ms = vt8500_enable_ms,
568ab4382d2SGreg Kroah-Hartman .break_ctl = vt8500_break_ctl,
569ab4382d2SGreg Kroah-Hartman .startup = vt8500_startup,
570ab4382d2SGreg Kroah-Hartman .shutdown = vt8500_shutdown,
571ab4382d2SGreg Kroah-Hartman .set_termios = vt8500_set_termios,
572ab4382d2SGreg Kroah-Hartman .type = vt8500_type,
573ab4382d2SGreg Kroah-Hartman .release_port = vt8500_release_port,
574ab4382d2SGreg Kroah-Hartman .request_port = vt8500_request_port,
575ab4382d2SGreg Kroah-Hartman .config_port = vt8500_config_port,
576ab4382d2SGreg Kroah-Hartman .verify_port = vt8500_verify_port,
5771db894ecSAlexey Charkov #ifdef CONFIG_CONSOLE_POLL
5781db894ecSAlexey Charkov .poll_get_char = vt8500_get_poll_char,
5791db894ecSAlexey Charkov .poll_put_char = vt8500_put_poll_char,
5801db894ecSAlexey Charkov #endif
581ab4382d2SGreg Kroah-Hartman };
582ab4382d2SGreg Kroah-Hartman
583ab4382d2SGreg Kroah-Hartman static struct uart_driver vt8500_uart_driver = {
584ab4382d2SGreg Kroah-Hartman .owner = THIS_MODULE,
585ab4382d2SGreg Kroah-Hartman .driver_name = "vt8500_serial",
586ab4382d2SGreg Kroah-Hartman .dev_name = "ttyWMT",
587ab4382d2SGreg Kroah-Hartman .nr = 6,
588ab4382d2SGreg Kroah-Hartman .cons = VT8500_CONSOLE,
589ab4382d2SGreg Kroah-Hartman };
590ab4382d2SGreg Kroah-Hartman
591ae382735SAlexey Charkov static unsigned int vt8500_flags; /* none required so far */
592ae382735SAlexey Charkov static unsigned int wm8880_flags = VT8500_HAS_SWRTSCTS_SWITCH;
593ae382735SAlexey Charkov
594ae382735SAlexey Charkov static const struct of_device_id wmt_dt_ids[] = {
595ae382735SAlexey Charkov { .compatible = "via,vt8500-uart", .data = &vt8500_flags},
596ae382735SAlexey Charkov { .compatible = "wm,wm8880-uart", .data = &wm8880_flags},
597ae382735SAlexey Charkov {}
598ae382735SAlexey Charkov };
599ae382735SAlexey Charkov
vt8500_serial_probe(struct platform_device * pdev)6009671f099SBill Pemberton static int vt8500_serial_probe(struct platform_device *pdev)
601ab4382d2SGreg Kroah-Hartman {
602ab4382d2SGreg Kroah-Hartman struct vt8500_port *vt8500_port;
603f63f1ddbSLad Prabhakar struct resource *mmres;
6044001130dSTony Prisk struct device_node *np = pdev->dev.of_node;
605ae382735SAlexey Charkov const unsigned int *flags;
606ab4382d2SGreg Kroah-Hartman int ret;
6074001130dSTony Prisk int port;
608f63f1ddbSLad Prabhakar int irq;
609ab4382d2SGreg Kroah-Hartman
61074d2fb7eSTang Bin flags = of_device_get_match_data(&pdev->dev);
61174d2fb7eSTang Bin if (!flags)
612ae382735SAlexey Charkov return -EINVAL;
613ae382735SAlexey Charkov
614f63f1ddbSLad Prabhakar irq = platform_get_irq(pdev, 0);
615f63f1ddbSLad Prabhakar if (irq < 0)
616f63f1ddbSLad Prabhakar return irq;
617f63f1ddbSLad Prabhakar
618d969de8dSRoel Kluin if (np) {
6194001130dSTony Prisk port = of_alias_get_id(np, "serial");
62027dd2e04STony Prisk if (port >= VT8500_MAX_PORTS)
6214001130dSTony Prisk port = -1;
622d969de8dSRoel Kluin } else {
6234001130dSTony Prisk port = -1;
624d969de8dSRoel Kluin }
6254001130dSTony Prisk
6264001130dSTony Prisk if (port < 0) {
6274001130dSTony Prisk /* calculate the port id */
6280b1221a3SChristophe JAILLET port = find_first_zero_bit(vt8500_ports_in_use,
6290b1221a3SChristophe JAILLET VT8500_MAX_PORTS);
6304001130dSTony Prisk }
6314001130dSTony Prisk
63227dd2e04STony Prisk if (port >= VT8500_MAX_PORTS)
6334001130dSTony Prisk return -ENODEV;
6344001130dSTony Prisk
6354001130dSTony Prisk /* reserve the port id */
6360b1221a3SChristophe JAILLET if (test_and_set_bit(port, vt8500_ports_in_use)) {
6374001130dSTony Prisk /* port already in use - shouldn't really happen */
6384001130dSTony Prisk return -EBUSY;
6394001130dSTony Prisk }
6404001130dSTony Prisk
64149abd90cSTony Prisk vt8500_port = devm_kzalloc(&pdev->dev, sizeof(struct vt8500_port),
64249abd90cSTony Prisk GFP_KERNEL);
64359c2e855SWei Yongjun if (!vt8500_port)
64459c2e855SWei Yongjun return -ENOMEM;
64559c2e855SWei Yongjun
646*0548688dSYangtao Li vt8500_port->uart.membase = devm_platform_get_and_ioremap_resource(pdev, 0, &mmres);
64782b23132SSachin Kamat if (IS_ERR(vt8500_port->uart.membase))
64882b23132SSachin Kamat return PTR_ERR(vt8500_port->uart.membase);
64912faa35aSTony Prisk
65012faa35aSTony Prisk vt8500_port->clk = of_clk_get(pdev->dev.of_node, 0);
65112faa35aSTony Prisk if (IS_ERR(vt8500_port->clk)) {
65212faa35aSTony Prisk dev_err(&pdev->dev, "failed to get clock\n");
65349abd90cSTony Prisk return -EINVAL;
65412faa35aSTony Prisk }
65512faa35aSTony Prisk
65612faa35aSTony Prisk ret = clk_prepare_enable(vt8500_port->clk);
65712faa35aSTony Prisk if (ret) {
65812faa35aSTony Prisk dev_err(&pdev->dev, "failed to enable clock\n");
65949abd90cSTony Prisk return ret;
66012faa35aSTony Prisk }
66112faa35aSTony Prisk
662ae382735SAlexey Charkov vt8500_port->vt8500_uart_flags = *flags;
6635aa387c1SAlexey Charkov vt8500_port->clk_predivisor = DIV_ROUND_CLOSEST(
6645aa387c1SAlexey Charkov clk_get_rate(vt8500_port->clk),
6655aa387c1SAlexey Charkov VT8500_RECOMMENDED_CLK
6665aa387c1SAlexey Charkov );
667ab4382d2SGreg Kroah-Hartman vt8500_port->uart.type = PORT_VT8500;
668ab4382d2SGreg Kroah-Hartman vt8500_port->uart.iotype = UPIO_MEM;
669ab4382d2SGreg Kroah-Hartman vt8500_port->uart.mapbase = mmres->start;
670f63f1ddbSLad Prabhakar vt8500_port->uart.irq = irq;
671ab4382d2SGreg Kroah-Hartman vt8500_port->uart.fifosize = 16;
672ab4382d2SGreg Kroah-Hartman vt8500_port->uart.ops = &vt8500_uart_pops;
6734001130dSTony Prisk vt8500_port->uart.line = port;
674ab4382d2SGreg Kroah-Hartman vt8500_port->uart.dev = &pdev->dev;
675ab4382d2SGreg Kroah-Hartman vt8500_port->uart.flags = UPF_IOREMAP | UPF_BOOT_AUTOCONF;
6766e021166SDmitry Safonov vt8500_port->uart.has_sysrq = IS_ENABLED(CONFIG_SERIAL_VT8500_CONSOLE);
6774001130dSTony Prisk
6785aa387c1SAlexey Charkov /* Serial core uses the magic "16" everywhere - adjust for it */
6795aa387c1SAlexey Charkov vt8500_port->uart.uartclk = 16 * clk_get_rate(vt8500_port->clk) /
6805aa387c1SAlexey Charkov vt8500_port->clk_predivisor /
6815aa387c1SAlexey Charkov VT8500_OVERSAMPLING_DIVISOR;
682ab4382d2SGreg Kroah-Hartman
683ab4382d2SGreg Kroah-Hartman snprintf(vt8500_port->name, sizeof(vt8500_port->name),
684ab4382d2SGreg Kroah-Hartman "VT8500 UART%d", pdev->id);
685ab4382d2SGreg Kroah-Hartman
6864001130dSTony Prisk vt8500_uart_ports[port] = vt8500_port;
687ab4382d2SGreg Kroah-Hartman
688ab4382d2SGreg Kroah-Hartman uart_add_one_port(&vt8500_uart_driver, &vt8500_port->uart);
689ab4382d2SGreg Kroah-Hartman
690ab4382d2SGreg Kroah-Hartman platform_set_drvdata(pdev, vt8500_port);
691ab4382d2SGreg Kroah-Hartman
692ab4382d2SGreg Kroah-Hartman return 0;
693ab4382d2SGreg Kroah-Hartman }
694ab4382d2SGreg Kroah-Hartman
695ab4382d2SGreg Kroah-Hartman static struct platform_driver vt8500_platform_driver = {
696ab4382d2SGreg Kroah-Hartman .probe = vt8500_serial_probe,
697ab4382d2SGreg Kroah-Hartman .driver = {
698ab4382d2SGreg Kroah-Hartman .name = "vt8500_serial",
69986c346deSSachin Kamat .of_match_table = wmt_dt_ids,
70003ba5d51SPaul Gortmaker .suppress_bind_attrs = true,
701ab4382d2SGreg Kroah-Hartman },
702ab4382d2SGreg Kroah-Hartman };
703ab4382d2SGreg Kroah-Hartman
vt8500_serial_init(void)704ab4382d2SGreg Kroah-Hartman static int __init vt8500_serial_init(void)
705ab4382d2SGreg Kroah-Hartman {
706ab4382d2SGreg Kroah-Hartman int ret;
707ab4382d2SGreg Kroah-Hartman
708ab4382d2SGreg Kroah-Hartman ret = uart_register_driver(&vt8500_uart_driver);
709ab4382d2SGreg Kroah-Hartman if (unlikely(ret))
710ab4382d2SGreg Kroah-Hartman return ret;
711ab4382d2SGreg Kroah-Hartman
712ab4382d2SGreg Kroah-Hartman ret = platform_driver_register(&vt8500_platform_driver);
713ab4382d2SGreg Kroah-Hartman
714ab4382d2SGreg Kroah-Hartman if (unlikely(ret))
715ab4382d2SGreg Kroah-Hartman uart_unregister_driver(&vt8500_uart_driver);
716ab4382d2SGreg Kroah-Hartman
717ab4382d2SGreg Kroah-Hartman return ret;
718ab4382d2SGreg Kroah-Hartman }
71903ba5d51SPaul Gortmaker device_initcall(vt8500_serial_init);
720