1 /* SPDX-License-Identifier: BSD-3-Clause
2 * Copyright 2018 Gaëtan Rivet
3 */
4
5 #include <sys/queue.h>
6
7 #include <bus_driver.h>
8 #include <rte_bus_pci.h>
9 #include <dev_driver.h>
10 #include <rte_errno.h>
11 #include <rte_kvargs.h>
12 #include <rte_devargs.h>
13 #include <rte_pci.h>
14 #include <rte_debug.h>
15
16 #include "private.h"
17
18 enum pci_params {
19 RTE_PCI_PARAM_ADDR,
20 RTE_PCI_PARAM_MAX,
21 };
22
23 static const char * const pci_params_keys[] = {
24 [RTE_PCI_PARAM_ADDR] = "addr",
25 [RTE_PCI_PARAM_MAX] = NULL,
26 };
27
28 static int
pci_addr_kv_cmp(const char * key __rte_unused,const char * value,void * _addr2)29 pci_addr_kv_cmp(const char *key __rte_unused,
30 const char *value,
31 void *_addr2)
32 {
33 struct rte_pci_addr _addr1;
34 struct rte_pci_addr *addr1 = &_addr1;
35 struct rte_pci_addr *addr2 = _addr2;
36
37 if (rte_pci_addr_parse(value, addr1))
38 return -1;
39 return -abs(rte_pci_addr_cmp(addr1, addr2));
40 }
41
42 static int
pci_dev_match(const struct rte_device * dev,const void * _kvlist)43 pci_dev_match(const struct rte_device *dev,
44 const void *_kvlist)
45 {
46 const struct rte_kvargs *kvlist = _kvlist;
47 const struct rte_pci_device *pdev;
48
49 if (kvlist == NULL)
50 /* Empty string matches everything. */
51 return 0;
52 pdev = RTE_DEV_TO_PCI_CONST(dev);
53 /* if any field does not match. */
54 if (rte_kvargs_process(kvlist, pci_params_keys[RTE_PCI_PARAM_ADDR],
55 &pci_addr_kv_cmp,
56 (void *)(intptr_t)&pdev->addr))
57 return 1;
58 return 0;
59 }
60
61 void *
rte_pci_dev_iterate(const void * start,const char * str,const struct rte_dev_iterator * it __rte_unused)62 rte_pci_dev_iterate(const void *start,
63 const char *str,
64 const struct rte_dev_iterator *it __rte_unused)
65 {
66 rte_bus_find_device_t find_device;
67 struct rte_kvargs *kvargs = NULL;
68 struct rte_device *dev;
69
70 if (str != NULL) {
71 kvargs = rte_kvargs_parse(str, pci_params_keys);
72 if (kvargs == NULL) {
73 PCI_LOG(ERR, "cannot parse argument list");
74 rte_errno = EINVAL;
75 return NULL;
76 }
77 }
78 find_device = rte_pci_bus.bus.find_device;
79 dev = find_device(start, pci_dev_match, kvargs);
80 rte_kvargs_free(kvargs);
81 return dev;
82 }
83
84 int
rte_pci_devargs_parse(struct rte_devargs * da)85 rte_pci_devargs_parse(struct rte_devargs *da)
86 {
87 struct rte_kvargs *kvargs;
88 const char *addr_str;
89 struct rte_pci_addr addr;
90 int ret = 0;
91
92 if (da == NULL || da->bus_str == NULL)
93 return 0;
94
95 kvargs = rte_kvargs_parse(da->bus_str, NULL);
96 if (kvargs == NULL) {
97 PCI_LOG(ERR, "cannot parse argument list: %s", da->bus_str);
98 ret = -ENODEV;
99 goto out;
100 }
101
102 addr_str = rte_kvargs_get(kvargs, pci_params_keys[RTE_PCI_PARAM_ADDR]);
103 if (addr_str == NULL) {
104 PCI_LOG(DEBUG, "No PCI address specified using '%s=<id>' in: %s",
105 pci_params_keys[RTE_PCI_PARAM_ADDR], da->bus_str);
106 goto out;
107 }
108
109 ret = rte_pci_addr_parse(addr_str, &addr);
110 if (ret != 0) {
111 PCI_LOG(ERR, "PCI address invalid: %s", da->bus_str);
112 ret = -EINVAL;
113 goto out;
114 }
115
116 rte_pci_device_name(&addr, da->name, sizeof(da->name));
117
118 out:
119 rte_kvargs_free(kvargs);
120 if (ret != 0)
121 rte_errno = -ret;
122 return ret;
123 }
124