6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
10 * * Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * * Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in
14 * the documentation and/or other materials provided with the
16 * * Neither the name of NXP nor the names of its
17 * contributors may be used to endorse or promote products derived
18 * from this software without specific prior written permission.
20 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
21 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
22 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
23 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
24 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
25 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
26 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
27 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
28 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
29 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
30 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
40 #include <sys/types.h>
41 #include <sys/syscall.h>
43 #include <rte_config.h>
44 #include <rte_byteorder.h>
45 #include <rte_common.h>
46 #include <rte_interrupts.h>
48 #include <rte_debug.h>
50 #include <rte_atomic.h>
51 #include <rte_branch_prediction.h>
52 #include <rte_memory.h>
53 #include <rte_memzone.h>
54 #include <rte_tailq.h>
56 #include <rte_alarm.h>
57 #include <rte_ether.h>
58 #include <rte_ethdev.h>
59 #include <rte_malloc.h>
63 #include <rte_dpaa_bus.h>
64 #include <rte_dpaa_logs.h>
73 int dpaa_logtype_mempool;
75 struct rte_dpaa_bus rte_dpaa_bus;
76 struct netcfg_info *dpaa_netcfg;
78 /* define a variable to hold the portal_key, once created.*/
79 pthread_key_t dpaa_portal_key;
81 RTE_DEFINE_PER_LCORE(bool, _dpaa_io);
84 dpaa_add_to_device_list(struct rte_dpaa_device *dev)
86 TAILQ_INSERT_TAIL(&rte_dpaa_bus.device_list, dev, next);
90 dpaa_remove_from_device_list(struct rte_dpaa_device *dev)
92 TAILQ_INSERT_TAIL(&rte_dpaa_bus.device_list, dev, next);
95 static void dpaa_clean_device_list(void);
98 dpaa_create_device_list(void)
102 struct rte_dpaa_device *dev;
103 struct fm_eth_port_cfg *cfg;
104 struct fman_if *fman_intf;
106 /* Creating Ethernet Devices */
107 for (i = 0; i < dpaa_netcfg->num_ethports; i++) {
108 dev = calloc(1, sizeof(struct rte_dpaa_device));
110 DPAA_BUS_LOG(ERR, "Failed to allocate ETH devices");
115 cfg = &dpaa_netcfg->port_cfg[i];
116 fman_intf = cfg->fman_if;
118 /* Device identifiers */
119 dev->id.fman_id = fman_intf->fman_idx + 1;
120 dev->id.mac_id = fman_intf->mac_idx;
121 dev->device_type = FSL_DPAA_ETH;
124 /* Create device name */
125 memset(dev->name, 0, RTE_ETH_NAME_MAX_LEN);
126 sprintf(dev->name, "fm%d-mac%d", (fman_intf->fman_idx + 1),
128 DPAA_BUS_LOG(DEBUG, "Device added: %s", dev->name);
129 dev->device.name = dev->name;
131 dpaa_add_to_device_list(dev);
134 rte_dpaa_bus.device_count = i;
139 dpaa_clean_device_list();
144 dpaa_clean_device_list(void)
146 struct rte_dpaa_device *dev = NULL;
147 struct rte_dpaa_device *tdev = NULL;
149 TAILQ_FOREACH_SAFE(dev, &rte_dpaa_bus.device_list, next, tdev) {
150 TAILQ_REMOVE(&rte_dpaa_bus.device_list, dev, next);
156 /** XXX move this function into a separate file */
158 _dpaa_portal_init(void *arg)
162 uint32_t cpu = rte_lcore_id();
164 struct dpaa_portal *dpaa_io_portal;
166 BUS_INIT_FUNC_TRACE();
168 if ((uint64_t)arg == 1 || cpu == LCORE_ID_ANY)
169 cpu = rte_get_master_lcore();
170 /* if the core id is not supported */
172 if (cpu >= RTE_MAX_LCORE)
175 /* Set CPU affinity for this thread */
177 CPU_SET(cpu, &cpuset);
179 ret = pthread_setaffinity_np(id, sizeof(cpu_set_t), &cpuset);
181 DPAA_BUS_LOG(ERR, "pthread_setaffinity_np failed on "
182 "core :%d with ret: %d", cpu, ret);
186 /* Initialise bman thread portals */
187 ret = bman_thread_init();
189 DPAA_BUS_LOG(ERR, "bman_thread_init failed on "
190 "core %d with ret: %d", cpu, ret);
194 DPAA_BUS_LOG(DEBUG, "BMAN thread initialized");
196 /* Initialise qman thread portals */
197 ret = qman_thread_init();
199 DPAA_BUS_LOG(ERR, "bman_thread_init failed on "
200 "core %d with ret: %d", cpu, ret);
201 bman_thread_finish();
205 DPAA_BUS_LOG(DEBUG, "QMAN thread initialized");
207 dpaa_io_portal = rte_malloc(NULL, sizeof(struct dpaa_portal),
208 RTE_CACHE_LINE_SIZE);
209 if (!dpaa_io_portal) {
210 DPAA_BUS_LOG(ERR, "Unable to allocate memory");
211 bman_thread_finish();
212 qman_thread_finish();
216 dpaa_io_portal->qman_idx = qman_get_portal_index();
217 dpaa_io_portal->bman_idx = bman_get_portal_index();
218 dpaa_io_portal->tid = syscall(SYS_gettid);
220 ret = pthread_setspecific(dpaa_portal_key, (void *)dpaa_io_portal);
222 DPAA_BUS_LOG(ERR, "pthread_setspecific failed on "
223 "core %d with ret: %d", cpu, ret);
224 dpaa_portal_finish(NULL);
229 RTE_PER_LCORE(_dpaa_io) = true;
231 DPAA_BUS_LOG(DEBUG, "QMAN thread initialized");
237 * rte_dpaa_portal_init - Wrapper over _dpaa_portal_init with thread level check
241 rte_dpaa_portal_init(void *arg)
243 if (unlikely(!RTE_PER_LCORE(_dpaa_io)))
244 return _dpaa_portal_init(arg);
250 dpaa_portal_finish(void *arg)
252 struct dpaa_portal *dpaa_io_portal = (struct dpaa_portal *)arg;
254 if (!dpaa_io_portal) {
255 DPAA_BUS_LOG(DEBUG, "Portal already cleaned");
259 bman_thread_finish();
260 qman_thread_finish();
262 pthread_setspecific(dpaa_portal_key, NULL);
264 rte_free(dpaa_io_portal);
265 dpaa_io_portal = NULL;
267 RTE_PER_LCORE(_dpaa_io) = false;
270 #define DPAA_DEV_PATH1 "/sys/devices/platform/soc/soc:fsl,dpaa"
271 #define DPAA_DEV_PATH2 "/sys/devices/platform/fsl,dpaa"
274 rte_dpaa_bus_scan(void)
278 BUS_INIT_FUNC_TRACE();
280 if ((access(DPAA_DEV_PATH1, F_OK) != 0) &&
281 (access(DPAA_DEV_PATH2, F_OK) != 0)) {
282 RTE_LOG(DEBUG, EAL, "DPAA Bus not present. Skipping.\n");
286 /* Load the device-tree driver */
289 DPAA_BUS_LOG(ERR, "of_init failed with ret: %d", ret);
293 /* Get the interface configurations from device-tree */
294 dpaa_netcfg = netcfg_acquire();
296 DPAA_BUS_LOG(ERR, "netcfg_acquire failed");
300 RTE_LOG(NOTICE, EAL, "DPAA Bus Detected\n");
302 if (!dpaa_netcfg->num_ethports) {
303 DPAA_BUS_LOG(INFO, "no network interfaces available");
304 /* This is not an error */
308 DPAA_BUS_LOG(DEBUG, "Bus: Address of netcfg=%p, Ethports=%d",
309 dpaa_netcfg, dpaa_netcfg->num_ethports);
311 #ifdef RTE_LIBRTE_DPAA_DEBUG_DRIVER
312 dump_netcfg(dpaa_netcfg);
315 DPAA_BUS_LOG(DEBUG, "Number of devices = %d\n",
316 dpaa_netcfg->num_ethports);
317 ret = dpaa_create_device_list();
319 DPAA_BUS_LOG(ERR, "Unable to create device list. (%d)", ret);
323 /* create the key, supplying a function that'll be invoked
324 * when a portal affined thread will be deleted.
326 ret = pthread_key_create(&dpaa_portal_key, dpaa_portal_finish);
328 DPAA_BUS_LOG(DEBUG, "Unable to create pthread key. (%d)", ret);
329 dpaa_clean_device_list();
333 DPAA_BUS_LOG(DEBUG, "dpaa_portal_key=%u, ret=%d\n",
334 (unsigned int)dpaa_portal_key, ret);
339 /* register a dpaa bus based dpaa driver */
341 rte_dpaa_driver_register(struct rte_dpaa_driver *driver)
345 BUS_INIT_FUNC_TRACE();
347 TAILQ_INSERT_TAIL(&rte_dpaa_bus.driver_list, driver, next);
348 /* Update Bus references */
349 driver->dpaa_bus = &rte_dpaa_bus;
352 /* un-register a dpaa bus based dpaa driver */
354 rte_dpaa_driver_unregister(struct rte_dpaa_driver *driver)
356 struct rte_dpaa_bus *dpaa_bus;
358 BUS_INIT_FUNC_TRACE();
360 dpaa_bus = driver->dpaa_bus;
362 TAILQ_REMOVE(&dpaa_bus->driver_list, driver, next);
363 /* Update Bus references */
364 driver->dpaa_bus = NULL;
368 rte_dpaa_device_match(struct rte_dpaa_driver *drv,
369 struct rte_dpaa_device *dev)
373 BUS_INIT_FUNC_TRACE();
376 DPAA_BUS_DEBUG("Invalid drv or dev received.");
380 if (drv->drv_type == dev->device_type) {
381 DPAA_BUS_INFO("Device: %s matches for driver: %s",
382 dev->name, drv->driver.name);
383 ret = 0; /* Found a match */
390 rte_dpaa_bus_probe(void)
393 struct rte_dpaa_device *dev;
394 struct rte_dpaa_driver *drv;
396 BUS_INIT_FUNC_TRACE();
398 /* For each registered driver, and device, call the driver->probe */
399 TAILQ_FOREACH(dev, &rte_dpaa_bus.device_list, next) {
400 TAILQ_FOREACH(drv, &rte_dpaa_bus.driver_list, next) {
401 ret = rte_dpaa_device_match(drv, dev);
408 ret = drv->probe(drv, dev);
410 DPAA_BUS_ERR("Unable to probe.\n");
417 static struct rte_device *
418 rte_dpaa_find_device(const struct rte_device *start, rte_dev_cmp_t cmp,
421 struct rte_dpaa_device *dev;
423 TAILQ_FOREACH(dev, &rte_dpaa_bus.device_list, next) {
424 if (start && &dev->device == start) {
425 start = NULL; /* starting point found */
429 if (cmp(&dev->device, data) == 0)
436 struct rte_dpaa_bus rte_dpaa_bus = {
438 .scan = rte_dpaa_bus_scan,
439 .probe = rte_dpaa_bus_probe,
440 .find_device = rte_dpaa_find_device,
442 .device_list = TAILQ_HEAD_INITIALIZER(rte_dpaa_bus.device_list),
443 .driver_list = TAILQ_HEAD_INITIALIZER(rte_dpaa_bus.driver_list),
447 RTE_REGISTER_BUS(FSL_DPAA_BUS_NAME, rte_dpaa_bus.bus);
449 RTE_INIT(dpaa_init_log);
453 dpaa_logtype_bus = rte_log_register("bus.dpaa");
454 if (dpaa_logtype_bus >= 0)
455 rte_log_set_level(dpaa_logtype_bus, RTE_LOG_NOTICE);
457 dpaa_logtype_mempool = rte_log_register("mempool.dpaa");
458 if (dpaa_logtype_mempool >= 0)
459 rte_log_set_level(dpaa_logtype_mempool, RTE_LOG_NOTICE);