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