Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel os linux
1
fork

Configure Feed

Select the types of activity you want to include in your feed.

at v5.7-rc7 729 lines 20 kB view raw
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