xref: /OK3568_Linux_fs/kernel/drivers/dma/qcom/hidma_ll.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Qualcomm Technologies HIDMA DMA engine low level code
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (c) 2015-2016, The Linux Foundation. All rights reserved.
6*4882a593Smuzhiyun  */
7*4882a593Smuzhiyun 
8*4882a593Smuzhiyun #include <linux/dmaengine.h>
9*4882a593Smuzhiyun #include <linux/slab.h>
10*4882a593Smuzhiyun #include <linux/interrupt.h>
11*4882a593Smuzhiyun #include <linux/mm.h>
12*4882a593Smuzhiyun #include <linux/highmem.h>
13*4882a593Smuzhiyun #include <linux/dma-mapping.h>
14*4882a593Smuzhiyun #include <linux/delay.h>
15*4882a593Smuzhiyun #include <linux/atomic.h>
16*4882a593Smuzhiyun #include <linux/iopoll.h>
17*4882a593Smuzhiyun #include <linux/kfifo.h>
18*4882a593Smuzhiyun #include <linux/bitops.h>
19*4882a593Smuzhiyun 
20*4882a593Smuzhiyun #include "hidma.h"
21*4882a593Smuzhiyun 
22*4882a593Smuzhiyun #define HIDMA_EVRE_SIZE			16	/* each EVRE is 16 bytes */
23*4882a593Smuzhiyun 
24*4882a593Smuzhiyun #define HIDMA_TRCA_CTRLSTS_REG			0x000
25*4882a593Smuzhiyun #define HIDMA_TRCA_RING_LOW_REG		0x008
26*4882a593Smuzhiyun #define HIDMA_TRCA_RING_HIGH_REG		0x00C
27*4882a593Smuzhiyun #define HIDMA_TRCA_RING_LEN_REG		0x010
28*4882a593Smuzhiyun #define HIDMA_TRCA_DOORBELL_REG		0x400
29*4882a593Smuzhiyun 
30*4882a593Smuzhiyun #define HIDMA_EVCA_CTRLSTS_REG			0x000
31*4882a593Smuzhiyun #define HIDMA_EVCA_INTCTRL_REG			0x004
32*4882a593Smuzhiyun #define HIDMA_EVCA_RING_LOW_REG		0x008
33*4882a593Smuzhiyun #define HIDMA_EVCA_RING_HIGH_REG		0x00C
34*4882a593Smuzhiyun #define HIDMA_EVCA_RING_LEN_REG		0x010
35*4882a593Smuzhiyun #define HIDMA_EVCA_WRITE_PTR_REG		0x020
36*4882a593Smuzhiyun #define HIDMA_EVCA_DOORBELL_REG		0x400
37*4882a593Smuzhiyun 
38*4882a593Smuzhiyun #define HIDMA_EVCA_IRQ_STAT_REG		0x100
39*4882a593Smuzhiyun #define HIDMA_EVCA_IRQ_CLR_REG			0x108
40*4882a593Smuzhiyun #define HIDMA_EVCA_IRQ_EN_REG			0x110
41*4882a593Smuzhiyun 
42*4882a593Smuzhiyun #define HIDMA_EVRE_CFG_IDX			0
43*4882a593Smuzhiyun 
44*4882a593Smuzhiyun #define HIDMA_EVRE_ERRINFO_BIT_POS		24
45*4882a593Smuzhiyun #define HIDMA_EVRE_CODE_BIT_POS		28
46*4882a593Smuzhiyun 
47*4882a593Smuzhiyun #define HIDMA_EVRE_ERRINFO_MASK		GENMASK(3, 0)
48*4882a593Smuzhiyun #define HIDMA_EVRE_CODE_MASK			GENMASK(3, 0)
49*4882a593Smuzhiyun 
50*4882a593Smuzhiyun #define HIDMA_CH_CONTROL_MASK			GENMASK(7, 0)
51*4882a593Smuzhiyun #define HIDMA_CH_STATE_MASK			GENMASK(7, 0)
52*4882a593Smuzhiyun #define HIDMA_CH_STATE_BIT_POS			0x8
53*4882a593Smuzhiyun 
54*4882a593Smuzhiyun #define HIDMA_IRQ_EV_CH_EOB_IRQ_BIT_POS	0
55*4882a593Smuzhiyun #define HIDMA_IRQ_EV_CH_WR_RESP_BIT_POS	1
56*4882a593Smuzhiyun #define HIDMA_IRQ_TR_CH_TRE_RD_RSP_ER_BIT_POS	9
57*4882a593Smuzhiyun #define HIDMA_IRQ_TR_CH_DATA_RD_ER_BIT_POS	10
58*4882a593Smuzhiyun #define HIDMA_IRQ_TR_CH_DATA_WR_ER_BIT_POS	11
59*4882a593Smuzhiyun #define HIDMA_IRQ_TR_CH_INVALID_TRE_BIT_POS	14
60*4882a593Smuzhiyun 
61*4882a593Smuzhiyun #define ENABLE_IRQS (BIT(HIDMA_IRQ_EV_CH_EOB_IRQ_BIT_POS)	| \
62*4882a593Smuzhiyun 		     BIT(HIDMA_IRQ_EV_CH_WR_RESP_BIT_POS)	| \
63*4882a593Smuzhiyun 		     BIT(HIDMA_IRQ_TR_CH_TRE_RD_RSP_ER_BIT_POS)	| \
64*4882a593Smuzhiyun 		     BIT(HIDMA_IRQ_TR_CH_DATA_RD_ER_BIT_POS)	| \
65*4882a593Smuzhiyun 		     BIT(HIDMA_IRQ_TR_CH_DATA_WR_ER_BIT_POS)	| \
66*4882a593Smuzhiyun 		     BIT(HIDMA_IRQ_TR_CH_INVALID_TRE_BIT_POS))
67*4882a593Smuzhiyun 
68*4882a593Smuzhiyun #define HIDMA_INCREMENT_ITERATOR(iter, size, ring_size)	\
69*4882a593Smuzhiyun do {								\
70*4882a593Smuzhiyun 	iter += size;						\
71*4882a593Smuzhiyun 	if (iter >= ring_size)					\
72*4882a593Smuzhiyun 		iter -= ring_size;				\
73*4882a593Smuzhiyun } while (0)
74*4882a593Smuzhiyun 
75*4882a593Smuzhiyun #define HIDMA_CH_STATE(val)	\
76*4882a593Smuzhiyun 	((val >> HIDMA_CH_STATE_BIT_POS) & HIDMA_CH_STATE_MASK)
77*4882a593Smuzhiyun 
78*4882a593Smuzhiyun #define HIDMA_ERR_INT_MASK				\
79*4882a593Smuzhiyun 	(BIT(HIDMA_IRQ_TR_CH_INVALID_TRE_BIT_POS)   |	\
80*4882a593Smuzhiyun 	 BIT(HIDMA_IRQ_TR_CH_TRE_RD_RSP_ER_BIT_POS) |	\
81*4882a593Smuzhiyun 	 BIT(HIDMA_IRQ_EV_CH_WR_RESP_BIT_POS)	    |	\
82*4882a593Smuzhiyun 	 BIT(HIDMA_IRQ_TR_CH_DATA_RD_ER_BIT_POS)    |	\
83*4882a593Smuzhiyun 	 BIT(HIDMA_IRQ_TR_CH_DATA_WR_ER_BIT_POS))
84*4882a593Smuzhiyun 
85*4882a593Smuzhiyun enum ch_command {
86*4882a593Smuzhiyun 	HIDMA_CH_DISABLE = 0,
87*4882a593Smuzhiyun 	HIDMA_CH_ENABLE = 1,
88*4882a593Smuzhiyun 	HIDMA_CH_SUSPEND = 2,
89*4882a593Smuzhiyun 	HIDMA_CH_RESET = 9,
90*4882a593Smuzhiyun };
91*4882a593Smuzhiyun 
92*4882a593Smuzhiyun enum ch_state {
93*4882a593Smuzhiyun 	HIDMA_CH_DISABLED = 0,
94*4882a593Smuzhiyun 	HIDMA_CH_ENABLED = 1,
95*4882a593Smuzhiyun 	HIDMA_CH_RUNNING = 2,
96*4882a593Smuzhiyun 	HIDMA_CH_SUSPENDED = 3,
97*4882a593Smuzhiyun 	HIDMA_CH_STOPPED = 4,
98*4882a593Smuzhiyun };
99*4882a593Smuzhiyun 
100*4882a593Smuzhiyun enum err_code {
101*4882a593Smuzhiyun 	HIDMA_EVRE_STATUS_COMPLETE = 1,
102*4882a593Smuzhiyun 	HIDMA_EVRE_STATUS_ERROR = 4,
103*4882a593Smuzhiyun };
104*4882a593Smuzhiyun 
hidma_is_chan_enabled(int state)105*4882a593Smuzhiyun static int hidma_is_chan_enabled(int state)
106*4882a593Smuzhiyun {
107*4882a593Smuzhiyun 	switch (state) {
108*4882a593Smuzhiyun 	case HIDMA_CH_ENABLED:
109*4882a593Smuzhiyun 	case HIDMA_CH_RUNNING:
110*4882a593Smuzhiyun 		return true;
111*4882a593Smuzhiyun 	default:
112*4882a593Smuzhiyun 		return false;
113*4882a593Smuzhiyun 	}
114*4882a593Smuzhiyun }
115*4882a593Smuzhiyun 
hidma_ll_free(struct hidma_lldev * lldev,u32 tre_ch)116*4882a593Smuzhiyun void hidma_ll_free(struct hidma_lldev *lldev, u32 tre_ch)
117*4882a593Smuzhiyun {
118*4882a593Smuzhiyun 	struct hidma_tre *tre;
119*4882a593Smuzhiyun 
120*4882a593Smuzhiyun 	if (tre_ch >= lldev->nr_tres) {
121*4882a593Smuzhiyun 		dev_err(lldev->dev, "invalid TRE number in free:%d", tre_ch);
122*4882a593Smuzhiyun 		return;
123*4882a593Smuzhiyun 	}
124*4882a593Smuzhiyun 
125*4882a593Smuzhiyun 	tre = &lldev->trepool[tre_ch];
126*4882a593Smuzhiyun 	if (atomic_read(&tre->allocated) != true) {
127*4882a593Smuzhiyun 		dev_err(lldev->dev, "trying to free an unused TRE:%d", tre_ch);
128*4882a593Smuzhiyun 		return;
129*4882a593Smuzhiyun 	}
130*4882a593Smuzhiyun 
131*4882a593Smuzhiyun 	atomic_set(&tre->allocated, 0);
132*4882a593Smuzhiyun }
133*4882a593Smuzhiyun 
hidma_ll_request(struct hidma_lldev * lldev,u32 sig,const char * dev_name,void (* callback)(void * data),void * data,u32 * tre_ch)134*4882a593Smuzhiyun int hidma_ll_request(struct hidma_lldev *lldev, u32 sig, const char *dev_name,
135*4882a593Smuzhiyun 		     void (*callback)(void *data), void *data, u32 *tre_ch)
136*4882a593Smuzhiyun {
137*4882a593Smuzhiyun 	unsigned int i;
138*4882a593Smuzhiyun 	struct hidma_tre *tre;
139*4882a593Smuzhiyun 	u32 *tre_local;
140*4882a593Smuzhiyun 
141*4882a593Smuzhiyun 	if (!tre_ch || !lldev)
142*4882a593Smuzhiyun 		return -EINVAL;
143*4882a593Smuzhiyun 
144*4882a593Smuzhiyun 	/* need to have at least one empty spot in the queue */
145*4882a593Smuzhiyun 	for (i = 0; i < lldev->nr_tres - 1; i++) {
146*4882a593Smuzhiyun 		if (atomic_add_unless(&lldev->trepool[i].allocated, 1, 1))
147*4882a593Smuzhiyun 			break;
148*4882a593Smuzhiyun 	}
149*4882a593Smuzhiyun 
150*4882a593Smuzhiyun 	if (i == (lldev->nr_tres - 1))
151*4882a593Smuzhiyun 		return -ENOMEM;
152*4882a593Smuzhiyun 
153*4882a593Smuzhiyun 	tre = &lldev->trepool[i];
154*4882a593Smuzhiyun 	tre->dma_sig = sig;
155*4882a593Smuzhiyun 	tre->dev_name = dev_name;
156*4882a593Smuzhiyun 	tre->callback = callback;
157*4882a593Smuzhiyun 	tre->data = data;
158*4882a593Smuzhiyun 	tre->idx = i;
159*4882a593Smuzhiyun 	tre->status = 0;
160*4882a593Smuzhiyun 	tre->queued = 0;
161*4882a593Smuzhiyun 	tre->err_code = 0;
162*4882a593Smuzhiyun 	tre->err_info = 0;
163*4882a593Smuzhiyun 	tre->lldev = lldev;
164*4882a593Smuzhiyun 	tre_local = &tre->tre_local[0];
165*4882a593Smuzhiyun 	tre_local[HIDMA_TRE_CFG_IDX] = (lldev->chidx & 0xFF) << 8;
166*4882a593Smuzhiyun 	tre_local[HIDMA_TRE_CFG_IDX] |= BIT(16);	/* set IEOB */
167*4882a593Smuzhiyun 	*tre_ch = i;
168*4882a593Smuzhiyun 	if (callback)
169*4882a593Smuzhiyun 		callback(data);
170*4882a593Smuzhiyun 	return 0;
171*4882a593Smuzhiyun }
172*4882a593Smuzhiyun 
173*4882a593Smuzhiyun /*
174*4882a593Smuzhiyun  * Multiple TREs may be queued and waiting in the pending queue.
175*4882a593Smuzhiyun  */
hidma_ll_tre_complete(struct tasklet_struct * t)176*4882a593Smuzhiyun static void hidma_ll_tre_complete(struct tasklet_struct *t)
177*4882a593Smuzhiyun {
178*4882a593Smuzhiyun 	struct hidma_lldev *lldev = from_tasklet(lldev, t, task);
179*4882a593Smuzhiyun 	struct hidma_tre *tre;
180*4882a593Smuzhiyun 
181*4882a593Smuzhiyun 	while (kfifo_out(&lldev->handoff_fifo, &tre, 1)) {
182*4882a593Smuzhiyun 		/* call the user if it has been read by the hardware */
183*4882a593Smuzhiyun 		if (tre->callback)
184*4882a593Smuzhiyun 			tre->callback(tre->data);
185*4882a593Smuzhiyun 	}
186*4882a593Smuzhiyun }
187*4882a593Smuzhiyun 
hidma_post_completed(struct hidma_lldev * lldev,u8 err_info,u8 err_code)188*4882a593Smuzhiyun static int hidma_post_completed(struct hidma_lldev *lldev, u8 err_info,
189*4882a593Smuzhiyun 				u8 err_code)
190*4882a593Smuzhiyun {
191*4882a593Smuzhiyun 	struct hidma_tre *tre;
192*4882a593Smuzhiyun 	unsigned long flags;
193*4882a593Smuzhiyun 	u32 tre_iterator;
194*4882a593Smuzhiyun 
195*4882a593Smuzhiyun 	spin_lock_irqsave(&lldev->lock, flags);
196*4882a593Smuzhiyun 
197*4882a593Smuzhiyun 	tre_iterator = lldev->tre_processed_off;
198*4882a593Smuzhiyun 	tre = lldev->pending_tre_list[tre_iterator / HIDMA_TRE_SIZE];
199*4882a593Smuzhiyun 	if (!tre) {
200*4882a593Smuzhiyun 		spin_unlock_irqrestore(&lldev->lock, flags);
201*4882a593Smuzhiyun 		dev_warn(lldev->dev, "tre_index [%d] and tre out of sync\n",
202*4882a593Smuzhiyun 			 tre_iterator / HIDMA_TRE_SIZE);
203*4882a593Smuzhiyun 		return -EINVAL;
204*4882a593Smuzhiyun 	}
205*4882a593Smuzhiyun 	lldev->pending_tre_list[tre->tre_index] = NULL;
206*4882a593Smuzhiyun 
207*4882a593Smuzhiyun 	/*
208*4882a593Smuzhiyun 	 * Keep track of pending TREs that SW is expecting to receive
209*4882a593Smuzhiyun 	 * from HW. We got one now. Decrement our counter.
210*4882a593Smuzhiyun 	 */
211*4882a593Smuzhiyun 	if (atomic_dec_return(&lldev->pending_tre_count) < 0) {
212*4882a593Smuzhiyun 		dev_warn(lldev->dev, "tre count mismatch on completion");
213*4882a593Smuzhiyun 		atomic_set(&lldev->pending_tre_count, 0);
214*4882a593Smuzhiyun 	}
215*4882a593Smuzhiyun 
216*4882a593Smuzhiyun 	HIDMA_INCREMENT_ITERATOR(tre_iterator, HIDMA_TRE_SIZE,
217*4882a593Smuzhiyun 				 lldev->tre_ring_size);
218*4882a593Smuzhiyun 	lldev->tre_processed_off = tre_iterator;
219*4882a593Smuzhiyun 	spin_unlock_irqrestore(&lldev->lock, flags);
220*4882a593Smuzhiyun 
221*4882a593Smuzhiyun 	tre->err_info = err_info;
222*4882a593Smuzhiyun 	tre->err_code = err_code;
223*4882a593Smuzhiyun 	tre->queued = 0;
224*4882a593Smuzhiyun 
225*4882a593Smuzhiyun 	kfifo_put(&lldev->handoff_fifo, tre);
226*4882a593Smuzhiyun 	tasklet_schedule(&lldev->task);
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun 	return 0;
229*4882a593Smuzhiyun }
230*4882a593Smuzhiyun 
231*4882a593Smuzhiyun /*
232*4882a593Smuzhiyun  * Called to handle the interrupt for the channel.
233*4882a593Smuzhiyun  * Return a positive number if TRE or EVRE were consumed on this run.
234*4882a593Smuzhiyun  * Return a positive number if there are pending TREs or EVREs.
235*4882a593Smuzhiyun  * Return 0 if there is nothing to consume or no pending TREs/EVREs found.
236*4882a593Smuzhiyun  */
hidma_handle_tre_completion(struct hidma_lldev * lldev)237*4882a593Smuzhiyun static int hidma_handle_tre_completion(struct hidma_lldev *lldev)
238*4882a593Smuzhiyun {
239*4882a593Smuzhiyun 	u32 evre_ring_size = lldev->evre_ring_size;
240*4882a593Smuzhiyun 	u32 err_info, err_code, evre_write_off;
241*4882a593Smuzhiyun 	u32 evre_iterator;
242*4882a593Smuzhiyun 	u32 num_completed = 0;
243*4882a593Smuzhiyun 
244*4882a593Smuzhiyun 	evre_write_off = readl_relaxed(lldev->evca + HIDMA_EVCA_WRITE_PTR_REG);
245*4882a593Smuzhiyun 	evre_iterator = lldev->evre_processed_off;
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun 	if ((evre_write_off > evre_ring_size) ||
248*4882a593Smuzhiyun 	    (evre_write_off % HIDMA_EVRE_SIZE)) {
249*4882a593Smuzhiyun 		dev_err(lldev->dev, "HW reports invalid EVRE write offset\n");
250*4882a593Smuzhiyun 		return 0;
251*4882a593Smuzhiyun 	}
252*4882a593Smuzhiyun 
253*4882a593Smuzhiyun 	/*
254*4882a593Smuzhiyun 	 * By the time control reaches here the number of EVREs and TREs
255*4882a593Smuzhiyun 	 * may not match. Only consume the ones that hardware told us.
256*4882a593Smuzhiyun 	 */
257*4882a593Smuzhiyun 	while ((evre_iterator != evre_write_off)) {
258*4882a593Smuzhiyun 		u32 *current_evre = lldev->evre_ring + evre_iterator;
259*4882a593Smuzhiyun 		u32 cfg;
260*4882a593Smuzhiyun 
261*4882a593Smuzhiyun 		cfg = current_evre[HIDMA_EVRE_CFG_IDX];
262*4882a593Smuzhiyun 		err_info = cfg >> HIDMA_EVRE_ERRINFO_BIT_POS;
263*4882a593Smuzhiyun 		err_info &= HIDMA_EVRE_ERRINFO_MASK;
264*4882a593Smuzhiyun 		err_code =
265*4882a593Smuzhiyun 		    (cfg >> HIDMA_EVRE_CODE_BIT_POS) & HIDMA_EVRE_CODE_MASK;
266*4882a593Smuzhiyun 
267*4882a593Smuzhiyun 		if (hidma_post_completed(lldev, err_info, err_code))
268*4882a593Smuzhiyun 			break;
269*4882a593Smuzhiyun 
270*4882a593Smuzhiyun 		HIDMA_INCREMENT_ITERATOR(evre_iterator, HIDMA_EVRE_SIZE,
271*4882a593Smuzhiyun 					 evre_ring_size);
272*4882a593Smuzhiyun 
273*4882a593Smuzhiyun 		/*
274*4882a593Smuzhiyun 		 * Read the new event descriptor written by the HW.
275*4882a593Smuzhiyun 		 * As we are processing the delivered events, other events
276*4882a593Smuzhiyun 		 * get queued to the SW for processing.
277*4882a593Smuzhiyun 		 */
278*4882a593Smuzhiyun 		evre_write_off =
279*4882a593Smuzhiyun 		    readl_relaxed(lldev->evca + HIDMA_EVCA_WRITE_PTR_REG);
280*4882a593Smuzhiyun 		num_completed++;
281*4882a593Smuzhiyun 
282*4882a593Smuzhiyun 		/*
283*4882a593Smuzhiyun 		 * An error interrupt might have arrived while we are processing
284*4882a593Smuzhiyun 		 * the completed interrupt.
285*4882a593Smuzhiyun 		 */
286*4882a593Smuzhiyun 		if (!hidma_ll_isenabled(lldev))
287*4882a593Smuzhiyun 			break;
288*4882a593Smuzhiyun 	}
289*4882a593Smuzhiyun 
290*4882a593Smuzhiyun 	if (num_completed) {
291*4882a593Smuzhiyun 		u32 evre_read_off = (lldev->evre_processed_off +
292*4882a593Smuzhiyun 				     HIDMA_EVRE_SIZE * num_completed);
293*4882a593Smuzhiyun 		evre_read_off = evre_read_off % evre_ring_size;
294*4882a593Smuzhiyun 		writel(evre_read_off, lldev->evca + HIDMA_EVCA_DOORBELL_REG);
295*4882a593Smuzhiyun 
296*4882a593Smuzhiyun 		/* record the last processed tre offset */
297*4882a593Smuzhiyun 		lldev->evre_processed_off = evre_read_off;
298*4882a593Smuzhiyun 	}
299*4882a593Smuzhiyun 
300*4882a593Smuzhiyun 	return num_completed;
301*4882a593Smuzhiyun }
302*4882a593Smuzhiyun 
hidma_cleanup_pending_tre(struct hidma_lldev * lldev,u8 err_info,u8 err_code)303*4882a593Smuzhiyun void hidma_cleanup_pending_tre(struct hidma_lldev *lldev, u8 err_info,
304*4882a593Smuzhiyun 			       u8 err_code)
305*4882a593Smuzhiyun {
306*4882a593Smuzhiyun 	while (atomic_read(&lldev->pending_tre_count)) {
307*4882a593Smuzhiyun 		if (hidma_post_completed(lldev, err_info, err_code))
308*4882a593Smuzhiyun 			break;
309*4882a593Smuzhiyun 	}
310*4882a593Smuzhiyun }
311*4882a593Smuzhiyun 
hidma_ll_reset(struct hidma_lldev * lldev)312*4882a593Smuzhiyun static int hidma_ll_reset(struct hidma_lldev *lldev)
313*4882a593Smuzhiyun {
314*4882a593Smuzhiyun 	u32 val;
315*4882a593Smuzhiyun 	int ret;
316*4882a593Smuzhiyun 
317*4882a593Smuzhiyun 	val = readl(lldev->trca + HIDMA_TRCA_CTRLSTS_REG);
318*4882a593Smuzhiyun 	val &= ~(HIDMA_CH_CONTROL_MASK << 16);
319*4882a593Smuzhiyun 	val |= HIDMA_CH_RESET << 16;
320*4882a593Smuzhiyun 	writel(val, lldev->trca + HIDMA_TRCA_CTRLSTS_REG);
321*4882a593Smuzhiyun 
322*4882a593Smuzhiyun 	/*
323*4882a593Smuzhiyun 	 * Delay 10ms after reset to allow DMA logic to quiesce.
324*4882a593Smuzhiyun 	 * Do a polled read up to 1ms and 10ms maximum.
325*4882a593Smuzhiyun 	 */
326*4882a593Smuzhiyun 	ret = readl_poll_timeout(lldev->trca + HIDMA_TRCA_CTRLSTS_REG, val,
327*4882a593Smuzhiyun 				 HIDMA_CH_STATE(val) == HIDMA_CH_DISABLED,
328*4882a593Smuzhiyun 				 1000, 10000);
329*4882a593Smuzhiyun 	if (ret) {
330*4882a593Smuzhiyun 		dev_err(lldev->dev, "transfer channel did not reset\n");
331*4882a593Smuzhiyun 		return ret;
332*4882a593Smuzhiyun 	}
333*4882a593Smuzhiyun 
334*4882a593Smuzhiyun 	val = readl(lldev->evca + HIDMA_EVCA_CTRLSTS_REG);
335*4882a593Smuzhiyun 	val &= ~(HIDMA_CH_CONTROL_MASK << 16);
336*4882a593Smuzhiyun 	val |= HIDMA_CH_RESET << 16;
337*4882a593Smuzhiyun 	writel(val, lldev->evca + HIDMA_EVCA_CTRLSTS_REG);
338*4882a593Smuzhiyun 
339*4882a593Smuzhiyun 	/*
340*4882a593Smuzhiyun 	 * Delay 10ms after reset to allow DMA logic to quiesce.
341*4882a593Smuzhiyun 	 * Do a polled read up to 1ms and 10ms maximum.
342*4882a593Smuzhiyun 	 */
343*4882a593Smuzhiyun 	ret = readl_poll_timeout(lldev->evca + HIDMA_EVCA_CTRLSTS_REG, val,
344*4882a593Smuzhiyun 				 HIDMA_CH_STATE(val) == HIDMA_CH_DISABLED,
345*4882a593Smuzhiyun 				 1000, 10000);
346*4882a593Smuzhiyun 	if (ret)
347*4882a593Smuzhiyun 		return ret;
348*4882a593Smuzhiyun 
349*4882a593Smuzhiyun 	lldev->trch_state = HIDMA_CH_DISABLED;
350*4882a593Smuzhiyun 	lldev->evch_state = HIDMA_CH_DISABLED;
351*4882a593Smuzhiyun 	return 0;
352*4882a593Smuzhiyun }
353*4882a593Smuzhiyun 
354*4882a593Smuzhiyun /*
355*4882a593Smuzhiyun  * The interrupt handler for HIDMA will try to consume as many pending
356*4882a593Smuzhiyun  * EVRE from the event queue as possible. Each EVRE has an associated
357*4882a593Smuzhiyun  * TRE that holds the user interface parameters. EVRE reports the
358*4882a593Smuzhiyun  * result of the transaction. Hardware guarantees ordering between EVREs
359*4882a593Smuzhiyun  * and TREs. We use last processed offset to figure out which TRE is
360*4882a593Smuzhiyun  * associated with which EVRE. If two TREs are consumed by HW, the EVREs
361*4882a593Smuzhiyun  * are in order in the event ring.
362*4882a593Smuzhiyun  *
363*4882a593Smuzhiyun  * This handler will do a one pass for consuming EVREs. Other EVREs may
364*4882a593Smuzhiyun  * be delivered while we are working. It will try to consume incoming
365*4882a593Smuzhiyun  * EVREs one more time and return.
366*4882a593Smuzhiyun  *
367*4882a593Smuzhiyun  * For unprocessed EVREs, hardware will trigger another interrupt until
368*4882a593Smuzhiyun  * all the interrupt bits are cleared.
369*4882a593Smuzhiyun  *
370*4882a593Smuzhiyun  * Hardware guarantees that by the time interrupt is observed, all data
371*4882a593Smuzhiyun  * transactions in flight are delivered to their respective places and
372*4882a593Smuzhiyun  * are visible to the CPU.
373*4882a593Smuzhiyun  *
374*4882a593Smuzhiyun  * On demand paging for IOMMU is only supported for PCIe via PRI
375*4882a593Smuzhiyun  * (Page Request Interface) not for HIDMA. All other hardware instances
376*4882a593Smuzhiyun  * including HIDMA work on pinned DMA addresses.
377*4882a593Smuzhiyun  *
378*4882a593Smuzhiyun  * HIDMA is not aware of IOMMU presence since it follows the DMA API. All
379*4882a593Smuzhiyun  * IOMMU latency will be built into the data movement time. By the time
380*4882a593Smuzhiyun  * interrupt happens, IOMMU lookups + data movement has already taken place.
381*4882a593Smuzhiyun  *
382*4882a593Smuzhiyun  * While the first read in a typical PCI endpoint ISR flushes all outstanding
383*4882a593Smuzhiyun  * requests traditionally to the destination, this concept does not apply
384*4882a593Smuzhiyun  * here for this HW.
385*4882a593Smuzhiyun  */
hidma_ll_int_handler_internal(struct hidma_lldev * lldev,int cause)386*4882a593Smuzhiyun static void hidma_ll_int_handler_internal(struct hidma_lldev *lldev, int cause)
387*4882a593Smuzhiyun {
388*4882a593Smuzhiyun 	unsigned long irqflags;
389*4882a593Smuzhiyun 
390*4882a593Smuzhiyun 	if (cause & HIDMA_ERR_INT_MASK) {
391*4882a593Smuzhiyun 		dev_err(lldev->dev, "error 0x%x, disabling...\n",
392*4882a593Smuzhiyun 				cause);
393*4882a593Smuzhiyun 
394*4882a593Smuzhiyun 		/* Clear out pending interrupts */
395*4882a593Smuzhiyun 		writel(cause, lldev->evca + HIDMA_EVCA_IRQ_CLR_REG);
396*4882a593Smuzhiyun 
397*4882a593Smuzhiyun 		/* No further submissions. */
398*4882a593Smuzhiyun 		hidma_ll_disable(lldev);
399*4882a593Smuzhiyun 
400*4882a593Smuzhiyun 		/* Driver completes the txn and intimates the client.*/
401*4882a593Smuzhiyun 		hidma_cleanup_pending_tre(lldev, 0xFF,
402*4882a593Smuzhiyun 					  HIDMA_EVRE_STATUS_ERROR);
403*4882a593Smuzhiyun 
404*4882a593Smuzhiyun 		return;
405*4882a593Smuzhiyun 	}
406*4882a593Smuzhiyun 
407*4882a593Smuzhiyun 	spin_lock_irqsave(&lldev->lock, irqflags);
408*4882a593Smuzhiyun 	writel_relaxed(cause, lldev->evca + HIDMA_EVCA_IRQ_CLR_REG);
409*4882a593Smuzhiyun 	spin_unlock_irqrestore(&lldev->lock, irqflags);
410*4882a593Smuzhiyun 
411*4882a593Smuzhiyun 	/*
412*4882a593Smuzhiyun 	 * Fine tuned for this HW...
413*4882a593Smuzhiyun 	 *
414*4882a593Smuzhiyun 	 * This ISR has been designed for this particular hardware. Relaxed
415*4882a593Smuzhiyun 	 * read and write accessors are used for performance reasons due to
416*4882a593Smuzhiyun 	 * interrupt delivery guarantees. Do not copy this code blindly and
417*4882a593Smuzhiyun 	 * expect that to work.
418*4882a593Smuzhiyun 	 *
419*4882a593Smuzhiyun 	 * Try to consume as many EVREs as possible.
420*4882a593Smuzhiyun 	 */
421*4882a593Smuzhiyun 	hidma_handle_tre_completion(lldev);
422*4882a593Smuzhiyun }
423*4882a593Smuzhiyun 
hidma_ll_inthandler(int chirq,void * arg)424*4882a593Smuzhiyun irqreturn_t hidma_ll_inthandler(int chirq, void *arg)
425*4882a593Smuzhiyun {
426*4882a593Smuzhiyun 	struct hidma_lldev *lldev = arg;
427*4882a593Smuzhiyun 	u32 status;
428*4882a593Smuzhiyun 	u32 enable;
429*4882a593Smuzhiyun 	u32 cause;
430*4882a593Smuzhiyun 
431*4882a593Smuzhiyun 	status = readl_relaxed(lldev->evca + HIDMA_EVCA_IRQ_STAT_REG);
432*4882a593Smuzhiyun 	enable = readl_relaxed(lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
433*4882a593Smuzhiyun 	cause = status & enable;
434*4882a593Smuzhiyun 
435*4882a593Smuzhiyun 	while (cause) {
436*4882a593Smuzhiyun 		hidma_ll_int_handler_internal(lldev, cause);
437*4882a593Smuzhiyun 
438*4882a593Smuzhiyun 		/*
439*4882a593Smuzhiyun 		 * Another interrupt might have arrived while we are
440*4882a593Smuzhiyun 		 * processing this one. Read the new cause.
441*4882a593Smuzhiyun 		 */
442*4882a593Smuzhiyun 		status = readl_relaxed(lldev->evca + HIDMA_EVCA_IRQ_STAT_REG);
443*4882a593Smuzhiyun 		enable = readl_relaxed(lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
444*4882a593Smuzhiyun 		cause = status & enable;
445*4882a593Smuzhiyun 	}
446*4882a593Smuzhiyun 
447*4882a593Smuzhiyun 	return IRQ_HANDLED;
448*4882a593Smuzhiyun }
449*4882a593Smuzhiyun 
hidma_ll_inthandler_msi(int chirq,void * arg,int cause)450*4882a593Smuzhiyun irqreturn_t hidma_ll_inthandler_msi(int chirq, void *arg, int cause)
451*4882a593Smuzhiyun {
452*4882a593Smuzhiyun 	struct hidma_lldev *lldev = arg;
453*4882a593Smuzhiyun 
454*4882a593Smuzhiyun 	hidma_ll_int_handler_internal(lldev, cause);
455*4882a593Smuzhiyun 	return IRQ_HANDLED;
456*4882a593Smuzhiyun }
457*4882a593Smuzhiyun 
hidma_ll_enable(struct hidma_lldev * lldev)458*4882a593Smuzhiyun int hidma_ll_enable(struct hidma_lldev *lldev)
459*4882a593Smuzhiyun {
460*4882a593Smuzhiyun 	u32 val;
461*4882a593Smuzhiyun 	int ret;
462*4882a593Smuzhiyun 
463*4882a593Smuzhiyun 	val = readl(lldev->evca + HIDMA_EVCA_CTRLSTS_REG);
464*4882a593Smuzhiyun 	val &= ~(HIDMA_CH_CONTROL_MASK << 16);
465*4882a593Smuzhiyun 	val |= HIDMA_CH_ENABLE << 16;
466*4882a593Smuzhiyun 	writel(val, lldev->evca + HIDMA_EVCA_CTRLSTS_REG);
467*4882a593Smuzhiyun 
468*4882a593Smuzhiyun 	ret = readl_poll_timeout(lldev->evca + HIDMA_EVCA_CTRLSTS_REG, val,
469*4882a593Smuzhiyun 				 hidma_is_chan_enabled(HIDMA_CH_STATE(val)),
470*4882a593Smuzhiyun 				 1000, 10000);
471*4882a593Smuzhiyun 	if (ret) {
472*4882a593Smuzhiyun 		dev_err(lldev->dev, "event channel did not get enabled\n");
473*4882a593Smuzhiyun 		return ret;
474*4882a593Smuzhiyun 	}
475*4882a593Smuzhiyun 
476*4882a593Smuzhiyun 	val = readl(lldev->trca + HIDMA_TRCA_CTRLSTS_REG);
477*4882a593Smuzhiyun 	val &= ~(HIDMA_CH_CONTROL_MASK << 16);
478*4882a593Smuzhiyun 	val |= HIDMA_CH_ENABLE << 16;
479*4882a593Smuzhiyun 	writel(val, lldev->trca + HIDMA_TRCA_CTRLSTS_REG);
480*4882a593Smuzhiyun 
481*4882a593Smuzhiyun 	ret = readl_poll_timeout(lldev->trca + HIDMA_TRCA_CTRLSTS_REG, val,
482*4882a593Smuzhiyun 				 hidma_is_chan_enabled(HIDMA_CH_STATE(val)),
483*4882a593Smuzhiyun 				 1000, 10000);
484*4882a593Smuzhiyun 	if (ret) {
485*4882a593Smuzhiyun 		dev_err(lldev->dev, "transfer channel did not get enabled\n");
486*4882a593Smuzhiyun 		return ret;
487*4882a593Smuzhiyun 	}
488*4882a593Smuzhiyun 
489*4882a593Smuzhiyun 	lldev->trch_state = HIDMA_CH_ENABLED;
490*4882a593Smuzhiyun 	lldev->evch_state = HIDMA_CH_ENABLED;
491*4882a593Smuzhiyun 
492*4882a593Smuzhiyun 	/* enable irqs */
493*4882a593Smuzhiyun 	writel(ENABLE_IRQS, lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
494*4882a593Smuzhiyun 
495*4882a593Smuzhiyun 	return 0;
496*4882a593Smuzhiyun }
497*4882a593Smuzhiyun 
hidma_ll_start(struct hidma_lldev * lldev)498*4882a593Smuzhiyun void hidma_ll_start(struct hidma_lldev *lldev)
499*4882a593Smuzhiyun {
500*4882a593Smuzhiyun 	unsigned long irqflags;
501*4882a593Smuzhiyun 
502*4882a593Smuzhiyun 	spin_lock_irqsave(&lldev->lock, irqflags);
503*4882a593Smuzhiyun 	writel(lldev->tre_write_offset, lldev->trca + HIDMA_TRCA_DOORBELL_REG);
504*4882a593Smuzhiyun 	spin_unlock_irqrestore(&lldev->lock, irqflags);
505*4882a593Smuzhiyun }
506*4882a593Smuzhiyun 
hidma_ll_isenabled(struct hidma_lldev * lldev)507*4882a593Smuzhiyun bool hidma_ll_isenabled(struct hidma_lldev *lldev)
508*4882a593Smuzhiyun {
509*4882a593Smuzhiyun 	u32 val;
510*4882a593Smuzhiyun 
511*4882a593Smuzhiyun 	val = readl(lldev->trca + HIDMA_TRCA_CTRLSTS_REG);
512*4882a593Smuzhiyun 	lldev->trch_state = HIDMA_CH_STATE(val);
513*4882a593Smuzhiyun 	val = readl(lldev->evca + HIDMA_EVCA_CTRLSTS_REG);
514*4882a593Smuzhiyun 	lldev->evch_state = HIDMA_CH_STATE(val);
515*4882a593Smuzhiyun 
516*4882a593Smuzhiyun 	/* both channels have to be enabled before calling this function */
517*4882a593Smuzhiyun 	if (hidma_is_chan_enabled(lldev->trch_state) &&
518*4882a593Smuzhiyun 	    hidma_is_chan_enabled(lldev->evch_state))
519*4882a593Smuzhiyun 		return true;
520*4882a593Smuzhiyun 
521*4882a593Smuzhiyun 	return false;
522*4882a593Smuzhiyun }
523*4882a593Smuzhiyun 
hidma_ll_queue_request(struct hidma_lldev * lldev,u32 tre_ch)524*4882a593Smuzhiyun void hidma_ll_queue_request(struct hidma_lldev *lldev, u32 tre_ch)
525*4882a593Smuzhiyun {
526*4882a593Smuzhiyun 	struct hidma_tre *tre;
527*4882a593Smuzhiyun 	unsigned long flags;
528*4882a593Smuzhiyun 
529*4882a593Smuzhiyun 	tre = &lldev->trepool[tre_ch];
530*4882a593Smuzhiyun 
531*4882a593Smuzhiyun 	/* copy the TRE into its location in the TRE ring */
532*4882a593Smuzhiyun 	spin_lock_irqsave(&lldev->lock, flags);
533*4882a593Smuzhiyun 	tre->tre_index = lldev->tre_write_offset / HIDMA_TRE_SIZE;
534*4882a593Smuzhiyun 	lldev->pending_tre_list[tre->tre_index] = tre;
535*4882a593Smuzhiyun 	memcpy(lldev->tre_ring + lldev->tre_write_offset,
536*4882a593Smuzhiyun 			&tre->tre_local[0], HIDMA_TRE_SIZE);
537*4882a593Smuzhiyun 	tre->err_code = 0;
538*4882a593Smuzhiyun 	tre->err_info = 0;
539*4882a593Smuzhiyun 	tre->queued = 1;
540*4882a593Smuzhiyun 	atomic_inc(&lldev->pending_tre_count);
541*4882a593Smuzhiyun 	lldev->tre_write_offset = (lldev->tre_write_offset + HIDMA_TRE_SIZE)
542*4882a593Smuzhiyun 					% lldev->tre_ring_size;
543*4882a593Smuzhiyun 	spin_unlock_irqrestore(&lldev->lock, flags);
544*4882a593Smuzhiyun }
545*4882a593Smuzhiyun 
546*4882a593Smuzhiyun /*
547*4882a593Smuzhiyun  * Note that even though we stop this channel if there is a pending transaction
548*4882a593Smuzhiyun  * in flight it will complete and follow the callback. This request will
549*4882a593Smuzhiyun  * prevent further requests to be made.
550*4882a593Smuzhiyun  */
hidma_ll_disable(struct hidma_lldev * lldev)551*4882a593Smuzhiyun int hidma_ll_disable(struct hidma_lldev *lldev)
552*4882a593Smuzhiyun {
553*4882a593Smuzhiyun 	u32 val;
554*4882a593Smuzhiyun 	int ret;
555*4882a593Smuzhiyun 
556*4882a593Smuzhiyun 	/* The channel needs to be in working state */
557*4882a593Smuzhiyun 	if (!hidma_ll_isenabled(lldev))
558*4882a593Smuzhiyun 		return 0;
559*4882a593Smuzhiyun 
560*4882a593Smuzhiyun 	val = readl(lldev->trca + HIDMA_TRCA_CTRLSTS_REG);
561*4882a593Smuzhiyun 	val &= ~(HIDMA_CH_CONTROL_MASK << 16);
562*4882a593Smuzhiyun 	val |= HIDMA_CH_SUSPEND << 16;
563*4882a593Smuzhiyun 	writel(val, lldev->trca + HIDMA_TRCA_CTRLSTS_REG);
564*4882a593Smuzhiyun 
565*4882a593Smuzhiyun 	/*
566*4882a593Smuzhiyun 	 * Start the wait right after the suspend is confirmed.
567*4882a593Smuzhiyun 	 * Do a polled read up to 1ms and 10ms maximum.
568*4882a593Smuzhiyun 	 */
569*4882a593Smuzhiyun 	ret = readl_poll_timeout(lldev->trca + HIDMA_TRCA_CTRLSTS_REG, val,
570*4882a593Smuzhiyun 				 HIDMA_CH_STATE(val) == HIDMA_CH_SUSPENDED,
571*4882a593Smuzhiyun 				 1000, 10000);
572*4882a593Smuzhiyun 	if (ret)
573*4882a593Smuzhiyun 		return ret;
574*4882a593Smuzhiyun 
575*4882a593Smuzhiyun 	val = readl(lldev->evca + HIDMA_EVCA_CTRLSTS_REG);
576*4882a593Smuzhiyun 	val &= ~(HIDMA_CH_CONTROL_MASK << 16);
577*4882a593Smuzhiyun 	val |= HIDMA_CH_SUSPEND << 16;
578*4882a593Smuzhiyun 	writel(val, lldev->evca + HIDMA_EVCA_CTRLSTS_REG);
579*4882a593Smuzhiyun 
580*4882a593Smuzhiyun 	/*
581*4882a593Smuzhiyun 	 * Start the wait right after the suspend is confirmed
582*4882a593Smuzhiyun 	 * Delay up to 10ms after reset to allow DMA logic to quiesce.
583*4882a593Smuzhiyun 	 */
584*4882a593Smuzhiyun 	ret = readl_poll_timeout(lldev->evca + HIDMA_EVCA_CTRLSTS_REG, val,
585*4882a593Smuzhiyun 				 HIDMA_CH_STATE(val) == HIDMA_CH_SUSPENDED,
586*4882a593Smuzhiyun 				 1000, 10000);
587*4882a593Smuzhiyun 	if (ret)
588*4882a593Smuzhiyun 		return ret;
589*4882a593Smuzhiyun 
590*4882a593Smuzhiyun 	lldev->trch_state = HIDMA_CH_SUSPENDED;
591*4882a593Smuzhiyun 	lldev->evch_state = HIDMA_CH_SUSPENDED;
592*4882a593Smuzhiyun 
593*4882a593Smuzhiyun 	/* disable interrupts */
594*4882a593Smuzhiyun 	writel(0, lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
595*4882a593Smuzhiyun 	return 0;
596*4882a593Smuzhiyun }
597*4882a593Smuzhiyun 
hidma_ll_set_transfer_params(struct hidma_lldev * lldev,u32 tre_ch,dma_addr_t src,dma_addr_t dest,u32 len,u32 flags,u32 txntype)598*4882a593Smuzhiyun void hidma_ll_set_transfer_params(struct hidma_lldev *lldev, u32 tre_ch,
599*4882a593Smuzhiyun 				  dma_addr_t src, dma_addr_t dest, u32 len,
600*4882a593Smuzhiyun 				  u32 flags, u32 txntype)
601*4882a593Smuzhiyun {
602*4882a593Smuzhiyun 	struct hidma_tre *tre;
603*4882a593Smuzhiyun 	u32 *tre_local;
604*4882a593Smuzhiyun 
605*4882a593Smuzhiyun 	if (tre_ch >= lldev->nr_tres) {
606*4882a593Smuzhiyun 		dev_err(lldev->dev, "invalid TRE number in transfer params:%d",
607*4882a593Smuzhiyun 			tre_ch);
608*4882a593Smuzhiyun 		return;
609*4882a593Smuzhiyun 	}
610*4882a593Smuzhiyun 
611*4882a593Smuzhiyun 	tre = &lldev->trepool[tre_ch];
612*4882a593Smuzhiyun 	if (atomic_read(&tre->allocated) != true) {
613*4882a593Smuzhiyun 		dev_err(lldev->dev, "trying to set params on an unused TRE:%d",
614*4882a593Smuzhiyun 			tre_ch);
615*4882a593Smuzhiyun 		return;
616*4882a593Smuzhiyun 	}
617*4882a593Smuzhiyun 
618*4882a593Smuzhiyun 	tre_local = &tre->tre_local[0];
619*4882a593Smuzhiyun 	tre_local[HIDMA_TRE_CFG_IDX] &= ~GENMASK(7, 0);
620*4882a593Smuzhiyun 	tre_local[HIDMA_TRE_CFG_IDX] |= txntype;
621*4882a593Smuzhiyun 	tre_local[HIDMA_TRE_LEN_IDX] = len;
622*4882a593Smuzhiyun 	tre_local[HIDMA_TRE_SRC_LOW_IDX] = lower_32_bits(src);
623*4882a593Smuzhiyun 	tre_local[HIDMA_TRE_SRC_HI_IDX] = upper_32_bits(src);
624*4882a593Smuzhiyun 	tre_local[HIDMA_TRE_DEST_LOW_IDX] = lower_32_bits(dest);
625*4882a593Smuzhiyun 	tre_local[HIDMA_TRE_DEST_HI_IDX] = upper_32_bits(dest);
626*4882a593Smuzhiyun 	tre->int_flags = flags;
627*4882a593Smuzhiyun }
628*4882a593Smuzhiyun 
629*4882a593Smuzhiyun /*
630*4882a593Smuzhiyun  * Called during initialization and after an error condition
631*4882a593Smuzhiyun  * to restore hardware state.
632*4882a593Smuzhiyun  */
hidma_ll_setup(struct hidma_lldev * lldev)633*4882a593Smuzhiyun int hidma_ll_setup(struct hidma_lldev *lldev)
634*4882a593Smuzhiyun {
635*4882a593Smuzhiyun 	int rc;
636*4882a593Smuzhiyun 	u64 addr;
637*4882a593Smuzhiyun 	u32 val;
638*4882a593Smuzhiyun 	u32 nr_tres = lldev->nr_tres;
639*4882a593Smuzhiyun 
640*4882a593Smuzhiyun 	atomic_set(&lldev->pending_tre_count, 0);
641*4882a593Smuzhiyun 	lldev->tre_processed_off = 0;
642*4882a593Smuzhiyun 	lldev->evre_processed_off = 0;
643*4882a593Smuzhiyun 	lldev->tre_write_offset = 0;
644*4882a593Smuzhiyun 
645*4882a593Smuzhiyun 	/* disable interrupts */
646*4882a593Smuzhiyun 	writel(0, lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
647*4882a593Smuzhiyun 
648*4882a593Smuzhiyun 	/* clear all pending interrupts */
649*4882a593Smuzhiyun 	val = readl(lldev->evca + HIDMA_EVCA_IRQ_STAT_REG);
650*4882a593Smuzhiyun 	writel(val, lldev->evca + HIDMA_EVCA_IRQ_CLR_REG);
651*4882a593Smuzhiyun 
652*4882a593Smuzhiyun 	rc = hidma_ll_reset(lldev);
653*4882a593Smuzhiyun 	if (rc)
654*4882a593Smuzhiyun 		return rc;
655*4882a593Smuzhiyun 
656*4882a593Smuzhiyun 	/*
657*4882a593Smuzhiyun 	 * Clear all pending interrupts again.
658*4882a593Smuzhiyun 	 * Otherwise, we observe reset complete interrupts.
659*4882a593Smuzhiyun 	 */
660*4882a593Smuzhiyun 	val = readl(lldev->evca + HIDMA_EVCA_IRQ_STAT_REG);
661*4882a593Smuzhiyun 	writel(val, lldev->evca + HIDMA_EVCA_IRQ_CLR_REG);
662*4882a593Smuzhiyun 
663*4882a593Smuzhiyun 	/* disable interrupts again after reset */
664*4882a593Smuzhiyun 	writel(0, lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
665*4882a593Smuzhiyun 
666*4882a593Smuzhiyun 	addr = lldev->tre_dma;
667*4882a593Smuzhiyun 	writel(lower_32_bits(addr), lldev->trca + HIDMA_TRCA_RING_LOW_REG);
668*4882a593Smuzhiyun 	writel(upper_32_bits(addr), lldev->trca + HIDMA_TRCA_RING_HIGH_REG);
669*4882a593Smuzhiyun 	writel(lldev->tre_ring_size, lldev->trca + HIDMA_TRCA_RING_LEN_REG);
670*4882a593Smuzhiyun 
671*4882a593Smuzhiyun 	addr = lldev->evre_dma;
672*4882a593Smuzhiyun 	writel(lower_32_bits(addr), lldev->evca + HIDMA_EVCA_RING_LOW_REG);
673*4882a593Smuzhiyun 	writel(upper_32_bits(addr), lldev->evca + HIDMA_EVCA_RING_HIGH_REG);
674*4882a593Smuzhiyun 	writel(HIDMA_EVRE_SIZE * nr_tres,
675*4882a593Smuzhiyun 			lldev->evca + HIDMA_EVCA_RING_LEN_REG);
676*4882a593Smuzhiyun 
677*4882a593Smuzhiyun 	/* configure interrupts */
678*4882a593Smuzhiyun 	hidma_ll_setup_irq(lldev, lldev->msi_support);
679*4882a593Smuzhiyun 
680*4882a593Smuzhiyun 	rc = hidma_ll_enable(lldev);
681*4882a593Smuzhiyun 	if (rc)
682*4882a593Smuzhiyun 		return rc;
683*4882a593Smuzhiyun 
684*4882a593Smuzhiyun 	return rc;
685*4882a593Smuzhiyun }
686*4882a593Smuzhiyun 
hidma_ll_setup_irq(struct hidma_lldev * lldev,bool msi)687*4882a593Smuzhiyun void hidma_ll_setup_irq(struct hidma_lldev *lldev, bool msi)
688*4882a593Smuzhiyun {
689*4882a593Smuzhiyun 	u32 val;
690*4882a593Smuzhiyun 
691*4882a593Smuzhiyun 	lldev->msi_support = msi;
692*4882a593Smuzhiyun 
693*4882a593Smuzhiyun 	/* disable interrupts again after reset */
694*4882a593Smuzhiyun 	writel(0, lldev->evca + HIDMA_EVCA_IRQ_CLR_REG);
695*4882a593Smuzhiyun 	writel(0, lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
696*4882a593Smuzhiyun 
697*4882a593Smuzhiyun 	/* support IRQ by default */
698*4882a593Smuzhiyun 	val = readl(lldev->evca + HIDMA_EVCA_INTCTRL_REG);
699*4882a593Smuzhiyun 	val &= ~0xF;
700*4882a593Smuzhiyun 	if (!lldev->msi_support)
701*4882a593Smuzhiyun 		val = val | 0x1;
702*4882a593Smuzhiyun 	writel(val, lldev->evca + HIDMA_EVCA_INTCTRL_REG);
703*4882a593Smuzhiyun 
704*4882a593Smuzhiyun 	/* clear all pending interrupts and enable them */
705*4882a593Smuzhiyun 	writel(ENABLE_IRQS, lldev->evca + HIDMA_EVCA_IRQ_CLR_REG);
706*4882a593Smuzhiyun 	writel(ENABLE_IRQS, lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
707*4882a593Smuzhiyun }
708*4882a593Smuzhiyun 
hidma_ll_init(struct device * dev,u32 nr_tres,void __iomem * trca,void __iomem * evca,u8 chidx)709*4882a593Smuzhiyun struct hidma_lldev *hidma_ll_init(struct device *dev, u32 nr_tres,
710*4882a593Smuzhiyun 				  void __iomem *trca, void __iomem *evca,
711*4882a593Smuzhiyun 				  u8 chidx)
712*4882a593Smuzhiyun {
713*4882a593Smuzhiyun 	u32 required_bytes;
714*4882a593Smuzhiyun 	struct hidma_lldev *lldev;
715*4882a593Smuzhiyun 	int rc;
716*4882a593Smuzhiyun 	size_t sz;
717*4882a593Smuzhiyun 
718*4882a593Smuzhiyun 	if (!trca || !evca || !dev || !nr_tres)
719*4882a593Smuzhiyun 		return NULL;
720*4882a593Smuzhiyun 
721*4882a593Smuzhiyun 	/* need at least four TREs */
722*4882a593Smuzhiyun 	if (nr_tres < 4)
723*4882a593Smuzhiyun 		return NULL;
724*4882a593Smuzhiyun 
725*4882a593Smuzhiyun 	/* need an extra space */
726*4882a593Smuzhiyun 	nr_tres += 1;
727*4882a593Smuzhiyun 
728*4882a593Smuzhiyun 	lldev = devm_kzalloc(dev, sizeof(struct hidma_lldev), GFP_KERNEL);
729*4882a593Smuzhiyun 	if (!lldev)
730*4882a593Smuzhiyun 		return NULL;
731*4882a593Smuzhiyun 
732*4882a593Smuzhiyun 	lldev->evca = evca;
733*4882a593Smuzhiyun 	lldev->trca = trca;
734*4882a593Smuzhiyun 	lldev->dev = dev;
735*4882a593Smuzhiyun 	sz = sizeof(struct hidma_tre);
736*4882a593Smuzhiyun 	lldev->trepool = devm_kcalloc(lldev->dev, nr_tres, sz, GFP_KERNEL);
737*4882a593Smuzhiyun 	if (!lldev->trepool)
738*4882a593Smuzhiyun 		return NULL;
739*4882a593Smuzhiyun 
740*4882a593Smuzhiyun 	required_bytes = sizeof(lldev->pending_tre_list[0]);
741*4882a593Smuzhiyun 	lldev->pending_tre_list = devm_kcalloc(dev, nr_tres, required_bytes,
742*4882a593Smuzhiyun 					       GFP_KERNEL);
743*4882a593Smuzhiyun 	if (!lldev->pending_tre_list)
744*4882a593Smuzhiyun 		return NULL;
745*4882a593Smuzhiyun 
746*4882a593Smuzhiyun 	sz = (HIDMA_TRE_SIZE + 1) * nr_tres;
747*4882a593Smuzhiyun 	lldev->tre_ring = dmam_alloc_coherent(dev, sz, &lldev->tre_dma,
748*4882a593Smuzhiyun 					      GFP_KERNEL);
749*4882a593Smuzhiyun 	if (!lldev->tre_ring)
750*4882a593Smuzhiyun 		return NULL;
751*4882a593Smuzhiyun 
752*4882a593Smuzhiyun 	lldev->tre_ring_size = HIDMA_TRE_SIZE * nr_tres;
753*4882a593Smuzhiyun 	lldev->nr_tres = nr_tres;
754*4882a593Smuzhiyun 
755*4882a593Smuzhiyun 	/* the TRE ring has to be TRE_SIZE aligned */
756*4882a593Smuzhiyun 	if (!IS_ALIGNED(lldev->tre_dma, HIDMA_TRE_SIZE)) {
757*4882a593Smuzhiyun 		u8 tre_ring_shift;
758*4882a593Smuzhiyun 
759*4882a593Smuzhiyun 		tre_ring_shift = lldev->tre_dma % HIDMA_TRE_SIZE;
760*4882a593Smuzhiyun 		tre_ring_shift = HIDMA_TRE_SIZE - tre_ring_shift;
761*4882a593Smuzhiyun 		lldev->tre_dma += tre_ring_shift;
762*4882a593Smuzhiyun 		lldev->tre_ring += tre_ring_shift;
763*4882a593Smuzhiyun 	}
764*4882a593Smuzhiyun 
765*4882a593Smuzhiyun 	sz = (HIDMA_EVRE_SIZE + 1) * nr_tres;
766*4882a593Smuzhiyun 	lldev->evre_ring = dmam_alloc_coherent(dev, sz, &lldev->evre_dma,
767*4882a593Smuzhiyun 					       GFP_KERNEL);
768*4882a593Smuzhiyun 	if (!lldev->evre_ring)
769*4882a593Smuzhiyun 		return NULL;
770*4882a593Smuzhiyun 
771*4882a593Smuzhiyun 	lldev->evre_ring_size = HIDMA_EVRE_SIZE * nr_tres;
772*4882a593Smuzhiyun 
773*4882a593Smuzhiyun 	/* the EVRE ring has to be EVRE_SIZE aligned */
774*4882a593Smuzhiyun 	if (!IS_ALIGNED(lldev->evre_dma, HIDMA_EVRE_SIZE)) {
775*4882a593Smuzhiyun 		u8 evre_ring_shift;
776*4882a593Smuzhiyun 
777*4882a593Smuzhiyun 		evre_ring_shift = lldev->evre_dma % HIDMA_EVRE_SIZE;
778*4882a593Smuzhiyun 		evre_ring_shift = HIDMA_EVRE_SIZE - evre_ring_shift;
779*4882a593Smuzhiyun 		lldev->evre_dma += evre_ring_shift;
780*4882a593Smuzhiyun 		lldev->evre_ring += evre_ring_shift;
781*4882a593Smuzhiyun 	}
782*4882a593Smuzhiyun 	lldev->nr_tres = nr_tres;
783*4882a593Smuzhiyun 	lldev->chidx = chidx;
784*4882a593Smuzhiyun 
785*4882a593Smuzhiyun 	sz = nr_tres * sizeof(struct hidma_tre *);
786*4882a593Smuzhiyun 	rc = kfifo_alloc(&lldev->handoff_fifo, sz, GFP_KERNEL);
787*4882a593Smuzhiyun 	if (rc)
788*4882a593Smuzhiyun 		return NULL;
789*4882a593Smuzhiyun 
790*4882a593Smuzhiyun 	rc = hidma_ll_setup(lldev);
791*4882a593Smuzhiyun 	if (rc)
792*4882a593Smuzhiyun 		return NULL;
793*4882a593Smuzhiyun 
794*4882a593Smuzhiyun 	spin_lock_init(&lldev->lock);
795*4882a593Smuzhiyun 	tasklet_setup(&lldev->task, hidma_ll_tre_complete);
796*4882a593Smuzhiyun 	lldev->initialized = 1;
797*4882a593Smuzhiyun 	writel(ENABLE_IRQS, lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
798*4882a593Smuzhiyun 	return lldev;
799*4882a593Smuzhiyun }
800*4882a593Smuzhiyun 
hidma_ll_uninit(struct hidma_lldev * lldev)801*4882a593Smuzhiyun int hidma_ll_uninit(struct hidma_lldev *lldev)
802*4882a593Smuzhiyun {
803*4882a593Smuzhiyun 	u32 required_bytes;
804*4882a593Smuzhiyun 	int rc = 0;
805*4882a593Smuzhiyun 	u32 val;
806*4882a593Smuzhiyun 
807*4882a593Smuzhiyun 	if (!lldev)
808*4882a593Smuzhiyun 		return -ENODEV;
809*4882a593Smuzhiyun 
810*4882a593Smuzhiyun 	if (!lldev->initialized)
811*4882a593Smuzhiyun 		return 0;
812*4882a593Smuzhiyun 
813*4882a593Smuzhiyun 	lldev->initialized = 0;
814*4882a593Smuzhiyun 
815*4882a593Smuzhiyun 	required_bytes = sizeof(struct hidma_tre) * lldev->nr_tres;
816*4882a593Smuzhiyun 	tasklet_kill(&lldev->task);
817*4882a593Smuzhiyun 	memset(lldev->trepool, 0, required_bytes);
818*4882a593Smuzhiyun 	lldev->trepool = NULL;
819*4882a593Smuzhiyun 	atomic_set(&lldev->pending_tre_count, 0);
820*4882a593Smuzhiyun 	lldev->tre_write_offset = 0;
821*4882a593Smuzhiyun 
822*4882a593Smuzhiyun 	rc = hidma_ll_reset(lldev);
823*4882a593Smuzhiyun 
824*4882a593Smuzhiyun 	/*
825*4882a593Smuzhiyun 	 * Clear all pending interrupts again.
826*4882a593Smuzhiyun 	 * Otherwise, we observe reset complete interrupts.
827*4882a593Smuzhiyun 	 */
828*4882a593Smuzhiyun 	val = readl(lldev->evca + HIDMA_EVCA_IRQ_STAT_REG);
829*4882a593Smuzhiyun 	writel(val, lldev->evca + HIDMA_EVCA_IRQ_CLR_REG);
830*4882a593Smuzhiyun 	writel(0, lldev->evca + HIDMA_EVCA_IRQ_EN_REG);
831*4882a593Smuzhiyun 	return rc;
832*4882a593Smuzhiyun }
833*4882a593Smuzhiyun 
hidma_ll_status(struct hidma_lldev * lldev,u32 tre_ch)834*4882a593Smuzhiyun enum dma_status hidma_ll_status(struct hidma_lldev *lldev, u32 tre_ch)
835*4882a593Smuzhiyun {
836*4882a593Smuzhiyun 	enum dma_status ret = DMA_ERROR;
837*4882a593Smuzhiyun 	struct hidma_tre *tre;
838*4882a593Smuzhiyun 	unsigned long flags;
839*4882a593Smuzhiyun 	u8 err_code;
840*4882a593Smuzhiyun 
841*4882a593Smuzhiyun 	spin_lock_irqsave(&lldev->lock, flags);
842*4882a593Smuzhiyun 
843*4882a593Smuzhiyun 	tre = &lldev->trepool[tre_ch];
844*4882a593Smuzhiyun 	err_code = tre->err_code;
845*4882a593Smuzhiyun 
846*4882a593Smuzhiyun 	if (err_code & HIDMA_EVRE_STATUS_COMPLETE)
847*4882a593Smuzhiyun 		ret = DMA_COMPLETE;
848*4882a593Smuzhiyun 	else if (err_code & HIDMA_EVRE_STATUS_ERROR)
849*4882a593Smuzhiyun 		ret = DMA_ERROR;
850*4882a593Smuzhiyun 	else
851*4882a593Smuzhiyun 		ret = DMA_IN_PROGRESS;
852*4882a593Smuzhiyun 	spin_unlock_irqrestore(&lldev->lock, flags);
853*4882a593Smuzhiyun 
854*4882a593Smuzhiyun 	return ret;
855*4882a593Smuzhiyun }
856