xref: /openbmc/linux/drivers/tty/serial/atmel_serial.c (revision 9bcffe7575b721d7b6d9b3090fe18809d9806e78)
1ab4382d2SGreg Kroah-Hartman /*
2ab4382d2SGreg Kroah-Hartman  *  Driver for Atmel AT91 / AT32 Serial ports
3ab4382d2SGreg Kroah-Hartman  *  Copyright (C) 2003 Rick Bronson
4ab4382d2SGreg Kroah-Hartman  *
5ab4382d2SGreg Kroah-Hartman  *  Based on drivers/char/serial_sa1100.c, by Deep Blue Solutions Ltd.
6ab4382d2SGreg Kroah-Hartman  *  Based on drivers/char/serial.c, by Linus Torvalds, Theodore Ts'o.
7ab4382d2SGreg Kroah-Hartman  *
8ab4382d2SGreg Kroah-Hartman  *  DMA support added by Chip Coldwell.
9ab4382d2SGreg Kroah-Hartman  *
10ab4382d2SGreg Kroah-Hartman  * This program is free software; you can redistribute it and/or modify
11ab4382d2SGreg Kroah-Hartman  * it under the terms of the GNU General Public License as published by
12ab4382d2SGreg Kroah-Hartman  * the Free Software Foundation; either version 2 of the License, or
13ab4382d2SGreg Kroah-Hartman  * (at your option) any later version.
14ab4382d2SGreg Kroah-Hartman  *
15ab4382d2SGreg Kroah-Hartman  * This program is distributed in the hope that it will be useful,
16ab4382d2SGreg Kroah-Hartman  * but WITHOUT ANY WARRANTY; without even the implied warranty of
17ab4382d2SGreg Kroah-Hartman  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18ab4382d2SGreg Kroah-Hartman  * GNU General Public License for more details.
19ab4382d2SGreg Kroah-Hartman  *
20ab4382d2SGreg Kroah-Hartman  * You should have received a copy of the GNU General Public License
21ab4382d2SGreg Kroah-Hartman  * along with this program; if not, write to the Free Software
22ab4382d2SGreg Kroah-Hartman  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
23ab4382d2SGreg Kroah-Hartman  *
24ab4382d2SGreg Kroah-Hartman  */
25ab4382d2SGreg Kroah-Hartman #include <linux/tty.h>
26ab4382d2SGreg Kroah-Hartman #include <linux/ioport.h>
27ab4382d2SGreg Kroah-Hartman #include <linux/slab.h>
28ab4382d2SGreg Kroah-Hartman #include <linux/init.h>
29ab4382d2SGreg Kroah-Hartman #include <linux/serial.h>
30ab4382d2SGreg Kroah-Hartman #include <linux/clk.h>
31ab4382d2SGreg Kroah-Hartman #include <linux/console.h>
32ab4382d2SGreg Kroah-Hartman #include <linux/sysrq.h>
33ab4382d2SGreg Kroah-Hartman #include <linux/tty_flip.h>
34ab4382d2SGreg Kroah-Hartman #include <linux/platform_device.h>
355fbe46b6SNicolas Ferre #include <linux/of.h>
365fbe46b6SNicolas Ferre #include <linux/of_device.h>
37354e57f3SLinus Walleij #include <linux/of_gpio.h>
38ab4382d2SGreg Kroah-Hartman #include <linux/dma-mapping.h>
396b997babSVinod Koul #include <linux/dmaengine.h>
40ab4382d2SGreg Kroah-Hartman #include <linux/atmel_pdc.h>
41ab4382d2SGreg Kroah-Hartman #include <linux/atmel_serial.h>
42ab4382d2SGreg Kroah-Hartman #include <linux/uaccess.h>
43bcd2360cSJean-Christophe PLAGNIOL-VILLARD #include <linux/platform_data/atmel.h>
442e68c22fSElen Song #include <linux/timer.h>
45354e57f3SLinus Walleij #include <linux/gpio.h>
46e0b0baadSRichard Genoud #include <linux/gpio/consumer.h>
47e0b0baadSRichard Genoud #include <linux/err.h>
48ab5e4e41SRichard Genoud #include <linux/irq.h>
492c7af5baSBoris BREZILLON #include <linux/suspend.h>
50ab4382d2SGreg Kroah-Hartman 
51ab4382d2SGreg Kroah-Hartman #include <asm/io.h>
52ab4382d2SGreg Kroah-Hartman #include <asm/ioctls.h>
53ab4382d2SGreg Kroah-Hartman 
54ab4382d2SGreg Kroah-Hartman #define PDC_BUFFER_SIZE		512
55ab4382d2SGreg Kroah-Hartman /* Revisit: We should calculate this based on the actual port settings */
56ab4382d2SGreg Kroah-Hartman #define PDC_RX_TIMEOUT		(3 * 10)		/* 3 bytes */
57ab4382d2SGreg Kroah-Hartman 
58b5199d46SCyrille Pitchen /* The minium number of data FIFOs should be able to contain */
59b5199d46SCyrille Pitchen #define ATMEL_MIN_FIFO_SIZE	8
60b5199d46SCyrille Pitchen /*
61b5199d46SCyrille Pitchen  * These two offsets are substracted from the RX FIFO size to define the RTS
62b5199d46SCyrille Pitchen  * high and low thresholds
63b5199d46SCyrille Pitchen  */
64b5199d46SCyrille Pitchen #define ATMEL_RTS_HIGH_OFFSET	16
65b5199d46SCyrille Pitchen #define ATMEL_RTS_LOW_OFFSET	20
66b5199d46SCyrille Pitchen 
67ab4382d2SGreg Kroah-Hartman #if defined(CONFIG_SERIAL_ATMEL_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
68ab4382d2SGreg Kroah-Hartman #define SUPPORT_SYSRQ
69ab4382d2SGreg Kroah-Hartman #endif
70ab4382d2SGreg Kroah-Hartman 
71ab4382d2SGreg Kroah-Hartman #include <linux/serial_core.h>
72ab4382d2SGreg Kroah-Hartman 
73e0b0baadSRichard Genoud #include "serial_mctrl_gpio.h"
74e0b0baadSRichard Genoud 
75ab4382d2SGreg Kroah-Hartman static void atmel_start_rx(struct uart_port *port);
76ab4382d2SGreg Kroah-Hartman static void atmel_stop_rx(struct uart_port *port);
77ab4382d2SGreg Kroah-Hartman 
78ab4382d2SGreg Kroah-Hartman #ifdef CONFIG_SERIAL_ATMEL_TTYAT
79ab4382d2SGreg Kroah-Hartman 
80ab4382d2SGreg Kroah-Hartman /* Use device name ttyAT, major 204 and minor 154-169.  This is necessary if we
81ab4382d2SGreg Kroah-Hartman  * should coexist with the 8250 driver, such as if we have an external 16C550
82ab4382d2SGreg Kroah-Hartman  * UART. */
83ab4382d2SGreg Kroah-Hartman #define SERIAL_ATMEL_MAJOR	204
84ab4382d2SGreg Kroah-Hartman #define MINOR_START		154
85ab4382d2SGreg Kroah-Hartman #define ATMEL_DEVICENAME	"ttyAT"
86ab4382d2SGreg Kroah-Hartman 
87ab4382d2SGreg Kroah-Hartman #else
88ab4382d2SGreg Kroah-Hartman 
89ab4382d2SGreg Kroah-Hartman /* Use device name ttyS, major 4, minor 64-68.  This is the usual serial port
90ab4382d2SGreg Kroah-Hartman  * name, but it is legally reserved for the 8250 driver. */
91ab4382d2SGreg Kroah-Hartman #define SERIAL_ATMEL_MAJOR	TTY_MAJOR
92ab4382d2SGreg Kroah-Hartman #define MINOR_START		64
93ab4382d2SGreg Kroah-Hartman #define ATMEL_DEVICENAME	"ttyS"
94ab4382d2SGreg Kroah-Hartman 
95ab4382d2SGreg Kroah-Hartman #endif
96ab4382d2SGreg Kroah-Hartman 
97ab4382d2SGreg Kroah-Hartman #define ATMEL_ISR_PASS_LIMIT	256
98ab4382d2SGreg Kroah-Hartman 
99ab4382d2SGreg Kroah-Hartman struct atmel_dma_buffer {
100ab4382d2SGreg Kroah-Hartman 	unsigned char	*buf;
101ab4382d2SGreg Kroah-Hartman 	dma_addr_t	dma_addr;
102ab4382d2SGreg Kroah-Hartman 	unsigned int	dma_size;
103ab4382d2SGreg Kroah-Hartman 	unsigned int	ofs;
104ab4382d2SGreg Kroah-Hartman };
105ab4382d2SGreg Kroah-Hartman 
106ab4382d2SGreg Kroah-Hartman struct atmel_uart_char {
107ab4382d2SGreg Kroah-Hartman 	u16		status;
108ab4382d2SGreg Kroah-Hartman 	u16		ch;
109ab4382d2SGreg Kroah-Hartman };
110ab4382d2SGreg Kroah-Hartman 
111637ba54fSLudovic Desroches /*
112637ba54fSLudovic Desroches  * Be careful, the real size of the ring buffer is
113637ba54fSLudovic Desroches  * sizeof(atmel_uart_char) * ATMEL_SERIAL_RINGSIZE. It means that ring buffer
114637ba54fSLudovic Desroches  * can contain up to 1024 characters in PIO mode and up to 4096 characters in
115637ba54fSLudovic Desroches  * DMA mode.
116637ba54fSLudovic Desroches  */
117ab4382d2SGreg Kroah-Hartman #define ATMEL_SERIAL_RINGSIZE 1024
118ab4382d2SGreg Kroah-Hartman 
119ab4382d2SGreg Kroah-Hartman /*
1209af92fbfSAlexandre Belloni  * at91: 6 USARTs and one DBGU port (SAM9260)
1219af92fbfSAlexandre Belloni  * avr32: 4
1229af92fbfSAlexandre Belloni  */
1239af92fbfSAlexandre Belloni #define ATMEL_MAX_UART		7
1249af92fbfSAlexandre Belloni 
1259af92fbfSAlexandre Belloni /*
126ab4382d2SGreg Kroah-Hartman  * We wrap our port structure around the generic uart_port.
127ab4382d2SGreg Kroah-Hartman  */
128ab4382d2SGreg Kroah-Hartman struct atmel_uart_port {
129ab4382d2SGreg Kroah-Hartman 	struct uart_port	uart;		/* uart */
130ab4382d2SGreg Kroah-Hartman 	struct clk		*clk;		/* uart clock */
131ab4382d2SGreg Kroah-Hartman 	int			may_wakeup;	/* cached value of device_may_wakeup for times we need to disable it */
132ab4382d2SGreg Kroah-Hartman 	u32			backup_imr;	/* IMR saved during suspend */
133ab4382d2SGreg Kroah-Hartman 	int			break_active;	/* break being received */
134ab4382d2SGreg Kroah-Hartman 
13534df42f5SElen Song 	bool			use_dma_rx;	/* enable DMA receiver */
13664e22ebeSElen Song 	bool			use_pdc_rx;	/* enable PDC receiver */
137ab4382d2SGreg Kroah-Hartman 	short			pdc_rx_idx;	/* current PDC RX buffer */
138ab4382d2SGreg Kroah-Hartman 	struct atmel_dma_buffer	pdc_rx[2];	/* PDC receier */
139ab4382d2SGreg Kroah-Hartman 
14008f738beSElen Song 	bool			use_dma_tx;     /* enable DMA transmitter */
14164e22ebeSElen Song 	bool			use_pdc_tx;	/* enable PDC transmitter */
142ab4382d2SGreg Kroah-Hartman 	struct atmel_dma_buffer	pdc_tx;		/* PDC transmitter */
143ab4382d2SGreg Kroah-Hartman 
14408f738beSElen Song 	spinlock_t			lock_tx;	/* port lock */
14534df42f5SElen Song 	spinlock_t			lock_rx;	/* port lock */
14608f738beSElen Song 	struct dma_chan			*chan_tx;
14734df42f5SElen Song 	struct dma_chan			*chan_rx;
14808f738beSElen Song 	struct dma_async_tx_descriptor	*desc_tx;
14934df42f5SElen Song 	struct dma_async_tx_descriptor	*desc_rx;
15008f738beSElen Song 	dma_cookie_t			cookie_tx;
15134df42f5SElen Song 	dma_cookie_t			cookie_rx;
15208f738beSElen Song 	struct scatterlist		sg_tx;
15334df42f5SElen Song 	struct scatterlist		sg_rx;
15400e8e658SNicolas Ferre 	struct tasklet_struct	tasklet_rx;
15500e8e658SNicolas Ferre 	struct tasklet_struct	tasklet_tx;
15698f2082cSNicolas Ferre 	atomic_t		tasklet_shutdown;
157ab4382d2SGreg Kroah-Hartman 	unsigned int		irq_status_prev;
1585f258b3eSCyrille Pitchen 	unsigned int		tx_len;
159ab4382d2SGreg Kroah-Hartman 
160ab4382d2SGreg Kroah-Hartman 	struct circ_buf		rx_ring;
161ab4382d2SGreg Kroah-Hartman 
162e0b0baadSRichard Genoud 	struct mctrl_gpios	*gpios;
163ab4382d2SGreg Kroah-Hartman 	unsigned int		tx_done_mask;
164b5199d46SCyrille Pitchen 	u32			fifo_size;
165b5199d46SCyrille Pitchen 	u32			rts_high;
166b5199d46SCyrille Pitchen 	u32			rts_low;
167ab5e4e41SRichard Genoud 	bool			ms_irq_enabled;
1682958cceeSLudovic Desroches 	u32			rtor;	/* address of receiver timeout register if it exists */
1695bf5635aSLudovic Desroches 	bool			has_frac_baudrate;
1704b769371SNicolas Ferre 	bool			has_hw_timer;
1714b769371SNicolas Ferre 	struct timer_list	uart_timer;
1722c7af5baSBoris BREZILLON 
1732c7af5baSBoris BREZILLON 	bool			suspended;
1742c7af5baSBoris BREZILLON 	unsigned int		pending;
1752c7af5baSBoris BREZILLON 	unsigned int		pending_status;
1762c7af5baSBoris BREZILLON 	spinlock_t		lock_suspended;
1772c7af5baSBoris BREZILLON 
178a930e528SElen Song 	int (*prepare_rx)(struct uart_port *port);
179a930e528SElen Song 	int (*prepare_tx)(struct uart_port *port);
180a930e528SElen Song 	void (*schedule_rx)(struct uart_port *port);
181a930e528SElen Song 	void (*schedule_tx)(struct uart_port *port);
182a930e528SElen Song 	void (*release_rx)(struct uart_port *port);
183a930e528SElen Song 	void (*release_tx)(struct uart_port *port);
184ab4382d2SGreg Kroah-Hartman };
185ab4382d2SGreg Kroah-Hartman 
186ab4382d2SGreg Kroah-Hartman static struct atmel_uart_port atmel_ports[ATMEL_MAX_UART];
187503bded9SPawel Wieczorkiewicz static DECLARE_BITMAP(atmel_ports_in_use, ATMEL_MAX_UART);
188ab4382d2SGreg Kroah-Hartman 
189ab4382d2SGreg Kroah-Hartman #ifdef SUPPORT_SYSRQ
190ab4382d2SGreg Kroah-Hartman static struct console atmel_console;
191ab4382d2SGreg Kroah-Hartman #endif
192ab4382d2SGreg Kroah-Hartman 
1935fbe46b6SNicolas Ferre #if defined(CONFIG_OF)
1945fbe46b6SNicolas Ferre static const struct of_device_id atmel_serial_dt_ids[] = {
1955fbe46b6SNicolas Ferre 	{ .compatible = "atmel,at91rm9200-usart" },
1965fbe46b6SNicolas Ferre 	{ .compatible = "atmel,at91sam9260-usart" },
1975fbe46b6SNicolas Ferre 	{ /* sentinel */ }
1985fbe46b6SNicolas Ferre };
1995fbe46b6SNicolas Ferre #endif
2005fbe46b6SNicolas Ferre 
201ab4382d2SGreg Kroah-Hartman static inline struct atmel_uart_port *
202ab4382d2SGreg Kroah-Hartman to_atmel_uart_port(struct uart_port *uart)
203ab4382d2SGreg Kroah-Hartman {
204ab4382d2SGreg Kroah-Hartman 	return container_of(uart, struct atmel_uart_port, uart);
205ab4382d2SGreg Kroah-Hartman }
206ab4382d2SGreg Kroah-Hartman 
2074e7decdaSCyrille Pitchen static inline u32 atmel_uart_readl(struct uart_port *port, u32 reg)
2084e7decdaSCyrille Pitchen {
2094e7decdaSCyrille Pitchen 	return __raw_readl(port->membase + reg);
2104e7decdaSCyrille Pitchen }
2114e7decdaSCyrille Pitchen 
2124e7decdaSCyrille Pitchen static inline void atmel_uart_writel(struct uart_port *port, u32 reg, u32 value)
2134e7decdaSCyrille Pitchen {
2144e7decdaSCyrille Pitchen 	__raw_writel(value, port->membase + reg);
2154e7decdaSCyrille Pitchen }
2164e7decdaSCyrille Pitchen 
217a6499435SCyrille Pitchen #ifdef CONFIG_AVR32
218a6499435SCyrille Pitchen 
219a6499435SCyrille Pitchen /* AVR32 cannot handle 8 or 16bit I/O accesses but only 32bit I/O accesses */
220a6499435SCyrille Pitchen static inline u8 atmel_uart_read_char(struct uart_port *port)
221b5199d46SCyrille Pitchen {
222a6499435SCyrille Pitchen 	return __raw_readl(port->membase + ATMEL_US_RHR);
223b5199d46SCyrille Pitchen }
224b5199d46SCyrille Pitchen 
225a6499435SCyrille Pitchen static inline void atmel_uart_write_char(struct uart_port *port, u8 value)
226b5199d46SCyrille Pitchen {
227a6499435SCyrille Pitchen 	__raw_writel(value, port->membase + ATMEL_US_THR);
228b5199d46SCyrille Pitchen }
229b5199d46SCyrille Pitchen 
230a6499435SCyrille Pitchen #else
231a6499435SCyrille Pitchen 
232a6499435SCyrille Pitchen static inline u8 atmel_uart_read_char(struct uart_port *port)
233a6499435SCyrille Pitchen {
234a6499435SCyrille Pitchen 	return __raw_readb(port->membase + ATMEL_US_RHR);
235a6499435SCyrille Pitchen }
236a6499435SCyrille Pitchen 
237a6499435SCyrille Pitchen static inline void atmel_uart_write_char(struct uart_port *port, u8 value)
238a6499435SCyrille Pitchen {
239a6499435SCyrille Pitchen 	__raw_writeb(value, port->membase + ATMEL_US_THR);
240a6499435SCyrille Pitchen }
241a6499435SCyrille Pitchen 
242a6499435SCyrille Pitchen #endif
243a6499435SCyrille Pitchen 
244ab4382d2SGreg Kroah-Hartman #ifdef CONFIG_SERIAL_ATMEL_PDC
24564e22ebeSElen Song static bool atmel_use_pdc_rx(struct uart_port *port)
246ab4382d2SGreg Kroah-Hartman {
247ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
248ab4382d2SGreg Kroah-Hartman 
24964e22ebeSElen Song 	return atmel_port->use_pdc_rx;
250ab4382d2SGreg Kroah-Hartman }
251ab4382d2SGreg Kroah-Hartman 
25264e22ebeSElen Song static bool atmel_use_pdc_tx(struct uart_port *port)
253ab4382d2SGreg Kroah-Hartman {
254ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
255ab4382d2SGreg Kroah-Hartman 
25664e22ebeSElen Song 	return atmel_port->use_pdc_tx;
257ab4382d2SGreg Kroah-Hartman }
258ab4382d2SGreg Kroah-Hartman #else
25964e22ebeSElen Song static bool atmel_use_pdc_rx(struct uart_port *port)
260ab4382d2SGreg Kroah-Hartman {
261ab4382d2SGreg Kroah-Hartman 	return false;
262ab4382d2SGreg Kroah-Hartman }
263ab4382d2SGreg Kroah-Hartman 
26464e22ebeSElen Song static bool atmel_use_pdc_tx(struct uart_port *port)
265ab4382d2SGreg Kroah-Hartman {
266ab4382d2SGreg Kroah-Hartman 	return false;
267ab4382d2SGreg Kroah-Hartman }
268ab4382d2SGreg Kroah-Hartman #endif
269ab4382d2SGreg Kroah-Hartman 
27008f738beSElen Song static bool atmel_use_dma_tx(struct uart_port *port)
27108f738beSElen Song {
27208f738beSElen Song 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
27308f738beSElen Song 
27408f738beSElen Song 	return atmel_port->use_dma_tx;
27508f738beSElen Song }
27608f738beSElen Song 
27734df42f5SElen Song static bool atmel_use_dma_rx(struct uart_port *port)
27834df42f5SElen Song {
27934df42f5SElen Song 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
28034df42f5SElen Song 
28134df42f5SElen Song 	return atmel_port->use_dma_rx;
28234df42f5SElen Song }
28334df42f5SElen Song 
2845be605acSAlexandre Belloni static bool atmel_use_fifo(struct uart_port *port)
2855be605acSAlexandre Belloni {
2865be605acSAlexandre Belloni 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
2875be605acSAlexandre Belloni 
2885be605acSAlexandre Belloni 	return atmel_port->fifo_size;
2895be605acSAlexandre Belloni }
2905be605acSAlexandre Belloni 
29198f2082cSNicolas Ferre static void atmel_tasklet_schedule(struct atmel_uart_port *atmel_port,
29298f2082cSNicolas Ferre 				   struct tasklet_struct *t)
29398f2082cSNicolas Ferre {
29498f2082cSNicolas Ferre 	if (!atomic_read(&atmel_port->tasklet_shutdown))
29598f2082cSNicolas Ferre 		tasklet_schedule(t);
29698f2082cSNicolas Ferre }
29798f2082cSNicolas Ferre 
298e0b0baadSRichard Genoud static unsigned int atmel_get_lines_status(struct uart_port *port)
299e0b0baadSRichard Genoud {
300e0b0baadSRichard Genoud 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
301e0b0baadSRichard Genoud 	unsigned int status, ret = 0;
302e0b0baadSRichard Genoud 
3034e7decdaSCyrille Pitchen 	status = atmel_uart_readl(port, ATMEL_US_CSR);
304e0b0baadSRichard Genoud 
305e0b0baadSRichard Genoud 	mctrl_gpio_get(atmel_port->gpios, &ret);
306e0b0baadSRichard Genoud 
307e0b0baadSRichard Genoud 	if (!IS_ERR_OR_NULL(mctrl_gpio_to_gpiod(atmel_port->gpios,
308e0b0baadSRichard Genoud 						UART_GPIO_CTS))) {
309e0b0baadSRichard Genoud 		if (ret & TIOCM_CTS)
310e0b0baadSRichard Genoud 			status &= ~ATMEL_US_CTS;
311e0b0baadSRichard Genoud 		else
312e0b0baadSRichard Genoud 			status |= ATMEL_US_CTS;
313e0b0baadSRichard Genoud 	}
314e0b0baadSRichard Genoud 
315e0b0baadSRichard Genoud 	if (!IS_ERR_OR_NULL(mctrl_gpio_to_gpiod(atmel_port->gpios,
316e0b0baadSRichard Genoud 						UART_GPIO_DSR))) {
317e0b0baadSRichard Genoud 		if (ret & TIOCM_DSR)
318e0b0baadSRichard Genoud 			status &= ~ATMEL_US_DSR;
319e0b0baadSRichard Genoud 		else
320e0b0baadSRichard Genoud 			status |= ATMEL_US_DSR;
321e0b0baadSRichard Genoud 	}
322e0b0baadSRichard Genoud 
323e0b0baadSRichard Genoud 	if (!IS_ERR_OR_NULL(mctrl_gpio_to_gpiod(atmel_port->gpios,
324e0b0baadSRichard Genoud 						UART_GPIO_RI))) {
325e0b0baadSRichard Genoud 		if (ret & TIOCM_RI)
326e0b0baadSRichard Genoud 			status &= ~ATMEL_US_RI;
327e0b0baadSRichard Genoud 		else
328e0b0baadSRichard Genoud 			status |= ATMEL_US_RI;
329e0b0baadSRichard Genoud 	}
330e0b0baadSRichard Genoud 
331e0b0baadSRichard Genoud 	if (!IS_ERR_OR_NULL(mctrl_gpio_to_gpiod(atmel_port->gpios,
332e0b0baadSRichard Genoud 						UART_GPIO_DCD))) {
333e0b0baadSRichard Genoud 		if (ret & TIOCM_CD)
334e0b0baadSRichard Genoud 			status &= ~ATMEL_US_DCD;
335e0b0baadSRichard Genoud 		else
336e0b0baadSRichard Genoud 			status |= ATMEL_US_DCD;
337e0b0baadSRichard Genoud 	}
338e0b0baadSRichard Genoud 
339e0b0baadSRichard Genoud 	return status;
340e0b0baadSRichard Genoud }
341e0b0baadSRichard Genoud 
342ab4382d2SGreg Kroah-Hartman /* Enable or disable the rs485 support */
34313bd3e6fSRicardo Ribalda Delgado static int atmel_config_rs485(struct uart_port *port,
34413bd3e6fSRicardo Ribalda Delgado 			      struct serial_rs485 *rs485conf)
345ab4382d2SGreg Kroah-Hartman {
346ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
347ab4382d2SGreg Kroah-Hartman 	unsigned int mode;
348ab4382d2SGreg Kroah-Hartman 
349ab4382d2SGreg Kroah-Hartman 	/* Disable interrupts */
3504e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_IDR, atmel_port->tx_done_mask);
351ab4382d2SGreg Kroah-Hartman 
3524e7decdaSCyrille Pitchen 	mode = atmel_uart_readl(port, ATMEL_US_MR);
353ab4382d2SGreg Kroah-Hartman 
354ab4382d2SGreg Kroah-Hartman 	/* Resetting serial mode to RS232 (0x0) */
355ab4382d2SGreg Kroah-Hartman 	mode &= ~ATMEL_US_USMODE;
356ab4382d2SGreg Kroah-Hartman 
35713bd3e6fSRicardo Ribalda Delgado 	port->rs485 = *rs485conf;
358ab4382d2SGreg Kroah-Hartman 
359ab4382d2SGreg Kroah-Hartman 	if (rs485conf->flags & SER_RS485_ENABLED) {
360ab4382d2SGreg Kroah-Hartman 		dev_dbg(port->dev, "Setting UART to RS485\n");
361ab4382d2SGreg Kroah-Hartman 		atmel_port->tx_done_mask = ATMEL_US_TXEMPTY;
3624e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_TTGR,
3634e7decdaSCyrille Pitchen 				  rs485conf->delay_rts_after_send);
364ab4382d2SGreg Kroah-Hartman 		mode |= ATMEL_US_USMODE_RS485;
365ab4382d2SGreg Kroah-Hartman 	} else {
366ab4382d2SGreg Kroah-Hartman 		dev_dbg(port->dev, "Setting UART to RS232\n");
36764e22ebeSElen Song 		if (atmel_use_pdc_tx(port))
368ab4382d2SGreg Kroah-Hartman 			atmel_port->tx_done_mask = ATMEL_US_ENDTX |
369ab4382d2SGreg Kroah-Hartman 				ATMEL_US_TXBUFE;
370ab4382d2SGreg Kroah-Hartman 		else
371ab4382d2SGreg Kroah-Hartman 			atmel_port->tx_done_mask = ATMEL_US_TXRDY;
372ab4382d2SGreg Kroah-Hartman 	}
3734e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_MR, mode);
374ab4382d2SGreg Kroah-Hartman 
375ab4382d2SGreg Kroah-Hartman 	/* Enable interrupts */
3764e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_IER, atmel_port->tx_done_mask);
377ab4382d2SGreg Kroah-Hartman 
37813bd3e6fSRicardo Ribalda Delgado 	return 0;
379ab4382d2SGreg Kroah-Hartman }
380ab4382d2SGreg Kroah-Hartman 
381ab4382d2SGreg Kroah-Hartman /*
382ab4382d2SGreg Kroah-Hartman  * Return TIOCSER_TEMT when transmitter FIFO and Shift register is empty.
383ab4382d2SGreg Kroah-Hartman  */
384ab4382d2SGreg Kroah-Hartman static u_int atmel_tx_empty(struct uart_port *port)
385ab4382d2SGreg Kroah-Hartman {
3864e7decdaSCyrille Pitchen 	return (atmel_uart_readl(port, ATMEL_US_CSR) & ATMEL_US_TXEMPTY) ?
3874e7decdaSCyrille Pitchen 		TIOCSER_TEMT :
3884e7decdaSCyrille Pitchen 		0;
389ab4382d2SGreg Kroah-Hartman }
390ab4382d2SGreg Kroah-Hartman 
391ab4382d2SGreg Kroah-Hartman /*
392ab4382d2SGreg Kroah-Hartman  * Set state of the modem control output lines
393ab4382d2SGreg Kroah-Hartman  */
394ab4382d2SGreg Kroah-Hartman static void atmel_set_mctrl(struct uart_port *port, u_int mctrl)
395ab4382d2SGreg Kroah-Hartman {
396ab4382d2SGreg Kroah-Hartman 	unsigned int control = 0;
3974e7decdaSCyrille Pitchen 	unsigned int mode = atmel_uart_readl(port, ATMEL_US_MR);
3981cf6e8fcSCyrille Pitchen 	unsigned int rts_paused, rts_ready;
399ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
400ab4382d2SGreg Kroah-Hartman 
4011cf6e8fcSCyrille Pitchen 	/* override mode to RS485 if needed, otherwise keep the current mode */
4021cf6e8fcSCyrille Pitchen 	if (port->rs485.flags & SER_RS485_ENABLED) {
4034e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_TTGR,
4044e7decdaSCyrille Pitchen 				  port->rs485.delay_rts_after_send);
4051cf6e8fcSCyrille Pitchen 		mode &= ~ATMEL_US_USMODE;
4061cf6e8fcSCyrille Pitchen 		mode |= ATMEL_US_USMODE_RS485;
4071cf6e8fcSCyrille Pitchen 	}
4081cf6e8fcSCyrille Pitchen 
4091cf6e8fcSCyrille Pitchen 	/* set the RTS line state according to the mode */
4101cf6e8fcSCyrille Pitchen 	if ((mode & ATMEL_US_USMODE) == ATMEL_US_USMODE_HWHS) {
4111cf6e8fcSCyrille Pitchen 		/* force RTS line to high level */
4121cf6e8fcSCyrille Pitchen 		rts_paused = ATMEL_US_RTSEN;
4131cf6e8fcSCyrille Pitchen 
4141cf6e8fcSCyrille Pitchen 		/* give the control of the RTS line back to the hardware */
4151cf6e8fcSCyrille Pitchen 		rts_ready = ATMEL_US_RTSDIS;
4161cf6e8fcSCyrille Pitchen 	} else {
4171cf6e8fcSCyrille Pitchen 		/* force RTS line to high level */
4181cf6e8fcSCyrille Pitchen 		rts_paused = ATMEL_US_RTSDIS;
4191cf6e8fcSCyrille Pitchen 
4201cf6e8fcSCyrille Pitchen 		/* force RTS line to low level */
4211cf6e8fcSCyrille Pitchen 		rts_ready = ATMEL_US_RTSEN;
4221cf6e8fcSCyrille Pitchen 	}
4231cf6e8fcSCyrille Pitchen 
424ab4382d2SGreg Kroah-Hartman 	if (mctrl & TIOCM_RTS)
4251cf6e8fcSCyrille Pitchen 		control |= rts_ready;
426ab4382d2SGreg Kroah-Hartman 	else
4271cf6e8fcSCyrille Pitchen 		control |= rts_paused;
428ab4382d2SGreg Kroah-Hartman 
429ab4382d2SGreg Kroah-Hartman 	if (mctrl & TIOCM_DTR)
430ab4382d2SGreg Kroah-Hartman 		control |= ATMEL_US_DTREN;
431ab4382d2SGreg Kroah-Hartman 	else
432ab4382d2SGreg Kroah-Hartman 		control |= ATMEL_US_DTRDIS;
433ab4382d2SGreg Kroah-Hartman 
4344e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_CR, control);
435ab4382d2SGreg Kroah-Hartman 
436e0b0baadSRichard Genoud 	mctrl_gpio_set(atmel_port->gpios, mctrl);
437e0b0baadSRichard Genoud 
438ab4382d2SGreg Kroah-Hartman 	/* Local loopback mode? */
4391cf6e8fcSCyrille Pitchen 	mode &= ~ATMEL_US_CHMODE;
440ab4382d2SGreg Kroah-Hartman 	if (mctrl & TIOCM_LOOP)
441ab4382d2SGreg Kroah-Hartman 		mode |= ATMEL_US_CHMODE_LOC_LOOP;
442ab4382d2SGreg Kroah-Hartman 	else
443ab4382d2SGreg Kroah-Hartman 		mode |= ATMEL_US_CHMODE_NORMAL;
444ab4382d2SGreg Kroah-Hartman 
4454e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_MR, mode);
446ab4382d2SGreg Kroah-Hartman }
447ab4382d2SGreg Kroah-Hartman 
448ab4382d2SGreg Kroah-Hartman /*
449ab4382d2SGreg Kroah-Hartman  * Get state of the modem control input lines
450ab4382d2SGreg Kroah-Hartman  */
451ab4382d2SGreg Kroah-Hartman static u_int atmel_get_mctrl(struct uart_port *port)
452ab4382d2SGreg Kroah-Hartman {
453e0b0baadSRichard Genoud 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
454e0b0baadSRichard Genoud 	unsigned int ret = 0, status;
455ab4382d2SGreg Kroah-Hartman 
4564e7decdaSCyrille Pitchen 	status = atmel_uart_readl(port, ATMEL_US_CSR);
457ab4382d2SGreg Kroah-Hartman 
458ab4382d2SGreg Kroah-Hartman 	/*
459ab4382d2SGreg Kroah-Hartman 	 * The control signals are active low.
460ab4382d2SGreg Kroah-Hartman 	 */
461ab4382d2SGreg Kroah-Hartman 	if (!(status & ATMEL_US_DCD))
462ab4382d2SGreg Kroah-Hartman 		ret |= TIOCM_CD;
463ab4382d2SGreg Kroah-Hartman 	if (!(status & ATMEL_US_CTS))
464ab4382d2SGreg Kroah-Hartman 		ret |= TIOCM_CTS;
465ab4382d2SGreg Kroah-Hartman 	if (!(status & ATMEL_US_DSR))
466ab4382d2SGreg Kroah-Hartman 		ret |= TIOCM_DSR;
467ab4382d2SGreg Kroah-Hartman 	if (!(status & ATMEL_US_RI))
468ab4382d2SGreg Kroah-Hartman 		ret |= TIOCM_RI;
469ab4382d2SGreg Kroah-Hartman 
470e0b0baadSRichard Genoud 	return mctrl_gpio_get(atmel_port->gpios, &ret);
471ab4382d2SGreg Kroah-Hartman }
472ab4382d2SGreg Kroah-Hartman 
473ab4382d2SGreg Kroah-Hartman /*
474ab4382d2SGreg Kroah-Hartman  * Stop transmitting.
475ab4382d2SGreg Kroah-Hartman  */
476ab4382d2SGreg Kroah-Hartman static void atmel_stop_tx(struct uart_port *port)
477ab4382d2SGreg Kroah-Hartman {
478ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
479ab4382d2SGreg Kroah-Hartman 
48064e22ebeSElen Song 	if (atmel_use_pdc_tx(port)) {
481ab4382d2SGreg Kroah-Hartman 		/* disable PDC transmit */
4824e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_PDC_PTCR, ATMEL_PDC_TXTDIS);
483ab4382d2SGreg Kroah-Hartman 	}
484ab4382d2SGreg Kroah-Hartman 	/* Disable interrupts */
4854e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_IDR, atmel_port->tx_done_mask);
486ab4382d2SGreg Kroah-Hartman 
48713bd3e6fSRicardo Ribalda Delgado 	if ((port->rs485.flags & SER_RS485_ENABLED) &&
48813bd3e6fSRicardo Ribalda Delgado 	    !(port->rs485.flags & SER_RS485_RX_DURING_TX))
489ab4382d2SGreg Kroah-Hartman 		atmel_start_rx(port);
490ab4382d2SGreg Kroah-Hartman }
491ab4382d2SGreg Kroah-Hartman 
492ab4382d2SGreg Kroah-Hartman /*
493ab4382d2SGreg Kroah-Hartman  * Start transmitting.
494ab4382d2SGreg Kroah-Hartman  */
495ab4382d2SGreg Kroah-Hartman static void atmel_start_tx(struct uart_port *port)
496ab4382d2SGreg Kroah-Hartman {
497ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
498ab4382d2SGreg Kroah-Hartman 
4990058f087SAlexandre Belloni 	if (atmel_use_pdc_tx(port) && (atmel_uart_readl(port, ATMEL_PDC_PTSR)
5000058f087SAlexandre Belloni 				       & ATMEL_PDC_TXTEN))
501ab4382d2SGreg Kroah-Hartman 		/* The transmitter is already running.  Yes, we
502ab4382d2SGreg Kroah-Hartman 		   really need this.*/
503ab4382d2SGreg Kroah-Hartman 		return;
504ab4382d2SGreg Kroah-Hartman 
5050058f087SAlexandre Belloni 	if (atmel_use_pdc_tx(port) || atmel_use_dma_tx(port))
50613bd3e6fSRicardo Ribalda Delgado 		if ((port->rs485.flags & SER_RS485_ENABLED) &&
50713bd3e6fSRicardo Ribalda Delgado 		    !(port->rs485.flags & SER_RS485_RX_DURING_TX))
508ab4382d2SGreg Kroah-Hartman 			atmel_stop_rx(port);
509ab4382d2SGreg Kroah-Hartman 
5100058f087SAlexandre Belloni 	if (atmel_use_pdc_tx(port))
511ab4382d2SGreg Kroah-Hartman 		/* re-enable PDC transmit */
5124e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_PDC_PTCR, ATMEL_PDC_TXTEN);
5130058f087SAlexandre Belloni 
514ab4382d2SGreg Kroah-Hartman 	/* Enable interrupts */
5154e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_IER, atmel_port->tx_done_mask);
516ab4382d2SGreg Kroah-Hartman }
517ab4382d2SGreg Kroah-Hartman 
518ab4382d2SGreg Kroah-Hartman /*
519ab4382d2SGreg Kroah-Hartman  * start receiving - port is in process of being opened.
520ab4382d2SGreg Kroah-Hartman  */
521ab4382d2SGreg Kroah-Hartman static void atmel_start_rx(struct uart_port *port)
522ab4382d2SGreg Kroah-Hartman {
5234e7decdaSCyrille Pitchen 	/* reset status and receiver */
5244e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_RSTSTA);
525ab4382d2SGreg Kroah-Hartman 
5264e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_RXEN);
52757c36868SSiftar, Gabe 
52864e22ebeSElen Song 	if (atmel_use_pdc_rx(port)) {
529ab4382d2SGreg Kroah-Hartman 		/* enable PDC controller */
5304e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_IER,
5314e7decdaSCyrille Pitchen 				  ATMEL_US_ENDRX | ATMEL_US_TIMEOUT |
532ab4382d2SGreg Kroah-Hartman 				  port->read_status_mask);
5334e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_PDC_PTCR, ATMEL_PDC_RXTEN);
534ab4382d2SGreg Kroah-Hartman 	} else {
5354e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_IER, ATMEL_US_RXRDY);
536ab4382d2SGreg Kroah-Hartman 	}
537ab4382d2SGreg Kroah-Hartman }
538ab4382d2SGreg Kroah-Hartman 
539ab4382d2SGreg Kroah-Hartman /*
540ab4382d2SGreg Kroah-Hartman  * Stop receiving - port is in process of being closed.
541ab4382d2SGreg Kroah-Hartman  */
542ab4382d2SGreg Kroah-Hartman static void atmel_stop_rx(struct uart_port *port)
543ab4382d2SGreg Kroah-Hartman {
5444e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_RXDIS);
54557c36868SSiftar, Gabe 
54664e22ebeSElen Song 	if (atmel_use_pdc_rx(port)) {
547ab4382d2SGreg Kroah-Hartman 		/* disable PDC receive */
5484e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_PDC_PTCR, ATMEL_PDC_RXTDIS);
5494e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_IDR,
5504e7decdaSCyrille Pitchen 				  ATMEL_US_ENDRX | ATMEL_US_TIMEOUT |
551ab4382d2SGreg Kroah-Hartman 				  port->read_status_mask);
552ab4382d2SGreg Kroah-Hartman 	} else {
5534e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_IDR, ATMEL_US_RXRDY);
554ab4382d2SGreg Kroah-Hartman 	}
555ab4382d2SGreg Kroah-Hartman }
556ab4382d2SGreg Kroah-Hartman 
557ab4382d2SGreg Kroah-Hartman /*
558ab4382d2SGreg Kroah-Hartman  * Enable modem status interrupts
559ab4382d2SGreg Kroah-Hartman  */
560ab4382d2SGreg Kroah-Hartman static void atmel_enable_ms(struct uart_port *port)
561ab4382d2SGreg Kroah-Hartman {
562ab5e4e41SRichard Genoud 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
563ab5e4e41SRichard Genoud 	uint32_t ier = 0;
564ab5e4e41SRichard Genoud 
565ab5e4e41SRichard Genoud 	/*
566ab5e4e41SRichard Genoud 	 * Interrupt should not be enabled twice
567ab5e4e41SRichard Genoud 	 */
568ab5e4e41SRichard Genoud 	if (atmel_port->ms_irq_enabled)
569ab5e4e41SRichard Genoud 		return;
570ab5e4e41SRichard Genoud 
571ab5e4e41SRichard Genoud 	atmel_port->ms_irq_enabled = true;
572ab5e4e41SRichard Genoud 
57318dfef9cSUwe Kleine-König 	if (!mctrl_gpio_to_gpiod(atmel_port->gpios, UART_GPIO_CTS))
574ab5e4e41SRichard Genoud 		ier |= ATMEL_US_CTSIC;
575ab5e4e41SRichard Genoud 
57618dfef9cSUwe Kleine-König 	if (!mctrl_gpio_to_gpiod(atmel_port->gpios, UART_GPIO_DSR))
577ab5e4e41SRichard Genoud 		ier |= ATMEL_US_DSRIC;
578ab5e4e41SRichard Genoud 
57918dfef9cSUwe Kleine-König 	if (!mctrl_gpio_to_gpiod(atmel_port->gpios, UART_GPIO_RI))
580ab5e4e41SRichard Genoud 		ier |= ATMEL_US_RIIC;
581ab5e4e41SRichard Genoud 
58218dfef9cSUwe Kleine-König 	if (!mctrl_gpio_to_gpiod(atmel_port->gpios, UART_GPIO_DCD))
583ab5e4e41SRichard Genoud 		ier |= ATMEL_US_DCDIC;
584ab5e4e41SRichard Genoud 
5854e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_IER, ier);
58618dfef9cSUwe Kleine-König 
58718dfef9cSUwe Kleine-König 	mctrl_gpio_enable_ms(atmel_port->gpios);
588ab4382d2SGreg Kroah-Hartman }
589ab4382d2SGreg Kroah-Hartman 
590ab4382d2SGreg Kroah-Hartman /*
59135b675b9SRichard Genoud  * Disable modem status interrupts
59235b675b9SRichard Genoud  */
59335b675b9SRichard Genoud static void atmel_disable_ms(struct uart_port *port)
59435b675b9SRichard Genoud {
59535b675b9SRichard Genoud 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
59635b675b9SRichard Genoud 	uint32_t idr = 0;
59735b675b9SRichard Genoud 
59835b675b9SRichard Genoud 	/*
59935b675b9SRichard Genoud 	 * Interrupt should not be disabled twice
60035b675b9SRichard Genoud 	 */
60135b675b9SRichard Genoud 	if (!atmel_port->ms_irq_enabled)
60235b675b9SRichard Genoud 		return;
60335b675b9SRichard Genoud 
60435b675b9SRichard Genoud 	atmel_port->ms_irq_enabled = false;
60535b675b9SRichard Genoud 
60618dfef9cSUwe Kleine-König 	mctrl_gpio_disable_ms(atmel_port->gpios);
60718dfef9cSUwe Kleine-König 
60818dfef9cSUwe Kleine-König 	if (!mctrl_gpio_to_gpiod(atmel_port->gpios, UART_GPIO_CTS))
60935b675b9SRichard Genoud 		idr |= ATMEL_US_CTSIC;
61035b675b9SRichard Genoud 
61118dfef9cSUwe Kleine-König 	if (!mctrl_gpio_to_gpiod(atmel_port->gpios, UART_GPIO_DSR))
61235b675b9SRichard Genoud 		idr |= ATMEL_US_DSRIC;
61335b675b9SRichard Genoud 
61418dfef9cSUwe Kleine-König 	if (!mctrl_gpio_to_gpiod(atmel_port->gpios, UART_GPIO_RI))
61535b675b9SRichard Genoud 		idr |= ATMEL_US_RIIC;
61635b675b9SRichard Genoud 
61718dfef9cSUwe Kleine-König 	if (!mctrl_gpio_to_gpiod(atmel_port->gpios, UART_GPIO_DCD))
61835b675b9SRichard Genoud 		idr |= ATMEL_US_DCDIC;
61935b675b9SRichard Genoud 
6204e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_IDR, idr);
62135b675b9SRichard Genoud }
62235b675b9SRichard Genoud 
62335b675b9SRichard Genoud /*
624ab4382d2SGreg Kroah-Hartman  * Control the transmission of a break signal
625ab4382d2SGreg Kroah-Hartman  */
626ab4382d2SGreg Kroah-Hartman static void atmel_break_ctl(struct uart_port *port, int break_state)
627ab4382d2SGreg Kroah-Hartman {
628ab4382d2SGreg Kroah-Hartman 	if (break_state != 0)
6294e7decdaSCyrille Pitchen 		/* start break */
6304e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_STTBRK);
631ab4382d2SGreg Kroah-Hartman 	else
6324e7decdaSCyrille Pitchen 		/* stop break */
6334e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_STPBRK);
634ab4382d2SGreg Kroah-Hartman }
635ab4382d2SGreg Kroah-Hartman 
636ab4382d2SGreg Kroah-Hartman /*
637ab4382d2SGreg Kroah-Hartman  * Stores the incoming character in the ring buffer
638ab4382d2SGreg Kroah-Hartman  */
639ab4382d2SGreg Kroah-Hartman static void
640ab4382d2SGreg Kroah-Hartman atmel_buffer_rx_char(struct uart_port *port, unsigned int status,
641ab4382d2SGreg Kroah-Hartman 		     unsigned int ch)
642ab4382d2SGreg Kroah-Hartman {
643ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
644ab4382d2SGreg Kroah-Hartman 	struct circ_buf *ring = &atmel_port->rx_ring;
645ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_char *c;
646ab4382d2SGreg Kroah-Hartman 
647ab4382d2SGreg Kroah-Hartman 	if (!CIRC_SPACE(ring->head, ring->tail, ATMEL_SERIAL_RINGSIZE))
648ab4382d2SGreg Kroah-Hartman 		/* Buffer overflow, ignore char */
649ab4382d2SGreg Kroah-Hartman 		return;
650ab4382d2SGreg Kroah-Hartman 
651ab4382d2SGreg Kroah-Hartman 	c = &((struct atmel_uart_char *)ring->buf)[ring->head];
652ab4382d2SGreg Kroah-Hartman 	c->status	= status;
653ab4382d2SGreg Kroah-Hartman 	c->ch		= ch;
654ab4382d2SGreg Kroah-Hartman 
655ab4382d2SGreg Kroah-Hartman 	/* Make sure the character is stored before we update head. */
656ab4382d2SGreg Kroah-Hartman 	smp_wmb();
657ab4382d2SGreg Kroah-Hartman 
658ab4382d2SGreg Kroah-Hartman 	ring->head = (ring->head + 1) & (ATMEL_SERIAL_RINGSIZE - 1);
659ab4382d2SGreg Kroah-Hartman }
660ab4382d2SGreg Kroah-Hartman 
661ab4382d2SGreg Kroah-Hartman /*
662ab4382d2SGreg Kroah-Hartman  * Deal with parity, framing and overrun errors.
663ab4382d2SGreg Kroah-Hartman  */
664ab4382d2SGreg Kroah-Hartman static void atmel_pdc_rxerr(struct uart_port *port, unsigned int status)
665ab4382d2SGreg Kroah-Hartman {
666ab4382d2SGreg Kroah-Hartman 	/* clear error */
6674e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_RSTSTA);
668ab4382d2SGreg Kroah-Hartman 
669ab4382d2SGreg Kroah-Hartman 	if (status & ATMEL_US_RXBRK) {
670ab4382d2SGreg Kroah-Hartman 		/* ignore side-effect */
671ab4382d2SGreg Kroah-Hartman 		status &= ~(ATMEL_US_PARE | ATMEL_US_FRAME);
672ab4382d2SGreg Kroah-Hartman 		port->icount.brk++;
673ab4382d2SGreg Kroah-Hartman 	}
674ab4382d2SGreg Kroah-Hartman 	if (status & ATMEL_US_PARE)
675ab4382d2SGreg Kroah-Hartman 		port->icount.parity++;
676ab4382d2SGreg Kroah-Hartman 	if (status & ATMEL_US_FRAME)
677ab4382d2SGreg Kroah-Hartman 		port->icount.frame++;
678ab4382d2SGreg Kroah-Hartman 	if (status & ATMEL_US_OVRE)
679ab4382d2SGreg Kroah-Hartman 		port->icount.overrun++;
680ab4382d2SGreg Kroah-Hartman }
681ab4382d2SGreg Kroah-Hartman 
682ab4382d2SGreg Kroah-Hartman /*
683ab4382d2SGreg Kroah-Hartman  * Characters received (called from interrupt handler)
684ab4382d2SGreg Kroah-Hartman  */
685ab4382d2SGreg Kroah-Hartman static void atmel_rx_chars(struct uart_port *port)
686ab4382d2SGreg Kroah-Hartman {
687ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
688ab4382d2SGreg Kroah-Hartman 	unsigned int status, ch;
689ab4382d2SGreg Kroah-Hartman 
6904e7decdaSCyrille Pitchen 	status = atmel_uart_readl(port, ATMEL_US_CSR);
691ab4382d2SGreg Kroah-Hartman 	while (status & ATMEL_US_RXRDY) {
692a6499435SCyrille Pitchen 		ch = atmel_uart_read_char(port);
693ab4382d2SGreg Kroah-Hartman 
694ab4382d2SGreg Kroah-Hartman 		/*
695ab4382d2SGreg Kroah-Hartman 		 * note that the error handling code is
696ab4382d2SGreg Kroah-Hartman 		 * out of the main execution path
697ab4382d2SGreg Kroah-Hartman 		 */
698ab4382d2SGreg Kroah-Hartman 		if (unlikely(status & (ATMEL_US_PARE | ATMEL_US_FRAME
699ab4382d2SGreg Kroah-Hartman 				       | ATMEL_US_OVRE | ATMEL_US_RXBRK)
700ab4382d2SGreg Kroah-Hartman 			     || atmel_port->break_active)) {
701ab4382d2SGreg Kroah-Hartman 
702ab4382d2SGreg Kroah-Hartman 			/* clear error */
7034e7decdaSCyrille Pitchen 			atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_RSTSTA);
704ab4382d2SGreg Kroah-Hartman 
705ab4382d2SGreg Kroah-Hartman 			if (status & ATMEL_US_RXBRK
706ab4382d2SGreg Kroah-Hartman 			    && !atmel_port->break_active) {
707ab4382d2SGreg Kroah-Hartman 				atmel_port->break_active = 1;
7084e7decdaSCyrille Pitchen 				atmel_uart_writel(port, ATMEL_US_IER,
7094e7decdaSCyrille Pitchen 						  ATMEL_US_RXBRK);
710ab4382d2SGreg Kroah-Hartman 			} else {
711ab4382d2SGreg Kroah-Hartman 				/*
712ab4382d2SGreg Kroah-Hartman 				 * This is either the end-of-break
713ab4382d2SGreg Kroah-Hartman 				 * condition or we've received at
714ab4382d2SGreg Kroah-Hartman 				 * least one character without RXBRK
715ab4382d2SGreg Kroah-Hartman 				 * being set. In both cases, the next
716ab4382d2SGreg Kroah-Hartman 				 * RXBRK will indicate start-of-break.
717ab4382d2SGreg Kroah-Hartman 				 */
7184e7decdaSCyrille Pitchen 				atmel_uart_writel(port, ATMEL_US_IDR,
7194e7decdaSCyrille Pitchen 						  ATMEL_US_RXBRK);
720ab4382d2SGreg Kroah-Hartman 				status &= ~ATMEL_US_RXBRK;
721ab4382d2SGreg Kroah-Hartman 				atmel_port->break_active = 0;
722ab4382d2SGreg Kroah-Hartman 			}
723ab4382d2SGreg Kroah-Hartman 		}
724ab4382d2SGreg Kroah-Hartman 
725ab4382d2SGreg Kroah-Hartman 		atmel_buffer_rx_char(port, status, ch);
7264e7decdaSCyrille Pitchen 		status = atmel_uart_readl(port, ATMEL_US_CSR);
727ab4382d2SGreg Kroah-Hartman 	}
728ab4382d2SGreg Kroah-Hartman 
72998f2082cSNicolas Ferre 	atmel_tasklet_schedule(atmel_port, &atmel_port->tasklet_rx);
730ab4382d2SGreg Kroah-Hartman }
731ab4382d2SGreg Kroah-Hartman 
732ab4382d2SGreg Kroah-Hartman /*
733ab4382d2SGreg Kroah-Hartman  * Transmit characters (called from tasklet with TXRDY interrupt
734ab4382d2SGreg Kroah-Hartman  * disabled)
735ab4382d2SGreg Kroah-Hartman  */
736ab4382d2SGreg Kroah-Hartman static void atmel_tx_chars(struct uart_port *port)
737ab4382d2SGreg Kroah-Hartman {
738ab4382d2SGreg Kroah-Hartman 	struct circ_buf *xmit = &port->state->xmit;
739ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
740ab4382d2SGreg Kroah-Hartman 
7414e7decdaSCyrille Pitchen 	if (port->x_char &&
7424e7decdaSCyrille Pitchen 	    (atmel_uart_readl(port, ATMEL_US_CSR) & atmel_port->tx_done_mask)) {
743a6499435SCyrille Pitchen 		atmel_uart_write_char(port, port->x_char);
744ab4382d2SGreg Kroah-Hartman 		port->icount.tx++;
745ab4382d2SGreg Kroah-Hartman 		port->x_char = 0;
746ab4382d2SGreg Kroah-Hartman 	}
747ab4382d2SGreg Kroah-Hartman 	if (uart_circ_empty(xmit) || uart_tx_stopped(port))
748ab4382d2SGreg Kroah-Hartman 		return;
749ab4382d2SGreg Kroah-Hartman 
7504e7decdaSCyrille Pitchen 	while (atmel_uart_readl(port, ATMEL_US_CSR) &
7514e7decdaSCyrille Pitchen 	       atmel_port->tx_done_mask) {
752a6499435SCyrille Pitchen 		atmel_uart_write_char(port, xmit->buf[xmit->tail]);
753ab4382d2SGreg Kroah-Hartman 		xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
754ab4382d2SGreg Kroah-Hartman 		port->icount.tx++;
755ab4382d2SGreg Kroah-Hartman 		if (uart_circ_empty(xmit))
756ab4382d2SGreg Kroah-Hartman 			break;
757ab4382d2SGreg Kroah-Hartman 	}
758ab4382d2SGreg Kroah-Hartman 
759ab4382d2SGreg Kroah-Hartman 	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
760ab4382d2SGreg Kroah-Hartman 		uart_write_wakeup(port);
761ab4382d2SGreg Kroah-Hartman 
762ab4382d2SGreg Kroah-Hartman 	if (!uart_circ_empty(xmit))
763ab4382d2SGreg Kroah-Hartman 		/* Enable interrupts */
7644e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_IER,
7654e7decdaSCyrille Pitchen 				  atmel_port->tx_done_mask);
766ab4382d2SGreg Kroah-Hartman }
767ab4382d2SGreg Kroah-Hartman 
76808f738beSElen Song static void atmel_complete_tx_dma(void *arg)
76908f738beSElen Song {
77008f738beSElen Song 	struct atmel_uart_port *atmel_port = arg;
77108f738beSElen Song 	struct uart_port *port = &atmel_port->uart;
77208f738beSElen Song 	struct circ_buf *xmit = &port->state->xmit;
77308f738beSElen Song 	struct dma_chan *chan = atmel_port->chan_tx;
77408f738beSElen Song 	unsigned long flags;
77508f738beSElen Song 
77608f738beSElen Song 	spin_lock_irqsave(&port->lock, flags);
77708f738beSElen Song 
77808f738beSElen Song 	if (chan)
77908f738beSElen Song 		dmaengine_terminate_all(chan);
7805f258b3eSCyrille Pitchen 	xmit->tail += atmel_port->tx_len;
78108f738beSElen Song 	xmit->tail &= UART_XMIT_SIZE - 1;
78208f738beSElen Song 
7835f258b3eSCyrille Pitchen 	port->icount.tx += atmel_port->tx_len;
78408f738beSElen Song 
78508f738beSElen Song 	spin_lock_irq(&atmel_port->lock_tx);
78608f738beSElen Song 	async_tx_ack(atmel_port->desc_tx);
78708f738beSElen Song 	atmel_port->cookie_tx = -EINVAL;
78808f738beSElen Song 	atmel_port->desc_tx = NULL;
78908f738beSElen Song 	spin_unlock_irq(&atmel_port->lock_tx);
79008f738beSElen Song 
79108f738beSElen Song 	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
79208f738beSElen Song 		uart_write_wakeup(port);
79308f738beSElen Song 
7941842dc2eSCyrille Pitchen 	/*
7951842dc2eSCyrille Pitchen 	 * xmit is a circular buffer so, if we have just send data from
7961842dc2eSCyrille Pitchen 	 * xmit->tail to the end of xmit->buf, now we have to transmit the
7971842dc2eSCyrille Pitchen 	 * remaining data from the beginning of xmit->buf to xmit->head.
7981842dc2eSCyrille Pitchen 	 */
79908f738beSElen Song 	if (!uart_circ_empty(xmit))
80098f2082cSNicolas Ferre 		atmel_tasklet_schedule(atmel_port, &atmel_port->tasklet_tx);
80108f738beSElen Song 
80208f738beSElen Song 	spin_unlock_irqrestore(&port->lock, flags);
80308f738beSElen Song }
80408f738beSElen Song 
80508f738beSElen Song static void atmel_release_tx_dma(struct uart_port *port)
80608f738beSElen Song {
80708f738beSElen Song 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
80808f738beSElen Song 	struct dma_chan *chan = atmel_port->chan_tx;
80908f738beSElen Song 
81008f738beSElen Song 	if (chan) {
81108f738beSElen Song 		dmaengine_terminate_all(chan);
81208f738beSElen Song 		dma_release_channel(chan);
81308f738beSElen Song 		dma_unmap_sg(port->dev, &atmel_port->sg_tx, 1,
81448479148SWolfram Sang 				DMA_TO_DEVICE);
81508f738beSElen Song 	}
81608f738beSElen Song 
81708f738beSElen Song 	atmel_port->desc_tx = NULL;
81808f738beSElen Song 	atmel_port->chan_tx = NULL;
81908f738beSElen Song 	atmel_port->cookie_tx = -EINVAL;
82008f738beSElen Song }
82108f738beSElen Song 
82208f738beSElen Song /*
82308f738beSElen Song  * Called from tasklet with TXRDY interrupt is disabled.
82408f738beSElen Song  */
82508f738beSElen Song static void atmel_tx_dma(struct uart_port *port)
82608f738beSElen Song {
82708f738beSElen Song 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
82808f738beSElen Song 	struct circ_buf *xmit = &port->state->xmit;
82908f738beSElen Song 	struct dma_chan *chan = atmel_port->chan_tx;
83008f738beSElen Song 	struct dma_async_tx_descriptor *desc;
8315f258b3eSCyrille Pitchen 	struct scatterlist sgl[2], *sg, *sg_tx = &atmel_port->sg_tx;
8325f258b3eSCyrille Pitchen 	unsigned int tx_len, part1_len, part2_len, sg_len;
8335f258b3eSCyrille Pitchen 	dma_addr_t phys_addr;
83408f738beSElen Song 
83508f738beSElen Song 	/* Make sure we have an idle channel */
83608f738beSElen Song 	if (atmel_port->desc_tx != NULL)
83708f738beSElen Song 		return;
83808f738beSElen Song 
83908f738beSElen Song 	if (!uart_circ_empty(xmit) && !uart_tx_stopped(port)) {
84008f738beSElen Song 		/*
84108f738beSElen Song 		 * DMA is idle now.
84208f738beSElen Song 		 * Port xmit buffer is already mapped,
84308f738beSElen Song 		 * and it is one page... Just adjust
84408f738beSElen Song 		 * offsets and lengths. Since it is a circular buffer,
84508f738beSElen Song 		 * we have to transmit till the end, and then the rest.
84608f738beSElen Song 		 * Take the port lock to get a
84708f738beSElen Song 		 * consistent xmit buffer state.
84808f738beSElen Song 		 */
8495f258b3eSCyrille Pitchen 		tx_len = CIRC_CNT_TO_END(xmit->head,
85008f738beSElen Song 					 xmit->tail,
85108f738beSElen Song 					 UART_XMIT_SIZE);
8525f258b3eSCyrille Pitchen 
8535f258b3eSCyrille Pitchen 		if (atmel_port->fifo_size) {
8545f258b3eSCyrille Pitchen 			/* multi data mode */
8555f258b3eSCyrille Pitchen 			part1_len = (tx_len & ~0x3); /* DWORD access */
8565f258b3eSCyrille Pitchen 			part2_len = (tx_len & 0x3); /* BYTE access */
8575f258b3eSCyrille Pitchen 		} else {
8585f258b3eSCyrille Pitchen 			/* single data (legacy) mode */
8595f258b3eSCyrille Pitchen 			part1_len = 0;
8605f258b3eSCyrille Pitchen 			part2_len = tx_len; /* BYTE access only */
8615f258b3eSCyrille Pitchen 		}
8625f258b3eSCyrille Pitchen 
8635f258b3eSCyrille Pitchen 		sg_init_table(sgl, 2);
8645f258b3eSCyrille Pitchen 		sg_len = 0;
8655f258b3eSCyrille Pitchen 		phys_addr = sg_dma_address(sg_tx) + xmit->tail;
8665f258b3eSCyrille Pitchen 		if (part1_len) {
8675f258b3eSCyrille Pitchen 			sg = &sgl[sg_len++];
8685f258b3eSCyrille Pitchen 			sg_dma_address(sg) = phys_addr;
8695f258b3eSCyrille Pitchen 			sg_dma_len(sg) = part1_len;
8705f258b3eSCyrille Pitchen 
8715f258b3eSCyrille Pitchen 			phys_addr += part1_len;
8725f258b3eSCyrille Pitchen 		}
8735f258b3eSCyrille Pitchen 
8745f258b3eSCyrille Pitchen 		if (part2_len) {
8755f258b3eSCyrille Pitchen 			sg = &sgl[sg_len++];
8765f258b3eSCyrille Pitchen 			sg_dma_address(sg) = phys_addr;
8775f258b3eSCyrille Pitchen 			sg_dma_len(sg) = part2_len;
8785f258b3eSCyrille Pitchen 		}
8795f258b3eSCyrille Pitchen 
8805f258b3eSCyrille Pitchen 		/*
8815f258b3eSCyrille Pitchen 		 * save tx_len so atmel_complete_tx_dma() will increase
8825f258b3eSCyrille Pitchen 		 * xmit->tail correctly
8835f258b3eSCyrille Pitchen 		 */
8845f258b3eSCyrille Pitchen 		atmel_port->tx_len = tx_len;
88508f738beSElen Song 
88608f738beSElen Song 		desc = dmaengine_prep_slave_sg(chan,
8875f258b3eSCyrille Pitchen 					       sgl,
8885f258b3eSCyrille Pitchen 					       sg_len,
88908f738beSElen Song 					       DMA_MEM_TO_DEV,
89008f738beSElen Song 					       DMA_PREP_INTERRUPT |
89108f738beSElen Song 					       DMA_CTRL_ACK);
89208f738beSElen Song 		if (!desc) {
89308f738beSElen Song 			dev_err(port->dev, "Failed to send via dma!\n");
89408f738beSElen Song 			return;
89508f738beSElen Song 		}
89608f738beSElen Song 
8975f258b3eSCyrille Pitchen 		dma_sync_sg_for_device(port->dev, sg_tx, 1, DMA_TO_DEVICE);
89808f738beSElen Song 
89908f738beSElen Song 		atmel_port->desc_tx = desc;
90008f738beSElen Song 		desc->callback = atmel_complete_tx_dma;
90108f738beSElen Song 		desc->callback_param = atmel_port;
90208f738beSElen Song 		atmel_port->cookie_tx = dmaengine_submit(desc);
90308f738beSElen Song 
90408f738beSElen Song 	} else {
90513bd3e6fSRicardo Ribalda Delgado 		if (port->rs485.flags & SER_RS485_ENABLED) {
90608f738beSElen Song 			/* DMA done, stop TX, start RX for RS485 */
90708f738beSElen Song 			atmel_start_rx(port);
90808f738beSElen Song 		}
90908f738beSElen Song 	}
91008f738beSElen Song 
91108f738beSElen Song 	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
91208f738beSElen Song 		uart_write_wakeup(port);
91308f738beSElen Song }
91408f738beSElen Song 
91508f738beSElen Song static int atmel_prepare_tx_dma(struct uart_port *port)
91608f738beSElen Song {
91708f738beSElen Song 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
91808f738beSElen Song 	dma_cap_mask_t		mask;
91908f738beSElen Song 	struct dma_slave_config config;
92008f738beSElen Song 	int ret, nent;
92108f738beSElen Song 
92208f738beSElen Song 	dma_cap_zero(mask);
92308f738beSElen Song 	dma_cap_set(DMA_SLAVE, mask);
92408f738beSElen Song 
92508f738beSElen Song 	atmel_port->chan_tx = dma_request_slave_channel(port->dev, "tx");
92608f738beSElen Song 	if (atmel_port->chan_tx == NULL)
92708f738beSElen Song 		goto chan_err;
92808f738beSElen Song 	dev_info(port->dev, "using %s for tx DMA transfers\n",
92908f738beSElen Song 		dma_chan_name(atmel_port->chan_tx));
93008f738beSElen Song 
93108f738beSElen Song 	spin_lock_init(&atmel_port->lock_tx);
93208f738beSElen Song 	sg_init_table(&atmel_port->sg_tx, 1);
93308f738beSElen Song 	/* UART circular tx buffer is an aligned page. */
9342c277054SLeilei Zhao 	BUG_ON(!PAGE_ALIGNED(port->state->xmit.buf));
93508f738beSElen Song 	sg_set_page(&atmel_port->sg_tx,
93608f738beSElen Song 			virt_to_page(port->state->xmit.buf),
93708f738beSElen Song 			UART_XMIT_SIZE,
938c8d1f022SUwe Kleine-König 			(unsigned long)port->state->xmit.buf & ~PAGE_MASK);
93908f738beSElen Song 	nent = dma_map_sg(port->dev,
94008f738beSElen Song 				&atmel_port->sg_tx,
94108f738beSElen Song 				1,
94248479148SWolfram Sang 				DMA_TO_DEVICE);
94308f738beSElen Song 
94408f738beSElen Song 	if (!nent) {
94508f738beSElen Song 		dev_dbg(port->dev, "need to release resource of dma\n");
94608f738beSElen Song 		goto chan_err;
94708f738beSElen Song 	} else {
948c8d1f022SUwe Kleine-König 		dev_dbg(port->dev, "%s: mapped %d@%p to %pad\n", __func__,
94908f738beSElen Song 			sg_dma_len(&atmel_port->sg_tx),
95008f738beSElen Song 			port->state->xmit.buf,
951c8d1f022SUwe Kleine-König 			&sg_dma_address(&atmel_port->sg_tx));
95208f738beSElen Song 	}
95308f738beSElen Song 
95408f738beSElen Song 	/* Configure the slave DMA */
95508f738beSElen Song 	memset(&config, 0, sizeof(config));
95608f738beSElen Song 	config.direction = DMA_MEM_TO_DEV;
9575f258b3eSCyrille Pitchen 	config.dst_addr_width = (atmel_port->fifo_size) ?
9585f258b3eSCyrille Pitchen 				DMA_SLAVE_BUSWIDTH_4_BYTES :
9595f258b3eSCyrille Pitchen 				DMA_SLAVE_BUSWIDTH_1_BYTE;
96008f738beSElen Song 	config.dst_addr = port->mapbase + ATMEL_US_THR;
961a8d4e016SLudovic Desroches 	config.dst_maxburst = 1;
96208f738beSElen Song 
9635483c10eSMaxime Ripard 	ret = dmaengine_slave_config(atmel_port->chan_tx,
9645483c10eSMaxime Ripard 				     &config);
96508f738beSElen Song 	if (ret) {
96608f738beSElen Song 		dev_err(port->dev, "DMA tx slave configuration failed\n");
96708f738beSElen Song 		goto chan_err;
96808f738beSElen Song 	}
96908f738beSElen Song 
97008f738beSElen Song 	return 0;
97108f738beSElen Song 
97208f738beSElen Song chan_err:
97308f738beSElen Song 	dev_err(port->dev, "TX channel not available, switch to pio\n");
97408f738beSElen Song 	atmel_port->use_dma_tx = 0;
97508f738beSElen Song 	if (atmel_port->chan_tx)
97608f738beSElen Song 		atmel_release_tx_dma(port);
97708f738beSElen Song 	return -EINVAL;
97808f738beSElen Song }
97908f738beSElen Song 
98034df42f5SElen Song static void atmel_complete_rx_dma(void *arg)
98134df42f5SElen Song {
98234df42f5SElen Song 	struct uart_port *port = arg;
98334df42f5SElen Song 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
98434df42f5SElen Song 
98598f2082cSNicolas Ferre 	atmel_tasklet_schedule(atmel_port, &atmel_port->tasklet_rx);
98634df42f5SElen Song }
98734df42f5SElen Song 
98834df42f5SElen Song static void atmel_release_rx_dma(struct uart_port *port)
98934df42f5SElen Song {
99034df42f5SElen Song 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
99134df42f5SElen Song 	struct dma_chan *chan = atmel_port->chan_rx;
99234df42f5SElen Song 
99334df42f5SElen Song 	if (chan) {
99434df42f5SElen Song 		dmaengine_terminate_all(chan);
99534df42f5SElen Song 		dma_release_channel(chan);
99634df42f5SElen Song 		dma_unmap_sg(port->dev, &atmel_port->sg_rx, 1,
99748479148SWolfram Sang 				DMA_FROM_DEVICE);
99834df42f5SElen Song 	}
99934df42f5SElen Song 
100034df42f5SElen Song 	atmel_port->desc_rx = NULL;
100134df42f5SElen Song 	atmel_port->chan_rx = NULL;
100234df42f5SElen Song 	atmel_port->cookie_rx = -EINVAL;
100334df42f5SElen Song }
100434df42f5SElen Song 
100534df42f5SElen Song static void atmel_rx_from_dma(struct uart_port *port)
100634df42f5SElen Song {
100734df42f5SElen Song 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
100866f37aafSCyrille Pitchen 	struct tty_port *tport = &port->state->port;
100934df42f5SElen Song 	struct circ_buf *ring = &atmel_port->rx_ring;
101034df42f5SElen Song 	struct dma_chan *chan = atmel_port->chan_rx;
101134df42f5SElen Song 	struct dma_tx_state state;
101234df42f5SElen Song 	enum dma_status dmastat;
101366f37aafSCyrille Pitchen 	size_t count;
101434df42f5SElen Song 
101534df42f5SElen Song 
101634df42f5SElen Song 	/* Reset the UART timeout early so that we don't miss one */
10174e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_STTTO);
101834df42f5SElen Song 	dmastat = dmaengine_tx_status(chan,
101934df42f5SElen Song 				atmel_port->cookie_rx,
102034df42f5SElen Song 				&state);
102134df42f5SElen Song 	/* Restart a new tasklet if DMA status is error */
102234df42f5SElen Song 	if (dmastat == DMA_ERROR) {
102334df42f5SElen Song 		dev_dbg(port->dev, "Get residue error, restart tasklet\n");
10244e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_IER, ATMEL_US_TIMEOUT);
102598f2082cSNicolas Ferre 		atmel_tasklet_schedule(atmel_port, &atmel_port->tasklet_rx);
102634df42f5SElen Song 		return;
102734df42f5SElen Song 	}
102866f37aafSCyrille Pitchen 
102966f37aafSCyrille Pitchen 	/* CPU claims ownership of RX DMA buffer */
103066f37aafSCyrille Pitchen 	dma_sync_sg_for_cpu(port->dev,
103166f37aafSCyrille Pitchen 			    &atmel_port->sg_rx,
103266f37aafSCyrille Pitchen 			    1,
1033485819b5SCyrille Pitchen 			    DMA_FROM_DEVICE);
103434df42f5SElen Song 
103534df42f5SElen Song 	/*
103666f37aafSCyrille Pitchen 	 * ring->head points to the end of data already written by the DMA.
103766f37aafSCyrille Pitchen 	 * ring->tail points to the beginning of data to be read by the
103866f37aafSCyrille Pitchen 	 * framework.
103966f37aafSCyrille Pitchen 	 * The current transfer size should not be larger than the dma buffer
104066f37aafSCyrille Pitchen 	 * length.
104134df42f5SElen Song 	 */
104266f37aafSCyrille Pitchen 	ring->head = sg_dma_len(&atmel_port->sg_rx) - state.residue;
104366f37aafSCyrille Pitchen 	BUG_ON(ring->head > sg_dma_len(&atmel_port->sg_rx));
104466f37aafSCyrille Pitchen 	/*
104566f37aafSCyrille Pitchen 	 * At this point ring->head may point to the first byte right after the
104666f37aafSCyrille Pitchen 	 * last byte of the dma buffer:
104766f37aafSCyrille Pitchen 	 * 0 <= ring->head <= sg_dma_len(&atmel_port->sg_rx)
104866f37aafSCyrille Pitchen 	 *
104966f37aafSCyrille Pitchen 	 * However ring->tail must always points inside the dma buffer:
105066f37aafSCyrille Pitchen 	 * 0 <= ring->tail <= sg_dma_len(&atmel_port->sg_rx) - 1
105166f37aafSCyrille Pitchen 	 *
105266f37aafSCyrille Pitchen 	 * Since we use a ring buffer, we have to handle the case
105366f37aafSCyrille Pitchen 	 * where head is lower than tail. In such a case, we first read from
105466f37aafSCyrille Pitchen 	 * tail to the end of the buffer then reset tail.
105566f37aafSCyrille Pitchen 	 */
105666f37aafSCyrille Pitchen 	if (ring->head < ring->tail) {
105766f37aafSCyrille Pitchen 		count = sg_dma_len(&atmel_port->sg_rx) - ring->tail;
105834df42f5SElen Song 
105966f37aafSCyrille Pitchen 		tty_insert_flip_string(tport, ring->buf + ring->tail, count);
106066f37aafSCyrille Pitchen 		ring->tail = 0;
106134df42f5SElen Song 		port->icount.rx += count;
106234df42f5SElen Song 	}
106334df42f5SElen Song 
106466f37aafSCyrille Pitchen 	/* Finally we read data from tail to head */
106566f37aafSCyrille Pitchen 	if (ring->tail < ring->head) {
106666f37aafSCyrille Pitchen 		count = ring->head - ring->tail;
106766f37aafSCyrille Pitchen 
106866f37aafSCyrille Pitchen 		tty_insert_flip_string(tport, ring->buf + ring->tail, count);
106966f37aafSCyrille Pitchen 		/* Wrap ring->head if needed */
107066f37aafSCyrille Pitchen 		if (ring->head >= sg_dma_len(&atmel_port->sg_rx))
107166f37aafSCyrille Pitchen 			ring->head = 0;
107266f37aafSCyrille Pitchen 		ring->tail = ring->head;
107366f37aafSCyrille Pitchen 		port->icount.rx += count;
107466f37aafSCyrille Pitchen 	}
107566f37aafSCyrille Pitchen 
107666f37aafSCyrille Pitchen 	/* USART retreives ownership of RX DMA buffer */
107766f37aafSCyrille Pitchen 	dma_sync_sg_for_device(port->dev,
107866f37aafSCyrille Pitchen 			       &atmel_port->sg_rx,
107966f37aafSCyrille Pitchen 			       1,
1080485819b5SCyrille Pitchen 			       DMA_FROM_DEVICE);
108166f37aafSCyrille Pitchen 
108266f37aafSCyrille Pitchen 	/*
108366f37aafSCyrille Pitchen 	 * Drop the lock here since it might end up calling
108466f37aafSCyrille Pitchen 	 * uart_start(), which takes the lock.
108566f37aafSCyrille Pitchen 	 */
108666f37aafSCyrille Pitchen 	spin_unlock(&port->lock);
108766f37aafSCyrille Pitchen 	tty_flip_buffer_push(tport);
108866f37aafSCyrille Pitchen 	spin_lock(&port->lock);
108966f37aafSCyrille Pitchen 
10904e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_IER, ATMEL_US_TIMEOUT);
109134df42f5SElen Song }
109234df42f5SElen Song 
109334df42f5SElen Song static int atmel_prepare_rx_dma(struct uart_port *port)
109434df42f5SElen Song {
109534df42f5SElen Song 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
109634df42f5SElen Song 	struct dma_async_tx_descriptor *desc;
109734df42f5SElen Song 	dma_cap_mask_t		mask;
109834df42f5SElen Song 	struct dma_slave_config config;
109934df42f5SElen Song 	struct circ_buf		*ring;
110034df42f5SElen Song 	int ret, nent;
110134df42f5SElen Song 
110234df42f5SElen Song 	ring = &atmel_port->rx_ring;
110334df42f5SElen Song 
110434df42f5SElen Song 	dma_cap_zero(mask);
110534df42f5SElen Song 	dma_cap_set(DMA_CYCLIC, mask);
110634df42f5SElen Song 
110734df42f5SElen Song 	atmel_port->chan_rx = dma_request_slave_channel(port->dev, "rx");
110834df42f5SElen Song 	if (atmel_port->chan_rx == NULL)
110934df42f5SElen Song 		goto chan_err;
111034df42f5SElen Song 	dev_info(port->dev, "using %s for rx DMA transfers\n",
111134df42f5SElen Song 		dma_chan_name(atmel_port->chan_rx));
111234df42f5SElen Song 
111334df42f5SElen Song 	spin_lock_init(&atmel_port->lock_rx);
111434df42f5SElen Song 	sg_init_table(&atmel_port->sg_rx, 1);
111534df42f5SElen Song 	/* UART circular rx buffer is an aligned page. */
11162c277054SLeilei Zhao 	BUG_ON(!PAGE_ALIGNED(ring->buf));
111734df42f5SElen Song 	sg_set_page(&atmel_port->sg_rx,
111834df42f5SElen Song 		    virt_to_page(ring->buf),
1119a510880fSLeilei Zhao 		    sizeof(struct atmel_uart_char) * ATMEL_SERIAL_RINGSIZE,
1120c8d1f022SUwe Kleine-König 		    (unsigned long)ring->buf & ~PAGE_MASK);
112134df42f5SElen Song 	nent = dma_map_sg(port->dev,
112234df42f5SElen Song 			  &atmel_port->sg_rx,
112334df42f5SElen Song 			  1,
112448479148SWolfram Sang 			  DMA_FROM_DEVICE);
112534df42f5SElen Song 
112634df42f5SElen Song 	if (!nent) {
112734df42f5SElen Song 		dev_dbg(port->dev, "need to release resource of dma\n");
112834df42f5SElen Song 		goto chan_err;
112934df42f5SElen Song 	} else {
1130c8d1f022SUwe Kleine-König 		dev_dbg(port->dev, "%s: mapped %d@%p to %pad\n", __func__,
113134df42f5SElen Song 			sg_dma_len(&atmel_port->sg_rx),
113234df42f5SElen Song 			ring->buf,
1133c8d1f022SUwe Kleine-König 			&sg_dma_address(&atmel_port->sg_rx));
113434df42f5SElen Song 	}
113534df42f5SElen Song 
113634df42f5SElen Song 	/* Configure the slave DMA */
113734df42f5SElen Song 	memset(&config, 0, sizeof(config));
113834df42f5SElen Song 	config.direction = DMA_DEV_TO_MEM;
113934df42f5SElen Song 	config.src_addr_width = DMA_SLAVE_BUSWIDTH_1_BYTE;
114034df42f5SElen Song 	config.src_addr = port->mapbase + ATMEL_US_RHR;
1141a8d4e016SLudovic Desroches 	config.src_maxburst = 1;
114234df42f5SElen Song 
11435483c10eSMaxime Ripard 	ret = dmaengine_slave_config(atmel_port->chan_rx,
11445483c10eSMaxime Ripard 				     &config);
114534df42f5SElen Song 	if (ret) {
114634df42f5SElen Song 		dev_err(port->dev, "DMA rx slave configuration failed\n");
114734df42f5SElen Song 		goto chan_err;
114834df42f5SElen Song 	}
114934df42f5SElen Song 	/*
115034df42f5SElen Song 	 * Prepare a cyclic dma transfer, assign 2 descriptors,
115134df42f5SElen Song 	 * each one is half ring buffer size
115234df42f5SElen Song 	 */
115334df42f5SElen Song 	desc = dmaengine_prep_dma_cyclic(atmel_port->chan_rx,
115434df42f5SElen Song 					 sg_dma_address(&atmel_port->sg_rx),
115534df42f5SElen Song 					 sg_dma_len(&atmel_port->sg_rx),
115634df42f5SElen Song 					 sg_dma_len(&atmel_port->sg_rx)/2,
115734df42f5SElen Song 					 DMA_DEV_TO_MEM,
115834df42f5SElen Song 					 DMA_PREP_INTERRUPT);
115934df42f5SElen Song 	desc->callback = atmel_complete_rx_dma;
116034df42f5SElen Song 	desc->callback_param = port;
116134df42f5SElen Song 	atmel_port->desc_rx = desc;
116234df42f5SElen Song 	atmel_port->cookie_rx = dmaengine_submit(desc);
116334df42f5SElen Song 
116434df42f5SElen Song 	return 0;
116534df42f5SElen Song 
116634df42f5SElen Song chan_err:
116734df42f5SElen Song 	dev_err(port->dev, "RX channel not available, switch to pio\n");
116834df42f5SElen Song 	atmel_port->use_dma_rx = 0;
116934df42f5SElen Song 	if (atmel_port->chan_rx)
117034df42f5SElen Song 		atmel_release_rx_dma(port);
117134df42f5SElen Song 	return -EINVAL;
117234df42f5SElen Song }
117334df42f5SElen Song 
11742e68c22fSElen Song static void atmel_uart_timer_callback(unsigned long data)
11752e68c22fSElen Song {
11762e68c22fSElen Song 	struct uart_port *port = (void *)data;
11772e68c22fSElen Song 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
11782e68c22fSElen Song 
117998f2082cSNicolas Ferre 	if (!atomic_read(&atmel_port->tasklet_shutdown)) {
118000e8e658SNicolas Ferre 		tasklet_schedule(&atmel_port->tasklet_rx);
118198f2082cSNicolas Ferre 		mod_timer(&atmel_port->uart_timer,
118298f2082cSNicolas Ferre 			  jiffies + uart_poll_timeout(port));
118398f2082cSNicolas Ferre 	}
11842e68c22fSElen Song }
11852e68c22fSElen Song 
1186ab4382d2SGreg Kroah-Hartman /*
1187ab4382d2SGreg Kroah-Hartman  * receive interrupt handler.
1188ab4382d2SGreg Kroah-Hartman  */
1189ab4382d2SGreg Kroah-Hartman static void
1190ab4382d2SGreg Kroah-Hartman atmel_handle_receive(struct uart_port *port, unsigned int pending)
1191ab4382d2SGreg Kroah-Hartman {
1192ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
1193ab4382d2SGreg Kroah-Hartman 
119464e22ebeSElen Song 	if (atmel_use_pdc_rx(port)) {
1195ab4382d2SGreg Kroah-Hartman 		/*
1196ab4382d2SGreg Kroah-Hartman 		 * PDC receive. Just schedule the tasklet and let it
1197ab4382d2SGreg Kroah-Hartman 		 * figure out the details.
1198ab4382d2SGreg Kroah-Hartman 		 *
1199ab4382d2SGreg Kroah-Hartman 		 * TODO: We're not handling error flags correctly at
1200ab4382d2SGreg Kroah-Hartman 		 * the moment.
1201ab4382d2SGreg Kroah-Hartman 		 */
1202ab4382d2SGreg Kroah-Hartman 		if (pending & (ATMEL_US_ENDRX | ATMEL_US_TIMEOUT)) {
12034e7decdaSCyrille Pitchen 			atmel_uart_writel(port, ATMEL_US_IDR,
12044e7decdaSCyrille Pitchen 					  (ATMEL_US_ENDRX | ATMEL_US_TIMEOUT));
120598f2082cSNicolas Ferre 			atmel_tasklet_schedule(atmel_port,
120698f2082cSNicolas Ferre 					       &atmel_port->tasklet_rx);
1207ab4382d2SGreg Kroah-Hartman 		}
1208ab4382d2SGreg Kroah-Hartman 
1209ab4382d2SGreg Kroah-Hartman 		if (pending & (ATMEL_US_RXBRK | ATMEL_US_OVRE |
1210ab4382d2SGreg Kroah-Hartman 				ATMEL_US_FRAME | ATMEL_US_PARE))
1211ab4382d2SGreg Kroah-Hartman 			atmel_pdc_rxerr(port, pending);
1212ab4382d2SGreg Kroah-Hartman 	}
1213ab4382d2SGreg Kroah-Hartman 
121434df42f5SElen Song 	if (atmel_use_dma_rx(port)) {
121534df42f5SElen Song 		if (pending & ATMEL_US_TIMEOUT) {
12164e7decdaSCyrille Pitchen 			atmel_uart_writel(port, ATMEL_US_IDR,
12174e7decdaSCyrille Pitchen 					  ATMEL_US_TIMEOUT);
121898f2082cSNicolas Ferre 			atmel_tasklet_schedule(atmel_port,
121998f2082cSNicolas Ferre 					       &atmel_port->tasklet_rx);
122034df42f5SElen Song 		}
122134df42f5SElen Song 	}
122234df42f5SElen Song 
1223ab4382d2SGreg Kroah-Hartman 	/* Interrupt receive */
1224ab4382d2SGreg Kroah-Hartman 	if (pending & ATMEL_US_RXRDY)
1225ab4382d2SGreg Kroah-Hartman 		atmel_rx_chars(port);
1226ab4382d2SGreg Kroah-Hartman 	else if (pending & ATMEL_US_RXBRK) {
1227ab4382d2SGreg Kroah-Hartman 		/*
1228ab4382d2SGreg Kroah-Hartman 		 * End of break detected. If it came along with a
1229ab4382d2SGreg Kroah-Hartman 		 * character, atmel_rx_chars will handle it.
1230ab4382d2SGreg Kroah-Hartman 		 */
12314e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_RSTSTA);
12324e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_IDR, ATMEL_US_RXBRK);
1233ab4382d2SGreg Kroah-Hartman 		atmel_port->break_active = 0;
1234ab4382d2SGreg Kroah-Hartman 	}
1235ab4382d2SGreg Kroah-Hartman }
1236ab4382d2SGreg Kroah-Hartman 
1237ab4382d2SGreg Kroah-Hartman /*
1238ab4382d2SGreg Kroah-Hartman  * transmit interrupt handler. (Transmit is IRQF_NODELAY safe)
1239ab4382d2SGreg Kroah-Hartman  */
1240ab4382d2SGreg Kroah-Hartman static void
1241ab4382d2SGreg Kroah-Hartman atmel_handle_transmit(struct uart_port *port, unsigned int pending)
1242ab4382d2SGreg Kroah-Hartman {
1243ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
1244ab4382d2SGreg Kroah-Hartman 
1245ab4382d2SGreg Kroah-Hartman 	if (pending & atmel_port->tx_done_mask) {
1246ab4382d2SGreg Kroah-Hartman 		/* Either PDC or interrupt transmission */
12474e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_IDR,
12484e7decdaSCyrille Pitchen 				  atmel_port->tx_done_mask);
124998f2082cSNicolas Ferre 		atmel_tasklet_schedule(atmel_port, &atmel_port->tasklet_tx);
1250ab4382d2SGreg Kroah-Hartman 	}
1251ab4382d2SGreg Kroah-Hartman }
1252ab4382d2SGreg Kroah-Hartman 
1253ab4382d2SGreg Kroah-Hartman /*
1254ab4382d2SGreg Kroah-Hartman  * status flags interrupt handler.
1255ab4382d2SGreg Kroah-Hartman  */
1256ab4382d2SGreg Kroah-Hartman static void
1257ab4382d2SGreg Kroah-Hartman atmel_handle_status(struct uart_port *port, unsigned int pending,
1258ab4382d2SGreg Kroah-Hartman 		    unsigned int status)
1259ab4382d2SGreg Kroah-Hartman {
1260ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
12619205218eSNicolas Ferre 	unsigned int status_change;
1262ab4382d2SGreg Kroah-Hartman 
1263ab4382d2SGreg Kroah-Hartman 	if (pending & (ATMEL_US_RIIC | ATMEL_US_DSRIC | ATMEL_US_DCDIC
1264ab4382d2SGreg Kroah-Hartman 				| ATMEL_US_CTSIC)) {
12659205218eSNicolas Ferre 		status_change = status ^ atmel_port->irq_status_prev;
1266d033e82dSLeilei Zhao 		atmel_port->irq_status_prev = status;
12679205218eSNicolas Ferre 
12689205218eSNicolas Ferre 		if (status_change & (ATMEL_US_RI | ATMEL_US_DSR
12699205218eSNicolas Ferre 					| ATMEL_US_DCD | ATMEL_US_CTS)) {
12709205218eSNicolas Ferre 			/* TODO: All reads to CSR will clear these interrupts! */
12719205218eSNicolas Ferre 			if (status_change & ATMEL_US_RI)
12729205218eSNicolas Ferre 				port->icount.rng++;
12739205218eSNicolas Ferre 			if (status_change & ATMEL_US_DSR)
12749205218eSNicolas Ferre 				port->icount.dsr++;
12759205218eSNicolas Ferre 			if (status_change & ATMEL_US_DCD)
12769205218eSNicolas Ferre 				uart_handle_dcd_change(port, !(status & ATMEL_US_DCD));
12779205218eSNicolas Ferre 			if (status_change & ATMEL_US_CTS)
12789205218eSNicolas Ferre 				uart_handle_cts_change(port, !(status & ATMEL_US_CTS));
12799205218eSNicolas Ferre 
12809205218eSNicolas Ferre 			wake_up_interruptible(&port->state->port.delta_msr_wait);
12819205218eSNicolas Ferre 		}
1282ab4382d2SGreg Kroah-Hartman 	}
1283ab4382d2SGreg Kroah-Hartman }
1284ab4382d2SGreg Kroah-Hartman 
1285ab4382d2SGreg Kroah-Hartman /*
1286ab4382d2SGreg Kroah-Hartman  * Interrupt handler
1287ab4382d2SGreg Kroah-Hartman  */
1288ab4382d2SGreg Kroah-Hartman static irqreturn_t atmel_interrupt(int irq, void *dev_id)
1289ab4382d2SGreg Kroah-Hartman {
1290ab4382d2SGreg Kroah-Hartman 	struct uart_port *port = dev_id;
1291ab5e4e41SRichard Genoud 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
12922c7af5baSBoris BREZILLON 	unsigned int status, pending, mask, pass_counter = 0;
1293ab4382d2SGreg Kroah-Hartman 
12942c7af5baSBoris BREZILLON 	spin_lock(&atmel_port->lock_suspended);
12952c7af5baSBoris BREZILLON 
1296ab4382d2SGreg Kroah-Hartman 	do {
1297e0b0baadSRichard Genoud 		status = atmel_get_lines_status(port);
12984e7decdaSCyrille Pitchen 		mask = atmel_uart_readl(port, ATMEL_US_IMR);
12992c7af5baSBoris BREZILLON 		pending = status & mask;
1300ab4382d2SGreg Kroah-Hartman 		if (!pending)
1301ab4382d2SGreg Kroah-Hartman 			break;
1302ab4382d2SGreg Kroah-Hartman 
13032c7af5baSBoris BREZILLON 		if (atmel_port->suspended) {
13042c7af5baSBoris BREZILLON 			atmel_port->pending |= pending;
13052c7af5baSBoris BREZILLON 			atmel_port->pending_status = status;
13064e7decdaSCyrille Pitchen 			atmel_uart_writel(port, ATMEL_US_IDR, mask);
13072c7af5baSBoris BREZILLON 			pm_system_wakeup();
13082c7af5baSBoris BREZILLON 			break;
13092c7af5baSBoris BREZILLON 		}
13102c7af5baSBoris BREZILLON 
1311ab4382d2SGreg Kroah-Hartman 		atmel_handle_receive(port, pending);
1312ab4382d2SGreg Kroah-Hartman 		atmel_handle_status(port, pending, status);
1313ab4382d2SGreg Kroah-Hartman 		atmel_handle_transmit(port, pending);
1314ab4382d2SGreg Kroah-Hartman 	} while (pass_counter++ < ATMEL_ISR_PASS_LIMIT);
1315ab4382d2SGreg Kroah-Hartman 
13162c7af5baSBoris BREZILLON 	spin_unlock(&atmel_port->lock_suspended);
13172c7af5baSBoris BREZILLON 
1318ab4382d2SGreg Kroah-Hartman 	return pass_counter ? IRQ_HANDLED : IRQ_NONE;
1319ab4382d2SGreg Kroah-Hartman }
1320ab4382d2SGreg Kroah-Hartman 
1321a930e528SElen Song static void atmel_release_tx_pdc(struct uart_port *port)
1322a930e528SElen Song {
1323a930e528SElen Song 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
1324a930e528SElen Song 	struct atmel_dma_buffer *pdc = &atmel_port->pdc_tx;
1325a930e528SElen Song 
1326a930e528SElen Song 	dma_unmap_single(port->dev,
1327a930e528SElen Song 			 pdc->dma_addr,
1328a930e528SElen Song 			 pdc->dma_size,
1329a930e528SElen Song 			 DMA_TO_DEVICE);
1330a930e528SElen Song }
1331a930e528SElen Song 
1332ab4382d2SGreg Kroah-Hartman /*
1333ab4382d2SGreg Kroah-Hartman  * Called from tasklet with ENDTX and TXBUFE interrupts disabled.
1334ab4382d2SGreg Kroah-Hartman  */
133564e22ebeSElen Song static void atmel_tx_pdc(struct uart_port *port)
1336ab4382d2SGreg Kroah-Hartman {
1337ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
1338ab4382d2SGreg Kroah-Hartman 	struct circ_buf *xmit = &port->state->xmit;
1339ab4382d2SGreg Kroah-Hartman 	struct atmel_dma_buffer *pdc = &atmel_port->pdc_tx;
1340ab4382d2SGreg Kroah-Hartman 	int count;
1341ab4382d2SGreg Kroah-Hartman 
1342ab4382d2SGreg Kroah-Hartman 	/* nothing left to transmit? */
13434e7decdaSCyrille Pitchen 	if (atmel_uart_readl(port, ATMEL_PDC_TCR))
1344ab4382d2SGreg Kroah-Hartman 		return;
1345ab4382d2SGreg Kroah-Hartman 
1346ab4382d2SGreg Kroah-Hartman 	xmit->tail += pdc->ofs;
1347ab4382d2SGreg Kroah-Hartman 	xmit->tail &= UART_XMIT_SIZE - 1;
1348ab4382d2SGreg Kroah-Hartman 
1349ab4382d2SGreg Kroah-Hartman 	port->icount.tx += pdc->ofs;
1350ab4382d2SGreg Kroah-Hartman 	pdc->ofs = 0;
1351ab4382d2SGreg Kroah-Hartman 
1352ab4382d2SGreg Kroah-Hartman 	/* more to transmit - setup next transfer */
1353ab4382d2SGreg Kroah-Hartman 
1354ab4382d2SGreg Kroah-Hartman 	/* disable PDC transmit */
13554e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_PDC_PTCR, ATMEL_PDC_TXTDIS);
1356ab4382d2SGreg Kroah-Hartman 
1357ab4382d2SGreg Kroah-Hartman 	if (!uart_circ_empty(xmit) && !uart_tx_stopped(port)) {
1358ab4382d2SGreg Kroah-Hartman 		dma_sync_single_for_device(port->dev,
1359ab4382d2SGreg Kroah-Hartman 					   pdc->dma_addr,
1360ab4382d2SGreg Kroah-Hartman 					   pdc->dma_size,
1361ab4382d2SGreg Kroah-Hartman 					   DMA_TO_DEVICE);
1362ab4382d2SGreg Kroah-Hartman 
1363ab4382d2SGreg Kroah-Hartman 		count = CIRC_CNT_TO_END(xmit->head, xmit->tail, UART_XMIT_SIZE);
1364ab4382d2SGreg Kroah-Hartman 		pdc->ofs = count;
1365ab4382d2SGreg Kroah-Hartman 
13664e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_PDC_TPR,
13674e7decdaSCyrille Pitchen 				  pdc->dma_addr + xmit->tail);
13684e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_PDC_TCR, count);
1369ab4382d2SGreg Kroah-Hartman 		/* re-enable PDC transmit */
13704e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_PDC_PTCR, ATMEL_PDC_TXTEN);
1371ab4382d2SGreg Kroah-Hartman 		/* Enable interrupts */
13724e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_IER,
13734e7decdaSCyrille Pitchen 				  atmel_port->tx_done_mask);
1374ab4382d2SGreg Kroah-Hartman 	} else {
137513bd3e6fSRicardo Ribalda Delgado 		if ((port->rs485.flags & SER_RS485_ENABLED) &&
137613bd3e6fSRicardo Ribalda Delgado 		    !(port->rs485.flags & SER_RS485_RX_DURING_TX)) {
1377ab4382d2SGreg Kroah-Hartman 			/* DMA done, stop TX, start RX for RS485 */
1378ab4382d2SGreg Kroah-Hartman 			atmel_start_rx(port);
1379ab4382d2SGreg Kroah-Hartman 		}
1380ab4382d2SGreg Kroah-Hartman 	}
1381ab4382d2SGreg Kroah-Hartman 
1382ab4382d2SGreg Kroah-Hartman 	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
1383ab4382d2SGreg Kroah-Hartman 		uart_write_wakeup(port);
1384ab4382d2SGreg Kroah-Hartman }
1385ab4382d2SGreg Kroah-Hartman 
1386a930e528SElen Song static int atmel_prepare_tx_pdc(struct uart_port *port)
1387a930e528SElen Song {
1388a930e528SElen Song 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
1389a930e528SElen Song 	struct atmel_dma_buffer *pdc = &atmel_port->pdc_tx;
1390a930e528SElen Song 	struct circ_buf *xmit = &port->state->xmit;
1391a930e528SElen Song 
1392a930e528SElen Song 	pdc->buf = xmit->buf;
1393a930e528SElen Song 	pdc->dma_addr = dma_map_single(port->dev,
1394a930e528SElen Song 					pdc->buf,
1395a930e528SElen Song 					UART_XMIT_SIZE,
1396a930e528SElen Song 					DMA_TO_DEVICE);
1397a930e528SElen Song 	pdc->dma_size = UART_XMIT_SIZE;
1398a930e528SElen Song 	pdc->ofs = 0;
1399a930e528SElen Song 
1400a930e528SElen Song 	return 0;
1401a930e528SElen Song }
1402a930e528SElen Song 
1403ab4382d2SGreg Kroah-Hartman static void atmel_rx_from_ring(struct uart_port *port)
1404ab4382d2SGreg Kroah-Hartman {
1405ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
1406ab4382d2SGreg Kroah-Hartman 	struct circ_buf *ring = &atmel_port->rx_ring;
1407ab4382d2SGreg Kroah-Hartman 	unsigned int flg;
1408ab4382d2SGreg Kroah-Hartman 	unsigned int status;
1409ab4382d2SGreg Kroah-Hartman 
1410ab4382d2SGreg Kroah-Hartman 	while (ring->head != ring->tail) {
1411ab4382d2SGreg Kroah-Hartman 		struct atmel_uart_char c;
1412ab4382d2SGreg Kroah-Hartman 
1413ab4382d2SGreg Kroah-Hartman 		/* Make sure c is loaded after head. */
1414ab4382d2SGreg Kroah-Hartman 		smp_rmb();
1415ab4382d2SGreg Kroah-Hartman 
1416ab4382d2SGreg Kroah-Hartman 		c = ((struct atmel_uart_char *)ring->buf)[ring->tail];
1417ab4382d2SGreg Kroah-Hartman 
1418ab4382d2SGreg Kroah-Hartman 		ring->tail = (ring->tail + 1) & (ATMEL_SERIAL_RINGSIZE - 1);
1419ab4382d2SGreg Kroah-Hartman 
1420ab4382d2SGreg Kroah-Hartman 		port->icount.rx++;
1421ab4382d2SGreg Kroah-Hartman 		status = c.status;
1422ab4382d2SGreg Kroah-Hartman 		flg = TTY_NORMAL;
1423ab4382d2SGreg Kroah-Hartman 
1424ab4382d2SGreg Kroah-Hartman 		/*
1425ab4382d2SGreg Kroah-Hartman 		 * note that the error handling code is
1426ab4382d2SGreg Kroah-Hartman 		 * out of the main execution path
1427ab4382d2SGreg Kroah-Hartman 		 */
1428ab4382d2SGreg Kroah-Hartman 		if (unlikely(status & (ATMEL_US_PARE | ATMEL_US_FRAME
1429ab4382d2SGreg Kroah-Hartman 				       | ATMEL_US_OVRE | ATMEL_US_RXBRK))) {
1430ab4382d2SGreg Kroah-Hartman 			if (status & ATMEL_US_RXBRK) {
1431ab4382d2SGreg Kroah-Hartman 				/* ignore side-effect */
1432ab4382d2SGreg Kroah-Hartman 				status &= ~(ATMEL_US_PARE | ATMEL_US_FRAME);
1433ab4382d2SGreg Kroah-Hartman 
1434ab4382d2SGreg Kroah-Hartman 				port->icount.brk++;
1435ab4382d2SGreg Kroah-Hartman 				if (uart_handle_break(port))
1436ab4382d2SGreg Kroah-Hartman 					continue;
1437ab4382d2SGreg Kroah-Hartman 			}
1438ab4382d2SGreg Kroah-Hartman 			if (status & ATMEL_US_PARE)
1439ab4382d2SGreg Kroah-Hartman 				port->icount.parity++;
1440ab4382d2SGreg Kroah-Hartman 			if (status & ATMEL_US_FRAME)
1441ab4382d2SGreg Kroah-Hartman 				port->icount.frame++;
1442ab4382d2SGreg Kroah-Hartman 			if (status & ATMEL_US_OVRE)
1443ab4382d2SGreg Kroah-Hartman 				port->icount.overrun++;
1444ab4382d2SGreg Kroah-Hartman 
1445ab4382d2SGreg Kroah-Hartman 			status &= port->read_status_mask;
1446ab4382d2SGreg Kroah-Hartman 
1447ab4382d2SGreg Kroah-Hartman 			if (status & ATMEL_US_RXBRK)
1448ab4382d2SGreg Kroah-Hartman 				flg = TTY_BREAK;
1449ab4382d2SGreg Kroah-Hartman 			else if (status & ATMEL_US_PARE)
1450ab4382d2SGreg Kroah-Hartman 				flg = TTY_PARITY;
1451ab4382d2SGreg Kroah-Hartman 			else if (status & ATMEL_US_FRAME)
1452ab4382d2SGreg Kroah-Hartman 				flg = TTY_FRAME;
1453ab4382d2SGreg Kroah-Hartman 		}
1454ab4382d2SGreg Kroah-Hartman 
1455ab4382d2SGreg Kroah-Hartman 
1456ab4382d2SGreg Kroah-Hartman 		if (uart_handle_sysrq_char(port, c.ch))
1457ab4382d2SGreg Kroah-Hartman 			continue;
1458ab4382d2SGreg Kroah-Hartman 
1459ab4382d2SGreg Kroah-Hartman 		uart_insert_char(port, status, ATMEL_US_OVRE, c.ch, flg);
1460ab4382d2SGreg Kroah-Hartman 	}
1461ab4382d2SGreg Kroah-Hartman 
1462ab4382d2SGreg Kroah-Hartman 	/*
1463ab4382d2SGreg Kroah-Hartman 	 * Drop the lock here since it might end up calling
1464ab4382d2SGreg Kroah-Hartman 	 * uart_start(), which takes the lock.
1465ab4382d2SGreg Kroah-Hartman 	 */
1466ab4382d2SGreg Kroah-Hartman 	spin_unlock(&port->lock);
14672e124b4aSJiri Slaby 	tty_flip_buffer_push(&port->state->port);
1468ab4382d2SGreg Kroah-Hartman 	spin_lock(&port->lock);
1469ab4382d2SGreg Kroah-Hartman }
1470ab4382d2SGreg Kroah-Hartman 
1471a930e528SElen Song static void atmel_release_rx_pdc(struct uart_port *port)
1472a930e528SElen Song {
1473a930e528SElen Song 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
1474a930e528SElen Song 	int i;
1475a930e528SElen Song 
1476a930e528SElen Song 	for (i = 0; i < 2; i++) {
1477a930e528SElen Song 		struct atmel_dma_buffer *pdc = &atmel_port->pdc_rx[i];
1478a930e528SElen Song 
1479a930e528SElen Song 		dma_unmap_single(port->dev,
1480a930e528SElen Song 				 pdc->dma_addr,
1481a930e528SElen Song 				 pdc->dma_size,
1482a930e528SElen Song 				 DMA_FROM_DEVICE);
1483a930e528SElen Song 		kfree(pdc->buf);
1484a930e528SElen Song 	}
1485a930e528SElen Song }
1486a930e528SElen Song 
148764e22ebeSElen Song static void atmel_rx_from_pdc(struct uart_port *port)
1488ab4382d2SGreg Kroah-Hartman {
1489ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
149005c7cd39SJiri Slaby 	struct tty_port *tport = &port->state->port;
1491ab4382d2SGreg Kroah-Hartman 	struct atmel_dma_buffer *pdc;
1492ab4382d2SGreg Kroah-Hartman 	int rx_idx = atmel_port->pdc_rx_idx;
1493ab4382d2SGreg Kroah-Hartman 	unsigned int head;
1494ab4382d2SGreg Kroah-Hartman 	unsigned int tail;
1495ab4382d2SGreg Kroah-Hartman 	unsigned int count;
1496ab4382d2SGreg Kroah-Hartman 
1497ab4382d2SGreg Kroah-Hartman 	do {
1498ab4382d2SGreg Kroah-Hartman 		/* Reset the UART timeout early so that we don't miss one */
14994e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_STTTO);
1500ab4382d2SGreg Kroah-Hartman 
1501ab4382d2SGreg Kroah-Hartman 		pdc = &atmel_port->pdc_rx[rx_idx];
15024e7decdaSCyrille Pitchen 		head = atmel_uart_readl(port, ATMEL_PDC_RPR) - pdc->dma_addr;
1503ab4382d2SGreg Kroah-Hartman 		tail = pdc->ofs;
1504ab4382d2SGreg Kroah-Hartman 
1505ab4382d2SGreg Kroah-Hartman 		/* If the PDC has switched buffers, RPR won't contain
1506ab4382d2SGreg Kroah-Hartman 		 * any address within the current buffer. Since head
1507ab4382d2SGreg Kroah-Hartman 		 * is unsigned, we just need a one-way comparison to
1508ab4382d2SGreg Kroah-Hartman 		 * find out.
1509ab4382d2SGreg Kroah-Hartman 		 *
1510ab4382d2SGreg Kroah-Hartman 		 * In this case, we just need to consume the entire
1511ab4382d2SGreg Kroah-Hartman 		 * buffer and resubmit it for DMA. This will clear the
1512ab4382d2SGreg Kroah-Hartman 		 * ENDRX bit as well, so that we can safely re-enable
1513ab4382d2SGreg Kroah-Hartman 		 * all interrupts below.
1514ab4382d2SGreg Kroah-Hartman 		 */
1515ab4382d2SGreg Kroah-Hartman 		head = min(head, pdc->dma_size);
1516ab4382d2SGreg Kroah-Hartman 
1517ab4382d2SGreg Kroah-Hartman 		if (likely(head != tail)) {
1518ab4382d2SGreg Kroah-Hartman 			dma_sync_single_for_cpu(port->dev, pdc->dma_addr,
1519ab4382d2SGreg Kroah-Hartman 					pdc->dma_size, DMA_FROM_DEVICE);
1520ab4382d2SGreg Kroah-Hartman 
1521ab4382d2SGreg Kroah-Hartman 			/*
1522ab4382d2SGreg Kroah-Hartman 			 * head will only wrap around when we recycle
1523ab4382d2SGreg Kroah-Hartman 			 * the DMA buffer, and when that happens, we
1524ab4382d2SGreg Kroah-Hartman 			 * explicitly set tail to 0. So head will
1525ab4382d2SGreg Kroah-Hartman 			 * always be greater than tail.
1526ab4382d2SGreg Kroah-Hartman 			 */
1527ab4382d2SGreg Kroah-Hartman 			count = head - tail;
1528ab4382d2SGreg Kroah-Hartman 
152905c7cd39SJiri Slaby 			tty_insert_flip_string(tport, pdc->buf + pdc->ofs,
153005c7cd39SJiri Slaby 						count);
1531ab4382d2SGreg Kroah-Hartman 
1532ab4382d2SGreg Kroah-Hartman 			dma_sync_single_for_device(port->dev, pdc->dma_addr,
1533ab4382d2SGreg Kroah-Hartman 					pdc->dma_size, DMA_FROM_DEVICE);
1534ab4382d2SGreg Kroah-Hartman 
1535ab4382d2SGreg Kroah-Hartman 			port->icount.rx += count;
1536ab4382d2SGreg Kroah-Hartman 			pdc->ofs = head;
1537ab4382d2SGreg Kroah-Hartman 		}
1538ab4382d2SGreg Kroah-Hartman 
1539ab4382d2SGreg Kroah-Hartman 		/*
1540ab4382d2SGreg Kroah-Hartman 		 * If the current buffer is full, we need to check if
1541ab4382d2SGreg Kroah-Hartman 		 * the next one contains any additional data.
1542ab4382d2SGreg Kroah-Hartman 		 */
1543ab4382d2SGreg Kroah-Hartman 		if (head >= pdc->dma_size) {
1544ab4382d2SGreg Kroah-Hartman 			pdc->ofs = 0;
15454e7decdaSCyrille Pitchen 			atmel_uart_writel(port, ATMEL_PDC_RNPR, pdc->dma_addr);
15464e7decdaSCyrille Pitchen 			atmel_uart_writel(port, ATMEL_PDC_RNCR, pdc->dma_size);
1547ab4382d2SGreg Kroah-Hartman 
1548ab4382d2SGreg Kroah-Hartman 			rx_idx = !rx_idx;
1549ab4382d2SGreg Kroah-Hartman 			atmel_port->pdc_rx_idx = rx_idx;
1550ab4382d2SGreg Kroah-Hartman 		}
1551ab4382d2SGreg Kroah-Hartman 	} while (head >= pdc->dma_size);
1552ab4382d2SGreg Kroah-Hartman 
1553ab4382d2SGreg Kroah-Hartman 	/*
1554ab4382d2SGreg Kroah-Hartman 	 * Drop the lock here since it might end up calling
1555ab4382d2SGreg Kroah-Hartman 	 * uart_start(), which takes the lock.
1556ab4382d2SGreg Kroah-Hartman 	 */
1557ab4382d2SGreg Kroah-Hartman 	spin_unlock(&port->lock);
15582e124b4aSJiri Slaby 	tty_flip_buffer_push(tport);
1559ab4382d2SGreg Kroah-Hartman 	spin_lock(&port->lock);
1560ab4382d2SGreg Kroah-Hartman 
15614e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_IER,
15624e7decdaSCyrille Pitchen 			  ATMEL_US_ENDRX | ATMEL_US_TIMEOUT);
1563ab4382d2SGreg Kroah-Hartman }
1564ab4382d2SGreg Kroah-Hartman 
1565a930e528SElen Song static int atmel_prepare_rx_pdc(struct uart_port *port)
1566a930e528SElen Song {
1567a930e528SElen Song 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
1568a930e528SElen Song 	int i;
1569a930e528SElen Song 
1570a930e528SElen Song 	for (i = 0; i < 2; i++) {
1571a930e528SElen Song 		struct atmel_dma_buffer *pdc = &atmel_port->pdc_rx[i];
1572a930e528SElen Song 
1573a930e528SElen Song 		pdc->buf = kmalloc(PDC_BUFFER_SIZE, GFP_KERNEL);
1574a930e528SElen Song 		if (pdc->buf == NULL) {
1575a930e528SElen Song 			if (i != 0) {
1576a930e528SElen Song 				dma_unmap_single(port->dev,
1577a930e528SElen Song 					atmel_port->pdc_rx[0].dma_addr,
1578a930e528SElen Song 					PDC_BUFFER_SIZE,
1579a930e528SElen Song 					DMA_FROM_DEVICE);
1580a930e528SElen Song 				kfree(atmel_port->pdc_rx[0].buf);
1581a930e528SElen Song 			}
1582a930e528SElen Song 			atmel_port->use_pdc_rx = 0;
1583a930e528SElen Song 			return -ENOMEM;
1584a930e528SElen Song 		}
1585a930e528SElen Song 		pdc->dma_addr = dma_map_single(port->dev,
1586a930e528SElen Song 						pdc->buf,
1587a930e528SElen Song 						PDC_BUFFER_SIZE,
1588a930e528SElen Song 						DMA_FROM_DEVICE);
1589a930e528SElen Song 		pdc->dma_size = PDC_BUFFER_SIZE;
1590a930e528SElen Song 		pdc->ofs = 0;
1591a930e528SElen Song 	}
1592a930e528SElen Song 
1593a930e528SElen Song 	atmel_port->pdc_rx_idx = 0;
1594a930e528SElen Song 
15954e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_PDC_RPR, atmel_port->pdc_rx[0].dma_addr);
15964e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_PDC_RCR, PDC_BUFFER_SIZE);
1597a930e528SElen Song 
15984e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_PDC_RNPR,
15994e7decdaSCyrille Pitchen 			  atmel_port->pdc_rx[1].dma_addr);
16004e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_PDC_RNCR, PDC_BUFFER_SIZE);
1601a930e528SElen Song 
1602a930e528SElen Song 	return 0;
1603a930e528SElen Song }
1604a930e528SElen Song 
1605ab4382d2SGreg Kroah-Hartman /*
1606ab4382d2SGreg Kroah-Hartman  * tasklet handling tty stuff outside the interrupt handler.
1607ab4382d2SGreg Kroah-Hartman  */
160800e8e658SNicolas Ferre static void atmel_tasklet_rx_func(unsigned long data)
1609ab4382d2SGreg Kroah-Hartman {
1610ab4382d2SGreg Kroah-Hartman 	struct uart_port *port = (struct uart_port *)data;
1611ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
1612ab4382d2SGreg Kroah-Hartman 
1613ab4382d2SGreg Kroah-Hartman 	/* The interrupt handler does not take the lock */
1614ab4382d2SGreg Kroah-Hartman 	spin_lock(&port->lock);
1615a930e528SElen Song 	atmel_port->schedule_rx(port);
161600e8e658SNicolas Ferre 	spin_unlock(&port->lock);
161700e8e658SNicolas Ferre }
1618ab4382d2SGreg Kroah-Hartman 
161900e8e658SNicolas Ferre static void atmel_tasklet_tx_func(unsigned long data)
162000e8e658SNicolas Ferre {
162100e8e658SNicolas Ferre 	struct uart_port *port = (struct uart_port *)data;
162200e8e658SNicolas Ferre 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
162300e8e658SNicolas Ferre 
162400e8e658SNicolas Ferre 	/* The interrupt handler does not take the lock */
162500e8e658SNicolas Ferre 	spin_lock(&port->lock);
162600e8e658SNicolas Ferre 	atmel_port->schedule_tx(port);
1627ab4382d2SGreg Kroah-Hartman 	spin_unlock(&port->lock);
1628ab4382d2SGreg Kroah-Hartman }
1629ab4382d2SGreg Kroah-Hartman 
16304a1e8888SLeilei Zhao static void atmel_init_property(struct atmel_uart_port *atmel_port,
163133d64c4fSElen Song 				struct platform_device *pdev)
163233d64c4fSElen Song {
163333d64c4fSElen Song 	struct device_node *np = pdev->dev.of_node;
1634574de559SJingoo Han 	struct atmel_uart_data *pdata = dev_get_platdata(&pdev->dev);
163533d64c4fSElen Song 
163633d64c4fSElen Song 	if (np) {
163733d64c4fSElen Song 		/* DMA/PDC usage specification */
1638490d5ce2SJulia Lawall 		if (of_property_read_bool(np, "atmel,use-dma-rx")) {
1639490d5ce2SJulia Lawall 			if (of_property_read_bool(np, "dmas")) {
164033d64c4fSElen Song 				atmel_port->use_dma_rx  = true;
164133d64c4fSElen Song 				atmel_port->use_pdc_rx  = false;
164233d64c4fSElen Song 			} else {
164333d64c4fSElen Song 				atmel_port->use_dma_rx  = false;
164433d64c4fSElen Song 				atmel_port->use_pdc_rx  = true;
164533d64c4fSElen Song 			}
164633d64c4fSElen Song 		} else {
164733d64c4fSElen Song 			atmel_port->use_dma_rx  = false;
164833d64c4fSElen Song 			atmel_port->use_pdc_rx  = false;
164933d64c4fSElen Song 		}
165033d64c4fSElen Song 
1651490d5ce2SJulia Lawall 		if (of_property_read_bool(np, "atmel,use-dma-tx")) {
1652490d5ce2SJulia Lawall 			if (of_property_read_bool(np, "dmas")) {
165333d64c4fSElen Song 				atmel_port->use_dma_tx  = true;
165433d64c4fSElen Song 				atmel_port->use_pdc_tx  = false;
165533d64c4fSElen Song 			} else {
165633d64c4fSElen Song 				atmel_port->use_dma_tx  = false;
165733d64c4fSElen Song 				atmel_port->use_pdc_tx  = true;
165833d64c4fSElen Song 			}
165933d64c4fSElen Song 		} else {
166033d64c4fSElen Song 			atmel_port->use_dma_tx  = false;
166133d64c4fSElen Song 			atmel_port->use_pdc_tx  = false;
166233d64c4fSElen Song 		}
166333d64c4fSElen Song 
166433d64c4fSElen Song 	} else {
166533d64c4fSElen Song 		atmel_port->use_pdc_rx  = pdata->use_dma_rx;
166633d64c4fSElen Song 		atmel_port->use_pdc_tx  = pdata->use_dma_tx;
166733d64c4fSElen Song 		atmel_port->use_dma_rx  = false;
166833d64c4fSElen Song 		atmel_port->use_dma_tx  = false;
166933d64c4fSElen Song 	}
167033d64c4fSElen Song 
167133d64c4fSElen Song }
167233d64c4fSElen Song 
167313bd3e6fSRicardo Ribalda Delgado static void atmel_init_rs485(struct uart_port *port,
167433d64c4fSElen Song 				struct platform_device *pdev)
167533d64c4fSElen Song {
167633d64c4fSElen Song 	struct device_node *np = pdev->dev.of_node;
1677574de559SJingoo Han 	struct atmel_uart_data *pdata = dev_get_platdata(&pdev->dev);
167833d64c4fSElen Song 
167933d64c4fSElen Song 	if (np) {
168077bdec6fSJiri Slaby 		struct serial_rs485 *rs485conf = &port->rs485;
168133d64c4fSElen Song 		u32 rs485_delay[2];
168233d64c4fSElen Song 		/* rs485 properties */
168333d64c4fSElen Song 		if (of_property_read_u32_array(np, "rs485-rts-delay",
168433d64c4fSElen Song 					rs485_delay, 2) == 0) {
168533d64c4fSElen Song 			rs485conf->delay_rts_before_send = rs485_delay[0];
168633d64c4fSElen Song 			rs485conf->delay_rts_after_send = rs485_delay[1];
168733d64c4fSElen Song 			rs485conf->flags = 0;
168877bdec6fSJiri Slaby 		}
168933d64c4fSElen Song 
169033d64c4fSElen Song 		if (of_get_property(np, "rs485-rx-during-tx", NULL))
169133d64c4fSElen Song 			rs485conf->flags |= SER_RS485_RX_DURING_TX;
169233d64c4fSElen Song 
169333d64c4fSElen Song 		if (of_get_property(np, "linux,rs485-enabled-at-boot-time",
169433d64c4fSElen Song 								NULL))
169533d64c4fSElen Song 			rs485conf->flags |= SER_RS485_ENABLED;
169633d64c4fSElen Song 	} else {
169713bd3e6fSRicardo Ribalda Delgado 		port->rs485       = pdata->rs485;
169833d64c4fSElen Song 	}
169933d64c4fSElen Song 
170033d64c4fSElen Song }
170133d64c4fSElen Song 
1702a930e528SElen Song static void atmel_set_ops(struct uart_port *port)
1703a930e528SElen Song {
1704a930e528SElen Song 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
1705a930e528SElen Song 
170634df42f5SElen Song 	if (atmel_use_dma_rx(port)) {
170734df42f5SElen Song 		atmel_port->prepare_rx = &atmel_prepare_rx_dma;
170834df42f5SElen Song 		atmel_port->schedule_rx = &atmel_rx_from_dma;
170934df42f5SElen Song 		atmel_port->release_rx = &atmel_release_rx_dma;
171034df42f5SElen Song 	} else if (atmel_use_pdc_rx(port)) {
1711a930e528SElen Song 		atmel_port->prepare_rx = &atmel_prepare_rx_pdc;
1712a930e528SElen Song 		atmel_port->schedule_rx = &atmel_rx_from_pdc;
1713a930e528SElen Song 		atmel_port->release_rx = &atmel_release_rx_pdc;
1714a930e528SElen Song 	} else {
1715a930e528SElen Song 		atmel_port->prepare_rx = NULL;
1716a930e528SElen Song 		atmel_port->schedule_rx = &atmel_rx_from_ring;
1717a930e528SElen Song 		atmel_port->release_rx = NULL;
1718a930e528SElen Song 	}
1719a930e528SElen Song 
172008f738beSElen Song 	if (atmel_use_dma_tx(port)) {
172108f738beSElen Song 		atmel_port->prepare_tx = &atmel_prepare_tx_dma;
172208f738beSElen Song 		atmel_port->schedule_tx = &atmel_tx_dma;
172308f738beSElen Song 		atmel_port->release_tx = &atmel_release_tx_dma;
172408f738beSElen Song 	} else if (atmel_use_pdc_tx(port)) {
1725a930e528SElen Song 		atmel_port->prepare_tx = &atmel_prepare_tx_pdc;
1726a930e528SElen Song 		atmel_port->schedule_tx = &atmel_tx_pdc;
1727a930e528SElen Song 		atmel_port->release_tx = &atmel_release_tx_pdc;
1728a930e528SElen Song 	} else {
1729a930e528SElen Song 		atmel_port->prepare_tx = NULL;
1730a930e528SElen Song 		atmel_port->schedule_tx = &atmel_tx_chars;
1731a930e528SElen Song 		atmel_port->release_tx = NULL;
1732a930e528SElen Song 	}
1733a930e528SElen Song }
1734a930e528SElen Song 
1735ab4382d2SGreg Kroah-Hartman /*
1736055560b0SElen Song  * Get ip name usart or uart
1737055560b0SElen Song  */
1738892db58bSNicolas Ferre static void atmel_get_ip_name(struct uart_port *port)
1739055560b0SElen Song {
1740055560b0SElen Song 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
17414e7decdaSCyrille Pitchen 	int name = atmel_uart_readl(port, ATMEL_US_NAME);
1742731d9caeSNicolas Ferre 	u32 version;
17431d673fb9SNicolas Ferre 	u32 usart, dbgu_uart, new_uart;
17444b769371SNicolas Ferre 	/* ASCII decoding for IP version */
17454b769371SNicolas Ferre 	usart = 0x55534152;	/* USAR(T) */
17464b769371SNicolas Ferre 	dbgu_uart = 0x44424755;	/* DBGU */
17471d673fb9SNicolas Ferre 	new_uart = 0x55415254;	/* UART */
1748055560b0SElen Song 
17495bf5635aSLudovic Desroches 	/*
17505bf5635aSLudovic Desroches 	 * Only USART devices from at91sam9260 SOC implement fractional
17515bf5635aSLudovic Desroches 	 * baudrate.
17525bf5635aSLudovic Desroches 	 */
17535bf5635aSLudovic Desroches 	atmel_port->has_frac_baudrate = false;
17544b769371SNicolas Ferre 	atmel_port->has_hw_timer = false;
1755055560b0SElen Song 
17562958cceeSLudovic Desroches 	if (name == new_uart) {
17572958cceeSLudovic Desroches 		dev_dbg(port->dev, "Uart with hw timer");
17584b769371SNicolas Ferre 		atmel_port->has_hw_timer = true;
17592958cceeSLudovic Desroches 		atmel_port->rtor = ATMEL_UA_RTOR;
17602958cceeSLudovic Desroches 	} else if (name == usart) {
17612958cceeSLudovic Desroches 		dev_dbg(port->dev, "Usart\n");
17625bf5635aSLudovic Desroches 		atmel_port->has_frac_baudrate = true;
17632958cceeSLudovic Desroches 		atmel_port->has_hw_timer = true;
17642958cceeSLudovic Desroches 		atmel_port->rtor = ATMEL_US_RTOR;
17654b769371SNicolas Ferre 	} else if (name == dbgu_uart) {
17664b769371SNicolas Ferre 		dev_dbg(port->dev, "Dbgu or uart without hw timer\n");
1767055560b0SElen Song 	} else {
1768731d9caeSNicolas Ferre 		/* fallback for older SoCs: use version field */
17694e7decdaSCyrille Pitchen 		version = atmel_uart_readl(port, ATMEL_US_VERSION);
1770731d9caeSNicolas Ferre 		switch (version) {
1771731d9caeSNicolas Ferre 		case 0x302:
1772731d9caeSNicolas Ferre 		case 0x10213:
1773731d9caeSNicolas Ferre 			dev_dbg(port->dev, "This version is usart\n");
17745bf5635aSLudovic Desroches 			atmel_port->has_frac_baudrate = true;
17754b769371SNicolas Ferre 			atmel_port->has_hw_timer = true;
17762958cceeSLudovic Desroches 			atmel_port->rtor = ATMEL_US_RTOR;
1777731d9caeSNicolas Ferre 			break;
1778731d9caeSNicolas Ferre 		case 0x203:
1779731d9caeSNicolas Ferre 		case 0x10202:
1780731d9caeSNicolas Ferre 			dev_dbg(port->dev, "This version is uart\n");
1781731d9caeSNicolas Ferre 			break;
1782731d9caeSNicolas Ferre 		default:
1783731d9caeSNicolas Ferre 			dev_err(port->dev, "Not supported ip name nor version, set to uart\n");
1784731d9caeSNicolas Ferre 		}
1785055560b0SElen Song 	}
1786055560b0SElen Song }
1787055560b0SElen Song 
1788055560b0SElen Song /*
1789ab4382d2SGreg Kroah-Hartman  * Perform initialization and enable port for reception
1790ab4382d2SGreg Kroah-Hartman  */
1791ab4382d2SGreg Kroah-Hartman static int atmel_startup(struct uart_port *port)
1792ab4382d2SGreg Kroah-Hartman {
179333d64c4fSElen Song 	struct platform_device *pdev = to_platform_device(port->dev);
1794ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
1795ab4382d2SGreg Kroah-Hartman 	struct tty_struct *tty = port->state->port.tty;
1796ab4382d2SGreg Kroah-Hartman 	int retval;
1797ab4382d2SGreg Kroah-Hartman 
1798ab4382d2SGreg Kroah-Hartman 	/*
1799ab4382d2SGreg Kroah-Hartman 	 * Ensure that no interrupts are enabled otherwise when
1800ab4382d2SGreg Kroah-Hartman 	 * request_irq() is called we could get stuck trying to
1801ab4382d2SGreg Kroah-Hartman 	 * handle an unexpected interrupt
1802ab4382d2SGreg Kroah-Hartman 	 */
18034e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_IDR, -1);
1804ab5e4e41SRichard Genoud 	atmel_port->ms_irq_enabled = false;
1805ab4382d2SGreg Kroah-Hartman 
1806ab4382d2SGreg Kroah-Hartman 	/*
1807ab4382d2SGreg Kroah-Hartman 	 * Allocate the IRQ
1808ab4382d2SGreg Kroah-Hartman 	 */
18092c7af5baSBoris BREZILLON 	retval = request_irq(port->irq, atmel_interrupt,
18102c7af5baSBoris BREZILLON 			IRQF_SHARED | IRQF_COND_SUSPEND,
1811ab4382d2SGreg Kroah-Hartman 			tty ? tty->name : "atmel_serial", port);
1812ab4382d2SGreg Kroah-Hartman 	if (retval) {
1813ddaa6037SRichard Genoud 		dev_err(port->dev, "atmel_startup - Can't get irq\n");
1814ab4382d2SGreg Kroah-Hartman 		return retval;
1815ab4382d2SGreg Kroah-Hartman 	}
1816ab4382d2SGreg Kroah-Hartman 
181798f2082cSNicolas Ferre 	atomic_set(&atmel_port->tasklet_shutdown, 0);
181898f2082cSNicolas Ferre 	tasklet_init(&atmel_port->tasklet_rx, atmel_tasklet_rx_func,
181998f2082cSNicolas Ferre 			(unsigned long)port);
182098f2082cSNicolas Ferre 	tasklet_init(&atmel_port->tasklet_tx, atmel_tasklet_tx_func,
182198f2082cSNicolas Ferre 			(unsigned long)port);
18221e125786SLeilei Zhao 
1823ab5e4e41SRichard Genoud 	/*
1824ab4382d2SGreg Kroah-Hartman 	 * Initialize DMA (if necessary)
1825ab4382d2SGreg Kroah-Hartman 	 */
182633d64c4fSElen Song 	atmel_init_property(atmel_port, pdev);
18274d9628a1SLeilei Zhao 	atmel_set_ops(port);
182833d64c4fSElen Song 
1829a930e528SElen Song 	if (atmel_port->prepare_rx) {
1830a930e528SElen Song 		retval = atmel_port->prepare_rx(port);
1831a930e528SElen Song 		if (retval < 0)
1832a930e528SElen Song 			atmel_set_ops(port);
1833ab4382d2SGreg Kroah-Hartman 	}
1834ab4382d2SGreg Kroah-Hartman 
1835a930e528SElen Song 	if (atmel_port->prepare_tx) {
1836a930e528SElen Song 		retval = atmel_port->prepare_tx(port);
1837a930e528SElen Song 		if (retval < 0)
1838a930e528SElen Song 			atmel_set_ops(port);
1839ab4382d2SGreg Kroah-Hartman 	}
1840ab4382d2SGreg Kroah-Hartman 
1841b5199d46SCyrille Pitchen 	/*
1842b5199d46SCyrille Pitchen 	 * Enable FIFO when available
1843b5199d46SCyrille Pitchen 	 */
1844b5199d46SCyrille Pitchen 	if (atmel_port->fifo_size) {
1845b5199d46SCyrille Pitchen 		unsigned int txrdym = ATMEL_US_ONE_DATA;
1846b5199d46SCyrille Pitchen 		unsigned int rxrdym = ATMEL_US_ONE_DATA;
1847b5199d46SCyrille Pitchen 		unsigned int fmr;
1848b5199d46SCyrille Pitchen 
1849b5199d46SCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_CR,
1850b5199d46SCyrille Pitchen 				  ATMEL_US_FIFOEN |
1851b5199d46SCyrille Pitchen 				  ATMEL_US_RXFCLR |
1852b5199d46SCyrille Pitchen 				  ATMEL_US_TXFLCLR);
1853b5199d46SCyrille Pitchen 
18545f258b3eSCyrille Pitchen 		if (atmel_use_dma_tx(port))
18555f258b3eSCyrille Pitchen 			txrdym = ATMEL_US_FOUR_DATA;
18565f258b3eSCyrille Pitchen 
1857b5199d46SCyrille Pitchen 		fmr = ATMEL_US_TXRDYM(txrdym) | ATMEL_US_RXRDYM(rxrdym);
1858b5199d46SCyrille Pitchen 		if (atmel_port->rts_high &&
1859b5199d46SCyrille Pitchen 		    atmel_port->rts_low)
1860b5199d46SCyrille Pitchen 			fmr |=	ATMEL_US_FRTSC |
1861b5199d46SCyrille Pitchen 				ATMEL_US_RXFTHRES(atmel_port->rts_high) |
1862b5199d46SCyrille Pitchen 				ATMEL_US_RXFTHRES2(atmel_port->rts_low);
1863b5199d46SCyrille Pitchen 
1864b5199d46SCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_FMR, fmr);
1865b5199d46SCyrille Pitchen 	}
1866b5199d46SCyrille Pitchen 
1867ab4382d2SGreg Kroah-Hartman 	/* Save current CSR for comparison in atmel_tasklet_func() */
1868e0b0baadSRichard Genoud 	atmel_port->irq_status_prev = atmel_get_lines_status(port);
1869ab4382d2SGreg Kroah-Hartman 
1870ab4382d2SGreg Kroah-Hartman 	/*
1871ab4382d2SGreg Kroah-Hartman 	 * Finally, enable the serial port
1872ab4382d2SGreg Kroah-Hartman 	 */
18734e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_RSTSTA | ATMEL_US_RSTRX);
1874ab4382d2SGreg Kroah-Hartman 	/* enable xmit & rcvr */
18754e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_TXEN | ATMEL_US_RXEN);
1876ab4382d2SGreg Kroah-Hartman 
18772e68c22fSElen Song 	setup_timer(&atmel_port->uart_timer,
18782e68c22fSElen Song 			atmel_uart_timer_callback,
18792e68c22fSElen Song 			(unsigned long)port);
18808bc661bfSMarek Roszko 
18818bc661bfSMarek Roszko 	if (atmel_use_pdc_rx(port)) {
18828bc661bfSMarek Roszko 		/* set UART timeout */
18834b769371SNicolas Ferre 		if (!atmel_port->has_hw_timer) {
18842e68c22fSElen Song 			mod_timer(&atmel_port->uart_timer,
18852e68c22fSElen Song 					jiffies + uart_poll_timeout(port));
18862e68c22fSElen Song 		/* set USART timeout */
18872e68c22fSElen Song 		} else {
18882958cceeSLudovic Desroches 			atmel_uart_writel(port, atmel_port->rtor,
18892958cceeSLudovic Desroches 					  PDC_RX_TIMEOUT);
18904e7decdaSCyrille Pitchen 			atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_STTTO);
1891ab4382d2SGreg Kroah-Hartman 
18924e7decdaSCyrille Pitchen 			atmel_uart_writel(port, ATMEL_US_IER,
18934e7decdaSCyrille Pitchen 					  ATMEL_US_ENDRX | ATMEL_US_TIMEOUT);
18942e68c22fSElen Song 		}
1895ab4382d2SGreg Kroah-Hartman 		/* enable PDC controller */
18964e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_PDC_PTCR, ATMEL_PDC_RXTEN);
189734df42f5SElen Song 	} else if (atmel_use_dma_rx(port)) {
18982e68c22fSElen Song 		/* set UART timeout */
18994b769371SNicolas Ferre 		if (!atmel_port->has_hw_timer) {
19002e68c22fSElen Song 			mod_timer(&atmel_port->uart_timer,
19012e68c22fSElen Song 					jiffies + uart_poll_timeout(port));
19022e68c22fSElen Song 		/* set USART timeout */
19032e68c22fSElen Song 		} else {
19042958cceeSLudovic Desroches 			atmel_uart_writel(port, atmel_port->rtor,
19052958cceeSLudovic Desroches 					  PDC_RX_TIMEOUT);
19064e7decdaSCyrille Pitchen 			atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_STTTO);
190734df42f5SElen Song 
19084e7decdaSCyrille Pitchen 			atmel_uart_writel(port, ATMEL_US_IER,
19094e7decdaSCyrille Pitchen 					  ATMEL_US_TIMEOUT);
19102e68c22fSElen Song 		}
1911ab4382d2SGreg Kroah-Hartman 	} else {
1912ab4382d2SGreg Kroah-Hartman 		/* enable receive only */
19134e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_IER, ATMEL_US_RXRDY);
1914ab4382d2SGreg Kroah-Hartman 	}
1915ab4382d2SGreg Kroah-Hartman 
1916ab4382d2SGreg Kroah-Hartman 	return 0;
1917ab4382d2SGreg Kroah-Hartman }
1918ab4382d2SGreg Kroah-Hartman 
1919ab4382d2SGreg Kroah-Hartman /*
1920479e9b94SPeter Hurley  * Flush any TX data submitted for DMA. Called when the TX circular
1921479e9b94SPeter Hurley  * buffer is reset.
1922479e9b94SPeter Hurley  */
1923479e9b94SPeter Hurley static void atmel_flush_buffer(struct uart_port *port)
1924479e9b94SPeter Hurley {
1925479e9b94SPeter Hurley 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
1926479e9b94SPeter Hurley 
1927479e9b94SPeter Hurley 	if (atmel_use_pdc_tx(port)) {
19284e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_PDC_TCR, 0);
1929479e9b94SPeter Hurley 		atmel_port->pdc_tx.ofs = 0;
1930479e9b94SPeter Hurley 	}
1931479e9b94SPeter Hurley }
1932479e9b94SPeter Hurley 
1933479e9b94SPeter Hurley /*
1934ab4382d2SGreg Kroah-Hartman  * Disable the port
1935ab4382d2SGreg Kroah-Hartman  */
1936ab4382d2SGreg Kroah-Hartman static void atmel_shutdown(struct uart_port *port)
1937ab4382d2SGreg Kroah-Hartman {
1938ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
19390cc7c6c7SMarek Roszko 
19400ae9fdefSRichard Genoud 	/* Disable modem control lines interrupts */
19410ae9fdefSRichard Genoud 	atmel_disable_ms(port);
19420ae9fdefSRichard Genoud 
194398f2082cSNicolas Ferre 	/* Disable interrupts at device level */
194498f2082cSNicolas Ferre 	atmel_uart_writel(port, ATMEL_US_IDR, -1);
194598f2082cSNicolas Ferre 
194698f2082cSNicolas Ferre 	/* Prevent spurious interrupts from scheduling the tasklet */
194798f2082cSNicolas Ferre 	atomic_inc(&atmel_port->tasklet_shutdown);
194898f2082cSNicolas Ferre 
1949ab4382d2SGreg Kroah-Hartman 	/*
19508bc661bfSMarek Roszko 	 * Prevent any tasklets being scheduled during
19518bc661bfSMarek Roszko 	 * cleanup
19528bc661bfSMarek Roszko 	 */
19538bc661bfSMarek Roszko 	del_timer_sync(&atmel_port->uart_timer);
19548bc661bfSMarek Roszko 
195598f2082cSNicolas Ferre 	/* Make sure that no interrupt is on the fly */
195698f2082cSNicolas Ferre 	synchronize_irq(port->irq);
195798f2082cSNicolas Ferre 
19588bc661bfSMarek Roszko 	/*
19590cc7c6c7SMarek Roszko 	 * Clear out any scheduled tasklets before
19600cc7c6c7SMarek Roszko 	 * we destroy the buffers
19610cc7c6c7SMarek Roszko 	 */
196200e8e658SNicolas Ferre 	tasklet_kill(&atmel_port->tasklet_rx);
196300e8e658SNicolas Ferre 	tasklet_kill(&atmel_port->tasklet_tx);
19640cc7c6c7SMarek Roszko 
19650cc7c6c7SMarek Roszko 	/*
19660cc7c6c7SMarek Roszko 	 * Ensure everything is stopped and
196798f2082cSNicolas Ferre 	 * disable port and break condition.
1968ab4382d2SGreg Kroah-Hartman 	 */
1969ab4382d2SGreg Kroah-Hartman 	atmel_stop_rx(port);
1970ab4382d2SGreg Kroah-Hartman 	atmel_stop_tx(port);
1971ab4382d2SGreg Kroah-Hartman 
19724e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_RSTSTA);
19730cc7c6c7SMarek Roszko 
1974ab4382d2SGreg Kroah-Hartman 	/*
1975ab4382d2SGreg Kroah-Hartman 	 * Shut-down the DMA.
1976ab4382d2SGreg Kroah-Hartman 	 */
1977a930e528SElen Song 	if (atmel_port->release_rx)
1978a930e528SElen Song 		atmel_port->release_rx(port);
1979a930e528SElen Song 	if (atmel_port->release_tx)
1980a930e528SElen Song 		atmel_port->release_tx(port);
1981ab4382d2SGreg Kroah-Hartman 
1982ab4382d2SGreg Kroah-Hartman 	/*
1983bb7e73c5SMark Deneen 	 * Reset ring buffer pointers
1984bb7e73c5SMark Deneen 	 */
1985bb7e73c5SMark Deneen 	atmel_port->rx_ring.head = 0;
1986bb7e73c5SMark Deneen 	atmel_port->rx_ring.tail = 0;
1987bb7e73c5SMark Deneen 
1988bb7e73c5SMark Deneen 	/*
1989ab5e4e41SRichard Genoud 	 * Free the interrupts
1990ab4382d2SGreg Kroah-Hartman 	 */
1991ab4382d2SGreg Kroah-Hartman 	free_irq(port->irq, port);
1992ab5e4e41SRichard Genoud 
1993479e9b94SPeter Hurley 	atmel_flush_buffer(port);
1994ab4382d2SGreg Kroah-Hartman }
1995ab4382d2SGreg Kroah-Hartman 
1996ab4382d2SGreg Kroah-Hartman /*
1997ab4382d2SGreg Kroah-Hartman  * Power / Clock management.
1998ab4382d2SGreg Kroah-Hartman  */
1999ab4382d2SGreg Kroah-Hartman static void atmel_serial_pm(struct uart_port *port, unsigned int state,
2000ab4382d2SGreg Kroah-Hartman 			    unsigned int oldstate)
2001ab4382d2SGreg Kroah-Hartman {
2002ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
2003ab4382d2SGreg Kroah-Hartman 
2004ab4382d2SGreg Kroah-Hartman 	switch (state) {
2005ab4382d2SGreg Kroah-Hartman 	case 0:
2006ab4382d2SGreg Kroah-Hartman 		/*
2007ab4382d2SGreg Kroah-Hartman 		 * Enable the peripheral clock for this serial port.
2008ab4382d2SGreg Kroah-Hartman 		 * This is called on uart_open() or a resume event.
2009ab4382d2SGreg Kroah-Hartman 		 */
201091f8c2d8SBoris BREZILLON 		clk_prepare_enable(atmel_port->clk);
2011ab4382d2SGreg Kroah-Hartman 
2012ab4382d2SGreg Kroah-Hartman 		/* re-enable interrupts if we disabled some on suspend */
20134e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_IER, atmel_port->backup_imr);
2014ab4382d2SGreg Kroah-Hartman 		break;
2015ab4382d2SGreg Kroah-Hartman 	case 3:
2016ab4382d2SGreg Kroah-Hartman 		/* Back up the interrupt mask and disable all interrupts */
20174e7decdaSCyrille Pitchen 		atmel_port->backup_imr = atmel_uart_readl(port, ATMEL_US_IMR);
20184e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_IDR, -1);
2019ab4382d2SGreg Kroah-Hartman 
2020ab4382d2SGreg Kroah-Hartman 		/*
2021ab4382d2SGreg Kroah-Hartman 		 * Disable the peripheral clock for this serial port.
2022ab4382d2SGreg Kroah-Hartman 		 * This is called on uart_close() or a suspend event.
2023ab4382d2SGreg Kroah-Hartman 		 */
202491f8c2d8SBoris BREZILLON 		clk_disable_unprepare(atmel_port->clk);
2025ab4382d2SGreg Kroah-Hartman 		break;
2026ab4382d2SGreg Kroah-Hartman 	default:
2027ddaa6037SRichard Genoud 		dev_err(port->dev, "atmel_serial: unknown pm %d\n", state);
2028ab4382d2SGreg Kroah-Hartman 	}
2029ab4382d2SGreg Kroah-Hartman }
2030ab4382d2SGreg Kroah-Hartman 
2031ab4382d2SGreg Kroah-Hartman /*
2032ab4382d2SGreg Kroah-Hartman  * Change the port parameters
2033ab4382d2SGreg Kroah-Hartman  */
2034ab4382d2SGreg Kroah-Hartman static void atmel_set_termios(struct uart_port *port, struct ktermios *termios,
2035ab4382d2SGreg Kroah-Hartman 			      struct ktermios *old)
2036ab4382d2SGreg Kroah-Hartman {
20375bf5635aSLudovic Desroches 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
2038ab4382d2SGreg Kroah-Hartman 	unsigned long flags;
20395bf5635aSLudovic Desroches 	unsigned int old_mode, mode, imr, quot, baud, div, cd, fp = 0;
2040ab4382d2SGreg Kroah-Hartman 
20411cf6e8fcSCyrille Pitchen 	/* save the current mode register */
20424e7decdaSCyrille Pitchen 	mode = old_mode = atmel_uart_readl(port, ATMEL_US_MR);
20431cf6e8fcSCyrille Pitchen 
20441cf6e8fcSCyrille Pitchen 	/* reset the mode, clock divisor, parity, stop bits and data size */
20451cf6e8fcSCyrille Pitchen 	mode &= ~(ATMEL_US_USCLKS | ATMEL_US_CHRL | ATMEL_US_NBSTOP |
20461cf6e8fcSCyrille Pitchen 		  ATMEL_US_PAR | ATMEL_US_USMODE);
2047ab4382d2SGreg Kroah-Hartman 
2048ab4382d2SGreg Kroah-Hartman 	baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk / 16);
2049ab4382d2SGreg Kroah-Hartman 
2050ab4382d2SGreg Kroah-Hartman 	/* byte size */
2051ab4382d2SGreg Kroah-Hartman 	switch (termios->c_cflag & CSIZE) {
2052ab4382d2SGreg Kroah-Hartman 	case CS5:
2053ab4382d2SGreg Kroah-Hartman 		mode |= ATMEL_US_CHRL_5;
2054ab4382d2SGreg Kroah-Hartman 		break;
2055ab4382d2SGreg Kroah-Hartman 	case CS6:
2056ab4382d2SGreg Kroah-Hartman 		mode |= ATMEL_US_CHRL_6;
2057ab4382d2SGreg Kroah-Hartman 		break;
2058ab4382d2SGreg Kroah-Hartman 	case CS7:
2059ab4382d2SGreg Kroah-Hartman 		mode |= ATMEL_US_CHRL_7;
2060ab4382d2SGreg Kroah-Hartman 		break;
2061ab4382d2SGreg Kroah-Hartman 	default:
2062ab4382d2SGreg Kroah-Hartman 		mode |= ATMEL_US_CHRL_8;
2063ab4382d2SGreg Kroah-Hartman 		break;
2064ab4382d2SGreg Kroah-Hartman 	}
2065ab4382d2SGreg Kroah-Hartman 
2066ab4382d2SGreg Kroah-Hartman 	/* stop bits */
2067ab4382d2SGreg Kroah-Hartman 	if (termios->c_cflag & CSTOPB)
2068ab4382d2SGreg Kroah-Hartman 		mode |= ATMEL_US_NBSTOP_2;
2069ab4382d2SGreg Kroah-Hartman 
2070ab4382d2SGreg Kroah-Hartman 	/* parity */
2071ab4382d2SGreg Kroah-Hartman 	if (termios->c_cflag & PARENB) {
2072ab4382d2SGreg Kroah-Hartman 		/* Mark or Space parity */
2073ab4382d2SGreg Kroah-Hartman 		if (termios->c_cflag & CMSPAR) {
2074ab4382d2SGreg Kroah-Hartman 			if (termios->c_cflag & PARODD)
2075ab4382d2SGreg Kroah-Hartman 				mode |= ATMEL_US_PAR_MARK;
2076ab4382d2SGreg Kroah-Hartman 			else
2077ab4382d2SGreg Kroah-Hartman 				mode |= ATMEL_US_PAR_SPACE;
2078ab4382d2SGreg Kroah-Hartman 		} else if (termios->c_cflag & PARODD)
2079ab4382d2SGreg Kroah-Hartman 			mode |= ATMEL_US_PAR_ODD;
2080ab4382d2SGreg Kroah-Hartman 		else
2081ab4382d2SGreg Kroah-Hartman 			mode |= ATMEL_US_PAR_EVEN;
2082ab4382d2SGreg Kroah-Hartman 	} else
2083ab4382d2SGreg Kroah-Hartman 		mode |= ATMEL_US_PAR_NONE;
2084ab4382d2SGreg Kroah-Hartman 
2085ab4382d2SGreg Kroah-Hartman 	spin_lock_irqsave(&port->lock, flags);
2086ab4382d2SGreg Kroah-Hartman 
2087ab4382d2SGreg Kroah-Hartman 	port->read_status_mask = ATMEL_US_OVRE;
2088ab4382d2SGreg Kroah-Hartman 	if (termios->c_iflag & INPCK)
2089ab4382d2SGreg Kroah-Hartman 		port->read_status_mask |= (ATMEL_US_FRAME | ATMEL_US_PARE);
2090ef8b9ddcSPeter Hurley 	if (termios->c_iflag & (IGNBRK | BRKINT | PARMRK))
2091ab4382d2SGreg Kroah-Hartman 		port->read_status_mask |= ATMEL_US_RXBRK;
2092ab4382d2SGreg Kroah-Hartman 
209364e22ebeSElen Song 	if (atmel_use_pdc_rx(port))
2094ab4382d2SGreg Kroah-Hartman 		/* need to enable error interrupts */
20954e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_IER, port->read_status_mask);
2096ab4382d2SGreg Kroah-Hartman 
2097ab4382d2SGreg Kroah-Hartman 	/*
2098ab4382d2SGreg Kroah-Hartman 	 * Characters to ignore
2099ab4382d2SGreg Kroah-Hartman 	 */
2100ab4382d2SGreg Kroah-Hartman 	port->ignore_status_mask = 0;
2101ab4382d2SGreg Kroah-Hartman 	if (termios->c_iflag & IGNPAR)
2102ab4382d2SGreg Kroah-Hartman 		port->ignore_status_mask |= (ATMEL_US_FRAME | ATMEL_US_PARE);
2103ab4382d2SGreg Kroah-Hartman 	if (termios->c_iflag & IGNBRK) {
2104ab4382d2SGreg Kroah-Hartman 		port->ignore_status_mask |= ATMEL_US_RXBRK;
2105ab4382d2SGreg Kroah-Hartman 		/*
2106ab4382d2SGreg Kroah-Hartman 		 * If we're ignoring parity and break indicators,
2107ab4382d2SGreg Kroah-Hartman 		 * ignore overruns too (for real raw support).
2108ab4382d2SGreg Kroah-Hartman 		 */
2109ab4382d2SGreg Kroah-Hartman 		if (termios->c_iflag & IGNPAR)
2110ab4382d2SGreg Kroah-Hartman 			port->ignore_status_mask |= ATMEL_US_OVRE;
2111ab4382d2SGreg Kroah-Hartman 	}
2112ab4382d2SGreg Kroah-Hartman 	/* TODO: Ignore all characters if CREAD is set.*/
2113ab4382d2SGreg Kroah-Hartman 
2114ab4382d2SGreg Kroah-Hartman 	/* update the per-port timeout */
2115ab4382d2SGreg Kroah-Hartman 	uart_update_timeout(port, termios->c_cflag, baud);
2116ab4382d2SGreg Kroah-Hartman 
2117ab4382d2SGreg Kroah-Hartman 	/*
2118ab4382d2SGreg Kroah-Hartman 	 * save/disable interrupts. The tty layer will ensure that the
2119ab4382d2SGreg Kroah-Hartman 	 * transmitter is empty if requested by the caller, so there's
2120ab4382d2SGreg Kroah-Hartman 	 * no need to wait for it here.
2121ab4382d2SGreg Kroah-Hartman 	 */
21224e7decdaSCyrille Pitchen 	imr = atmel_uart_readl(port, ATMEL_US_IMR);
21234e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_IDR, -1);
2124ab4382d2SGreg Kroah-Hartman 
2125ab4382d2SGreg Kroah-Hartman 	/* disable receiver and transmitter */
21264e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_TXDIS | ATMEL_US_RXDIS);
2127ab4382d2SGreg Kroah-Hartman 
21281cf6e8fcSCyrille Pitchen 	/* mode */
212913bd3e6fSRicardo Ribalda Delgado 	if (port->rs485.flags & SER_RS485_ENABLED) {
21304e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_TTGR,
21314e7decdaSCyrille Pitchen 				  port->rs485.delay_rts_after_send);
2132ab4382d2SGreg Kroah-Hartman 		mode |= ATMEL_US_USMODE_RS485;
21331cf6e8fcSCyrille Pitchen 	} else if (termios->c_cflag & CRTSCTS) {
21341cf6e8fcSCyrille Pitchen 		/* RS232 with hardware handshake (RTS/CTS) */
2135*9bcffe75SRichard Genoud 		if (atmel_use_fifo(port) &&
2136*9bcffe75SRichard Genoud 		    !mctrl_gpio_to_gpiod(atmel_port->gpios, UART_GPIO_CTS)) {
2137*9bcffe75SRichard Genoud 			/*
2138*9bcffe75SRichard Genoud 			 * with ATMEL_US_USMODE_HWHS set, the controller will
2139*9bcffe75SRichard Genoud 			 * be able to drive the RTS pin high/low when the RX
2140*9bcffe75SRichard Genoud 			 * FIFO is above RXFTHRES/below RXFTHRES2.
2141*9bcffe75SRichard Genoud 			 * It will also disable the transmitter when the CTS
2142*9bcffe75SRichard Genoud 			 * pin is high.
2143*9bcffe75SRichard Genoud 			 * This mode is not activated if CTS pin is a GPIO
2144*9bcffe75SRichard Genoud 			 * because in this case, the transmitter is always
2145*9bcffe75SRichard Genoud 			 * disabled (there must be an internal pull-up
2146*9bcffe75SRichard Genoud 			 * responsible for this behaviour).
2147*9bcffe75SRichard Genoud 			 * If the RTS pin is a GPIO, the controller won't be
2148*9bcffe75SRichard Genoud 			 * able to drive it according to the FIFO thresholds,
2149*9bcffe75SRichard Genoud 			 * but it will be handled by the driver.
2150*9bcffe75SRichard Genoud 			 */
21511cf6e8fcSCyrille Pitchen 			mode |= ATMEL_US_USMODE_HWHS;
2152*9bcffe75SRichard Genoud 		} else {
2153*9bcffe75SRichard Genoud 			/*
2154*9bcffe75SRichard Genoud 			 * For platforms without FIFO, the flow control is
2155*9bcffe75SRichard Genoud 			 * handled by the driver.
2156*9bcffe75SRichard Genoud 			 */
2157*9bcffe75SRichard Genoud 			mode |= ATMEL_US_USMODE_NORMAL;
21585be605acSAlexandre Belloni 		}
21591cf6e8fcSCyrille Pitchen 	} else {
21601cf6e8fcSCyrille Pitchen 		/* RS232 without hadware handshake */
21611cf6e8fcSCyrille Pitchen 		mode |= ATMEL_US_USMODE_NORMAL;
2162ab4382d2SGreg Kroah-Hartman 	}
2163ab4382d2SGreg Kroah-Hartman 
21641cf6e8fcSCyrille Pitchen 	/* set the mode, clock divisor, parity, stop bits and data size */
21654e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_MR, mode);
2166ab4382d2SGreg Kroah-Hartman 
21671cf6e8fcSCyrille Pitchen 	/*
21681cf6e8fcSCyrille Pitchen 	 * when switching the mode, set the RTS line state according to the
21691cf6e8fcSCyrille Pitchen 	 * new mode, otherwise keep the former state
21701cf6e8fcSCyrille Pitchen 	 */
21711cf6e8fcSCyrille Pitchen 	if ((old_mode & ATMEL_US_USMODE) != (mode & ATMEL_US_USMODE)) {
21721cf6e8fcSCyrille Pitchen 		unsigned int rts_state;
21731cf6e8fcSCyrille Pitchen 
21741cf6e8fcSCyrille Pitchen 		if ((mode & ATMEL_US_USMODE) == ATMEL_US_USMODE_HWHS) {
21751cf6e8fcSCyrille Pitchen 			/* let the hardware control the RTS line */
21761cf6e8fcSCyrille Pitchen 			rts_state = ATMEL_US_RTSDIS;
21771cf6e8fcSCyrille Pitchen 		} else {
21781cf6e8fcSCyrille Pitchen 			/* force RTS line to low level */
21791cf6e8fcSCyrille Pitchen 			rts_state = ATMEL_US_RTSEN;
21801cf6e8fcSCyrille Pitchen 		}
21811cf6e8fcSCyrille Pitchen 
21824e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_US_CR, rts_state);
21831cf6e8fcSCyrille Pitchen 	}
21841cf6e8fcSCyrille Pitchen 
21855bf5635aSLudovic Desroches 	/*
21865bf5635aSLudovic Desroches 	 * Set the baud rate:
21875bf5635aSLudovic Desroches 	 * Fractional baudrate allows to setup output frequency more
21885bf5635aSLudovic Desroches 	 * accurately. This feature is enabled only when using normal mode.
21895bf5635aSLudovic Desroches 	 * baudrate = selected clock / (8 * (2 - OVER) * (CD + FP / 8))
21905bf5635aSLudovic Desroches 	 * Currently, OVER is always set to 0 so we get
219136131cdfSAlexey Starikovskiy 	 * baudrate = selected clock / (16 * (CD + FP / 8))
219236131cdfSAlexey Starikovskiy 	 * then
219336131cdfSAlexey Starikovskiy 	 * 8 CD + FP = selected clock / (2 * baudrate)
21945bf5635aSLudovic Desroches 	 */
21955bf5635aSLudovic Desroches 	if (atmel_port->has_frac_baudrate &&
21965bf5635aSLudovic Desroches 	    (mode & ATMEL_US_USMODE) == ATMEL_US_USMODE_NORMAL) {
219736131cdfSAlexey Starikovskiy 		div = DIV_ROUND_CLOSEST(port->uartclk, baud * 2);
219836131cdfSAlexey Starikovskiy 		cd = div >> 3;
219936131cdfSAlexey Starikovskiy 		fp = div & ATMEL_US_FP_MASK;
22005bf5635aSLudovic Desroches 	} else {
22015bf5635aSLudovic Desroches 		cd = uart_get_divisor(port, baud);
22025bf5635aSLudovic Desroches 	}
22035bf5635aSLudovic Desroches 
22045bf5635aSLudovic Desroches 	if (cd > 65535) {	/* BRGR is 16-bit, so switch to slower clock */
22055bf5635aSLudovic Desroches 		cd /= 8;
22065bf5635aSLudovic Desroches 		mode |= ATMEL_US_USCLKS_MCK_DIV8;
22075bf5635aSLudovic Desroches 	}
22085bf5635aSLudovic Desroches 	quot = cd | fp << ATMEL_US_FP_OFFSET;
22095bf5635aSLudovic Desroches 
22104e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_BRGR, quot);
22114e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_RSTSTA | ATMEL_US_RSTRX);
22124e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_TXEN | ATMEL_US_RXEN);
2213ab4382d2SGreg Kroah-Hartman 
2214ab4382d2SGreg Kroah-Hartman 	/* restore interrupts */
22154e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_IER, imr);
2216ab4382d2SGreg Kroah-Hartman 
2217ab4382d2SGreg Kroah-Hartman 	/* CTS flow-control and modem-status interrupts */
2218ab4382d2SGreg Kroah-Hartman 	if (UART_ENABLE_MS(port, termios->c_cflag))
221935b675b9SRichard Genoud 		atmel_enable_ms(port);
222035b675b9SRichard Genoud 	else
222135b675b9SRichard Genoud 		atmel_disable_ms(port);
2222ab4382d2SGreg Kroah-Hartman 
2223ab4382d2SGreg Kroah-Hartman 	spin_unlock_irqrestore(&port->lock, flags);
2224ab4382d2SGreg Kroah-Hartman }
2225ab4382d2SGreg Kroah-Hartman 
2226732a84a0SPeter Hurley static void atmel_set_ldisc(struct uart_port *port, struct ktermios *termios)
222742bd7a4fSViktar Palstsiuk {
2228732a84a0SPeter Hurley 	if (termios->c_line == N_PPS) {
222942bd7a4fSViktar Palstsiuk 		port->flags |= UPF_HARDPPS_CD;
2230d41510ceSPeter Hurley 		spin_lock_irq(&port->lock);
223142bd7a4fSViktar Palstsiuk 		atmel_enable_ms(port);
2232d41510ceSPeter Hurley 		spin_unlock_irq(&port->lock);
223342bd7a4fSViktar Palstsiuk 	} else {
223442bd7a4fSViktar Palstsiuk 		port->flags &= ~UPF_HARDPPS_CD;
2235cab68f89SPeter Hurley 		if (!UART_ENABLE_MS(port, termios->c_cflag)) {
2236cab68f89SPeter Hurley 			spin_lock_irq(&port->lock);
2237cab68f89SPeter Hurley 			atmel_disable_ms(port);
2238cab68f89SPeter Hurley 			spin_unlock_irq(&port->lock);
2239cab68f89SPeter Hurley 		}
224042bd7a4fSViktar Palstsiuk 	}
224142bd7a4fSViktar Palstsiuk }
224242bd7a4fSViktar Palstsiuk 
2243ab4382d2SGreg Kroah-Hartman /*
2244ab4382d2SGreg Kroah-Hartman  * Return string describing the specified port
2245ab4382d2SGreg Kroah-Hartman  */
2246ab4382d2SGreg Kroah-Hartman static const char *atmel_type(struct uart_port *port)
2247ab4382d2SGreg Kroah-Hartman {
2248ab4382d2SGreg Kroah-Hartman 	return (port->type == PORT_ATMEL) ? "ATMEL_SERIAL" : NULL;
2249ab4382d2SGreg Kroah-Hartman }
2250ab4382d2SGreg Kroah-Hartman 
2251ab4382d2SGreg Kroah-Hartman /*
2252ab4382d2SGreg Kroah-Hartman  * Release the memory region(s) being used by 'port'.
2253ab4382d2SGreg Kroah-Hartman  */
2254ab4382d2SGreg Kroah-Hartman static void atmel_release_port(struct uart_port *port)
2255ab4382d2SGreg Kroah-Hartman {
2256ab4382d2SGreg Kroah-Hartman 	struct platform_device *pdev = to_platform_device(port->dev);
2257ab4382d2SGreg Kroah-Hartman 	int size = pdev->resource[0].end - pdev->resource[0].start + 1;
2258ab4382d2SGreg Kroah-Hartman 
2259ab4382d2SGreg Kroah-Hartman 	release_mem_region(port->mapbase, size);
2260ab4382d2SGreg Kroah-Hartman 
2261ab4382d2SGreg Kroah-Hartman 	if (port->flags & UPF_IOREMAP) {
2262ab4382d2SGreg Kroah-Hartman 		iounmap(port->membase);
2263ab4382d2SGreg Kroah-Hartman 		port->membase = NULL;
2264ab4382d2SGreg Kroah-Hartman 	}
2265ab4382d2SGreg Kroah-Hartman }
2266ab4382d2SGreg Kroah-Hartman 
2267ab4382d2SGreg Kroah-Hartman /*
2268ab4382d2SGreg Kroah-Hartman  * Request the memory region(s) being used by 'port'.
2269ab4382d2SGreg Kroah-Hartman  */
2270ab4382d2SGreg Kroah-Hartman static int atmel_request_port(struct uart_port *port)
2271ab4382d2SGreg Kroah-Hartman {
2272ab4382d2SGreg Kroah-Hartman 	struct platform_device *pdev = to_platform_device(port->dev);
2273ab4382d2SGreg Kroah-Hartman 	int size = pdev->resource[0].end - pdev->resource[0].start + 1;
2274ab4382d2SGreg Kroah-Hartman 
2275ab4382d2SGreg Kroah-Hartman 	if (!request_mem_region(port->mapbase, size, "atmel_serial"))
2276ab4382d2SGreg Kroah-Hartman 		return -EBUSY;
2277ab4382d2SGreg Kroah-Hartman 
2278ab4382d2SGreg Kroah-Hartman 	if (port->flags & UPF_IOREMAP) {
2279ab4382d2SGreg Kroah-Hartman 		port->membase = ioremap(port->mapbase, size);
2280ab4382d2SGreg Kroah-Hartman 		if (port->membase == NULL) {
2281ab4382d2SGreg Kroah-Hartman 			release_mem_region(port->mapbase, size);
2282ab4382d2SGreg Kroah-Hartman 			return -ENOMEM;
2283ab4382d2SGreg Kroah-Hartman 		}
2284ab4382d2SGreg Kroah-Hartman 	}
2285ab4382d2SGreg Kroah-Hartman 
2286ab4382d2SGreg Kroah-Hartman 	return 0;
2287ab4382d2SGreg Kroah-Hartman }
2288ab4382d2SGreg Kroah-Hartman 
2289ab4382d2SGreg Kroah-Hartman /*
2290ab4382d2SGreg Kroah-Hartman  * Configure/autoconfigure the port.
2291ab4382d2SGreg Kroah-Hartman  */
2292ab4382d2SGreg Kroah-Hartman static void atmel_config_port(struct uart_port *port, int flags)
2293ab4382d2SGreg Kroah-Hartman {
2294ab4382d2SGreg Kroah-Hartman 	if (flags & UART_CONFIG_TYPE) {
2295ab4382d2SGreg Kroah-Hartman 		port->type = PORT_ATMEL;
2296ab4382d2SGreg Kroah-Hartman 		atmel_request_port(port);
2297ab4382d2SGreg Kroah-Hartman 	}
2298ab4382d2SGreg Kroah-Hartman }
2299ab4382d2SGreg Kroah-Hartman 
2300ab4382d2SGreg Kroah-Hartman /*
2301ab4382d2SGreg Kroah-Hartman  * Verify the new serial_struct (for TIOCSSERIAL).
2302ab4382d2SGreg Kroah-Hartman  */
2303ab4382d2SGreg Kroah-Hartman static int atmel_verify_port(struct uart_port *port, struct serial_struct *ser)
2304ab4382d2SGreg Kroah-Hartman {
2305ab4382d2SGreg Kroah-Hartman 	int ret = 0;
2306ab4382d2SGreg Kroah-Hartman 	if (ser->type != PORT_UNKNOWN && ser->type != PORT_ATMEL)
2307ab4382d2SGreg Kroah-Hartman 		ret = -EINVAL;
2308ab4382d2SGreg Kroah-Hartman 	if (port->irq != ser->irq)
2309ab4382d2SGreg Kroah-Hartman 		ret = -EINVAL;
2310ab4382d2SGreg Kroah-Hartman 	if (ser->io_type != SERIAL_IO_MEM)
2311ab4382d2SGreg Kroah-Hartman 		ret = -EINVAL;
2312ab4382d2SGreg Kroah-Hartman 	if (port->uartclk / 16 != ser->baud_base)
2313ab4382d2SGreg Kroah-Hartman 		ret = -EINVAL;
2314270c2adeSAndre Przywara 	if (port->mapbase != (unsigned long)ser->iomem_base)
2315ab4382d2SGreg Kroah-Hartman 		ret = -EINVAL;
2316ab4382d2SGreg Kroah-Hartman 	if (port->iobase != ser->port)
2317ab4382d2SGreg Kroah-Hartman 		ret = -EINVAL;
2318ab4382d2SGreg Kroah-Hartman 	if (ser->hub6 != 0)
2319ab4382d2SGreg Kroah-Hartman 		ret = -EINVAL;
2320ab4382d2SGreg Kroah-Hartman 	return ret;
2321ab4382d2SGreg Kroah-Hartman }
2322ab4382d2SGreg Kroah-Hartman 
2323ab4382d2SGreg Kroah-Hartman #ifdef CONFIG_CONSOLE_POLL
2324ab4382d2SGreg Kroah-Hartman static int atmel_poll_get_char(struct uart_port *port)
2325ab4382d2SGreg Kroah-Hartman {
23264e7decdaSCyrille Pitchen 	while (!(atmel_uart_readl(port, ATMEL_US_CSR) & ATMEL_US_RXRDY))
2327ab4382d2SGreg Kroah-Hartman 		cpu_relax();
2328ab4382d2SGreg Kroah-Hartman 
2329a6499435SCyrille Pitchen 	return atmel_uart_read_char(port);
2330ab4382d2SGreg Kroah-Hartman }
2331ab4382d2SGreg Kroah-Hartman 
2332ab4382d2SGreg Kroah-Hartman static void atmel_poll_put_char(struct uart_port *port, unsigned char ch)
2333ab4382d2SGreg Kroah-Hartman {
23344e7decdaSCyrille Pitchen 	while (!(atmel_uart_readl(port, ATMEL_US_CSR) & ATMEL_US_TXRDY))
2335ab4382d2SGreg Kroah-Hartman 		cpu_relax();
2336ab4382d2SGreg Kroah-Hartman 
2337a6499435SCyrille Pitchen 	atmel_uart_write_char(port, ch);
2338ab4382d2SGreg Kroah-Hartman }
2339ab4382d2SGreg Kroah-Hartman #endif
2340ab4382d2SGreg Kroah-Hartman 
23415c7dcdb6SJulia Lawall static const struct uart_ops atmel_pops = {
2342ab4382d2SGreg Kroah-Hartman 	.tx_empty	= atmel_tx_empty,
2343ab4382d2SGreg Kroah-Hartman 	.set_mctrl	= atmel_set_mctrl,
2344ab4382d2SGreg Kroah-Hartman 	.get_mctrl	= atmel_get_mctrl,
2345ab4382d2SGreg Kroah-Hartman 	.stop_tx	= atmel_stop_tx,
2346ab4382d2SGreg Kroah-Hartman 	.start_tx	= atmel_start_tx,
2347ab4382d2SGreg Kroah-Hartman 	.stop_rx	= atmel_stop_rx,
2348ab4382d2SGreg Kroah-Hartman 	.enable_ms	= atmel_enable_ms,
2349ab4382d2SGreg Kroah-Hartman 	.break_ctl	= atmel_break_ctl,
2350ab4382d2SGreg Kroah-Hartman 	.startup	= atmel_startup,
2351ab4382d2SGreg Kroah-Hartman 	.shutdown	= atmel_shutdown,
2352ab4382d2SGreg Kroah-Hartman 	.flush_buffer	= atmel_flush_buffer,
2353ab4382d2SGreg Kroah-Hartman 	.set_termios	= atmel_set_termios,
235442bd7a4fSViktar Palstsiuk 	.set_ldisc	= atmel_set_ldisc,
2355ab4382d2SGreg Kroah-Hartman 	.type		= atmel_type,
2356ab4382d2SGreg Kroah-Hartman 	.release_port	= atmel_release_port,
2357ab4382d2SGreg Kroah-Hartman 	.request_port	= atmel_request_port,
2358ab4382d2SGreg Kroah-Hartman 	.config_port	= atmel_config_port,
2359ab4382d2SGreg Kroah-Hartman 	.verify_port	= atmel_verify_port,
2360ab4382d2SGreg Kroah-Hartman 	.pm		= atmel_serial_pm,
2361ab4382d2SGreg Kroah-Hartman #ifdef CONFIG_CONSOLE_POLL
2362ab4382d2SGreg Kroah-Hartman 	.poll_get_char	= atmel_poll_get_char,
2363ab4382d2SGreg Kroah-Hartman 	.poll_put_char	= atmel_poll_put_char,
2364ab4382d2SGreg Kroah-Hartman #endif
2365ab4382d2SGreg Kroah-Hartman };
2366ab4382d2SGreg Kroah-Hartman 
2367ab4382d2SGreg Kroah-Hartman /*
2368ab4382d2SGreg Kroah-Hartman  * Configure the port from the platform device resource info.
2369ab4382d2SGreg Kroah-Hartman  */
237091f8c2d8SBoris BREZILLON static int atmel_init_port(struct atmel_uart_port *atmel_port,
2371ab4382d2SGreg Kroah-Hartman 				      struct platform_device *pdev)
2372ab4382d2SGreg Kroah-Hartman {
237391f8c2d8SBoris BREZILLON 	int ret;
2374ab4382d2SGreg Kroah-Hartman 	struct uart_port *port = &atmel_port->uart;
2375574de559SJingoo Han 	struct atmel_uart_data *pdata = dev_get_platdata(&pdev->dev);
2376ab4382d2SGreg Kroah-Hartman 
23774a1e8888SLeilei Zhao 	atmel_init_property(atmel_port, pdev);
2378a930e528SElen Song 	atmel_set_ops(port);
2379a930e528SElen Song 
238013bd3e6fSRicardo Ribalda Delgado 	atmel_init_rs485(port, pdev);
238133d64c4fSElen Song 
2382ab4382d2SGreg Kroah-Hartman 	port->iotype		= UPIO_MEM;
2383ab4382d2SGreg Kroah-Hartman 	port->flags		= UPF_BOOT_AUTOCONF;
2384ab4382d2SGreg Kroah-Hartman 	port->ops		= &atmel_pops;
2385ab4382d2SGreg Kroah-Hartman 	port->fifosize		= 1;
2386ab4382d2SGreg Kroah-Hartman 	port->dev		= &pdev->dev;
2387ab4382d2SGreg Kroah-Hartman 	port->mapbase	= pdev->resource[0].start;
2388ab4382d2SGreg Kroah-Hartman 	port->irq	= pdev->resource[1].start;
238913bd3e6fSRicardo Ribalda Delgado 	port->rs485_config	= atmel_config_rs485;
2390ab4382d2SGreg Kroah-Hartman 
2391ab4382d2SGreg Kroah-Hartman 	memset(&atmel_port->rx_ring, 0, sizeof(atmel_port->rx_ring));
2392ab4382d2SGreg Kroah-Hartman 
23935fbe46b6SNicolas Ferre 	if (pdata && pdata->regs) {
2394ab4382d2SGreg Kroah-Hartman 		/* Already mapped by setup code */
23951acfc7ecSNicolas Ferre 		port->membase = pdata->regs;
2396588edbf3SNicolas Ferre 	} else {
2397ab4382d2SGreg Kroah-Hartman 		port->flags	|= UPF_IOREMAP;
2398ab4382d2SGreg Kroah-Hartman 		port->membase	= NULL;
2399ab4382d2SGreg Kroah-Hartman 	}
2400ab4382d2SGreg Kroah-Hartman 
2401ab4382d2SGreg Kroah-Hartman 	/* for console, the clock could already be configured */
2402ab4382d2SGreg Kroah-Hartman 	if (!atmel_port->clk) {
2403ab4382d2SGreg Kroah-Hartman 		atmel_port->clk = clk_get(&pdev->dev, "usart");
240491f8c2d8SBoris BREZILLON 		if (IS_ERR(atmel_port->clk)) {
240591f8c2d8SBoris BREZILLON 			ret = PTR_ERR(atmel_port->clk);
240691f8c2d8SBoris BREZILLON 			atmel_port->clk = NULL;
240791f8c2d8SBoris BREZILLON 			return ret;
240891f8c2d8SBoris BREZILLON 		}
240991f8c2d8SBoris BREZILLON 		ret = clk_prepare_enable(atmel_port->clk);
241091f8c2d8SBoris BREZILLON 		if (ret) {
241191f8c2d8SBoris BREZILLON 			clk_put(atmel_port->clk);
241291f8c2d8SBoris BREZILLON 			atmel_port->clk = NULL;
241391f8c2d8SBoris BREZILLON 			return ret;
241491f8c2d8SBoris BREZILLON 		}
2415ab4382d2SGreg Kroah-Hartman 		port->uartclk = clk_get_rate(atmel_port->clk);
241691f8c2d8SBoris BREZILLON 		clk_disable_unprepare(atmel_port->clk);
2417ab4382d2SGreg Kroah-Hartman 		/* only enable clock when USART is in use */
2418ab4382d2SGreg Kroah-Hartman 	}
2419ab4382d2SGreg Kroah-Hartman 
2420ab4382d2SGreg Kroah-Hartman 	/* Use TXEMPTY for interrupt when rs485 else TXRDY or ENDTX|TXBUFE */
242113bd3e6fSRicardo Ribalda Delgado 	if (port->rs485.flags & SER_RS485_ENABLED)
2422ab4382d2SGreg Kroah-Hartman 		atmel_port->tx_done_mask = ATMEL_US_TXEMPTY;
242364e22ebeSElen Song 	else if (atmel_use_pdc_tx(port)) {
2424ab4382d2SGreg Kroah-Hartman 		port->fifosize = PDC_BUFFER_SIZE;
2425ab4382d2SGreg Kroah-Hartman 		atmel_port->tx_done_mask = ATMEL_US_ENDTX | ATMEL_US_TXBUFE;
2426ab4382d2SGreg Kroah-Hartman 	} else {
2427ab4382d2SGreg Kroah-Hartman 		atmel_port->tx_done_mask = ATMEL_US_TXRDY;
2428ab4382d2SGreg Kroah-Hartman 	}
242991f8c2d8SBoris BREZILLON 
243091f8c2d8SBoris BREZILLON 	return 0;
2431ab4382d2SGreg Kroah-Hartman }
2432ab4382d2SGreg Kroah-Hartman 
243369f6a27bSJean-Christophe PLAGNIOL-VILLARD struct platform_device *atmel_default_console_device;	/* the serial console device */
243469f6a27bSJean-Christophe PLAGNIOL-VILLARD 
2435ab4382d2SGreg Kroah-Hartman #ifdef CONFIG_SERIAL_ATMEL_CONSOLE
2436ab4382d2SGreg Kroah-Hartman static void atmel_console_putchar(struct uart_port *port, int ch)
2437ab4382d2SGreg Kroah-Hartman {
24384e7decdaSCyrille Pitchen 	while (!(atmel_uart_readl(port, ATMEL_US_CSR) & ATMEL_US_TXRDY))
2439ab4382d2SGreg Kroah-Hartman 		cpu_relax();
2440a6499435SCyrille Pitchen 	atmel_uart_write_char(port, ch);
2441ab4382d2SGreg Kroah-Hartman }
2442ab4382d2SGreg Kroah-Hartman 
2443ab4382d2SGreg Kroah-Hartman /*
2444ab4382d2SGreg Kroah-Hartman  * Interrupts are disabled on entering
2445ab4382d2SGreg Kroah-Hartman  */
2446ab4382d2SGreg Kroah-Hartman static void atmel_console_write(struct console *co, const char *s, u_int count)
2447ab4382d2SGreg Kroah-Hartman {
2448ab4382d2SGreg Kroah-Hartman 	struct uart_port *port = &atmel_ports[co->index].uart;
2449ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
2450ab4382d2SGreg Kroah-Hartman 	unsigned int status, imr;
2451ab4382d2SGreg Kroah-Hartman 	unsigned int pdc_tx;
2452ab4382d2SGreg Kroah-Hartman 
2453ab4382d2SGreg Kroah-Hartman 	/*
2454ab4382d2SGreg Kroah-Hartman 	 * First, save IMR and then disable interrupts
2455ab4382d2SGreg Kroah-Hartman 	 */
24564e7decdaSCyrille Pitchen 	imr = atmel_uart_readl(port, ATMEL_US_IMR);
24574e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_IDR,
24584e7decdaSCyrille Pitchen 			  ATMEL_US_RXRDY | atmel_port->tx_done_mask);
2459ab4382d2SGreg Kroah-Hartman 
2460ab4382d2SGreg Kroah-Hartman 	/* Store PDC transmit status and disable it */
24614e7decdaSCyrille Pitchen 	pdc_tx = atmel_uart_readl(port, ATMEL_PDC_PTSR) & ATMEL_PDC_TXTEN;
24624e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_PDC_PTCR, ATMEL_PDC_TXTDIS);
2463ab4382d2SGreg Kroah-Hartman 
2464ab4382d2SGreg Kroah-Hartman 	uart_console_write(port, s, count, atmel_console_putchar);
2465ab4382d2SGreg Kroah-Hartman 
2466ab4382d2SGreg Kroah-Hartman 	/*
2467ab4382d2SGreg Kroah-Hartman 	 * Finally, wait for transmitter to become empty
2468ab4382d2SGreg Kroah-Hartman 	 * and restore IMR
2469ab4382d2SGreg Kroah-Hartman 	 */
2470ab4382d2SGreg Kroah-Hartman 	do {
24714e7decdaSCyrille Pitchen 		status = atmel_uart_readl(port, ATMEL_US_CSR);
2472ab4382d2SGreg Kroah-Hartman 	} while (!(status & ATMEL_US_TXRDY));
2473ab4382d2SGreg Kroah-Hartman 
2474ab4382d2SGreg Kroah-Hartman 	/* Restore PDC transmit status */
2475ab4382d2SGreg Kroah-Hartman 	if (pdc_tx)
24764e7decdaSCyrille Pitchen 		atmel_uart_writel(port, ATMEL_PDC_PTCR, ATMEL_PDC_TXTEN);
2477ab4382d2SGreg Kroah-Hartman 
2478ab4382d2SGreg Kroah-Hartman 	/* set interrupts back the way they were */
24794e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_IER, imr);
2480ab4382d2SGreg Kroah-Hartman }
2481ab4382d2SGreg Kroah-Hartman 
2482ab4382d2SGreg Kroah-Hartman /*
2483ab4382d2SGreg Kroah-Hartman  * If the port was already initialised (eg, by a boot loader),
2484ab4382d2SGreg Kroah-Hartman  * try to determine the current setup.
2485ab4382d2SGreg Kroah-Hartman  */
2486ab4382d2SGreg Kroah-Hartman static void __init atmel_console_get_options(struct uart_port *port, int *baud,
2487ab4382d2SGreg Kroah-Hartman 					     int *parity, int *bits)
2488ab4382d2SGreg Kroah-Hartman {
2489ab4382d2SGreg Kroah-Hartman 	unsigned int mr, quot;
2490ab4382d2SGreg Kroah-Hartman 
2491ab4382d2SGreg Kroah-Hartman 	/*
2492ab4382d2SGreg Kroah-Hartman 	 * If the baud rate generator isn't running, the port wasn't
2493ab4382d2SGreg Kroah-Hartman 	 * initialized by the boot loader.
2494ab4382d2SGreg Kroah-Hartman 	 */
24954e7decdaSCyrille Pitchen 	quot = atmel_uart_readl(port, ATMEL_US_BRGR) & ATMEL_US_CD;
2496ab4382d2SGreg Kroah-Hartman 	if (!quot)
2497ab4382d2SGreg Kroah-Hartman 		return;
2498ab4382d2SGreg Kroah-Hartman 
24994e7decdaSCyrille Pitchen 	mr = atmel_uart_readl(port, ATMEL_US_MR) & ATMEL_US_CHRL;
2500ab4382d2SGreg Kroah-Hartman 	if (mr == ATMEL_US_CHRL_8)
2501ab4382d2SGreg Kroah-Hartman 		*bits = 8;
2502ab4382d2SGreg Kroah-Hartman 	else
2503ab4382d2SGreg Kroah-Hartman 		*bits = 7;
2504ab4382d2SGreg Kroah-Hartman 
25054e7decdaSCyrille Pitchen 	mr = atmel_uart_readl(port, ATMEL_US_MR) & ATMEL_US_PAR;
2506ab4382d2SGreg Kroah-Hartman 	if (mr == ATMEL_US_PAR_EVEN)
2507ab4382d2SGreg Kroah-Hartman 		*parity = 'e';
2508ab4382d2SGreg Kroah-Hartman 	else if (mr == ATMEL_US_PAR_ODD)
2509ab4382d2SGreg Kroah-Hartman 		*parity = 'o';
2510ab4382d2SGreg Kroah-Hartman 
2511ab4382d2SGreg Kroah-Hartman 	/*
2512ab4382d2SGreg Kroah-Hartman 	 * The serial core only rounds down when matching this to a
2513ab4382d2SGreg Kroah-Hartman 	 * supported baud rate. Make sure we don't end up slightly
2514ab4382d2SGreg Kroah-Hartman 	 * lower than one of those, as it would make us fall through
2515ab4382d2SGreg Kroah-Hartman 	 * to a much lower baud rate than we really want.
2516ab4382d2SGreg Kroah-Hartman 	 */
2517ab4382d2SGreg Kroah-Hartman 	*baud = port->uartclk / (16 * (quot - 1));
2518ab4382d2SGreg Kroah-Hartman }
2519ab4382d2SGreg Kroah-Hartman 
2520ab4382d2SGreg Kroah-Hartman static int __init atmel_console_setup(struct console *co, char *options)
2521ab4382d2SGreg Kroah-Hartman {
252291f8c2d8SBoris BREZILLON 	int ret;
2523ab4382d2SGreg Kroah-Hartman 	struct uart_port *port = &atmel_ports[co->index].uart;
2524ab4382d2SGreg Kroah-Hartman 	int baud = 115200;
2525ab4382d2SGreg Kroah-Hartman 	int bits = 8;
2526ab4382d2SGreg Kroah-Hartman 	int parity = 'n';
2527ab4382d2SGreg Kroah-Hartman 	int flow = 'n';
2528ab4382d2SGreg Kroah-Hartman 
2529ab4382d2SGreg Kroah-Hartman 	if (port->membase == NULL) {
2530ab4382d2SGreg Kroah-Hartman 		/* Port not initialized yet - delay setup */
2531ab4382d2SGreg Kroah-Hartman 		return -ENODEV;
2532ab4382d2SGreg Kroah-Hartman 	}
2533ab4382d2SGreg Kroah-Hartman 
253491f8c2d8SBoris BREZILLON 	ret = clk_prepare_enable(atmel_ports[co->index].clk);
253591f8c2d8SBoris BREZILLON 	if (ret)
253691f8c2d8SBoris BREZILLON 		return ret;
2537ab4382d2SGreg Kroah-Hartman 
25384e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_IDR, -1);
25394e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_RSTSTA | ATMEL_US_RSTRX);
25404e7decdaSCyrille Pitchen 	atmel_uart_writel(port, ATMEL_US_CR, ATMEL_US_TXEN | ATMEL_US_RXEN);
2541ab4382d2SGreg Kroah-Hartman 
2542ab4382d2SGreg Kroah-Hartman 	if (options)
2543ab4382d2SGreg Kroah-Hartman 		uart_parse_options(options, &baud, &parity, &bits, &flow);
2544ab4382d2SGreg Kroah-Hartman 	else
2545ab4382d2SGreg Kroah-Hartman 		atmel_console_get_options(port, &baud, &parity, &bits);
2546ab4382d2SGreg Kroah-Hartman 
2547ab4382d2SGreg Kroah-Hartman 	return uart_set_options(port, co, baud, parity, bits, flow);
2548ab4382d2SGreg Kroah-Hartman }
2549ab4382d2SGreg Kroah-Hartman 
2550ab4382d2SGreg Kroah-Hartman static struct uart_driver atmel_uart;
2551ab4382d2SGreg Kroah-Hartman 
2552ab4382d2SGreg Kroah-Hartman static struct console atmel_console = {
2553ab4382d2SGreg Kroah-Hartman 	.name		= ATMEL_DEVICENAME,
2554ab4382d2SGreg Kroah-Hartman 	.write		= atmel_console_write,
2555ab4382d2SGreg Kroah-Hartman 	.device		= uart_console_device,
2556ab4382d2SGreg Kroah-Hartman 	.setup		= atmel_console_setup,
2557ab4382d2SGreg Kroah-Hartman 	.flags		= CON_PRINTBUFFER,
2558ab4382d2SGreg Kroah-Hartman 	.index		= -1,
2559ab4382d2SGreg Kroah-Hartman 	.data		= &atmel_uart,
2560ab4382d2SGreg Kroah-Hartman };
2561ab4382d2SGreg Kroah-Hartman 
2562ab4382d2SGreg Kroah-Hartman #define ATMEL_CONSOLE_DEVICE	(&atmel_console)
2563ab4382d2SGreg Kroah-Hartman 
2564ab4382d2SGreg Kroah-Hartman /*
2565ab4382d2SGreg Kroah-Hartman  * Early console initialization (before VM subsystem initialized).
2566ab4382d2SGreg Kroah-Hartman  */
2567ab4382d2SGreg Kroah-Hartman static int __init atmel_console_init(void)
2568ab4382d2SGreg Kroah-Hartman {
256991f8c2d8SBoris BREZILLON 	int ret;
2570ab4382d2SGreg Kroah-Hartman 	if (atmel_default_console_device) {
25710d0a3cc1SVoss, Nikolaus 		struct atmel_uart_data *pdata =
2572574de559SJingoo Han 			dev_get_platdata(&atmel_default_console_device->dev);
2573efb8d21bSLinus Torvalds 		int id = pdata->num;
2574b78cd169SJaeden Amero 		struct atmel_uart_port *atmel_port = &atmel_ports[id];
25750d0a3cc1SVoss, Nikolaus 
2576b78cd169SJaeden Amero 		atmel_port->backup_imr = 0;
2577b78cd169SJaeden Amero 		atmel_port->uart.line = id;
25784cbf9f48SNicolas Ferre 
25794cbf9f48SNicolas Ferre 		add_preferred_console(ATMEL_DEVICENAME, id, NULL);
2580b78cd169SJaeden Amero 		ret = atmel_init_port(atmel_port, atmel_default_console_device);
258191f8c2d8SBoris BREZILLON 		if (ret)
258291f8c2d8SBoris BREZILLON 			return ret;
2583ab4382d2SGreg Kroah-Hartman 		register_console(&atmel_console);
2584ab4382d2SGreg Kroah-Hartman 	}
2585ab4382d2SGreg Kroah-Hartman 
2586ab4382d2SGreg Kroah-Hartman 	return 0;
2587ab4382d2SGreg Kroah-Hartman }
2588ab4382d2SGreg Kroah-Hartman 
2589ab4382d2SGreg Kroah-Hartman console_initcall(atmel_console_init);
2590ab4382d2SGreg Kroah-Hartman 
2591ab4382d2SGreg Kroah-Hartman /*
2592ab4382d2SGreg Kroah-Hartman  * Late console initialization.
2593ab4382d2SGreg Kroah-Hartman  */
2594ab4382d2SGreg Kroah-Hartman static int __init atmel_late_console_init(void)
2595ab4382d2SGreg Kroah-Hartman {
2596ab4382d2SGreg Kroah-Hartman 	if (atmel_default_console_device
2597ab4382d2SGreg Kroah-Hartman 	    && !(atmel_console.flags & CON_ENABLED))
2598ab4382d2SGreg Kroah-Hartman 		register_console(&atmel_console);
2599ab4382d2SGreg Kroah-Hartman 
2600ab4382d2SGreg Kroah-Hartman 	return 0;
2601ab4382d2SGreg Kroah-Hartman }
2602ab4382d2SGreg Kroah-Hartman 
2603ab4382d2SGreg Kroah-Hartman core_initcall(atmel_late_console_init);
2604ab4382d2SGreg Kroah-Hartman 
2605ab4382d2SGreg Kroah-Hartman static inline bool atmel_is_console_port(struct uart_port *port)
2606ab4382d2SGreg Kroah-Hartman {
2607ab4382d2SGreg Kroah-Hartman 	return port->cons && port->cons->index == port->line;
2608ab4382d2SGreg Kroah-Hartman }
2609ab4382d2SGreg Kroah-Hartman 
2610ab4382d2SGreg Kroah-Hartman #else
2611ab4382d2SGreg Kroah-Hartman #define ATMEL_CONSOLE_DEVICE	NULL
2612ab4382d2SGreg Kroah-Hartman 
2613ab4382d2SGreg Kroah-Hartman static inline bool atmel_is_console_port(struct uart_port *port)
2614ab4382d2SGreg Kroah-Hartman {
2615ab4382d2SGreg Kroah-Hartman 	return false;
2616ab4382d2SGreg Kroah-Hartman }
2617ab4382d2SGreg Kroah-Hartman #endif
2618ab4382d2SGreg Kroah-Hartman 
2619ab4382d2SGreg Kroah-Hartman static struct uart_driver atmel_uart = {
2620ab4382d2SGreg Kroah-Hartman 	.owner		= THIS_MODULE,
2621ab4382d2SGreg Kroah-Hartman 	.driver_name	= "atmel_serial",
2622ab4382d2SGreg Kroah-Hartman 	.dev_name	= ATMEL_DEVICENAME,
2623ab4382d2SGreg Kroah-Hartman 	.major		= SERIAL_ATMEL_MAJOR,
2624ab4382d2SGreg Kroah-Hartman 	.minor		= MINOR_START,
2625ab4382d2SGreg Kroah-Hartman 	.nr		= ATMEL_MAX_UART,
2626ab4382d2SGreg Kroah-Hartman 	.cons		= ATMEL_CONSOLE_DEVICE,
2627ab4382d2SGreg Kroah-Hartman };
2628ab4382d2SGreg Kroah-Hartman 
2629ab4382d2SGreg Kroah-Hartman #ifdef CONFIG_PM
2630ab4382d2SGreg Kroah-Hartman static bool atmel_serial_clk_will_stop(void)
2631ab4382d2SGreg Kroah-Hartman {
2632ab4382d2SGreg Kroah-Hartman #ifdef CONFIG_ARCH_AT91
2633ab4382d2SGreg Kroah-Hartman 	return at91_suspend_entering_slow_clock();
2634ab4382d2SGreg Kroah-Hartman #else
2635ab4382d2SGreg Kroah-Hartman 	return false;
2636ab4382d2SGreg Kroah-Hartman #endif
2637ab4382d2SGreg Kroah-Hartman }
2638ab4382d2SGreg Kroah-Hartman 
2639ab4382d2SGreg Kroah-Hartman static int atmel_serial_suspend(struct platform_device *pdev,
2640ab4382d2SGreg Kroah-Hartman 				pm_message_t state)
2641ab4382d2SGreg Kroah-Hartman {
2642ab4382d2SGreg Kroah-Hartman 	struct uart_port *port = platform_get_drvdata(pdev);
2643ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
2644ab4382d2SGreg Kroah-Hartman 
2645ab4382d2SGreg Kroah-Hartman 	if (atmel_is_console_port(port) && console_suspend_enabled) {
2646ab4382d2SGreg Kroah-Hartman 		/* Drain the TX shifter */
26474e7decdaSCyrille Pitchen 		while (!(atmel_uart_readl(port, ATMEL_US_CSR) &
26484e7decdaSCyrille Pitchen 			 ATMEL_US_TXEMPTY))
2649ab4382d2SGreg Kroah-Hartman 			cpu_relax();
2650ab4382d2SGreg Kroah-Hartman 	}
2651ab4382d2SGreg Kroah-Hartman 
2652ab4382d2SGreg Kroah-Hartman 	/* we can not wake up if we're running on slow clock */
2653ab4382d2SGreg Kroah-Hartman 	atmel_port->may_wakeup = device_may_wakeup(&pdev->dev);
26542c7af5baSBoris BREZILLON 	if (atmel_serial_clk_will_stop()) {
26552c7af5baSBoris BREZILLON 		unsigned long flags;
26562c7af5baSBoris BREZILLON 
26572c7af5baSBoris BREZILLON 		spin_lock_irqsave(&atmel_port->lock_suspended, flags);
26582c7af5baSBoris BREZILLON 		atmel_port->suspended = true;
26592c7af5baSBoris BREZILLON 		spin_unlock_irqrestore(&atmel_port->lock_suspended, flags);
2660ab4382d2SGreg Kroah-Hartman 		device_set_wakeup_enable(&pdev->dev, 0);
26612c7af5baSBoris BREZILLON 	}
2662ab4382d2SGreg Kroah-Hartman 
2663ab4382d2SGreg Kroah-Hartman 	uart_suspend_port(&atmel_uart, port);
2664ab4382d2SGreg Kroah-Hartman 
2665ab4382d2SGreg Kroah-Hartman 	return 0;
2666ab4382d2SGreg Kroah-Hartman }
2667ab4382d2SGreg Kroah-Hartman 
2668ab4382d2SGreg Kroah-Hartman static int atmel_serial_resume(struct platform_device *pdev)
2669ab4382d2SGreg Kroah-Hartman {
2670ab4382d2SGreg Kroah-Hartman 	struct uart_port *port = platform_get_drvdata(pdev);
2671ab4382d2SGreg Kroah-Hartman 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
26722c7af5baSBoris BREZILLON 	unsigned long flags;
26732c7af5baSBoris BREZILLON 
26742c7af5baSBoris BREZILLON 	spin_lock_irqsave(&atmel_port->lock_suspended, flags);
26752c7af5baSBoris BREZILLON 	if (atmel_port->pending) {
26762c7af5baSBoris BREZILLON 		atmel_handle_receive(port, atmel_port->pending);
26772c7af5baSBoris BREZILLON 		atmel_handle_status(port, atmel_port->pending,
26782c7af5baSBoris BREZILLON 				    atmel_port->pending_status);
26792c7af5baSBoris BREZILLON 		atmel_handle_transmit(port, atmel_port->pending);
26802c7af5baSBoris BREZILLON 		atmel_port->pending = 0;
26812c7af5baSBoris BREZILLON 	}
26822c7af5baSBoris BREZILLON 	atmel_port->suspended = false;
26832c7af5baSBoris BREZILLON 	spin_unlock_irqrestore(&atmel_port->lock_suspended, flags);
2684ab4382d2SGreg Kroah-Hartman 
2685ab4382d2SGreg Kroah-Hartman 	uart_resume_port(&atmel_uart, port);
2686ab4382d2SGreg Kroah-Hartman 	device_set_wakeup_enable(&pdev->dev, atmel_port->may_wakeup);
2687ab4382d2SGreg Kroah-Hartman 
2688ab4382d2SGreg Kroah-Hartman 	return 0;
2689ab4382d2SGreg Kroah-Hartman }
2690ab4382d2SGreg Kroah-Hartman #else
2691ab4382d2SGreg Kroah-Hartman #define atmel_serial_suspend NULL
2692ab4382d2SGreg Kroah-Hartman #define atmel_serial_resume NULL
2693ab4382d2SGreg Kroah-Hartman #endif
2694ab4382d2SGreg Kroah-Hartman 
2695b78cd169SJaeden Amero static void atmel_serial_probe_fifos(struct atmel_uart_port *atmel_port,
2696b5199d46SCyrille Pitchen 				     struct platform_device *pdev)
2697b5199d46SCyrille Pitchen {
2698b78cd169SJaeden Amero 	atmel_port->fifo_size = 0;
2699b78cd169SJaeden Amero 	atmel_port->rts_low = 0;
2700b78cd169SJaeden Amero 	atmel_port->rts_high = 0;
2701b5199d46SCyrille Pitchen 
2702b5199d46SCyrille Pitchen 	if (of_property_read_u32(pdev->dev.of_node,
2703b5199d46SCyrille Pitchen 				 "atmel,fifo-size",
2704b78cd169SJaeden Amero 				 &atmel_port->fifo_size))
2705b5199d46SCyrille Pitchen 		return;
2706b5199d46SCyrille Pitchen 
2707b78cd169SJaeden Amero 	if (!atmel_port->fifo_size)
2708b5199d46SCyrille Pitchen 		return;
2709b5199d46SCyrille Pitchen 
2710b78cd169SJaeden Amero 	if (atmel_port->fifo_size < ATMEL_MIN_FIFO_SIZE) {
2711b78cd169SJaeden Amero 		atmel_port->fifo_size = 0;
2712b5199d46SCyrille Pitchen 		dev_err(&pdev->dev, "Invalid FIFO size\n");
2713b5199d46SCyrille Pitchen 		return;
2714b5199d46SCyrille Pitchen 	}
2715b5199d46SCyrille Pitchen 
2716b5199d46SCyrille Pitchen 	/*
2717b5199d46SCyrille Pitchen 	 * 0 <= rts_low <= rts_high <= fifo_size
2718b5199d46SCyrille Pitchen 	 * Once their CTS line asserted by the remote peer, some x86 UARTs tend
2719b5199d46SCyrille Pitchen 	 * to flush their internal TX FIFO, commonly up to 16 data, before
2720b5199d46SCyrille Pitchen 	 * actually stopping to send new data. So we try to set the RTS High
2721b5199d46SCyrille Pitchen 	 * Threshold to a reasonably high value respecting this 16 data
2722b5199d46SCyrille Pitchen 	 * empirical rule when possible.
2723b5199d46SCyrille Pitchen 	 */
2724b78cd169SJaeden Amero 	atmel_port->rts_high = max_t(int, atmel_port->fifo_size >> 1,
2725b78cd169SJaeden Amero 			       atmel_port->fifo_size - ATMEL_RTS_HIGH_OFFSET);
2726b78cd169SJaeden Amero 	atmel_port->rts_low  = max_t(int, atmel_port->fifo_size >> 2,
2727b78cd169SJaeden Amero 			       atmel_port->fifo_size - ATMEL_RTS_LOW_OFFSET);
2728b5199d46SCyrille Pitchen 
2729b5199d46SCyrille Pitchen 	dev_info(&pdev->dev, "Using FIFO (%u data)\n",
2730b78cd169SJaeden Amero 		 atmel_port->fifo_size);
2731b5199d46SCyrille Pitchen 	dev_dbg(&pdev->dev, "RTS High Threshold : %2u data\n",
2732b78cd169SJaeden Amero 		atmel_port->rts_high);
2733b5199d46SCyrille Pitchen 	dev_dbg(&pdev->dev, "RTS Low Threshold  : %2u data\n",
2734b78cd169SJaeden Amero 		atmel_port->rts_low);
2735b5199d46SCyrille Pitchen }
2736b5199d46SCyrille Pitchen 
27379671f099SBill Pemberton static int atmel_serial_probe(struct platform_device *pdev)
2738ab4382d2SGreg Kroah-Hartman {
2739b78cd169SJaeden Amero 	struct atmel_uart_port *atmel_port;
27405fbe46b6SNicolas Ferre 	struct device_node *np = pdev->dev.of_node;
2741574de559SJingoo Han 	struct atmel_uart_data *pdata = dev_get_platdata(&pdev->dev);
2742ab4382d2SGreg Kroah-Hartman 	void *data;
27434cbf9f48SNicolas Ferre 	int ret = -ENODEV;
2744bd737f87SRicardo Ribalda Delgado 	bool rs485_enabled;
2745ab4382d2SGreg Kroah-Hartman 
2746ab4382d2SGreg Kroah-Hartman 	BUILD_BUG_ON(ATMEL_SERIAL_RINGSIZE & (ATMEL_SERIAL_RINGSIZE - 1));
2747ab4382d2SGreg Kroah-Hartman 
27485fbe46b6SNicolas Ferre 	if (np)
27495fbe46b6SNicolas Ferre 		ret = of_alias_get_id(np, "serial");
27505fbe46b6SNicolas Ferre 	else
27514cbf9f48SNicolas Ferre 		if (pdata)
27524cbf9f48SNicolas Ferre 			ret = pdata->num;
27534cbf9f48SNicolas Ferre 
27544cbf9f48SNicolas Ferre 	if (ret < 0)
27555fbe46b6SNicolas Ferre 		/* port id not found in platform data nor device-tree aliases:
27564cbf9f48SNicolas Ferre 		 * auto-enumerate it */
2757503bded9SPawel Wieczorkiewicz 		ret = find_first_zero_bit(atmel_ports_in_use, ATMEL_MAX_UART);
27584cbf9f48SNicolas Ferre 
2759503bded9SPawel Wieczorkiewicz 	if (ret >= ATMEL_MAX_UART) {
27604cbf9f48SNicolas Ferre 		ret = -ENODEV;
27614cbf9f48SNicolas Ferre 		goto err;
27624cbf9f48SNicolas Ferre 	}
27634cbf9f48SNicolas Ferre 
2764503bded9SPawel Wieczorkiewicz 	if (test_and_set_bit(ret, atmel_ports_in_use)) {
27654cbf9f48SNicolas Ferre 		/* port already in use */
27664cbf9f48SNicolas Ferre 		ret = -EBUSY;
27674cbf9f48SNicolas Ferre 		goto err;
27684cbf9f48SNicolas Ferre 	}
27694cbf9f48SNicolas Ferre 
2770b78cd169SJaeden Amero 	atmel_port = &atmel_ports[ret];
2771b78cd169SJaeden Amero 	atmel_port->backup_imr = 0;
2772b78cd169SJaeden Amero 	atmel_port->uart.line = ret;
2773b78cd169SJaeden Amero 	atmel_serial_probe_fifos(atmel_port, pdev);
2774354e57f3SLinus Walleij 
277598f2082cSNicolas Ferre 	atomic_set(&atmel_port->tasklet_shutdown, 0);
2776b78cd169SJaeden Amero 	spin_lock_init(&atmel_port->lock_suspended);
27772c7af5baSBoris BREZILLON 
2778b78cd169SJaeden Amero 	ret = atmel_init_port(atmel_port, pdev);
277991f8c2d8SBoris BREZILLON 	if (ret)
27806fbb9bdfSCyrille Pitchen 		goto err_clear_bit;
2781ab4382d2SGreg Kroah-Hartman 
2782b78cd169SJaeden Amero 	atmel_port->gpios = mctrl_gpio_init(&atmel_port->uart, 0);
2783b78cd169SJaeden Amero 	if (IS_ERR(atmel_port->gpios)) {
2784b78cd169SJaeden Amero 		ret = PTR_ERR(atmel_port->gpios);
278518dfef9cSUwe Kleine-König 		goto err_clear_bit;
278618dfef9cSUwe Kleine-König 	}
278718dfef9cSUwe Kleine-König 
2788b78cd169SJaeden Amero 	if (!atmel_use_pdc_rx(&atmel_port->uart)) {
2789ab4382d2SGreg Kroah-Hartman 		ret = -ENOMEM;
2790ab4382d2SGreg Kroah-Hartman 		data = kmalloc(sizeof(struct atmel_uart_char)
2791ab4382d2SGreg Kroah-Hartman 				* ATMEL_SERIAL_RINGSIZE, GFP_KERNEL);
2792ab4382d2SGreg Kroah-Hartman 		if (!data)
2793ab4382d2SGreg Kroah-Hartman 			goto err_alloc_ring;
2794b78cd169SJaeden Amero 		atmel_port->rx_ring.buf = data;
2795ab4382d2SGreg Kroah-Hartman 	}
2796ab4382d2SGreg Kroah-Hartman 
2797b78cd169SJaeden Amero 	rs485_enabled = atmel_port->uart.rs485.flags & SER_RS485_ENABLED;
2798bd737f87SRicardo Ribalda Delgado 
2799b78cd169SJaeden Amero 	ret = uart_add_one_port(&atmel_uart, &atmel_port->uart);
2800ab4382d2SGreg Kroah-Hartman 	if (ret)
2801ab4382d2SGreg Kroah-Hartman 		goto err_add_port;
2802ab4382d2SGreg Kroah-Hartman 
2803ab4382d2SGreg Kroah-Hartman #ifdef CONFIG_SERIAL_ATMEL_CONSOLE
2804b78cd169SJaeden Amero 	if (atmel_is_console_port(&atmel_port->uart)
2805ab4382d2SGreg Kroah-Hartman 			&& ATMEL_CONSOLE_DEVICE->flags & CON_ENABLED) {
2806ab4382d2SGreg Kroah-Hartman 		/*
2807ab4382d2SGreg Kroah-Hartman 		 * The serial core enabled the clock for us, so undo
280891f8c2d8SBoris BREZILLON 		 * the clk_prepare_enable() in atmel_console_setup()
2809ab4382d2SGreg Kroah-Hartman 		 */
2810b78cd169SJaeden Amero 		clk_disable_unprepare(atmel_port->clk);
2811ab4382d2SGreg Kroah-Hartman 	}
2812ab4382d2SGreg Kroah-Hartman #endif
2813ab4382d2SGreg Kroah-Hartman 
2814ab4382d2SGreg Kroah-Hartman 	device_init_wakeup(&pdev->dev, 1);
2815b78cd169SJaeden Amero 	platform_set_drvdata(pdev, atmel_port);
2816ab4382d2SGreg Kroah-Hartman 
2817d4f64187SCyrille Pitchen 	/*
2818d4f64187SCyrille Pitchen 	 * The peripheral clock has been disabled by atmel_init_port():
2819d4f64187SCyrille Pitchen 	 * enable it before accessing I/O registers
2820d4f64187SCyrille Pitchen 	 */
2821b78cd169SJaeden Amero 	clk_prepare_enable(atmel_port->clk);
2822d4f64187SCyrille Pitchen 
2823bd737f87SRicardo Ribalda Delgado 	if (rs485_enabled) {
2824b78cd169SJaeden Amero 		atmel_uart_writel(&atmel_port->uart, ATMEL_US_MR,
28254e7decdaSCyrille Pitchen 				  ATMEL_US_USMODE_NORMAL);
2826b78cd169SJaeden Amero 		atmel_uart_writel(&atmel_port->uart, ATMEL_US_CR,
2827b78cd169SJaeden Amero 				  ATMEL_US_RTSEN);
2828fc887b15SLinus Torvalds 	}
2829fc887b15SLinus Torvalds 
2830055560b0SElen Song 	/*
2831055560b0SElen Song 	 * Get port name of usart or uart
2832055560b0SElen Song 	 */
2833b78cd169SJaeden Amero 	atmel_get_ip_name(&atmel_port->uart);
2834055560b0SElen Song 
2835d4f64187SCyrille Pitchen 	/*
2836d4f64187SCyrille Pitchen 	 * The peripheral clock can now safely be disabled till the port
2837d4f64187SCyrille Pitchen 	 * is used
2838d4f64187SCyrille Pitchen 	 */
2839b78cd169SJaeden Amero 	clk_disable_unprepare(atmel_port->clk);
2840d4f64187SCyrille Pitchen 
2841ab4382d2SGreg Kroah-Hartman 	return 0;
2842ab4382d2SGreg Kroah-Hartman 
2843ab4382d2SGreg Kroah-Hartman err_add_port:
2844b78cd169SJaeden Amero 	kfree(atmel_port->rx_ring.buf);
2845b78cd169SJaeden Amero 	atmel_port->rx_ring.buf = NULL;
2846ab4382d2SGreg Kroah-Hartman err_alloc_ring:
2847b78cd169SJaeden Amero 	if (!atmel_is_console_port(&atmel_port->uart)) {
2848b78cd169SJaeden Amero 		clk_put(atmel_port->clk);
2849b78cd169SJaeden Amero 		atmel_port->clk = NULL;
2850ab4382d2SGreg Kroah-Hartman 	}
28516fbb9bdfSCyrille Pitchen err_clear_bit:
2852b78cd169SJaeden Amero 	clear_bit(atmel_port->uart.line, atmel_ports_in_use);
28534cbf9f48SNicolas Ferre err:
2854ab4382d2SGreg Kroah-Hartman 	return ret;
2855ab4382d2SGreg Kroah-Hartman }
2856ab4382d2SGreg Kroah-Hartman 
2857f4a8ab04SRomain Izard /*
2858f4a8ab04SRomain Izard  * Even if the driver is not modular, it makes sense to be able to
2859f4a8ab04SRomain Izard  * unbind a device: there can be many bound devices, and there are
2860f4a8ab04SRomain Izard  * situations where dynamic binding and unbinding can be useful.
2861f4a8ab04SRomain Izard  *
2862f4a8ab04SRomain Izard  * For example, a connected device can require a specific firmware update
2863f4a8ab04SRomain Izard  * protocol that needs bitbanging on IO lines, but use the regular serial
2864f4a8ab04SRomain Izard  * port in the normal case.
2865f4a8ab04SRomain Izard  */
2866f4a8ab04SRomain Izard static int atmel_serial_remove(struct platform_device *pdev)
2867f4a8ab04SRomain Izard {
2868f4a8ab04SRomain Izard 	struct uart_port *port = platform_get_drvdata(pdev);
2869f4a8ab04SRomain Izard 	struct atmel_uart_port *atmel_port = to_atmel_uart_port(port);
2870f4a8ab04SRomain Izard 	int ret = 0;
2871f4a8ab04SRomain Izard 
287200e8e658SNicolas Ferre 	tasklet_kill(&atmel_port->tasklet_rx);
287300e8e658SNicolas Ferre 	tasklet_kill(&atmel_port->tasklet_tx);
2874f4a8ab04SRomain Izard 
2875f4a8ab04SRomain Izard 	device_init_wakeup(&pdev->dev, 0);
2876f4a8ab04SRomain Izard 
2877f4a8ab04SRomain Izard 	ret = uart_remove_one_port(&atmel_uart, port);
2878f4a8ab04SRomain Izard 
2879f4a8ab04SRomain Izard 	kfree(atmel_port->rx_ring.buf);
2880f4a8ab04SRomain Izard 
2881f4a8ab04SRomain Izard 	/* "port" is allocated statically, so we shouldn't free it */
2882f4a8ab04SRomain Izard 
2883f4a8ab04SRomain Izard 	clear_bit(port->line, atmel_ports_in_use);
2884f4a8ab04SRomain Izard 
2885f4a8ab04SRomain Izard 	clk_put(atmel_port->clk);
2886f4a8ab04SRomain Izard 	atmel_port->clk = NULL;
2887f4a8ab04SRomain Izard 
2888f4a8ab04SRomain Izard 	return ret;
2889f4a8ab04SRomain Izard }
2890f4a8ab04SRomain Izard 
2891ab4382d2SGreg Kroah-Hartman static struct platform_driver atmel_serial_driver = {
2892ab4382d2SGreg Kroah-Hartman 	.probe		= atmel_serial_probe,
2893f4a8ab04SRomain Izard 	.remove		= atmel_serial_remove,
2894ab4382d2SGreg Kroah-Hartman 	.suspend	= atmel_serial_suspend,
2895ab4382d2SGreg Kroah-Hartman 	.resume		= atmel_serial_resume,
2896ab4382d2SGreg Kroah-Hartman 	.driver		= {
2897ab4382d2SGreg Kroah-Hartman 		.name			= "atmel_usart",
28985fbe46b6SNicolas Ferre 		.of_match_table		= of_match_ptr(atmel_serial_dt_ids),
2899ab4382d2SGreg Kroah-Hartman 	},
2900ab4382d2SGreg Kroah-Hartman };
2901ab4382d2SGreg Kroah-Hartman 
2902ab4382d2SGreg Kroah-Hartman static int __init atmel_serial_init(void)
2903ab4382d2SGreg Kroah-Hartman {
2904ab4382d2SGreg Kroah-Hartman 	int ret;
2905ab4382d2SGreg Kroah-Hartman 
2906ab4382d2SGreg Kroah-Hartman 	ret = uart_register_driver(&atmel_uart);
2907ab4382d2SGreg Kroah-Hartman 	if (ret)
2908ab4382d2SGreg Kroah-Hartman 		return ret;
2909ab4382d2SGreg Kroah-Hartman 
2910ab4382d2SGreg Kroah-Hartman 	ret = platform_driver_register(&atmel_serial_driver);
2911ab4382d2SGreg Kroah-Hartman 	if (ret)
2912ab4382d2SGreg Kroah-Hartman 		uart_unregister_driver(&atmel_uart);
2913ab4382d2SGreg Kroah-Hartman 
2914ab4382d2SGreg Kroah-Hartman 	return ret;
2915ab4382d2SGreg Kroah-Hartman }
2916c39dfebcSPaul Gortmaker device_initcall(atmel_serial_init);
2917