drivers/bus/fslmc/fslmc_bus.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  *
   3  *   Copyright 2016,2018 NXP
   4  *
   5  */
   6
   7 #include <string.h>
   8 #include <dirent.h>
   9 #include <stdbool.h>
  10
  11 #include <rte_log.h>
  12 #include <rte_bus.h>
  13 #include <rte_eal_memconfig.h>
  14 #include <rte_malloc.h>
  15 #include <rte_devargs.h>
  16 #include <rte_memcpy.h>
  17 #include <rte_ethdev_driver.h>
  18
  19 #include <rte_fslmc.h>
  20 #include <fslmc_vfio.h>
  21 #include "fslmc_logs.h"
  22
  23 #include <dpaax_iova_table.h>
  24
  25 int dpaa2_logtype_bus;
  26
  27 #define VFIO_IOMMU_GROUP_PATH "/sys/kernel/iommu_groups"
  28 #define FSLMC_BUS_NAME  fslmc
  29
  30 struct rte_fslmc_bus rte_fslmc_bus;
  31 uint8_t dpaa2_virt_mode;
  32
  33 uint32_t
  34 rte_fslmc_get_device_count(enum rte_dpaa2_dev_type device_type)
  35 {
  36         if (device_type > DPAA2_DEVTYPE_MAX)
  37                 return 0;
  38         return rte_fslmc_bus.device_count[device_type];
  39 }
  40
  41 RTE_DEFINE_PER_LCORE(struct dpaa2_portal_dqrr, dpaa2_held_bufs);
  42
  43 static void
  44 cleanup_fslmc_device_list(void)
  45 {
  46         struct rte_dpaa2_device *dev;
  47         struct rte_dpaa2_device *t_dev;
  48
  49         TAILQ_FOREACH_SAFE(dev, &rte_fslmc_bus.device_list, next, t_dev) {
  50                 TAILQ_REMOVE(&rte_fslmc_bus.device_list, dev, next);
  51                 free(dev);
  52                 dev = NULL;
  53         }
  54 }
  55
  56 static int
  57 compare_dpaa2_devname(struct rte_dpaa2_device *dev1,
  58                       struct rte_dpaa2_device *dev2)
  59 {
  60         int comp;
  61
  62         if (dev1->dev_type > dev2->dev_type) {
  63                 comp = 1;
  64         } else if (dev1->dev_type < dev2->dev_type) {
  65                 comp = -1;
  66         } else {
  67                 /* Check the ID as types match */
  68                 if (dev1->object_id > dev2->object_id)
  69                         comp = 1;
  70                 else if (dev1->object_id < dev2->object_id)
  71                         comp = -1;
  72                 else
  73                         comp = 0; /* Duplicate device name */
  74         }
  75
  76         return comp;
  77 }
  78
  79 static void
  80 insert_in_device_list(struct rte_dpaa2_device *newdev)
  81 {
  82         int comp, inserted = 0;
  83         struct rte_dpaa2_device *dev = NULL;
  84         struct rte_dpaa2_device *tdev = NULL;
  85
  86         TAILQ_FOREACH_SAFE(dev, &rte_fslmc_bus.device_list, next, tdev) {
  87                 comp = compare_dpaa2_devname(newdev, dev);
  88                 if (comp < 0) {
  89                         TAILQ_INSERT_BEFORE(dev, newdev, next);
  90                         inserted = 1;
  91                         break;
  92                 }
  93         }
  94
  95         if (!inserted)
  96                 TAILQ_INSERT_TAIL(&rte_fslmc_bus.device_list, newdev, next);
  97 }
  98
  99 static struct rte_devargs *
 100 fslmc_devargs_lookup(struct rte_dpaa2_device *dev)
 101 {
 102         struct rte_devargs *devargs;
 103         char dev_name[32];
 104
 105         RTE_EAL_DEVARGS_FOREACH("fslmc", devargs) {
 106                 devargs->bus->parse(devargs->name, &dev_name);
 107                 if (strcmp(dev_name, dev->device.name) == 0) {
 108                         DPAA2_BUS_INFO("**Devargs matched %s", dev_name);
 109                         return devargs;
 110                 }
 111         }
 112         return NULL;
 113 }
 114
 115 static void
 116 dump_device_list(void)
 117 {
 118         struct rte_dpaa2_device *dev;
 119         uint32_t global_log_level;
 120         int local_log_level;
 121
 122         /* Only if the log level has been set to Debugging, print list */
 123         global_log_level = rte_log_get_global_level();
 124         local_log_level = rte_log_get_level(dpaa2_logtype_bus);
 125         if (global_log_level == RTE_LOG_DEBUG ||
 126             local_log_level == RTE_LOG_DEBUG) {
 127                 DPAA2_BUS_LOG(DEBUG, "List of devices scanned on bus:");
 128                 TAILQ_FOREACH(dev, &rte_fslmc_bus.device_list, next) {
 129                         DPAA2_BUS_LOG(DEBUG, "\t\t%s", dev->device.name);
 130                 }
 131         }
 132 }
 133
 134 static int
 135 scan_one_fslmc_device(char *dev_name)
 136 {
 137         char *dup_dev_name, *t_ptr;
 138         struct rte_dpaa2_device *dev;
 139
 140         if (!dev_name)
 141                 return -1;
 142
 143         /* Ignore the Container name itself */
 144         if (!strncmp("dprc", dev_name, 4))
 145                 return 0;
 146
 147         /* Creating a temporary copy to perform cut-parse over string */
 148         dup_dev_name = strdup(dev_name);
 149         if (!dup_dev_name) {
 150                 DPAA2_BUS_ERR("Unable to allocate device name memory");
 151                 return -ENOMEM;
 152         }
 153
 154         /* For all other devices, we allocate rte_dpaa2_device.
 155          * For those devices where there is no driver, probe would release
 156          * the memory associated with the rte_dpaa2_device after necessary
 157          * initialization.
 158          */
 159         dev = calloc(1, sizeof(struct rte_dpaa2_device));
 160         if (!dev) {
 161                 DPAA2_BUS_ERR("Unable to allocate device object");
 162                 free(dup_dev_name);
 163                 return -ENOMEM;
 164         }
 165
 166         dev->device.bus = &rte_fslmc_bus.bus;
 167
 168         /* Parse the device name and ID */
 169         t_ptr = strtok(dup_dev_name, ".");
 170         if (!t_ptr) {
 171                 DPAA2_BUS_ERR("Incorrect device name observed");
 172                 goto cleanup;
 173         }
 174         if (!strncmp("dpni", t_ptr, 4))
 175                 dev->dev_type = DPAA2_ETH;
 176         else if (!strncmp("dpseci", t_ptr, 6))
 177                 dev->dev_type = DPAA2_CRYPTO;
 178         else if (!strncmp("dpcon", t_ptr, 5))
 179                 dev->dev_type = DPAA2_CON;
 180         else if (!strncmp("dpbp", t_ptr, 4))
 181                 dev->dev_type = DPAA2_BPOOL;
 182         else if (!strncmp("dpio", t_ptr, 4))
 183                 dev->dev_type = DPAA2_IO;
 184         else if (!strncmp("dpci", t_ptr, 4))
 185                 dev->dev_type = DPAA2_CI;
 186         else if (!strncmp("dpmcp", t_ptr, 5))
 187                 dev->dev_type = DPAA2_MPORTAL;
 188         else if (!strncmp("dpdmai", t_ptr, 6))
 189                 dev->dev_type = DPAA2_QDMA;
 190         else if (!strncmp("dpdmux", t_ptr, 6))
 191                 dev->dev_type = DPAA2_MUX;
 192         else
 193                 dev->dev_type = DPAA2_UNKNOWN;
 194
 195         /* Update the device found into the device_count table */
 196         rte_fslmc_bus.device_count[dev->dev_type]++;
 197
 198         t_ptr = strtok(NULL, ".");
 199         if (!t_ptr) {
 200                 DPAA2_BUS_ERR("Incorrect device string observed (%s)", t_ptr);
 201                 goto cleanup;
 202         }
 203
 204         sscanf(t_ptr, "%hu", &dev->object_id);
 205         dev->device.name = strdup(dev_name);
 206         if (!dev->device.name) {
 207                 DPAA2_BUS_ERR("Unable to clone device name. Out of memory");
 208                 goto cleanup;
 209         }
 210         dev->device.devargs = fslmc_devargs_lookup(dev);
 211
 212         /* Add device in the fslmc device list */
 213         insert_in_device_list(dev);
 214
 215         /* Don't need the duplicated device filesystem entry anymore */
 216         if (dup_dev_name)
 217                 free(dup_dev_name);
 218
 219         return 0;
 220 cleanup:
 221         if (dup_dev_name)
 222                 free(dup_dev_name);
 223         if (dev)
 224                 free(dev);
 225         return -1;
 226 }
 227
 228 static int
 229 rte_fslmc_parse(const char *name, void *addr)
 230 {
 231         uint16_t dev_id;
 232         char *t_ptr = NULL, *dname = NULL;
 233
 234         /* 'name' is expected to contain name of device, for example, dpio.1,
 235          * dpni.2, etc.
 236          */
 237
 238         dname = strdup(name);
 239         if (!dname)
 240                 return -EINVAL;
 241         t_ptr = dname;
 242
 243         if (strncmp("dpni", t_ptr, 4) &&
 244             strncmp("dpseci", t_ptr, 6) &&
 245             strncmp("dpcon", t_ptr, 5) &&
 246             strncmp("dpbp", t_ptr, 4) &&
 247             strncmp("dpio", t_ptr, 4) &&
 248             strncmp("dpci", t_ptr, 4) &&
 249             strncmp("dpmcp", t_ptr, 5) &&
 250             strncmp("dpdmai", t_ptr, 6) &&
 251             strncmp("dpdmux", t_ptr, 6)) {
 252                 DPAA2_BUS_ERR("Unknown or unsupported device");
 253                 goto err_out;
 254         }
 255
 256         t_ptr = strchr(name, '.');
 257         if (!t_ptr) {
 258                 DPAA2_BUS_ERR("Incorrect device string observed (%s)", t_ptr);
 259                 goto err_out;
 260         }
 261
 262         t_ptr = (char *)(t_ptr + 1);
 263         if (sscanf(t_ptr, "%hu", &dev_id) <= 0) {
 264                 DPAA2_BUS_ERR("Incorrect device string observed (%s)", t_ptr);
 265                 goto err_out;
 266         }
 267         free(dname);
 268
 269         if (addr)
 270                 strcpy(addr, name);
 271
 272         return 0;
 273 err_out:
 274         free(dname);
 275         return -EINVAL;
 276 }
 277
 278 static int
 279 rte_fslmc_scan(void)
 280 {
 281         int ret;
 282         int device_count = 0;
 283         char fslmc_dirpath[PATH_MAX];
 284         DIR *dir;
 285         struct dirent *entry;
 286         static int process_once;
 287         int groupid;
 288
 289         if (process_once) {
 290                 DPAA2_BUS_DEBUG("Fslmc bus already scanned. Not rescanning");
 291                 return 0;
 292         }
 293         process_once = 1;
 294
 295         ret = fslmc_get_container_group(&groupid);
 296         if (ret != 0)
 297                 goto scan_fail;
 298
 299         /* Scan devices on the group */
 300         snprintf(fslmc_dirpath, sizeof(fslmc_dirpath), "%s/%d/devices",
 301                         VFIO_IOMMU_GROUP_PATH, groupid);
 302         dir = opendir(fslmc_dirpath);
 303         if (!dir) {
 304                 DPAA2_BUS_ERR("Unable to open VFIO group directory");
 305                 goto scan_fail;
 306         }
 307
 308         while ((entry = readdir(dir)) != NULL) {
 309                 if (entry->d_name[0] == '.' || entry->d_type != DT_LNK)
 310                         continue;
 311
 312                 ret = scan_one_fslmc_device(entry->d_name);
 313                 if (ret != 0) {
 314                         /* Error in parsing directory - exit gracefully */
 315                         goto scan_fail_cleanup;
 316                 }
 317                 device_count += 1;
 318         }
 319
 320         closedir(dir);
 321
 322         DPAA2_BUS_INFO("FSLMC Bus scan completed");
 323         /* If debugging is enabled, device list is dumped to log output */
 324         dump_device_list();
 325
 326         return 0;
 327
 328 scan_fail_cleanup:
 329         closedir(dir);
 330
 331         /* Remove all devices in the list */
 332         cleanup_fslmc_device_list();
 333 scan_fail:
 334         DPAA2_BUS_DEBUG("FSLMC Bus Not Available. Skipping");
 335         /* Irrespective of failure, scan only return success */
 336         return 0;
 337 }
 338
 339 static int
 340 rte_fslmc_match(struct rte_dpaa2_driver *dpaa2_drv,
 341                 struct rte_dpaa2_device *dpaa2_dev)
 342 {
 343         if (dpaa2_drv->drv_type == dpaa2_dev->dev_type)
 344                 return 0;
 345
 346         return 1;
 347 }
 348
 349 static int
 350 rte_fslmc_probe(void)
 351 {
 352         int ret = 0;
 353         int probe_all;
 354
 355         struct rte_dpaa2_device *dev;
 356         struct rte_dpaa2_driver *drv;
 357
 358         if (TAILQ_EMPTY(&rte_fslmc_bus.device_list))
 359                 return 0;
 360
 361         ret = fslmc_vfio_setup_group();
 362         if (ret) {
 363                 DPAA2_BUS_ERR("Unable to setup VFIO %d", ret);
 364                 return 0;
 365         }
 366
 367         /* Map existing segments as well as, in case of hotpluggable memory,
 368          * install callback handler.
 369          */
 370         ret = rte_fslmc_vfio_dmamap();
 371         if (ret) {
 372                 DPAA2_BUS_ERR("Unable to DMA map existing VAs: (%d)", ret);
 373                 /* Not continuing ahead */
 374                 DPAA2_BUS_ERR("FSLMC VFIO Mapping failed");
 375                 return 0;
 376         }
 377
 378         ret = fslmc_vfio_process_group();
 379         if (ret) {
 380                 DPAA2_BUS_ERR("Unable to setup devices %d", ret);
 381                 return 0;
 382         }
 383
 384         probe_all = rte_fslmc_bus.bus.conf.scan_mode != RTE_BUS_SCAN_WHITELIST;
 385
 386         /* In case of PA, the FD addresses returned by qbman APIs are physical
 387          * addresses, which need conversion into equivalent VA address for
 388          * rte_mbuf. For that, a table (a serial array, in memory) is used to
 389          * increase translation efficiency.
 390          * This has to be done before probe as some device initialization
 391          * (during) probe allocate memory (dpaa2_sec) which needs to be pinned
 392          * to this table.
 393          *
 394          * Error is ignored as relevant logs are handled within dpaax and
 395          * handling for unavailable dpaax table too is transparent to caller.
 396          */
 397         dpaax_iova_table_populate();
 398
 399         TAILQ_FOREACH(dev, &rte_fslmc_bus.device_list, next) {
 400                 TAILQ_FOREACH(drv, &rte_fslmc_bus.driver_list, next) {
 401                         ret = rte_fslmc_match(drv, dev);
 402                         if (ret)
 403                                 continue;
 404
 405                         if (!drv->probe)
 406                                 continue;
 407
 408                         if (rte_dev_is_probed(&dev->device))
 409                                 continue;
 410
 411                         if (dev->device.devargs &&
 412                           dev->device.devargs->policy == RTE_DEV_BLACKLISTED) {
 413                                 DPAA2_BUS_LOG(DEBUG, "%s Blacklisted, skipping",
 414                                               dev->device.name);
 415                                 continue;
 416                         }
 417
 418                         if (probe_all ||
 419                            (dev->device.devargs &&
 420                            dev->device.devargs->policy ==
 421                            RTE_DEV_WHITELISTED)) {
 422                                 ret = drv->probe(drv, dev);
 423                                 if (ret) {
 424                                         DPAA2_BUS_ERR("Unable to probe");
 425                                 } else {
 426                                         dev->driver = drv;
 427                                         dev->device.driver = &drv->driver;
 428                                 }
 429                         }
 430                         break;
 431                 }
 432         }
 433
 434         if (rte_eal_iova_mode() == RTE_IOVA_VA)
 435                 dpaa2_virt_mode = 1;
 436
 437         return 0;
 438 }
 439
 440 static struct rte_device *
 441 rte_fslmc_find_device(const struct rte_device *start, rte_dev_cmp_t cmp,
 442                       const void *data)
 443 {
 444         const struct rte_dpaa2_device *dstart;
 445         struct rte_dpaa2_device *dev;
 446
 447         if (start != NULL) {
 448                 dstart = RTE_DEV_TO_FSLMC_CONST(start);
 449                 dev = TAILQ_NEXT(dstart, next);
 450         } else {
 451                 dev = TAILQ_FIRST(&rte_fslmc_bus.device_list);
 452         }
 453         while (dev != NULL) {
 454                 if (cmp(&dev->device, data) == 0)
 455                         return &dev->device;
 456                 dev = TAILQ_NEXT(dev, next);
 457         }
 458
 459         return NULL;
 460 }
 461
 462 /*register a fslmc bus based dpaa2 driver */
 463 void
 464 rte_fslmc_driver_register(struct rte_dpaa2_driver *driver)
 465 {
 466         RTE_VERIFY(driver);
 467
 468         TAILQ_INSERT_TAIL(&rte_fslmc_bus.driver_list, driver, next);
 469         /* Update Bus references */
 470         driver->fslmc_bus = &rte_fslmc_bus;
 471 }
 472
 473 /*un-register a fslmc bus based dpaa2 driver */
 474 void
 475 rte_fslmc_driver_unregister(struct rte_dpaa2_driver *driver)
 476 {
 477         struct rte_fslmc_bus *fslmc_bus;
 478
 479         fslmc_bus = driver->fslmc_bus;
 480
 481         /* Cleanup the PA->VA Translation table; From whereever this function
 482          * is called from.
 483          */
 484         dpaax_iova_table_depopulate();
 485
 486         TAILQ_REMOVE(&fslmc_bus->driver_list, driver, next);
 487         /* Update Bus references */
 488         driver->fslmc_bus = NULL;
 489 }
 490
 491 /*
 492  * All device has iova as va
 493  */
 494 static inline int
 495 fslmc_all_device_support_iova(void)
 496 {
 497         int ret = 0;
 498         struct rte_dpaa2_device *dev;
 499         struct rte_dpaa2_driver *drv;
 500
 501         TAILQ_FOREACH(dev, &rte_fslmc_bus.device_list, next) {
 502                 TAILQ_FOREACH(drv, &rte_fslmc_bus.driver_list, next) {
 503                         ret = rte_fslmc_match(drv, dev);
 504                         if (ret)
 505                                 continue;
 506                         /* if the driver is not supporting IOVA */
 507                         if (!(drv->drv_flags & RTE_DPAA2_DRV_IOVA_AS_VA))
 508                                 return 0;
 509                 }
 510         }
 511         return 1;
 512 }
 513
 514 /*
 515  * Get iommu class of DPAA2 devices on the bus.
 516  */
 517 static enum rte_iova_mode
 518 rte_dpaa2_get_iommu_class(void)
 519 {
 520         bool is_vfio_noiommu_enabled = 1;
 521         bool has_iova_va;
 522
 523         if (TAILQ_EMPTY(&rte_fslmc_bus.device_list))
 524                 return RTE_IOVA_DC;
 525
 526 #ifdef RTE_LIBRTE_DPAA2_USE_PHYS_IOVA
 527         return RTE_IOVA_PA;
 528 #endif
 529
 530         /* check if all devices on the bus support Virtual addressing or not */
 531         has_iova_va = fslmc_all_device_support_iova();
 532
 533 #ifdef VFIO_PRESENT
 534         is_vfio_noiommu_enabled = rte_vfio_noiommu_is_enabled() == true ?
 535                                                 true : false;
 536 #endif
 537
 538         if (has_iova_va && !is_vfio_noiommu_enabled)
 539                 return RTE_IOVA_VA;
 540
 541         return RTE_IOVA_PA;
 542 }
 543
 544 struct rte_fslmc_bus rte_fslmc_bus = {
 545         .bus = {
 546                 .scan = rte_fslmc_scan,
 547                 .probe = rte_fslmc_probe,
 548                 .parse = rte_fslmc_parse,
 549                 .find_device = rte_fslmc_find_device,
 550                 .get_iommu_class = rte_dpaa2_get_iommu_class,
 551         },
 552         .device_list = TAILQ_HEAD_INITIALIZER(rte_fslmc_bus.device_list),
 553         .driver_list = TAILQ_HEAD_INITIALIZER(rte_fslmc_bus.driver_list),
 554         .device_count = {0},
 555 };
 556
 557 RTE_REGISTER_BUS(FSLMC_BUS_NAME, rte_fslmc_bus.bus);
 558
 559 RTE_INIT(fslmc_init_log)
 560 {
 561         /* Bus level logs */
 562         dpaa2_logtype_bus = rte_log_register("bus.fslmc");
 563         if (dpaa2_logtype_bus >= 0)
 564                 rte_log_set_level(dpaa2_logtype_bus, RTE_LOG_NOTICE);
 565 }