xref: /OK3568_Linux_fs/kernel/drivers/tty/serial/amba-pl010.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0+
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  *  Driver for AMBA serial ports
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  *  Based on drivers/char/serial.c, by Linus Torvalds, Theodore Ts'o.
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  *  Copyright 1999 ARM Limited
8*4882a593Smuzhiyun  *  Copyright (C) 2000 Deep Blue Solutions Ltd.
9*4882a593Smuzhiyun  *
10*4882a593Smuzhiyun  * This is a generic driver for ARM AMBA-type serial ports.  They
11*4882a593Smuzhiyun  * have a lot of 16550-like features, but are not register compatible.
12*4882a593Smuzhiyun  * Note that although they do have CTS, DCD and DSR inputs, they do
13*4882a593Smuzhiyun  * not have an RI input, nor do they have DTR or RTS outputs.  If
14*4882a593Smuzhiyun  * required, these have to be supplied via some other means (eg, GPIO)
15*4882a593Smuzhiyun  * and hooked into this driver.
16*4882a593Smuzhiyun  */
17*4882a593Smuzhiyun 
18*4882a593Smuzhiyun #include <linux/module.h>
19*4882a593Smuzhiyun #include <linux/ioport.h>
20*4882a593Smuzhiyun #include <linux/init.h>
21*4882a593Smuzhiyun #include <linux/console.h>
22*4882a593Smuzhiyun #include <linux/sysrq.h>
23*4882a593Smuzhiyun #include <linux/device.h>
24*4882a593Smuzhiyun #include <linux/tty.h>
25*4882a593Smuzhiyun #include <linux/tty_flip.h>
26*4882a593Smuzhiyun #include <linux/serial_core.h>
27*4882a593Smuzhiyun #include <linux/serial.h>
28*4882a593Smuzhiyun #include <linux/amba/bus.h>
29*4882a593Smuzhiyun #include <linux/amba/serial.h>
30*4882a593Smuzhiyun #include <linux/clk.h>
31*4882a593Smuzhiyun #include <linux/slab.h>
32*4882a593Smuzhiyun #include <linux/io.h>
33*4882a593Smuzhiyun 
34*4882a593Smuzhiyun #define UART_NR		8
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun #define SERIAL_AMBA_MAJOR	204
37*4882a593Smuzhiyun #define SERIAL_AMBA_MINOR	16
38*4882a593Smuzhiyun #define SERIAL_AMBA_NR		UART_NR
39*4882a593Smuzhiyun 
40*4882a593Smuzhiyun #define AMBA_ISR_PASS_LIMIT	256
41*4882a593Smuzhiyun 
42*4882a593Smuzhiyun #define UART_RX_DATA(s)		(((s) & UART01x_FR_RXFE) == 0)
43*4882a593Smuzhiyun #define UART_TX_READY(s)	(((s) & UART01x_FR_TXFF) == 0)
44*4882a593Smuzhiyun 
45*4882a593Smuzhiyun #define UART_DUMMY_RSR_RX	256
46*4882a593Smuzhiyun #define UART_PORT_SIZE		64
47*4882a593Smuzhiyun 
48*4882a593Smuzhiyun /*
49*4882a593Smuzhiyun  * We wrap our port structure around the generic uart_port.
50*4882a593Smuzhiyun  */
51*4882a593Smuzhiyun struct uart_amba_port {
52*4882a593Smuzhiyun 	struct uart_port	port;
53*4882a593Smuzhiyun 	struct clk		*clk;
54*4882a593Smuzhiyun 	struct amba_device	*dev;
55*4882a593Smuzhiyun 	struct amba_pl010_data	*data;
56*4882a593Smuzhiyun 	unsigned int		old_status;
57*4882a593Smuzhiyun };
58*4882a593Smuzhiyun 
pl010_stop_tx(struct uart_port * port)59*4882a593Smuzhiyun static void pl010_stop_tx(struct uart_port *port)
60*4882a593Smuzhiyun {
61*4882a593Smuzhiyun 	struct uart_amba_port *uap =
62*4882a593Smuzhiyun 		container_of(port, struct uart_amba_port, port);
63*4882a593Smuzhiyun 	unsigned int cr;
64*4882a593Smuzhiyun 
65*4882a593Smuzhiyun 	cr = readb(uap->port.membase + UART010_CR);
66*4882a593Smuzhiyun 	cr &= ~UART010_CR_TIE;
67*4882a593Smuzhiyun 	writel(cr, uap->port.membase + UART010_CR);
68*4882a593Smuzhiyun }
69*4882a593Smuzhiyun 
pl010_start_tx(struct uart_port * port)70*4882a593Smuzhiyun static void pl010_start_tx(struct uart_port *port)
71*4882a593Smuzhiyun {
72*4882a593Smuzhiyun 	struct uart_amba_port *uap =
73*4882a593Smuzhiyun 		container_of(port, struct uart_amba_port, port);
74*4882a593Smuzhiyun 	unsigned int cr;
75*4882a593Smuzhiyun 
76*4882a593Smuzhiyun 	cr = readb(uap->port.membase + UART010_CR);
77*4882a593Smuzhiyun 	cr |= UART010_CR_TIE;
78*4882a593Smuzhiyun 	writel(cr, uap->port.membase + UART010_CR);
79*4882a593Smuzhiyun }
80*4882a593Smuzhiyun 
pl010_stop_rx(struct uart_port * port)81*4882a593Smuzhiyun static void pl010_stop_rx(struct uart_port *port)
82*4882a593Smuzhiyun {
83*4882a593Smuzhiyun 	struct uart_amba_port *uap =
84*4882a593Smuzhiyun 		container_of(port, struct uart_amba_port, port);
85*4882a593Smuzhiyun 	unsigned int cr;
86*4882a593Smuzhiyun 
87*4882a593Smuzhiyun 	cr = readb(uap->port.membase + UART010_CR);
88*4882a593Smuzhiyun 	cr &= ~(UART010_CR_RIE | UART010_CR_RTIE);
89*4882a593Smuzhiyun 	writel(cr, uap->port.membase + UART010_CR);
90*4882a593Smuzhiyun }
91*4882a593Smuzhiyun 
pl010_disable_ms(struct uart_port * port)92*4882a593Smuzhiyun static void pl010_disable_ms(struct uart_port *port)
93*4882a593Smuzhiyun {
94*4882a593Smuzhiyun 	struct uart_amba_port *uap = (struct uart_amba_port *)port;
95*4882a593Smuzhiyun 	unsigned int cr;
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun 	cr = readb(uap->port.membase + UART010_CR);
98*4882a593Smuzhiyun 	cr &= ~UART010_CR_MSIE;
99*4882a593Smuzhiyun 	writel(cr, uap->port.membase + UART010_CR);
100*4882a593Smuzhiyun }
101*4882a593Smuzhiyun 
pl010_enable_ms(struct uart_port * port)102*4882a593Smuzhiyun static void pl010_enable_ms(struct uart_port *port)
103*4882a593Smuzhiyun {
104*4882a593Smuzhiyun 	struct uart_amba_port *uap =
105*4882a593Smuzhiyun 		container_of(port, struct uart_amba_port, port);
106*4882a593Smuzhiyun 	unsigned int cr;
107*4882a593Smuzhiyun 
108*4882a593Smuzhiyun 	cr = readb(uap->port.membase + UART010_CR);
109*4882a593Smuzhiyun 	cr |= UART010_CR_MSIE;
110*4882a593Smuzhiyun 	writel(cr, uap->port.membase + UART010_CR);
111*4882a593Smuzhiyun }
112*4882a593Smuzhiyun 
pl010_rx_chars(struct uart_amba_port * uap)113*4882a593Smuzhiyun static void pl010_rx_chars(struct uart_amba_port *uap)
114*4882a593Smuzhiyun {
115*4882a593Smuzhiyun 	unsigned int status, ch, flag, rsr, max_count = 256;
116*4882a593Smuzhiyun 
117*4882a593Smuzhiyun 	status = readb(uap->port.membase + UART01x_FR);
118*4882a593Smuzhiyun 	while (UART_RX_DATA(status) && max_count--) {
119*4882a593Smuzhiyun 		ch = readb(uap->port.membase + UART01x_DR);
120*4882a593Smuzhiyun 		flag = TTY_NORMAL;
121*4882a593Smuzhiyun 
122*4882a593Smuzhiyun 		uap->port.icount.rx++;
123*4882a593Smuzhiyun 
124*4882a593Smuzhiyun 		/*
125*4882a593Smuzhiyun 		 * Note that the error handling code is
126*4882a593Smuzhiyun 		 * out of the main execution path
127*4882a593Smuzhiyun 		 */
128*4882a593Smuzhiyun 		rsr = readb(uap->port.membase + UART01x_RSR) | UART_DUMMY_RSR_RX;
129*4882a593Smuzhiyun 		if (unlikely(rsr & UART01x_RSR_ANY)) {
130*4882a593Smuzhiyun 			writel(0, uap->port.membase + UART01x_ECR);
131*4882a593Smuzhiyun 
132*4882a593Smuzhiyun 			if (rsr & UART01x_RSR_BE) {
133*4882a593Smuzhiyun 				rsr &= ~(UART01x_RSR_FE | UART01x_RSR_PE);
134*4882a593Smuzhiyun 				uap->port.icount.brk++;
135*4882a593Smuzhiyun 				if (uart_handle_break(&uap->port))
136*4882a593Smuzhiyun 					goto ignore_char;
137*4882a593Smuzhiyun 			} else if (rsr & UART01x_RSR_PE)
138*4882a593Smuzhiyun 				uap->port.icount.parity++;
139*4882a593Smuzhiyun 			else if (rsr & UART01x_RSR_FE)
140*4882a593Smuzhiyun 				uap->port.icount.frame++;
141*4882a593Smuzhiyun 			if (rsr & UART01x_RSR_OE)
142*4882a593Smuzhiyun 				uap->port.icount.overrun++;
143*4882a593Smuzhiyun 
144*4882a593Smuzhiyun 			rsr &= uap->port.read_status_mask;
145*4882a593Smuzhiyun 
146*4882a593Smuzhiyun 			if (rsr & UART01x_RSR_BE)
147*4882a593Smuzhiyun 				flag = TTY_BREAK;
148*4882a593Smuzhiyun 			else if (rsr & UART01x_RSR_PE)
149*4882a593Smuzhiyun 				flag = TTY_PARITY;
150*4882a593Smuzhiyun 			else if (rsr & UART01x_RSR_FE)
151*4882a593Smuzhiyun 				flag = TTY_FRAME;
152*4882a593Smuzhiyun 		}
153*4882a593Smuzhiyun 
154*4882a593Smuzhiyun 		if (uart_handle_sysrq_char(&uap->port, ch))
155*4882a593Smuzhiyun 			goto ignore_char;
156*4882a593Smuzhiyun 
157*4882a593Smuzhiyun 		uart_insert_char(&uap->port, rsr, UART01x_RSR_OE, ch, flag);
158*4882a593Smuzhiyun 
159*4882a593Smuzhiyun 	ignore_char:
160*4882a593Smuzhiyun 		status = readb(uap->port.membase + UART01x_FR);
161*4882a593Smuzhiyun 	}
162*4882a593Smuzhiyun 	spin_unlock(&uap->port.lock);
163*4882a593Smuzhiyun 	tty_flip_buffer_push(&uap->port.state->port);
164*4882a593Smuzhiyun 	spin_lock(&uap->port.lock);
165*4882a593Smuzhiyun }
166*4882a593Smuzhiyun 
pl010_tx_chars(struct uart_amba_port * uap)167*4882a593Smuzhiyun static void pl010_tx_chars(struct uart_amba_port *uap)
168*4882a593Smuzhiyun {
169*4882a593Smuzhiyun 	struct circ_buf *xmit = &uap->port.state->xmit;
170*4882a593Smuzhiyun 	int count;
171*4882a593Smuzhiyun 
172*4882a593Smuzhiyun 	if (uap->port.x_char) {
173*4882a593Smuzhiyun 		writel(uap->port.x_char, uap->port.membase + UART01x_DR);
174*4882a593Smuzhiyun 		uap->port.icount.tx++;
175*4882a593Smuzhiyun 		uap->port.x_char = 0;
176*4882a593Smuzhiyun 		return;
177*4882a593Smuzhiyun 	}
178*4882a593Smuzhiyun 	if (uart_circ_empty(xmit) || uart_tx_stopped(&uap->port)) {
179*4882a593Smuzhiyun 		pl010_stop_tx(&uap->port);
180*4882a593Smuzhiyun 		return;
181*4882a593Smuzhiyun 	}
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun 	count = uap->port.fifosize >> 1;
184*4882a593Smuzhiyun 	do {
185*4882a593Smuzhiyun 		writel(xmit->buf[xmit->tail], uap->port.membase + UART01x_DR);
186*4882a593Smuzhiyun 		xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
187*4882a593Smuzhiyun 		uap->port.icount.tx++;
188*4882a593Smuzhiyun 		if (uart_circ_empty(xmit))
189*4882a593Smuzhiyun 			break;
190*4882a593Smuzhiyun 	} while (--count > 0);
191*4882a593Smuzhiyun 
192*4882a593Smuzhiyun 	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
193*4882a593Smuzhiyun 		uart_write_wakeup(&uap->port);
194*4882a593Smuzhiyun 
195*4882a593Smuzhiyun 	if (uart_circ_empty(xmit))
196*4882a593Smuzhiyun 		pl010_stop_tx(&uap->port);
197*4882a593Smuzhiyun }
198*4882a593Smuzhiyun 
pl010_modem_status(struct uart_amba_port * uap)199*4882a593Smuzhiyun static void pl010_modem_status(struct uart_amba_port *uap)
200*4882a593Smuzhiyun {
201*4882a593Smuzhiyun 	unsigned int status, delta;
202*4882a593Smuzhiyun 
203*4882a593Smuzhiyun 	writel(0, uap->port.membase + UART010_ICR);
204*4882a593Smuzhiyun 
205*4882a593Smuzhiyun 	status = readb(uap->port.membase + UART01x_FR) & UART01x_FR_MODEM_ANY;
206*4882a593Smuzhiyun 
207*4882a593Smuzhiyun 	delta = status ^ uap->old_status;
208*4882a593Smuzhiyun 	uap->old_status = status;
209*4882a593Smuzhiyun 
210*4882a593Smuzhiyun 	if (!delta)
211*4882a593Smuzhiyun 		return;
212*4882a593Smuzhiyun 
213*4882a593Smuzhiyun 	if (delta & UART01x_FR_DCD)
214*4882a593Smuzhiyun 		uart_handle_dcd_change(&uap->port, status & UART01x_FR_DCD);
215*4882a593Smuzhiyun 
216*4882a593Smuzhiyun 	if (delta & UART01x_FR_DSR)
217*4882a593Smuzhiyun 		uap->port.icount.dsr++;
218*4882a593Smuzhiyun 
219*4882a593Smuzhiyun 	if (delta & UART01x_FR_CTS)
220*4882a593Smuzhiyun 		uart_handle_cts_change(&uap->port, status & UART01x_FR_CTS);
221*4882a593Smuzhiyun 
222*4882a593Smuzhiyun 	wake_up_interruptible(&uap->port.state->port.delta_msr_wait);
223*4882a593Smuzhiyun }
224*4882a593Smuzhiyun 
pl010_int(int irq,void * dev_id)225*4882a593Smuzhiyun static irqreturn_t pl010_int(int irq, void *dev_id)
226*4882a593Smuzhiyun {
227*4882a593Smuzhiyun 	struct uart_amba_port *uap = dev_id;
228*4882a593Smuzhiyun 	unsigned int status, pass_counter = AMBA_ISR_PASS_LIMIT;
229*4882a593Smuzhiyun 	int handled = 0;
230*4882a593Smuzhiyun 
231*4882a593Smuzhiyun 	spin_lock(&uap->port.lock);
232*4882a593Smuzhiyun 
233*4882a593Smuzhiyun 	status = readb(uap->port.membase + UART010_IIR);
234*4882a593Smuzhiyun 	if (status) {
235*4882a593Smuzhiyun 		do {
236*4882a593Smuzhiyun 			if (status & (UART010_IIR_RTIS | UART010_IIR_RIS))
237*4882a593Smuzhiyun 				pl010_rx_chars(uap);
238*4882a593Smuzhiyun 			if (status & UART010_IIR_MIS)
239*4882a593Smuzhiyun 				pl010_modem_status(uap);
240*4882a593Smuzhiyun 			if (status & UART010_IIR_TIS)
241*4882a593Smuzhiyun 				pl010_tx_chars(uap);
242*4882a593Smuzhiyun 
243*4882a593Smuzhiyun 			if (pass_counter-- == 0)
244*4882a593Smuzhiyun 				break;
245*4882a593Smuzhiyun 
246*4882a593Smuzhiyun 			status = readb(uap->port.membase + UART010_IIR);
247*4882a593Smuzhiyun 		} while (status & (UART010_IIR_RTIS | UART010_IIR_RIS |
248*4882a593Smuzhiyun 				   UART010_IIR_TIS));
249*4882a593Smuzhiyun 		handled = 1;
250*4882a593Smuzhiyun 	}
251*4882a593Smuzhiyun 
252*4882a593Smuzhiyun 	spin_unlock(&uap->port.lock);
253*4882a593Smuzhiyun 
254*4882a593Smuzhiyun 	return IRQ_RETVAL(handled);
255*4882a593Smuzhiyun }
256*4882a593Smuzhiyun 
pl010_tx_empty(struct uart_port * port)257*4882a593Smuzhiyun static unsigned int pl010_tx_empty(struct uart_port *port)
258*4882a593Smuzhiyun {
259*4882a593Smuzhiyun 	struct uart_amba_port *uap =
260*4882a593Smuzhiyun 		container_of(port, struct uart_amba_port, port);
261*4882a593Smuzhiyun 	unsigned int status = readb(uap->port.membase + UART01x_FR);
262*4882a593Smuzhiyun 	return status & UART01x_FR_BUSY ? 0 : TIOCSER_TEMT;
263*4882a593Smuzhiyun }
264*4882a593Smuzhiyun 
pl010_get_mctrl(struct uart_port * port)265*4882a593Smuzhiyun static unsigned int pl010_get_mctrl(struct uart_port *port)
266*4882a593Smuzhiyun {
267*4882a593Smuzhiyun 	struct uart_amba_port *uap =
268*4882a593Smuzhiyun 		container_of(port, struct uart_amba_port, port);
269*4882a593Smuzhiyun 	unsigned int result = 0;
270*4882a593Smuzhiyun 	unsigned int status;
271*4882a593Smuzhiyun 
272*4882a593Smuzhiyun 	status = readb(uap->port.membase + UART01x_FR);
273*4882a593Smuzhiyun 	if (status & UART01x_FR_DCD)
274*4882a593Smuzhiyun 		result |= TIOCM_CAR;
275*4882a593Smuzhiyun 	if (status & UART01x_FR_DSR)
276*4882a593Smuzhiyun 		result |= TIOCM_DSR;
277*4882a593Smuzhiyun 	if (status & UART01x_FR_CTS)
278*4882a593Smuzhiyun 		result |= TIOCM_CTS;
279*4882a593Smuzhiyun 
280*4882a593Smuzhiyun 	return result;
281*4882a593Smuzhiyun }
282*4882a593Smuzhiyun 
pl010_set_mctrl(struct uart_port * port,unsigned int mctrl)283*4882a593Smuzhiyun static void pl010_set_mctrl(struct uart_port *port, unsigned int mctrl)
284*4882a593Smuzhiyun {
285*4882a593Smuzhiyun 	struct uart_amba_port *uap =
286*4882a593Smuzhiyun 		container_of(port, struct uart_amba_port, port);
287*4882a593Smuzhiyun 
288*4882a593Smuzhiyun 	if (uap->data)
289*4882a593Smuzhiyun 		uap->data->set_mctrl(uap->dev, uap->port.membase, mctrl);
290*4882a593Smuzhiyun }
291*4882a593Smuzhiyun 
pl010_break_ctl(struct uart_port * port,int break_state)292*4882a593Smuzhiyun static void pl010_break_ctl(struct uart_port *port, int break_state)
293*4882a593Smuzhiyun {
294*4882a593Smuzhiyun 	struct uart_amba_port *uap =
295*4882a593Smuzhiyun 		container_of(port, struct uart_amba_port, port);
296*4882a593Smuzhiyun 	unsigned long flags;
297*4882a593Smuzhiyun 	unsigned int lcr_h;
298*4882a593Smuzhiyun 
299*4882a593Smuzhiyun 	spin_lock_irqsave(&uap->port.lock, flags);
300*4882a593Smuzhiyun 	lcr_h = readb(uap->port.membase + UART010_LCRH);
301*4882a593Smuzhiyun 	if (break_state == -1)
302*4882a593Smuzhiyun 		lcr_h |= UART01x_LCRH_BRK;
303*4882a593Smuzhiyun 	else
304*4882a593Smuzhiyun 		lcr_h &= ~UART01x_LCRH_BRK;
305*4882a593Smuzhiyun 	writel(lcr_h, uap->port.membase + UART010_LCRH);
306*4882a593Smuzhiyun 	spin_unlock_irqrestore(&uap->port.lock, flags);
307*4882a593Smuzhiyun }
308*4882a593Smuzhiyun 
pl010_startup(struct uart_port * port)309*4882a593Smuzhiyun static int pl010_startup(struct uart_port *port)
310*4882a593Smuzhiyun {
311*4882a593Smuzhiyun 	struct uart_amba_port *uap =
312*4882a593Smuzhiyun 		container_of(port, struct uart_amba_port, port);
313*4882a593Smuzhiyun 	int retval;
314*4882a593Smuzhiyun 
315*4882a593Smuzhiyun 	/*
316*4882a593Smuzhiyun 	 * Try to enable the clock producer.
317*4882a593Smuzhiyun 	 */
318*4882a593Smuzhiyun 	retval = clk_prepare_enable(uap->clk);
319*4882a593Smuzhiyun 	if (retval)
320*4882a593Smuzhiyun 		goto out;
321*4882a593Smuzhiyun 
322*4882a593Smuzhiyun 	uap->port.uartclk = clk_get_rate(uap->clk);
323*4882a593Smuzhiyun 
324*4882a593Smuzhiyun 	/*
325*4882a593Smuzhiyun 	 * Allocate the IRQ
326*4882a593Smuzhiyun 	 */
327*4882a593Smuzhiyun 	retval = request_irq(uap->port.irq, pl010_int, 0, "uart-pl010", uap);
328*4882a593Smuzhiyun 	if (retval)
329*4882a593Smuzhiyun 		goto clk_dis;
330*4882a593Smuzhiyun 
331*4882a593Smuzhiyun 	/*
332*4882a593Smuzhiyun 	 * initialise the old status of the modem signals
333*4882a593Smuzhiyun 	 */
334*4882a593Smuzhiyun 	uap->old_status = readb(uap->port.membase + UART01x_FR) & UART01x_FR_MODEM_ANY;
335*4882a593Smuzhiyun 
336*4882a593Smuzhiyun 	/*
337*4882a593Smuzhiyun 	 * Finally, enable interrupts
338*4882a593Smuzhiyun 	 */
339*4882a593Smuzhiyun 	writel(UART01x_CR_UARTEN | UART010_CR_RIE | UART010_CR_RTIE,
340*4882a593Smuzhiyun 	       uap->port.membase + UART010_CR);
341*4882a593Smuzhiyun 
342*4882a593Smuzhiyun 	return 0;
343*4882a593Smuzhiyun 
344*4882a593Smuzhiyun  clk_dis:
345*4882a593Smuzhiyun 	clk_disable_unprepare(uap->clk);
346*4882a593Smuzhiyun  out:
347*4882a593Smuzhiyun 	return retval;
348*4882a593Smuzhiyun }
349*4882a593Smuzhiyun 
pl010_shutdown(struct uart_port * port)350*4882a593Smuzhiyun static void pl010_shutdown(struct uart_port *port)
351*4882a593Smuzhiyun {
352*4882a593Smuzhiyun 	struct uart_amba_port *uap =
353*4882a593Smuzhiyun 		container_of(port, struct uart_amba_port, port);
354*4882a593Smuzhiyun 
355*4882a593Smuzhiyun 	/*
356*4882a593Smuzhiyun 	 * Free the interrupt
357*4882a593Smuzhiyun 	 */
358*4882a593Smuzhiyun 	free_irq(uap->port.irq, uap);
359*4882a593Smuzhiyun 
360*4882a593Smuzhiyun 	/*
361*4882a593Smuzhiyun 	 * disable all interrupts, disable the port
362*4882a593Smuzhiyun 	 */
363*4882a593Smuzhiyun 	writel(0, uap->port.membase + UART010_CR);
364*4882a593Smuzhiyun 
365*4882a593Smuzhiyun 	/* disable break condition and fifos */
366*4882a593Smuzhiyun 	writel(readb(uap->port.membase + UART010_LCRH) &
367*4882a593Smuzhiyun 		~(UART01x_LCRH_BRK | UART01x_LCRH_FEN),
368*4882a593Smuzhiyun 	       uap->port.membase + UART010_LCRH);
369*4882a593Smuzhiyun 
370*4882a593Smuzhiyun 	/*
371*4882a593Smuzhiyun 	 * Shut down the clock producer
372*4882a593Smuzhiyun 	 */
373*4882a593Smuzhiyun 	clk_disable_unprepare(uap->clk);
374*4882a593Smuzhiyun }
375*4882a593Smuzhiyun 
376*4882a593Smuzhiyun static void
pl010_set_termios(struct uart_port * port,struct ktermios * termios,struct ktermios * old)377*4882a593Smuzhiyun pl010_set_termios(struct uart_port *port, struct ktermios *termios,
378*4882a593Smuzhiyun 		     struct ktermios *old)
379*4882a593Smuzhiyun {
380*4882a593Smuzhiyun 	struct uart_amba_port *uap =
381*4882a593Smuzhiyun 		container_of(port, struct uart_amba_port, port);
382*4882a593Smuzhiyun 	unsigned int lcr_h, old_cr;
383*4882a593Smuzhiyun 	unsigned long flags;
384*4882a593Smuzhiyun 	unsigned int baud, quot;
385*4882a593Smuzhiyun 
386*4882a593Smuzhiyun 	/*
387*4882a593Smuzhiyun 	 * Ask the core to calculate the divisor for us.
388*4882a593Smuzhiyun 	 */
389*4882a593Smuzhiyun 	baud = uart_get_baud_rate(port, termios, old, 0, uap->port.uartclk/16);
390*4882a593Smuzhiyun 	quot = uart_get_divisor(port, baud);
391*4882a593Smuzhiyun 
392*4882a593Smuzhiyun 	switch (termios->c_cflag & CSIZE) {
393*4882a593Smuzhiyun 	case CS5:
394*4882a593Smuzhiyun 		lcr_h = UART01x_LCRH_WLEN_5;
395*4882a593Smuzhiyun 		break;
396*4882a593Smuzhiyun 	case CS6:
397*4882a593Smuzhiyun 		lcr_h = UART01x_LCRH_WLEN_6;
398*4882a593Smuzhiyun 		break;
399*4882a593Smuzhiyun 	case CS7:
400*4882a593Smuzhiyun 		lcr_h = UART01x_LCRH_WLEN_7;
401*4882a593Smuzhiyun 		break;
402*4882a593Smuzhiyun 	default: // CS8
403*4882a593Smuzhiyun 		lcr_h = UART01x_LCRH_WLEN_8;
404*4882a593Smuzhiyun 		break;
405*4882a593Smuzhiyun 	}
406*4882a593Smuzhiyun 	if (termios->c_cflag & CSTOPB)
407*4882a593Smuzhiyun 		lcr_h |= UART01x_LCRH_STP2;
408*4882a593Smuzhiyun 	if (termios->c_cflag & PARENB) {
409*4882a593Smuzhiyun 		lcr_h |= UART01x_LCRH_PEN;
410*4882a593Smuzhiyun 		if (!(termios->c_cflag & PARODD))
411*4882a593Smuzhiyun 			lcr_h |= UART01x_LCRH_EPS;
412*4882a593Smuzhiyun 	}
413*4882a593Smuzhiyun 	if (uap->port.fifosize > 1)
414*4882a593Smuzhiyun 		lcr_h |= UART01x_LCRH_FEN;
415*4882a593Smuzhiyun 
416*4882a593Smuzhiyun 	spin_lock_irqsave(&uap->port.lock, flags);
417*4882a593Smuzhiyun 
418*4882a593Smuzhiyun 	/*
419*4882a593Smuzhiyun 	 * Update the per-port timeout.
420*4882a593Smuzhiyun 	 */
421*4882a593Smuzhiyun 	uart_update_timeout(port, termios->c_cflag, baud);
422*4882a593Smuzhiyun 
423*4882a593Smuzhiyun 	uap->port.read_status_mask = UART01x_RSR_OE;
424*4882a593Smuzhiyun 	if (termios->c_iflag & INPCK)
425*4882a593Smuzhiyun 		uap->port.read_status_mask |= UART01x_RSR_FE | UART01x_RSR_PE;
426*4882a593Smuzhiyun 	if (termios->c_iflag & (IGNBRK | BRKINT | PARMRK))
427*4882a593Smuzhiyun 		uap->port.read_status_mask |= UART01x_RSR_BE;
428*4882a593Smuzhiyun 
429*4882a593Smuzhiyun 	/*
430*4882a593Smuzhiyun 	 * Characters to ignore
431*4882a593Smuzhiyun 	 */
432*4882a593Smuzhiyun 	uap->port.ignore_status_mask = 0;
433*4882a593Smuzhiyun 	if (termios->c_iflag & IGNPAR)
434*4882a593Smuzhiyun 		uap->port.ignore_status_mask |= UART01x_RSR_FE | UART01x_RSR_PE;
435*4882a593Smuzhiyun 	if (termios->c_iflag & IGNBRK) {
436*4882a593Smuzhiyun 		uap->port.ignore_status_mask |= UART01x_RSR_BE;
437*4882a593Smuzhiyun 		/*
438*4882a593Smuzhiyun 		 * If we're ignoring parity and break indicators,
439*4882a593Smuzhiyun 		 * ignore overruns too (for real raw support).
440*4882a593Smuzhiyun 		 */
441*4882a593Smuzhiyun 		if (termios->c_iflag & IGNPAR)
442*4882a593Smuzhiyun 			uap->port.ignore_status_mask |= UART01x_RSR_OE;
443*4882a593Smuzhiyun 	}
444*4882a593Smuzhiyun 
445*4882a593Smuzhiyun 	/*
446*4882a593Smuzhiyun 	 * Ignore all characters if CREAD is not set.
447*4882a593Smuzhiyun 	 */
448*4882a593Smuzhiyun 	if ((termios->c_cflag & CREAD) == 0)
449*4882a593Smuzhiyun 		uap->port.ignore_status_mask |= UART_DUMMY_RSR_RX;
450*4882a593Smuzhiyun 
451*4882a593Smuzhiyun 	old_cr = readb(uap->port.membase + UART010_CR) & ~UART010_CR_MSIE;
452*4882a593Smuzhiyun 
453*4882a593Smuzhiyun 	if (UART_ENABLE_MS(port, termios->c_cflag))
454*4882a593Smuzhiyun 		old_cr |= UART010_CR_MSIE;
455*4882a593Smuzhiyun 
456*4882a593Smuzhiyun 	/* Set baud rate */
457*4882a593Smuzhiyun 	quot -= 1;
458*4882a593Smuzhiyun 	writel((quot & 0xf00) >> 8, uap->port.membase + UART010_LCRM);
459*4882a593Smuzhiyun 	writel(quot & 0xff, uap->port.membase + UART010_LCRL);
460*4882a593Smuzhiyun 
461*4882a593Smuzhiyun 	/*
462*4882a593Smuzhiyun 	 * ----------v----------v----------v----------v-----
463*4882a593Smuzhiyun 	 * NOTE: MUST BE WRITTEN AFTER UARTLCR_M & UARTLCR_L
464*4882a593Smuzhiyun 	 * ----------^----------^----------^----------^-----
465*4882a593Smuzhiyun 	 */
466*4882a593Smuzhiyun 	writel(lcr_h, uap->port.membase + UART010_LCRH);
467*4882a593Smuzhiyun 	writel(old_cr, uap->port.membase + UART010_CR);
468*4882a593Smuzhiyun 
469*4882a593Smuzhiyun 	spin_unlock_irqrestore(&uap->port.lock, flags);
470*4882a593Smuzhiyun }
471*4882a593Smuzhiyun 
pl010_set_ldisc(struct uart_port * port,struct ktermios * termios)472*4882a593Smuzhiyun static void pl010_set_ldisc(struct uart_port *port, struct ktermios *termios)
473*4882a593Smuzhiyun {
474*4882a593Smuzhiyun 	if (termios->c_line == N_PPS) {
475*4882a593Smuzhiyun 		port->flags |= UPF_HARDPPS_CD;
476*4882a593Smuzhiyun 		spin_lock_irq(&port->lock);
477*4882a593Smuzhiyun 		pl010_enable_ms(port);
478*4882a593Smuzhiyun 		spin_unlock_irq(&port->lock);
479*4882a593Smuzhiyun 	} else {
480*4882a593Smuzhiyun 		port->flags &= ~UPF_HARDPPS_CD;
481*4882a593Smuzhiyun 		if (!UART_ENABLE_MS(port, termios->c_cflag)) {
482*4882a593Smuzhiyun 			spin_lock_irq(&port->lock);
483*4882a593Smuzhiyun 			pl010_disable_ms(port);
484*4882a593Smuzhiyun 			spin_unlock_irq(&port->lock);
485*4882a593Smuzhiyun 		}
486*4882a593Smuzhiyun 	}
487*4882a593Smuzhiyun }
488*4882a593Smuzhiyun 
pl010_type(struct uart_port * port)489*4882a593Smuzhiyun static const char *pl010_type(struct uart_port *port)
490*4882a593Smuzhiyun {
491*4882a593Smuzhiyun 	return port->type == PORT_AMBA ? "AMBA" : NULL;
492*4882a593Smuzhiyun }
493*4882a593Smuzhiyun 
494*4882a593Smuzhiyun /*
495*4882a593Smuzhiyun  * Release the memory region(s) being used by 'port'
496*4882a593Smuzhiyun  */
pl010_release_port(struct uart_port * port)497*4882a593Smuzhiyun static void pl010_release_port(struct uart_port *port)
498*4882a593Smuzhiyun {
499*4882a593Smuzhiyun 	release_mem_region(port->mapbase, UART_PORT_SIZE);
500*4882a593Smuzhiyun }
501*4882a593Smuzhiyun 
502*4882a593Smuzhiyun /*
503*4882a593Smuzhiyun  * Request the memory region(s) being used by 'port'
504*4882a593Smuzhiyun  */
pl010_request_port(struct uart_port * port)505*4882a593Smuzhiyun static int pl010_request_port(struct uart_port *port)
506*4882a593Smuzhiyun {
507*4882a593Smuzhiyun 	return request_mem_region(port->mapbase, UART_PORT_SIZE, "uart-pl010")
508*4882a593Smuzhiyun 			!= NULL ? 0 : -EBUSY;
509*4882a593Smuzhiyun }
510*4882a593Smuzhiyun 
511*4882a593Smuzhiyun /*
512*4882a593Smuzhiyun  * Configure/autoconfigure the port.
513*4882a593Smuzhiyun  */
pl010_config_port(struct uart_port * port,int flags)514*4882a593Smuzhiyun static void pl010_config_port(struct uart_port *port, int flags)
515*4882a593Smuzhiyun {
516*4882a593Smuzhiyun 	if (flags & UART_CONFIG_TYPE) {
517*4882a593Smuzhiyun 		port->type = PORT_AMBA;
518*4882a593Smuzhiyun 		pl010_request_port(port);
519*4882a593Smuzhiyun 	}
520*4882a593Smuzhiyun }
521*4882a593Smuzhiyun 
522*4882a593Smuzhiyun /*
523*4882a593Smuzhiyun  * verify the new serial_struct (for TIOCSSERIAL).
524*4882a593Smuzhiyun  */
pl010_verify_port(struct uart_port * port,struct serial_struct * ser)525*4882a593Smuzhiyun static int pl010_verify_port(struct uart_port *port, struct serial_struct *ser)
526*4882a593Smuzhiyun {
527*4882a593Smuzhiyun 	int ret = 0;
528*4882a593Smuzhiyun 	if (ser->type != PORT_UNKNOWN && ser->type != PORT_AMBA)
529*4882a593Smuzhiyun 		ret = -EINVAL;
530*4882a593Smuzhiyun 	if (ser->irq < 0 || ser->irq >= nr_irqs)
531*4882a593Smuzhiyun 		ret = -EINVAL;
532*4882a593Smuzhiyun 	if (ser->baud_base < 9600)
533*4882a593Smuzhiyun 		ret = -EINVAL;
534*4882a593Smuzhiyun 	return ret;
535*4882a593Smuzhiyun }
536*4882a593Smuzhiyun 
537*4882a593Smuzhiyun static const struct uart_ops amba_pl010_pops = {
538*4882a593Smuzhiyun 	.tx_empty	= pl010_tx_empty,
539*4882a593Smuzhiyun 	.set_mctrl	= pl010_set_mctrl,
540*4882a593Smuzhiyun 	.get_mctrl	= pl010_get_mctrl,
541*4882a593Smuzhiyun 	.stop_tx	= pl010_stop_tx,
542*4882a593Smuzhiyun 	.start_tx	= pl010_start_tx,
543*4882a593Smuzhiyun 	.stop_rx	= pl010_stop_rx,
544*4882a593Smuzhiyun 	.enable_ms	= pl010_enable_ms,
545*4882a593Smuzhiyun 	.break_ctl	= pl010_break_ctl,
546*4882a593Smuzhiyun 	.startup	= pl010_startup,
547*4882a593Smuzhiyun 	.shutdown	= pl010_shutdown,
548*4882a593Smuzhiyun 	.set_termios	= pl010_set_termios,
549*4882a593Smuzhiyun 	.set_ldisc	= pl010_set_ldisc,
550*4882a593Smuzhiyun 	.type		= pl010_type,
551*4882a593Smuzhiyun 	.release_port	= pl010_release_port,
552*4882a593Smuzhiyun 	.request_port	= pl010_request_port,
553*4882a593Smuzhiyun 	.config_port	= pl010_config_port,
554*4882a593Smuzhiyun 	.verify_port	= pl010_verify_port,
555*4882a593Smuzhiyun };
556*4882a593Smuzhiyun 
557*4882a593Smuzhiyun static struct uart_amba_port *amba_ports[UART_NR];
558*4882a593Smuzhiyun 
559*4882a593Smuzhiyun #ifdef CONFIG_SERIAL_AMBA_PL010_CONSOLE
560*4882a593Smuzhiyun 
pl010_console_putchar(struct uart_port * port,int ch)561*4882a593Smuzhiyun static void pl010_console_putchar(struct uart_port *port, int ch)
562*4882a593Smuzhiyun {
563*4882a593Smuzhiyun 	struct uart_amba_port *uap =
564*4882a593Smuzhiyun 		container_of(port, struct uart_amba_port, port);
565*4882a593Smuzhiyun 	unsigned int status;
566*4882a593Smuzhiyun 
567*4882a593Smuzhiyun 	do {
568*4882a593Smuzhiyun 		status = readb(uap->port.membase + UART01x_FR);
569*4882a593Smuzhiyun 		barrier();
570*4882a593Smuzhiyun 	} while (!UART_TX_READY(status));
571*4882a593Smuzhiyun 	writel(ch, uap->port.membase + UART01x_DR);
572*4882a593Smuzhiyun }
573*4882a593Smuzhiyun 
574*4882a593Smuzhiyun static void
pl010_console_write(struct console * co,const char * s,unsigned int count)575*4882a593Smuzhiyun pl010_console_write(struct console *co, const char *s, unsigned int count)
576*4882a593Smuzhiyun {
577*4882a593Smuzhiyun 	struct uart_amba_port *uap = amba_ports[co->index];
578*4882a593Smuzhiyun 	unsigned int status, old_cr;
579*4882a593Smuzhiyun 
580*4882a593Smuzhiyun 	clk_enable(uap->clk);
581*4882a593Smuzhiyun 
582*4882a593Smuzhiyun 	/*
583*4882a593Smuzhiyun 	 *	First save the CR then disable the interrupts
584*4882a593Smuzhiyun 	 */
585*4882a593Smuzhiyun 	old_cr = readb(uap->port.membase + UART010_CR);
586*4882a593Smuzhiyun 	writel(UART01x_CR_UARTEN, uap->port.membase + UART010_CR);
587*4882a593Smuzhiyun 
588*4882a593Smuzhiyun 	uart_console_write(&uap->port, s, count, pl010_console_putchar);
589*4882a593Smuzhiyun 
590*4882a593Smuzhiyun 	/*
591*4882a593Smuzhiyun 	 *	Finally, wait for transmitter to become empty
592*4882a593Smuzhiyun 	 *	and restore the TCR
593*4882a593Smuzhiyun 	 */
594*4882a593Smuzhiyun 	do {
595*4882a593Smuzhiyun 		status = readb(uap->port.membase + UART01x_FR);
596*4882a593Smuzhiyun 		barrier();
597*4882a593Smuzhiyun 	} while (status & UART01x_FR_BUSY);
598*4882a593Smuzhiyun 	writel(old_cr, uap->port.membase + UART010_CR);
599*4882a593Smuzhiyun 
600*4882a593Smuzhiyun 	clk_disable(uap->clk);
601*4882a593Smuzhiyun }
602*4882a593Smuzhiyun 
603*4882a593Smuzhiyun static void __init
pl010_console_get_options(struct uart_amba_port * uap,int * baud,int * parity,int * bits)604*4882a593Smuzhiyun pl010_console_get_options(struct uart_amba_port *uap, int *baud,
605*4882a593Smuzhiyun 			     int *parity, int *bits)
606*4882a593Smuzhiyun {
607*4882a593Smuzhiyun 	if (readb(uap->port.membase + UART010_CR) & UART01x_CR_UARTEN) {
608*4882a593Smuzhiyun 		unsigned int lcr_h, quot;
609*4882a593Smuzhiyun 		lcr_h = readb(uap->port.membase + UART010_LCRH);
610*4882a593Smuzhiyun 
611*4882a593Smuzhiyun 		*parity = 'n';
612*4882a593Smuzhiyun 		if (lcr_h & UART01x_LCRH_PEN) {
613*4882a593Smuzhiyun 			if (lcr_h & UART01x_LCRH_EPS)
614*4882a593Smuzhiyun 				*parity = 'e';
615*4882a593Smuzhiyun 			else
616*4882a593Smuzhiyun 				*parity = 'o';
617*4882a593Smuzhiyun 		}
618*4882a593Smuzhiyun 
619*4882a593Smuzhiyun 		if ((lcr_h & 0x60) == UART01x_LCRH_WLEN_7)
620*4882a593Smuzhiyun 			*bits = 7;
621*4882a593Smuzhiyun 		else
622*4882a593Smuzhiyun 			*bits = 8;
623*4882a593Smuzhiyun 
624*4882a593Smuzhiyun 		quot = readb(uap->port.membase + UART010_LCRL) |
625*4882a593Smuzhiyun 		       readb(uap->port.membase + UART010_LCRM) << 8;
626*4882a593Smuzhiyun 		*baud = uap->port.uartclk / (16 * (quot + 1));
627*4882a593Smuzhiyun 	}
628*4882a593Smuzhiyun }
629*4882a593Smuzhiyun 
pl010_console_setup(struct console * co,char * options)630*4882a593Smuzhiyun static int __init pl010_console_setup(struct console *co, char *options)
631*4882a593Smuzhiyun {
632*4882a593Smuzhiyun 	struct uart_amba_port *uap;
633*4882a593Smuzhiyun 	int baud = 38400;
634*4882a593Smuzhiyun 	int bits = 8;
635*4882a593Smuzhiyun 	int parity = 'n';
636*4882a593Smuzhiyun 	int flow = 'n';
637*4882a593Smuzhiyun 	int ret;
638*4882a593Smuzhiyun 
639*4882a593Smuzhiyun 	/*
640*4882a593Smuzhiyun 	 * Check whether an invalid uart number has been specified, and
641*4882a593Smuzhiyun 	 * if so, search for the first available port that does have
642*4882a593Smuzhiyun 	 * console support.
643*4882a593Smuzhiyun 	 */
644*4882a593Smuzhiyun 	if (co->index >= UART_NR)
645*4882a593Smuzhiyun 		co->index = 0;
646*4882a593Smuzhiyun 	uap = amba_ports[co->index];
647*4882a593Smuzhiyun 	if (!uap)
648*4882a593Smuzhiyun 		return -ENODEV;
649*4882a593Smuzhiyun 
650*4882a593Smuzhiyun 	ret = clk_prepare(uap->clk);
651*4882a593Smuzhiyun 	if (ret)
652*4882a593Smuzhiyun 		return ret;
653*4882a593Smuzhiyun 
654*4882a593Smuzhiyun 	uap->port.uartclk = clk_get_rate(uap->clk);
655*4882a593Smuzhiyun 
656*4882a593Smuzhiyun 	if (options)
657*4882a593Smuzhiyun 		uart_parse_options(options, &baud, &parity, &bits, &flow);
658*4882a593Smuzhiyun 	else
659*4882a593Smuzhiyun 		pl010_console_get_options(uap, &baud, &parity, &bits);
660*4882a593Smuzhiyun 
661*4882a593Smuzhiyun 	return uart_set_options(&uap->port, co, baud, parity, bits, flow);
662*4882a593Smuzhiyun }
663*4882a593Smuzhiyun 
664*4882a593Smuzhiyun static struct uart_driver amba_reg;
665*4882a593Smuzhiyun static struct console amba_console = {
666*4882a593Smuzhiyun 	.name		= "ttyAM",
667*4882a593Smuzhiyun 	.write		= pl010_console_write,
668*4882a593Smuzhiyun 	.device		= uart_console_device,
669*4882a593Smuzhiyun 	.setup		= pl010_console_setup,
670*4882a593Smuzhiyun 	.flags		= CON_PRINTBUFFER,
671*4882a593Smuzhiyun 	.index		= -1,
672*4882a593Smuzhiyun 	.data		= &amba_reg,
673*4882a593Smuzhiyun };
674*4882a593Smuzhiyun 
675*4882a593Smuzhiyun #define AMBA_CONSOLE	&amba_console
676*4882a593Smuzhiyun #else
677*4882a593Smuzhiyun #define AMBA_CONSOLE	NULL
678*4882a593Smuzhiyun #endif
679*4882a593Smuzhiyun 
680*4882a593Smuzhiyun static DEFINE_MUTEX(amba_reg_lock);
681*4882a593Smuzhiyun static struct uart_driver amba_reg = {
682*4882a593Smuzhiyun 	.owner			= THIS_MODULE,
683*4882a593Smuzhiyun 	.driver_name		= "ttyAM",
684*4882a593Smuzhiyun 	.dev_name		= "ttyAM",
685*4882a593Smuzhiyun 	.major			= SERIAL_AMBA_MAJOR,
686*4882a593Smuzhiyun 	.minor			= SERIAL_AMBA_MINOR,
687*4882a593Smuzhiyun 	.nr			= UART_NR,
688*4882a593Smuzhiyun 	.cons			= AMBA_CONSOLE,
689*4882a593Smuzhiyun };
690*4882a593Smuzhiyun 
pl010_probe(struct amba_device * dev,const struct amba_id * id)691*4882a593Smuzhiyun static int pl010_probe(struct amba_device *dev, const struct amba_id *id)
692*4882a593Smuzhiyun {
693*4882a593Smuzhiyun 	struct uart_amba_port *uap;
694*4882a593Smuzhiyun 	void __iomem *base;
695*4882a593Smuzhiyun 	int i, ret;
696*4882a593Smuzhiyun 
697*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(amba_ports); i++)
698*4882a593Smuzhiyun 		if (amba_ports[i] == NULL)
699*4882a593Smuzhiyun 			break;
700*4882a593Smuzhiyun 
701*4882a593Smuzhiyun 	if (i == ARRAY_SIZE(amba_ports))
702*4882a593Smuzhiyun 		return -EBUSY;
703*4882a593Smuzhiyun 
704*4882a593Smuzhiyun 	uap = devm_kzalloc(&dev->dev, sizeof(struct uart_amba_port),
705*4882a593Smuzhiyun 			   GFP_KERNEL);
706*4882a593Smuzhiyun 	if (!uap)
707*4882a593Smuzhiyun 		return -ENOMEM;
708*4882a593Smuzhiyun 
709*4882a593Smuzhiyun 	base = devm_ioremap(&dev->dev, dev->res.start,
710*4882a593Smuzhiyun 			    resource_size(&dev->res));
711*4882a593Smuzhiyun 	if (!base)
712*4882a593Smuzhiyun 		return -ENOMEM;
713*4882a593Smuzhiyun 
714*4882a593Smuzhiyun 	uap->clk = devm_clk_get(&dev->dev, NULL);
715*4882a593Smuzhiyun 	if (IS_ERR(uap->clk))
716*4882a593Smuzhiyun 		return PTR_ERR(uap->clk);
717*4882a593Smuzhiyun 
718*4882a593Smuzhiyun 	uap->port.dev = &dev->dev;
719*4882a593Smuzhiyun 	uap->port.mapbase = dev->res.start;
720*4882a593Smuzhiyun 	uap->port.membase = base;
721*4882a593Smuzhiyun 	uap->port.iotype = UPIO_MEM;
722*4882a593Smuzhiyun 	uap->port.irq = dev->irq[0];
723*4882a593Smuzhiyun 	uap->port.fifosize = 16;
724*4882a593Smuzhiyun 	uap->port.has_sysrq = IS_ENABLED(CONFIG_SERIAL_AMBA_PL010_CONSOLE);
725*4882a593Smuzhiyun 	uap->port.ops = &amba_pl010_pops;
726*4882a593Smuzhiyun 	uap->port.flags = UPF_BOOT_AUTOCONF;
727*4882a593Smuzhiyun 	uap->port.line = i;
728*4882a593Smuzhiyun 	uap->dev = dev;
729*4882a593Smuzhiyun 	uap->data = dev_get_platdata(&dev->dev);
730*4882a593Smuzhiyun 
731*4882a593Smuzhiyun 	amba_ports[i] = uap;
732*4882a593Smuzhiyun 
733*4882a593Smuzhiyun 	amba_set_drvdata(dev, uap);
734*4882a593Smuzhiyun 
735*4882a593Smuzhiyun 	mutex_lock(&amba_reg_lock);
736*4882a593Smuzhiyun 	if (!amba_reg.state) {
737*4882a593Smuzhiyun 		ret = uart_register_driver(&amba_reg);
738*4882a593Smuzhiyun 		if (ret < 0) {
739*4882a593Smuzhiyun 			mutex_unlock(&amba_reg_lock);
740*4882a593Smuzhiyun 			dev_err(uap->port.dev,
741*4882a593Smuzhiyun 				"Failed to register AMBA-PL010 driver\n");
742*4882a593Smuzhiyun 			return ret;
743*4882a593Smuzhiyun 		}
744*4882a593Smuzhiyun 	}
745*4882a593Smuzhiyun 	mutex_unlock(&amba_reg_lock);
746*4882a593Smuzhiyun 
747*4882a593Smuzhiyun 	ret = uart_add_one_port(&amba_reg, &uap->port);
748*4882a593Smuzhiyun 	if (ret)
749*4882a593Smuzhiyun 		amba_ports[i] = NULL;
750*4882a593Smuzhiyun 
751*4882a593Smuzhiyun 	return ret;
752*4882a593Smuzhiyun }
753*4882a593Smuzhiyun 
pl010_remove(struct amba_device * dev)754*4882a593Smuzhiyun static void pl010_remove(struct amba_device *dev)
755*4882a593Smuzhiyun {
756*4882a593Smuzhiyun 	struct uart_amba_port *uap = amba_get_drvdata(dev);
757*4882a593Smuzhiyun 	int i;
758*4882a593Smuzhiyun 	bool busy = false;
759*4882a593Smuzhiyun 
760*4882a593Smuzhiyun 	uart_remove_one_port(&amba_reg, &uap->port);
761*4882a593Smuzhiyun 
762*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(amba_ports); i++)
763*4882a593Smuzhiyun 		if (amba_ports[i] == uap)
764*4882a593Smuzhiyun 			amba_ports[i] = NULL;
765*4882a593Smuzhiyun 		else if (amba_ports[i])
766*4882a593Smuzhiyun 			busy = true;
767*4882a593Smuzhiyun 
768*4882a593Smuzhiyun 	if (!busy)
769*4882a593Smuzhiyun 		uart_unregister_driver(&amba_reg);
770*4882a593Smuzhiyun }
771*4882a593Smuzhiyun 
772*4882a593Smuzhiyun #ifdef CONFIG_PM_SLEEP
pl010_suspend(struct device * dev)773*4882a593Smuzhiyun static int pl010_suspend(struct device *dev)
774*4882a593Smuzhiyun {
775*4882a593Smuzhiyun 	struct uart_amba_port *uap = dev_get_drvdata(dev);
776*4882a593Smuzhiyun 
777*4882a593Smuzhiyun 	if (uap)
778*4882a593Smuzhiyun 		uart_suspend_port(&amba_reg, &uap->port);
779*4882a593Smuzhiyun 
780*4882a593Smuzhiyun 	return 0;
781*4882a593Smuzhiyun }
782*4882a593Smuzhiyun 
pl010_resume(struct device * dev)783*4882a593Smuzhiyun static int pl010_resume(struct device *dev)
784*4882a593Smuzhiyun {
785*4882a593Smuzhiyun 	struct uart_amba_port *uap = dev_get_drvdata(dev);
786*4882a593Smuzhiyun 
787*4882a593Smuzhiyun 	if (uap)
788*4882a593Smuzhiyun 		uart_resume_port(&amba_reg, &uap->port);
789*4882a593Smuzhiyun 
790*4882a593Smuzhiyun 	return 0;
791*4882a593Smuzhiyun }
792*4882a593Smuzhiyun #endif
793*4882a593Smuzhiyun 
794*4882a593Smuzhiyun static SIMPLE_DEV_PM_OPS(pl010_dev_pm_ops, pl010_suspend, pl010_resume);
795*4882a593Smuzhiyun 
796*4882a593Smuzhiyun static const struct amba_id pl010_ids[] = {
797*4882a593Smuzhiyun 	{
798*4882a593Smuzhiyun 		.id	= 0x00041010,
799*4882a593Smuzhiyun 		.mask	= 0x000fffff,
800*4882a593Smuzhiyun 	},
801*4882a593Smuzhiyun 	{ 0, 0 },
802*4882a593Smuzhiyun };
803*4882a593Smuzhiyun 
804*4882a593Smuzhiyun MODULE_DEVICE_TABLE(amba, pl010_ids);
805*4882a593Smuzhiyun 
806*4882a593Smuzhiyun static struct amba_driver pl010_driver = {
807*4882a593Smuzhiyun 	.drv = {
808*4882a593Smuzhiyun 		.name	= "uart-pl010",
809*4882a593Smuzhiyun 		.pm	= &pl010_dev_pm_ops,
810*4882a593Smuzhiyun 	},
811*4882a593Smuzhiyun 	.id_table	= pl010_ids,
812*4882a593Smuzhiyun 	.probe		= pl010_probe,
813*4882a593Smuzhiyun 	.remove		= pl010_remove,
814*4882a593Smuzhiyun };
815*4882a593Smuzhiyun 
pl010_init(void)816*4882a593Smuzhiyun static int __init pl010_init(void)
817*4882a593Smuzhiyun {
818*4882a593Smuzhiyun 	printk(KERN_INFO "Serial: AMBA driver\n");
819*4882a593Smuzhiyun 
820*4882a593Smuzhiyun 	return  amba_driver_register(&pl010_driver);
821*4882a593Smuzhiyun }
822*4882a593Smuzhiyun 
pl010_exit(void)823*4882a593Smuzhiyun static void __exit pl010_exit(void)
824*4882a593Smuzhiyun {
825*4882a593Smuzhiyun 	amba_driver_unregister(&pl010_driver);
826*4882a593Smuzhiyun }
827*4882a593Smuzhiyun 
828*4882a593Smuzhiyun module_init(pl010_init);
829*4882a593Smuzhiyun module_exit(pl010_exit);
830*4882a593Smuzhiyun 
831*4882a593Smuzhiyun MODULE_AUTHOR("ARM Ltd/Deep Blue Solutions Ltd");
832*4882a593Smuzhiyun MODULE_DESCRIPTION("ARM AMBA serial port driver");
833*4882a593Smuzhiyun MODULE_LICENSE("GPL");
834