lib/librte_eal/bsdapp/eal/eal_pci.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 <ctype.h>
  35 #include <stdio.h>
  36 #include <stdlib.h>
  37 #include <string.h>
  38 #include <stdarg.h>
  39 #include <unistd.h>
  40 #include <inttypes.h>
  41 #include <sys/types.h>
  42 #include <sys/stat.h>
  43 #include <fcntl.h>
  44 #include <stdarg.h>
  45 #include <errno.h>
  46 #include <dirent.h>
  47 #include <limits.h>
  48 #include <sys/queue.h>
  49 #include <sys/mman.h>
  50 #include <sys/ioctl.h>
  51 #include <sys/pciio.h>
  52 #include <dev/pci/pcireg.h>
  53
  54 #include <rte_interrupts.h>
  55 #include <rte_log.h>
  56 #include <rte_pci.h>
  57 #include <rte_common.h>
  58 #include <rte_launch.h>
  59 #include <rte_memory.h>
  60 #include <rte_memzone.h>
  61 #include <rte_eal.h>
  62 #include <rte_eal_memconfig.h>
  63 #include <rte_per_lcore.h>
  64 #include <rte_lcore.h>
  65 #include <rte_malloc.h>
  66 #include <rte_string_fns.h>
  67 #include <rte_debug.h>
  68 #include <rte_devargs.h>
  69
  70 #include "rte_pci_dev_ids.h"
  71 #include "eal_filesystem.h"
  72 #include "eal_private.h"
  73
  74 /**
  75  * @file
  76  * PCI probing under linux
  77  *
  78  * This code is used to simulate a PCI probe by parsing information in
  79  * sysfs. Moreover, when a registered driver matches a device, the
  80  * kernel driver currently using it is unloaded and replaced by
  81  * igb_uio module, which is a very minimal userland driver for Intel
  82  * network card, only providing access to PCI BAR to applications, and
  83  * enabling bus master.
  84  */
  85
  86 struct uio_map {
  87         void *addr;
  88         uint64_t offset;
  89         uint64_t size;
  90         uint64_t phaddr;
  91 };
  92
  93 /*
  94  * For multi-process we need to reproduce all PCI mappings in secondary
  95  * processes, so save them in a tailq.
  96  */
  97 struct uio_resource {
  98         TAILQ_ENTRY(uio_resource) next;
  99
 100         struct rte_pci_addr pci_addr;
 101         char path[PATH_MAX];
 102         size_t nb_maps;
 103         struct uio_map maps[PCI_MAX_RESOURCE];
 104 };
 105
 106 TAILQ_HEAD(uio_res_list, uio_resource);
 107
 108 static struct rte_tailq_elem rte_uio_tailq = {
 109         .name = "UIO_RESOURCE_LIST",
 110 };
 111 EAL_REGISTER_TAILQ(rte_uio_tailq)
 112
 113 /* unbind kernel driver for this device */
 114 static int
 115 pci_unbind_kernel_driver(struct rte_pci_device *dev __rte_unused)
 116 {
 117         RTE_LOG(ERR, EAL, "RTE_PCI_DRV_FORCE_UNBIND flag is not implemented "
 118                 "for BSD\n");
 119         return -ENOTSUP;
 120 }
 121
 122 /* map a particular resource from a file */
 123 static void *
 124 pci_map_resource(void *requested_addr, const char *devname, off_t offset,
 125                  size_t size)
 126 {
 127         int fd;
 128         void *mapaddr;
 129
 130         /*
 131          * open devname, to mmap it
 132          */
 133         fd = open(devname, O_RDWR);
 134         if (fd < 0) {
 135                 RTE_LOG(ERR, EAL, "Cannot open %s: %s\n",
 136                         devname, strerror(errno));
 137                 goto fail;
 138         }
 139
 140         /* Map the PCI memory resource of device */
 141         mapaddr = mmap(requested_addr, size, PROT_READ | PROT_WRITE,
 142                         MAP_SHARED, fd, offset);
 143         close(fd);
 144         if (mapaddr == MAP_FAILED ||
 145                         (requested_addr != NULL && mapaddr != requested_addr)) {
 146                 RTE_LOG(ERR, EAL, "%s(): cannot mmap(%s(%d), %p, 0x%lx, 0x%lx):"
 147                         " %s (%p)\n", __func__, devname, fd, requested_addr,
 148                         (unsigned long)size, (unsigned long)offset,
 149                         strerror(errno), mapaddr);
 150                 goto fail;
 151         }
 152
 153         RTE_LOG(DEBUG, EAL, "  PCI memory mapped at %p\n", mapaddr);
 154
 155         return mapaddr;
 156
 157 fail:
 158         return NULL;
 159 }
 160
 161 static int
 162 pci_uio_map_secondary(struct rte_pci_device *dev)
 163 {
 164         size_t i;
 165         struct uio_resource *uio_res;
 166         struct uio_res_list *uio_res_list =
 167                         RTE_TAILQ_CAST(rte_uio_tailq.head, uio_res_list);
 168
 169         TAILQ_FOREACH(uio_res, uio_res_list, next) {
 170
 171                 /* skip this element if it doesn't match our PCI address */
 172                 if (memcmp(&uio_res->pci_addr, &dev->addr, sizeof(dev->addr)))
 173                         continue;
 174
 175                 for (i = 0; i != uio_res->nb_maps; i++) {
 176                         if (pci_map_resource(uio_res->maps[i].addr,
 177                                              uio_res->path,
 178                                              (off_t)uio_res->maps[i].offset,
 179                                              (size_t)uio_res->maps[i].size)
 180                             != uio_res->maps[i].addr) {
 181                                 RTE_LOG(ERR, EAL,
 182                                         "Cannot mmap device resource\n");
 183                                 return -1;
 184                         }
 185                 }
 186                 return 0;
 187         }
 188
 189         RTE_LOG(ERR, EAL, "Cannot find resource for device\n");
 190         return 1;
 191 }
 192
 193 /* map the PCI resource of a PCI device in virtual memory */
 194 static int
 195 pci_uio_map_resource(struct rte_pci_device *dev)
 196 {
 197         int i, j;
 198         char devname[PATH_MAX]; /* contains the /dev/uioX */
 199         void *mapaddr;
 200         uint64_t phaddr;
 201         uint64_t offset;
 202         uint64_t pagesz;
 203         struct rte_pci_addr *loc = &dev->addr;
 204         struct uio_resource *uio_res;
 205         struct uio_res_list *uio_res_list =
 206                         RTE_TAILQ_CAST(rte_uio_tailq.head, uio_res_list);
 207         struct uio_map *maps;
 208
 209         dev->intr_handle.fd = -1;
 210         dev->intr_handle.type = RTE_INTR_HANDLE_UNKNOWN;
 211
 212         /* secondary processes - use already recorded details */
 213         if (rte_eal_process_type() != RTE_PROC_PRIMARY)
 214                 return pci_uio_map_secondary(dev);
 215
 216         snprintf(devname, sizeof(devname), "/dev/uio@pci:%u:%u:%u",
 217                         dev->addr.bus, dev->addr.devid, dev->addr.function);
 218
 219         if (access(devname, O_RDWR) < 0) {
 220                 RTE_LOG(WARNING, EAL, "  "PCI_PRI_FMT" not managed by UIO driver, "
 221                                 "skipping\n", loc->domain, loc->bus, loc->devid, loc->function);
 222                 return 1;
 223         }
 224
 225         /* save fd if in primary process */
 226         dev->intr_handle.fd = open(devname, O_RDWR);
 227         if (dev->intr_handle.fd < 0) {
 228                 RTE_LOG(ERR, EAL, "Cannot open %s: %s\n",
 229                         devname, strerror(errno));
 230                 return -1;
 231         }
 232         dev->intr_handle.type = RTE_INTR_HANDLE_UIO;
 233
 234         /* allocate the mapping details for secondary processes*/
 235         if ((uio_res = rte_zmalloc("UIO_RES", sizeof (*uio_res), 0)) == NULL) {
 236                 RTE_LOG(ERR, EAL,
 237                         "%s(): cannot store uio mmap details\n", __func__);
 238                 return -1;
 239         }
 240
 241         snprintf(uio_res->path, sizeof(uio_res->path), "%s", devname);
 242         memcpy(&uio_res->pci_addr, &dev->addr, sizeof(uio_res->pci_addr));
 243
 244
 245         /* Map all BARs */
 246         pagesz = sysconf(_SC_PAGESIZE);
 247
 248         maps = uio_res->maps;
 249         for (i = uio_res->nb_maps = 0; i != PCI_MAX_RESOURCE; i++) {
 250
 251                 j = uio_res->nb_maps;
 252                 /* skip empty BAR */
 253                 if ((phaddr = dev->mem_resource[i].phys_addr) == 0)
 254                         continue;
 255
 256                 /* if matching map is found, then use it */
 257                 offset = i * pagesz;
 258                 maps[j].offset = offset;
 259                 maps[j].phaddr = dev->mem_resource[i].phys_addr;
 260                 maps[j].size = dev->mem_resource[i].len;
 261                 if (maps[j].addr != NULL ||
 262                     (mapaddr = pci_map_resource(NULL, devname, (off_t)offset,
 263                                                 (size_t)maps[j].size)
 264                     ) == NULL) {
 265                         rte_free(uio_res);
 266                         return -1;
 267                 }
 268
 269                 maps[j].addr = mapaddr;
 270                 uio_res->nb_maps++;
 271                 dev->mem_resource[i].addr = mapaddr;
 272         }
 273
 274         TAILQ_INSERT_TAIL(uio_res_list, uio_res, next);
 275
 276         return 0;
 277 }
 278
 279 /* Scan one pci sysfs entry, and fill the devices list from it. */
 280 static int
 281 pci_scan_one(int dev_pci_fd, struct pci_conf *conf)
 282 {
 283         struct rte_pci_device *dev;
 284         struct pci_bar_io bar;
 285         unsigned i, max;
 286
 287         dev = malloc(sizeof(*dev));
 288         if (dev == NULL) {
 289                 return -1;
 290         }
 291
 292         memset(dev, 0, sizeof(*dev));
 293         dev->addr.domain = conf->pc_sel.pc_domain;
 294         dev->addr.bus = conf->pc_sel.pc_bus;
 295         dev->addr.devid = conf->pc_sel.pc_dev;
 296         dev->addr.function = conf->pc_sel.pc_func;
 297
 298         /* get vendor id */
 299         dev->id.vendor_id = conf->pc_vendor;
 300
 301         /* get device id */
 302         dev->id.device_id = conf->pc_device;
 303
 304         /* get subsystem_vendor id */
 305         dev->id.subsystem_vendor_id = conf->pc_subvendor;
 306
 307         /* get subsystem_device id */
 308         dev->id.subsystem_device_id = conf->pc_subdevice;
 309
 310         /* TODO: get max_vfs */
 311         dev->max_vfs = 0;
 312
 313         /* FreeBSD has no NUMA support (yet) */
 314         dev->numa_node = 0;
 315
 316         /* parse resources */
 317         switch (conf->pc_hdr & PCIM_HDRTYPE) {
 318         case PCIM_HDRTYPE_NORMAL:
 319                 max = PCIR_MAX_BAR_0;
 320                 break;
 321         case PCIM_HDRTYPE_BRIDGE:
 322                 max = PCIR_MAX_BAR_1;
 323                 break;
 324         case PCIM_HDRTYPE_CARDBUS:
 325                 max = PCIR_MAX_BAR_2;
 326                 break;
 327         default:
 328                 goto skipdev;
 329         }
 330
 331         for (i = 0; i <= max; i++) {
 332                 bar.pbi_sel = conf->pc_sel;
 333                 bar.pbi_reg = PCIR_BAR(i);
 334                 if (ioctl(dev_pci_fd, PCIOCGETBAR, &bar) < 0)
 335                         continue;
 336
 337                 dev->mem_resource[i].len = bar.pbi_length;
 338                 if (PCI_BAR_IO(bar.pbi_base)) {
 339                         dev->mem_resource[i].addr = (void *)(bar.pbi_base & ~((uint64_t)0xf));
 340                         continue;
 341                 }
 342                 dev->mem_resource[i].phys_addr = bar.pbi_base & ~((uint64_t)0xf);
 343         }
 344
 345         /* device is valid, add in list (sorted) */
 346         if (TAILQ_EMPTY(&pci_device_list)) {
 347                 TAILQ_INSERT_TAIL(&pci_device_list, dev, next);
 348         }
 349         else {
 350                 struct rte_pci_device *dev2 = NULL;
 351                 int ret;
 352
 353                 TAILQ_FOREACH(dev2, &pci_device_list, next) {
 354                         ret = rte_eal_compare_pci_addr(&dev->addr, &dev2->addr);
 355                         if (ret > 0)
 356                                 continue;
 357                         else if (ret < 0) {
 358                                 TAILQ_INSERT_BEFORE(dev2, dev, next);
 359                                 return 0;
 360                         } else { /* already registered */
 361                                 dev2->kdrv = dev->kdrv;
 362                                 dev2->max_vfs = dev->max_vfs;
 363                                 memmove(dev2->mem_resource,
 364                                         dev->mem_resource,
 365                                         sizeof(dev->mem_resource));
 366                                 free(dev);
 367                                 return 0;
 368                         }
 369                 }
 370                 TAILQ_INSERT_TAIL(&pci_device_list, dev, next);
 371         }
 372
 373         return 0;
 374
 375 skipdev:
 376         free(dev);
 377         return 0;
 378 }
 379
 380 /*
 381  * Scan the content of the PCI bus, and add the devices in the devices
 382  * list. Call pci_scan_one() for each pci entry found.
 383  */
 384 static int
 385 pci_scan(void)
 386 {
 387         int fd;
 388         unsigned dev_count = 0;
 389         struct pci_conf matches[16];
 390         struct pci_conf_io conf_io = {
 391                         .pat_buf_len = 0,
 392                         .num_patterns = 0,
 393                         .patterns = NULL,
 394                         .match_buf_len = sizeof(matches),
 395                         .matches = &matches[0],
 396         };
 397
 398         fd = open("/dev/pci", O_RDONLY);
 399         if (fd < 0) {
 400                 RTE_LOG(ERR, EAL, "%s(): error opening /dev/pci\n", __func__);
 401                 goto error;
 402         }
 403
 404         do {
 405                 unsigned i;
 406                 if (ioctl(fd, PCIOCGETCONF, &conf_io) < 0) {
 407                         RTE_LOG(ERR, EAL, "%s(): error with ioctl on /dev/pci: %s\n",
 408                                         __func__, strerror(errno));
 409                         goto error;
 410                 }
 411
 412                 for (i = 0; i < conf_io.num_matches; i++)
 413                         if (pci_scan_one(fd, &matches[i]) < 0)
 414                                 goto error;
 415
 416                 dev_count += conf_io.num_matches;
 417         } while(conf_io.status == PCI_GETCONF_MORE_DEVS);
 418
 419         close(fd);
 420
 421         RTE_LOG(ERR, EAL, "PCI scan found %u devices\n", dev_count);
 422         return 0;
 423
 424 error:
 425         if (fd >= 0)
 426                 close(fd);
 427         return -1;
 428 }
 429
 430 /*
 431  * If vendor/device ID match, call the devinit() function of the
 432  * driver.
 433  */
 434 int
 435 rte_eal_pci_probe_one_driver(struct rte_pci_driver *dr, struct rte_pci_device *dev)
 436 {
 437         const struct rte_pci_id *id_table;
 438         int ret;
 439
 440         for (id_table = dr->id_table ; id_table->vendor_id != 0; id_table++) {
 441
 442                 /* check if device's identifiers match the driver's ones */
 443                 if (id_table->vendor_id != dev->id.vendor_id &&
 444                                 id_table->vendor_id != PCI_ANY_ID)
 445                         continue;
 446                 if (id_table->device_id != dev->id.device_id &&
 447                                 id_table->device_id != PCI_ANY_ID)
 448                         continue;
 449                 if (id_table->subsystem_vendor_id != dev->id.subsystem_vendor_id &&
 450                                 id_table->subsystem_vendor_id != PCI_ANY_ID)
 451                         continue;
 452                 if (id_table->subsystem_device_id != dev->id.subsystem_device_id &&
 453                                 id_table->subsystem_device_id != PCI_ANY_ID)
 454                         continue;
 455
 456                 struct rte_pci_addr *loc = &dev->addr;
 457
 458                 RTE_LOG(DEBUG, EAL, "PCI device "PCI_PRI_FMT" on NUMA socket %i\n",
 459                                 loc->domain, loc->bus, loc->devid, loc->function,
 460                                 dev->numa_node);
 461
 462                 RTE_LOG(DEBUG, EAL, "  probe driver: %x:%x %s\n", dev->id.vendor_id,
 463                                 dev->id.device_id, dr->name);
 464
 465                 /* no initialization when blacklisted, return without error */
 466                 if (dev->devargs != NULL &&
 467                         dev->devargs->type == RTE_DEVTYPE_BLACKLISTED_PCI) {
 468
 469                         RTE_LOG(DEBUG, EAL, "  Device is blacklisted, not initializing\n");
 470                         return 0;
 471                 }
 472
 473                 if (dr->drv_flags & RTE_PCI_DRV_NEED_MAPPING) {
 474                         /* map resources for devices that use igb_uio */
 475                         ret = pci_uio_map_resource(dev);
 476                         if (ret != 0)
 477                                 return ret;
 478                 } else if (dr->drv_flags & RTE_PCI_DRV_FORCE_UNBIND &&
 479                            rte_eal_process_type() == RTE_PROC_PRIMARY) {
 480                         /* unbind current driver */
 481                         if (pci_unbind_kernel_driver(dev) < 0)
 482                                 return -1;
 483                 }
 484
 485                 /* reference driver structure */
 486                 dev->driver = dr;
 487
 488                 /* call the driver devinit() function */
 489                 return dr->devinit(dr, dev);
 490         }
 491         /* return positive value if driver is not found */
 492         return 1;
 493 }
 494
 495 /* Init the PCI EAL subsystem */
 496 int
 497 rte_eal_pci_init(void)
 498 {
 499         TAILQ_INIT(&pci_driver_list);
 500         TAILQ_INIT(&pci_device_list);
 501
 502         /* for debug purposes, PCI can be disabled */
 503         if (internal_config.no_pci)
 504                 return 0;
 505
 506         if (pci_scan() < 0) {
 507                 RTE_LOG(ERR, EAL, "%s(): Cannot scan PCI bus\n", __func__);
 508                 return -1;
 509         }
 510         return 0;
 511 }