xref: /OK3568_Linux_fs/kernel/drivers/dma/sh/usb-dmac.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Renesas USB DMA Controller Driver
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (C) 2015 Renesas Electronics Corporation
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  * based on rcar-dmac.c
8*4882a593Smuzhiyun  * Copyright (C) 2014 Renesas Electronics Inc.
9*4882a593Smuzhiyun  * Author: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
10*4882a593Smuzhiyun  */
11*4882a593Smuzhiyun 
12*4882a593Smuzhiyun #include <linux/delay.h>
13*4882a593Smuzhiyun #include <linux/dma-mapping.h>
14*4882a593Smuzhiyun #include <linux/dmaengine.h>
15*4882a593Smuzhiyun #include <linux/interrupt.h>
16*4882a593Smuzhiyun #include <linux/list.h>
17*4882a593Smuzhiyun #include <linux/module.h>
18*4882a593Smuzhiyun #include <linux/of.h>
19*4882a593Smuzhiyun #include <linux/of_dma.h>
20*4882a593Smuzhiyun #include <linux/of_platform.h>
21*4882a593Smuzhiyun #include <linux/platform_device.h>
22*4882a593Smuzhiyun #include <linux/pm_runtime.h>
23*4882a593Smuzhiyun #include <linux/slab.h>
24*4882a593Smuzhiyun #include <linux/spinlock.h>
25*4882a593Smuzhiyun 
26*4882a593Smuzhiyun #include "../dmaengine.h"
27*4882a593Smuzhiyun #include "../virt-dma.h"
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun /*
30*4882a593Smuzhiyun  * struct usb_dmac_sg - Descriptor for a hardware transfer
31*4882a593Smuzhiyun  * @mem_addr: memory address
32*4882a593Smuzhiyun  * @size: transfer size in bytes
33*4882a593Smuzhiyun  */
34*4882a593Smuzhiyun struct usb_dmac_sg {
35*4882a593Smuzhiyun 	dma_addr_t mem_addr;
36*4882a593Smuzhiyun 	u32 size;
37*4882a593Smuzhiyun };
38*4882a593Smuzhiyun 
39*4882a593Smuzhiyun /*
40*4882a593Smuzhiyun  * struct usb_dmac_desc - USB DMA Transfer Descriptor
41*4882a593Smuzhiyun  * @vd: base virtual channel DMA transaction descriptor
42*4882a593Smuzhiyun  * @direction: direction of the DMA transfer
43*4882a593Smuzhiyun  * @sg_allocated_len: length of allocated sg
44*4882a593Smuzhiyun  * @sg_len: length of sg
45*4882a593Smuzhiyun  * @sg_index: index of sg
46*4882a593Smuzhiyun  * @residue: residue after the DMAC completed a transfer
47*4882a593Smuzhiyun  * @node: node for desc_got and desc_freed
48*4882a593Smuzhiyun  * @done_cookie: cookie after the DMAC completed a transfer
49*4882a593Smuzhiyun  * @sg: information for the transfer
50*4882a593Smuzhiyun  */
51*4882a593Smuzhiyun struct usb_dmac_desc {
52*4882a593Smuzhiyun 	struct virt_dma_desc vd;
53*4882a593Smuzhiyun 	enum dma_transfer_direction direction;
54*4882a593Smuzhiyun 	unsigned int sg_allocated_len;
55*4882a593Smuzhiyun 	unsigned int sg_len;
56*4882a593Smuzhiyun 	unsigned int sg_index;
57*4882a593Smuzhiyun 	u32 residue;
58*4882a593Smuzhiyun 	struct list_head node;
59*4882a593Smuzhiyun 	dma_cookie_t done_cookie;
60*4882a593Smuzhiyun 	struct usb_dmac_sg sg[];
61*4882a593Smuzhiyun };
62*4882a593Smuzhiyun 
63*4882a593Smuzhiyun #define to_usb_dmac_desc(vd)	container_of(vd, struct usb_dmac_desc, vd)
64*4882a593Smuzhiyun 
65*4882a593Smuzhiyun /*
66*4882a593Smuzhiyun  * struct usb_dmac_chan - USB DMA Controller Channel
67*4882a593Smuzhiyun  * @vc: base virtual DMA channel object
68*4882a593Smuzhiyun  * @iomem: channel I/O memory base
69*4882a593Smuzhiyun  * @index: index of this channel in the controller
70*4882a593Smuzhiyun  * @irq: irq number of this channel
71*4882a593Smuzhiyun  * @desc: the current descriptor
72*4882a593Smuzhiyun  * @descs_allocated: number of descriptors allocated
73*4882a593Smuzhiyun  * @desc_got: got descriptors
74*4882a593Smuzhiyun  * @desc_freed: freed descriptors after the DMAC completed a transfer
75*4882a593Smuzhiyun  */
76*4882a593Smuzhiyun struct usb_dmac_chan {
77*4882a593Smuzhiyun 	struct virt_dma_chan vc;
78*4882a593Smuzhiyun 	void __iomem *iomem;
79*4882a593Smuzhiyun 	unsigned int index;
80*4882a593Smuzhiyun 	int irq;
81*4882a593Smuzhiyun 	struct usb_dmac_desc *desc;
82*4882a593Smuzhiyun 	int descs_allocated;
83*4882a593Smuzhiyun 	struct list_head desc_got;
84*4882a593Smuzhiyun 	struct list_head desc_freed;
85*4882a593Smuzhiyun };
86*4882a593Smuzhiyun 
87*4882a593Smuzhiyun #define to_usb_dmac_chan(c) container_of(c, struct usb_dmac_chan, vc.chan)
88*4882a593Smuzhiyun 
89*4882a593Smuzhiyun /*
90*4882a593Smuzhiyun  * struct usb_dmac - USB DMA Controller
91*4882a593Smuzhiyun  * @engine: base DMA engine object
92*4882a593Smuzhiyun  * @dev: the hardware device
93*4882a593Smuzhiyun  * @iomem: remapped I/O memory base
94*4882a593Smuzhiyun  * @n_channels: number of available channels
95*4882a593Smuzhiyun  * @channels: array of DMAC channels
96*4882a593Smuzhiyun  */
97*4882a593Smuzhiyun struct usb_dmac {
98*4882a593Smuzhiyun 	struct dma_device engine;
99*4882a593Smuzhiyun 	struct device *dev;
100*4882a593Smuzhiyun 	void __iomem *iomem;
101*4882a593Smuzhiyun 
102*4882a593Smuzhiyun 	unsigned int n_channels;
103*4882a593Smuzhiyun 	struct usb_dmac_chan *channels;
104*4882a593Smuzhiyun };
105*4882a593Smuzhiyun 
106*4882a593Smuzhiyun #define to_usb_dmac(d)		container_of(d, struct usb_dmac, engine)
107*4882a593Smuzhiyun 
108*4882a593Smuzhiyun /* -----------------------------------------------------------------------------
109*4882a593Smuzhiyun  * Registers
110*4882a593Smuzhiyun  */
111*4882a593Smuzhiyun 
112*4882a593Smuzhiyun #define USB_DMAC_CHAN_OFFSET(i)		(0x20 + 0x20 * (i))
113*4882a593Smuzhiyun 
114*4882a593Smuzhiyun #define USB_DMASWR			0x0008
115*4882a593Smuzhiyun #define USB_DMASWR_SWR			(1 << 0)
116*4882a593Smuzhiyun #define USB_DMAOR			0x0060
117*4882a593Smuzhiyun #define USB_DMAOR_AE			(1 << 1)
118*4882a593Smuzhiyun #define USB_DMAOR_DME			(1 << 0)
119*4882a593Smuzhiyun 
120*4882a593Smuzhiyun #define USB_DMASAR			0x0000
121*4882a593Smuzhiyun #define USB_DMADAR			0x0004
122*4882a593Smuzhiyun #define USB_DMATCR			0x0008
123*4882a593Smuzhiyun #define USB_DMATCR_MASK			0x00ffffff
124*4882a593Smuzhiyun #define USB_DMACHCR			0x0014
125*4882a593Smuzhiyun #define USB_DMACHCR_FTE			(1 << 24)
126*4882a593Smuzhiyun #define USB_DMACHCR_NULLE		(1 << 16)
127*4882a593Smuzhiyun #define USB_DMACHCR_NULL		(1 << 12)
128*4882a593Smuzhiyun #define USB_DMACHCR_TS_8B		((0 << 7) | (0 << 6))
129*4882a593Smuzhiyun #define USB_DMACHCR_TS_16B		((0 << 7) | (1 << 6))
130*4882a593Smuzhiyun #define USB_DMACHCR_TS_32B		((1 << 7) | (0 << 6))
131*4882a593Smuzhiyun #define USB_DMACHCR_IE			(1 << 5)
132*4882a593Smuzhiyun #define USB_DMACHCR_SP			(1 << 2)
133*4882a593Smuzhiyun #define USB_DMACHCR_TE			(1 << 1)
134*4882a593Smuzhiyun #define USB_DMACHCR_DE			(1 << 0)
135*4882a593Smuzhiyun #define USB_DMATEND			0x0018
136*4882a593Smuzhiyun 
137*4882a593Smuzhiyun /* Hardcode the xfer_shift to 5 (32bytes) */
138*4882a593Smuzhiyun #define USB_DMAC_XFER_SHIFT	5
139*4882a593Smuzhiyun #define USB_DMAC_XFER_SIZE	(1 << USB_DMAC_XFER_SHIFT)
140*4882a593Smuzhiyun #define USB_DMAC_CHCR_TS	USB_DMACHCR_TS_32B
141*4882a593Smuzhiyun #define USB_DMAC_SLAVE_BUSWIDTH	DMA_SLAVE_BUSWIDTH_32_BYTES
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun /* for descriptors */
144*4882a593Smuzhiyun #define USB_DMAC_INITIAL_NR_DESC	16
145*4882a593Smuzhiyun #define USB_DMAC_INITIAL_NR_SG		8
146*4882a593Smuzhiyun 
147*4882a593Smuzhiyun /* -----------------------------------------------------------------------------
148*4882a593Smuzhiyun  * Device access
149*4882a593Smuzhiyun  */
150*4882a593Smuzhiyun 
usb_dmac_write(struct usb_dmac * dmac,u32 reg,u32 data)151*4882a593Smuzhiyun static void usb_dmac_write(struct usb_dmac *dmac, u32 reg, u32 data)
152*4882a593Smuzhiyun {
153*4882a593Smuzhiyun 	writel(data, dmac->iomem + reg);
154*4882a593Smuzhiyun }
155*4882a593Smuzhiyun 
usb_dmac_read(struct usb_dmac * dmac,u32 reg)156*4882a593Smuzhiyun static u32 usb_dmac_read(struct usb_dmac *dmac, u32 reg)
157*4882a593Smuzhiyun {
158*4882a593Smuzhiyun 	return readl(dmac->iomem + reg);
159*4882a593Smuzhiyun }
160*4882a593Smuzhiyun 
usb_dmac_chan_read(struct usb_dmac_chan * chan,u32 reg)161*4882a593Smuzhiyun static u32 usb_dmac_chan_read(struct usb_dmac_chan *chan, u32 reg)
162*4882a593Smuzhiyun {
163*4882a593Smuzhiyun 	return readl(chan->iomem + reg);
164*4882a593Smuzhiyun }
165*4882a593Smuzhiyun 
usb_dmac_chan_write(struct usb_dmac_chan * chan,u32 reg,u32 data)166*4882a593Smuzhiyun static void usb_dmac_chan_write(struct usb_dmac_chan *chan, u32 reg, u32 data)
167*4882a593Smuzhiyun {
168*4882a593Smuzhiyun 	writel(data, chan->iomem + reg);
169*4882a593Smuzhiyun }
170*4882a593Smuzhiyun 
171*4882a593Smuzhiyun /* -----------------------------------------------------------------------------
172*4882a593Smuzhiyun  * Initialization and configuration
173*4882a593Smuzhiyun  */
174*4882a593Smuzhiyun 
usb_dmac_chan_is_busy(struct usb_dmac_chan * chan)175*4882a593Smuzhiyun static bool usb_dmac_chan_is_busy(struct usb_dmac_chan *chan)
176*4882a593Smuzhiyun {
177*4882a593Smuzhiyun 	u32 chcr = usb_dmac_chan_read(chan, USB_DMACHCR);
178*4882a593Smuzhiyun 
179*4882a593Smuzhiyun 	return (chcr & (USB_DMACHCR_DE | USB_DMACHCR_TE)) == USB_DMACHCR_DE;
180*4882a593Smuzhiyun }
181*4882a593Smuzhiyun 
usb_dmac_calc_tend(u32 size)182*4882a593Smuzhiyun static u32 usb_dmac_calc_tend(u32 size)
183*4882a593Smuzhiyun {
184*4882a593Smuzhiyun 	/*
185*4882a593Smuzhiyun 	 * Please refer to the Figure "Example of Final Transaction Valid
186*4882a593Smuzhiyun 	 * Data Transfer Enable (EDTEN) Setting" in the data sheet.
187*4882a593Smuzhiyun 	 */
188*4882a593Smuzhiyun 	return 0xffffffff << (32 - (size % USB_DMAC_XFER_SIZE ?	:
189*4882a593Smuzhiyun 						USB_DMAC_XFER_SIZE));
190*4882a593Smuzhiyun }
191*4882a593Smuzhiyun 
192*4882a593Smuzhiyun /* This function is already held by vc.lock */
usb_dmac_chan_start_sg(struct usb_dmac_chan * chan,unsigned int index)193*4882a593Smuzhiyun static void usb_dmac_chan_start_sg(struct usb_dmac_chan *chan,
194*4882a593Smuzhiyun 				   unsigned int index)
195*4882a593Smuzhiyun {
196*4882a593Smuzhiyun 	struct usb_dmac_desc *desc = chan->desc;
197*4882a593Smuzhiyun 	struct usb_dmac_sg *sg = desc->sg + index;
198*4882a593Smuzhiyun 	dma_addr_t src_addr = 0, dst_addr = 0;
199*4882a593Smuzhiyun 
200*4882a593Smuzhiyun 	WARN_ON_ONCE(usb_dmac_chan_is_busy(chan));
201*4882a593Smuzhiyun 
202*4882a593Smuzhiyun 	if (desc->direction == DMA_DEV_TO_MEM)
203*4882a593Smuzhiyun 		dst_addr = sg->mem_addr;
204*4882a593Smuzhiyun 	else
205*4882a593Smuzhiyun 		src_addr = sg->mem_addr;
206*4882a593Smuzhiyun 
207*4882a593Smuzhiyun 	dev_dbg(chan->vc.chan.device->dev,
208*4882a593Smuzhiyun 		"chan%u: queue sg %p: %u@%pad -> %pad\n",
209*4882a593Smuzhiyun 		chan->index, sg, sg->size, &src_addr, &dst_addr);
210*4882a593Smuzhiyun 
211*4882a593Smuzhiyun 	usb_dmac_chan_write(chan, USB_DMASAR, src_addr & 0xffffffff);
212*4882a593Smuzhiyun 	usb_dmac_chan_write(chan, USB_DMADAR, dst_addr & 0xffffffff);
213*4882a593Smuzhiyun 	usb_dmac_chan_write(chan, USB_DMATCR,
214*4882a593Smuzhiyun 			    DIV_ROUND_UP(sg->size, USB_DMAC_XFER_SIZE));
215*4882a593Smuzhiyun 	usb_dmac_chan_write(chan, USB_DMATEND, usb_dmac_calc_tend(sg->size));
216*4882a593Smuzhiyun 
217*4882a593Smuzhiyun 	usb_dmac_chan_write(chan, USB_DMACHCR, USB_DMAC_CHCR_TS |
218*4882a593Smuzhiyun 			USB_DMACHCR_NULLE | USB_DMACHCR_IE | USB_DMACHCR_DE);
219*4882a593Smuzhiyun }
220*4882a593Smuzhiyun 
221*4882a593Smuzhiyun /* This function is already held by vc.lock */
usb_dmac_chan_start_desc(struct usb_dmac_chan * chan)222*4882a593Smuzhiyun static void usb_dmac_chan_start_desc(struct usb_dmac_chan *chan)
223*4882a593Smuzhiyun {
224*4882a593Smuzhiyun 	struct virt_dma_desc *vd;
225*4882a593Smuzhiyun 
226*4882a593Smuzhiyun 	vd = vchan_next_desc(&chan->vc);
227*4882a593Smuzhiyun 	if (!vd) {
228*4882a593Smuzhiyun 		chan->desc = NULL;
229*4882a593Smuzhiyun 		return;
230*4882a593Smuzhiyun 	}
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun 	/*
233*4882a593Smuzhiyun 	 * Remove this request from vc->desc_issued. Otherwise, this driver
234*4882a593Smuzhiyun 	 * will get the previous value from vchan_next_desc() after a transfer
235*4882a593Smuzhiyun 	 * was completed.
236*4882a593Smuzhiyun 	 */
237*4882a593Smuzhiyun 	list_del(&vd->node);
238*4882a593Smuzhiyun 
239*4882a593Smuzhiyun 	chan->desc = to_usb_dmac_desc(vd);
240*4882a593Smuzhiyun 	chan->desc->sg_index = 0;
241*4882a593Smuzhiyun 	usb_dmac_chan_start_sg(chan, 0);
242*4882a593Smuzhiyun }
243*4882a593Smuzhiyun 
usb_dmac_init(struct usb_dmac * dmac)244*4882a593Smuzhiyun static int usb_dmac_init(struct usb_dmac *dmac)
245*4882a593Smuzhiyun {
246*4882a593Smuzhiyun 	u16 dmaor;
247*4882a593Smuzhiyun 
248*4882a593Smuzhiyun 	/* Clear all channels and enable the DMAC globally. */
249*4882a593Smuzhiyun 	usb_dmac_write(dmac, USB_DMAOR, USB_DMAOR_DME);
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun 	dmaor = usb_dmac_read(dmac, USB_DMAOR);
252*4882a593Smuzhiyun 	if ((dmaor & (USB_DMAOR_AE | USB_DMAOR_DME)) != USB_DMAOR_DME) {
253*4882a593Smuzhiyun 		dev_warn(dmac->dev, "DMAOR initialization failed.\n");
254*4882a593Smuzhiyun 		return -EIO;
255*4882a593Smuzhiyun 	}
256*4882a593Smuzhiyun 
257*4882a593Smuzhiyun 	return 0;
258*4882a593Smuzhiyun }
259*4882a593Smuzhiyun 
260*4882a593Smuzhiyun /* -----------------------------------------------------------------------------
261*4882a593Smuzhiyun  * Descriptors allocation and free
262*4882a593Smuzhiyun  */
usb_dmac_desc_alloc(struct usb_dmac_chan * chan,unsigned int sg_len,gfp_t gfp)263*4882a593Smuzhiyun static int usb_dmac_desc_alloc(struct usb_dmac_chan *chan, unsigned int sg_len,
264*4882a593Smuzhiyun 			       gfp_t gfp)
265*4882a593Smuzhiyun {
266*4882a593Smuzhiyun 	struct usb_dmac_desc *desc;
267*4882a593Smuzhiyun 	unsigned long flags;
268*4882a593Smuzhiyun 
269*4882a593Smuzhiyun 	desc = kzalloc(struct_size(desc, sg, sg_len), gfp);
270*4882a593Smuzhiyun 	if (!desc)
271*4882a593Smuzhiyun 		return -ENOMEM;
272*4882a593Smuzhiyun 
273*4882a593Smuzhiyun 	desc->sg_allocated_len = sg_len;
274*4882a593Smuzhiyun 	INIT_LIST_HEAD(&desc->node);
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun 	spin_lock_irqsave(&chan->vc.lock, flags);
277*4882a593Smuzhiyun 	list_add_tail(&desc->node, &chan->desc_freed);
278*4882a593Smuzhiyun 	spin_unlock_irqrestore(&chan->vc.lock, flags);
279*4882a593Smuzhiyun 
280*4882a593Smuzhiyun 	return 0;
281*4882a593Smuzhiyun }
282*4882a593Smuzhiyun 
usb_dmac_desc_free(struct usb_dmac_chan * chan)283*4882a593Smuzhiyun static void usb_dmac_desc_free(struct usb_dmac_chan *chan)
284*4882a593Smuzhiyun {
285*4882a593Smuzhiyun 	struct usb_dmac_desc *desc, *_desc;
286*4882a593Smuzhiyun 	LIST_HEAD(list);
287*4882a593Smuzhiyun 
288*4882a593Smuzhiyun 	list_splice_init(&chan->desc_freed, &list);
289*4882a593Smuzhiyun 	list_splice_init(&chan->desc_got, &list);
290*4882a593Smuzhiyun 
291*4882a593Smuzhiyun 	list_for_each_entry_safe(desc, _desc, &list, node) {
292*4882a593Smuzhiyun 		list_del(&desc->node);
293*4882a593Smuzhiyun 		kfree(desc);
294*4882a593Smuzhiyun 	}
295*4882a593Smuzhiyun 	chan->descs_allocated = 0;
296*4882a593Smuzhiyun }
297*4882a593Smuzhiyun 
usb_dmac_desc_get(struct usb_dmac_chan * chan,unsigned int sg_len,gfp_t gfp)298*4882a593Smuzhiyun static struct usb_dmac_desc *usb_dmac_desc_get(struct usb_dmac_chan *chan,
299*4882a593Smuzhiyun 					       unsigned int sg_len, gfp_t gfp)
300*4882a593Smuzhiyun {
301*4882a593Smuzhiyun 	struct usb_dmac_desc *desc = NULL;
302*4882a593Smuzhiyun 	unsigned long flags;
303*4882a593Smuzhiyun 
304*4882a593Smuzhiyun 	/* Get a freed descritpor */
305*4882a593Smuzhiyun 	spin_lock_irqsave(&chan->vc.lock, flags);
306*4882a593Smuzhiyun 	list_for_each_entry(desc, &chan->desc_freed, node) {
307*4882a593Smuzhiyun 		if (sg_len <= desc->sg_allocated_len) {
308*4882a593Smuzhiyun 			list_move_tail(&desc->node, &chan->desc_got);
309*4882a593Smuzhiyun 			spin_unlock_irqrestore(&chan->vc.lock, flags);
310*4882a593Smuzhiyun 			return desc;
311*4882a593Smuzhiyun 		}
312*4882a593Smuzhiyun 	}
313*4882a593Smuzhiyun 	spin_unlock_irqrestore(&chan->vc.lock, flags);
314*4882a593Smuzhiyun 
315*4882a593Smuzhiyun 	/* Allocate a new descriptor */
316*4882a593Smuzhiyun 	if (!usb_dmac_desc_alloc(chan, sg_len, gfp)) {
317*4882a593Smuzhiyun 		/* If allocated the desc, it was added to tail of the list */
318*4882a593Smuzhiyun 		spin_lock_irqsave(&chan->vc.lock, flags);
319*4882a593Smuzhiyun 		desc = list_last_entry(&chan->desc_freed, struct usb_dmac_desc,
320*4882a593Smuzhiyun 				       node);
321*4882a593Smuzhiyun 		list_move_tail(&desc->node, &chan->desc_got);
322*4882a593Smuzhiyun 		spin_unlock_irqrestore(&chan->vc.lock, flags);
323*4882a593Smuzhiyun 		return desc;
324*4882a593Smuzhiyun 	}
325*4882a593Smuzhiyun 
326*4882a593Smuzhiyun 	return NULL;
327*4882a593Smuzhiyun }
328*4882a593Smuzhiyun 
usb_dmac_desc_put(struct usb_dmac_chan * chan,struct usb_dmac_desc * desc)329*4882a593Smuzhiyun static void usb_dmac_desc_put(struct usb_dmac_chan *chan,
330*4882a593Smuzhiyun 			      struct usb_dmac_desc *desc)
331*4882a593Smuzhiyun {
332*4882a593Smuzhiyun 	unsigned long flags;
333*4882a593Smuzhiyun 
334*4882a593Smuzhiyun 	spin_lock_irqsave(&chan->vc.lock, flags);
335*4882a593Smuzhiyun 	list_move_tail(&desc->node, &chan->desc_freed);
336*4882a593Smuzhiyun 	spin_unlock_irqrestore(&chan->vc.lock, flags);
337*4882a593Smuzhiyun }
338*4882a593Smuzhiyun 
339*4882a593Smuzhiyun /* -----------------------------------------------------------------------------
340*4882a593Smuzhiyun  * Stop and reset
341*4882a593Smuzhiyun  */
342*4882a593Smuzhiyun 
usb_dmac_soft_reset(struct usb_dmac_chan * uchan)343*4882a593Smuzhiyun static void usb_dmac_soft_reset(struct usb_dmac_chan *uchan)
344*4882a593Smuzhiyun {
345*4882a593Smuzhiyun 	struct dma_chan *chan = &uchan->vc.chan;
346*4882a593Smuzhiyun 	struct usb_dmac *dmac = to_usb_dmac(chan->device);
347*4882a593Smuzhiyun 	int i;
348*4882a593Smuzhiyun 
349*4882a593Smuzhiyun 	/* Don't issue soft reset if any one of channels is busy */
350*4882a593Smuzhiyun 	for (i = 0; i < dmac->n_channels; ++i) {
351*4882a593Smuzhiyun 		if (usb_dmac_chan_is_busy(uchan))
352*4882a593Smuzhiyun 			return;
353*4882a593Smuzhiyun 	}
354*4882a593Smuzhiyun 
355*4882a593Smuzhiyun 	usb_dmac_write(dmac, USB_DMAOR, 0);
356*4882a593Smuzhiyun 	usb_dmac_write(dmac, USB_DMASWR, USB_DMASWR_SWR);
357*4882a593Smuzhiyun 	udelay(100);
358*4882a593Smuzhiyun 	usb_dmac_write(dmac, USB_DMASWR, 0);
359*4882a593Smuzhiyun 	usb_dmac_write(dmac, USB_DMAOR, 1);
360*4882a593Smuzhiyun }
361*4882a593Smuzhiyun 
usb_dmac_chan_halt(struct usb_dmac_chan * chan)362*4882a593Smuzhiyun static void usb_dmac_chan_halt(struct usb_dmac_chan *chan)
363*4882a593Smuzhiyun {
364*4882a593Smuzhiyun 	u32 chcr = usb_dmac_chan_read(chan, USB_DMACHCR);
365*4882a593Smuzhiyun 
366*4882a593Smuzhiyun 	chcr &= ~(USB_DMACHCR_IE | USB_DMACHCR_TE | USB_DMACHCR_DE);
367*4882a593Smuzhiyun 	usb_dmac_chan_write(chan, USB_DMACHCR, chcr);
368*4882a593Smuzhiyun 
369*4882a593Smuzhiyun 	usb_dmac_soft_reset(chan);
370*4882a593Smuzhiyun }
371*4882a593Smuzhiyun 
usb_dmac_stop(struct usb_dmac * dmac)372*4882a593Smuzhiyun static void usb_dmac_stop(struct usb_dmac *dmac)
373*4882a593Smuzhiyun {
374*4882a593Smuzhiyun 	usb_dmac_write(dmac, USB_DMAOR, 0);
375*4882a593Smuzhiyun }
376*4882a593Smuzhiyun 
377*4882a593Smuzhiyun /* -----------------------------------------------------------------------------
378*4882a593Smuzhiyun  * DMA engine operations
379*4882a593Smuzhiyun  */
380*4882a593Smuzhiyun 
usb_dmac_alloc_chan_resources(struct dma_chan * chan)381*4882a593Smuzhiyun static int usb_dmac_alloc_chan_resources(struct dma_chan *chan)
382*4882a593Smuzhiyun {
383*4882a593Smuzhiyun 	struct usb_dmac_chan *uchan = to_usb_dmac_chan(chan);
384*4882a593Smuzhiyun 	int ret;
385*4882a593Smuzhiyun 
386*4882a593Smuzhiyun 	while (uchan->descs_allocated < USB_DMAC_INITIAL_NR_DESC) {
387*4882a593Smuzhiyun 		ret = usb_dmac_desc_alloc(uchan, USB_DMAC_INITIAL_NR_SG,
388*4882a593Smuzhiyun 					  GFP_KERNEL);
389*4882a593Smuzhiyun 		if (ret < 0) {
390*4882a593Smuzhiyun 			usb_dmac_desc_free(uchan);
391*4882a593Smuzhiyun 			return ret;
392*4882a593Smuzhiyun 		}
393*4882a593Smuzhiyun 		uchan->descs_allocated++;
394*4882a593Smuzhiyun 	}
395*4882a593Smuzhiyun 
396*4882a593Smuzhiyun 	return pm_runtime_get_sync(chan->device->dev);
397*4882a593Smuzhiyun }
398*4882a593Smuzhiyun 
usb_dmac_free_chan_resources(struct dma_chan * chan)399*4882a593Smuzhiyun static void usb_dmac_free_chan_resources(struct dma_chan *chan)
400*4882a593Smuzhiyun {
401*4882a593Smuzhiyun 	struct usb_dmac_chan *uchan = to_usb_dmac_chan(chan);
402*4882a593Smuzhiyun 	unsigned long flags;
403*4882a593Smuzhiyun 
404*4882a593Smuzhiyun 	/* Protect against ISR */
405*4882a593Smuzhiyun 	spin_lock_irqsave(&uchan->vc.lock, flags);
406*4882a593Smuzhiyun 	usb_dmac_chan_halt(uchan);
407*4882a593Smuzhiyun 	spin_unlock_irqrestore(&uchan->vc.lock, flags);
408*4882a593Smuzhiyun 
409*4882a593Smuzhiyun 	usb_dmac_desc_free(uchan);
410*4882a593Smuzhiyun 	vchan_free_chan_resources(&uchan->vc);
411*4882a593Smuzhiyun 
412*4882a593Smuzhiyun 	pm_runtime_put(chan->device->dev);
413*4882a593Smuzhiyun }
414*4882a593Smuzhiyun 
415*4882a593Smuzhiyun static struct dma_async_tx_descriptor *
usb_dmac_prep_slave_sg(struct dma_chan * chan,struct scatterlist * sgl,unsigned int sg_len,enum dma_transfer_direction dir,unsigned long dma_flags,void * context)416*4882a593Smuzhiyun usb_dmac_prep_slave_sg(struct dma_chan *chan, struct scatterlist *sgl,
417*4882a593Smuzhiyun 		       unsigned int sg_len, enum dma_transfer_direction dir,
418*4882a593Smuzhiyun 		       unsigned long dma_flags, void *context)
419*4882a593Smuzhiyun {
420*4882a593Smuzhiyun 	struct usb_dmac_chan *uchan = to_usb_dmac_chan(chan);
421*4882a593Smuzhiyun 	struct usb_dmac_desc *desc;
422*4882a593Smuzhiyun 	struct scatterlist *sg;
423*4882a593Smuzhiyun 	int i;
424*4882a593Smuzhiyun 
425*4882a593Smuzhiyun 	if (!sg_len) {
426*4882a593Smuzhiyun 		dev_warn(chan->device->dev,
427*4882a593Smuzhiyun 			 "%s: bad parameter: len=%d\n", __func__, sg_len);
428*4882a593Smuzhiyun 		return NULL;
429*4882a593Smuzhiyun 	}
430*4882a593Smuzhiyun 
431*4882a593Smuzhiyun 	desc = usb_dmac_desc_get(uchan, sg_len, GFP_NOWAIT);
432*4882a593Smuzhiyun 	if (!desc)
433*4882a593Smuzhiyun 		return NULL;
434*4882a593Smuzhiyun 
435*4882a593Smuzhiyun 	desc->direction = dir;
436*4882a593Smuzhiyun 	desc->sg_len = sg_len;
437*4882a593Smuzhiyun 	for_each_sg(sgl, sg, sg_len, i) {
438*4882a593Smuzhiyun 		desc->sg[i].mem_addr = sg_dma_address(sg);
439*4882a593Smuzhiyun 		desc->sg[i].size = sg_dma_len(sg);
440*4882a593Smuzhiyun 	}
441*4882a593Smuzhiyun 
442*4882a593Smuzhiyun 	return vchan_tx_prep(&uchan->vc, &desc->vd, dma_flags);
443*4882a593Smuzhiyun }
444*4882a593Smuzhiyun 
usb_dmac_chan_terminate_all(struct dma_chan * chan)445*4882a593Smuzhiyun static int usb_dmac_chan_terminate_all(struct dma_chan *chan)
446*4882a593Smuzhiyun {
447*4882a593Smuzhiyun 	struct usb_dmac_chan *uchan = to_usb_dmac_chan(chan);
448*4882a593Smuzhiyun 	struct usb_dmac_desc *desc, *_desc;
449*4882a593Smuzhiyun 	unsigned long flags;
450*4882a593Smuzhiyun 	LIST_HEAD(head);
451*4882a593Smuzhiyun 	LIST_HEAD(list);
452*4882a593Smuzhiyun 
453*4882a593Smuzhiyun 	spin_lock_irqsave(&uchan->vc.lock, flags);
454*4882a593Smuzhiyun 	usb_dmac_chan_halt(uchan);
455*4882a593Smuzhiyun 	vchan_get_all_descriptors(&uchan->vc, &head);
456*4882a593Smuzhiyun 	if (uchan->desc)
457*4882a593Smuzhiyun 		uchan->desc = NULL;
458*4882a593Smuzhiyun 	list_splice_init(&uchan->desc_got, &list);
459*4882a593Smuzhiyun 	list_for_each_entry_safe(desc, _desc, &list, node)
460*4882a593Smuzhiyun 		list_move_tail(&desc->node, &uchan->desc_freed);
461*4882a593Smuzhiyun 	spin_unlock_irqrestore(&uchan->vc.lock, flags);
462*4882a593Smuzhiyun 	vchan_dma_desc_free_list(&uchan->vc, &head);
463*4882a593Smuzhiyun 
464*4882a593Smuzhiyun 	return 0;
465*4882a593Smuzhiyun }
466*4882a593Smuzhiyun 
usb_dmac_get_current_residue(struct usb_dmac_chan * chan,struct usb_dmac_desc * desc,int sg_index)467*4882a593Smuzhiyun static unsigned int usb_dmac_get_current_residue(struct usb_dmac_chan *chan,
468*4882a593Smuzhiyun 						 struct usb_dmac_desc *desc,
469*4882a593Smuzhiyun 						 int sg_index)
470*4882a593Smuzhiyun {
471*4882a593Smuzhiyun 	struct usb_dmac_sg *sg = desc->sg + sg_index;
472*4882a593Smuzhiyun 	u32 mem_addr = sg->mem_addr & 0xffffffff;
473*4882a593Smuzhiyun 	unsigned int residue = sg->size;
474*4882a593Smuzhiyun 
475*4882a593Smuzhiyun 	/*
476*4882a593Smuzhiyun 	 * We cannot use USB_DMATCR to calculate residue because USB_DMATCR
477*4882a593Smuzhiyun 	 * has unsuited value to calculate.
478*4882a593Smuzhiyun 	 */
479*4882a593Smuzhiyun 	if (desc->direction == DMA_DEV_TO_MEM)
480*4882a593Smuzhiyun 		residue -= usb_dmac_chan_read(chan, USB_DMADAR) - mem_addr;
481*4882a593Smuzhiyun 	else
482*4882a593Smuzhiyun 		residue -= usb_dmac_chan_read(chan, USB_DMASAR) - mem_addr;
483*4882a593Smuzhiyun 
484*4882a593Smuzhiyun 	return residue;
485*4882a593Smuzhiyun }
486*4882a593Smuzhiyun 
usb_dmac_chan_get_residue_if_complete(struct usb_dmac_chan * chan,dma_cookie_t cookie)487*4882a593Smuzhiyun static u32 usb_dmac_chan_get_residue_if_complete(struct usb_dmac_chan *chan,
488*4882a593Smuzhiyun 						 dma_cookie_t cookie)
489*4882a593Smuzhiyun {
490*4882a593Smuzhiyun 	struct usb_dmac_desc *desc;
491*4882a593Smuzhiyun 	u32 residue = 0;
492*4882a593Smuzhiyun 
493*4882a593Smuzhiyun 	list_for_each_entry_reverse(desc, &chan->desc_freed, node) {
494*4882a593Smuzhiyun 		if (desc->done_cookie == cookie) {
495*4882a593Smuzhiyun 			residue = desc->residue;
496*4882a593Smuzhiyun 			break;
497*4882a593Smuzhiyun 		}
498*4882a593Smuzhiyun 	}
499*4882a593Smuzhiyun 
500*4882a593Smuzhiyun 	return residue;
501*4882a593Smuzhiyun }
502*4882a593Smuzhiyun 
usb_dmac_chan_get_residue(struct usb_dmac_chan * chan,dma_cookie_t cookie)503*4882a593Smuzhiyun static u32 usb_dmac_chan_get_residue(struct usb_dmac_chan *chan,
504*4882a593Smuzhiyun 				     dma_cookie_t cookie)
505*4882a593Smuzhiyun {
506*4882a593Smuzhiyun 	u32 residue = 0;
507*4882a593Smuzhiyun 	struct virt_dma_desc *vd;
508*4882a593Smuzhiyun 	struct usb_dmac_desc *desc = chan->desc;
509*4882a593Smuzhiyun 	int i;
510*4882a593Smuzhiyun 
511*4882a593Smuzhiyun 	if (!desc) {
512*4882a593Smuzhiyun 		vd = vchan_find_desc(&chan->vc, cookie);
513*4882a593Smuzhiyun 		if (!vd)
514*4882a593Smuzhiyun 			return 0;
515*4882a593Smuzhiyun 		desc = to_usb_dmac_desc(vd);
516*4882a593Smuzhiyun 	}
517*4882a593Smuzhiyun 
518*4882a593Smuzhiyun 	/* Compute the size of all usb_dmac_sg still to be transferred */
519*4882a593Smuzhiyun 	for (i = desc->sg_index + 1; i < desc->sg_len; i++)
520*4882a593Smuzhiyun 		residue += desc->sg[i].size;
521*4882a593Smuzhiyun 
522*4882a593Smuzhiyun 	/* Add the residue for the current sg */
523*4882a593Smuzhiyun 	residue += usb_dmac_get_current_residue(chan, desc, desc->sg_index);
524*4882a593Smuzhiyun 
525*4882a593Smuzhiyun 	return residue;
526*4882a593Smuzhiyun }
527*4882a593Smuzhiyun 
usb_dmac_tx_status(struct dma_chan * chan,dma_cookie_t cookie,struct dma_tx_state * txstate)528*4882a593Smuzhiyun static enum dma_status usb_dmac_tx_status(struct dma_chan *chan,
529*4882a593Smuzhiyun 					  dma_cookie_t cookie,
530*4882a593Smuzhiyun 					  struct dma_tx_state *txstate)
531*4882a593Smuzhiyun {
532*4882a593Smuzhiyun 	struct usb_dmac_chan *uchan = to_usb_dmac_chan(chan);
533*4882a593Smuzhiyun 	enum dma_status status;
534*4882a593Smuzhiyun 	unsigned int residue = 0;
535*4882a593Smuzhiyun 	unsigned long flags;
536*4882a593Smuzhiyun 
537*4882a593Smuzhiyun 	status = dma_cookie_status(chan, cookie, txstate);
538*4882a593Smuzhiyun 	/* a client driver will get residue after DMA_COMPLETE */
539*4882a593Smuzhiyun 	if (!txstate)
540*4882a593Smuzhiyun 		return status;
541*4882a593Smuzhiyun 
542*4882a593Smuzhiyun 	spin_lock_irqsave(&uchan->vc.lock, flags);
543*4882a593Smuzhiyun 	if (status == DMA_COMPLETE)
544*4882a593Smuzhiyun 		residue = usb_dmac_chan_get_residue_if_complete(uchan, cookie);
545*4882a593Smuzhiyun 	else
546*4882a593Smuzhiyun 		residue = usb_dmac_chan_get_residue(uchan, cookie);
547*4882a593Smuzhiyun 	spin_unlock_irqrestore(&uchan->vc.lock, flags);
548*4882a593Smuzhiyun 
549*4882a593Smuzhiyun 	dma_set_residue(txstate, residue);
550*4882a593Smuzhiyun 
551*4882a593Smuzhiyun 	return status;
552*4882a593Smuzhiyun }
553*4882a593Smuzhiyun 
usb_dmac_issue_pending(struct dma_chan * chan)554*4882a593Smuzhiyun static void usb_dmac_issue_pending(struct dma_chan *chan)
555*4882a593Smuzhiyun {
556*4882a593Smuzhiyun 	struct usb_dmac_chan *uchan = to_usb_dmac_chan(chan);
557*4882a593Smuzhiyun 	unsigned long flags;
558*4882a593Smuzhiyun 
559*4882a593Smuzhiyun 	spin_lock_irqsave(&uchan->vc.lock, flags);
560*4882a593Smuzhiyun 	if (vchan_issue_pending(&uchan->vc) && !uchan->desc)
561*4882a593Smuzhiyun 		usb_dmac_chan_start_desc(uchan);
562*4882a593Smuzhiyun 	spin_unlock_irqrestore(&uchan->vc.lock, flags);
563*4882a593Smuzhiyun }
564*4882a593Smuzhiyun 
usb_dmac_virt_desc_free(struct virt_dma_desc * vd)565*4882a593Smuzhiyun static void usb_dmac_virt_desc_free(struct virt_dma_desc *vd)
566*4882a593Smuzhiyun {
567*4882a593Smuzhiyun 	struct usb_dmac_desc *desc = to_usb_dmac_desc(vd);
568*4882a593Smuzhiyun 	struct usb_dmac_chan *chan = to_usb_dmac_chan(vd->tx.chan);
569*4882a593Smuzhiyun 
570*4882a593Smuzhiyun 	usb_dmac_desc_put(chan, desc);
571*4882a593Smuzhiyun }
572*4882a593Smuzhiyun 
573*4882a593Smuzhiyun /* -----------------------------------------------------------------------------
574*4882a593Smuzhiyun  * IRQ handling
575*4882a593Smuzhiyun  */
576*4882a593Smuzhiyun 
usb_dmac_isr_transfer_end(struct usb_dmac_chan * chan)577*4882a593Smuzhiyun static void usb_dmac_isr_transfer_end(struct usb_dmac_chan *chan)
578*4882a593Smuzhiyun {
579*4882a593Smuzhiyun 	struct usb_dmac_desc *desc = chan->desc;
580*4882a593Smuzhiyun 
581*4882a593Smuzhiyun 	BUG_ON(!desc);
582*4882a593Smuzhiyun 
583*4882a593Smuzhiyun 	if (++desc->sg_index < desc->sg_len) {
584*4882a593Smuzhiyun 		usb_dmac_chan_start_sg(chan, desc->sg_index);
585*4882a593Smuzhiyun 	} else {
586*4882a593Smuzhiyun 		desc->residue = usb_dmac_get_current_residue(chan, desc,
587*4882a593Smuzhiyun 							desc->sg_index - 1);
588*4882a593Smuzhiyun 		desc->done_cookie = desc->vd.tx.cookie;
589*4882a593Smuzhiyun 		desc->vd.tx_result.result = DMA_TRANS_NOERROR;
590*4882a593Smuzhiyun 		desc->vd.tx_result.residue = desc->residue;
591*4882a593Smuzhiyun 		vchan_cookie_complete(&desc->vd);
592*4882a593Smuzhiyun 
593*4882a593Smuzhiyun 		/* Restart the next transfer if this driver has a next desc */
594*4882a593Smuzhiyun 		usb_dmac_chan_start_desc(chan);
595*4882a593Smuzhiyun 	}
596*4882a593Smuzhiyun }
597*4882a593Smuzhiyun 
usb_dmac_isr_channel(int irq,void * dev)598*4882a593Smuzhiyun static irqreturn_t usb_dmac_isr_channel(int irq, void *dev)
599*4882a593Smuzhiyun {
600*4882a593Smuzhiyun 	struct usb_dmac_chan *chan = dev;
601*4882a593Smuzhiyun 	irqreturn_t ret = IRQ_NONE;
602*4882a593Smuzhiyun 	u32 mask = 0;
603*4882a593Smuzhiyun 	u32 chcr;
604*4882a593Smuzhiyun 	bool xfer_end = false;
605*4882a593Smuzhiyun 
606*4882a593Smuzhiyun 	spin_lock(&chan->vc.lock);
607*4882a593Smuzhiyun 
608*4882a593Smuzhiyun 	chcr = usb_dmac_chan_read(chan, USB_DMACHCR);
609*4882a593Smuzhiyun 	if (chcr & (USB_DMACHCR_TE | USB_DMACHCR_SP)) {
610*4882a593Smuzhiyun 		mask |= USB_DMACHCR_DE | USB_DMACHCR_TE | USB_DMACHCR_SP;
611*4882a593Smuzhiyun 		if (chcr & USB_DMACHCR_DE)
612*4882a593Smuzhiyun 			xfer_end = true;
613*4882a593Smuzhiyun 		ret |= IRQ_HANDLED;
614*4882a593Smuzhiyun 	}
615*4882a593Smuzhiyun 	if (chcr & USB_DMACHCR_NULL) {
616*4882a593Smuzhiyun 		/* An interruption of TE will happen after we set FTE */
617*4882a593Smuzhiyun 		mask |= USB_DMACHCR_NULL;
618*4882a593Smuzhiyun 		chcr |= USB_DMACHCR_FTE;
619*4882a593Smuzhiyun 		ret |= IRQ_HANDLED;
620*4882a593Smuzhiyun 	}
621*4882a593Smuzhiyun 	if (mask)
622*4882a593Smuzhiyun 		usb_dmac_chan_write(chan, USB_DMACHCR, chcr & ~mask);
623*4882a593Smuzhiyun 
624*4882a593Smuzhiyun 	if (xfer_end)
625*4882a593Smuzhiyun 		usb_dmac_isr_transfer_end(chan);
626*4882a593Smuzhiyun 
627*4882a593Smuzhiyun 	spin_unlock(&chan->vc.lock);
628*4882a593Smuzhiyun 
629*4882a593Smuzhiyun 	return ret;
630*4882a593Smuzhiyun }
631*4882a593Smuzhiyun 
632*4882a593Smuzhiyun /* -----------------------------------------------------------------------------
633*4882a593Smuzhiyun  * OF xlate and channel filter
634*4882a593Smuzhiyun  */
635*4882a593Smuzhiyun 
usb_dmac_chan_filter(struct dma_chan * chan,void * arg)636*4882a593Smuzhiyun static bool usb_dmac_chan_filter(struct dma_chan *chan, void *arg)
637*4882a593Smuzhiyun {
638*4882a593Smuzhiyun 	struct usb_dmac_chan *uchan = to_usb_dmac_chan(chan);
639*4882a593Smuzhiyun 	struct of_phandle_args *dma_spec = arg;
640*4882a593Smuzhiyun 
641*4882a593Smuzhiyun 	/* USB-DMAC should be used with fixed usb controller's FIFO */
642*4882a593Smuzhiyun 	if (uchan->index != dma_spec->args[0])
643*4882a593Smuzhiyun 		return false;
644*4882a593Smuzhiyun 
645*4882a593Smuzhiyun 	return true;
646*4882a593Smuzhiyun }
647*4882a593Smuzhiyun 
usb_dmac_of_xlate(struct of_phandle_args * dma_spec,struct of_dma * ofdma)648*4882a593Smuzhiyun static struct dma_chan *usb_dmac_of_xlate(struct of_phandle_args *dma_spec,
649*4882a593Smuzhiyun 					  struct of_dma *ofdma)
650*4882a593Smuzhiyun {
651*4882a593Smuzhiyun 	struct dma_chan *chan;
652*4882a593Smuzhiyun 	dma_cap_mask_t mask;
653*4882a593Smuzhiyun 
654*4882a593Smuzhiyun 	if (dma_spec->args_count != 1)
655*4882a593Smuzhiyun 		return NULL;
656*4882a593Smuzhiyun 
657*4882a593Smuzhiyun 	/* Only slave DMA channels can be allocated via DT */
658*4882a593Smuzhiyun 	dma_cap_zero(mask);
659*4882a593Smuzhiyun 	dma_cap_set(DMA_SLAVE, mask);
660*4882a593Smuzhiyun 
661*4882a593Smuzhiyun 	chan = __dma_request_channel(&mask, usb_dmac_chan_filter, dma_spec,
662*4882a593Smuzhiyun 				     ofdma->of_node);
663*4882a593Smuzhiyun 	if (!chan)
664*4882a593Smuzhiyun 		return NULL;
665*4882a593Smuzhiyun 
666*4882a593Smuzhiyun 	return chan;
667*4882a593Smuzhiyun }
668*4882a593Smuzhiyun 
669*4882a593Smuzhiyun /* -----------------------------------------------------------------------------
670*4882a593Smuzhiyun  * Power management
671*4882a593Smuzhiyun  */
672*4882a593Smuzhiyun 
673*4882a593Smuzhiyun #ifdef CONFIG_PM
usb_dmac_runtime_suspend(struct device * dev)674*4882a593Smuzhiyun static int usb_dmac_runtime_suspend(struct device *dev)
675*4882a593Smuzhiyun {
676*4882a593Smuzhiyun 	struct usb_dmac *dmac = dev_get_drvdata(dev);
677*4882a593Smuzhiyun 	int i;
678*4882a593Smuzhiyun 
679*4882a593Smuzhiyun 	for (i = 0; i < dmac->n_channels; ++i) {
680*4882a593Smuzhiyun 		if (!dmac->channels[i].iomem)
681*4882a593Smuzhiyun 			break;
682*4882a593Smuzhiyun 		usb_dmac_chan_halt(&dmac->channels[i]);
683*4882a593Smuzhiyun 	}
684*4882a593Smuzhiyun 
685*4882a593Smuzhiyun 	return 0;
686*4882a593Smuzhiyun }
687*4882a593Smuzhiyun 
usb_dmac_runtime_resume(struct device * dev)688*4882a593Smuzhiyun static int usb_dmac_runtime_resume(struct device *dev)
689*4882a593Smuzhiyun {
690*4882a593Smuzhiyun 	struct usb_dmac *dmac = dev_get_drvdata(dev);
691*4882a593Smuzhiyun 
692*4882a593Smuzhiyun 	return usb_dmac_init(dmac);
693*4882a593Smuzhiyun }
694*4882a593Smuzhiyun #endif /* CONFIG_PM */
695*4882a593Smuzhiyun 
696*4882a593Smuzhiyun static const struct dev_pm_ops usb_dmac_pm = {
697*4882a593Smuzhiyun 	SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
698*4882a593Smuzhiyun 				      pm_runtime_force_resume)
699*4882a593Smuzhiyun 	SET_RUNTIME_PM_OPS(usb_dmac_runtime_suspend, usb_dmac_runtime_resume,
700*4882a593Smuzhiyun 			   NULL)
701*4882a593Smuzhiyun };
702*4882a593Smuzhiyun 
703*4882a593Smuzhiyun /* -----------------------------------------------------------------------------
704*4882a593Smuzhiyun  * Probe and remove
705*4882a593Smuzhiyun  */
706*4882a593Smuzhiyun 
usb_dmac_chan_probe(struct usb_dmac * dmac,struct usb_dmac_chan * uchan,unsigned int index)707*4882a593Smuzhiyun static int usb_dmac_chan_probe(struct usb_dmac *dmac,
708*4882a593Smuzhiyun 			       struct usb_dmac_chan *uchan,
709*4882a593Smuzhiyun 			       unsigned int index)
710*4882a593Smuzhiyun {
711*4882a593Smuzhiyun 	struct platform_device *pdev = to_platform_device(dmac->dev);
712*4882a593Smuzhiyun 	char pdev_irqname[5];
713*4882a593Smuzhiyun 	char *irqname;
714*4882a593Smuzhiyun 	int ret;
715*4882a593Smuzhiyun 
716*4882a593Smuzhiyun 	uchan->index = index;
717*4882a593Smuzhiyun 	uchan->iomem = dmac->iomem + USB_DMAC_CHAN_OFFSET(index);
718*4882a593Smuzhiyun 
719*4882a593Smuzhiyun 	/* Request the channel interrupt. */
720*4882a593Smuzhiyun 	sprintf(pdev_irqname, "ch%u", index);
721*4882a593Smuzhiyun 	uchan->irq = platform_get_irq_byname(pdev, pdev_irqname);
722*4882a593Smuzhiyun 	if (uchan->irq < 0)
723*4882a593Smuzhiyun 		return -ENODEV;
724*4882a593Smuzhiyun 
725*4882a593Smuzhiyun 	irqname = devm_kasprintf(dmac->dev, GFP_KERNEL, "%s:%u",
726*4882a593Smuzhiyun 				 dev_name(dmac->dev), index);
727*4882a593Smuzhiyun 	if (!irqname)
728*4882a593Smuzhiyun 		return -ENOMEM;
729*4882a593Smuzhiyun 
730*4882a593Smuzhiyun 	ret = devm_request_irq(dmac->dev, uchan->irq, usb_dmac_isr_channel,
731*4882a593Smuzhiyun 			       IRQF_SHARED, irqname, uchan);
732*4882a593Smuzhiyun 	if (ret) {
733*4882a593Smuzhiyun 		dev_err(dmac->dev, "failed to request IRQ %u (%d)\n",
734*4882a593Smuzhiyun 			uchan->irq, ret);
735*4882a593Smuzhiyun 		return ret;
736*4882a593Smuzhiyun 	}
737*4882a593Smuzhiyun 
738*4882a593Smuzhiyun 	uchan->vc.desc_free = usb_dmac_virt_desc_free;
739*4882a593Smuzhiyun 	vchan_init(&uchan->vc, &dmac->engine);
740*4882a593Smuzhiyun 	INIT_LIST_HEAD(&uchan->desc_freed);
741*4882a593Smuzhiyun 	INIT_LIST_HEAD(&uchan->desc_got);
742*4882a593Smuzhiyun 
743*4882a593Smuzhiyun 	return 0;
744*4882a593Smuzhiyun }
745*4882a593Smuzhiyun 
usb_dmac_parse_of(struct device * dev,struct usb_dmac * dmac)746*4882a593Smuzhiyun static int usb_dmac_parse_of(struct device *dev, struct usb_dmac *dmac)
747*4882a593Smuzhiyun {
748*4882a593Smuzhiyun 	struct device_node *np = dev->of_node;
749*4882a593Smuzhiyun 	int ret;
750*4882a593Smuzhiyun 
751*4882a593Smuzhiyun 	ret = of_property_read_u32(np, "dma-channels", &dmac->n_channels);
752*4882a593Smuzhiyun 	if (ret < 0) {
753*4882a593Smuzhiyun 		dev_err(dev, "unable to read dma-channels property\n");
754*4882a593Smuzhiyun 		return ret;
755*4882a593Smuzhiyun 	}
756*4882a593Smuzhiyun 
757*4882a593Smuzhiyun 	if (dmac->n_channels <= 0 || dmac->n_channels >= 100) {
758*4882a593Smuzhiyun 		dev_err(dev, "invalid number of channels %u\n",
759*4882a593Smuzhiyun 			dmac->n_channels);
760*4882a593Smuzhiyun 		return -EINVAL;
761*4882a593Smuzhiyun 	}
762*4882a593Smuzhiyun 
763*4882a593Smuzhiyun 	return 0;
764*4882a593Smuzhiyun }
765*4882a593Smuzhiyun 
usb_dmac_probe(struct platform_device * pdev)766*4882a593Smuzhiyun static int usb_dmac_probe(struct platform_device *pdev)
767*4882a593Smuzhiyun {
768*4882a593Smuzhiyun 	const enum dma_slave_buswidth widths = USB_DMAC_SLAVE_BUSWIDTH;
769*4882a593Smuzhiyun 	struct dma_device *engine;
770*4882a593Smuzhiyun 	struct usb_dmac *dmac;
771*4882a593Smuzhiyun 	struct resource *mem;
772*4882a593Smuzhiyun 	unsigned int i;
773*4882a593Smuzhiyun 	int ret;
774*4882a593Smuzhiyun 
775*4882a593Smuzhiyun 	dmac = devm_kzalloc(&pdev->dev, sizeof(*dmac), GFP_KERNEL);
776*4882a593Smuzhiyun 	if (!dmac)
777*4882a593Smuzhiyun 		return -ENOMEM;
778*4882a593Smuzhiyun 
779*4882a593Smuzhiyun 	dmac->dev = &pdev->dev;
780*4882a593Smuzhiyun 	platform_set_drvdata(pdev, dmac);
781*4882a593Smuzhiyun 
782*4882a593Smuzhiyun 	ret = usb_dmac_parse_of(&pdev->dev, dmac);
783*4882a593Smuzhiyun 	if (ret < 0)
784*4882a593Smuzhiyun 		return ret;
785*4882a593Smuzhiyun 
786*4882a593Smuzhiyun 	dmac->channels = devm_kcalloc(&pdev->dev, dmac->n_channels,
787*4882a593Smuzhiyun 				      sizeof(*dmac->channels), GFP_KERNEL);
788*4882a593Smuzhiyun 	if (!dmac->channels)
789*4882a593Smuzhiyun 		return -ENOMEM;
790*4882a593Smuzhiyun 
791*4882a593Smuzhiyun 	/* Request resources. */
792*4882a593Smuzhiyun 	mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
793*4882a593Smuzhiyun 	dmac->iomem = devm_ioremap_resource(&pdev->dev, mem);
794*4882a593Smuzhiyun 	if (IS_ERR(dmac->iomem))
795*4882a593Smuzhiyun 		return PTR_ERR(dmac->iomem);
796*4882a593Smuzhiyun 
797*4882a593Smuzhiyun 	/* Enable runtime PM and initialize the device. */
798*4882a593Smuzhiyun 	pm_runtime_enable(&pdev->dev);
799*4882a593Smuzhiyun 	ret = pm_runtime_get_sync(&pdev->dev);
800*4882a593Smuzhiyun 	if (ret < 0) {
801*4882a593Smuzhiyun 		dev_err(&pdev->dev, "runtime PM get sync failed (%d)\n", ret);
802*4882a593Smuzhiyun 		goto error_pm;
803*4882a593Smuzhiyun 	}
804*4882a593Smuzhiyun 
805*4882a593Smuzhiyun 	ret = usb_dmac_init(dmac);
806*4882a593Smuzhiyun 
807*4882a593Smuzhiyun 	if (ret) {
808*4882a593Smuzhiyun 		dev_err(&pdev->dev, "failed to reset device\n");
809*4882a593Smuzhiyun 		goto error;
810*4882a593Smuzhiyun 	}
811*4882a593Smuzhiyun 
812*4882a593Smuzhiyun 	/* Initialize the channels. */
813*4882a593Smuzhiyun 	INIT_LIST_HEAD(&dmac->engine.channels);
814*4882a593Smuzhiyun 
815*4882a593Smuzhiyun 	for (i = 0; i < dmac->n_channels; ++i) {
816*4882a593Smuzhiyun 		ret = usb_dmac_chan_probe(dmac, &dmac->channels[i], i);
817*4882a593Smuzhiyun 		if (ret < 0)
818*4882a593Smuzhiyun 			goto error;
819*4882a593Smuzhiyun 	}
820*4882a593Smuzhiyun 
821*4882a593Smuzhiyun 	/* Register the DMAC as a DMA provider for DT. */
822*4882a593Smuzhiyun 	ret = of_dma_controller_register(pdev->dev.of_node, usb_dmac_of_xlate,
823*4882a593Smuzhiyun 					 NULL);
824*4882a593Smuzhiyun 	if (ret < 0)
825*4882a593Smuzhiyun 		goto error;
826*4882a593Smuzhiyun 
827*4882a593Smuzhiyun 	/*
828*4882a593Smuzhiyun 	 * Register the DMA engine device.
829*4882a593Smuzhiyun 	 *
830*4882a593Smuzhiyun 	 * Default transfer size of 32 bytes requires 32-byte alignment.
831*4882a593Smuzhiyun 	 */
832*4882a593Smuzhiyun 	engine = &dmac->engine;
833*4882a593Smuzhiyun 	dma_cap_set(DMA_SLAVE, engine->cap_mask);
834*4882a593Smuzhiyun 
835*4882a593Smuzhiyun 	engine->dev = &pdev->dev;
836*4882a593Smuzhiyun 
837*4882a593Smuzhiyun 	engine->src_addr_widths = widths;
838*4882a593Smuzhiyun 	engine->dst_addr_widths = widths;
839*4882a593Smuzhiyun 	engine->directions = BIT(DMA_MEM_TO_DEV) | BIT(DMA_DEV_TO_MEM);
840*4882a593Smuzhiyun 	engine->residue_granularity = DMA_RESIDUE_GRANULARITY_BURST;
841*4882a593Smuzhiyun 
842*4882a593Smuzhiyun 	engine->device_alloc_chan_resources = usb_dmac_alloc_chan_resources;
843*4882a593Smuzhiyun 	engine->device_free_chan_resources = usb_dmac_free_chan_resources;
844*4882a593Smuzhiyun 	engine->device_prep_slave_sg = usb_dmac_prep_slave_sg;
845*4882a593Smuzhiyun 	engine->device_terminate_all = usb_dmac_chan_terminate_all;
846*4882a593Smuzhiyun 	engine->device_tx_status = usb_dmac_tx_status;
847*4882a593Smuzhiyun 	engine->device_issue_pending = usb_dmac_issue_pending;
848*4882a593Smuzhiyun 
849*4882a593Smuzhiyun 	ret = dma_async_device_register(engine);
850*4882a593Smuzhiyun 	if (ret < 0)
851*4882a593Smuzhiyun 		goto error;
852*4882a593Smuzhiyun 
853*4882a593Smuzhiyun 	pm_runtime_put(&pdev->dev);
854*4882a593Smuzhiyun 	return 0;
855*4882a593Smuzhiyun 
856*4882a593Smuzhiyun error:
857*4882a593Smuzhiyun 	of_dma_controller_free(pdev->dev.of_node);
858*4882a593Smuzhiyun error_pm:
859*4882a593Smuzhiyun 	pm_runtime_put(&pdev->dev);
860*4882a593Smuzhiyun 	pm_runtime_disable(&pdev->dev);
861*4882a593Smuzhiyun 	return ret;
862*4882a593Smuzhiyun }
863*4882a593Smuzhiyun 
usb_dmac_chan_remove(struct usb_dmac * dmac,struct usb_dmac_chan * uchan)864*4882a593Smuzhiyun static void usb_dmac_chan_remove(struct usb_dmac *dmac,
865*4882a593Smuzhiyun 				 struct usb_dmac_chan *uchan)
866*4882a593Smuzhiyun {
867*4882a593Smuzhiyun 	usb_dmac_chan_halt(uchan);
868*4882a593Smuzhiyun 	devm_free_irq(dmac->dev, uchan->irq, uchan);
869*4882a593Smuzhiyun }
870*4882a593Smuzhiyun 
usb_dmac_remove(struct platform_device * pdev)871*4882a593Smuzhiyun static int usb_dmac_remove(struct platform_device *pdev)
872*4882a593Smuzhiyun {
873*4882a593Smuzhiyun 	struct usb_dmac *dmac = platform_get_drvdata(pdev);
874*4882a593Smuzhiyun 	int i;
875*4882a593Smuzhiyun 
876*4882a593Smuzhiyun 	for (i = 0; i < dmac->n_channels; ++i)
877*4882a593Smuzhiyun 		usb_dmac_chan_remove(dmac, &dmac->channels[i]);
878*4882a593Smuzhiyun 	of_dma_controller_free(pdev->dev.of_node);
879*4882a593Smuzhiyun 	dma_async_device_unregister(&dmac->engine);
880*4882a593Smuzhiyun 
881*4882a593Smuzhiyun 	pm_runtime_disable(&pdev->dev);
882*4882a593Smuzhiyun 
883*4882a593Smuzhiyun 	return 0;
884*4882a593Smuzhiyun }
885*4882a593Smuzhiyun 
usb_dmac_shutdown(struct platform_device * pdev)886*4882a593Smuzhiyun static void usb_dmac_shutdown(struct platform_device *pdev)
887*4882a593Smuzhiyun {
888*4882a593Smuzhiyun 	struct usb_dmac *dmac = platform_get_drvdata(pdev);
889*4882a593Smuzhiyun 
890*4882a593Smuzhiyun 	usb_dmac_stop(dmac);
891*4882a593Smuzhiyun }
892*4882a593Smuzhiyun 
893*4882a593Smuzhiyun static const struct of_device_id usb_dmac_of_ids[] = {
894*4882a593Smuzhiyun 	{ .compatible = "renesas,usb-dmac", },
895*4882a593Smuzhiyun 	{ /* Sentinel */ }
896*4882a593Smuzhiyun };
897*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, usb_dmac_of_ids);
898*4882a593Smuzhiyun 
899*4882a593Smuzhiyun static struct platform_driver usb_dmac_driver = {
900*4882a593Smuzhiyun 	.driver		= {
901*4882a593Smuzhiyun 		.pm	= &usb_dmac_pm,
902*4882a593Smuzhiyun 		.name	= "usb-dmac",
903*4882a593Smuzhiyun 		.of_match_table = usb_dmac_of_ids,
904*4882a593Smuzhiyun 	},
905*4882a593Smuzhiyun 	.probe		= usb_dmac_probe,
906*4882a593Smuzhiyun 	.remove		= usb_dmac_remove,
907*4882a593Smuzhiyun 	.shutdown	= usb_dmac_shutdown,
908*4882a593Smuzhiyun };
909*4882a593Smuzhiyun 
910*4882a593Smuzhiyun module_platform_driver(usb_dmac_driver);
911*4882a593Smuzhiyun 
912*4882a593Smuzhiyun MODULE_DESCRIPTION("Renesas USB DMA Controller Driver");
913*4882a593Smuzhiyun MODULE_AUTHOR("Yoshihiro Shimoda <yoshihiro.shimoda.uh@renesas.com>");
914*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
915