Branch data Line data Source code
1 : : /* SPDX-License-Identifier: BSD-3-Clause
2 : : * Copyright(c) 2018 Vladimir Medvedkin <medvedkinv@gmail.com>
3 : : * Copyright(c) 2019 Intel Corporation
4 : : */
5 : :
6 : : #include <stdint.h>
7 : : #include <string.h>
8 : : #include <sys/queue.h>
9 : :
10 : : #include <rte_eal_memconfig.h>
11 : : #include <rte_tailq.h>
12 : : #include <rte_errno.h>
13 : : #include <rte_log.h>
14 : : #include <rte_malloc.h>
15 : : #include <rte_string_fns.h>
16 : :
17 : : #include <rte_rib6.h>
18 : : #include <rte_fib6.h>
19 : :
20 : : #include "trie.h"
21 : : #include "fib_log.h"
22 : :
23 : : TAILQ_HEAD(rte_fib6_list, rte_tailq_entry);
24 : : static struct rte_tailq_elem rte_fib6_tailq = {
25 : : .name = "RTE_FIB6",
26 : : };
27 [ - + ]: 238 : EAL_REGISTER_TAILQ(rte_fib6_tailq)
28 : :
29 : : /* Maximum length of a FIB name. */
30 : : #define FIB6_NAMESIZE 64
31 : :
32 : : #if defined(RTE_LIBRTE_FIB_DEBUG)
33 : : #define FIB6_RETURN_IF_TRUE(cond, retval) do { \
34 : : if (cond) \
35 : : return retval; \
36 : : } while (0)
37 : : #else
38 : : #define FIB6_RETURN_IF_TRUE(cond, retval)
39 : : #endif
40 : :
41 : : struct rte_fib6 {
42 : : char name[FIB6_NAMESIZE];
43 : : enum rte_fib6_type type; /**< Type of FIB struct */
44 : : struct rte_rib6 *rib; /**< RIB helper datastructure */
45 : : void *dp; /**< pointer to the dataplane struct*/
46 : : rte_fib6_lookup_fn_t lookup; /**< FIB lookup function */
47 : : rte_fib6_modify_fn_t modify; /**< modify FIB datastructure */
48 : : uint64_t def_nh;
49 : : };
50 : :
51 : : static void
52 : 1026 : dummy_lookup(void *fib_p, uint8_t ips[][RTE_FIB6_IPV6_ADDR_SIZE],
53 : : uint64_t *next_hops, const unsigned int n)
54 : : {
55 : : unsigned int i;
56 : : struct rte_fib6 *fib = fib_p;
57 : : struct rte_rib6_node *node;
58 : :
59 [ + + ]: 67203 : for (i = 0; i < n; i++) {
60 : 66177 : node = rte_rib6_lookup(fib->rib, ips[i]);
61 [ + + ]: 66177 : if (node != NULL)
62 : 49024 : rte_rib6_get_nh(node, &next_hops[i]);
63 : : else
64 : 17153 : next_hops[i] = fib->def_nh;
65 : : }
66 : 1026 : }
67 : :
68 : : static int
69 : 512 : dummy_modify(struct rte_fib6 *fib, const uint8_t ip[RTE_FIB6_IPV6_ADDR_SIZE],
70 : : uint8_t depth, uint64_t next_hop, int op)
71 : : {
72 : : struct rte_rib6_node *node;
73 [ + - ]: 512 : if ((fib == NULL) || (depth > RTE_FIB6_MAXDEPTH))
74 : : return -EINVAL;
75 : :
76 : 512 : node = rte_rib6_lookup_exact(fib->rib, ip, depth);
77 : :
78 [ + + - ]: 512 : switch (op) {
79 : 256 : case RTE_FIB6_ADD:
80 [ + - ]: 256 : if (node == NULL)
81 : 256 : node = rte_rib6_insert(fib->rib, ip, depth);
82 [ - + ]: 256 : if (node == NULL)
83 : 0 : return -rte_errno;
84 : 256 : return rte_rib6_set_nh(node, next_hop);
85 : 256 : case RTE_FIB6_DEL:
86 [ + - ]: 256 : if (node == NULL)
87 : : return -ENOENT;
88 : 256 : rte_rib6_remove(fib->rib, ip, depth);
89 : 256 : return 0;
90 : : }
91 : : return -EINVAL;
92 : : }
93 : :
94 : : static int
95 [ + + - ]: 8 : init_dataplane(struct rte_fib6 *fib, __rte_unused int socket_id,
96 : : struct rte_fib6_conf *conf)
97 : : {
98 : : char dp_name[sizeof(void *)];
99 : :
100 : : snprintf(dp_name, sizeof(dp_name), "%p", fib);
101 [ + + - ]: 8 : switch (conf->type) {
102 : 3 : case RTE_FIB6_DUMMY:
103 : 3 : fib->dp = fib;
104 : 3 : fib->lookup = dummy_lookup;
105 : 3 : fib->modify = dummy_modify;
106 : 3 : return 0;
107 : 5 : case RTE_FIB6_TRIE:
108 : 5 : fib->dp = trie_create(dp_name, socket_id, conf);
109 [ + + ]: 5 : if (fib->dp == NULL)
110 : 2 : return -rte_errno;
111 : 3 : fib->lookup = trie_get_lookup_fn(fib->dp, RTE_FIB6_LOOKUP_DEFAULT);
112 : 3 : fib->modify = trie_modify;
113 : 3 : return 0;
114 : : default:
115 : : return -EINVAL;
116 : : }
117 : : return 0;
118 : : }
119 : :
120 : : int
121 : 1026 : rte_fib6_add(struct rte_fib6 *fib, const uint8_t ip[RTE_FIB6_IPV6_ADDR_SIZE],
122 : : uint8_t depth, uint64_t next_hop)
123 : : {
124 [ + + + - : 1026 : if ((fib == NULL) || (ip == NULL) || (fib->modify == NULL) ||
+ + ]
125 : : (depth > RTE_FIB6_MAXDEPTH))
126 : : return -EINVAL;
127 : 1024 : return fib->modify(fib, ip, depth, next_hop, RTE_FIB6_ADD);
128 : : }
129 : :
130 : : int
131 : 1026 : rte_fib6_delete(struct rte_fib6 *fib, const uint8_t ip[RTE_FIB6_IPV6_ADDR_SIZE],
132 : : uint8_t depth)
133 : : {
134 [ + + + - : 1026 : if ((fib == NULL) || (ip == NULL) || (fib->modify == NULL) ||
+ + ]
135 : : (depth > RTE_FIB6_MAXDEPTH))
136 : : return -EINVAL;
137 : 1024 : return fib->modify(fib, ip, depth, 0, RTE_FIB6_DEL);
138 : : }
139 : :
140 : : int
141 : 4104 : rte_fib6_lookup_bulk(struct rte_fib6 *fib,
142 : : uint8_t ips[][RTE_FIB6_IPV6_ADDR_SIZE],
143 : : uint64_t *next_hops, int n)
144 : : {
145 : : FIB6_RETURN_IF_TRUE((fib == NULL) || (ips == NULL) ||
146 : : (next_hops == NULL) || (fib->lookup == NULL), -EINVAL);
147 : 4104 : fib->lookup(fib->dp, ips, next_hops, n);
148 : 4104 : return 0;
149 : : }
150 : :
151 : : struct rte_fib6 *
152 : 13 : rte_fib6_create(const char *name, int socket_id, struct rte_fib6_conf *conf)
153 : : {
154 : : char mem_name[FIB6_NAMESIZE];
155 : : int ret;
156 : : struct rte_fib6 *fib = NULL;
157 : : struct rte_rib6 *rib = NULL;
158 : : struct rte_tailq_entry *te;
159 : : struct rte_fib6_list *fib_list;
160 : : struct rte_rib6_conf rib_conf;
161 : :
162 : : /* Check user arguments. */
163 [ + + + - ]: 13 : if ((name == NULL) || (conf == NULL) || (conf->max_routes < 0) ||
164 [ + + ]: 11 : (conf->type > RTE_FIB6_TRIE)) {
165 : 3 : rte_errno = EINVAL;
166 : 3 : return NULL;
167 : : }
168 : :
169 : 10 : rib_conf.ext_sz = conf->rib_ext_sz;
170 : 10 : rib_conf.max_nodes = conf->max_routes * 2;
171 : :
172 : 10 : rib = rte_rib6_create(name, socket_id, &rib_conf);
173 [ + + ]: 10 : if (rib == NULL) {
174 : 2 : FIB_LOG(ERR,
175 : : "Can not allocate RIB %s", name);
176 : 2 : return NULL;
177 : : }
178 : :
179 : : snprintf(mem_name, sizeof(mem_name), "FIB6_%s", name);
180 : 8 : fib_list = RTE_TAILQ_CAST(rte_fib6_tailq.head, rte_fib6_list);
181 : :
182 : 8 : rte_mcfg_tailq_write_lock();
183 : :
184 : : /* guarantee there's no existing */
185 [ - + ]: 8 : TAILQ_FOREACH(te, fib_list, next) {
186 : 0 : fib = (struct rte_fib6 *)te->data;
187 [ # # ]: 0 : if (strncmp(name, fib->name, FIB6_NAMESIZE) == 0)
188 : : break;
189 : : }
190 : : fib = NULL;
191 [ - + ]: 8 : if (te != NULL) {
192 : 0 : rte_errno = EEXIST;
193 : 0 : goto exit;
194 : : }
195 : :
196 : : /* allocate tailq entry */
197 : 8 : te = rte_zmalloc("FIB_TAILQ_ENTRY", sizeof(*te), 0);
198 [ - + ]: 8 : if (te == NULL) {
199 : 0 : FIB_LOG(ERR,
200 : : "Can not allocate tailq entry for FIB %s", name);
201 : 0 : rte_errno = ENOMEM;
202 : 0 : goto exit;
203 : : }
204 : :
205 : : /* Allocate memory to store the FIB data structures. */
206 : 8 : fib = rte_zmalloc_socket(mem_name,
207 : : sizeof(struct rte_fib6), RTE_CACHE_LINE_SIZE, socket_id);
208 [ - + ]: 8 : if (fib == NULL) {
209 : 0 : FIB_LOG(ERR, "FIB %s memory allocation failed", name);
210 : 0 : rte_errno = ENOMEM;
211 : 0 : goto free_te;
212 : : }
213 : :
214 : 8 : rte_strlcpy(fib->name, name, sizeof(fib->name));
215 : 8 : fib->rib = rib;
216 : 8 : fib->type = conf->type;
217 : 8 : fib->def_nh = conf->default_nh;
218 : 8 : ret = init_dataplane(fib, socket_id, conf);
219 [ + + ]: 8 : if (ret < 0) {
220 : 2 : FIB_LOG(ERR,
221 : : "FIB dataplane struct %s memory allocation failed",
222 : : name);
223 : 2 : rte_errno = -ret;
224 : 2 : goto free_fib;
225 : : }
226 : :
227 : 6 : te->data = (void *)fib;
228 : 6 : TAILQ_INSERT_TAIL(fib_list, te, next);
229 : :
230 : 6 : rte_mcfg_tailq_write_unlock();
231 : :
232 : 6 : return fib;
233 : :
234 : : free_fib:
235 : 2 : rte_free(fib);
236 : 2 : free_te:
237 : 2 : rte_free(te);
238 : 2 : exit:
239 : 2 : rte_mcfg_tailq_write_unlock();
240 : 2 : rte_rib6_free(rib);
241 : :
242 : 2 : return NULL;
243 : : }
244 : :
245 : : struct rte_fib6 *
246 : 0 : rte_fib6_find_existing(const char *name)
247 : : {
248 : : struct rte_fib6 *fib = NULL;
249 : : struct rte_tailq_entry *te;
250 : : struct rte_fib6_list *fib_list;
251 : :
252 : 0 : fib_list = RTE_TAILQ_CAST(rte_fib6_tailq.head, rte_fib6_list);
253 : :
254 : 0 : rte_mcfg_tailq_read_lock();
255 [ # # ]: 0 : TAILQ_FOREACH(te, fib_list, next) {
256 : 0 : fib = (struct rte_fib6 *) te->data;
257 [ # # ]: 0 : if (strncmp(name, fib->name, FIB6_NAMESIZE) == 0)
258 : : break;
259 : : }
260 : 0 : rte_mcfg_tailq_read_unlock();
261 : :
262 [ # # ]: 0 : if (te == NULL) {
263 : 0 : rte_errno = ENOENT;
264 : 0 : return NULL;
265 : : }
266 : :
267 : : return fib;
268 : : }
269 : :
270 : : static void
271 : : free_dataplane(struct rte_fib6 *fib)
272 : : {
273 [ + + ]: 6 : switch (fib->type) {
274 : : case RTE_FIB6_DUMMY:
275 : : return;
276 : 3 : case RTE_FIB6_TRIE:
277 : 3 : trie_free(fib->dp);
278 : : default:
279 : : return;
280 : : }
281 : : }
282 : :
283 : : void
284 : 7 : rte_fib6_free(struct rte_fib6 *fib)
285 : : {
286 : : struct rte_tailq_entry *te;
287 : : struct rte_fib6_list *fib_list;
288 : :
289 [ + + ]: 7 : if (fib == NULL)
290 : : return;
291 : :
292 : 6 : fib_list = RTE_TAILQ_CAST(rte_fib6_tailq.head, rte_fib6_list);
293 : :
294 : 6 : rte_mcfg_tailq_write_lock();
295 : :
296 : : /* find our tailq entry */
297 [ + - ]: 6 : TAILQ_FOREACH(te, fib_list, next) {
298 [ - + ]: 6 : if (te->data == (void *)fib)
299 : : break;
300 : : }
301 [ + - ]: 6 : if (te != NULL)
302 [ - + ]: 6 : TAILQ_REMOVE(fib_list, te, next);
303 : :
304 : 6 : rte_mcfg_tailq_write_unlock();
305 : :
306 : : free_dataplane(fib);
307 : 6 : rte_rib6_free(fib->rib);
308 : 6 : rte_free(fib);
309 : 6 : rte_free(te);
310 : : }
311 : :
312 : : void *
313 : 1537 : rte_fib6_get_dp(struct rte_fib6 *fib)
314 : : {
315 [ + + ]: 1537 : return (fib == NULL) ? NULL : fib->dp;
316 : : }
317 : :
318 : : struct rte_rib6 *
319 : 1537 : rte_fib6_get_rib(struct rte_fib6 *fib)
320 : : {
321 [ + + ]: 1537 : return (fib == NULL) ? NULL : fib->rib;
322 : : }
323 : :
324 : : int
325 : 0 : rte_fib6_select_lookup(struct rte_fib6 *fib,
326 : : enum rte_fib6_lookup_type type)
327 : : {
328 : : rte_fib6_lookup_fn_t fn;
329 : :
330 [ # # ]: 0 : switch (fib->type) {
331 : 0 : case RTE_FIB6_TRIE:
332 : 0 : fn = trie_get_lookup_fn(fib->dp, type);
333 [ # # ]: 0 : if (fn == NULL)
334 : : return -EINVAL;
335 : 0 : fib->lookup = fn;
336 : 0 : return 0;
337 : : default:
338 : : return -EINVAL;
339 : : }
340 : : }
|