lib/librte_mempool/rte_mempool.c

   1 /*-
   2  *   BSD LICENSE
   3  *
   4  *   Copyright(c) 2010-2014 Intel Corporation. All rights reserved.
   5  *   All rights reserved.
   6  *
   7  *   Redistribution and use in source and binary forms, with or without
   8  *   modification, are permitted provided that the following conditions
   9  *   are met:
  10  *
  11  *     * Redistributions of source code must retain the above copyright
  12  *       notice, this list of conditions and the following disclaimer.
  13  *     * Redistributions in binary form must reproduce the above copyright
  14  *       notice, this list of conditions and the following disclaimer in
  15  *       the documentation and/or other materials provided with the
  16  *       distribution.
  17  *     * Neither the name of Intel Corporation nor the names of its
  18  *       contributors may be used to endorse or promote products derived
  19  *       from this software without specific prior written permission.
  20  *
  21  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  22  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  23  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  24  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  25  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  26  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  27  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  28  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  29  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  30  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  31  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  32  */
  33
  34 #include <stdio.h>
  35 #include <string.h>
  36 #include <stdint.h>
  37 #include <stdarg.h>
  38 #include <unistd.h>
  39 #include <inttypes.h>
  40 #include <errno.h>
  41 #include <sys/queue.h>
  42
  43 #include <rte_common.h>
  44 #include <rte_log.h>
  45 #include <rte_debug.h>
  46 #include <rte_memory.h>
  47 #include <rte_memzone.h>
  48 #include <rte_malloc.h>
  49 #include <rte_atomic.h>
  50 #include <rte_launch.h>
  51 #include <rte_eal.h>
  52 #include <rte_eal_memconfig.h>
  53 #include <rte_per_lcore.h>
  54 #include <rte_lcore.h>
  55 #include <rte_branch_prediction.h>
  56 #include <rte_ring.h>
  57 #include <rte_errno.h>
  58 #include <rte_string_fns.h>
  59 #include <rte_spinlock.h>
  60
  61 #include "rte_mempool.h"
  62
  63 TAILQ_HEAD(rte_mempool_list, rte_tailq_entry);
  64
  65 static struct rte_tailq_elem rte_mempool_tailq = {
  66         .name = "RTE_MEMPOOL",
  67 };
  68 EAL_REGISTER_TAILQ(rte_mempool_tailq)
  69
  70 #define CACHE_FLUSHTHRESH_MULTIPLIER 1.5
  71 #define CALC_CACHE_FLUSHTHRESH(c)       \
  72         ((typeof(c))((c) * CACHE_FLUSHTHRESH_MULTIPLIER))
  73
  74 /*
  75  * return the greatest common divisor between a and b (fast algorithm)
  76  *
  77  */
  78 static unsigned get_gcd(unsigned a, unsigned b)
  79 {
  80         unsigned c;
  81
  82         if (0 == a)
  83                 return b;
  84         if (0 == b)
  85                 return a;
  86
  87         if (a < b) {
  88                 c = a;
  89                 a = b;
  90                 b = c;
  91         }
  92
  93         while (b != 0) {
  94                 c = a % b;
  95                 a = b;
  96                 b = c;
  97         }
  98
  99         return a;
 100 }
 101
 102 /*
 103  * Depending on memory configuration, objects addresses are spread
 104  * between channels and ranks in RAM: the pool allocator will add
 105  * padding between objects. This function return the new size of the
 106  * object.
 107  */
 108 static unsigned optimize_object_size(unsigned obj_size)
 109 {
 110         unsigned nrank, nchan;
 111         unsigned new_obj_size;
 112
 113         /* get number of channels */
 114         nchan = rte_memory_get_nchannel();
 115         if (nchan == 0)
 116                 nchan = 1;
 117
 118         nrank = rte_memory_get_nrank();
 119         if (nrank == 0)
 120                 nrank = 1;
 121
 122         /* process new object size */
 123         new_obj_size = (obj_size + RTE_CACHE_LINE_MASK) / RTE_CACHE_LINE_SIZE;
 124         while (get_gcd(new_obj_size, nrank * nchan) != 1)
 125                 new_obj_size++;
 126         return new_obj_size * RTE_CACHE_LINE_SIZE;
 127 }
 128
 129 static void
 130 mempool_add_elem(struct rte_mempool *mp, void *obj, uint32_t obj_idx,
 131         rte_mempool_obj_ctor_t *obj_init, void *obj_init_arg)
 132 {
 133         struct rte_mempool_objhdr *hdr;
 134         struct rte_mempool_objtlr *tlr __rte_unused;
 135
 136         obj = (char *)obj + mp->header_size;
 137
 138         /* set mempool ptr in header */
 139         hdr = RTE_PTR_SUB(obj, sizeof(*hdr));
 140         hdr->mp = mp;
 141
 142 #ifdef RTE_LIBRTE_MEMPOOL_DEBUG
 143         hdr->cookie = RTE_MEMPOOL_HEADER_COOKIE2;
 144         tlr = __mempool_get_trailer(obj);
 145         tlr->cookie = RTE_MEMPOOL_TRAILER_COOKIE;
 146 #endif
 147         /* call the initializer */
 148         if (obj_init)
 149                 obj_init(mp, obj_init_arg, obj, obj_idx);
 150
 151         /* enqueue in ring */
 152         rte_ring_sp_enqueue(mp->ring, obj);
 153 }
 154
 155 uint32_t
 156 rte_mempool_obj_iter(void *vaddr, uint32_t elt_num, size_t elt_sz, size_t align,
 157         const phys_addr_t paddr[], uint32_t pg_num, uint32_t pg_shift,
 158         rte_mempool_obj_iter_t obj_iter, void *obj_iter_arg)
 159 {
 160         uint32_t i, j, k;
 161         uint32_t pgn, pgf;
 162         uintptr_t end, start, va;
 163         uintptr_t pg_sz;
 164
 165         pg_sz = (uintptr_t)1 << pg_shift;
 166         va = (uintptr_t)vaddr;
 167
 168         i = 0;
 169         j = 0;
 170
 171         while (i != elt_num && j != pg_num) {
 172
 173                 start = RTE_ALIGN_CEIL(va, align);
 174                 end = start + elt_sz;
 175
 176                 /* index of the first page for the next element. */
 177                 pgf = (end >> pg_shift) - (start >> pg_shift);
 178
 179                 /* index of the last page for the current element. */
 180                 pgn = ((end - 1) >> pg_shift) - (start >> pg_shift);
 181                 pgn += j;
 182
 183                 /* do we have enough space left for the element. */
 184                 if (pgn >= pg_num)
 185                         break;
 186
 187                 for (k = j;
 188                                 k != pgn &&
 189                                 paddr[k] + pg_sz == paddr[k + 1];
 190                                 k++)
 191                         ;
 192
 193                 /*
 194                  * if next pgn chunks of memory physically continuous,
 195                  * use it to create next element.
 196                  * otherwise, just skip that chunk unused.
 197                  */
 198                 if (k == pgn) {
 199                         if (obj_iter != NULL)
 200                                 obj_iter(obj_iter_arg, (void *)start,
 201                                         (void *)end, i);
 202                         va = end;
 203                         j += pgf;
 204                         i++;
 205                 } else {
 206                         va = RTE_ALIGN_CEIL((va + 1), pg_sz);
 207                         j++;
 208                 }
 209         }
 210
 211         return i;
 212 }
 213
 214 /*
 215  * Populate  mempool with the objects.
 216  */
 217
 218 struct mempool_populate_arg {
 219         struct rte_mempool     *mp;
 220         rte_mempool_obj_ctor_t *obj_init;
 221         void                   *obj_init_arg;
 222 };
 223
 224 static void
 225 mempool_obj_populate(void *arg, void *start, void *end, uint32_t idx)
 226 {
 227         struct mempool_populate_arg *pa = arg;
 228
 229         mempool_add_elem(pa->mp, start, idx, pa->obj_init, pa->obj_init_arg);
 230         pa->mp->elt_va_end = (uintptr_t)end;
 231 }
 232
 233 static void
 234 mempool_populate(struct rte_mempool *mp, size_t num, size_t align,
 235         rte_mempool_obj_ctor_t *obj_init, void *obj_init_arg)
 236 {
 237         uint32_t elt_sz;
 238         struct mempool_populate_arg arg;
 239
 240         elt_sz = mp->elt_size + mp->header_size + mp->trailer_size;
 241         arg.mp = mp;
 242         arg.obj_init = obj_init;
 243         arg.obj_init_arg = obj_init_arg;
 244
 245         mp->size = rte_mempool_obj_iter((void *)mp->elt_va_start,
 246                 num, elt_sz, align,
 247                 mp->elt_pa, mp->pg_num, mp->pg_shift,
 248                 mempool_obj_populate, &arg);
 249 }
 250
 251 uint32_t
 252 rte_mempool_calc_obj_size(uint32_t elt_size, uint32_t flags,
 253         struct rte_mempool_objsz *sz)
 254 {
 255         struct rte_mempool_objsz lsz;
 256
 257         sz = (sz != NULL) ? sz : &lsz;
 258
 259         /*
 260          * In header, we have at least the pointer to the pool, and
 261          * optionaly a 64 bits cookie.
 262          */
 263         sz->header_size = 0;
 264         sz->header_size += sizeof(struct rte_mempool *); /* ptr to pool */
 265 #ifdef RTE_LIBRTE_MEMPOOL_DEBUG
 266         sz->header_size += sizeof(uint64_t); /* cookie */
 267 #endif
 268         if ((flags & MEMPOOL_F_NO_CACHE_ALIGN) == 0)
 269                 sz->header_size = RTE_ALIGN_CEIL(sz->header_size,
 270                         RTE_CACHE_LINE_SIZE);
 271
 272         /* trailer contains the cookie in debug mode */
 273         sz->trailer_size = 0;
 274 #ifdef RTE_LIBRTE_MEMPOOL_DEBUG
 275         sz->trailer_size += sizeof(uint64_t); /* cookie */
 276 #endif
 277         /* element size is 8 bytes-aligned at least */
 278         sz->elt_size = RTE_ALIGN_CEIL(elt_size, sizeof(uint64_t));
 279
 280         /* expand trailer to next cache line */
 281         if ((flags & MEMPOOL_F_NO_CACHE_ALIGN) == 0) {
 282                 sz->total_size = sz->header_size + sz->elt_size +
 283                         sz->trailer_size;
 284                 sz->trailer_size += ((RTE_CACHE_LINE_SIZE -
 285                                   (sz->total_size & RTE_CACHE_LINE_MASK)) &
 286                                  RTE_CACHE_LINE_MASK);
 287         }
 288
 289         /*
 290          * increase trailer to add padding between objects in order to
 291          * spread them across memory channels/ranks
 292          */
 293         if ((flags & MEMPOOL_F_NO_SPREAD) == 0) {
 294                 unsigned new_size;
 295                 new_size = optimize_object_size(sz->header_size + sz->elt_size +
 296                         sz->trailer_size);
 297                 sz->trailer_size = new_size - sz->header_size - sz->elt_size;
 298         }
 299
 300         if (! rte_eal_has_hugepages()) {
 301                 /*
 302                  * compute trailer size so that pool elements fit exactly in
 303                  * a standard page
 304                  */
 305                 int page_size = getpagesize();
 306                 int new_size = page_size - sz->header_size - sz->elt_size;
 307                 if (new_size < 0 || (unsigned int)new_size < sz->trailer_size) {
 308                         printf("When hugepages are disabled, pool objects "
 309                                "can't exceed PAGE_SIZE: %d + %d + %d > %d\n",
 310                                sz->header_size, sz->elt_size, sz->trailer_size,
 311                                page_size);
 312                         return 0;
 313                 }
 314                 sz->trailer_size = new_size;
 315         }
 316
 317         /* this is the size of an object, including header and trailer */
 318         sz->total_size = sz->header_size + sz->elt_size + sz->trailer_size;
 319
 320         return sz->total_size;
 321 }
 322
 323
 324 /*
 325  * Calculate maximum amount of memory required to store given number of objects.
 326  */
 327 size_t
 328 rte_mempool_xmem_size(uint32_t elt_num, size_t elt_sz, uint32_t pg_shift)
 329 {
 330         size_t n, pg_num, pg_sz, sz;
 331
 332         pg_sz = (size_t)1 << pg_shift;
 333
 334         if ((n = pg_sz / elt_sz) > 0) {
 335                 pg_num = (elt_num + n - 1) / n;
 336                 sz = pg_num << pg_shift;
 337         } else {
 338                 sz = RTE_ALIGN_CEIL(elt_sz, pg_sz) * elt_num;
 339         }
 340
 341         return sz;
 342 }
 343
 344 /*
 345  * Calculate how much memory would be actually required with the
 346  * given memory footprint to store required number of elements.
 347  */
 348 static void
 349 mempool_lelem_iter(void *arg, __rte_unused void *start, void *end,
 350         __rte_unused uint32_t idx)
 351 {
 352         *(uintptr_t *)arg = (uintptr_t)end;
 353 }
 354
 355 ssize_t
 356 rte_mempool_xmem_usage(void *vaddr, uint32_t elt_num, size_t elt_sz,
 357         const phys_addr_t paddr[], uint32_t pg_num, uint32_t pg_shift)
 358 {
 359         uint32_t n;
 360         uintptr_t va, uv;
 361         size_t pg_sz, usz;
 362
 363         pg_sz = (size_t)1 << pg_shift;
 364         va = (uintptr_t)vaddr;
 365         uv = va;
 366
 367         if ((n = rte_mempool_obj_iter(vaddr, elt_num, elt_sz, 1,
 368                         paddr, pg_num, pg_shift, mempool_lelem_iter,
 369                         &uv)) != elt_num) {
 370                 return -(ssize_t)n;
 371         }
 372
 373         uv = RTE_ALIGN_CEIL(uv, pg_sz);
 374         usz = uv - va;
 375         return usz;
 376 }
 377
 378 /* create the mempool */
 379 struct rte_mempool *
 380 rte_mempool_create(const char *name, unsigned n, unsigned elt_size,
 381                    unsigned cache_size, unsigned private_data_size,
 382                    rte_mempool_ctor_t *mp_init, void *mp_init_arg,
 383                    rte_mempool_obj_ctor_t *obj_init, void *obj_init_arg,
 384                    int socket_id, unsigned flags)
 385 {
 386 #ifdef RTE_LIBRTE_XEN_DOM0
 387         return rte_dom0_mempool_create(name, n, elt_size,
 388                 cache_size, private_data_size,
 389                 mp_init, mp_init_arg,
 390                 obj_init, obj_init_arg,
 391                 socket_id, flags);
 392 #else
 393         return rte_mempool_xmem_create(name, n, elt_size,
 394                 cache_size, private_data_size,
 395                 mp_init, mp_init_arg,
 396                 obj_init, obj_init_arg,
 397                 socket_id, flags,
 398                 NULL, NULL, MEMPOOL_PG_NUM_DEFAULT, MEMPOOL_PG_SHIFT_MAX);
 399 #endif
 400 }
 401
 402 /*
 403  * Create the mempool over already allocated chunk of memory.
 404  * That external memory buffer can consists of physically disjoint pages.
 405  * Setting vaddr to NULL, makes mempool to fallback to original behaviour
 406  * and allocate space for mempool and it's elements as one big chunk of
 407  * physically continuos memory.
 408  * */
 409 struct rte_mempool *
 410 rte_mempool_xmem_create(const char *name, unsigned n, unsigned elt_size,
 411                 unsigned cache_size, unsigned private_data_size,
 412                 rte_mempool_ctor_t *mp_init, void *mp_init_arg,
 413                 rte_mempool_obj_ctor_t *obj_init, void *obj_init_arg,
 414                 int socket_id, unsigned flags, void *vaddr,
 415                 const phys_addr_t paddr[], uint32_t pg_num, uint32_t pg_shift)
 416 {
 417         char mz_name[RTE_MEMZONE_NAMESIZE];
 418         char rg_name[RTE_RING_NAMESIZE];
 419         struct rte_mempool_list *mempool_list;
 420         struct rte_mempool *mp = NULL;
 421         struct rte_tailq_entry *te;
 422         struct rte_ring *r;
 423         const struct rte_memzone *mz;
 424         size_t mempool_size;
 425         int mz_flags = RTE_MEMZONE_1GB|RTE_MEMZONE_SIZE_HINT_ONLY;
 426         int rg_flags = 0;
 427         void *obj;
 428         struct rte_mempool_objsz objsz;
 429         void *startaddr;
 430         int page_size = getpagesize();
 431
 432         /* compilation-time checks */
 433         RTE_BUILD_BUG_ON((sizeof(struct rte_mempool) &
 434                           RTE_CACHE_LINE_MASK) != 0);
 435 #if RTE_MEMPOOL_CACHE_MAX_SIZE > 0
 436         RTE_BUILD_BUG_ON((sizeof(struct rte_mempool_cache) &
 437                           RTE_CACHE_LINE_MASK) != 0);
 438         RTE_BUILD_BUG_ON((offsetof(struct rte_mempool, local_cache) &
 439                           RTE_CACHE_LINE_MASK) != 0);
 440 #endif
 441 #ifdef RTE_LIBRTE_MEMPOOL_DEBUG
 442         RTE_BUILD_BUG_ON((sizeof(struct rte_mempool_debug_stats) &
 443                           RTE_CACHE_LINE_MASK) != 0);
 444         RTE_BUILD_BUG_ON((offsetof(struct rte_mempool, stats) &
 445                           RTE_CACHE_LINE_MASK) != 0);
 446 #endif
 447
 448         mempool_list = RTE_TAILQ_CAST(rte_mempool_tailq.head, rte_mempool_list);
 449
 450         /* asked cache too big */
 451         if (cache_size > RTE_MEMPOOL_CACHE_MAX_SIZE ||
 452             CALC_CACHE_FLUSHTHRESH(cache_size) > n) {
 453                 rte_errno = EINVAL;
 454                 return NULL;
 455         }
 456
 457         /* check that we have both VA and PA */
 458         if (vaddr != NULL && paddr == NULL) {
 459                 rte_errno = EINVAL;
 460                 return NULL;
 461         }
 462
 463         /* Check that pg_num and pg_shift parameters are valid. */
 464         if (pg_num < RTE_DIM(mp->elt_pa) || pg_shift > MEMPOOL_PG_SHIFT_MAX) {
 465                 rte_errno = EINVAL;
 466                 return NULL;
 467         }
 468
 469         /* "no cache align" imply "no spread" */
 470         if (flags & MEMPOOL_F_NO_CACHE_ALIGN)
 471                 flags |= MEMPOOL_F_NO_SPREAD;
 472
 473         /* ring flags */
 474         if (flags & MEMPOOL_F_SP_PUT)
 475                 rg_flags |= RING_F_SP_ENQ;
 476         if (flags & MEMPOOL_F_SC_GET)
 477                 rg_flags |= RING_F_SC_DEQ;
 478
 479         /* calculate mempool object sizes. */
 480         if (!rte_mempool_calc_obj_size(elt_size, flags, &objsz)) {
 481                 rte_errno = EINVAL;
 482                 return NULL;
 483         }
 484
 485         rte_rwlock_write_lock(RTE_EAL_MEMPOOL_RWLOCK);
 486
 487         /* allocate the ring that will be used to store objects */
 488         /* Ring functions will return appropriate errors if we are
 489          * running as a secondary process etc., so no checks made
 490          * in this function for that condition */
 491         snprintf(rg_name, sizeof(rg_name), RTE_MEMPOOL_MZ_FORMAT, name);
 492         r = rte_ring_create(rg_name, rte_align32pow2(n+1), socket_id, rg_flags);
 493         if (r == NULL)
 494                 goto exit;
 495
 496         /*
 497          * reserve a memory zone for this mempool: private data is
 498          * cache-aligned
 499          */
 500         private_data_size = (private_data_size +
 501                              RTE_CACHE_LINE_MASK) & (~RTE_CACHE_LINE_MASK);
 502
 503         if (! rte_eal_has_hugepages()) {
 504                 /*
 505                  * expand private data size to a whole page, so that the
 506                  * first pool element will start on a new standard page
 507                  */
 508                 int head = sizeof(struct rte_mempool);
 509                 int new_size = (private_data_size + head) % page_size;
 510                 if (new_size) {
 511                         private_data_size += page_size - new_size;
 512                 }
 513         }
 514
 515         /* try to allocate tailq entry */
 516         te = rte_zmalloc("MEMPOOL_TAILQ_ENTRY", sizeof(*te), 0);
 517         if (te == NULL) {
 518                 RTE_LOG(ERR, MEMPOOL, "Cannot allocate tailq entry!\n");
 519                 goto exit;
 520         }
 521
 522         /*
 523          * If user provided an external memory buffer, then use it to
 524          * store mempool objects. Otherwise reserve a memzone that is large
 525          * enough to hold mempool header and metadata plus mempool objects.
 526          */
 527         mempool_size = MEMPOOL_HEADER_SIZE(mp, pg_num) + private_data_size;
 528         if (vaddr == NULL)
 529                 mempool_size += (size_t)objsz.total_size * n;
 530
 531         if (! rte_eal_has_hugepages()) {
 532                 /*
 533                  * we want the memory pool to start on a page boundary,
 534                  * because pool elements crossing page boundaries would
 535                  * result in discontiguous physical addresses
 536                  */
 537                 mempool_size += page_size;
 538         }
 539
 540         snprintf(mz_name, sizeof(mz_name), RTE_MEMPOOL_MZ_FORMAT, name);
 541
 542         mz = rte_memzone_reserve(mz_name, mempool_size, socket_id, mz_flags);
 543
 544         /*
 545          * no more memory: in this case we loose previously reserved
 546          * space for the ring as we cannot free it
 547          */
 548         if (mz == NULL) {
 549                 rte_free(te);
 550                 goto exit;
 551         }
 552
 553         if (rte_eal_has_hugepages()) {
 554                 startaddr = (void*)mz->addr;
 555         } else {
 556                 /* align memory pool start address on a page boundary */
 557                 unsigned long addr = (unsigned long)mz->addr;
 558                 if (addr & (page_size - 1)) {
 559                         addr += page_size;
 560                         addr &= ~(page_size - 1);
 561                 }
 562                 startaddr = (void*)addr;
 563         }
 564
 565         /* init the mempool structure */
 566         mp = startaddr;
 567         memset(mp, 0, sizeof(*mp));
 568         snprintf(mp->name, sizeof(mp->name), "%s", name);
 569         mp->phys_addr = mz->phys_addr;
 570         mp->ring = r;
 571         mp->size = n;
 572         mp->flags = flags;
 573         mp->elt_size = objsz.elt_size;
 574         mp->header_size = objsz.header_size;
 575         mp->trailer_size = objsz.trailer_size;
 576         mp->cache_size = cache_size;
 577         mp->cache_flushthresh = CALC_CACHE_FLUSHTHRESH(cache_size);
 578         mp->private_data_size = private_data_size;
 579
 580         /* calculate address of the first element for continuous mempool. */
 581         obj = (char *)mp + MEMPOOL_HEADER_SIZE(mp, pg_num) +
 582                 private_data_size;
 583
 584         /* populate address translation fields. */
 585         mp->pg_num = pg_num;
 586         mp->pg_shift = pg_shift;
 587         mp->pg_mask = RTE_LEN2MASK(mp->pg_shift, typeof(mp->pg_mask));
 588
 589         /* mempool elements allocated together with mempool */
 590         if (vaddr == NULL) {
 591                 mp->elt_va_start = (uintptr_t)obj;
 592                 mp->elt_pa[0] = mp->phys_addr +
 593                         (mp->elt_va_start - (uintptr_t)mp);
 594
 595         /* mempool elements in a separate chunk of memory. */
 596         } else {
 597                 mp->elt_va_start = (uintptr_t)vaddr;
 598                 memcpy(mp->elt_pa, paddr, sizeof (mp->elt_pa[0]) * pg_num);
 599         }
 600
 601         mp->elt_va_end = mp->elt_va_start;
 602
 603         /* call the initializer */
 604         if (mp_init)
 605                 mp_init(mp, mp_init_arg);
 606
 607         mempool_populate(mp, n, 1, obj_init, obj_init_arg);
 608
 609         te->data = (void *) mp;
 610
 611         rte_rwlock_write_lock(RTE_EAL_TAILQ_RWLOCK);
 612         TAILQ_INSERT_TAIL(mempool_list, te, next);
 613         rte_rwlock_write_unlock(RTE_EAL_TAILQ_RWLOCK);
 614
 615 exit:
 616         rte_rwlock_write_unlock(RTE_EAL_MEMPOOL_RWLOCK);
 617
 618         return mp;
 619 }
 620
 621 /* Return the number of entries in the mempool */
 622 unsigned
 623 rte_mempool_count(const struct rte_mempool *mp)
 624 {
 625         unsigned count;
 626
 627         count = rte_ring_count(mp->ring);
 628
 629 #if RTE_MEMPOOL_CACHE_MAX_SIZE > 0
 630         {
 631                 unsigned lcore_id;
 632                 if (mp->cache_size == 0)
 633                         return count;
 634
 635                 for (lcore_id = 0; lcore_id < RTE_MAX_LCORE; lcore_id++)
 636                         count += mp->local_cache[lcore_id].len;
 637         }
 638 #endif
 639
 640         /*
 641          * due to race condition (access to len is not locked), the
 642          * total can be greater than size... so fix the result
 643          */
 644         if (count > mp->size)
 645                 return mp->size;
 646         return count;
 647 }
 648
 649 /* dump the cache status */
 650 static unsigned
 651 rte_mempool_dump_cache(FILE *f, const struct rte_mempool *mp)
 652 {
 653 #if RTE_MEMPOOL_CACHE_MAX_SIZE > 0
 654         unsigned lcore_id;
 655         unsigned count = 0;
 656         unsigned cache_count;
 657
 658         fprintf(f, "  cache infos:\n");
 659         fprintf(f, "    cache_size=%"PRIu32"\n", mp->cache_size);
 660         for (lcore_id = 0; lcore_id < RTE_MAX_LCORE; lcore_id++) {
 661                 cache_count = mp->local_cache[lcore_id].len;
 662                 fprintf(f, "    cache_count[%u]=%u\n", lcore_id, cache_count);
 663                 count += cache_count;
 664         }
 665         fprintf(f, "    total_cache_count=%u\n", count);
 666         return count;
 667 #else
 668         RTE_SET_USED(mp);
 669         fprintf(f, "  cache disabled\n");
 670         return 0;
 671 #endif
 672 }
 673
 674 #ifdef RTE_LIBRTE_MEMPOOL_DEBUG
 675 /* check cookies before and after objects */
 676 #ifndef __INTEL_COMPILER
 677 #pragma GCC diagnostic ignored "-Wcast-qual"
 678 #endif
 679
 680 struct mempool_audit_arg {
 681         const struct rte_mempool *mp;
 682         uintptr_t obj_end;
 683         uint32_t obj_num;
 684 };
 685
 686 static void
 687 mempool_obj_audit(void *arg, void *start, void *end, uint32_t idx)
 688 {
 689         struct mempool_audit_arg *pa = arg;
 690         void *obj;
 691
 692         obj = (char *)start + pa->mp->header_size;
 693         pa->obj_end = (uintptr_t)end;
 694         pa->obj_num = idx + 1;
 695         __mempool_check_cookies(pa->mp, &obj, 1, 2);
 696 }
 697
 698 static void
 699 mempool_audit_cookies(const struct rte_mempool *mp)
 700 {
 701         uint32_t elt_sz, num;
 702         struct mempool_audit_arg arg;
 703
 704         elt_sz = mp->elt_size + mp->header_size + mp->trailer_size;
 705
 706         arg.mp = mp;
 707         arg.obj_end = mp->elt_va_start;
 708         arg.obj_num = 0;
 709
 710         num = rte_mempool_obj_iter((void *)mp->elt_va_start,
 711                 mp->size, elt_sz, 1,
 712                 mp->elt_pa, mp->pg_num, mp->pg_shift,
 713                 mempool_obj_audit, &arg);
 714
 715         if (num != mp->size) {
 716                         rte_panic("rte_mempool_obj_iter(mempool=%p, size=%u) "
 717                         "iterated only over %u elements\n",
 718                         mp, mp->size, num);
 719         } else if (arg.obj_end != mp->elt_va_end || arg.obj_num != mp->size) {
 720                         rte_panic("rte_mempool_obj_iter(mempool=%p, size=%u) "
 721                         "last callback va_end: %#tx (%#tx expeceted), "
 722                         "num of objects: %u (%u expected)\n",
 723                         mp, mp->size,
 724                         arg.obj_end, mp->elt_va_end,
 725                         arg.obj_num, mp->size);
 726         }
 727 }
 728
 729 #ifndef __INTEL_COMPILER
 730 #pragma GCC diagnostic error "-Wcast-qual"
 731 #endif
 732 #else
 733 #define mempool_audit_cookies(mp) do {} while(0)
 734 #endif
 735
 736 #if RTE_MEMPOOL_CACHE_MAX_SIZE > 0
 737 /* check cookies before and after objects */
 738 static void
 739 mempool_audit_cache(const struct rte_mempool *mp)
 740 {
 741         /* check cache size consistency */
 742         unsigned lcore_id;
 743         for (lcore_id = 0; lcore_id < RTE_MAX_LCORE; lcore_id++) {
 744                 if (mp->local_cache[lcore_id].len > mp->cache_flushthresh) {
 745                         RTE_LOG(CRIT, MEMPOOL, "badness on cache[%u]\n",
 746                                 lcore_id);
 747                         rte_panic("MEMPOOL: invalid cache len\n");
 748                 }
 749         }
 750 }
 751 #else
 752 #define mempool_audit_cache(mp) do {} while(0)
 753 #endif
 754
 755
 756 /* check the consistency of mempool (size, cookies, ...) */
 757 void
 758 rte_mempool_audit(const struct rte_mempool *mp)
 759 {
 760         mempool_audit_cache(mp);
 761         mempool_audit_cookies(mp);
 762
 763         /* For case where mempool DEBUG is not set, and cache size is 0 */
 764         RTE_SET_USED(mp);
 765 }
 766
 767 /* dump the status of the mempool on the console */
 768 void
 769 rte_mempool_dump(FILE *f, const struct rte_mempool *mp)
 770 {
 771 #ifdef RTE_LIBRTE_MEMPOOL_DEBUG
 772         struct rte_mempool_debug_stats sum;
 773         unsigned lcore_id;
 774 #endif
 775         unsigned common_count;
 776         unsigned cache_count;
 777
 778         RTE_VERIFY(f != NULL);
 779         RTE_VERIFY(mp != NULL);
 780
 781         fprintf(f, "mempool <%s>@%p\n", mp->name, mp);
 782         fprintf(f, "  flags=%x\n", mp->flags);
 783         fprintf(f, "  ring=<%s>@%p\n", mp->ring->name, mp->ring);
 784         fprintf(f, "  phys_addr=0x%" PRIx64 "\n", mp->phys_addr);
 785         fprintf(f, "  size=%"PRIu32"\n", mp->size);
 786         fprintf(f, "  header_size=%"PRIu32"\n", mp->header_size);
 787         fprintf(f, "  elt_size=%"PRIu32"\n", mp->elt_size);
 788         fprintf(f, "  trailer_size=%"PRIu32"\n", mp->trailer_size);
 789         fprintf(f, "  total_obj_size=%"PRIu32"\n",
 790                mp->header_size + mp->elt_size + mp->trailer_size);
 791
 792         fprintf(f, "  private_data_size=%"PRIu32"\n", mp->private_data_size);
 793         fprintf(f, "  pg_num=%"PRIu32"\n", mp->pg_num);
 794         fprintf(f, "  pg_shift=%"PRIu32"\n", mp->pg_shift);
 795         fprintf(f, "  pg_mask=%#tx\n", mp->pg_mask);
 796         fprintf(f, "  elt_va_start=%#tx\n", mp->elt_va_start);
 797         fprintf(f, "  elt_va_end=%#tx\n", mp->elt_va_end);
 798         fprintf(f, "  elt_pa[0]=0x%" PRIx64 "\n", mp->elt_pa[0]);
 799
 800         if (mp->size != 0)
 801                 fprintf(f, "  avg bytes/object=%#Lf\n",
 802                         (long double)(mp->elt_va_end - mp->elt_va_start) /
 803                         mp->size);
 804
 805         cache_count = rte_mempool_dump_cache(f, mp);
 806         common_count = rte_ring_count(mp->ring);
 807         if ((cache_count + common_count) > mp->size)
 808                 common_count = mp->size - cache_count;
 809         fprintf(f, "  common_pool_count=%u\n", common_count);
 810
 811         /* sum and dump statistics */
 812 #ifdef RTE_LIBRTE_MEMPOOL_DEBUG
 813         memset(&sum, 0, sizeof(sum));
 814         for (lcore_id = 0; lcore_id < RTE_MAX_LCORE; lcore_id++) {
 815                 sum.put_bulk += mp->stats[lcore_id].put_bulk;
 816                 sum.put_objs += mp->stats[lcore_id].put_objs;
 817                 sum.get_success_bulk += mp->stats[lcore_id].get_success_bulk;
 818                 sum.get_success_objs += mp->stats[lcore_id].get_success_objs;
 819                 sum.get_fail_bulk += mp->stats[lcore_id].get_fail_bulk;
 820                 sum.get_fail_objs += mp->stats[lcore_id].get_fail_objs;
 821         }
 822         fprintf(f, "  stats:\n");
 823         fprintf(f, "    put_bulk=%"PRIu64"\n", sum.put_bulk);
 824         fprintf(f, "    put_objs=%"PRIu64"\n", sum.put_objs);
 825         fprintf(f, "    get_success_bulk=%"PRIu64"\n", sum.get_success_bulk);
 826         fprintf(f, "    get_success_objs=%"PRIu64"\n", sum.get_success_objs);
 827         fprintf(f, "    get_fail_bulk=%"PRIu64"\n", sum.get_fail_bulk);
 828         fprintf(f, "    get_fail_objs=%"PRIu64"\n", sum.get_fail_objs);
 829 #else
 830         fprintf(f, "  no statistics available\n");
 831 #endif
 832
 833         rte_mempool_audit(mp);
 834 }
 835
 836 /* dump the status of all mempools on the console */
 837 void
 838 rte_mempool_list_dump(FILE *f)
 839 {
 840         const struct rte_mempool *mp = NULL;
 841         struct rte_tailq_entry *te;
 842         struct rte_mempool_list *mempool_list;
 843
 844         mempool_list = RTE_TAILQ_CAST(rte_mempool_tailq.head, rte_mempool_list);
 845
 846         rte_rwlock_read_lock(RTE_EAL_MEMPOOL_RWLOCK);
 847
 848         TAILQ_FOREACH(te, mempool_list, next) {
 849                 mp = (struct rte_mempool *) te->data;
 850                 rte_mempool_dump(f, mp);
 851         }
 852
 853         rte_rwlock_read_unlock(RTE_EAL_MEMPOOL_RWLOCK);
 854 }
 855
 856 /* search a mempool from its name */
 857 struct rte_mempool *
 858 rte_mempool_lookup(const char *name)
 859 {
 860         struct rte_mempool *mp = NULL;
 861         struct rte_tailq_entry *te;
 862         struct rte_mempool_list *mempool_list;
 863
 864         mempool_list = RTE_TAILQ_CAST(rte_mempool_tailq.head, rte_mempool_list);
 865
 866         rte_rwlock_read_lock(RTE_EAL_MEMPOOL_RWLOCK);
 867
 868         TAILQ_FOREACH(te, mempool_list, next) {
 869                 mp = (struct rte_mempool *) te->data;
 870                 if (strncmp(name, mp->name, RTE_MEMPOOL_NAMESIZE) == 0)
 871                         break;
 872         }
 873
 874         rte_rwlock_read_unlock(RTE_EAL_MEMPOOL_RWLOCK);
 875
 876         if (te == NULL) {
 877                 rte_errno = ENOENT;
 878                 return NULL;
 879         }
 880
 881         return mp;
 882 }
 883
 884 void rte_mempool_walk(void (*func)(const struct rte_mempool *, void *),
 885                       void *arg)
 886 {
 887         struct rte_tailq_entry *te = NULL;
 888         struct rte_mempool_list *mempool_list;
 889
 890         mempool_list = RTE_TAILQ_CAST(rte_mempool_tailq.head, rte_mempool_list);
 891
 892         rte_rwlock_read_lock(RTE_EAL_MEMPOOL_RWLOCK);
 893
 894         TAILQ_FOREACH(te, mempool_list, next) {
 895                 (*func)((struct rte_mempool *) te->data, arg);
 896         }
 897
 898         rte_rwlock_read_unlock(RTE_EAL_MEMPOOL_RWLOCK);
 899 }