lib/librte_eal/linuxapp/eal/eal_memalloc.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2017-2018 Intel Corporation
   3  */
   4
   5 #define _FILE_OFFSET_BITS 64
   6 #include <errno.h>
   7 #include <stdarg.h>
   8 #include <stdbool.h>
   9 #include <stdlib.h>
  10 #include <stdio.h>
  11 #include <stdint.h>
  12 #include <inttypes.h>
  13 #include <string.h>
  14 #include <sys/mman.h>
  15 #include <sys/types.h>
  16 #include <sys/stat.h>
  17 #include <sys/queue.h>
  18 #include <sys/file.h>
  19 #include <unistd.h>
  20 #include <limits.h>
  21 #include <fcntl.h>
  22 #include <sys/ioctl.h>
  23 #include <sys/time.h>
  24 #include <signal.h>
  25 #include <setjmp.h>
  26 #ifdef RTE_EAL_NUMA_AWARE_HUGEPAGES
  27 #include <numa.h>
  28 #include <numaif.h>
  29 #endif
  30 #include <linux/falloc.h>
  31
  32 #include <rte_common.h>
  33 #include <rte_log.h>
  34 #include <rte_eal_memconfig.h>
  35 #include <rte_eal.h>
  36 #include <rte_memory.h>
  37 #include <rte_spinlock.h>
  38
  39 #include "eal_filesystem.h"
  40 #include "eal_internal_cfg.h"
  41 #include "eal_memalloc.h"
  42
  43 /*
  44  * not all kernel version support fallocate on hugetlbfs, so fall back to
  45  * ftruncate and disallow deallocation if fallocate is not supported.
  46  */
  47 static int fallocate_supported = -1; /* unknown */
  48
  49 /*
  50  * If each page is in a separate file, we can close fd's since we need each fd
  51  * only once. However, in single file segments mode, we can get away with using
  52  * a single fd for entire segments, but we need to store them somewhere. Each
  53  * fd is different within each process, so we'll store them in a local tailq.
  54  */
  55 struct msl_entry {
  56         TAILQ_ENTRY(msl_entry) next;
  57         unsigned int msl_idx;
  58         int fd;
  59 };
  60
  61 /** Double linked list of memseg list fd's. */
  62 TAILQ_HEAD(msl_entry_list, msl_entry);
  63
  64 static struct msl_entry_list msl_entry_list =
  65                 TAILQ_HEAD_INITIALIZER(msl_entry_list);
  66 static rte_spinlock_t tailq_lock = RTE_SPINLOCK_INITIALIZER;
  67
  68 /** local copy of a memory map, used to synchronize memory hotplug in MP */
  69 static struct rte_memseg_list local_memsegs[RTE_MAX_MEMSEG_LISTS];
  70
  71 static sigjmp_buf huge_jmpenv;
  72
  73 static void __rte_unused huge_sigbus_handler(int signo __rte_unused)
  74 {
  75         siglongjmp(huge_jmpenv, 1);
  76 }
  77
  78 /* Put setjmp into a wrap method to avoid compiling error. Any non-volatile,
  79  * non-static local variable in the stack frame calling sigsetjmp might be
  80  * clobbered by a call to longjmp.
  81  */
  82 static int __rte_unused huge_wrap_sigsetjmp(void)
  83 {
  84         return sigsetjmp(huge_jmpenv, 1);
  85 }
  86
  87 static struct sigaction huge_action_old;
  88 static int huge_need_recover;
  89
  90 static void __rte_unused
  91 huge_register_sigbus(void)
  92 {
  93         sigset_t mask;
  94         struct sigaction action;
  95
  96         sigemptyset(&mask);
  97         sigaddset(&mask, SIGBUS);
  98         action.sa_flags = 0;
  99         action.sa_mask = mask;
 100         action.sa_handler = huge_sigbus_handler;
 101
 102         huge_need_recover = !sigaction(SIGBUS, &action, &huge_action_old);
 103 }
 104
 105 static void __rte_unused
 106 huge_recover_sigbus(void)
 107 {
 108         if (huge_need_recover) {
 109                 sigaction(SIGBUS, &huge_action_old, NULL);
 110                 huge_need_recover = 0;
 111         }
 112 }
 113
 114 #ifdef RTE_EAL_NUMA_AWARE_HUGEPAGES
 115 static bool
 116 check_numa(void)
 117 {
 118         bool ret = true;
 119         /* Check if kernel supports NUMA. */
 120         if (numa_available() != 0) {
 121                 RTE_LOG(DEBUG, EAL, "NUMA is not supported.\n");
 122                 ret = false;
 123         }
 124         return ret;
 125 }
 126
 127 static void
 128 prepare_numa(int *oldpolicy, struct bitmask *oldmask, int socket_id)
 129 {
 130         RTE_LOG(DEBUG, EAL, "Trying to obtain current memory policy.\n");
 131         if (get_mempolicy(oldpolicy, oldmask->maskp,
 132                           oldmask->size + 1, 0, 0) < 0) {
 133                 RTE_LOG(ERR, EAL,
 134                         "Failed to get current mempolicy: %s. "
 135                         "Assuming MPOL_DEFAULT.\n", strerror(errno));
 136                 oldpolicy = MPOL_DEFAULT;
 137         }
 138         RTE_LOG(DEBUG, EAL,
 139                 "Setting policy MPOL_PREFERRED for socket %d\n",
 140                 socket_id);
 141         numa_set_preferred(socket_id);
 142 }
 143
 144 static void
 145 resotre_numa(int *oldpolicy, struct bitmask *oldmask)
 146 {
 147         RTE_LOG(DEBUG, EAL,
 148                 "Restoring previous memory policy: %d\n", *oldpolicy);
 149         if (oldpolicy == MPOL_DEFAULT) {
 150                 numa_set_localalloc();
 151         } else if (set_mempolicy(*oldpolicy, oldmask->maskp,
 152                                  oldmask->size + 1) < 0) {
 153                 RTE_LOG(ERR, EAL, "Failed to restore mempolicy: %s\n",
 154                         strerror(errno));
 155                 numa_set_localalloc();
 156         }
 157         numa_free_cpumask(oldmask);
 158 }
 159 #endif
 160
 161 static struct msl_entry *
 162 get_msl_entry_by_idx(unsigned int list_idx)
 163 {
 164         struct msl_entry *te;
 165
 166         rte_spinlock_lock(&tailq_lock);
 167
 168         TAILQ_FOREACH(te, &msl_entry_list, next) {
 169                 if (te->msl_idx == list_idx)
 170                         break;
 171         }
 172         if (te == NULL) {
 173                 /* doesn't exist, so create it and set fd to -1 */
 174
 175                 te = malloc(sizeof(*te));
 176                 if (te == NULL) {
 177                         RTE_LOG(ERR, EAL, "%s(): cannot allocate tailq entry for memseg list\n",
 178                                 __func__);
 179                         goto unlock;
 180                 }
 181                 te->msl_idx = list_idx;
 182                 te->fd = -1;
 183                 TAILQ_INSERT_TAIL(&msl_entry_list, te, next);
 184         }
 185 unlock:
 186         rte_spinlock_unlock(&tailq_lock);
 187         return te;
 188 }
 189
 190 /*
 191  * uses fstat to report the size of a file on disk
 192  */
 193 static off_t
 194 get_file_size(int fd)
 195 {
 196         struct stat st;
 197         if (fstat(fd, &st) < 0)
 198                 return 0;
 199         return st.st_size;
 200 }
 201
 202 /*
 203  * uses fstat to check if file size on disk is zero (regular fstat won't show
 204  * true file size due to how fallocate works)
 205  */
 206 static bool
 207 is_zero_length(int fd)
 208 {
 209         struct stat st;
 210         if (fstat(fd, &st) < 0)
 211                 return false;
 212         return st.st_blocks == 0;
 213 }
 214
 215 /* we cannot use rte_memseg_list_walk() here because we will be holding a
 216  * write lock whenever we enter every function in this file, however copying
 217  * the same iteration code everywhere is not ideal as well. so, use a lockless
 218  * copy of memseg list walk here.
 219  */
 220 static int
 221 memseg_list_walk_thread_unsafe(rte_memseg_list_walk_t func, void *arg)
 222 {
 223         struct rte_mem_config *mcfg = rte_eal_get_configuration()->mem_config;
 224         int i, ret = 0;
 225
 226         for (i = 0; i < RTE_MAX_MEMSEG_LISTS; i++) {
 227                 struct rte_memseg_list *msl = &mcfg->memsegs[i];
 228
 229                 if (msl->base_va == NULL)
 230                         continue;
 231
 232                 ret = func(msl, arg);
 233                 if (ret < 0)
 234                         return -1;
 235                 if (ret > 0)
 236                         return 1;
 237         }
 238         return 0;
 239 }
 240
 241 static int
 242 get_seg_fd(char *path, int buflen, struct hugepage_info *hi,
 243                 unsigned int list_idx, unsigned int seg_idx)
 244 {
 245         int fd;
 246
 247         if (internal_config.single_file_segments) {
 248                 /*
 249                  * try to find a tailq entry, for this memseg list, or create
 250                  * one if it doesn't exist.
 251                  */
 252                 struct msl_entry *te = get_msl_entry_by_idx(list_idx);
 253                 if (te == NULL) {
 254                         RTE_LOG(ERR, EAL, "%s(): cannot allocate tailq entry for memseg list\n",
 255                                 __func__);
 256                         return -1;
 257                 } else if (te->fd < 0) {
 258                         /* create a hugepage file */
 259                         eal_get_hugefile_path(path, buflen, hi->hugedir,
 260                                         list_idx);
 261                         fd = open(path, O_CREAT | O_RDWR, 0600);
 262                         if (fd < 0) {
 263                                 RTE_LOG(DEBUG, EAL, "%s(): open failed: %s\n",
 264                                         __func__, strerror(errno));
 265                                 return -1;
 266                         }
 267                         te->fd = fd;
 268                 } else {
 269                         fd = te->fd;
 270                 }
 271         } else {
 272                 /* one file per page, just create it */
 273                 eal_get_hugefile_path(path, buflen, hi->hugedir,
 274                                 list_idx * RTE_MAX_MEMSEG_PER_LIST + seg_idx);
 275                 fd = open(path, O_CREAT | O_RDWR, 0600);
 276                 if (fd < 0) {
 277                         RTE_LOG(DEBUG, EAL, "%s(): open failed: %s\n", __func__,
 278                                         strerror(errno));
 279                         return -1;
 280                 }
 281         }
 282         return fd;
 283 }
 284
 285 /* returns 1 on successful lock, 0 on unsuccessful lock, -1 on error */
 286 static int lock(int fd, uint64_t offset, uint64_t len, int type)
 287 {
 288         struct flock lck;
 289         int ret;
 290
 291         memset(&lck, 0, sizeof(lck));
 292
 293         lck.l_type = type;
 294         lck.l_whence = SEEK_SET;
 295         lck.l_start = offset;
 296         lck.l_len = len;
 297
 298         ret = fcntl(fd, F_SETLK, &lck);
 299
 300         if (ret && (errno == EAGAIN || errno == EACCES)) {
 301                 /* locked by another process, not an error */
 302                 return 0;
 303         } else if (ret) {
 304                 RTE_LOG(ERR, EAL, "%s(): error calling fcntl(): %s\n",
 305                         __func__, strerror(errno));
 306                 /* we've encountered an unexpected error */
 307                 return -1;
 308         }
 309         return 1;
 310 }
 311
 312 static int
 313 resize_hugefile(int fd, uint64_t fa_offset, uint64_t page_sz,
 314                 bool grow)
 315 {
 316         bool again = false;
 317         do {
 318                 if (fallocate_supported == 0) {
 319                         /* we cannot deallocate memory if fallocate() is not
 320                          * supported, but locks are still needed to prevent
 321                          * primary process' initialization from clearing out
 322                          * huge pages used by this process.
 323                          */
 324
 325                         if (!grow) {
 326                                 RTE_LOG(DEBUG, EAL, "%s(): fallocate not supported, not freeing page back to the system\n",
 327                                         __func__);
 328                                 return -1;
 329                         }
 330                         uint64_t new_size = fa_offset + page_sz;
 331                         uint64_t cur_size = get_file_size(fd);
 332
 333                         /* fallocate isn't supported, fall back to ftruncate */
 334                         if (new_size > cur_size &&
 335                                         ftruncate(fd, new_size) < 0) {
 336                                 RTE_LOG(DEBUG, EAL, "%s(): ftruncate() failed: %s\n",
 337                                         __func__, strerror(errno));
 338                                 return -1;
 339                         }
 340                         /* not being able to take out a read lock is an error */
 341                         if (lock(fd, fa_offset, page_sz, F_RDLCK) != 1)
 342                                 return -1;
 343                 } else {
 344                         int flags = grow ? 0 : FALLOC_FL_PUNCH_HOLE |
 345                                         FALLOC_FL_KEEP_SIZE;
 346                         int ret;
 347
 348                         /* if fallocate() is supported, we need to take out a
 349                          * read lock on allocate (to prevent other processes
 350                          * from deallocating this page), and take out a write
 351                          * lock on deallocate (to ensure nobody else is using
 352                          * this page).
 353                          *
 354                          * we can't use flock() for this, as we actually need to
 355                          * lock part of the file, not the entire file.
 356                          */
 357
 358                         if (!grow) {
 359                                 ret = lock(fd, fa_offset, page_sz, F_WRLCK);
 360
 361                                 if (ret < 0)
 362                                         return -1;
 363                                 else if (ret == 0)
 364                                         /* failed to lock, not an error */
 365                                         return 0;
 366                         }
 367                         if (fallocate(fd, flags, fa_offset, page_sz) < 0) {
 368                                 if (fallocate_supported == -1 &&
 369                                                 errno == ENOTSUP) {
 370                                         RTE_LOG(ERR, EAL, "%s(): fallocate() not supported, hugepage deallocation will be disabled\n",
 371                                                 __func__);
 372                                         again = true;
 373                                         fallocate_supported = 0;
 374                                 } else {
 375                                         RTE_LOG(DEBUG, EAL, "%s(): fallocate() failed: %s\n",
 376                                                 __func__,
 377                                                 strerror(errno));
 378                                         return -1;
 379                                 }
 380                         } else {
 381                                 fallocate_supported = 1;
 382
 383                                 if (grow) {
 384                                         /* if can't read lock, it's an error */
 385                                         if (lock(fd, fa_offset, page_sz,
 386                                                         F_RDLCK) != 1)
 387                                                 return -1;
 388                                 } else {
 389                                         /* if can't unlock, it's an error */
 390                                         if (lock(fd, fa_offset, page_sz,
 391                                                         F_UNLCK) != 1)
 392                                                 return -1;
 393                                 }
 394                         }
 395                 }
 396         } while (again);
 397         return 0;
 398 }
 399
 400 static int
 401 alloc_seg(struct rte_memseg *ms, void *addr, int socket_id,
 402                 struct hugepage_info *hi, unsigned int list_idx,
 403                 unsigned int seg_idx)
 404 {
 405 #ifdef RTE_EAL_NUMA_AWARE_HUGEPAGES
 406         int cur_socket_id = 0;
 407 #endif
 408         uint64_t map_offset;
 409         char path[PATH_MAX];
 410         int ret = 0;
 411         int fd;
 412         size_t alloc_sz;
 413
 414         fd = get_seg_fd(path, sizeof(path), hi, list_idx, seg_idx);
 415         if (fd < 0)
 416                 return -1;
 417
 418         alloc_sz = hi->hugepage_sz;
 419         if (internal_config.single_file_segments) {
 420                 map_offset = seg_idx * alloc_sz;
 421                 ret = resize_hugefile(fd, map_offset, alloc_sz, true);
 422                 if (ret < 1)
 423                         goto resized;
 424         } else {
 425                 map_offset = 0;
 426                 if (ftruncate(fd, alloc_sz) < 0) {
 427                         RTE_LOG(DEBUG, EAL, "%s(): ftruncate() failed: %s\n",
 428                                 __func__, strerror(errno));
 429                         goto resized;
 430                 }
 431                 /* we've allocated a page - take out a read lock. we're using
 432                  * fcntl() locks rather than flock() here because doing that
 433                  * gives us one huge advantage - fcntl() locks are per-process,
 434                  * not per-file descriptor, which means that we don't have to
 435                  * keep the original fd's around to keep a lock on the file.
 436                  *
 437                  * this is useful, because when it comes to unmapping pages, we
 438                  * will have to take out a write lock (to figure out if another
 439                  * process still has this page mapped), and to do itwith flock()
 440                  * we'll have to use original fd, as lock is associated with
 441                  * that particular fd. with fcntl(), this is not necessary - we
 442                  * can open a new fd and use fcntl() on that.
 443                  */
 444                 ret = lock(fd, map_offset, alloc_sz, F_RDLCK);
 445
 446                 /* this should not fail */
 447                 if (ret != 1) {
 448                         RTE_LOG(ERR, EAL, "%s(): error locking file: %s\n",
 449                                 __func__,
 450                                 strerror(errno));
 451                         goto resized;
 452                 }
 453         }
 454
 455         /*
 456          * map the segment, and populate page tables, the kernel fills this
 457          * segment with zeros if it's a new page.
 458          */
 459         void *va = mmap(addr, alloc_sz, PROT_READ | PROT_WRITE,
 460                         MAP_SHARED | MAP_POPULATE | MAP_FIXED, fd, map_offset);
 461         /* for non-single file segments, we can close fd here */
 462         if (!internal_config.single_file_segments)
 463                 close(fd);
 464
 465         if (va == MAP_FAILED) {
 466                 RTE_LOG(DEBUG, EAL, "%s(): mmap() failed: %s\n", __func__,
 467                         strerror(errno));
 468                 goto resized;
 469         }
 470         if (va != addr) {
 471                 RTE_LOG(DEBUG, EAL, "%s(): wrong mmap() address\n", __func__);
 472                 goto mapped;
 473         }
 474
 475         rte_iova_t iova = rte_mem_virt2iova(addr);
 476         if (iova == RTE_BAD_PHYS_ADDR) {
 477                 RTE_LOG(DEBUG, EAL, "%s(): can't get IOVA addr\n",
 478                         __func__);
 479                 goto mapped;
 480         }
 481
 482 #ifdef RTE_EAL_NUMA_AWARE_HUGEPAGES
 483         move_pages(getpid(), 1, &addr, NULL, &cur_socket_id, 0);
 484
 485         if (cur_socket_id != socket_id) {
 486                 RTE_LOG(DEBUG, EAL,
 487                                 "%s(): allocation happened on wrong socket (wanted %d, got %d)\n",
 488                         __func__, socket_id, cur_socket_id);
 489                 goto mapped;
 490         }
 491 #endif
 492
 493         /* In linux, hugetlb limitations, like cgroup, are
 494          * enforced at fault time instead of mmap(), even
 495          * with the option of MAP_POPULATE. Kernel will send
 496          * a SIGBUS signal. To avoid to be killed, save stack
 497          * environment here, if SIGBUS happens, we can jump
 498          * back here.
 499          */
 500         if (huge_wrap_sigsetjmp()) {
 501                 RTE_LOG(DEBUG, EAL, "SIGBUS: Cannot mmap more hugepages of size %uMB\n",
 502                         (unsigned int)(alloc_sz >> 20));
 503                 goto mapped;
 504         }
 505         *(int *)addr = *(int *)addr;
 506
 507         ms->addr = addr;
 508         ms->hugepage_sz = alloc_sz;
 509         ms->len = alloc_sz;
 510         ms->nchannel = rte_memory_get_nchannel();
 511         ms->nrank = rte_memory_get_nrank();
 512         ms->iova = iova;
 513         ms->socket_id = socket_id;
 514
 515         return 0;
 516
 517 mapped:
 518         munmap(addr, alloc_sz);
 519 resized:
 520         if (internal_config.single_file_segments) {
 521                 resize_hugefile(fd, map_offset, alloc_sz, false);
 522                 if (is_zero_length(fd)) {
 523                         struct msl_entry *te = get_msl_entry_by_idx(list_idx);
 524                         if (te != NULL && te->fd >= 0) {
 525                                 close(te->fd);
 526                                 te->fd = -1;
 527                         }
 528                         /* ignore errors, can't make it any worse */
 529                         unlink(path);
 530                 }
 531         } else {
 532                 close(fd);
 533                 unlink(path);
 534         }
 535         return -1;
 536 }
 537
 538 static int
 539 free_seg(struct rte_memseg *ms, struct hugepage_info *hi,
 540                 unsigned int list_idx, unsigned int seg_idx)
 541 {
 542         uint64_t map_offset;
 543         char path[PATH_MAX];
 544         int fd, ret;
 545
 546         /* erase page data */
 547         memset(ms->addr, 0, ms->len);
 548
 549         if (mmap(ms->addr, ms->len, PROT_READ,
 550                         MAP_PRIVATE | MAP_ANONYMOUS | MAP_FIXED, -1, 0) ==
 551                                 MAP_FAILED) {
 552                 RTE_LOG(DEBUG, EAL, "couldn't unmap page\n");
 553                 return -1;
 554         }
 555
 556         fd = get_seg_fd(path, sizeof(path), hi, list_idx, seg_idx);
 557         if (fd < 0)
 558                 return -1;
 559
 560         if (internal_config.single_file_segments) {
 561                 map_offset = seg_idx * ms->len;
 562                 if (resize_hugefile(fd, map_offset, ms->len, false))
 563                         return -1;
 564                 /* if file is zero-length, we've already shrunk it, so it's
 565                  * safe to remove.
 566                  */
 567                 if (is_zero_length(fd)) {
 568                         struct msl_entry *te = get_msl_entry_by_idx(list_idx);
 569                         if (te != NULL && te->fd >= 0) {
 570                                 close(te->fd);
 571                                 te->fd = -1;
 572                         }
 573                         unlink(path);
 574                 }
 575                 ret = 0;
 576         } else {
 577                 /* if we're able to take out a write lock, we're the last one
 578                  * holding onto this page.
 579                  */
 580
 581                 ret = lock(fd, 0, ms->len, F_WRLCK);
 582                 if (ret >= 0) {
 583                         /* no one else is using this page */
 584                         if (ret == 1)
 585                                 unlink(path);
 586                         ret = lock(fd, 0, ms->len, F_UNLCK);
 587                         if (ret != 1)
 588                                 RTE_LOG(ERR, EAL, "%s(): unable to unlock file %s\n",
 589                                         __func__, path);
 590                 }
 591                 close(fd);
 592         }
 593
 594         memset(ms, 0, sizeof(*ms));
 595
 596         return ret;
 597 }
 598
 599 struct alloc_walk_param {
 600         struct hugepage_info *hi;
 601         struct rte_memseg **ms;
 602         size_t page_sz;
 603         unsigned int segs_allocated;
 604         unsigned int n_segs;
 605         int socket;
 606         bool exact;
 607 };
 608 static int
 609 alloc_seg_walk(const struct rte_memseg_list *msl, void *arg)
 610 {
 611         struct rte_mem_config *mcfg = rte_eal_get_configuration()->mem_config;
 612         struct alloc_walk_param *wa = arg;
 613         struct rte_memseg_list *cur_msl;
 614         size_t page_sz;
 615         int cur_idx, start_idx, j;
 616         unsigned int msl_idx, need, i;
 617
 618         if (msl->page_sz != wa->page_sz)
 619                 return 0;
 620         if (msl->socket_id != wa->socket)
 621                 return 0;
 622
 623         page_sz = (size_t)msl->page_sz;
 624
 625         msl_idx = msl - mcfg->memsegs;
 626         cur_msl = &mcfg->memsegs[msl_idx];
 627
 628         need = wa->n_segs;
 629
 630         /* try finding space in memseg list */
 631         cur_idx = rte_fbarray_find_next_n_free(&cur_msl->memseg_arr, 0, need);
 632         if (cur_idx < 0)
 633                 return 0;
 634         start_idx = cur_idx;
 635
 636         for (i = 0; i < need; i++, cur_idx++) {
 637                 struct rte_memseg *cur;
 638                 void *map_addr;
 639
 640                 cur = rte_fbarray_get(&cur_msl->memseg_arr, cur_idx);
 641                 map_addr = RTE_PTR_ADD(cur_msl->base_va,
 642                                 cur_idx * page_sz);
 643
 644                 if (alloc_seg(cur, map_addr, wa->socket, wa->hi,
 645                                 msl_idx, cur_idx)) {
 646                         RTE_LOG(DEBUG, EAL, "attempted to allocate %i segments, but only %i were allocated\n",
 647                                 need, i);
 648
 649                         /* if exact number wasn't requested, stop */
 650                         if (!wa->exact)
 651                                 goto out;
 652
 653                         /* clean up */
 654                         for (j = start_idx; j < cur_idx; j++) {
 655                                 struct rte_memseg *tmp;
 656                                 struct rte_fbarray *arr =
 657                                                 &cur_msl->memseg_arr;
 658
 659                                 tmp = rte_fbarray_get(arr, j);
 660                                 if (free_seg(tmp, wa->hi, msl_idx,
 661                                                 start_idx + j)) {
 662                                         RTE_LOG(ERR, EAL, "Cannot free page\n");
 663                                         continue;
 664                                 }
 665
 666                                 rte_fbarray_set_free(arr, j);
 667                         }
 668                         /* clear the list */
 669                         if (wa->ms)
 670                                 memset(wa->ms, 0, sizeof(*wa->ms) * wa->n_segs);
 671                         return -1;
 672                 }
 673                 if (wa->ms)
 674                         wa->ms[i] = cur;
 675
 676                 rte_fbarray_set_used(&cur_msl->memseg_arr, cur_idx);
 677         }
 678 out:
 679         wa->segs_allocated = i;
 680         if (i > 0)
 681                 cur_msl->version++;
 682         return 1;
 683 }
 684
 685 struct free_walk_param {
 686         struct hugepage_info *hi;
 687         struct rte_memseg *ms;
 688 };
 689 static int
 690 free_seg_walk(const struct rte_memseg_list *msl, void *arg)
 691 {
 692         struct rte_mem_config *mcfg = rte_eal_get_configuration()->mem_config;
 693         struct rte_memseg_list *found_msl;
 694         struct free_walk_param *wa = arg;
 695         uintptr_t start_addr, end_addr;
 696         int msl_idx, seg_idx;
 697
 698         start_addr = (uintptr_t) msl->base_va;
 699         end_addr = start_addr + msl->memseg_arr.len * (size_t)msl->page_sz;
 700
 701         if ((uintptr_t)wa->ms->addr < start_addr ||
 702                         (uintptr_t)wa->ms->addr >= end_addr)
 703                 return 0;
 704
 705         msl_idx = msl - mcfg->memsegs;
 706         seg_idx = RTE_PTR_DIFF(wa->ms->addr, start_addr) / msl->page_sz;
 707
 708         /* msl is const */
 709         found_msl = &mcfg->memsegs[msl_idx];
 710
 711         found_msl->version++;
 712
 713         rte_fbarray_set_free(&found_msl->memseg_arr, seg_idx);
 714
 715         if (free_seg(wa->ms, wa->hi, msl_idx, seg_idx))
 716                 return -1;
 717
 718         return 1;
 719 }
 720
 721 int
 722 eal_memalloc_alloc_seg_bulk(struct rte_memseg **ms, int n_segs, size_t page_sz,
 723                 int socket, bool exact)
 724 {
 725         int i, ret = -1;
 726 #ifdef RTE_EAL_NUMA_AWARE_HUGEPAGES
 727         bool have_numa = false;
 728         int oldpolicy;
 729         struct bitmask *oldmask;
 730 #endif
 731         struct alloc_walk_param wa;
 732         struct hugepage_info *hi = NULL;
 733
 734         memset(&wa, 0, sizeof(wa));
 735
 736         /* dynamic allocation not supported in legacy mode */
 737         if (internal_config.legacy_mem)
 738                 return -1;
 739
 740         for (i = 0; i < (int) RTE_DIM(internal_config.hugepage_info); i++) {
 741                 if (page_sz ==
 742                                 internal_config.hugepage_info[i].hugepage_sz) {
 743                         hi = &internal_config.hugepage_info[i];
 744                         break;
 745                 }
 746         }
 747         if (!hi) {
 748                 RTE_LOG(ERR, EAL, "%s(): can't find relevant hugepage_info entry\n",
 749                         __func__);
 750                 return -1;
 751         }
 752
 753 #ifdef RTE_EAL_NUMA_AWARE_HUGEPAGES
 754         if (check_numa()) {
 755                 oldmask = numa_allocate_nodemask();
 756                 prepare_numa(&oldpolicy, oldmask, socket);
 757                 have_numa = true;
 758         }
 759 #endif
 760
 761         wa.exact = exact;
 762         wa.hi = hi;
 763         wa.ms = ms;
 764         wa.n_segs = n_segs;
 765         wa.page_sz = page_sz;
 766         wa.socket = socket;
 767         wa.segs_allocated = 0;
 768
 769         ret = memseg_list_walk_thread_unsafe(alloc_seg_walk, &wa);
 770         if (ret == 0) {
 771                 RTE_LOG(ERR, EAL, "%s(): couldn't find suitable memseg_list\n",
 772                         __func__);
 773                 ret = -1;
 774         } else if (ret > 0) {
 775                 ret = (int)wa.segs_allocated;
 776         }
 777
 778 #ifdef RTE_EAL_NUMA_AWARE_HUGEPAGES
 779         if (have_numa)
 780                 resotre_numa(&oldpolicy, oldmask);
 781 #endif
 782         return ret;
 783 }
 784
 785 struct rte_memseg *
 786 eal_memalloc_alloc_seg(size_t page_sz, int socket)
 787 {
 788         struct rte_memseg *ms;
 789         if (eal_memalloc_alloc_seg_bulk(&ms, 1, page_sz, socket, true) < 0)
 790                 return NULL;
 791         /* return pointer to newly allocated memseg */
 792         return ms;
 793 }
 794
 795 int
 796 eal_memalloc_free_seg_bulk(struct rte_memseg **ms, int n_segs)
 797 {
 798         int seg, ret = 0;
 799
 800         /* dynamic free not supported in legacy mode */
 801         if (internal_config.legacy_mem)
 802                 return -1;
 803
 804         for (seg = 0; seg < n_segs; seg++) {
 805                 struct rte_memseg *cur = ms[seg];
 806                 struct hugepage_info *hi = NULL;
 807                 struct free_walk_param wa;
 808                 int i, walk_res;
 809
 810                 memset(&wa, 0, sizeof(wa));
 811
 812                 for (i = 0; i < (int)RTE_DIM(internal_config.hugepage_info);
 813                                 i++) {
 814                         hi = &internal_config.hugepage_info[i];
 815                         if (cur->hugepage_sz == hi->hugepage_sz)
 816                                 break;
 817                 }
 818                 if (i == (int)RTE_DIM(internal_config.hugepage_info)) {
 819                         RTE_LOG(ERR, EAL, "Can't find relevant hugepage_info entry\n");
 820                         ret = -1;
 821                         continue;
 822                 }
 823
 824                 wa.ms = cur;
 825                 wa.hi = hi;
 826
 827                 walk_res = memseg_list_walk_thread_unsafe(free_seg_walk, &wa);
 828                 if (walk_res == 1)
 829                         continue;
 830                 if (walk_res == 0)
 831                         RTE_LOG(ERR, EAL, "Couldn't find memseg list\n");
 832                 ret = -1;
 833         }
 834         return ret;
 835 }
 836
 837 int
 838 eal_memalloc_free_seg(struct rte_memseg *ms)
 839 {
 840         /* dynamic free not supported in legacy mode */
 841         if (internal_config.legacy_mem)
 842                 return -1;
 843
 844         return eal_memalloc_free_seg_bulk(&ms, 1);
 845 }
 846
 847 static int
 848 sync_chunk(struct rte_memseg_list *primary_msl,
 849                 struct rte_memseg_list *local_msl, struct hugepage_info *hi,
 850                 unsigned int msl_idx, bool used, int start, int end)
 851 {
 852         struct rte_fbarray *l_arr, *p_arr;
 853         int i, ret, chunk_len, diff_len;
 854
 855         l_arr = &local_msl->memseg_arr;
 856         p_arr = &primary_msl->memseg_arr;
 857
 858         /* we need to aggregate allocations/deallocations into bigger chunks,
 859          * as we don't want to spam the user with per-page callbacks.
 860          *
 861          * to avoid any potential issues, we also want to trigger
 862          * deallocation callbacks *before* we actually deallocate
 863          * memory, so that the user application could wrap up its use
 864          * before it goes away.
 865          */
 866
 867         chunk_len = end - start;
 868
 869         /* find how many contiguous pages we can map/unmap for this chunk */
 870         diff_len = used ?
 871                         rte_fbarray_find_contig_free(l_arr, start) :
 872                         rte_fbarray_find_contig_used(l_arr, start);
 873
 874         /* has to be at least one page */
 875         if (diff_len < 1)
 876                 return -1;
 877
 878         diff_len = RTE_MIN(chunk_len, diff_len);
 879
 880         /* if we are freeing memory, notify the application */
 881         if (!used) {
 882                 struct rte_memseg *ms;
 883                 void *start_va;
 884                 size_t len, page_sz;
 885
 886                 ms = rte_fbarray_get(l_arr, start);
 887                 start_va = ms->addr;
 888                 page_sz = (size_t)primary_msl->page_sz;
 889                 len = page_sz * diff_len;
 890
 891                 eal_memalloc_mem_event_notify(RTE_MEM_EVENT_FREE,
 892                                 start_va, len);
 893         }
 894
 895         for (i = 0; i < diff_len; i++) {
 896                 struct rte_memseg *p_ms, *l_ms;
 897                 int seg_idx = start + i;
 898
 899                 l_ms = rte_fbarray_get(l_arr, seg_idx);
 900                 p_ms = rte_fbarray_get(p_arr, seg_idx);
 901
 902                 if (l_ms == NULL || p_ms == NULL)
 903                         return -1;
 904
 905                 if (used) {
 906                         ret = alloc_seg(l_ms, p_ms->addr,
 907                                         p_ms->socket_id, hi,
 908                                         msl_idx, seg_idx);
 909                         if (ret < 0)
 910                                 return -1;
 911                         rte_fbarray_set_used(l_arr, seg_idx);
 912                 } else {
 913                         ret = free_seg(l_ms, hi, msl_idx, seg_idx);
 914                         rte_fbarray_set_free(l_arr, seg_idx);
 915                         if (ret < 0)
 916                                 return -1;
 917                 }
 918         }
 919
 920         /* if we just allocated memory, notify the application */
 921         if (used) {
 922                 struct rte_memseg *ms;
 923                 void *start_va;
 924                 size_t len, page_sz;
 925
 926                 ms = rte_fbarray_get(l_arr, start);
 927                 start_va = ms->addr;
 928                 page_sz = (size_t)primary_msl->page_sz;
 929                 len = page_sz * diff_len;
 930
 931                 eal_memalloc_mem_event_notify(RTE_MEM_EVENT_ALLOC,
 932                                 start_va, len);
 933         }
 934
 935         /* calculate how much we can advance until next chunk */
 936         diff_len = used ?
 937                         rte_fbarray_find_contig_used(l_arr, start) :
 938                         rte_fbarray_find_contig_free(l_arr, start);
 939         ret = RTE_MIN(chunk_len, diff_len);
 940
 941         return ret;
 942 }
 943
 944 static int
 945 sync_status(struct rte_memseg_list *primary_msl,
 946                 struct rte_memseg_list *local_msl, struct hugepage_info *hi,
 947                 unsigned int msl_idx, bool used)
 948 {
 949         struct rte_fbarray *l_arr, *p_arr;
 950         int p_idx, l_chunk_len, p_chunk_len, ret;
 951         int start, end;
 952
 953         /* this is a little bit tricky, but the basic idea is - walk both lists
 954          * and spot any places where there are discrepancies. walking both lists
 955          * and noting discrepancies in a single go is a hard problem, so we do
 956          * it in two passes - first we spot any places where allocated segments
 957          * mismatch (i.e. ensure that everything that's allocated in the primary
 958          * is also allocated in the secondary), and then we do it by looking at
 959          * free segments instead.
 960          *
 961          * we also need to aggregate changes into chunks, as we have to call
 962          * callbacks per allocation, not per page.
 963          */
 964         l_arr = &local_msl->memseg_arr;
 965         p_arr = &primary_msl->memseg_arr;
 966
 967         if (used)
 968                 p_idx = rte_fbarray_find_next_used(p_arr, 0);
 969         else
 970                 p_idx = rte_fbarray_find_next_free(p_arr, 0);
 971
 972         while (p_idx >= 0) {
 973                 int next_chunk_search_idx;
 974
 975                 if (used) {
 976                         p_chunk_len = rte_fbarray_find_contig_used(p_arr,
 977                                         p_idx);
 978                         l_chunk_len = rte_fbarray_find_contig_used(l_arr,
 979                                         p_idx);
 980                 } else {
 981                         p_chunk_len = rte_fbarray_find_contig_free(p_arr,
 982                                         p_idx);
 983                         l_chunk_len = rte_fbarray_find_contig_free(l_arr,
 984                                         p_idx);
 985                 }
 986                 /* best case scenario - no differences (or bigger, which will be
 987                  * fixed during next iteration), look for next chunk
 988                  */
 989                 if (l_chunk_len >= p_chunk_len) {
 990                         next_chunk_search_idx = p_idx + p_chunk_len;
 991                         goto next_chunk;
 992                 }
 993
 994                 /* if both chunks start at the same point, skip parts we know
 995                  * are identical, and sync the rest. each call to sync_chunk
 996                  * will only sync contiguous segments, so we need to call this
 997                  * until we are sure there are no more differences in this
 998                  * chunk.
 999                  */
1000                 start = p_idx + l_chunk_len;
1001                 end = p_idx + p_chunk_len;
1002                 do {
1003                         ret = sync_chunk(primary_msl, local_msl, hi, msl_idx,
1004                                         used, start, end);
1005                         start += ret;
1006                 } while (start < end && ret >= 0);
1007                 /* if ret is negative, something went wrong */
1008                 if (ret < 0)
1009                         return -1;
1010
1011                 next_chunk_search_idx = p_idx + p_chunk_len;
1012 next_chunk:
1013                 /* skip to end of this chunk */
1014                 if (used) {
1015                         p_idx = rte_fbarray_find_next_used(p_arr,
1016                                         next_chunk_search_idx);
1017                 } else {
1018                         p_idx = rte_fbarray_find_next_free(p_arr,
1019                                         next_chunk_search_idx);
1020                 }
1021         }
1022         return 0;
1023 }
1024
1025 static int
1026 sync_existing(struct rte_memseg_list *primary_msl,
1027                 struct rte_memseg_list *local_msl, struct hugepage_info *hi,
1028                 unsigned int msl_idx)
1029 {
1030         int ret;
1031
1032         /* ensure all allocated space is the same in both lists */
1033         ret = sync_status(primary_msl, local_msl, hi, msl_idx, true);
1034         if (ret < 0)
1035                 return -1;
1036
1037         /* ensure all unallocated space is the same in both lists */
1038         ret = sync_status(primary_msl, local_msl, hi, msl_idx, false);
1039         if (ret < 0)
1040                 return -1;
1041
1042         /* update version number */
1043         local_msl->version = primary_msl->version;
1044
1045         return 0;
1046 }
1047
1048 static int
1049 sync_walk(const struct rte_memseg_list *msl, void *arg __rte_unused)
1050 {
1051         struct rte_mem_config *mcfg = rte_eal_get_configuration()->mem_config;
1052         struct rte_memseg_list *primary_msl, *local_msl;
1053         struct hugepage_info *hi = NULL;
1054         unsigned int i;
1055         int msl_idx;
1056         bool new_msl = false;
1057
1058         msl_idx = msl - mcfg->memsegs;
1059         primary_msl = &mcfg->memsegs[msl_idx];
1060         local_msl = &local_memsegs[msl_idx];
1061
1062         /* check if secondary has this memseg list set up */
1063         if (local_msl->base_va == NULL) {
1064                 char name[PATH_MAX];
1065                 int ret;
1066                 new_msl = true;
1067
1068                 /* create distinct fbarrays for each secondary */
1069                 snprintf(name, RTE_FBARRAY_NAME_LEN, "%s_%i",
1070                         primary_msl->memseg_arr.name, getpid());
1071
1072                 ret = rte_fbarray_init(&local_msl->memseg_arr, name,
1073                         primary_msl->memseg_arr.len,
1074                         primary_msl->memseg_arr.elt_sz);
1075                 if (ret < 0) {
1076                         RTE_LOG(ERR, EAL, "Cannot initialize local memory map\n");
1077                         return -1;
1078                 }
1079
1080                 local_msl->base_va = primary_msl->base_va;
1081         }
1082
1083         for (i = 0; i < RTE_DIM(internal_config.hugepage_info); i++) {
1084                 uint64_t cur_sz =
1085                         internal_config.hugepage_info[i].hugepage_sz;
1086                 uint64_t msl_sz = primary_msl->page_sz;
1087                 if (msl_sz == cur_sz) {
1088                         hi = &internal_config.hugepage_info[i];
1089                         break;
1090                 }
1091         }
1092         if (!hi) {
1093                 RTE_LOG(ERR, EAL, "Can't find relevant hugepage_info entry\n");
1094                 return -1;
1095         }
1096
1097         /* if versions don't match or if we have just allocated a new
1098          * memseg list, synchronize everything
1099          */
1100         if ((new_msl || local_msl->version != primary_msl->version) &&
1101                         sync_existing(primary_msl, local_msl, hi, msl_idx))
1102                 return -1;
1103         return 0;
1104 }
1105
1106
1107 int
1108 eal_memalloc_sync_with_primary(void)
1109 {
1110         /* nothing to be done in primary */
1111         if (rte_eal_process_type() == RTE_PROC_PRIMARY)
1112                 return 0;
1113
1114         if (memseg_list_walk_thread_unsafe(sync_walk, NULL))
1115                 return -1;
1116         return 0;
1117 }