1 /* SPDX-License-Identifier: BSD-3-Clause
3 * Copyright 2016,2018-2019 NXP
13 #include <rte_malloc.h>
14 #include <rte_devargs.h>
15 #include <rte_memcpy.h>
16 #include <rte_ethdev_driver.h>
17 #include <rte_mbuf_dyn.h>
19 #include <rte_fslmc.h>
20 #include <fslmc_vfio.h>
21 #include "fslmc_logs.h"
23 #include <dpaax_iova_table.h>
25 #define VFIO_IOMMU_GROUP_PATH "/sys/kernel/iommu_groups"
26 #define FSLMC_BUS_NAME fslmc
28 struct rte_fslmc_bus rte_fslmc_bus;
29 uint8_t dpaa2_virt_mode;
31 #define DPAA2_SEQN_DYNFIELD_NAME "dpaa2_seqn_dynfield"
32 int dpaa2_seqn_dynfield_offset = -1;
35 rte_fslmc_get_device_count(enum rte_dpaa2_dev_type device_type)
37 if (device_type >= DPAA2_DEVTYPE_MAX)
39 return rte_fslmc_bus.device_count[device_type];
43 cleanup_fslmc_device_list(void)
45 struct rte_dpaa2_device *dev;
46 struct rte_dpaa2_device *t_dev;
48 TAILQ_FOREACH_SAFE(dev, &rte_fslmc_bus.device_list, next, t_dev) {
49 TAILQ_REMOVE(&rte_fslmc_bus.device_list, dev, next);
56 compare_dpaa2_devname(struct rte_dpaa2_device *dev1,
57 struct rte_dpaa2_device *dev2)
61 if (dev1->dev_type > dev2->dev_type) {
63 } else if (dev1->dev_type < dev2->dev_type) {
66 /* Check the ID as types match */
67 if (dev1->object_id > dev2->object_id)
69 else if (dev1->object_id < dev2->object_id)
72 comp = 0; /* Duplicate device name */
79 insert_in_device_list(struct rte_dpaa2_device *newdev)
81 int comp, inserted = 0;
82 struct rte_dpaa2_device *dev = NULL;
83 struct rte_dpaa2_device *tdev = NULL;
85 TAILQ_FOREACH_SAFE(dev, &rte_fslmc_bus.device_list, next, tdev) {
86 comp = compare_dpaa2_devname(newdev, dev);
88 TAILQ_INSERT_BEFORE(dev, newdev, next);
95 TAILQ_INSERT_TAIL(&rte_fslmc_bus.device_list, newdev, next);
98 static struct rte_devargs *
99 fslmc_devargs_lookup(struct rte_dpaa2_device *dev)
101 struct rte_devargs *devargs;
104 RTE_EAL_DEVARGS_FOREACH("fslmc", devargs) {
105 devargs->bus->parse(devargs->name, &dev_name);
106 if (strcmp(dev_name, dev->device.name) == 0) {
107 DPAA2_BUS_INFO("**Devargs matched %s", dev_name);
115 dump_device_list(void)
117 struct rte_dpaa2_device *dev;
119 /* Only if the log level has been set to Debugging, print list */
120 if (rte_log_can_log(dpaa2_logtype_bus, RTE_LOG_DEBUG)) {
121 DPAA2_BUS_LOG(DEBUG, "List of devices scanned on bus:");
122 TAILQ_FOREACH(dev, &rte_fslmc_bus.device_list, next) {
123 DPAA2_BUS_LOG(DEBUG, "\t\t%s", dev->device.name);
129 scan_one_fslmc_device(char *dev_name)
131 char *dup_dev_name, *t_ptr;
132 struct rte_dpaa2_device *dev = NULL;
138 /* Ignore the Container name itself */
139 if (!strncmp("dprc", dev_name, 4))
142 /* Creating a temporary copy to perform cut-parse over string */
143 dup_dev_name = strdup(dev_name);
145 DPAA2_BUS_ERR("Unable to allocate device name memory");
149 /* For all other devices, we allocate rte_dpaa2_device.
150 * For those devices where there is no driver, probe would release
151 * the memory associated with the rte_dpaa2_device after necessary
154 dev = calloc(1, sizeof(struct rte_dpaa2_device));
156 DPAA2_BUS_ERR("Unable to allocate device object");
161 dev->device.bus = &rte_fslmc_bus.bus;
163 /* Parse the device name and ID */
164 t_ptr = strtok(dup_dev_name, ".");
166 DPAA2_BUS_ERR("Invalid device found: (%s)", dup_dev_name);
170 if (!strncmp("dpni", t_ptr, 4))
171 dev->dev_type = DPAA2_ETH;
172 else if (!strncmp("dpseci", t_ptr, 6))
173 dev->dev_type = DPAA2_CRYPTO;
174 else if (!strncmp("dpcon", t_ptr, 5))
175 dev->dev_type = DPAA2_CON;
176 else if (!strncmp("dpbp", t_ptr, 4))
177 dev->dev_type = DPAA2_BPOOL;
178 else if (!strncmp("dpio", t_ptr, 4))
179 dev->dev_type = DPAA2_IO;
180 else if (!strncmp("dpci", t_ptr, 4))
181 dev->dev_type = DPAA2_CI;
182 else if (!strncmp("dpmcp", t_ptr, 5))
183 dev->dev_type = DPAA2_MPORTAL;
184 else if (!strncmp("dpdmai", t_ptr, 6))
185 dev->dev_type = DPAA2_QDMA;
186 else if (!strncmp("dpdmux", t_ptr, 6))
187 dev->dev_type = DPAA2_MUX;
188 else if (!strncmp("dprtc", t_ptr, 5))
189 dev->dev_type = DPAA2_DPRTC;
191 dev->dev_type = DPAA2_UNKNOWN;
193 t_ptr = strtok(NULL, ".");
195 DPAA2_BUS_ERR("Skipping invalid device (%s)", dup_dev_name);
200 sscanf(t_ptr, "%hu", &dev->object_id);
201 dev->device.name = strdup(dev_name);
202 if (!dev->device.name) {
203 DPAA2_BUS_ERR("Unable to clone device name. Out of memory");
207 dev->device.devargs = fslmc_devargs_lookup(dev);
209 /* Update the device found into the device_count table */
210 rte_fslmc_bus.device_count[dev->dev_type]++;
212 /* Add device in the fslmc device list */
213 insert_in_device_list(dev);
215 /* Don't need the duplicated device filesystem entry anymore */
229 rte_fslmc_parse(const char *name, void *addr)
234 uint8_t sep_exists = 0;
237 DPAA2_BUS_DEBUG("Parsing dev=(%s)", name);
239 /* There are multiple ways this can be called, with bus:dev, name=dev
240 * or just dev. In all cases, the 'addr' is actually a string.
242 sep = strchr(name, ':');
245 sep = strchr(name, '=');
253 /* Check if starting part if either of 'fslmc:' or 'name=', separator
257 /* If either of "fslmc" or "name" are starting part */
258 if (!strncmp(name, RTE_STR(FSLMC_BUS_NAME),
259 strlen(RTE_STR(FSLMC_BUS_NAME))) ||
260 (!strncmp(name, "name", strlen("name")))) {
263 DPAA2_BUS_DEBUG("Invalid device for matching (%s).",
272 /* Validate device name */
273 if (strncmp("dpni", sep, 4) &&
274 strncmp("dpseci", sep, 6) &&
275 strncmp("dpcon", sep, 5) &&
276 strncmp("dpbp", sep, 4) &&
277 strncmp("dpio", sep, 4) &&
278 strncmp("dpci", sep, 4) &&
279 strncmp("dpmcp", sep, 5) &&
280 strncmp("dpdmai", sep, 6) &&
281 strncmp("dpdmux", sep, 6)) {
282 DPAA2_BUS_DEBUG("Unknown or unsupported device (%s)", sep);
287 t_ptr = strchr(sep, '.');
288 if (!t_ptr || sscanf(t_ptr + 1, "%hu", &dev_id) != 1) {
289 DPAA2_BUS_ERR("Missing device id in device name (%s)", sep);
306 int device_count = 0;
307 char fslmc_dirpath[PATH_MAX];
309 struct dirent *entry;
310 static int process_once;
314 DPAA2_BUS_DEBUG("Fslmc bus already scanned. Not rescanning");
319 ret = fslmc_get_container_group(&groupid);
323 /* Scan devices on the group */
324 sprintf(fslmc_dirpath, "%s/%s", SYSFS_FSL_MC_DEVICES, fslmc_container);
325 dir = opendir(fslmc_dirpath);
327 DPAA2_BUS_ERR("Unable to open VFIO group directory");
331 while ((entry = readdir(dir)) != NULL) {
332 if (entry->d_name[0] == '.' || entry->d_type != DT_DIR)
335 ret = scan_one_fslmc_device(entry->d_name);
337 /* Error in parsing directory - exit gracefully */
338 goto scan_fail_cleanup;
345 DPAA2_BUS_INFO("FSLMC Bus scan completed");
346 /* If debugging is enabled, device list is dumped to log output */
354 /* Remove all devices in the list */
355 cleanup_fslmc_device_list();
357 DPAA2_BUS_DEBUG("FSLMC Bus Not Available. Skipping (%d)", ret);
358 /* Irrespective of failure, scan only return success */
363 rte_fslmc_match(struct rte_dpaa2_driver *dpaa2_drv,
364 struct rte_dpaa2_device *dpaa2_dev)
366 if (dpaa2_drv->drv_type == dpaa2_dev->dev_type)
373 rte_fslmc_probe(void)
378 struct rte_dpaa2_device *dev;
379 struct rte_dpaa2_driver *drv;
381 static const struct rte_mbuf_dynfield dpaa2_seqn_dynfield_desc = {
382 .name = DPAA2_SEQN_DYNFIELD_NAME,
383 .size = sizeof(dpaa2_seqn_t),
384 .align = __alignof__(dpaa2_seqn_t),
387 if (TAILQ_EMPTY(&rte_fslmc_bus.device_list))
390 dpaa2_seqn_dynfield_offset =
391 rte_mbuf_dynfield_register(&dpaa2_seqn_dynfield_desc);
392 if (dpaa2_seqn_dynfield_offset < 0) {
393 DPAA2_BUS_ERR("Failed to register mbuf field for dpaa sequence number");
397 ret = fslmc_vfio_setup_group();
399 DPAA2_BUS_ERR("Unable to setup VFIO %d", ret);
403 /* Map existing segments as well as, in case of hotpluggable memory,
404 * install callback handler.
406 if (rte_eal_process_type() == RTE_PROC_PRIMARY) {
407 ret = rte_fslmc_vfio_dmamap();
409 DPAA2_BUS_ERR("Unable to DMA map existing VAs: (%d)",
411 /* Not continuing ahead */
412 DPAA2_BUS_ERR("FSLMC VFIO Mapping failed");
417 ret = fslmc_vfio_process_group();
419 DPAA2_BUS_ERR("Unable to setup devices %d", ret);
423 probe_all = rte_fslmc_bus.bus.conf.scan_mode != RTE_BUS_SCAN_ALLOWLIST;
425 /* In case of PA, the FD addresses returned by qbman APIs are physical
426 * addresses, which need conversion into equivalent VA address for
427 * rte_mbuf. For that, a table (a serial array, in memory) is used to
428 * increase translation efficiency.
429 * This has to be done before probe as some device initialization
430 * (during) probe allocate memory (dpaa2_sec) which needs to be pinned
433 * Error is ignored as relevant logs are handled within dpaax and
434 * handling for unavailable dpaax table too is transparent to caller.
436 * And, the IOVA table is only applicable in case of PA mode.
438 if (rte_eal_iova_mode() == RTE_IOVA_PA)
439 dpaax_iova_table_populate();
441 TAILQ_FOREACH(dev, &rte_fslmc_bus.device_list, next) {
442 TAILQ_FOREACH(drv, &rte_fslmc_bus.driver_list, next) {
443 ret = rte_fslmc_match(drv, dev);
450 if (rte_dev_is_probed(&dev->device))
453 if (dev->device.devargs &&
454 dev->device.devargs->policy == RTE_DEV_BLOCKED) {
455 DPAA2_BUS_LOG(DEBUG, "%s Blocked, skipping",
461 (dev->device.devargs &&
462 dev->device.devargs->policy == RTE_DEV_ALLOWED)) {
463 ret = drv->probe(drv, dev);
465 DPAA2_BUS_ERR("Unable to probe");
468 dev->device.driver = &drv->driver;
475 if (rte_eal_iova_mode() == RTE_IOVA_VA)
481 static struct rte_device *
482 rte_fslmc_find_device(const struct rte_device *start, rte_dev_cmp_t cmp,
485 const struct rte_dpaa2_device *dstart;
486 struct rte_dpaa2_device *dev;
488 DPAA2_BUS_DEBUG("Finding a device named %s\n", (const char *)data);
490 /* find_device is always called with an opaque object which should be
491 * passed along to the 'cmp' function iterating over all device obj
496 dstart = RTE_DEV_TO_FSLMC_CONST(start);
497 dev = TAILQ_NEXT(dstart, next);
499 dev = TAILQ_FIRST(&rte_fslmc_bus.device_list);
501 while (dev != NULL) {
502 if (cmp(&dev->device, data) == 0) {
503 DPAA2_BUS_DEBUG("Found device (%s)\n",
507 dev = TAILQ_NEXT(dev, next);
513 /*register a fslmc bus based dpaa2 driver */
515 rte_fslmc_driver_register(struct rte_dpaa2_driver *driver)
519 TAILQ_INSERT_TAIL(&rte_fslmc_bus.driver_list, driver, next);
520 /* Update Bus references */
521 driver->fslmc_bus = &rte_fslmc_bus;
524 /*un-register a fslmc bus based dpaa2 driver */
526 rte_fslmc_driver_unregister(struct rte_dpaa2_driver *driver)
528 struct rte_fslmc_bus *fslmc_bus;
530 fslmc_bus = driver->fslmc_bus;
532 /* Cleanup the PA->VA Translation table; From whereever this function
535 if (rte_eal_iova_mode() == RTE_IOVA_PA)
536 dpaax_iova_table_depopulate();
538 TAILQ_REMOVE(&fslmc_bus->driver_list, driver, next);
539 /* Update Bus references */
540 driver->fslmc_bus = NULL;
544 * All device has iova as va
547 fslmc_all_device_support_iova(void)
550 struct rte_dpaa2_device *dev;
551 struct rte_dpaa2_driver *drv;
553 TAILQ_FOREACH(dev, &rte_fslmc_bus.device_list, next) {
554 TAILQ_FOREACH(drv, &rte_fslmc_bus.driver_list, next) {
555 ret = rte_fslmc_match(drv, dev);
558 /* if the driver is not supporting IOVA */
559 if (!(drv->drv_flags & RTE_DPAA2_DRV_IOVA_AS_VA))
567 * Get iommu class of DPAA2 devices on the bus.
569 static enum rte_iova_mode
570 rte_dpaa2_get_iommu_class(void)
572 bool is_vfio_noiommu_enabled = 1;
575 if (TAILQ_EMPTY(&rte_fslmc_bus.device_list))
578 #ifdef RTE_LIBRTE_DPAA2_USE_PHYS_IOVA
582 /* check if all devices on the bus support Virtual addressing or not */
583 has_iova_va = fslmc_all_device_support_iova();
586 is_vfio_noiommu_enabled = rte_vfio_noiommu_is_enabled() == true ?
590 if (has_iova_va && !is_vfio_noiommu_enabled)
597 fslmc_bus_plug(struct rte_device *dev __rte_unused)
599 /* No operation is performed while plugging the device */
604 fslmc_bus_unplug(struct rte_device *dev __rte_unused)
606 /* No operation is performed while unplugging the device */
611 fslmc_bus_dev_iterate(const void *start, const char *str,
612 const struct rte_dev_iterator *it __rte_unused)
614 const struct rte_dpaa2_device *dstart;
615 struct rte_dpaa2_device *dev;
616 char *dup, *dev_name = NULL;
619 DPAA2_BUS_DEBUG("No device string");
623 /* Expectation is that device would be name=device_name */
624 if (strncmp(str, "name=", 5) != 0) {
625 DPAA2_BUS_DEBUG("Invalid device string (%s)\n", str);
629 /* Now that name=device_name format is available, split */
631 dev_name = dup + strlen("name=");
634 dstart = RTE_DEV_TO_FSLMC_CONST(start);
635 dev = TAILQ_NEXT(dstart, next);
637 dev = TAILQ_FIRST(&rte_fslmc_bus.device_list);
640 while (dev != NULL) {
641 if (strcmp(dev->device.name, dev_name) == 0) {
645 dev = TAILQ_NEXT(dev, next);
652 struct rte_fslmc_bus rte_fslmc_bus = {
654 .scan = rte_fslmc_scan,
655 .probe = rte_fslmc_probe,
656 .parse = rte_fslmc_parse,
657 .find_device = rte_fslmc_find_device,
658 .get_iommu_class = rte_dpaa2_get_iommu_class,
659 .plug = fslmc_bus_plug,
660 .unplug = fslmc_bus_unplug,
661 .dev_iterate = fslmc_bus_dev_iterate,
663 .device_list = TAILQ_HEAD_INITIALIZER(rte_fslmc_bus.device_list),
664 .driver_list = TAILQ_HEAD_INITIALIZER(rte_fslmc_bus.driver_list),
668 RTE_REGISTER_BUS(FSLMC_BUS_NAME, rte_fslmc_bus.bus);
669 RTE_LOG_REGISTER(dpaa2_logtype_bus, bus.fslmc, NOTICE);