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