xref: /OK3568_Linux_fs/kernel/drivers/tty/serial/rda-uart.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0+
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * RDA8810PL serial device driver
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright RDA Microelectronics Company Limited
6*4882a593Smuzhiyun  * Copyright (c) 2017 Andreas Färber
7*4882a593Smuzhiyun  * Copyright (c) 2018 Manivannan Sadhasivam
8*4882a593Smuzhiyun  */
9*4882a593Smuzhiyun 
10*4882a593Smuzhiyun #include <linux/clk.h>
11*4882a593Smuzhiyun #include <linux/console.h>
12*4882a593Smuzhiyun #include <linux/delay.h>
13*4882a593Smuzhiyun #include <linux/io.h>
14*4882a593Smuzhiyun #include <linux/module.h>
15*4882a593Smuzhiyun #include <linux/of.h>
16*4882a593Smuzhiyun #include <linux/platform_device.h>
17*4882a593Smuzhiyun #include <linux/serial.h>
18*4882a593Smuzhiyun #include <linux/serial_core.h>
19*4882a593Smuzhiyun #include <linux/tty.h>
20*4882a593Smuzhiyun #include <linux/tty_flip.h>
21*4882a593Smuzhiyun 
22*4882a593Smuzhiyun #define RDA_UART_PORT_NUM 3
23*4882a593Smuzhiyun #define RDA_UART_DEV_NAME "ttyRDA"
24*4882a593Smuzhiyun 
25*4882a593Smuzhiyun #define RDA_UART_CTRL		0x00
26*4882a593Smuzhiyun #define RDA_UART_STATUS		0x04
27*4882a593Smuzhiyun #define RDA_UART_RXTX_BUFFER	0x08
28*4882a593Smuzhiyun #define RDA_UART_IRQ_MASK	0x0c
29*4882a593Smuzhiyun #define RDA_UART_IRQ_CAUSE	0x10
30*4882a593Smuzhiyun #define RDA_UART_IRQ_TRIGGERS	0x14
31*4882a593Smuzhiyun #define RDA_UART_CMD_SET	0x18
32*4882a593Smuzhiyun #define RDA_UART_CMD_CLR	0x1c
33*4882a593Smuzhiyun 
34*4882a593Smuzhiyun /* UART_CTRL Bits */
35*4882a593Smuzhiyun #define RDA_UART_ENABLE			BIT(0)
36*4882a593Smuzhiyun #define RDA_UART_DBITS_8		BIT(1)
37*4882a593Smuzhiyun #define RDA_UART_TX_SBITS_2		BIT(2)
38*4882a593Smuzhiyun #define RDA_UART_PARITY_EN		BIT(3)
39*4882a593Smuzhiyun #define RDA_UART_PARITY(x)		(((x) & 0x3) << 4)
40*4882a593Smuzhiyun #define RDA_UART_PARITY_ODD		RDA_UART_PARITY(0)
41*4882a593Smuzhiyun #define RDA_UART_PARITY_EVEN		RDA_UART_PARITY(1)
42*4882a593Smuzhiyun #define RDA_UART_PARITY_SPACE		RDA_UART_PARITY(2)
43*4882a593Smuzhiyun #define RDA_UART_PARITY_MARK		RDA_UART_PARITY(3)
44*4882a593Smuzhiyun #define RDA_UART_DIV_MODE		BIT(20)
45*4882a593Smuzhiyun #define RDA_UART_IRDA_EN		BIT(21)
46*4882a593Smuzhiyun #define RDA_UART_DMA_EN			BIT(22)
47*4882a593Smuzhiyun #define RDA_UART_FLOW_CNT_EN		BIT(23)
48*4882a593Smuzhiyun #define RDA_UART_LOOP_BACK_EN		BIT(24)
49*4882a593Smuzhiyun #define RDA_UART_RX_LOCK_ERR		BIT(25)
50*4882a593Smuzhiyun #define RDA_UART_RX_BREAK_LEN(x)	(((x) & 0xf) << 28)
51*4882a593Smuzhiyun 
52*4882a593Smuzhiyun /* UART_STATUS Bits */
53*4882a593Smuzhiyun #define RDA_UART_RX_FIFO(x)		(((x) & 0x7f) << 0)
54*4882a593Smuzhiyun #define RDA_UART_RX_FIFO_MASK		(0x7f << 0)
55*4882a593Smuzhiyun #define RDA_UART_TX_FIFO(x)		(((x) & 0x1f) << 8)
56*4882a593Smuzhiyun #define RDA_UART_TX_FIFO_MASK		(0x1f << 8)
57*4882a593Smuzhiyun #define RDA_UART_TX_ACTIVE		BIT(14)
58*4882a593Smuzhiyun #define RDA_UART_RX_ACTIVE		BIT(15)
59*4882a593Smuzhiyun #define RDA_UART_RX_OVERFLOW_ERR	BIT(16)
60*4882a593Smuzhiyun #define RDA_UART_TX_OVERFLOW_ERR	BIT(17)
61*4882a593Smuzhiyun #define RDA_UART_RX_PARITY_ERR		BIT(18)
62*4882a593Smuzhiyun #define RDA_UART_RX_FRAMING_ERR		BIT(19)
63*4882a593Smuzhiyun #define RDA_UART_RX_BREAK_INT		BIT(20)
64*4882a593Smuzhiyun #define RDA_UART_DCTS			BIT(24)
65*4882a593Smuzhiyun #define RDA_UART_CTS			BIT(25)
66*4882a593Smuzhiyun #define RDA_UART_DTR			BIT(28)
67*4882a593Smuzhiyun #define RDA_UART_CLK_ENABLED		BIT(31)
68*4882a593Smuzhiyun 
69*4882a593Smuzhiyun /* UART_RXTX_BUFFER Bits */
70*4882a593Smuzhiyun #define RDA_UART_RX_DATA(x)		(((x) & 0xff) << 0)
71*4882a593Smuzhiyun #define RDA_UART_TX_DATA(x)		(((x) & 0xff) << 0)
72*4882a593Smuzhiyun 
73*4882a593Smuzhiyun /* UART_IRQ_MASK Bits */
74*4882a593Smuzhiyun #define RDA_UART_TX_MODEM_STATUS	BIT(0)
75*4882a593Smuzhiyun #define RDA_UART_RX_DATA_AVAILABLE	BIT(1)
76*4882a593Smuzhiyun #define RDA_UART_TX_DATA_NEEDED		BIT(2)
77*4882a593Smuzhiyun #define RDA_UART_RX_TIMEOUT		BIT(3)
78*4882a593Smuzhiyun #define RDA_UART_RX_LINE_ERR		BIT(4)
79*4882a593Smuzhiyun #define RDA_UART_TX_DMA_DONE		BIT(5)
80*4882a593Smuzhiyun #define RDA_UART_RX_DMA_DONE		BIT(6)
81*4882a593Smuzhiyun #define RDA_UART_RX_DMA_TIMEOUT		BIT(7)
82*4882a593Smuzhiyun #define RDA_UART_DTR_RISE		BIT(8)
83*4882a593Smuzhiyun #define RDA_UART_DTR_FALL		BIT(9)
84*4882a593Smuzhiyun 
85*4882a593Smuzhiyun /* UART_IRQ_CAUSE Bits */
86*4882a593Smuzhiyun #define RDA_UART_TX_MODEM_STATUS_U	BIT(16)
87*4882a593Smuzhiyun #define RDA_UART_RX_DATA_AVAILABLE_U	BIT(17)
88*4882a593Smuzhiyun #define RDA_UART_TX_DATA_NEEDED_U	BIT(18)
89*4882a593Smuzhiyun #define RDA_UART_RX_TIMEOUT_U		BIT(19)
90*4882a593Smuzhiyun #define RDA_UART_RX_LINE_ERR_U		BIT(20)
91*4882a593Smuzhiyun #define RDA_UART_TX_DMA_DONE_U		BIT(21)
92*4882a593Smuzhiyun #define RDA_UART_RX_DMA_DONE_U		BIT(22)
93*4882a593Smuzhiyun #define RDA_UART_RX_DMA_TIMEOUT_U	BIT(23)
94*4882a593Smuzhiyun #define RDA_UART_DTR_RISE_U		BIT(24)
95*4882a593Smuzhiyun #define RDA_UART_DTR_FALL_U		BIT(25)
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun /* UART_TRIGGERS Bits */
98*4882a593Smuzhiyun #define RDA_UART_RX_TRIGGER(x)		(((x) & 0x1f) << 0)
99*4882a593Smuzhiyun #define RDA_UART_TX_TRIGGER(x)		(((x) & 0xf) << 8)
100*4882a593Smuzhiyun #define RDA_UART_AFC_LEVEL(x)		(((x) & 0x1f) << 16)
101*4882a593Smuzhiyun 
102*4882a593Smuzhiyun /* UART_CMD_SET Bits */
103*4882a593Smuzhiyun #define RDA_UART_RI			BIT(0)
104*4882a593Smuzhiyun #define RDA_UART_DCD			BIT(1)
105*4882a593Smuzhiyun #define RDA_UART_DSR			BIT(2)
106*4882a593Smuzhiyun #define RDA_UART_TX_BREAK_CONTROL	BIT(3)
107*4882a593Smuzhiyun #define RDA_UART_TX_FINISH_N_WAIT	BIT(4)
108*4882a593Smuzhiyun #define RDA_UART_RTS			BIT(5)
109*4882a593Smuzhiyun #define RDA_UART_RX_FIFO_RESET		BIT(6)
110*4882a593Smuzhiyun #define RDA_UART_TX_FIFO_RESET		BIT(7)
111*4882a593Smuzhiyun 
112*4882a593Smuzhiyun #define RDA_UART_TX_FIFO_SIZE	16
113*4882a593Smuzhiyun 
114*4882a593Smuzhiyun static struct uart_driver rda_uart_driver;
115*4882a593Smuzhiyun 
116*4882a593Smuzhiyun struct rda_uart_port {
117*4882a593Smuzhiyun 	struct uart_port port;
118*4882a593Smuzhiyun 	struct clk *clk;
119*4882a593Smuzhiyun };
120*4882a593Smuzhiyun 
121*4882a593Smuzhiyun #define to_rda_uart_port(port) container_of(port, struct rda_uart_port, port)
122*4882a593Smuzhiyun 
123*4882a593Smuzhiyun static struct rda_uart_port *rda_uart_ports[RDA_UART_PORT_NUM];
124*4882a593Smuzhiyun 
rda_uart_write(struct uart_port * port,u32 val,unsigned int off)125*4882a593Smuzhiyun static inline void rda_uart_write(struct uart_port *port, u32 val,
126*4882a593Smuzhiyun 				  unsigned int off)
127*4882a593Smuzhiyun {
128*4882a593Smuzhiyun 	writel(val, port->membase + off);
129*4882a593Smuzhiyun }
130*4882a593Smuzhiyun 
rda_uart_read(struct uart_port * port,unsigned int off)131*4882a593Smuzhiyun static inline u32 rda_uart_read(struct uart_port *port, unsigned int off)
132*4882a593Smuzhiyun {
133*4882a593Smuzhiyun 	return readl(port->membase + off);
134*4882a593Smuzhiyun }
135*4882a593Smuzhiyun 
rda_uart_tx_empty(struct uart_port * port)136*4882a593Smuzhiyun static unsigned int rda_uart_tx_empty(struct uart_port *port)
137*4882a593Smuzhiyun {
138*4882a593Smuzhiyun 	unsigned long flags;
139*4882a593Smuzhiyun 	unsigned int ret;
140*4882a593Smuzhiyun 	u32 val;
141*4882a593Smuzhiyun 
142*4882a593Smuzhiyun 	spin_lock_irqsave(&port->lock, flags);
143*4882a593Smuzhiyun 
144*4882a593Smuzhiyun 	val = rda_uart_read(port, RDA_UART_STATUS);
145*4882a593Smuzhiyun 	ret = (val & RDA_UART_TX_FIFO_MASK) ? TIOCSER_TEMT : 0;
146*4882a593Smuzhiyun 
147*4882a593Smuzhiyun 	spin_unlock_irqrestore(&port->lock, flags);
148*4882a593Smuzhiyun 
149*4882a593Smuzhiyun 	return ret;
150*4882a593Smuzhiyun }
151*4882a593Smuzhiyun 
rda_uart_get_mctrl(struct uart_port * port)152*4882a593Smuzhiyun static unsigned int rda_uart_get_mctrl(struct uart_port *port)
153*4882a593Smuzhiyun {
154*4882a593Smuzhiyun 	unsigned int mctrl = 0;
155*4882a593Smuzhiyun 	u32 cmd_set, status;
156*4882a593Smuzhiyun 
157*4882a593Smuzhiyun 	cmd_set = rda_uart_read(port, RDA_UART_CMD_SET);
158*4882a593Smuzhiyun 	status = rda_uart_read(port, RDA_UART_STATUS);
159*4882a593Smuzhiyun 	if (cmd_set & RDA_UART_RTS)
160*4882a593Smuzhiyun 		mctrl |= TIOCM_RTS;
161*4882a593Smuzhiyun 	if (!(status & RDA_UART_CTS))
162*4882a593Smuzhiyun 		mctrl |= TIOCM_CTS;
163*4882a593Smuzhiyun 
164*4882a593Smuzhiyun 	return mctrl;
165*4882a593Smuzhiyun }
166*4882a593Smuzhiyun 
rda_uart_set_mctrl(struct uart_port * port,unsigned int mctrl)167*4882a593Smuzhiyun static void rda_uart_set_mctrl(struct uart_port *port, unsigned int mctrl)
168*4882a593Smuzhiyun {
169*4882a593Smuzhiyun 	u32 val;
170*4882a593Smuzhiyun 
171*4882a593Smuzhiyun 	if (mctrl & TIOCM_RTS) {
172*4882a593Smuzhiyun 		val = rda_uart_read(port, RDA_UART_CMD_SET);
173*4882a593Smuzhiyun 		rda_uart_write(port, (val | RDA_UART_RTS), RDA_UART_CMD_SET);
174*4882a593Smuzhiyun 	} else {
175*4882a593Smuzhiyun 		/* Clear RTS to stop to receive. */
176*4882a593Smuzhiyun 		val = rda_uart_read(port, RDA_UART_CMD_CLR);
177*4882a593Smuzhiyun 		rda_uart_write(port, (val | RDA_UART_RTS), RDA_UART_CMD_CLR);
178*4882a593Smuzhiyun 	}
179*4882a593Smuzhiyun 
180*4882a593Smuzhiyun 	val = rda_uart_read(port, RDA_UART_CTRL);
181*4882a593Smuzhiyun 
182*4882a593Smuzhiyun 	if (mctrl & TIOCM_LOOP)
183*4882a593Smuzhiyun 		val |= RDA_UART_LOOP_BACK_EN;
184*4882a593Smuzhiyun 	else
185*4882a593Smuzhiyun 		val &= ~RDA_UART_LOOP_BACK_EN;
186*4882a593Smuzhiyun 
187*4882a593Smuzhiyun 	rda_uart_write(port, val, RDA_UART_CTRL);
188*4882a593Smuzhiyun }
189*4882a593Smuzhiyun 
rda_uart_stop_tx(struct uart_port * port)190*4882a593Smuzhiyun static void rda_uart_stop_tx(struct uart_port *port)
191*4882a593Smuzhiyun {
192*4882a593Smuzhiyun 	u32 val;
193*4882a593Smuzhiyun 
194*4882a593Smuzhiyun 	val = rda_uart_read(port, RDA_UART_IRQ_MASK);
195*4882a593Smuzhiyun 	val &= ~RDA_UART_TX_DATA_NEEDED;
196*4882a593Smuzhiyun 	rda_uart_write(port, val, RDA_UART_IRQ_MASK);
197*4882a593Smuzhiyun 
198*4882a593Smuzhiyun 	val = rda_uart_read(port, RDA_UART_CMD_SET);
199*4882a593Smuzhiyun 	val |= RDA_UART_TX_FIFO_RESET;
200*4882a593Smuzhiyun 	rda_uart_write(port, val, RDA_UART_CMD_SET);
201*4882a593Smuzhiyun }
202*4882a593Smuzhiyun 
rda_uart_stop_rx(struct uart_port * port)203*4882a593Smuzhiyun static void rda_uart_stop_rx(struct uart_port *port)
204*4882a593Smuzhiyun {
205*4882a593Smuzhiyun 	u32 val;
206*4882a593Smuzhiyun 
207*4882a593Smuzhiyun 	val = rda_uart_read(port, RDA_UART_IRQ_MASK);
208*4882a593Smuzhiyun 	val &= ~(RDA_UART_RX_DATA_AVAILABLE | RDA_UART_RX_TIMEOUT);
209*4882a593Smuzhiyun 	rda_uart_write(port, val, RDA_UART_IRQ_MASK);
210*4882a593Smuzhiyun 
211*4882a593Smuzhiyun 	/* Read Rx buffer before reset to avoid Rx timeout interrupt */
212*4882a593Smuzhiyun 	val = rda_uart_read(port, RDA_UART_RXTX_BUFFER);
213*4882a593Smuzhiyun 
214*4882a593Smuzhiyun 	val = rda_uart_read(port, RDA_UART_CMD_SET);
215*4882a593Smuzhiyun 	val |= RDA_UART_RX_FIFO_RESET;
216*4882a593Smuzhiyun 	rda_uart_write(port, val, RDA_UART_CMD_SET);
217*4882a593Smuzhiyun }
218*4882a593Smuzhiyun 
rda_uart_start_tx(struct uart_port * port)219*4882a593Smuzhiyun static void rda_uart_start_tx(struct uart_port *port)
220*4882a593Smuzhiyun {
221*4882a593Smuzhiyun 	u32 val;
222*4882a593Smuzhiyun 
223*4882a593Smuzhiyun 	if (uart_tx_stopped(port)) {
224*4882a593Smuzhiyun 		rda_uart_stop_tx(port);
225*4882a593Smuzhiyun 		return;
226*4882a593Smuzhiyun 	}
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun 	val = rda_uart_read(port, RDA_UART_IRQ_MASK);
229*4882a593Smuzhiyun 	val |= RDA_UART_TX_DATA_NEEDED;
230*4882a593Smuzhiyun 	rda_uart_write(port, val, RDA_UART_IRQ_MASK);
231*4882a593Smuzhiyun }
232*4882a593Smuzhiyun 
rda_uart_change_baudrate(struct rda_uart_port * rda_port,unsigned long baud)233*4882a593Smuzhiyun static void rda_uart_change_baudrate(struct rda_uart_port *rda_port,
234*4882a593Smuzhiyun 				     unsigned long baud)
235*4882a593Smuzhiyun {
236*4882a593Smuzhiyun 	clk_set_rate(rda_port->clk, baud * 8);
237*4882a593Smuzhiyun }
238*4882a593Smuzhiyun 
rda_uart_set_termios(struct uart_port * port,struct ktermios * termios,struct ktermios * old)239*4882a593Smuzhiyun static void rda_uart_set_termios(struct uart_port *port,
240*4882a593Smuzhiyun 				 struct ktermios *termios,
241*4882a593Smuzhiyun 				 struct ktermios *old)
242*4882a593Smuzhiyun {
243*4882a593Smuzhiyun 	struct rda_uart_port *rda_port = to_rda_uart_port(port);
244*4882a593Smuzhiyun 	unsigned long flags;
245*4882a593Smuzhiyun 	unsigned int ctrl, cmd_set, cmd_clr, triggers;
246*4882a593Smuzhiyun 	unsigned int baud;
247*4882a593Smuzhiyun 	u32 irq_mask;
248*4882a593Smuzhiyun 
249*4882a593Smuzhiyun 	spin_lock_irqsave(&port->lock, flags);
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun 	baud = uart_get_baud_rate(port, termios, old, 9600, port->uartclk / 4);
252*4882a593Smuzhiyun 	rda_uart_change_baudrate(rda_port, baud);
253*4882a593Smuzhiyun 
254*4882a593Smuzhiyun 	ctrl = rda_uart_read(port, RDA_UART_CTRL);
255*4882a593Smuzhiyun 	cmd_set = rda_uart_read(port, RDA_UART_CMD_SET);
256*4882a593Smuzhiyun 	cmd_clr = rda_uart_read(port, RDA_UART_CMD_CLR);
257*4882a593Smuzhiyun 
258*4882a593Smuzhiyun 	switch (termios->c_cflag & CSIZE) {
259*4882a593Smuzhiyun 	case CS5:
260*4882a593Smuzhiyun 	case CS6:
261*4882a593Smuzhiyun 		dev_warn(port->dev, "bit size not supported, using 7 bits\n");
262*4882a593Smuzhiyun 		fallthrough;
263*4882a593Smuzhiyun 	case CS7:
264*4882a593Smuzhiyun 		ctrl &= ~RDA_UART_DBITS_8;
265*4882a593Smuzhiyun 		termios->c_cflag &= ~CSIZE;
266*4882a593Smuzhiyun 		termios->c_cflag |= CS7;
267*4882a593Smuzhiyun 		break;
268*4882a593Smuzhiyun 	default:
269*4882a593Smuzhiyun 		ctrl |= RDA_UART_DBITS_8;
270*4882a593Smuzhiyun 		break;
271*4882a593Smuzhiyun 	}
272*4882a593Smuzhiyun 
273*4882a593Smuzhiyun 	/* stop bits */
274*4882a593Smuzhiyun 	if (termios->c_cflag & CSTOPB)
275*4882a593Smuzhiyun 		ctrl |= RDA_UART_TX_SBITS_2;
276*4882a593Smuzhiyun 	else
277*4882a593Smuzhiyun 		ctrl &= ~RDA_UART_TX_SBITS_2;
278*4882a593Smuzhiyun 
279*4882a593Smuzhiyun 	/* parity check */
280*4882a593Smuzhiyun 	if (termios->c_cflag & PARENB) {
281*4882a593Smuzhiyun 		ctrl |= RDA_UART_PARITY_EN;
282*4882a593Smuzhiyun 
283*4882a593Smuzhiyun 		/* Mark or Space parity */
284*4882a593Smuzhiyun 		if (termios->c_cflag & CMSPAR) {
285*4882a593Smuzhiyun 			if (termios->c_cflag & PARODD)
286*4882a593Smuzhiyun 				ctrl |= RDA_UART_PARITY_MARK;
287*4882a593Smuzhiyun 			else
288*4882a593Smuzhiyun 				ctrl |= RDA_UART_PARITY_SPACE;
289*4882a593Smuzhiyun 		} else if (termios->c_cflag & PARODD) {
290*4882a593Smuzhiyun 			ctrl |= RDA_UART_PARITY_ODD;
291*4882a593Smuzhiyun 		} else {
292*4882a593Smuzhiyun 			ctrl |= RDA_UART_PARITY_EVEN;
293*4882a593Smuzhiyun 		}
294*4882a593Smuzhiyun 	} else {
295*4882a593Smuzhiyun 		ctrl &= ~RDA_UART_PARITY_EN;
296*4882a593Smuzhiyun 	}
297*4882a593Smuzhiyun 
298*4882a593Smuzhiyun 	/* Hardware handshake (RTS/CTS) */
299*4882a593Smuzhiyun 	if (termios->c_cflag & CRTSCTS) {
300*4882a593Smuzhiyun 		ctrl   |= RDA_UART_FLOW_CNT_EN;
301*4882a593Smuzhiyun 		cmd_set |= RDA_UART_RTS;
302*4882a593Smuzhiyun 	} else {
303*4882a593Smuzhiyun 		ctrl   &= ~RDA_UART_FLOW_CNT_EN;
304*4882a593Smuzhiyun 		cmd_clr |= RDA_UART_RTS;
305*4882a593Smuzhiyun 	}
306*4882a593Smuzhiyun 
307*4882a593Smuzhiyun 	ctrl |= RDA_UART_ENABLE;
308*4882a593Smuzhiyun 	ctrl &= ~RDA_UART_DMA_EN;
309*4882a593Smuzhiyun 
310*4882a593Smuzhiyun 	triggers  = (RDA_UART_AFC_LEVEL(20) | RDA_UART_RX_TRIGGER(16));
311*4882a593Smuzhiyun 	irq_mask = rda_uart_read(port, RDA_UART_IRQ_MASK);
312*4882a593Smuzhiyun 	rda_uart_write(port, 0, RDA_UART_IRQ_MASK);
313*4882a593Smuzhiyun 
314*4882a593Smuzhiyun 	rda_uart_write(port, triggers, RDA_UART_IRQ_TRIGGERS);
315*4882a593Smuzhiyun 	rda_uart_write(port, ctrl, RDA_UART_CTRL);
316*4882a593Smuzhiyun 	rda_uart_write(port, cmd_set, RDA_UART_CMD_SET);
317*4882a593Smuzhiyun 	rda_uart_write(port, cmd_clr, RDA_UART_CMD_CLR);
318*4882a593Smuzhiyun 
319*4882a593Smuzhiyun 	rda_uart_write(port, irq_mask, RDA_UART_IRQ_MASK);
320*4882a593Smuzhiyun 
321*4882a593Smuzhiyun 	/* Don't rewrite B0 */
322*4882a593Smuzhiyun 	if (tty_termios_baud_rate(termios))
323*4882a593Smuzhiyun 		tty_termios_encode_baud_rate(termios, baud, baud);
324*4882a593Smuzhiyun 
325*4882a593Smuzhiyun 	/* update the per-port timeout */
326*4882a593Smuzhiyun 	uart_update_timeout(port, termios->c_cflag, baud);
327*4882a593Smuzhiyun 
328*4882a593Smuzhiyun 	spin_unlock_irqrestore(&port->lock, flags);
329*4882a593Smuzhiyun }
330*4882a593Smuzhiyun 
rda_uart_send_chars(struct uart_port * port)331*4882a593Smuzhiyun static void rda_uart_send_chars(struct uart_port *port)
332*4882a593Smuzhiyun {
333*4882a593Smuzhiyun 	struct circ_buf *xmit = &port->state->xmit;
334*4882a593Smuzhiyun 	unsigned int ch;
335*4882a593Smuzhiyun 	u32 val;
336*4882a593Smuzhiyun 
337*4882a593Smuzhiyun 	if (uart_tx_stopped(port))
338*4882a593Smuzhiyun 		return;
339*4882a593Smuzhiyun 
340*4882a593Smuzhiyun 	if (port->x_char) {
341*4882a593Smuzhiyun 		while (!(rda_uart_read(port, RDA_UART_STATUS) &
342*4882a593Smuzhiyun 			 RDA_UART_TX_FIFO_MASK))
343*4882a593Smuzhiyun 			cpu_relax();
344*4882a593Smuzhiyun 
345*4882a593Smuzhiyun 		rda_uart_write(port, port->x_char, RDA_UART_RXTX_BUFFER);
346*4882a593Smuzhiyun 		port->icount.tx++;
347*4882a593Smuzhiyun 		port->x_char = 0;
348*4882a593Smuzhiyun 	}
349*4882a593Smuzhiyun 
350*4882a593Smuzhiyun 	while (rda_uart_read(port, RDA_UART_STATUS) & RDA_UART_TX_FIFO_MASK) {
351*4882a593Smuzhiyun 		if (uart_circ_empty(xmit))
352*4882a593Smuzhiyun 			break;
353*4882a593Smuzhiyun 
354*4882a593Smuzhiyun 		ch = xmit->buf[xmit->tail];
355*4882a593Smuzhiyun 		rda_uart_write(port, ch, RDA_UART_RXTX_BUFFER);
356*4882a593Smuzhiyun 		xmit->tail = (xmit->tail + 1) & (SERIAL_XMIT_SIZE - 1);
357*4882a593Smuzhiyun 		port->icount.tx++;
358*4882a593Smuzhiyun 	}
359*4882a593Smuzhiyun 
360*4882a593Smuzhiyun 	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
361*4882a593Smuzhiyun 		uart_write_wakeup(port);
362*4882a593Smuzhiyun 
363*4882a593Smuzhiyun 	if (!uart_circ_empty(xmit)) {
364*4882a593Smuzhiyun 		/* Re-enable Tx FIFO interrupt */
365*4882a593Smuzhiyun 		val = rda_uart_read(port, RDA_UART_IRQ_MASK);
366*4882a593Smuzhiyun 		val |= RDA_UART_TX_DATA_NEEDED;
367*4882a593Smuzhiyun 		rda_uart_write(port, val, RDA_UART_IRQ_MASK);
368*4882a593Smuzhiyun 	}
369*4882a593Smuzhiyun }
370*4882a593Smuzhiyun 
rda_uart_receive_chars(struct uart_port * port)371*4882a593Smuzhiyun static void rda_uart_receive_chars(struct uart_port *port)
372*4882a593Smuzhiyun {
373*4882a593Smuzhiyun 	u32 status, val;
374*4882a593Smuzhiyun 
375*4882a593Smuzhiyun 	status = rda_uart_read(port, RDA_UART_STATUS);
376*4882a593Smuzhiyun 	while ((status & RDA_UART_RX_FIFO_MASK)) {
377*4882a593Smuzhiyun 		char flag = TTY_NORMAL;
378*4882a593Smuzhiyun 
379*4882a593Smuzhiyun 		if (status & RDA_UART_RX_PARITY_ERR) {
380*4882a593Smuzhiyun 			port->icount.parity++;
381*4882a593Smuzhiyun 			flag = TTY_PARITY;
382*4882a593Smuzhiyun 		}
383*4882a593Smuzhiyun 
384*4882a593Smuzhiyun 		if (status & RDA_UART_RX_FRAMING_ERR) {
385*4882a593Smuzhiyun 			port->icount.frame++;
386*4882a593Smuzhiyun 			flag = TTY_FRAME;
387*4882a593Smuzhiyun 		}
388*4882a593Smuzhiyun 
389*4882a593Smuzhiyun 		if (status & RDA_UART_RX_OVERFLOW_ERR) {
390*4882a593Smuzhiyun 			port->icount.overrun++;
391*4882a593Smuzhiyun 			flag = TTY_OVERRUN;
392*4882a593Smuzhiyun 		}
393*4882a593Smuzhiyun 
394*4882a593Smuzhiyun 		val = rda_uart_read(port, RDA_UART_RXTX_BUFFER);
395*4882a593Smuzhiyun 		val &= 0xff;
396*4882a593Smuzhiyun 
397*4882a593Smuzhiyun 		port->icount.rx++;
398*4882a593Smuzhiyun 		tty_insert_flip_char(&port->state->port, val, flag);
399*4882a593Smuzhiyun 
400*4882a593Smuzhiyun 		status = rda_uart_read(port, RDA_UART_STATUS);
401*4882a593Smuzhiyun 	}
402*4882a593Smuzhiyun 
403*4882a593Smuzhiyun 	spin_unlock(&port->lock);
404*4882a593Smuzhiyun 	tty_flip_buffer_push(&port->state->port);
405*4882a593Smuzhiyun 	spin_lock(&port->lock);
406*4882a593Smuzhiyun }
407*4882a593Smuzhiyun 
rda_interrupt(int irq,void * dev_id)408*4882a593Smuzhiyun static irqreturn_t rda_interrupt(int irq, void *dev_id)
409*4882a593Smuzhiyun {
410*4882a593Smuzhiyun 	struct uart_port *port = dev_id;
411*4882a593Smuzhiyun 	unsigned long flags;
412*4882a593Smuzhiyun 	u32 val, irq_mask;
413*4882a593Smuzhiyun 
414*4882a593Smuzhiyun 	spin_lock_irqsave(&port->lock, flags);
415*4882a593Smuzhiyun 
416*4882a593Smuzhiyun 	/* Clear IRQ cause */
417*4882a593Smuzhiyun 	val = rda_uart_read(port, RDA_UART_IRQ_CAUSE);
418*4882a593Smuzhiyun 	rda_uart_write(port, val, RDA_UART_IRQ_CAUSE);
419*4882a593Smuzhiyun 
420*4882a593Smuzhiyun 	if (val & (RDA_UART_RX_DATA_AVAILABLE | RDA_UART_RX_TIMEOUT))
421*4882a593Smuzhiyun 		rda_uart_receive_chars(port);
422*4882a593Smuzhiyun 
423*4882a593Smuzhiyun 	if (val & (RDA_UART_TX_DATA_NEEDED)) {
424*4882a593Smuzhiyun 		irq_mask = rda_uart_read(port, RDA_UART_IRQ_MASK);
425*4882a593Smuzhiyun 		irq_mask &= ~RDA_UART_TX_DATA_NEEDED;
426*4882a593Smuzhiyun 		rda_uart_write(port, irq_mask, RDA_UART_IRQ_MASK);
427*4882a593Smuzhiyun 
428*4882a593Smuzhiyun 		rda_uart_send_chars(port);
429*4882a593Smuzhiyun 	}
430*4882a593Smuzhiyun 
431*4882a593Smuzhiyun 	spin_unlock_irqrestore(&port->lock, flags);
432*4882a593Smuzhiyun 
433*4882a593Smuzhiyun 	return IRQ_HANDLED;
434*4882a593Smuzhiyun }
435*4882a593Smuzhiyun 
rda_uart_startup(struct uart_port * port)436*4882a593Smuzhiyun static int rda_uart_startup(struct uart_port *port)
437*4882a593Smuzhiyun {
438*4882a593Smuzhiyun 	unsigned long flags;
439*4882a593Smuzhiyun 	int ret;
440*4882a593Smuzhiyun 	u32 val;
441*4882a593Smuzhiyun 
442*4882a593Smuzhiyun 	spin_lock_irqsave(&port->lock, flags);
443*4882a593Smuzhiyun 	rda_uart_write(port, 0, RDA_UART_IRQ_MASK);
444*4882a593Smuzhiyun 	spin_unlock_irqrestore(&port->lock, flags);
445*4882a593Smuzhiyun 
446*4882a593Smuzhiyun 	ret = request_irq(port->irq, rda_interrupt, IRQF_NO_SUSPEND,
447*4882a593Smuzhiyun 			  "rda-uart", port);
448*4882a593Smuzhiyun 	if (ret)
449*4882a593Smuzhiyun 		return ret;
450*4882a593Smuzhiyun 
451*4882a593Smuzhiyun 	spin_lock_irqsave(&port->lock, flags);
452*4882a593Smuzhiyun 
453*4882a593Smuzhiyun 	val = rda_uart_read(port, RDA_UART_CTRL);
454*4882a593Smuzhiyun 	val |= RDA_UART_ENABLE;
455*4882a593Smuzhiyun 	rda_uart_write(port, val, RDA_UART_CTRL);
456*4882a593Smuzhiyun 
457*4882a593Smuzhiyun 	/* enable rx interrupt */
458*4882a593Smuzhiyun 	val = rda_uart_read(port, RDA_UART_IRQ_MASK);
459*4882a593Smuzhiyun 	val |= (RDA_UART_RX_DATA_AVAILABLE | RDA_UART_RX_TIMEOUT);
460*4882a593Smuzhiyun 	rda_uart_write(port, val, RDA_UART_IRQ_MASK);
461*4882a593Smuzhiyun 
462*4882a593Smuzhiyun 	spin_unlock_irqrestore(&port->lock, flags);
463*4882a593Smuzhiyun 
464*4882a593Smuzhiyun 	return 0;
465*4882a593Smuzhiyun }
466*4882a593Smuzhiyun 
rda_uart_shutdown(struct uart_port * port)467*4882a593Smuzhiyun static void rda_uart_shutdown(struct uart_port *port)
468*4882a593Smuzhiyun {
469*4882a593Smuzhiyun 	unsigned long flags;
470*4882a593Smuzhiyun 	u32 val;
471*4882a593Smuzhiyun 
472*4882a593Smuzhiyun 	spin_lock_irqsave(&port->lock, flags);
473*4882a593Smuzhiyun 
474*4882a593Smuzhiyun 	rda_uart_stop_tx(port);
475*4882a593Smuzhiyun 	rda_uart_stop_rx(port);
476*4882a593Smuzhiyun 
477*4882a593Smuzhiyun 	val = rda_uart_read(port, RDA_UART_CTRL);
478*4882a593Smuzhiyun 	val &= ~RDA_UART_ENABLE;
479*4882a593Smuzhiyun 	rda_uart_write(port, val, RDA_UART_CTRL);
480*4882a593Smuzhiyun 
481*4882a593Smuzhiyun 	spin_unlock_irqrestore(&port->lock, flags);
482*4882a593Smuzhiyun }
483*4882a593Smuzhiyun 
rda_uart_type(struct uart_port * port)484*4882a593Smuzhiyun static const char *rda_uart_type(struct uart_port *port)
485*4882a593Smuzhiyun {
486*4882a593Smuzhiyun 	return (port->type == PORT_RDA) ? "rda-uart" : NULL;
487*4882a593Smuzhiyun }
488*4882a593Smuzhiyun 
rda_uart_request_port(struct uart_port * port)489*4882a593Smuzhiyun static int rda_uart_request_port(struct uart_port *port)
490*4882a593Smuzhiyun {
491*4882a593Smuzhiyun 	struct platform_device *pdev = to_platform_device(port->dev);
492*4882a593Smuzhiyun 	struct resource *res;
493*4882a593Smuzhiyun 
494*4882a593Smuzhiyun 	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
495*4882a593Smuzhiyun 	if (!res)
496*4882a593Smuzhiyun 		return -ENXIO;
497*4882a593Smuzhiyun 
498*4882a593Smuzhiyun 	if (!devm_request_mem_region(port->dev, port->mapbase,
499*4882a593Smuzhiyun 				     resource_size(res), dev_name(port->dev)))
500*4882a593Smuzhiyun 		return -EBUSY;
501*4882a593Smuzhiyun 
502*4882a593Smuzhiyun 	if (port->flags & UPF_IOREMAP) {
503*4882a593Smuzhiyun 		port->membase = devm_ioremap(port->dev, port->mapbase,
504*4882a593Smuzhiyun 						     resource_size(res));
505*4882a593Smuzhiyun 		if (!port->membase)
506*4882a593Smuzhiyun 			return -EBUSY;
507*4882a593Smuzhiyun 	}
508*4882a593Smuzhiyun 
509*4882a593Smuzhiyun 	return 0;
510*4882a593Smuzhiyun }
511*4882a593Smuzhiyun 
rda_uart_config_port(struct uart_port * port,int flags)512*4882a593Smuzhiyun static void rda_uart_config_port(struct uart_port *port, int flags)
513*4882a593Smuzhiyun {
514*4882a593Smuzhiyun 	unsigned long irq_flags;
515*4882a593Smuzhiyun 
516*4882a593Smuzhiyun 	if (flags & UART_CONFIG_TYPE) {
517*4882a593Smuzhiyun 		port->type = PORT_RDA;
518*4882a593Smuzhiyun 		rda_uart_request_port(port);
519*4882a593Smuzhiyun 	}
520*4882a593Smuzhiyun 
521*4882a593Smuzhiyun 	spin_lock_irqsave(&port->lock, irq_flags);
522*4882a593Smuzhiyun 
523*4882a593Smuzhiyun 	/* Clear mask, so no surprise interrupts. */
524*4882a593Smuzhiyun 	rda_uart_write(port, 0, RDA_UART_IRQ_MASK);
525*4882a593Smuzhiyun 
526*4882a593Smuzhiyun 	/* Clear status register */
527*4882a593Smuzhiyun 	rda_uart_write(port, 0, RDA_UART_STATUS);
528*4882a593Smuzhiyun 
529*4882a593Smuzhiyun 	spin_unlock_irqrestore(&port->lock, irq_flags);
530*4882a593Smuzhiyun }
531*4882a593Smuzhiyun 
rda_uart_release_port(struct uart_port * port)532*4882a593Smuzhiyun static void rda_uart_release_port(struct uart_port *port)
533*4882a593Smuzhiyun {
534*4882a593Smuzhiyun 	struct platform_device *pdev = to_platform_device(port->dev);
535*4882a593Smuzhiyun 	struct resource *res;
536*4882a593Smuzhiyun 
537*4882a593Smuzhiyun 	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
538*4882a593Smuzhiyun 	if (!res)
539*4882a593Smuzhiyun 		return;
540*4882a593Smuzhiyun 
541*4882a593Smuzhiyun 	if (port->flags & UPF_IOREMAP) {
542*4882a593Smuzhiyun 		devm_release_mem_region(port->dev, port->mapbase,
543*4882a593Smuzhiyun 					resource_size(res));
544*4882a593Smuzhiyun 		devm_iounmap(port->dev, port->membase);
545*4882a593Smuzhiyun 		port->membase = NULL;
546*4882a593Smuzhiyun 	}
547*4882a593Smuzhiyun }
548*4882a593Smuzhiyun 
rda_uart_verify_port(struct uart_port * port,struct serial_struct * ser)549*4882a593Smuzhiyun static int rda_uart_verify_port(struct uart_port *port,
550*4882a593Smuzhiyun 				struct serial_struct *ser)
551*4882a593Smuzhiyun {
552*4882a593Smuzhiyun 	if (port->type != PORT_RDA)
553*4882a593Smuzhiyun 		return -EINVAL;
554*4882a593Smuzhiyun 
555*4882a593Smuzhiyun 	if (port->irq != ser->irq)
556*4882a593Smuzhiyun 		return -EINVAL;
557*4882a593Smuzhiyun 
558*4882a593Smuzhiyun 	return 0;
559*4882a593Smuzhiyun }
560*4882a593Smuzhiyun 
561*4882a593Smuzhiyun static const struct uart_ops rda_uart_ops = {
562*4882a593Smuzhiyun 	.tx_empty       = rda_uart_tx_empty,
563*4882a593Smuzhiyun 	.get_mctrl      = rda_uart_get_mctrl,
564*4882a593Smuzhiyun 	.set_mctrl      = rda_uart_set_mctrl,
565*4882a593Smuzhiyun 	.start_tx       = rda_uart_start_tx,
566*4882a593Smuzhiyun 	.stop_tx        = rda_uart_stop_tx,
567*4882a593Smuzhiyun 	.stop_rx        = rda_uart_stop_rx,
568*4882a593Smuzhiyun 	.startup        = rda_uart_startup,
569*4882a593Smuzhiyun 	.shutdown       = rda_uart_shutdown,
570*4882a593Smuzhiyun 	.set_termios    = rda_uart_set_termios,
571*4882a593Smuzhiyun 	.type           = rda_uart_type,
572*4882a593Smuzhiyun 	.request_port	= rda_uart_request_port,
573*4882a593Smuzhiyun 	.release_port	= rda_uart_release_port,
574*4882a593Smuzhiyun 	.config_port	= rda_uart_config_port,
575*4882a593Smuzhiyun 	.verify_port	= rda_uart_verify_port,
576*4882a593Smuzhiyun };
577*4882a593Smuzhiyun 
578*4882a593Smuzhiyun #ifdef CONFIG_SERIAL_RDA_CONSOLE
579*4882a593Smuzhiyun 
rda_console_putchar(struct uart_port * port,int ch)580*4882a593Smuzhiyun static void rda_console_putchar(struct uart_port *port, int ch)
581*4882a593Smuzhiyun {
582*4882a593Smuzhiyun 	if (!port->membase)
583*4882a593Smuzhiyun 		return;
584*4882a593Smuzhiyun 
585*4882a593Smuzhiyun 	while (!(rda_uart_read(port, RDA_UART_STATUS) & RDA_UART_TX_FIFO_MASK))
586*4882a593Smuzhiyun 		cpu_relax();
587*4882a593Smuzhiyun 
588*4882a593Smuzhiyun 	rda_uart_write(port, ch, RDA_UART_RXTX_BUFFER);
589*4882a593Smuzhiyun }
590*4882a593Smuzhiyun 
rda_uart_port_write(struct uart_port * port,const char * s,u_int count)591*4882a593Smuzhiyun static void rda_uart_port_write(struct uart_port *port, const char *s,
592*4882a593Smuzhiyun 				u_int count)
593*4882a593Smuzhiyun {
594*4882a593Smuzhiyun 	u32 old_irq_mask;
595*4882a593Smuzhiyun 	unsigned long flags;
596*4882a593Smuzhiyun 	int locked;
597*4882a593Smuzhiyun 
598*4882a593Smuzhiyun 	local_irq_save(flags);
599*4882a593Smuzhiyun 
600*4882a593Smuzhiyun 	if (port->sysrq) {
601*4882a593Smuzhiyun 		locked = 0;
602*4882a593Smuzhiyun 	} else if (oops_in_progress) {
603*4882a593Smuzhiyun 		locked = spin_trylock(&port->lock);
604*4882a593Smuzhiyun 	} else {
605*4882a593Smuzhiyun 		spin_lock(&port->lock);
606*4882a593Smuzhiyun 		locked = 1;
607*4882a593Smuzhiyun 	}
608*4882a593Smuzhiyun 
609*4882a593Smuzhiyun 	old_irq_mask = rda_uart_read(port, RDA_UART_IRQ_MASK);
610*4882a593Smuzhiyun 	rda_uart_write(port, 0, RDA_UART_IRQ_MASK);
611*4882a593Smuzhiyun 
612*4882a593Smuzhiyun 	uart_console_write(port, s, count, rda_console_putchar);
613*4882a593Smuzhiyun 
614*4882a593Smuzhiyun 	/* wait until all contents have been sent out */
615*4882a593Smuzhiyun 	while (!(rda_uart_read(port, RDA_UART_STATUS) & RDA_UART_TX_FIFO_MASK))
616*4882a593Smuzhiyun 		cpu_relax();
617*4882a593Smuzhiyun 
618*4882a593Smuzhiyun 	rda_uart_write(port, old_irq_mask, RDA_UART_IRQ_MASK);
619*4882a593Smuzhiyun 
620*4882a593Smuzhiyun 	if (locked)
621*4882a593Smuzhiyun 		spin_unlock(&port->lock);
622*4882a593Smuzhiyun 
623*4882a593Smuzhiyun 	local_irq_restore(flags);
624*4882a593Smuzhiyun }
625*4882a593Smuzhiyun 
rda_uart_console_write(struct console * co,const char * s,u_int count)626*4882a593Smuzhiyun static void rda_uart_console_write(struct console *co, const char *s,
627*4882a593Smuzhiyun 				   u_int count)
628*4882a593Smuzhiyun {
629*4882a593Smuzhiyun 	struct rda_uart_port *rda_port;
630*4882a593Smuzhiyun 
631*4882a593Smuzhiyun 	rda_port = rda_uart_ports[co->index];
632*4882a593Smuzhiyun 	if (!rda_port)
633*4882a593Smuzhiyun 		return;
634*4882a593Smuzhiyun 
635*4882a593Smuzhiyun 	rda_uart_port_write(&rda_port->port, s, count);
636*4882a593Smuzhiyun }
637*4882a593Smuzhiyun 
rda_uart_console_setup(struct console * co,char * options)638*4882a593Smuzhiyun static int rda_uart_console_setup(struct console *co, char *options)
639*4882a593Smuzhiyun {
640*4882a593Smuzhiyun 	struct rda_uart_port *rda_port;
641*4882a593Smuzhiyun 	int baud = 921600;
642*4882a593Smuzhiyun 	int bits = 8;
643*4882a593Smuzhiyun 	int parity = 'n';
644*4882a593Smuzhiyun 	int flow = 'n';
645*4882a593Smuzhiyun 
646*4882a593Smuzhiyun 	if (co->index < 0 || co->index >= RDA_UART_PORT_NUM)
647*4882a593Smuzhiyun 		return -EINVAL;
648*4882a593Smuzhiyun 
649*4882a593Smuzhiyun 	rda_port = rda_uart_ports[co->index];
650*4882a593Smuzhiyun 	if (!rda_port || !rda_port->port.membase)
651*4882a593Smuzhiyun 		return -ENODEV;
652*4882a593Smuzhiyun 
653*4882a593Smuzhiyun 	if (options)
654*4882a593Smuzhiyun 		uart_parse_options(options, &baud, &parity, &bits, &flow);
655*4882a593Smuzhiyun 
656*4882a593Smuzhiyun 	return uart_set_options(&rda_port->port, co, baud, parity, bits, flow);
657*4882a593Smuzhiyun }
658*4882a593Smuzhiyun 
659*4882a593Smuzhiyun static struct console rda_uart_console = {
660*4882a593Smuzhiyun 	.name = RDA_UART_DEV_NAME,
661*4882a593Smuzhiyun 	.write = rda_uart_console_write,
662*4882a593Smuzhiyun 	.device = uart_console_device,
663*4882a593Smuzhiyun 	.setup = rda_uart_console_setup,
664*4882a593Smuzhiyun 	.flags = CON_PRINTBUFFER,
665*4882a593Smuzhiyun 	.index = -1,
666*4882a593Smuzhiyun 	.data = &rda_uart_driver,
667*4882a593Smuzhiyun };
668*4882a593Smuzhiyun 
rda_uart_console_init(void)669*4882a593Smuzhiyun static int __init rda_uart_console_init(void)
670*4882a593Smuzhiyun {
671*4882a593Smuzhiyun 	register_console(&rda_uart_console);
672*4882a593Smuzhiyun 
673*4882a593Smuzhiyun 	return 0;
674*4882a593Smuzhiyun }
675*4882a593Smuzhiyun console_initcall(rda_uart_console_init);
676*4882a593Smuzhiyun 
rda_uart_early_console_write(struct console * co,const char * s,u_int count)677*4882a593Smuzhiyun static void rda_uart_early_console_write(struct console *co,
678*4882a593Smuzhiyun 					 const char *s,
679*4882a593Smuzhiyun 					 u_int count)
680*4882a593Smuzhiyun {
681*4882a593Smuzhiyun 	struct earlycon_device *dev = co->data;
682*4882a593Smuzhiyun 
683*4882a593Smuzhiyun 	rda_uart_port_write(&dev->port, s, count);
684*4882a593Smuzhiyun }
685*4882a593Smuzhiyun 
686*4882a593Smuzhiyun static int __init
rda_uart_early_console_setup(struct earlycon_device * device,const char * opt)687*4882a593Smuzhiyun rda_uart_early_console_setup(struct earlycon_device *device, const char *opt)
688*4882a593Smuzhiyun {
689*4882a593Smuzhiyun 	if (!device->port.membase)
690*4882a593Smuzhiyun 		return -ENODEV;
691*4882a593Smuzhiyun 
692*4882a593Smuzhiyun 	device->con->write = rda_uart_early_console_write;
693*4882a593Smuzhiyun 
694*4882a593Smuzhiyun 	return 0;
695*4882a593Smuzhiyun }
696*4882a593Smuzhiyun 
697*4882a593Smuzhiyun OF_EARLYCON_DECLARE(rda, "rda,8810pl-uart",
698*4882a593Smuzhiyun 		    rda_uart_early_console_setup);
699*4882a593Smuzhiyun 
700*4882a593Smuzhiyun #define RDA_UART_CONSOLE (&rda_uart_console)
701*4882a593Smuzhiyun #else
702*4882a593Smuzhiyun #define RDA_UART_CONSOLE NULL
703*4882a593Smuzhiyun #endif /* CONFIG_SERIAL_RDA_CONSOLE */
704*4882a593Smuzhiyun 
705*4882a593Smuzhiyun static struct uart_driver rda_uart_driver = {
706*4882a593Smuzhiyun 	.owner = THIS_MODULE,
707*4882a593Smuzhiyun 	.driver_name = "rda-uart",
708*4882a593Smuzhiyun 	.dev_name = RDA_UART_DEV_NAME,
709*4882a593Smuzhiyun 	.nr = RDA_UART_PORT_NUM,
710*4882a593Smuzhiyun 	.cons = RDA_UART_CONSOLE,
711*4882a593Smuzhiyun };
712*4882a593Smuzhiyun 
713*4882a593Smuzhiyun static const struct of_device_id rda_uart_dt_matches[] = {
714*4882a593Smuzhiyun 	{ .compatible = "rda,8810pl-uart" },
715*4882a593Smuzhiyun 	{ }
716*4882a593Smuzhiyun };
717*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, rda_uart_dt_matches);
718*4882a593Smuzhiyun 
rda_uart_probe(struct platform_device * pdev)719*4882a593Smuzhiyun static int rda_uart_probe(struct platform_device *pdev)
720*4882a593Smuzhiyun {
721*4882a593Smuzhiyun 	struct resource *res_mem;
722*4882a593Smuzhiyun 	struct rda_uart_port *rda_port;
723*4882a593Smuzhiyun 	int ret, irq;
724*4882a593Smuzhiyun 
725*4882a593Smuzhiyun 	if (pdev->dev.of_node)
726*4882a593Smuzhiyun 		pdev->id = of_alias_get_id(pdev->dev.of_node, "serial");
727*4882a593Smuzhiyun 
728*4882a593Smuzhiyun 	if (pdev->id < 0 || pdev->id >= RDA_UART_PORT_NUM) {
729*4882a593Smuzhiyun 		dev_err(&pdev->dev, "id %d out of range\n", pdev->id);
730*4882a593Smuzhiyun 		return -EINVAL;
731*4882a593Smuzhiyun 	}
732*4882a593Smuzhiyun 
733*4882a593Smuzhiyun 	res_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
734*4882a593Smuzhiyun 	if (!res_mem) {
735*4882a593Smuzhiyun 		dev_err(&pdev->dev, "could not get mem\n");
736*4882a593Smuzhiyun 		return -ENODEV;
737*4882a593Smuzhiyun 	}
738*4882a593Smuzhiyun 
739*4882a593Smuzhiyun 	irq = platform_get_irq(pdev, 0);
740*4882a593Smuzhiyun 	if (irq < 0)
741*4882a593Smuzhiyun 		return irq;
742*4882a593Smuzhiyun 
743*4882a593Smuzhiyun 	if (rda_uart_ports[pdev->id]) {
744*4882a593Smuzhiyun 		dev_err(&pdev->dev, "port %d already allocated\n", pdev->id);
745*4882a593Smuzhiyun 		return -EBUSY;
746*4882a593Smuzhiyun 	}
747*4882a593Smuzhiyun 
748*4882a593Smuzhiyun 	rda_port = devm_kzalloc(&pdev->dev, sizeof(*rda_port), GFP_KERNEL);
749*4882a593Smuzhiyun 	if (!rda_port)
750*4882a593Smuzhiyun 		return -ENOMEM;
751*4882a593Smuzhiyun 
752*4882a593Smuzhiyun 	rda_port->clk = devm_clk_get(&pdev->dev, NULL);
753*4882a593Smuzhiyun 	if (IS_ERR(rda_port->clk)) {
754*4882a593Smuzhiyun 		dev_err(&pdev->dev, "could not get clk\n");
755*4882a593Smuzhiyun 		return PTR_ERR(rda_port->clk);
756*4882a593Smuzhiyun 	}
757*4882a593Smuzhiyun 
758*4882a593Smuzhiyun 	rda_port->port.dev = &pdev->dev;
759*4882a593Smuzhiyun 	rda_port->port.regshift = 0;
760*4882a593Smuzhiyun 	rda_port->port.line = pdev->id;
761*4882a593Smuzhiyun 	rda_port->port.type = PORT_RDA;
762*4882a593Smuzhiyun 	rda_port->port.iotype = UPIO_MEM;
763*4882a593Smuzhiyun 	rda_port->port.mapbase = res_mem->start;
764*4882a593Smuzhiyun 	rda_port->port.irq = irq;
765*4882a593Smuzhiyun 	rda_port->port.uartclk = clk_get_rate(rda_port->clk);
766*4882a593Smuzhiyun 	if (rda_port->port.uartclk == 0) {
767*4882a593Smuzhiyun 		dev_err(&pdev->dev, "clock rate is zero\n");
768*4882a593Smuzhiyun 		return -EINVAL;
769*4882a593Smuzhiyun 	}
770*4882a593Smuzhiyun 	rda_port->port.flags = UPF_BOOT_AUTOCONF | UPF_IOREMAP |
771*4882a593Smuzhiyun 			       UPF_LOW_LATENCY;
772*4882a593Smuzhiyun 	rda_port->port.x_char = 0;
773*4882a593Smuzhiyun 	rda_port->port.fifosize = RDA_UART_TX_FIFO_SIZE;
774*4882a593Smuzhiyun 	rda_port->port.ops = &rda_uart_ops;
775*4882a593Smuzhiyun 
776*4882a593Smuzhiyun 	rda_uart_ports[pdev->id] = rda_port;
777*4882a593Smuzhiyun 	platform_set_drvdata(pdev, rda_port);
778*4882a593Smuzhiyun 
779*4882a593Smuzhiyun 	ret = uart_add_one_port(&rda_uart_driver, &rda_port->port);
780*4882a593Smuzhiyun 	if (ret)
781*4882a593Smuzhiyun 		rda_uart_ports[pdev->id] = NULL;
782*4882a593Smuzhiyun 
783*4882a593Smuzhiyun 	return ret;
784*4882a593Smuzhiyun }
785*4882a593Smuzhiyun 
rda_uart_remove(struct platform_device * pdev)786*4882a593Smuzhiyun static int rda_uart_remove(struct platform_device *pdev)
787*4882a593Smuzhiyun {
788*4882a593Smuzhiyun 	struct rda_uart_port *rda_port = platform_get_drvdata(pdev);
789*4882a593Smuzhiyun 
790*4882a593Smuzhiyun 	uart_remove_one_port(&rda_uart_driver, &rda_port->port);
791*4882a593Smuzhiyun 	rda_uart_ports[pdev->id] = NULL;
792*4882a593Smuzhiyun 
793*4882a593Smuzhiyun 	return 0;
794*4882a593Smuzhiyun }
795*4882a593Smuzhiyun 
796*4882a593Smuzhiyun static struct platform_driver rda_uart_platform_driver = {
797*4882a593Smuzhiyun 	.probe = rda_uart_probe,
798*4882a593Smuzhiyun 	.remove = rda_uart_remove,
799*4882a593Smuzhiyun 	.driver = {
800*4882a593Smuzhiyun 		.name = "rda-uart",
801*4882a593Smuzhiyun 		.of_match_table = rda_uart_dt_matches,
802*4882a593Smuzhiyun 	},
803*4882a593Smuzhiyun };
804*4882a593Smuzhiyun 
rda_uart_init(void)805*4882a593Smuzhiyun static int __init rda_uart_init(void)
806*4882a593Smuzhiyun {
807*4882a593Smuzhiyun 	int ret;
808*4882a593Smuzhiyun 
809*4882a593Smuzhiyun 	ret = uart_register_driver(&rda_uart_driver);
810*4882a593Smuzhiyun 	if (ret)
811*4882a593Smuzhiyun 		return ret;
812*4882a593Smuzhiyun 
813*4882a593Smuzhiyun 	ret = platform_driver_register(&rda_uart_platform_driver);
814*4882a593Smuzhiyun 	if (ret)
815*4882a593Smuzhiyun 		uart_unregister_driver(&rda_uart_driver);
816*4882a593Smuzhiyun 
817*4882a593Smuzhiyun 	return ret;
818*4882a593Smuzhiyun }
819*4882a593Smuzhiyun 
rda_uart_exit(void)820*4882a593Smuzhiyun static void __exit rda_uart_exit(void)
821*4882a593Smuzhiyun {
822*4882a593Smuzhiyun 	platform_driver_unregister(&rda_uart_platform_driver);
823*4882a593Smuzhiyun 	uart_unregister_driver(&rda_uart_driver);
824*4882a593Smuzhiyun }
825*4882a593Smuzhiyun 
826*4882a593Smuzhiyun module_init(rda_uart_init);
827*4882a593Smuzhiyun module_exit(rda_uart_exit);
828*4882a593Smuzhiyun 
829*4882a593Smuzhiyun MODULE_AUTHOR("Manivannan Sadhasivam <manivannan.sadhasivam@linaro.org>");
830*4882a593Smuzhiyun MODULE_DESCRIPTION("RDA8810PL serial device driver");
831*4882a593Smuzhiyun MODULE_LICENSE("GPL");
832