1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright (C) 2014 Freescale Semiconductor
4  */
5 
6 #include <log.h>
7 #include <malloc.h>
8 #include <asm/arch/clock.h>
9 #include <linux/bug.h>
10 #include "qbman_portal.h"
11 
12 /* QBMan portal management command codes */
13 #define QBMAN_MC_ACQUIRE       0x30
14 #define QBMAN_WQCHAN_CONFIGURE 0x46
15 
16 /* CINH register offsets */
17 #define QBMAN_CINH_SWP_EQAR    0x8c0
18 #define QBMAN_CINH_SWP_DCAP    0xac0
19 #define QBMAN_CINH_SWP_SDQCR   0xb00
20 #define QBMAN_CINH_SWP_RAR     0xcc0
21 
22 /* CENA register offsets */
23 #define QBMAN_CENA_SWP_EQCR(n) (0x000 + ((uint32_t)(n) << 6))
24 #define QBMAN_CENA_SWP_DQRR(n) (0x200 + ((uint32_t)(n) << 6))
25 #define QBMAN_CENA_SWP_RCR(n)  (0x400 + ((uint32_t)(n) << 6))
26 #define QBMAN_CENA_SWP_CR      0x600
27 #define QBMAN_CENA_SWP_RR(vb)  (0x700 + ((uint32_t)(vb) >> 1))
28 #define QBMAN_CENA_SWP_VDQCR   0x780
29 
30 /* Reverse mapping of QBMAN_CENA_SWP_DQRR() */
31 #define QBMAN_IDX_FROM_DQRR(p) (((unsigned long)p & 0x1ff) >> 6)
32 
33 /*******************************/
34 /* Pre-defined attribute codes */
35 /*******************************/
36 
37 struct qb_attr_code code_generic_verb = QB_CODE(0, 0, 7);
38 struct qb_attr_code code_generic_rslt = QB_CODE(0, 8, 8);
39 
40 /*************************/
41 /* SDQCR attribute codes */
42 /*************************/
43 
44 /* we put these here because at least some of them are required by
45  * qbman_swp_init() */
46 struct qb_attr_code code_sdqcr_dct = QB_CODE(0, 24, 2);
47 struct qb_attr_code code_sdqcr_fc = QB_CODE(0, 29, 1);
48 struct qb_attr_code code_sdqcr_tok = QB_CODE(0, 16, 8);
49 #define CODE_SDQCR_DQSRC(n) QB_CODE(0, n, 1)
50 enum qbman_sdqcr_dct {
51 	qbman_sdqcr_dct_null = 0,
52 	qbman_sdqcr_dct_prio_ics,
53 	qbman_sdqcr_dct_active_ics,
54 	qbman_sdqcr_dct_active
55 };
56 enum qbman_sdqcr_fc {
57 	qbman_sdqcr_fc_one = 0,
58 	qbman_sdqcr_fc_up_to_3 = 1
59 };
60 
61 /*********************************/
62 /* Portal constructor/destructor */
63 /*********************************/
64 
65 /* Software portals should always be in the power-on state when we initialise,
66  * due to the CCSR-based portal reset functionality that MC has. */
qbman_swp_init(const struct qbman_swp_desc * d)67 struct qbman_swp *qbman_swp_init(const struct qbman_swp_desc *d)
68 {
69 	int ret;
70 	struct qbman_swp *p = malloc(sizeof(struct qbman_swp));
71 	u32 major = 0, minor = 0;
72 
73 	if (!p)
74 		return NULL;
75 	p->desc = d;
76 #ifdef QBMAN_CHECKING
77 	p->mc.check = swp_mc_can_start;
78 #endif
79 	p->mc.valid_bit = QB_VALID_BIT;
80 	p->sdq = 0;
81 	qb_attr_code_encode(&code_sdqcr_dct, &p->sdq, qbman_sdqcr_dct_prio_ics);
82 	qb_attr_code_encode(&code_sdqcr_fc, &p->sdq, qbman_sdqcr_fc_up_to_3);
83 	qb_attr_code_encode(&code_sdqcr_tok, &p->sdq, 0xbb);
84 	atomic_set(&p->vdq.busy, 1);
85 	p->vdq.valid_bit = QB_VALID_BIT;
86 	p->dqrr.next_idx = 0;
87 
88 	qbman_version(&major, &minor);
89 	if (!major) {
90 		printf("invalid qbman version\n");
91 		return NULL;
92 	}
93 
94 	if (major >= 4 && minor >= 1)
95 		p->dqrr.dqrr_size = QBMAN_VER_4_1_DQRR_SIZE;
96 	else
97 		p->dqrr.dqrr_size = QBMAN_VER_4_0_DQRR_SIZE;
98 
99 	p->dqrr.valid_bit = QB_VALID_BIT;
100 	ret = qbman_swp_sys_init(&p->sys, d, p->dqrr.dqrr_size);
101 	if (ret) {
102 		free(p);
103 		printf("qbman_swp_sys_init() failed %d\n", ret);
104 		return NULL;
105 	}
106 	qbman_cinh_write(&p->sys, QBMAN_CINH_SWP_SDQCR, p->sdq);
107 	return p;
108 }
109 
110 /***********************/
111 /* Management commands */
112 /***********************/
113 
114 /*
115  * Internal code common to all types of management commands.
116  */
117 
qbman_swp_mc_start(struct qbman_swp * p)118 void *qbman_swp_mc_start(struct qbman_swp *p)
119 {
120 	void *ret;
121 	int *return_val;
122 #ifdef QBMAN_CHECKING
123 	BUG_ON(p->mc.check != swp_mc_can_start);
124 #endif
125 	ret = qbman_cena_write_start(&p->sys, QBMAN_CENA_SWP_CR);
126 #ifdef QBMAN_CHECKING
127 	return_val = (int *)ret;
128 	if (!(*return_val))
129 		p->mc.check = swp_mc_can_submit;
130 #endif
131 	return ret;
132 }
133 
qbman_swp_mc_submit(struct qbman_swp * p,void * cmd,uint32_t cmd_verb)134 void qbman_swp_mc_submit(struct qbman_swp *p, void *cmd, uint32_t cmd_verb)
135 {
136 	uint32_t *v = cmd;
137 #ifdef QBMAN_CHECKING
138 	BUG_ON(p->mc.check != swp_mc_can_submit);
139 #endif
140 	lwsync();
141 	/* TBD: "|=" is going to hurt performance. Need to move as many fields
142 	 * out of word zero, and for those that remain, the "OR" needs to occur
143 	 * at the caller side. This debug check helps to catch cases where the
144 	 * caller wants to OR but has forgotten to do so. */
145 	BUG_ON((*v & cmd_verb) != *v);
146 	*v = cmd_verb | p->mc.valid_bit;
147 	qbman_cena_write_complete(&p->sys, QBMAN_CENA_SWP_CR, cmd);
148 	/* TODO: add prefetch support for GPP */
149 #ifdef QBMAN_CHECKING
150 	p->mc.check = swp_mc_can_poll;
151 #endif
152 }
153 
qbman_swp_mc_result(struct qbman_swp * p)154 void *qbman_swp_mc_result(struct qbman_swp *p)
155 {
156 	uint32_t *ret, verb;
157 #ifdef QBMAN_CHECKING
158 	BUG_ON(p->mc.check != swp_mc_can_poll);
159 #endif
160 	ret = qbman_cena_read(&p->sys, QBMAN_CENA_SWP_RR(p->mc.valid_bit));
161 	/* Remove the valid-bit - command completed iff the rest is non-zero */
162 	verb = ret[0] & ~QB_VALID_BIT;
163 	if (!verb)
164 		return NULL;
165 #ifdef QBMAN_CHECKING
166 	p->mc.check = swp_mc_can_start;
167 #endif
168 	p->mc.valid_bit ^= QB_VALID_BIT;
169 	return ret;
170 }
171 
172 /***********/
173 /* Enqueue */
174 /***********/
175 
176 /* These should be const, eventually */
177 static struct qb_attr_code code_eq_cmd = QB_CODE(0, 0, 2);
178 static struct qb_attr_code code_eq_orp_en = QB_CODE(0, 2, 1);
179 static struct qb_attr_code code_eq_tgt_id = QB_CODE(2, 0, 24);
180 /* static struct qb_attr_code code_eq_tag = QB_CODE(3, 0, 32); */
181 static struct qb_attr_code code_eq_qd_en = QB_CODE(0, 4, 1);
182 static struct qb_attr_code code_eq_qd_bin = QB_CODE(4, 0, 16);
183 static struct qb_attr_code code_eq_qd_pri = QB_CODE(4, 16, 4);
184 static struct qb_attr_code code_eq_rsp_stash = QB_CODE(5, 16, 1);
185 static struct qb_attr_code code_eq_rsp_lo = QB_CODE(6, 0, 32);
186 
187 enum qbman_eq_cmd_e {
188 	/* No enqueue, primarily for plugging ORP gaps for dropped frames */
189 	qbman_eq_cmd_empty,
190 	/* DMA an enqueue response once complete */
191 	qbman_eq_cmd_respond,
192 	/* DMA an enqueue response only if the enqueue fails */
193 	qbman_eq_cmd_respond_reject
194 };
195 
qbman_eq_desc_clear(struct qbman_eq_desc * d)196 void qbman_eq_desc_clear(struct qbman_eq_desc *d)
197 {
198 	memset(d, 0, sizeof(*d));
199 }
200 
qbman_eq_desc_set_no_orp(struct qbman_eq_desc * d,int respond_success)201 void qbman_eq_desc_set_no_orp(struct qbman_eq_desc *d, int respond_success)
202 {
203 	uint32_t *cl = qb_cl(d);
204 
205 	qb_attr_code_encode(&code_eq_orp_en, cl, 0);
206 	qb_attr_code_encode(&code_eq_cmd, cl,
207 			    respond_success ? qbman_eq_cmd_respond :
208 					      qbman_eq_cmd_respond_reject);
209 }
210 
qbman_eq_desc_set_response(struct qbman_eq_desc * d,dma_addr_t storage_phys,int stash)211 void qbman_eq_desc_set_response(struct qbman_eq_desc *d,
212 				dma_addr_t storage_phys,
213 				int stash)
214 {
215 	uint32_t *cl = qb_cl(d);
216 
217 	qb_attr_code_encode_64(&code_eq_rsp_lo, (uint64_t *)cl, storage_phys);
218 	qb_attr_code_encode(&code_eq_rsp_stash, cl, !!stash);
219 }
220 
qbman_eq_desc_set_qd(struct qbman_eq_desc * d,uint32_t qdid,uint32_t qd_bin,uint32_t qd_prio)221 void qbman_eq_desc_set_qd(struct qbman_eq_desc *d, uint32_t qdid,
222 			  uint32_t qd_bin, uint32_t qd_prio)
223 {
224 	uint32_t *cl = qb_cl(d);
225 
226 	qb_attr_code_encode(&code_eq_qd_en, cl, 1);
227 	qb_attr_code_encode(&code_eq_tgt_id, cl, qdid);
228 	qb_attr_code_encode(&code_eq_qd_bin, cl, qd_bin);
229 	qb_attr_code_encode(&code_eq_qd_pri, cl, qd_prio);
230 }
231 
232 #define EQAR_IDX(eqar)     ((eqar) & 0x7)
233 #define EQAR_VB(eqar)      ((eqar) & 0x80)
234 #define EQAR_SUCCESS(eqar) ((eqar) & 0x100)
235 
qbman_swp_enqueue(struct qbman_swp * s,const struct qbman_eq_desc * d,const struct qbman_fd * fd)236 int qbman_swp_enqueue(struct qbman_swp *s, const struct qbman_eq_desc *d,
237 		      const struct qbman_fd *fd)
238 {
239 	uint32_t *p;
240 	const uint32_t *cl = qb_cl(d);
241 	uint32_t eqar = qbman_cinh_read(&s->sys, QBMAN_CINH_SWP_EQAR);
242 	debug("EQAR=%08x\n", eqar);
243 	if (!EQAR_SUCCESS(eqar))
244 		return -EBUSY;
245 	p = qbman_cena_write_start(&s->sys,
246 				   QBMAN_CENA_SWP_EQCR(EQAR_IDX(eqar)));
247 	word_copy(&p[1], &cl[1], 7);
248 	word_copy(&p[8], fd, sizeof(*fd) >> 2);
249 	lwsync();
250 	/* Set the verb byte, have to substitute in the valid-bit */
251 	p[0] = cl[0] | EQAR_VB(eqar);
252 	qbman_cena_write_complete(&s->sys,
253 				  QBMAN_CENA_SWP_EQCR(EQAR_IDX(eqar)),
254 				  p);
255 	return 0;
256 }
257 
258 /***************************/
259 /* Volatile (pull) dequeue */
260 /***************************/
261 
262 /* These should be const, eventually */
263 static struct qb_attr_code code_pull_dct = QB_CODE(0, 0, 2);
264 static struct qb_attr_code code_pull_dt = QB_CODE(0, 2, 2);
265 static struct qb_attr_code code_pull_rls = QB_CODE(0, 4, 1);
266 static struct qb_attr_code code_pull_stash = QB_CODE(0, 5, 1);
267 static struct qb_attr_code code_pull_numframes = QB_CODE(0, 8, 4);
268 static struct qb_attr_code code_pull_token = QB_CODE(0, 16, 8);
269 static struct qb_attr_code code_pull_dqsource = QB_CODE(1, 0, 24);
270 static struct qb_attr_code code_pull_rsp_lo = QB_CODE(2, 0, 32);
271 
272 enum qb_pull_dt_e {
273 	qb_pull_dt_channel,
274 	qb_pull_dt_workqueue,
275 	qb_pull_dt_framequeue
276 };
277 
qbman_pull_desc_clear(struct qbman_pull_desc * d)278 void qbman_pull_desc_clear(struct qbman_pull_desc *d)
279 {
280 	memset(d, 0, sizeof(*d));
281 }
282 
qbman_pull_desc_set_storage(struct qbman_pull_desc * d,struct ldpaa_dq * storage,dma_addr_t storage_phys,int stash)283 void qbman_pull_desc_set_storage(struct qbman_pull_desc *d,
284 				 struct ldpaa_dq *storage,
285 				 dma_addr_t storage_phys,
286 				 int stash)
287 {
288 	uint32_t *cl = qb_cl(d);
289 
290 	/* Squiggle the pointer 'storage' into the extra 2 words of the
291 	 * descriptor (which aren't copied to the hw command) */
292 	*(void **)&cl[4] = storage;
293 	if (!storage) {
294 		qb_attr_code_encode(&code_pull_rls, cl, 0);
295 		return;
296 	}
297 	qb_attr_code_encode(&code_pull_rls, cl, 1);
298 	qb_attr_code_encode(&code_pull_stash, cl, !!stash);
299 	qb_attr_code_encode_64(&code_pull_rsp_lo, (uint64_t *)cl, storage_phys);
300 }
301 
qbman_pull_desc_set_numframes(struct qbman_pull_desc * d,uint8_t numframes)302 void qbman_pull_desc_set_numframes(struct qbman_pull_desc *d, uint8_t numframes)
303 {
304 	uint32_t *cl = qb_cl(d);
305 
306 	BUG_ON(!numframes || (numframes > 16));
307 	qb_attr_code_encode(&code_pull_numframes, cl,
308 			    (uint32_t)(numframes - 1));
309 }
310 
qbman_pull_desc_set_token(struct qbman_pull_desc * d,uint8_t token)311 void qbman_pull_desc_set_token(struct qbman_pull_desc *d, uint8_t token)
312 {
313 	uint32_t *cl = qb_cl(d);
314 
315 	qb_attr_code_encode(&code_pull_token, cl, token);
316 }
317 
qbman_pull_desc_set_fq(struct qbman_pull_desc * d,uint32_t fqid)318 void qbman_pull_desc_set_fq(struct qbman_pull_desc *d, uint32_t fqid)
319 {
320 	uint32_t *cl = qb_cl(d);
321 
322 	qb_attr_code_encode(&code_pull_dct, cl, 1);
323 	qb_attr_code_encode(&code_pull_dt, cl, qb_pull_dt_framequeue);
324 	qb_attr_code_encode(&code_pull_dqsource, cl, fqid);
325 }
326 
qbman_swp_pull(struct qbman_swp * s,struct qbman_pull_desc * d)327 int qbman_swp_pull(struct qbman_swp *s, struct qbman_pull_desc *d)
328 {
329 	uint32_t *p;
330 	uint32_t *cl = qb_cl(d);
331 
332 	if (!atomic_dec_and_test(&s->vdq.busy)) {
333 		atomic_inc(&s->vdq.busy);
334 		return -EBUSY;
335 	}
336 	s->vdq.storage = *(void **)&cl[4];
337 	s->vdq.token = qb_attr_code_decode(&code_pull_token, cl);
338 	p = qbman_cena_write_start(&s->sys, QBMAN_CENA_SWP_VDQCR);
339 	word_copy(&p[1], &cl[1], 3);
340 	lwsync();
341 	/* Set the verb byte, have to substitute in the valid-bit */
342 	p[0] = cl[0] | s->vdq.valid_bit;
343 	s->vdq.valid_bit ^= QB_VALID_BIT;
344 	qbman_cena_write_complete(&s->sys, QBMAN_CENA_SWP_VDQCR, p);
345 	return 0;
346 }
347 
348 /****************/
349 /* Polling DQRR */
350 /****************/
351 
352 static struct qb_attr_code code_dqrr_verb = QB_CODE(0, 0, 8);
353 static struct qb_attr_code code_dqrr_response = QB_CODE(0, 0, 7);
354 static struct qb_attr_code code_dqrr_stat = QB_CODE(0, 8, 8);
355 
356 #define QBMAN_DQRR_RESPONSE_DQ        0x60
357 #define QBMAN_DQRR_RESPONSE_FQRN      0x21
358 #define QBMAN_DQRR_RESPONSE_FQRNI     0x22
359 #define QBMAN_DQRR_RESPONSE_FQPN      0x24
360 #define QBMAN_DQRR_RESPONSE_FQDAN     0x25
361 #define QBMAN_DQRR_RESPONSE_CDAN      0x26
362 #define QBMAN_DQRR_RESPONSE_CSCN_MEM  0x27
363 #define QBMAN_DQRR_RESPONSE_CGCU      0x28
364 #define QBMAN_DQRR_RESPONSE_BPSCN     0x29
365 #define QBMAN_DQRR_RESPONSE_CSCN_WQ   0x2a
366 
367 /* NULL return if there are no unconsumed DQRR entries. Returns a DQRR entry
368  * only once, so repeated calls can return a sequence of DQRR entries, without
369  * requiring they be consumed immediately or in any particular order. */
qbman_swp_dqrr_next(struct qbman_swp * s)370 const struct ldpaa_dq *qbman_swp_dqrr_next(struct qbman_swp *s)
371 {
372 	uint32_t verb;
373 	uint32_t response_verb;
374 	uint32_t flags;
375 	const struct ldpaa_dq *dq;
376 	const uint32_t *p;
377 
378 	dq = qbman_cena_read(&s->sys, QBMAN_CENA_SWP_DQRR(s->dqrr.next_idx));
379 	p = qb_cl(dq);
380 	verb = qb_attr_code_decode(&code_dqrr_verb, p);
381 
382 	/* If the valid-bit isn't of the expected polarity, nothing there. Note,
383 	 * in the DQRR reset bug workaround, we shouldn't need to skip these
384 	 * check, because we've already determined that a new entry is available
385 	 * and we've invalidated the cacheline before reading it, so the
386 	 * valid-bit behaviour is repaired and should tell us what we already
387 	 * knew from reading PI.
388 	 */
389 	if ((verb & QB_VALID_BIT) != s->dqrr.valid_bit) {
390 		qbman_cena_invalidate_prefetch(&s->sys,
391 					QBMAN_CENA_SWP_DQRR(s->dqrr.next_idx));
392 		return NULL;
393 	}
394 	/* There's something there. Move "next_idx" attention to the next ring
395 	 * entry (and prefetch it) before returning what we found. */
396 	s->dqrr.next_idx++;
397 	s->dqrr.next_idx &= s->dqrr.dqrr_size - 1;/* Wrap around at dqrr_size */
398 	/* TODO: it's possible to do all this without conditionals, optimise it
399 	 * later. */
400 	if (!s->dqrr.next_idx)
401 		s->dqrr.valid_bit ^= QB_VALID_BIT;
402 
403 	/* If this is the final response to a volatile dequeue command
404 	   indicate that the vdq is no longer busy */
405 	flags = ldpaa_dq_flags(dq);
406 	response_verb = qb_attr_code_decode(&code_dqrr_response, &verb);
407 	if ((response_verb == QBMAN_DQRR_RESPONSE_DQ) &&
408 	    (flags & LDPAA_DQ_STAT_VOLATILE) &&
409 	    (flags & LDPAA_DQ_STAT_EXPIRED))
410 			atomic_inc(&s->vdq.busy);
411 
412 	qbman_cena_invalidate_prefetch(&s->sys,
413 				       QBMAN_CENA_SWP_DQRR(s->dqrr.next_idx));
414 	return dq;
415 }
416 
417 /* Consume DQRR entries previously returned from qbman_swp_dqrr_next(). */
qbman_swp_dqrr_consume(struct qbman_swp * s,const struct ldpaa_dq * dq)418 void qbman_swp_dqrr_consume(struct qbman_swp *s, const struct ldpaa_dq *dq)
419 {
420 	qbman_cinh_write(&s->sys, QBMAN_CINH_SWP_DCAP, QBMAN_IDX_FROM_DQRR(dq));
421 }
422 
423 /*********************************/
424 /* Polling user-provided storage */
425 /*********************************/
426 
qbman_dq_entry_set_oldtoken(struct ldpaa_dq * dq,unsigned int num_entries,uint8_t oldtoken)427 void qbman_dq_entry_set_oldtoken(struct ldpaa_dq *dq,
428 				 unsigned int num_entries,
429 				 uint8_t oldtoken)
430 {
431 	memset(dq, oldtoken, num_entries * sizeof(*dq));
432 }
433 
qbman_dq_entry_has_newtoken(struct qbman_swp * s,const struct ldpaa_dq * dq,uint8_t newtoken)434 int qbman_dq_entry_has_newtoken(struct qbman_swp *s,
435 				const struct ldpaa_dq *dq,
436 				uint8_t newtoken)
437 {
438 	/* To avoid converting the little-endian DQ entry to host-endian prior
439 	 * to us knowing whether there is a valid entry or not (and run the
440 	 * risk of corrupting the incoming hardware LE write), we detect in
441 	 * hardware endianness rather than host. This means we need a different
442 	 * "code" depending on whether we are BE or LE in software, which is
443 	 * where DQRR_TOK_OFFSET comes in... */
444 	static struct qb_attr_code code_dqrr_tok_detect =
445 					QB_CODE(0, DQRR_TOK_OFFSET, 8);
446 	/* The user trying to poll for a result treats "dq" as const. It is
447 	 * however the same address that was provided to us non-const in the
448 	 * first place, for directing hardware DMA to. So we can cast away the
449 	 * const because it is mutable from our perspective. */
450 	uint32_t *p = qb_cl((struct ldpaa_dq *)dq);
451 	uint32_t token;
452 
453 	token = qb_attr_code_decode(&code_dqrr_tok_detect, &p[1]);
454 	if (token != newtoken)
455 		return 0;
456 
457 	/* Only now do we convert from hardware to host endianness. Also, as we
458 	 * are returning success, the user has promised not to call us again, so
459 	 * there's no risk of us converting the endianness twice... */
460 	make_le32_n(p, 16);
461 
462 	/* VDQCR "no longer busy" hook - not quite the same as DQRR, because the
463 	 * fact "VDQCR" shows busy doesn't mean that the result we're looking at
464 	 * is from the same command. Eg. we may be looking at our 10th dequeue
465 	 * result from our first VDQCR command, yet the second dequeue command
466 	 * could have been kicked off already, after seeing the 1st result. Ie.
467 	 * the result we're looking at is not necessarily proof that we can
468 	 * reset "busy".  We instead base the decision on whether the current
469 	 * result is sitting at the first 'storage' location of the busy
470 	 * command. */
471 	if (s->vdq.storage == dq) {
472 		s->vdq.storage = NULL;
473 			atomic_inc(&s->vdq.busy);
474 	}
475 	return 1;
476 }
477 
478 /********************************/
479 /* Categorising dequeue entries */
480 /********************************/
481 
__qbman_dq_entry_is_x(const struct ldpaa_dq * dq,uint32_t x)482 static inline int __qbman_dq_entry_is_x(const struct ldpaa_dq *dq, uint32_t x)
483 {
484 	const uint32_t *p = qb_cl(dq);
485 	uint32_t response_verb = qb_attr_code_decode(&code_dqrr_response, p);
486 
487 	return response_verb == x;
488 }
489 
qbman_dq_entry_is_DQ(const struct ldpaa_dq * dq)490 int qbman_dq_entry_is_DQ(const struct ldpaa_dq *dq)
491 {
492 	return __qbman_dq_entry_is_x(dq, QBMAN_DQRR_RESPONSE_DQ);
493 }
494 
495 /*********************************/
496 /* Parsing frame dequeue results */
497 /*********************************/
498 
499 /* These APIs assume qbman_dq_entry_is_DQ() is TRUE */
500 
ldpaa_dq_flags(const struct ldpaa_dq * dq)501 uint32_t ldpaa_dq_flags(const struct ldpaa_dq *dq)
502 {
503 	const uint32_t *p = qb_cl(dq);
504 
505 	return qb_attr_code_decode(&code_dqrr_stat, p);
506 }
507 
ldpaa_dq_fd(const struct ldpaa_dq * dq)508 const struct dpaa_fd *ldpaa_dq_fd(const struct ldpaa_dq *dq)
509 {
510 	const uint32_t *p = qb_cl(dq);
511 
512 	return (const struct dpaa_fd *)&p[8];
513 }
514 
515 /******************/
516 /* Buffer release */
517 /******************/
518 
519 /* These should be const, eventually */
520 /* static struct qb_attr_code code_release_num = QB_CODE(0, 0, 3); */
521 static struct qb_attr_code code_release_set_me = QB_CODE(0, 5, 1);
522 static struct qb_attr_code code_release_bpid = QB_CODE(0, 16, 16);
523 
qbman_release_desc_clear(struct qbman_release_desc * d)524 void qbman_release_desc_clear(struct qbman_release_desc *d)
525 {
526 	uint32_t *cl;
527 
528 	memset(d, 0, sizeof(*d));
529 	cl = qb_cl(d);
530 	qb_attr_code_encode(&code_release_set_me, cl, 1);
531 }
532 
qbman_release_desc_set_bpid(struct qbman_release_desc * d,uint32_t bpid)533 void qbman_release_desc_set_bpid(struct qbman_release_desc *d, uint32_t bpid)
534 {
535 	uint32_t *cl = qb_cl(d);
536 
537 	qb_attr_code_encode(&code_release_bpid, cl, bpid);
538 }
539 
540 #define RAR_IDX(rar)     ((rar) & 0x7)
541 #define RAR_VB(rar)      ((rar) & 0x80)
542 #define RAR_SUCCESS(rar) ((rar) & 0x100)
543 
qbman_swp_release(struct qbman_swp * s,const struct qbman_release_desc * d,const uint64_t * buffers,unsigned int num_buffers)544 int qbman_swp_release(struct qbman_swp *s, const struct qbman_release_desc *d,
545 		      const uint64_t *buffers, unsigned int num_buffers)
546 {
547 	uint32_t *p;
548 	const uint32_t *cl = qb_cl(d);
549 	uint32_t rar = qbman_cinh_read(&s->sys, QBMAN_CINH_SWP_RAR);
550 	debug("RAR=%08x\n", rar);
551 	if (!RAR_SUCCESS(rar))
552 		return -EBUSY;
553 	BUG_ON(!num_buffers || (num_buffers > 7));
554 	/* Start the release command */
555 	p = qbman_cena_write_start(&s->sys,
556 				   QBMAN_CENA_SWP_RCR(RAR_IDX(rar)));
557 	/* Copy the caller's buffer pointers to the command */
558 	u64_to_le32_copy(&p[2], buffers, num_buffers);
559 	lwsync();
560 	/* Set the verb byte, have to substitute in the valid-bit and the number
561 	 * of buffers. */
562 	p[0] = cl[0] | RAR_VB(rar) | num_buffers;
563 	qbman_cena_write_complete(&s->sys,
564 				  QBMAN_CENA_SWP_RCR(RAR_IDX(rar)),
565 				  p);
566 	return 0;
567 }
568 
569 /*******************/
570 /* Buffer acquires */
571 /*******************/
572 
573 /* These should be const, eventually */
574 static struct qb_attr_code code_acquire_bpid = QB_CODE(0, 16, 16);
575 static struct qb_attr_code code_acquire_num = QB_CODE(1, 0, 3);
576 static struct qb_attr_code code_acquire_r_num = QB_CODE(1, 0, 3);
577 
qbman_swp_acquire(struct qbman_swp * s,uint32_t bpid,uint64_t * buffers,unsigned int num_buffers)578 int qbman_swp_acquire(struct qbman_swp *s, uint32_t bpid, uint64_t *buffers,
579 		      unsigned int num_buffers)
580 {
581 	uint32_t *p;
582 	uint32_t verb, rslt, num;
583 
584 	BUG_ON(!num_buffers || (num_buffers > 7));
585 
586 	/* Start the management command */
587 	p = qbman_swp_mc_start(s);
588 
589 	if (!p)
590 		return -EBUSY;
591 
592 	/* Encode the caller-provided attributes */
593 	qb_attr_code_encode(&code_acquire_bpid, p, bpid);
594 	qb_attr_code_encode(&code_acquire_num, p, num_buffers);
595 
596 	/* Complete the management command */
597 	p = qbman_swp_mc_complete(s, p, p[0] | QBMAN_MC_ACQUIRE);
598 
599 	/* Decode the outcome */
600 	verb = qb_attr_code_decode(&code_generic_verb, p);
601 	rslt = qb_attr_code_decode(&code_generic_rslt, p);
602 	num = qb_attr_code_decode(&code_acquire_r_num, p);
603 	BUG_ON(verb != QBMAN_MC_ACQUIRE);
604 
605 	/* Determine success or failure */
606 	if (unlikely(rslt != QBMAN_MC_RSLT_OK)) {
607 		printf("Acquire buffers from BPID 0x%x failed, code=0x%02x\n",
608 		       bpid, rslt);
609 		return -EIO;
610 	}
611 	BUG_ON(num > num_buffers);
612 	/* Copy the acquired buffers to the caller's array */
613 	u64_from_le32_copy(buffers, &p[2], num);
614 	return (int)num;
615 }
616