Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel
os
linux
1/* QLogic qed NIC Driver
2 * Copyright (c) 2015-2017 QLogic Corporation
3 *
4 * This software is available to you under a choice of one of two
5 * licenses. You may choose to be licensed under the terms of the GNU
6 * General Public License (GPL) Version 2, available from the file
7 * COPYING in the main directory of this source tree, or the
8 * OpenIB.org BSD license below:
9 *
10 * Redistribution and use in source and binary forms, with or
11 * without modification, are permitted provided that the following
12 * conditions are met:
13 *
14 * - Redistributions of source code must retain the above
15 * copyright notice, this list of conditions and the following
16 * disclaimer.
17 *
18 * - Redistributions in binary form must reproduce the above
19 * copyright notice, this list of conditions and the following
20 * disclaimer in the documentation and /or other materials
21 * provided with the distribution.
22 *
23 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30 * SOFTWARE.
31 */
32
33#ifndef _QED_CHAIN_H
34#define _QED_CHAIN_H
35
36#include <linux/types.h>
37#include <asm/byteorder.h>
38#include <linux/kernel.h>
39#include <linux/list.h>
40#include <linux/slab.h>
41#include <linux/qed/common_hsi.h>
42
43enum qed_chain_mode {
44 /* Each Page contains a next pointer at its end */
45 QED_CHAIN_MODE_NEXT_PTR,
46
47 /* Chain is a single page (next ptr) is unrequired */
48 QED_CHAIN_MODE_SINGLE,
49
50 /* Page pointers are located in a side list */
51 QED_CHAIN_MODE_PBL,
52};
53
54enum qed_chain_use_mode {
55 QED_CHAIN_USE_TO_PRODUCE, /* Chain starts empty */
56 QED_CHAIN_USE_TO_CONSUME, /* Chain starts full */
57 QED_CHAIN_USE_TO_CONSUME_PRODUCE, /* Chain starts empty */
58};
59
60enum qed_chain_cnt_type {
61 /* The chain's size/prod/cons are kept in 16-bit variables */
62 QED_CHAIN_CNT_TYPE_U16,
63
64 /* The chain's size/prod/cons are kept in 32-bit variables */
65 QED_CHAIN_CNT_TYPE_U32,
66};
67
68struct qed_chain_next {
69 struct regpair next_phys;
70 void *next_virt;
71};
72
73struct qed_chain_pbl_u16 {
74 u16 prod_page_idx;
75 u16 cons_page_idx;
76};
77
78struct qed_chain_pbl_u32 {
79 u32 prod_page_idx;
80 u32 cons_page_idx;
81};
82
83struct qed_chain_ext_pbl {
84 dma_addr_t p_pbl_phys;
85 void *p_pbl_virt;
86};
87
88struct qed_chain_u16 {
89 /* Cyclic index of next element to produce/consme */
90 u16 prod_idx;
91 u16 cons_idx;
92};
93
94struct qed_chain_u32 {
95 /* Cyclic index of next element to produce/consme */
96 u32 prod_idx;
97 u32 cons_idx;
98};
99
100struct addr_tbl_entry {
101 void *virt_addr;
102 dma_addr_t dma_map;
103};
104
105struct qed_chain {
106 /* fastpath portion of the chain - required for commands such
107 * as produce / consume.
108 */
109 /* Point to next element to produce/consume */
110 void *p_prod_elem;
111 void *p_cons_elem;
112
113 /* Fastpath portions of the PBL [if exists] */
114 struct {
115 /* Table for keeping the virtual and physical addresses of the
116 * chain pages, respectively to the physical addresses
117 * in the pbl table.
118 */
119 struct addr_tbl_entry *pp_addr_tbl;
120
121 union {
122 struct qed_chain_pbl_u16 u16;
123 struct qed_chain_pbl_u32 u32;
124 } c;
125 } pbl;
126
127 union {
128 struct qed_chain_u16 chain16;
129 struct qed_chain_u32 chain32;
130 } u;
131
132 /* Capacity counts only usable elements */
133 u32 capacity;
134 u32 page_cnt;
135
136 enum qed_chain_mode mode;
137
138 /* Elements information for fast calculations */
139 u16 elem_per_page;
140 u16 elem_per_page_mask;
141 u16 elem_size;
142 u16 next_page_mask;
143 u16 usable_per_page;
144 u8 elem_unusable;
145
146 u8 cnt_type;
147
148 /* Slowpath of the chain - required for initialization and destruction,
149 * but isn't involved in regular functionality.
150 */
151
152 /* Base address of a pre-allocated buffer for pbl */
153 struct {
154 dma_addr_t p_phys_table;
155 void *p_virt_table;
156 } pbl_sp;
157
158 /* Address of first page of the chain - the address is required
159 * for fastpath operation [consume/produce] but only for the the SINGLE
160 * flavour which isn't considered fastpath [== SPQ].
161 */
162 void *p_virt_addr;
163 dma_addr_t p_phys_addr;
164
165 /* Total number of elements [for entire chain] */
166 u32 size;
167
168 u8 intended_use;
169
170 bool b_external_pbl;
171};
172
173#define QED_CHAIN_PBL_ENTRY_SIZE (8)
174#define QED_CHAIN_PAGE_SIZE (0x1000)
175#define ELEMS_PER_PAGE(elem_size) (QED_CHAIN_PAGE_SIZE / (elem_size))
176
177#define UNUSABLE_ELEMS_PER_PAGE(elem_size, mode) \
178 (((mode) == QED_CHAIN_MODE_NEXT_PTR) ? \
179 (u8)(1 + ((sizeof(struct qed_chain_next) - 1) / \
180 (elem_size))) : 0)
181
182#define USABLE_ELEMS_PER_PAGE(elem_size, mode) \
183 ((u32)(ELEMS_PER_PAGE(elem_size) - \
184 UNUSABLE_ELEMS_PER_PAGE(elem_size, mode)))
185
186#define QED_CHAIN_PAGE_CNT(elem_cnt, elem_size, mode) \
187 DIV_ROUND_UP(elem_cnt, USABLE_ELEMS_PER_PAGE(elem_size, mode))
188
189#define is_chain_u16(p) ((p)->cnt_type == QED_CHAIN_CNT_TYPE_U16)
190#define is_chain_u32(p) ((p)->cnt_type == QED_CHAIN_CNT_TYPE_U32)
191
192/* Accessors */
193static inline u16 qed_chain_get_prod_idx(struct qed_chain *p_chain)
194{
195 return p_chain->u.chain16.prod_idx;
196}
197
198static inline u16 qed_chain_get_cons_idx(struct qed_chain *p_chain)
199{
200 return p_chain->u.chain16.cons_idx;
201}
202
203static inline u32 qed_chain_get_cons_idx_u32(struct qed_chain *p_chain)
204{
205 return p_chain->u.chain32.cons_idx;
206}
207
208static inline u16 qed_chain_get_elem_left(struct qed_chain *p_chain)
209{
210 u16 used;
211
212 used = (u16) (((u32)0x10000 +
213 (u32)p_chain->u.chain16.prod_idx) -
214 (u32)p_chain->u.chain16.cons_idx);
215 if (p_chain->mode == QED_CHAIN_MODE_NEXT_PTR)
216 used -= p_chain->u.chain16.prod_idx / p_chain->elem_per_page -
217 p_chain->u.chain16.cons_idx / p_chain->elem_per_page;
218
219 return (u16)(p_chain->capacity - used);
220}
221
222static inline u32 qed_chain_get_elem_left_u32(struct qed_chain *p_chain)
223{
224 u32 used;
225
226 used = (u32) (((u64)0x100000000ULL +
227 (u64)p_chain->u.chain32.prod_idx) -
228 (u64)p_chain->u.chain32.cons_idx);
229 if (p_chain->mode == QED_CHAIN_MODE_NEXT_PTR)
230 used -= p_chain->u.chain32.prod_idx / p_chain->elem_per_page -
231 p_chain->u.chain32.cons_idx / p_chain->elem_per_page;
232
233 return p_chain->capacity - used;
234}
235
236static inline u16 qed_chain_get_usable_per_page(struct qed_chain *p_chain)
237{
238 return p_chain->usable_per_page;
239}
240
241static inline u8 qed_chain_get_unusable_per_page(struct qed_chain *p_chain)
242{
243 return p_chain->elem_unusable;
244}
245
246static inline u32 qed_chain_get_page_cnt(struct qed_chain *p_chain)
247{
248 return p_chain->page_cnt;
249}
250
251static inline dma_addr_t qed_chain_get_pbl_phys(struct qed_chain *p_chain)
252{
253 return p_chain->pbl_sp.p_phys_table;
254}
255
256/**
257 * @brief qed_chain_advance_page -
258 *
259 * Advance the next element accros pages for a linked chain
260 *
261 * @param p_chain
262 * @param p_next_elem
263 * @param idx_to_inc
264 * @param page_to_inc
265 */
266static inline void
267qed_chain_advance_page(struct qed_chain *p_chain,
268 void **p_next_elem, void *idx_to_inc, void *page_to_inc)
269{
270 struct qed_chain_next *p_next = NULL;
271 u32 page_index = 0;
272
273 switch (p_chain->mode) {
274 case QED_CHAIN_MODE_NEXT_PTR:
275 p_next = *p_next_elem;
276 *p_next_elem = p_next->next_virt;
277 if (is_chain_u16(p_chain))
278 *(u16 *)idx_to_inc += p_chain->elem_unusable;
279 else
280 *(u32 *)idx_to_inc += p_chain->elem_unusable;
281 break;
282 case QED_CHAIN_MODE_SINGLE:
283 *p_next_elem = p_chain->p_virt_addr;
284 break;
285
286 case QED_CHAIN_MODE_PBL:
287 if (is_chain_u16(p_chain)) {
288 if (++(*(u16 *)page_to_inc) == p_chain->page_cnt)
289 *(u16 *)page_to_inc = 0;
290 page_index = *(u16 *)page_to_inc;
291 } else {
292 if (++(*(u32 *)page_to_inc) == p_chain->page_cnt)
293 *(u32 *)page_to_inc = 0;
294 page_index = *(u32 *)page_to_inc;
295 }
296 *p_next_elem = p_chain->pbl.pp_addr_tbl[page_index].virt_addr;
297 }
298}
299
300#define is_unusable_idx(p, idx) \
301 (((p)->u.chain16.idx & (p)->elem_per_page_mask) == (p)->usable_per_page)
302
303#define is_unusable_idx_u32(p, idx) \
304 (((p)->u.chain32.idx & (p)->elem_per_page_mask) == (p)->usable_per_page)
305#define is_unusable_next_idx(p, idx) \
306 ((((p)->u.chain16.idx + 1) & (p)->elem_per_page_mask) == \
307 (p)->usable_per_page)
308
309#define is_unusable_next_idx_u32(p, idx) \
310 ((((p)->u.chain32.idx + 1) & (p)->elem_per_page_mask) == \
311 (p)->usable_per_page)
312
313#define test_and_skip(p, idx) \
314 do { \
315 if (is_chain_u16(p)) { \
316 if (is_unusable_idx(p, idx)) \
317 (p)->u.chain16.idx += (p)->elem_unusable; \
318 } else { \
319 if (is_unusable_idx_u32(p, idx)) \
320 (p)->u.chain32.idx += (p)->elem_unusable; \
321 } \
322 } while (0)
323
324/**
325 * @brief qed_chain_return_produced -
326 *
327 * A chain in which the driver "Produces" elements should use this API
328 * to indicate previous produced elements are now consumed.
329 *
330 * @param p_chain
331 */
332static inline void qed_chain_return_produced(struct qed_chain *p_chain)
333{
334 if (is_chain_u16(p_chain))
335 p_chain->u.chain16.cons_idx++;
336 else
337 p_chain->u.chain32.cons_idx++;
338 test_and_skip(p_chain, cons_idx);
339}
340
341/**
342 * @brief qed_chain_produce -
343 *
344 * A chain in which the driver "Produces" elements should use this to get
345 * a pointer to the next element which can be "Produced". It's driver
346 * responsibility to validate that the chain has room for new element.
347 *
348 * @param p_chain
349 *
350 * @return void*, a pointer to next element
351 */
352static inline void *qed_chain_produce(struct qed_chain *p_chain)
353{
354 void *p_ret = NULL, *p_prod_idx, *p_prod_page_idx;
355
356 if (is_chain_u16(p_chain)) {
357 if ((p_chain->u.chain16.prod_idx &
358 p_chain->elem_per_page_mask) == p_chain->next_page_mask) {
359 p_prod_idx = &p_chain->u.chain16.prod_idx;
360 p_prod_page_idx = &p_chain->pbl.c.u16.prod_page_idx;
361 qed_chain_advance_page(p_chain, &p_chain->p_prod_elem,
362 p_prod_idx, p_prod_page_idx);
363 }
364 p_chain->u.chain16.prod_idx++;
365 } else {
366 if ((p_chain->u.chain32.prod_idx &
367 p_chain->elem_per_page_mask) == p_chain->next_page_mask) {
368 p_prod_idx = &p_chain->u.chain32.prod_idx;
369 p_prod_page_idx = &p_chain->pbl.c.u32.prod_page_idx;
370 qed_chain_advance_page(p_chain, &p_chain->p_prod_elem,
371 p_prod_idx, p_prod_page_idx);
372 }
373 p_chain->u.chain32.prod_idx++;
374 }
375
376 p_ret = p_chain->p_prod_elem;
377 p_chain->p_prod_elem = (void *)(((u8 *)p_chain->p_prod_elem) +
378 p_chain->elem_size);
379
380 return p_ret;
381}
382
383/**
384 * @brief qed_chain_get_capacity -
385 *
386 * Get the maximum number of BDs in chain
387 *
388 * @param p_chain
389 * @param num
390 *
391 * @return number of unusable BDs
392 */
393static inline u32 qed_chain_get_capacity(struct qed_chain *p_chain)
394{
395 return p_chain->capacity;
396}
397
398/**
399 * @brief qed_chain_recycle_consumed -
400 *
401 * Returns an element which was previously consumed;
402 * Increments producers so they could be written to FW.
403 *
404 * @param p_chain
405 */
406static inline void qed_chain_recycle_consumed(struct qed_chain *p_chain)
407{
408 test_and_skip(p_chain, prod_idx);
409 if (is_chain_u16(p_chain))
410 p_chain->u.chain16.prod_idx++;
411 else
412 p_chain->u.chain32.prod_idx++;
413}
414
415/**
416 * @brief qed_chain_consume -
417 *
418 * A Chain in which the driver utilizes data written by a different source
419 * (i.e., FW) should use this to access passed buffers.
420 *
421 * @param p_chain
422 *
423 * @return void*, a pointer to the next buffer written
424 */
425static inline void *qed_chain_consume(struct qed_chain *p_chain)
426{
427 void *p_ret = NULL, *p_cons_idx, *p_cons_page_idx;
428
429 if (is_chain_u16(p_chain)) {
430 if ((p_chain->u.chain16.cons_idx &
431 p_chain->elem_per_page_mask) == p_chain->next_page_mask) {
432 p_cons_idx = &p_chain->u.chain16.cons_idx;
433 p_cons_page_idx = &p_chain->pbl.c.u16.cons_page_idx;
434 qed_chain_advance_page(p_chain, &p_chain->p_cons_elem,
435 p_cons_idx, p_cons_page_idx);
436 }
437 p_chain->u.chain16.cons_idx++;
438 } else {
439 if ((p_chain->u.chain32.cons_idx &
440 p_chain->elem_per_page_mask) == p_chain->next_page_mask) {
441 p_cons_idx = &p_chain->u.chain32.cons_idx;
442 p_cons_page_idx = &p_chain->pbl.c.u32.cons_page_idx;
443 qed_chain_advance_page(p_chain, &p_chain->p_cons_elem,
444 p_cons_idx, p_cons_page_idx);
445 }
446 p_chain->u.chain32.cons_idx++;
447 }
448
449 p_ret = p_chain->p_cons_elem;
450 p_chain->p_cons_elem = (void *)(((u8 *)p_chain->p_cons_elem) +
451 p_chain->elem_size);
452
453 return p_ret;
454}
455
456/**
457 * @brief qed_chain_reset - Resets the chain to its start state
458 *
459 * @param p_chain pointer to a previously allocted chain
460 */
461static inline void qed_chain_reset(struct qed_chain *p_chain)
462{
463 u32 i;
464
465 if (is_chain_u16(p_chain)) {
466 p_chain->u.chain16.prod_idx = 0;
467 p_chain->u.chain16.cons_idx = 0;
468 } else {
469 p_chain->u.chain32.prod_idx = 0;
470 p_chain->u.chain32.cons_idx = 0;
471 }
472 p_chain->p_cons_elem = p_chain->p_virt_addr;
473 p_chain->p_prod_elem = p_chain->p_virt_addr;
474
475 if (p_chain->mode == QED_CHAIN_MODE_PBL) {
476 /* Use (page_cnt - 1) as a reset value for the prod/cons page's
477 * indices, to avoid unnecessary page advancing on the first
478 * call to qed_chain_produce/consume. Instead, the indices
479 * will be advanced to page_cnt and then will be wrapped to 0.
480 */
481 u32 reset_val = p_chain->page_cnt - 1;
482
483 if (is_chain_u16(p_chain)) {
484 p_chain->pbl.c.u16.prod_page_idx = (u16)reset_val;
485 p_chain->pbl.c.u16.cons_page_idx = (u16)reset_val;
486 } else {
487 p_chain->pbl.c.u32.prod_page_idx = reset_val;
488 p_chain->pbl.c.u32.cons_page_idx = reset_val;
489 }
490 }
491
492 switch (p_chain->intended_use) {
493 case QED_CHAIN_USE_TO_CONSUME:
494 /* produce empty elements */
495 for (i = 0; i < p_chain->capacity; i++)
496 qed_chain_recycle_consumed(p_chain);
497 break;
498
499 case QED_CHAIN_USE_TO_CONSUME_PRODUCE:
500 case QED_CHAIN_USE_TO_PRODUCE:
501 default:
502 /* Do nothing */
503 break;
504 }
505}
506
507/**
508 * @brief qed_chain_init - Initalizes a basic chain struct
509 *
510 * @param p_chain
511 * @param p_virt_addr
512 * @param p_phys_addr physical address of allocated buffer's beginning
513 * @param page_cnt number of pages in the allocated buffer
514 * @param elem_size size of each element in the chain
515 * @param intended_use
516 * @param mode
517 */
518static inline void qed_chain_init_params(struct qed_chain *p_chain,
519 u32 page_cnt,
520 u8 elem_size,
521 enum qed_chain_use_mode intended_use,
522 enum qed_chain_mode mode,
523 enum qed_chain_cnt_type cnt_type)
524{
525 /* chain fixed parameters */
526 p_chain->p_virt_addr = NULL;
527 p_chain->p_phys_addr = 0;
528 p_chain->elem_size = elem_size;
529 p_chain->intended_use = (u8)intended_use;
530 p_chain->mode = mode;
531 p_chain->cnt_type = (u8)cnt_type;
532
533 p_chain->elem_per_page = ELEMS_PER_PAGE(elem_size);
534 p_chain->usable_per_page = USABLE_ELEMS_PER_PAGE(elem_size, mode);
535 p_chain->elem_per_page_mask = p_chain->elem_per_page - 1;
536 p_chain->elem_unusable = UNUSABLE_ELEMS_PER_PAGE(elem_size, mode);
537 p_chain->next_page_mask = (p_chain->usable_per_page &
538 p_chain->elem_per_page_mask);
539
540 p_chain->page_cnt = page_cnt;
541 p_chain->capacity = p_chain->usable_per_page * page_cnt;
542 p_chain->size = p_chain->elem_per_page * page_cnt;
543
544 p_chain->pbl_sp.p_phys_table = 0;
545 p_chain->pbl_sp.p_virt_table = NULL;
546 p_chain->pbl.pp_addr_tbl = NULL;
547}
548
549/**
550 * @brief qed_chain_init_mem -
551 *
552 * Initalizes a basic chain struct with its chain buffers
553 *
554 * @param p_chain
555 * @param p_virt_addr virtual address of allocated buffer's beginning
556 * @param p_phys_addr physical address of allocated buffer's beginning
557 *
558 */
559static inline void qed_chain_init_mem(struct qed_chain *p_chain,
560 void *p_virt_addr, dma_addr_t p_phys_addr)
561{
562 p_chain->p_virt_addr = p_virt_addr;
563 p_chain->p_phys_addr = p_phys_addr;
564}
565
566/**
567 * @brief qed_chain_init_pbl_mem -
568 *
569 * Initalizes a basic chain struct with its pbl buffers
570 *
571 * @param p_chain
572 * @param p_virt_pbl pointer to a pre allocated side table which will hold
573 * virtual page addresses.
574 * @param p_phys_pbl pointer to a pre-allocated side table which will hold
575 * physical page addresses.
576 * @param pp_virt_addr_tbl
577 * pointer to a pre-allocated side table which will hold
578 * the virtual addresses of the chain pages.
579 *
580 */
581static inline void qed_chain_init_pbl_mem(struct qed_chain *p_chain,
582 void *p_virt_pbl,
583 dma_addr_t p_phys_pbl,
584 struct addr_tbl_entry *pp_addr_tbl)
585{
586 p_chain->pbl_sp.p_phys_table = p_phys_pbl;
587 p_chain->pbl_sp.p_virt_table = p_virt_pbl;
588 p_chain->pbl.pp_addr_tbl = pp_addr_tbl;
589}
590
591/**
592 * @brief qed_chain_init_next_ptr_elem -
593 *
594 * Initalizes a next pointer element
595 *
596 * @param p_chain
597 * @param p_virt_curr virtual address of a chain page of which the next
598 * pointer element is initialized
599 * @param p_virt_next virtual address of the next chain page
600 * @param p_phys_next physical address of the next chain page
601 *
602 */
603static inline void
604qed_chain_init_next_ptr_elem(struct qed_chain *p_chain,
605 void *p_virt_curr,
606 void *p_virt_next, dma_addr_t p_phys_next)
607{
608 struct qed_chain_next *p_next;
609 u32 size;
610
611 size = p_chain->elem_size * p_chain->usable_per_page;
612 p_next = (struct qed_chain_next *)((u8 *)p_virt_curr + size);
613
614 DMA_REGPAIR_LE(p_next->next_phys, p_phys_next);
615
616 p_next->next_virt = p_virt_next;
617}
618
619/**
620 * @brief qed_chain_get_last_elem -
621 *
622 * Returns a pointer to the last element of the chain
623 *
624 * @param p_chain
625 *
626 * @return void*
627 */
628static inline void *qed_chain_get_last_elem(struct qed_chain *p_chain)
629{
630 struct qed_chain_next *p_next = NULL;
631 void *p_virt_addr = NULL;
632 u32 size, last_page_idx;
633
634 if (!p_chain->p_virt_addr)
635 goto out;
636
637 switch (p_chain->mode) {
638 case QED_CHAIN_MODE_NEXT_PTR:
639 size = p_chain->elem_size * p_chain->usable_per_page;
640 p_virt_addr = p_chain->p_virt_addr;
641 p_next = (struct qed_chain_next *)((u8 *)p_virt_addr + size);
642 while (p_next->next_virt != p_chain->p_virt_addr) {
643 p_virt_addr = p_next->next_virt;
644 p_next = (struct qed_chain_next *)((u8 *)p_virt_addr +
645 size);
646 }
647 break;
648 case QED_CHAIN_MODE_SINGLE:
649 p_virt_addr = p_chain->p_virt_addr;
650 break;
651 case QED_CHAIN_MODE_PBL:
652 last_page_idx = p_chain->page_cnt - 1;
653 p_virt_addr = p_chain->pbl.pp_addr_tbl[last_page_idx].virt_addr;
654 break;
655 }
656 /* p_virt_addr points at this stage to the last page of the chain */
657 size = p_chain->elem_size * (p_chain->usable_per_page - 1);
658 p_virt_addr = (u8 *)p_virt_addr + size;
659out:
660 return p_virt_addr;
661}
662
663/**
664 * @brief qed_chain_set_prod - sets the prod to the given value
665 *
666 * @param prod_idx
667 * @param p_prod_elem
668 */
669static inline void qed_chain_set_prod(struct qed_chain *p_chain,
670 u32 prod_idx, void *p_prod_elem)
671{
672 if (p_chain->mode == QED_CHAIN_MODE_PBL) {
673 u32 cur_prod, page_mask, page_cnt, page_diff;
674
675 cur_prod = is_chain_u16(p_chain) ? p_chain->u.chain16.prod_idx :
676 p_chain->u.chain32.prod_idx;
677
678 /* Assume that number of elements in a page is power of 2 */
679 page_mask = ~p_chain->elem_per_page_mask;
680
681 /* Use "cur_prod - 1" and "prod_idx - 1" since producer index
682 * reaches the first element of next page before the page index
683 * is incremented. See qed_chain_produce().
684 * Index wrap around is not a problem because the difference
685 * between current and given producer indices is always
686 * positive and lower than the chain's capacity.
687 */
688 page_diff = (((cur_prod - 1) & page_mask) -
689 ((prod_idx - 1) & page_mask)) /
690 p_chain->elem_per_page;
691
692 page_cnt = qed_chain_get_page_cnt(p_chain);
693 if (is_chain_u16(p_chain))
694 p_chain->pbl.c.u16.prod_page_idx =
695 (p_chain->pbl.c.u16.prod_page_idx -
696 page_diff + page_cnt) % page_cnt;
697 else
698 p_chain->pbl.c.u32.prod_page_idx =
699 (p_chain->pbl.c.u32.prod_page_idx -
700 page_diff + page_cnt) % page_cnt;
701 }
702
703 if (is_chain_u16(p_chain))
704 p_chain->u.chain16.prod_idx = (u16) prod_idx;
705 else
706 p_chain->u.chain32.prod_idx = prod_idx;
707 p_chain->p_prod_elem = p_prod_elem;
708}
709
710/**
711 * @brief qed_chain_pbl_zero_mem - set chain memory to 0
712 *
713 * @param p_chain
714 */
715static inline void qed_chain_pbl_zero_mem(struct qed_chain *p_chain)
716{
717 u32 i, page_cnt;
718
719 if (p_chain->mode != QED_CHAIN_MODE_PBL)
720 return;
721
722 page_cnt = qed_chain_get_page_cnt(p_chain);
723
724 for (i = 0; i < page_cnt; i++)
725 memset(p_chain->pbl.pp_addr_tbl[i].virt_addr, 0,
726 QED_CHAIN_PAGE_SIZE);
727}
728
729#endif