]> git.proxmox.com Git - mirror_iproute2.git/blob - devlink/devlink.c
projects / mirror_iproute2.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
devlink: Fix error reporting in cmd_resource_set()
[mirror_iproute2.git] / devlink / devlink.c
1 /*
2 * devlink.c Devlink tool
3 *
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version
7 * 2 of the License, or (at your option) any later version.
8 *
9 * Authors: Jiri Pirko <jiri@mellanox.com>
10 */
11
12 #include <stdio.h>
13 #include <stdlib.h>
14 #include <string.h>
15 #include <stdbool.h>
16 #include <unistd.h>
17 #include <getopt.h>
18 #include <limits.h>
19 #include <errno.h>
20 #include <inttypes.h>
21 #include <linux/genetlink.h>
22 #include <linux/devlink.h>
23 #include <libmnl/libmnl.h>
24 #include <netinet/ether.h>
25
26 #include "SNAPSHOT.h"
27 #include "list.h"
28 #include "mnlg.h"
29 #include "json_writer.h"
30 #include "utils.h"
31
32 #define ESWITCH_MODE_LEGACY "legacy"
33 #define ESWITCH_MODE_SWITCHDEV "switchdev"
34 #define ESWITCH_INLINE_MODE_NONE "none"
35 #define ESWITCH_INLINE_MODE_LINK "link"
36 #define ESWITCH_INLINE_MODE_NETWORK "network"
37 #define ESWITCH_INLINE_MODE_TRANSPORT "transport"
38
39 #define PARAM_CMODE_RUNTIME_STR "runtime"
40 #define PARAM_CMODE_DRIVERINIT_STR "driverinit"
41 #define PARAM_CMODE_PERMANENT_STR "permanent"
42
43 static int g_new_line_count;
44
45 #define pr_err(args...) fprintf(stderr, ##args)
46 #define pr_out(args...) \
47 do { \
48 if (g_indent_newline) { \
49 fprintf(stdout, "%s", g_indent_str); \
50 g_indent_newline = false; \
51 } \
52 fprintf(stdout, ##args); \
53 g_new_line_count = 0; \
54 } while (0)
55
56 #define pr_out_sp(num, args...) \
57 do { \
58 int ret = fprintf(stdout, ##args); \
59 if (ret < num) \
60 fprintf(stdout, "%*s", num - ret, ""); \
61 g_new_line_count = 0; \
62 } while (0)
63
64 static int g_indent_level;
65 static bool g_indent_newline;
66 #define INDENT_STR_STEP 2
67 #define INDENT_STR_MAXLEN 32
68 static char g_indent_str[INDENT_STR_MAXLEN + 1] = "";
69
70 static void __pr_out_indent_inc(void)
71 {
72 if (g_indent_level + INDENT_STR_STEP > INDENT_STR_MAXLEN)
73 return;
74 g_indent_level += INDENT_STR_STEP;
75 memset(g_indent_str, ' ', sizeof(g_indent_str));
76 g_indent_str[g_indent_level] = '\0';
77 }
78
79 static void __pr_out_indent_dec(void)
80 {
81 if (g_indent_level - INDENT_STR_STEP < 0)
82 return;
83 g_indent_level -= INDENT_STR_STEP;
84 g_indent_str[g_indent_level] = '\0';
85 }
86
87 static void __pr_out_newline(void)
88 {
89 if (g_new_line_count < 1) {
90 pr_out("\n");
91 g_indent_newline = true;
92 }
93 g_new_line_count++;
94 }
95
96 static int _mnlg_socket_recv_run(struct mnlg_socket *nlg,
97 mnl_cb_t data_cb, void *data)
98 {
99 int err;
100
101 err = mnlg_socket_recv_run(nlg, data_cb, data);
102 if (err < 0) {
103 pr_err("devlink answers: %s\n", strerror(errno));
104 return -errno;
105 }
106 return 0;
107 }
108
109 static int _mnlg_socket_sndrcv(struct mnlg_socket *nlg,
110 const struct nlmsghdr *nlh,
111 mnl_cb_t data_cb, void *data)
112 {
113 int err;
114
115 err = mnlg_socket_send(nlg, nlh);
116 if (err < 0) {
117 pr_err("Failed to call mnlg_socket_send\n");
118 return -errno;
119 }
120 return _mnlg_socket_recv_run(nlg, data_cb, data);
121 }
122
123 static int _mnlg_socket_group_add(struct mnlg_socket *nlg,
124 const char *group_name)
125 {
126 int err;
127
128 err = mnlg_socket_group_add(nlg, group_name);
129 if (err < 0) {
130 pr_err("Failed to call mnlg_socket_group_add\n");
131 return -errno;
132 }
133 return 0;
134 }
135
136 struct ifname_map {
137 struct list_head list;
138 char *bus_name;
139 char *dev_name;
140 uint32_t port_index;
141 char *ifname;
142 };
143
144 static struct ifname_map *ifname_map_alloc(const char *bus_name,
145 const char *dev_name,
146 uint32_t port_index,
147 const char *ifname)
148 {
149 struct ifname_map *ifname_map;
150
151 ifname_map = calloc(1, sizeof(*ifname_map));
152 if (!ifname_map)
153 return NULL;
154 ifname_map->bus_name = strdup(bus_name);
155 ifname_map->dev_name = strdup(dev_name);
156 ifname_map->port_index = port_index;
157 ifname_map->ifname = strdup(ifname);
158 if (!ifname_map->bus_name || !ifname_map->dev_name ||
159 !ifname_map->ifname) {
160 free(ifname_map->ifname);
161 free(ifname_map->dev_name);
162 free(ifname_map->bus_name);
163 free(ifname_map);
164 return NULL;
165 }
166 return ifname_map;
167 }
168
169 static void ifname_map_free(struct ifname_map *ifname_map)
170 {
171 free(ifname_map->ifname);
172 free(ifname_map->dev_name);
173 free(ifname_map->bus_name);
174 free(ifname_map);
175 }
176
177 #define DL_OPT_HANDLE BIT(0)
178 #define DL_OPT_HANDLEP BIT(1)
179 #define DL_OPT_PORT_TYPE BIT(2)
180 #define DL_OPT_PORT_COUNT BIT(3)
181 #define DL_OPT_SB BIT(4)
182 #define DL_OPT_SB_POOL BIT(5)
183 #define DL_OPT_SB_SIZE BIT(6)
184 #define DL_OPT_SB_TYPE BIT(7)
185 #define DL_OPT_SB_THTYPE BIT(8)
186 #define DL_OPT_SB_TH BIT(9)
187 #define DL_OPT_SB_TC BIT(10)
188 #define DL_OPT_ESWITCH_MODE BIT(11)
189 #define DL_OPT_ESWITCH_INLINE_MODE BIT(12)
190 #define DL_OPT_DPIPE_TABLE_NAME BIT(13)
191 #define DL_OPT_DPIPE_TABLE_COUNTERS BIT(14)
192 #define DL_OPT_ESWITCH_ENCAP_MODE BIT(15)
193 #define DL_OPT_RESOURCE_PATH BIT(16)
194 #define DL_OPT_RESOURCE_SIZE BIT(17)
195 #define DL_OPT_PARAM_NAME BIT(18)
196 #define DL_OPT_PARAM_VALUE BIT(19)
197 #define DL_OPT_PARAM_CMODE BIT(20)
198 #define DL_OPT_HANDLE_REGION BIT(21)
199 #define DL_OPT_REGION_SNAPSHOT_ID BIT(22)
200 #define DL_OPT_REGION_ADDRESS BIT(23)
201 #define DL_OPT_REGION_LENGTH BIT(24)
202
203 struct dl_opts {
204 uint32_t present; /* flags of present items */
205 char *bus_name;
206 char *dev_name;
207 uint32_t port_index;
208 enum devlink_port_type port_type;
209 uint32_t port_count;
210 uint32_t sb_index;
211 uint16_t sb_pool_index;
212 uint32_t sb_pool_size;
213 enum devlink_sb_pool_type sb_pool_type;
214 enum devlink_sb_threshold_type sb_pool_thtype;
215 uint32_t sb_threshold;
216 uint16_t sb_tc_index;
217 enum devlink_eswitch_mode eswitch_mode;
218 enum devlink_eswitch_inline_mode eswitch_inline_mode;
219 const char *dpipe_table_name;
220 bool dpipe_counters_enable;
221 bool eswitch_encap_mode;
222 const char *resource_path;
223 uint32_t resource_size;
224 uint32_t resource_id;
225 bool resource_id_valid;
226 const char *param_name;
227 const char *param_value;
228 enum devlink_param_cmode cmode;
229 char *region_name;
230 uint32_t region_snapshot_id;
231 uint64_t region_address;
232 uint64_t region_length;
233 };
234
235 struct dl {
236 struct mnlg_socket *nlg;
237 struct list_head ifname_map_list;
238 int argc;
239 char **argv;
240 bool no_nice_names;
241 struct dl_opts opts;
242 json_writer_t *jw;
243 bool json_output;
244 bool pretty_output;
245 bool verbose;
246 struct {
247 bool present;
248 char *bus_name;
249 char *dev_name;
250 uint32_t port_index;
251 } arr_last;
252 };
253
254 static int dl_argc(struct dl *dl)
255 {
256 return dl->argc;
257 }
258
259 static char *dl_argv(struct dl *dl)
260 {
261 if (dl_argc(dl) == 0)
262 return NULL;
263 return *dl->argv;
264 }
265
266 static void dl_arg_inc(struct dl *dl)
267 {
268 if (dl_argc(dl) == 0)
269 return;
270 dl->argc--;
271 dl->argv++;
272 }
273
274 static char *dl_argv_next(struct dl *dl)
275 {
276 char *ret;
277
278 if (dl_argc(dl) == 0)
279 return NULL;
280
281 ret = *dl->argv;
282 dl_arg_inc(dl);
283 return ret;
284 }
285
286 static char *dl_argv_index(struct dl *dl, unsigned int index)
287 {
288 if (index >= dl_argc(dl))
289 return NULL;
290 return dl->argv[index];
291 }
292
293 static int strcmpx(const char *str1, const char *str2)
294 {
295 if (strlen(str1) > strlen(str2))
296 return -1;
297 return strncmp(str1, str2, strlen(str1));
298 }
299
300 static bool dl_argv_match(struct dl *dl, const char *pattern)
301 {
302 if (dl_argc(dl) == 0)
303 return false;
304 return strcmpx(dl_argv(dl), pattern) == 0;
305 }
306
307 static bool dl_no_arg(struct dl *dl)
308 {
309 return dl_argc(dl) == 0;
310 }
311
312 static const enum mnl_attr_data_type devlink_policy[DEVLINK_ATTR_MAX + 1] = {
313 [DEVLINK_ATTR_BUS_NAME] = MNL_TYPE_NUL_STRING,
314 [DEVLINK_ATTR_DEV_NAME] = MNL_TYPE_NUL_STRING,
315 [DEVLINK_ATTR_PORT_INDEX] = MNL_TYPE_U32,
316 [DEVLINK_ATTR_PORT_TYPE] = MNL_TYPE_U16,
317 [DEVLINK_ATTR_PORT_DESIRED_TYPE] = MNL_TYPE_U16,
318 [DEVLINK_ATTR_PORT_NETDEV_IFINDEX] = MNL_TYPE_U32,
319 [DEVLINK_ATTR_PORT_NETDEV_NAME] = MNL_TYPE_NUL_STRING,
320 [DEVLINK_ATTR_PORT_IBDEV_NAME] = MNL_TYPE_NUL_STRING,
321 [DEVLINK_ATTR_SB_INDEX] = MNL_TYPE_U32,
322 [DEVLINK_ATTR_SB_SIZE] = MNL_TYPE_U32,
323 [DEVLINK_ATTR_SB_INGRESS_POOL_COUNT] = MNL_TYPE_U16,
324 [DEVLINK_ATTR_SB_EGRESS_POOL_COUNT] = MNL_TYPE_U16,
325 [DEVLINK_ATTR_SB_INGRESS_TC_COUNT] = MNL_TYPE_U16,
326 [DEVLINK_ATTR_SB_EGRESS_TC_COUNT] = MNL_TYPE_U16,
327 [DEVLINK_ATTR_SB_POOL_INDEX] = MNL_TYPE_U16,
328 [DEVLINK_ATTR_SB_POOL_TYPE] = MNL_TYPE_U8,
329 [DEVLINK_ATTR_SB_POOL_SIZE] = MNL_TYPE_U32,
330 [DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE] = MNL_TYPE_U8,
331 [DEVLINK_ATTR_SB_THRESHOLD] = MNL_TYPE_U32,
332 [DEVLINK_ATTR_SB_TC_INDEX] = MNL_TYPE_U16,
333 [DEVLINK_ATTR_SB_OCC_CUR] = MNL_TYPE_U32,
334 [DEVLINK_ATTR_SB_OCC_MAX] = MNL_TYPE_U32,
335 [DEVLINK_ATTR_ESWITCH_MODE] = MNL_TYPE_U16,
336 [DEVLINK_ATTR_ESWITCH_INLINE_MODE] = MNL_TYPE_U8,
337 [DEVLINK_ATTR_ESWITCH_ENCAP_MODE] = MNL_TYPE_U8,
338 [DEVLINK_ATTR_DPIPE_TABLES] = MNL_TYPE_NESTED,
339 [DEVLINK_ATTR_DPIPE_TABLE] = MNL_TYPE_NESTED,
340 [DEVLINK_ATTR_DPIPE_TABLE_NAME] = MNL_TYPE_STRING,
341 [DEVLINK_ATTR_DPIPE_TABLE_SIZE] = MNL_TYPE_U64,
342 [DEVLINK_ATTR_DPIPE_TABLE_MATCHES] = MNL_TYPE_NESTED,
343 [DEVLINK_ATTR_DPIPE_TABLE_ACTIONS] = MNL_TYPE_NESTED,
344 [DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED] = MNL_TYPE_U8,
345 [DEVLINK_ATTR_DPIPE_ENTRIES] = MNL_TYPE_NESTED,
346 [DEVLINK_ATTR_DPIPE_ENTRY] = MNL_TYPE_NESTED,
347 [DEVLINK_ATTR_DPIPE_ENTRY_INDEX] = MNL_TYPE_U64,
348 [DEVLINK_ATTR_DPIPE_ENTRY_MATCH_VALUES] = MNL_TYPE_NESTED,
349 [DEVLINK_ATTR_DPIPE_ENTRY_ACTION_VALUES] = MNL_TYPE_NESTED,
350 [DEVLINK_ATTR_DPIPE_ENTRY_COUNTER] = MNL_TYPE_U64,
351 [DEVLINK_ATTR_DPIPE_MATCH] = MNL_TYPE_NESTED,
352 [DEVLINK_ATTR_DPIPE_MATCH_VALUE] = MNL_TYPE_NESTED,
353 [DEVLINK_ATTR_DPIPE_MATCH_TYPE] = MNL_TYPE_U32,
354 [DEVLINK_ATTR_DPIPE_ACTION] = MNL_TYPE_NESTED,
355 [DEVLINK_ATTR_DPIPE_ACTION_VALUE] = MNL_TYPE_NESTED,
356 [DEVLINK_ATTR_DPIPE_ACTION_TYPE] = MNL_TYPE_U32,
357 [DEVLINK_ATTR_DPIPE_VALUE_MAPPING] = MNL_TYPE_U32,
358 [DEVLINK_ATTR_DPIPE_HEADERS] = MNL_TYPE_NESTED,
359 [DEVLINK_ATTR_DPIPE_HEADER] = MNL_TYPE_NESTED,
360 [DEVLINK_ATTR_DPIPE_HEADER_NAME] = MNL_TYPE_STRING,
361 [DEVLINK_ATTR_DPIPE_HEADER_ID] = MNL_TYPE_U32,
362 [DEVLINK_ATTR_DPIPE_HEADER_FIELDS] = MNL_TYPE_NESTED,
363 [DEVLINK_ATTR_DPIPE_HEADER_GLOBAL] = MNL_TYPE_U8,
364 [DEVLINK_ATTR_DPIPE_HEADER_INDEX] = MNL_TYPE_U32,
365 [DEVLINK_ATTR_DPIPE_FIELD] = MNL_TYPE_NESTED,
366 [DEVLINK_ATTR_DPIPE_FIELD_NAME] = MNL_TYPE_STRING,
367 [DEVLINK_ATTR_DPIPE_FIELD_ID] = MNL_TYPE_U32,
368 [DEVLINK_ATTR_DPIPE_FIELD_BITWIDTH] = MNL_TYPE_U32,
369 [DEVLINK_ATTR_DPIPE_FIELD_MAPPING_TYPE] = MNL_TYPE_U32,
370 [DEVLINK_ATTR_PARAM] = MNL_TYPE_NESTED,
371 [DEVLINK_ATTR_PARAM_NAME] = MNL_TYPE_STRING,
372 [DEVLINK_ATTR_PARAM_TYPE] = MNL_TYPE_U8,
373 [DEVLINK_ATTR_PARAM_VALUES_LIST] = MNL_TYPE_NESTED,
374 [DEVLINK_ATTR_PARAM_VALUE] = MNL_TYPE_NESTED,
375 [DEVLINK_ATTR_PARAM_VALUE_CMODE] = MNL_TYPE_U8,
376 [DEVLINK_ATTR_REGION_NAME] = MNL_TYPE_STRING,
377 [DEVLINK_ATTR_REGION_SIZE] = MNL_TYPE_U64,
378 [DEVLINK_ATTR_REGION_SNAPSHOTS] = MNL_TYPE_NESTED,
379 [DEVLINK_ATTR_REGION_SNAPSHOT] = MNL_TYPE_NESTED,
380 [DEVLINK_ATTR_REGION_SNAPSHOT_ID] = MNL_TYPE_U32,
381 [DEVLINK_ATTR_REGION_CHUNKS] = MNL_TYPE_NESTED,
382 [DEVLINK_ATTR_REGION_CHUNK] = MNL_TYPE_NESTED,
383 [DEVLINK_ATTR_REGION_CHUNK_DATA] = MNL_TYPE_BINARY,
384 [DEVLINK_ATTR_REGION_CHUNK_ADDR] = MNL_TYPE_U64,
385 [DEVLINK_ATTR_REGION_CHUNK_LEN] = MNL_TYPE_U64,
386 };
387
388 static int attr_cb(const struct nlattr *attr, void *data)
389 {
390 const struct nlattr **tb = data;
391 int type;
392
393 if (mnl_attr_type_valid(attr, DEVLINK_ATTR_MAX) < 0)
394 return MNL_CB_OK;
395
396 type = mnl_attr_get_type(attr);
397 if (mnl_attr_validate(attr, devlink_policy[type]) < 0)
398 return MNL_CB_ERROR;
399
400 tb[type] = attr;
401 return MNL_CB_OK;
402 }
403
404 static int ifname_map_cb(const struct nlmsghdr *nlh, void *data)
405 {
406 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
407 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
408 struct dl *dl = data;
409 struct ifname_map *ifname_map;
410 const char *bus_name;
411 const char *dev_name;
412 uint32_t port_ifindex;
413 const char *port_ifname;
414
415 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
416 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
417 !tb[DEVLINK_ATTR_PORT_INDEX])
418 return MNL_CB_ERROR;
419
420 if (!tb[DEVLINK_ATTR_PORT_NETDEV_NAME])
421 return MNL_CB_OK;
422
423 bus_name = mnl_attr_get_str(tb[DEVLINK_ATTR_BUS_NAME]);
424 dev_name = mnl_attr_get_str(tb[DEVLINK_ATTR_DEV_NAME]);
425 port_ifindex = mnl_attr_get_u32(tb[DEVLINK_ATTR_PORT_INDEX]);
426 port_ifname = mnl_attr_get_str(tb[DEVLINK_ATTR_PORT_NETDEV_NAME]);
427 ifname_map = ifname_map_alloc(bus_name, dev_name,
428 port_ifindex, port_ifname);
429 if (!ifname_map)
430 return MNL_CB_ERROR;
431 list_add(&ifname_map->list, &dl->ifname_map_list);
432
433 return MNL_CB_OK;
434 }
435
436 static void ifname_map_fini(struct dl *dl)
437 {
438 struct ifname_map *ifname_map, *tmp;
439
440 list_for_each_entry_safe(ifname_map, tmp,
441 &dl->ifname_map_list, list) {
442 list_del(&ifname_map->list);
443 ifname_map_free(ifname_map);
444 }
445 }
446
447 static int ifname_map_init(struct dl *dl)
448 {
449 struct nlmsghdr *nlh;
450 int err;
451
452 INIT_LIST_HEAD(&dl->ifname_map_list);
453
454 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PORT_GET,
455 NLM_F_REQUEST | NLM_F_ACK | NLM_F_DUMP);
456
457 err = _mnlg_socket_sndrcv(dl->nlg, nlh, ifname_map_cb, dl);
458 if (err) {
459 ifname_map_fini(dl);
460 return err;
461 }
462 return 0;
463 }
464
465 static int ifname_map_lookup(struct dl *dl, const char *ifname,
466 char **p_bus_name, char **p_dev_name,
467 uint32_t *p_port_index)
468 {
469 struct ifname_map *ifname_map;
470
471 list_for_each_entry(ifname_map, &dl->ifname_map_list, list) {
472 if (strcmp(ifname, ifname_map->ifname) == 0) {
473 *p_bus_name = ifname_map->bus_name;
474 *p_dev_name = ifname_map->dev_name;
475 *p_port_index = ifname_map->port_index;
476 return 0;
477 }
478 }
479 return -ENOENT;
480 }
481
482 static int ifname_map_rev_lookup(struct dl *dl, const char *bus_name,
483 const char *dev_name, uint32_t port_index,
484 char **p_ifname)
485 {
486 struct ifname_map *ifname_map;
487
488 list_for_each_entry(ifname_map, &dl->ifname_map_list, list) {
489 if (strcmp(bus_name, ifname_map->bus_name) == 0 &&
490 strcmp(dev_name, ifname_map->dev_name) == 0 &&
491 port_index == ifname_map->port_index) {
492 *p_ifname = ifname_map->ifname;
493 return 0;
494 }
495 }
496 return -ENOENT;
497 }
498
499 static unsigned int strslashcount(char *str)
500 {
501 unsigned int count = 0;
502 char *pos = str;
503
504 while ((pos = strchr(pos, '/'))) {
505 count++;
506 pos++;
507 }
508 return count;
509 }
510
511 static int strslashrsplit(char *str, char **before, char **after)
512 {
513 char *slash;
514
515 slash = strrchr(str, '/');
516 if (!slash)
517 return -EINVAL;
518 *slash = '\0';
519 *before = str;
520 *after = slash + 1;
521 return 0;
522 }
523
524 static int strtouint64_t(const char *str, uint64_t *p_val)
525 {
526 char *endptr;
527 unsigned long long int val;
528
529 val = strtoull(str, &endptr, 10);
530 if (endptr == str || *endptr != '\0')
531 return -EINVAL;
532 if (val > ULONG_MAX)
533 return -ERANGE;
534 *p_val = val;
535 return 0;
536 }
537
538 static int strtouint32_t(const char *str, uint32_t *p_val)
539 {
540 char *endptr;
541 unsigned long int val;
542
543 val = strtoul(str, &endptr, 10);
544 if (endptr == str || *endptr != '\0')
545 return -EINVAL;
546 if (val > UINT_MAX)
547 return -ERANGE;
548 *p_val = val;
549 return 0;
550 }
551
552 static int strtouint16_t(const char *str, uint16_t *p_val)
553 {
554 char *endptr;
555 unsigned long int val;
556
557 val = strtoul(str, &endptr, 10);
558 if (endptr == str || *endptr != '\0')
559 return -EINVAL;
560 if (val > USHRT_MAX)
561 return -ERANGE;
562 *p_val = val;
563 return 0;
564 }
565
566 static int strtouint8_t(const char *str, uint8_t *p_val)
567 {
568 char *endptr;
569 unsigned long int val;
570
571 val = strtoul(str, &endptr, 10);
572 if (endptr == str || *endptr != '\0')
573 return -EINVAL;
574 if (val > UCHAR_MAX)
575 return -ERANGE;
576 *p_val = val;
577 return 0;
578 }
579
580 static int strtobool(const char *str, bool *p_val)
581 {
582 bool val;
583
584 if (!strcmp(str, "true") || !strcmp(str, "1"))
585 val = true;
586 else if (!strcmp(str, "false") || !strcmp(str, "0"))
587 val = false;
588 else
589 return -EINVAL;
590 *p_val = val;
591 return 0;
592 }
593
594 static int __dl_argv_handle(char *str, char **p_bus_name, char **p_dev_name)
595 {
596 strslashrsplit(str, p_bus_name, p_dev_name);
597 return 0;
598 }
599
600 static int dl_argv_handle(struct dl *dl, char **p_bus_name, char **p_dev_name)
601 {
602 char *str = dl_argv_next(dl);
603
604 if (!str) {
605 pr_err("Devlink identification (\"bus_name/dev_name\") expected\n");
606 return -EINVAL;
607 }
608 if (strslashcount(str) != 1) {
609 pr_err("Wrong devlink identification string format.\n");
610 pr_err("Expected \"bus_name/dev_name\".\n");
611 return -EINVAL;
612 }
613 return __dl_argv_handle(str, p_bus_name, p_dev_name);
614 }
615
616 static int __dl_argv_handle_port(char *str,
617 char **p_bus_name, char **p_dev_name,
618 uint32_t *p_port_index)
619 {
620 char *handlestr;
621 char *portstr;
622 int err;
623
624 err = strslashrsplit(str, &handlestr, &portstr);
625 if (err) {
626 pr_err("Port identification \"%s\" is invalid\n", str);
627 return err;
628 }
629 err = strtouint32_t(portstr, p_port_index);
630 if (err) {
631 pr_err("Port index \"%s\" is not a number or not within range\n",
632 portstr);
633 return err;
634 }
635 err = strslashrsplit(handlestr, p_bus_name, p_dev_name);
636 if (err) {
637 pr_err("Port identification \"%s\" is invalid\n", str);
638 return err;
639 }
640 return 0;
641 }
642
643 static int __dl_argv_handle_port_ifname(struct dl *dl, char *str,
644 char **p_bus_name, char **p_dev_name,
645 uint32_t *p_port_index)
646 {
647 int err;
648
649 err = ifname_map_lookup(dl, str, p_bus_name, p_dev_name,
650 p_port_index);
651 if (err) {
652 pr_err("Netdevice \"%s\" not found\n", str);
653 return err;
654 }
655 return 0;
656 }
657
658 static int dl_argv_handle_port(struct dl *dl, char **p_bus_name,
659 char **p_dev_name, uint32_t *p_port_index)
660 {
661 char *str = dl_argv_next(dl);
662 unsigned int slash_count;
663
664 if (!str) {
665 pr_err("Port identification (\"bus_name/dev_name/port_index\" or \"netdev ifname\") expected.\n");
666 return -EINVAL;
667 }
668 slash_count = strslashcount(str);
669 switch (slash_count) {
670 case 0:
671 return __dl_argv_handle_port_ifname(dl, str, p_bus_name,
672 p_dev_name, p_port_index);
673 case 2:
674 return __dl_argv_handle_port(str, p_bus_name,
675 p_dev_name, p_port_index);
676 default:
677 pr_err("Wrong port identification string format.\n");
678 pr_err("Expected \"bus_name/dev_name/port_index\" or \"netdev_ifname\".\n");
679 return -EINVAL;
680 }
681 }
682
683 static int dl_argv_handle_both(struct dl *dl, char **p_bus_name,
684 char **p_dev_name, uint32_t *p_port_index,
685 uint32_t *p_handle_bit)
686 {
687 char *str = dl_argv_next(dl);
688 unsigned int slash_count;
689 int err;
690
691 if (!str) {
692 pr_err("One of following identifications expected:\n"
693 "Devlink identification (\"bus_name/dev_name\")\n"
694 "Port identification (\"bus_name/dev_name/port_index\" or \"netdev ifname\")\n");
695 return -EINVAL;
696 }
697 slash_count = strslashcount(str);
698 if (slash_count == 1) {
699 err = __dl_argv_handle(str, p_bus_name, p_dev_name);
700 if (err)
701 return err;
702 *p_handle_bit = DL_OPT_HANDLE;
703 } else if (slash_count == 2) {
704 err = __dl_argv_handle_port(str, p_bus_name,
705 p_dev_name, p_port_index);
706 if (err)
707 return err;
708 *p_handle_bit = DL_OPT_HANDLEP;
709 } else if (slash_count == 0) {
710 err = __dl_argv_handle_port_ifname(dl, str, p_bus_name,
711 p_dev_name, p_port_index);
712 if (err)
713 return err;
714 *p_handle_bit = DL_OPT_HANDLEP;
715 } else {
716 pr_err("Wrong port identification string format.\n");
717 pr_err("Expected \"bus_name/dev_name\" or \"bus_name/dev_name/port_index\" or \"netdev_ifname\".\n");
718 return -EINVAL;
719 }
720 return 0;
721 }
722
723 static int __dl_argv_handle_region(char *str, char **p_bus_name,
724 char **p_dev_name, char **p_region)
725 {
726 char *handlestr;
727 int err;
728
729 err = strslashrsplit(str, &handlestr, p_region);
730 if (err) {
731 pr_err("Region identification \"%s\" is invalid\n", str);
732 return err;
733 }
734 err = strslashrsplit(handlestr, p_bus_name, p_dev_name);
735 if (err) {
736 pr_err("Region identification \"%s\" is invalid\n", str);
737 return err;
738 }
739 return 0;
740 }
741
742 static int dl_argv_handle_region(struct dl *dl, char **p_bus_name,
743 char **p_dev_name, char **p_region)
744 {
745 char *str = dl_argv_next(dl);
746 unsigned int slash_count;
747
748 if (!str) {
749 pr_err("Expected \"bus_name/dev_name/region\" identification.\n");
750 return -EINVAL;
751 }
752
753 slash_count = strslashcount(str);
754 if (slash_count != 2) {
755 pr_err("Wrong region identification string format.\n");
756 pr_err("Expected \"bus_name/dev_name/region\" identification.\n"".\n");
757 return -EINVAL;
758 }
759
760 return __dl_argv_handle_region(str, p_bus_name, p_dev_name, p_region);
761 }
762
763 static int dl_argv_uint64_t(struct dl *dl, uint64_t *p_val)
764 {
765 char *str = dl_argv_next(dl);
766 int err;
767
768 if (!str) {
769 pr_err("Unsigned number argument expected\n");
770 return -EINVAL;
771 }
772
773 err = strtouint64_t(str, p_val);
774 if (err) {
775 pr_err("\"%s\" is not a number or not within range\n", str);
776 return err;
777 }
778 return 0;
779 }
780
781 static int dl_argv_uint32_t(struct dl *dl, uint32_t *p_val)
782 {
783 char *str = dl_argv_next(dl);
784 int err;
785
786 if (!str) {
787 pr_err("Unsigned number argument expected\n");
788 return -EINVAL;
789 }
790
791 err = strtouint32_t(str, p_val);
792 if (err) {
793 pr_err("\"%s\" is not a number or not within range\n", str);
794 return err;
795 }
796 return 0;
797 }
798
799 static int dl_argv_uint16_t(struct dl *dl, uint16_t *p_val)
800 {
801 char *str = dl_argv_next(dl);
802 int err;
803
804 if (!str) {
805 pr_err("Unsigned number argument expected\n");
806 return -EINVAL;
807 }
808
809 err = strtouint16_t(str, p_val);
810 if (err) {
811 pr_err("\"%s\" is not a number or not within range\n", str);
812 return err;
813 }
814 return 0;
815 }
816
817 static int dl_argv_str(struct dl *dl, const char **p_str)
818 {
819 const char *str = dl_argv_next(dl);
820
821 if (!str) {
822 pr_err("String parameter expected\n");
823 return -EINVAL;
824 }
825 *p_str = str;
826 return 0;
827 }
828
829 static int port_type_get(const char *typestr, enum devlink_port_type *p_type)
830 {
831 if (strcmp(typestr, "auto") == 0) {
832 *p_type = DEVLINK_PORT_TYPE_AUTO;
833 } else if (strcmp(typestr, "eth") == 0) {
834 *p_type = DEVLINK_PORT_TYPE_ETH;
835 } else if (strcmp(typestr, "ib") == 0) {
836 *p_type = DEVLINK_PORT_TYPE_IB;
837 } else {
838 pr_err("Unknown port type \"%s\"\n", typestr);
839 return -EINVAL;
840 }
841 return 0;
842 }
843
844 static int pool_type_get(const char *typestr, enum devlink_sb_pool_type *p_type)
845 {
846 if (strcmp(typestr, "ingress") == 0) {
847 *p_type = DEVLINK_SB_POOL_TYPE_INGRESS;
848 } else if (strcmp(typestr, "egress") == 0) {
849 *p_type = DEVLINK_SB_POOL_TYPE_EGRESS;
850 } else {
851 pr_err("Unknown pool type \"%s\"\n", typestr);
852 return -EINVAL;
853 }
854 return 0;
855 }
856
857 static int threshold_type_get(const char *typestr,
858 enum devlink_sb_threshold_type *p_type)
859 {
860 if (strcmp(typestr, "static") == 0) {
861 *p_type = DEVLINK_SB_THRESHOLD_TYPE_STATIC;
862 } else if (strcmp(typestr, "dynamic") == 0) {
863 *p_type = DEVLINK_SB_THRESHOLD_TYPE_DYNAMIC;
864 } else {
865 pr_err("Unknown threshold type \"%s\"\n", typestr);
866 return -EINVAL;
867 }
868 return 0;
869 }
870
871 static int eswitch_mode_get(const char *typestr,
872 enum devlink_eswitch_mode *p_mode)
873 {
874 if (strcmp(typestr, ESWITCH_MODE_LEGACY) == 0) {
875 *p_mode = DEVLINK_ESWITCH_MODE_LEGACY;
876 } else if (strcmp(typestr, ESWITCH_MODE_SWITCHDEV) == 0) {
877 *p_mode = DEVLINK_ESWITCH_MODE_SWITCHDEV;
878 } else {
879 pr_err("Unknown eswitch mode \"%s\"\n", typestr);
880 return -EINVAL;
881 }
882 return 0;
883 }
884
885 static int eswitch_inline_mode_get(const char *typestr,
886 enum devlink_eswitch_inline_mode *p_mode)
887 {
888 if (strcmp(typestr, ESWITCH_INLINE_MODE_NONE) == 0) {
889 *p_mode = DEVLINK_ESWITCH_INLINE_MODE_NONE;
890 } else if (strcmp(typestr, ESWITCH_INLINE_MODE_LINK) == 0) {
891 *p_mode = DEVLINK_ESWITCH_INLINE_MODE_LINK;
892 } else if (strcmp(typestr, ESWITCH_INLINE_MODE_NETWORK) == 0) {
893 *p_mode = DEVLINK_ESWITCH_INLINE_MODE_NETWORK;
894 } else if (strcmp(typestr, ESWITCH_INLINE_MODE_TRANSPORT) == 0) {
895 *p_mode = DEVLINK_ESWITCH_INLINE_MODE_TRANSPORT;
896 } else {
897 pr_err("Unknown eswitch inline mode \"%s\"\n", typestr);
898 return -EINVAL;
899 }
900 return 0;
901 }
902
903 static int dpipe_counters_enable_get(const char *typestr,
904 bool *counters_enable)
905 {
906 if (strcmp(typestr, "enable") == 0) {
907 *counters_enable = 1;
908 } else if (strcmp(typestr, "disable") == 0) {
909 *counters_enable = 0;
910 } else {
911 pr_err("Unknown counter_state \"%s\"\n", typestr);
912 return -EINVAL;
913 }
914 return 0;
915 }
916
917 static int eswitch_encap_mode_get(const char *typestr, bool *p_mode)
918 {
919 if (strcmp(typestr, "enable") == 0) {
920 *p_mode = true;
921 } else if (strcmp(typestr, "disable") == 0) {
922 *p_mode = false;
923 } else {
924 pr_err("Unknown eswitch encap mode \"%s\"\n", typestr);
925 return -EINVAL;
926 }
927 return 0;
928 }
929
930 static int param_cmode_get(const char *cmodestr,
931 enum devlink_param_cmode *cmode)
932 {
933 if (strcmp(cmodestr, PARAM_CMODE_RUNTIME_STR) == 0) {
934 *cmode = DEVLINK_PARAM_CMODE_RUNTIME;
935 } else if (strcmp(cmodestr, PARAM_CMODE_DRIVERINIT_STR) == 0) {
936 *cmode = DEVLINK_PARAM_CMODE_DRIVERINIT;
937 } else if (strcmp(cmodestr, PARAM_CMODE_PERMANENT_STR) == 0) {
938 *cmode = DEVLINK_PARAM_CMODE_PERMANENT;
939 } else {
940 pr_err("Unknown configuration mode \"%s\"\n", cmodestr);
941 return -EINVAL;
942 }
943 return 0;
944 }
945
946 static int dl_argv_parse(struct dl *dl, uint32_t o_required,
947 uint32_t o_optional)
948 {
949 struct dl_opts *opts = &dl->opts;
950 uint32_t o_all = o_required | o_optional;
951 uint32_t o_found = 0;
952 int err;
953
954 if (o_required & DL_OPT_HANDLE && o_required & DL_OPT_HANDLEP) {
955 uint32_t handle_bit;
956
957 err = dl_argv_handle_both(dl, &opts->bus_name, &opts->dev_name,
958 &opts->port_index, &handle_bit);
959 if (err)
960 return err;
961 o_found |= handle_bit;
962 } else if (o_required & DL_OPT_HANDLE) {
963 err = dl_argv_handle(dl, &opts->bus_name, &opts->dev_name);
964 if (err)
965 return err;
966 o_found |= DL_OPT_HANDLE;
967 } else if (o_required & DL_OPT_HANDLEP) {
968 err = dl_argv_handle_port(dl, &opts->bus_name, &opts->dev_name,
969 &opts->port_index);
970 if (err)
971 return err;
972 o_found |= DL_OPT_HANDLEP;
973 } else if (o_required & DL_OPT_HANDLE_REGION) {
974 err = dl_argv_handle_region(dl, &opts->bus_name,
975 &opts->dev_name,
976 &opts->region_name);
977 if (err)
978 return err;
979 o_found |= DL_OPT_HANDLE_REGION;
980 }
981
982 while (dl_argc(dl)) {
983 if (dl_argv_match(dl, "type") &&
984 (o_all & DL_OPT_PORT_TYPE)) {
985 const char *typestr;
986
987 dl_arg_inc(dl);
988 err = dl_argv_str(dl, &typestr);
989 if (err)
990 return err;
991 err = port_type_get(typestr, &opts->port_type);
992 if (err)
993 return err;
994 o_found |= DL_OPT_PORT_TYPE;
995 } else if (dl_argv_match(dl, "count") &&
996 (o_all & DL_OPT_PORT_COUNT)) {
997 dl_arg_inc(dl);
998 err = dl_argv_uint32_t(dl, &opts->port_count);
999 if (err)
1000 return err;
1001 o_found |= DL_OPT_PORT_COUNT;
1002 } else if (dl_argv_match(dl, "sb") &&
1003 (o_all & DL_OPT_SB)) {
1004 dl_arg_inc(dl);
1005 err = dl_argv_uint32_t(dl, &opts->sb_index);
1006 if (err)
1007 return err;
1008 o_found |= DL_OPT_SB;
1009 } else if (dl_argv_match(dl, "pool") &&
1010 (o_all & DL_OPT_SB_POOL)) {
1011 dl_arg_inc(dl);
1012 err = dl_argv_uint16_t(dl, &opts->sb_pool_index);
1013 if (err)
1014 return err;
1015 o_found |= DL_OPT_SB_POOL;
1016 } else if (dl_argv_match(dl, "size") &&
1017 (o_all & DL_OPT_SB_SIZE)) {
1018 dl_arg_inc(dl);
1019 err = dl_argv_uint32_t(dl, &opts->sb_pool_size);
1020 if (err)
1021 return err;
1022 o_found |= DL_OPT_SB_SIZE;
1023 } else if (dl_argv_match(dl, "type") &&
1024 (o_all & DL_OPT_SB_TYPE)) {
1025 const char *typestr;
1026
1027 dl_arg_inc(dl);
1028 err = dl_argv_str(dl, &typestr);
1029 if (err)
1030 return err;
1031 err = pool_type_get(typestr, &opts->sb_pool_type);
1032 if (err)
1033 return err;
1034 o_found |= DL_OPT_SB_TYPE;
1035 } else if (dl_argv_match(dl, "thtype") &&
1036 (o_all & DL_OPT_SB_THTYPE)) {
1037 const char *typestr;
1038
1039 dl_arg_inc(dl);
1040 err = dl_argv_str(dl, &typestr);
1041 if (err)
1042 return err;
1043 err = threshold_type_get(typestr,
1044 &opts->sb_pool_thtype);
1045 if (err)
1046 return err;
1047 o_found |= DL_OPT_SB_THTYPE;
1048 } else if (dl_argv_match(dl, "th") &&
1049 (o_all & DL_OPT_SB_TH)) {
1050 dl_arg_inc(dl);
1051 err = dl_argv_uint32_t(dl, &opts->sb_threshold);
1052 if (err)
1053 return err;
1054 o_found |= DL_OPT_SB_TH;
1055 } else if (dl_argv_match(dl, "tc") &&
1056 (o_all & DL_OPT_SB_TC)) {
1057 dl_arg_inc(dl);
1058 err = dl_argv_uint16_t(dl, &opts->sb_tc_index);
1059 if (err)
1060 return err;
1061 o_found |= DL_OPT_SB_TC;
1062 } else if (dl_argv_match(dl, "mode") &&
1063 (o_all & DL_OPT_ESWITCH_MODE)) {
1064 const char *typestr;
1065
1066 dl_arg_inc(dl);
1067 err = dl_argv_str(dl, &typestr);
1068 if (err)
1069 return err;
1070 err = eswitch_mode_get(typestr, &opts->eswitch_mode);
1071 if (err)
1072 return err;
1073 o_found |= DL_OPT_ESWITCH_MODE;
1074 } else if (dl_argv_match(dl, "inline-mode") &&
1075 (o_all & DL_OPT_ESWITCH_INLINE_MODE)) {
1076 const char *typestr;
1077
1078 dl_arg_inc(dl);
1079 err = dl_argv_str(dl, &typestr);
1080 if (err)
1081 return err;
1082 err = eswitch_inline_mode_get(
1083 typestr, &opts->eswitch_inline_mode);
1084 if (err)
1085 return err;
1086 o_found |= DL_OPT_ESWITCH_INLINE_MODE;
1087 } else if (dl_argv_match(dl, "name") &&
1088 (o_all & DL_OPT_DPIPE_TABLE_NAME)) {
1089 dl_arg_inc(dl);
1090 err = dl_argv_str(dl, &opts->dpipe_table_name);
1091 if (err)
1092 return err;
1093 o_found |= DL_OPT_DPIPE_TABLE_NAME;
1094 } else if (dl_argv_match(dl, "counters") &&
1095 (o_all & DL_OPT_DPIPE_TABLE_COUNTERS)) {
1096 const char *typestr;
1097
1098 dl_arg_inc(dl);
1099 err = dl_argv_str(dl, &typestr);
1100 if (err)
1101 return err;
1102 err = dpipe_counters_enable_get(typestr,
1103 &opts->dpipe_counters_enable);
1104 if (err)
1105 return err;
1106 o_found |= DL_OPT_DPIPE_TABLE_COUNTERS;
1107 } else if (dl_argv_match(dl, "encap") &&
1108 (o_all & DL_OPT_ESWITCH_ENCAP_MODE)) {
1109 const char *typestr;
1110
1111 dl_arg_inc(dl);
1112 err = dl_argv_str(dl, &typestr);
1113 if (err)
1114 return err;
1115 err = eswitch_encap_mode_get(typestr,
1116 &opts->eswitch_encap_mode);
1117 if (err)
1118 return err;
1119 o_found |= DL_OPT_ESWITCH_ENCAP_MODE;
1120 } else if (dl_argv_match(dl, "path") &&
1121 (o_all & DL_OPT_RESOURCE_PATH)) {
1122 dl_arg_inc(dl);
1123 err = dl_argv_str(dl, &opts->resource_path);
1124 if (err)
1125 return err;
1126 o_found |= DL_OPT_RESOURCE_PATH;
1127 } else if (dl_argv_match(dl, "size") &&
1128 (o_all & DL_OPT_RESOURCE_SIZE)) {
1129 dl_arg_inc(dl);
1130 err = dl_argv_uint32_t(dl, &opts->resource_size);
1131 if (err)
1132 return err;
1133 o_found |= DL_OPT_RESOURCE_SIZE;
1134 } else if (dl_argv_match(dl, "name") &&
1135 (o_all & DL_OPT_PARAM_NAME)) {
1136 dl_arg_inc(dl);
1137 err = dl_argv_str(dl, &opts->param_name);
1138 if (err)
1139 return err;
1140 o_found |= DL_OPT_PARAM_NAME;
1141 } else if (dl_argv_match(dl, "value") &&
1142 (o_all & DL_OPT_PARAM_VALUE)) {
1143 dl_arg_inc(dl);
1144 err = dl_argv_str(dl, &opts->param_value);
1145 if (err)
1146 return err;
1147 o_found |= DL_OPT_PARAM_VALUE;
1148 } else if (dl_argv_match(dl, "cmode") &&
1149 (o_all & DL_OPT_PARAM_CMODE)) {
1150 const char *cmodestr;
1151
1152 dl_arg_inc(dl);
1153 err = dl_argv_str(dl, &cmodestr);
1154 if (err)
1155 return err;
1156 err = param_cmode_get(cmodestr, &opts->cmode);
1157 if (err)
1158 return err;
1159 o_found |= DL_OPT_PARAM_CMODE;
1160 } else if (dl_argv_match(dl, "snapshot") &&
1161 (o_all & DL_OPT_REGION_SNAPSHOT_ID)) {
1162 dl_arg_inc(dl);
1163 err = dl_argv_uint32_t(dl, &opts->region_snapshot_id);
1164 if (err)
1165 return err;
1166 o_found |= DL_OPT_REGION_SNAPSHOT_ID;
1167 } else if (dl_argv_match(dl, "address") &&
1168 (o_all & DL_OPT_REGION_ADDRESS)) {
1169 dl_arg_inc(dl);
1170 err = dl_argv_uint64_t(dl, &opts->region_address);
1171 if (err)
1172 return err;
1173 o_found |= DL_OPT_REGION_ADDRESS;
1174 } else if (dl_argv_match(dl, "length") &&
1175 (o_all & DL_OPT_REGION_LENGTH)) {
1176 dl_arg_inc(dl);
1177 err = dl_argv_uint64_t(dl, &opts->region_length);
1178 if (err)
1179 return err;
1180 o_found |= DL_OPT_REGION_LENGTH;
1181 } else {
1182 pr_err("Unknown option \"%s\"\n", dl_argv(dl));
1183 return -EINVAL;
1184 }
1185 }
1186
1187 opts->present = o_found;
1188
1189 if ((o_optional & DL_OPT_SB) && !(o_found & DL_OPT_SB)) {
1190 opts->sb_index = 0;
1191 opts->present |= DL_OPT_SB;
1192 }
1193
1194 if ((o_required & DL_OPT_PORT_TYPE) && !(o_found & DL_OPT_PORT_TYPE)) {
1195 pr_err("Port type option expected.\n");
1196 return -EINVAL;
1197 }
1198
1199 if ((o_required & DL_OPT_PORT_COUNT) &&
1200 !(o_found & DL_OPT_PORT_COUNT)) {
1201 pr_err("Port split count option expected.\n");
1202 return -EINVAL;
1203 }
1204
1205 if ((o_required & DL_OPT_SB_POOL) && !(o_found & DL_OPT_SB_POOL)) {
1206 pr_err("Pool index option expected.\n");
1207 return -EINVAL;
1208 }
1209
1210 if ((o_required & DL_OPT_SB_SIZE) && !(o_found & DL_OPT_SB_SIZE)) {
1211 pr_err("Pool size option expected.\n");
1212 return -EINVAL;
1213 }
1214
1215 if ((o_required & DL_OPT_SB_TYPE) && !(o_found & DL_OPT_SB_TYPE)) {
1216 pr_err("Pool type option expected.\n");
1217 return -EINVAL;
1218 }
1219
1220 if ((o_required & DL_OPT_SB_THTYPE) && !(o_found & DL_OPT_SB_THTYPE)) {
1221 pr_err("Pool threshold type option expected.\n");
1222 return -EINVAL;
1223 }
1224
1225 if ((o_required & DL_OPT_SB_TH) && !(o_found & DL_OPT_SB_TH)) {
1226 pr_err("Threshold option expected.\n");
1227 return -EINVAL;
1228 }
1229
1230 if ((o_required & DL_OPT_SB_TC) && !(o_found & DL_OPT_SB_TC)) {
1231 pr_err("TC index option expected.\n");
1232 return -EINVAL;
1233 }
1234
1235 if ((o_required & DL_OPT_ESWITCH_MODE) &&
1236 !(o_found & DL_OPT_ESWITCH_MODE)) {
1237 pr_err("E-Switch mode option expected.\n");
1238 return -EINVAL;
1239 }
1240
1241 if ((o_required & DL_OPT_ESWITCH_INLINE_MODE) &&
1242 !(o_found & DL_OPT_ESWITCH_INLINE_MODE)) {
1243 pr_err("E-Switch inline-mode option expected.\n");
1244 return -EINVAL;
1245 }
1246
1247 if ((o_required & DL_OPT_DPIPE_TABLE_NAME) &&
1248 !(o_found & DL_OPT_DPIPE_TABLE_NAME)) {
1249 pr_err("Dpipe table name expected\n");
1250 return -EINVAL;
1251 }
1252
1253 if ((o_required & DL_OPT_DPIPE_TABLE_COUNTERS) &&
1254 !(o_found & DL_OPT_DPIPE_TABLE_COUNTERS)) {
1255 pr_err("Dpipe table counter state expected\n");
1256 return -EINVAL;
1257 }
1258
1259 if ((o_required & DL_OPT_ESWITCH_ENCAP_MODE) &&
1260 !(o_found & DL_OPT_ESWITCH_ENCAP_MODE)) {
1261 pr_err("E-Switch encapsulation option expected.\n");
1262 return -EINVAL;
1263 }
1264
1265 if ((o_required & DL_OPT_PARAM_NAME) &&
1266 !(o_found & DL_OPT_PARAM_NAME)) {
1267 pr_err("Parameter name expected.\n");
1268 return -EINVAL;
1269 }
1270
1271 if ((o_required & DL_OPT_PARAM_VALUE) &&
1272 !(o_found & DL_OPT_PARAM_VALUE)) {
1273 pr_err("Value to set expected.\n");
1274 return -EINVAL;
1275 }
1276
1277 if ((o_required & DL_OPT_PARAM_CMODE) &&
1278 !(o_found & DL_OPT_PARAM_CMODE)) {
1279 pr_err("Configuration mode expected.\n");
1280 return -EINVAL;
1281 }
1282
1283 if ((o_required & DL_OPT_REGION_SNAPSHOT_ID) &&
1284 !(o_found & DL_OPT_REGION_SNAPSHOT_ID)) {
1285 pr_err("Region snapshot id expected.\n");
1286 return -EINVAL;
1287 }
1288
1289 if ((o_required & DL_OPT_REGION_ADDRESS) &&
1290 !(o_found & DL_OPT_REGION_ADDRESS)) {
1291 pr_err("Region address value expected.\n");
1292 return -EINVAL;
1293 }
1294
1295 if ((o_required & DL_OPT_REGION_LENGTH) &&
1296 !(o_found & DL_OPT_REGION_LENGTH)) {
1297 pr_err("Region length value expected.\n");
1298 return -EINVAL;
1299 }
1300
1301 return 0;
1302 }
1303
1304 static void dl_opts_put(struct nlmsghdr *nlh, struct dl *dl)
1305 {
1306 struct dl_opts *opts = &dl->opts;
1307
1308 if (opts->present & DL_OPT_HANDLE) {
1309 mnl_attr_put_strz(nlh, DEVLINK_ATTR_BUS_NAME, opts->bus_name);
1310 mnl_attr_put_strz(nlh, DEVLINK_ATTR_DEV_NAME, opts->dev_name);
1311 } else if (opts->present & DL_OPT_HANDLEP) {
1312 mnl_attr_put_strz(nlh, DEVLINK_ATTR_BUS_NAME, opts->bus_name);
1313 mnl_attr_put_strz(nlh, DEVLINK_ATTR_DEV_NAME, opts->dev_name);
1314 mnl_attr_put_u32(nlh, DEVLINK_ATTR_PORT_INDEX,
1315 opts->port_index);
1316 } else if (opts->present & DL_OPT_HANDLE_REGION) {
1317 mnl_attr_put_strz(nlh, DEVLINK_ATTR_BUS_NAME, opts->bus_name);
1318 mnl_attr_put_strz(nlh, DEVLINK_ATTR_DEV_NAME, opts->dev_name);
1319 mnl_attr_put_strz(nlh, DEVLINK_ATTR_REGION_NAME,
1320 opts->region_name);
1321 }
1322 if (opts->present & DL_OPT_PORT_TYPE)
1323 mnl_attr_put_u16(nlh, DEVLINK_ATTR_PORT_TYPE,
1324 opts->port_type);
1325 if (opts->present & DL_OPT_PORT_COUNT)
1326 mnl_attr_put_u32(nlh, DEVLINK_ATTR_PORT_SPLIT_COUNT,
1327 opts->port_count);
1328 if (opts->present & DL_OPT_SB)
1329 mnl_attr_put_u32(nlh, DEVLINK_ATTR_SB_INDEX,
1330 opts->sb_index);
1331 if (opts->present & DL_OPT_SB_POOL)
1332 mnl_attr_put_u16(nlh, DEVLINK_ATTR_SB_POOL_INDEX,
1333 opts->sb_pool_index);
1334 if (opts->present & DL_OPT_SB_SIZE)
1335 mnl_attr_put_u32(nlh, DEVLINK_ATTR_SB_POOL_SIZE,
1336 opts->sb_pool_size);
1337 if (opts->present & DL_OPT_SB_TYPE)
1338 mnl_attr_put_u8(nlh, DEVLINK_ATTR_SB_POOL_TYPE,
1339 opts->sb_pool_type);
1340 if (opts->present & DL_OPT_SB_THTYPE)
1341 mnl_attr_put_u8(nlh, DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE,
1342 opts->sb_pool_thtype);
1343 if (opts->present & DL_OPT_SB_TH)
1344 mnl_attr_put_u32(nlh, DEVLINK_ATTR_SB_THRESHOLD,
1345 opts->sb_threshold);
1346 if (opts->present & DL_OPT_SB_TC)
1347 mnl_attr_put_u16(nlh, DEVLINK_ATTR_SB_TC_INDEX,
1348 opts->sb_tc_index);
1349 if (opts->present & DL_OPT_ESWITCH_MODE)
1350 mnl_attr_put_u16(nlh, DEVLINK_ATTR_ESWITCH_MODE,
1351 opts->eswitch_mode);
1352 if (opts->present & DL_OPT_ESWITCH_INLINE_MODE)
1353 mnl_attr_put_u8(nlh, DEVLINK_ATTR_ESWITCH_INLINE_MODE,
1354 opts->eswitch_inline_mode);
1355 if (opts->present & DL_OPT_DPIPE_TABLE_NAME)
1356 mnl_attr_put_strz(nlh, DEVLINK_ATTR_DPIPE_TABLE_NAME,
1357 opts->dpipe_table_name);
1358 if (opts->present & DL_OPT_DPIPE_TABLE_COUNTERS)
1359 mnl_attr_put_u8(nlh, DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED,
1360 opts->dpipe_counters_enable);
1361 if (opts->present & DL_OPT_ESWITCH_ENCAP_MODE)
1362 mnl_attr_put_u8(nlh, DEVLINK_ATTR_ESWITCH_ENCAP_MODE,
1363 opts->eswitch_encap_mode);
1364 if ((opts->present & DL_OPT_RESOURCE_PATH) && opts->resource_id_valid)
1365 mnl_attr_put_u64(nlh, DEVLINK_ATTR_RESOURCE_ID,
1366 opts->resource_id);
1367 if (opts->present & DL_OPT_RESOURCE_SIZE)
1368 mnl_attr_put_u64(nlh, DEVLINK_ATTR_RESOURCE_SIZE,
1369 opts->resource_size);
1370 if (opts->present & DL_OPT_PARAM_NAME)
1371 mnl_attr_put_strz(nlh, DEVLINK_ATTR_PARAM_NAME,
1372 opts->param_name);
1373 if (opts->present & DL_OPT_PARAM_CMODE)
1374 mnl_attr_put_u8(nlh, DEVLINK_ATTR_PARAM_VALUE_CMODE,
1375 opts->cmode);
1376 if (opts->present & DL_OPT_REGION_SNAPSHOT_ID)
1377 mnl_attr_put_u32(nlh, DEVLINK_ATTR_REGION_SNAPSHOT_ID,
1378 opts->region_snapshot_id);
1379 if (opts->present & DL_OPT_REGION_ADDRESS)
1380 mnl_attr_put_u64(nlh, DEVLINK_ATTR_REGION_CHUNK_ADDR,
1381 opts->region_address);
1382 if (opts->present & DL_OPT_REGION_LENGTH)
1383 mnl_attr_put_u64(nlh, DEVLINK_ATTR_REGION_CHUNK_LEN,
1384 opts->region_length);
1385 }
1386
1387 static int dl_argv_parse_put(struct nlmsghdr *nlh, struct dl *dl,
1388 uint32_t o_required, uint32_t o_optional)
1389 {
1390 int err;
1391
1392 err = dl_argv_parse(dl, o_required, o_optional);
1393 if (err)
1394 return err;
1395 dl_opts_put(nlh, dl);
1396 return 0;
1397 }
1398
1399 static bool dl_dump_filter(struct dl *dl, struct nlattr **tb)
1400 {
1401 struct dl_opts *opts = &dl->opts;
1402 struct nlattr *attr_bus_name = tb[DEVLINK_ATTR_BUS_NAME];
1403 struct nlattr *attr_dev_name = tb[DEVLINK_ATTR_DEV_NAME];
1404 struct nlattr *attr_port_index = tb[DEVLINK_ATTR_PORT_INDEX];
1405 struct nlattr *attr_sb_index = tb[DEVLINK_ATTR_SB_INDEX];
1406
1407 if (opts->present & DL_OPT_HANDLE &&
1408 attr_bus_name && attr_dev_name) {
1409 const char *bus_name = mnl_attr_get_str(attr_bus_name);
1410 const char *dev_name = mnl_attr_get_str(attr_dev_name);
1411
1412 if (strcmp(bus_name, opts->bus_name) != 0 ||
1413 strcmp(dev_name, opts->dev_name) != 0)
1414 return false;
1415 }
1416 if (opts->present & DL_OPT_HANDLEP &&
1417 attr_bus_name && attr_dev_name && attr_port_index) {
1418 const char *bus_name = mnl_attr_get_str(attr_bus_name);
1419 const char *dev_name = mnl_attr_get_str(attr_dev_name);
1420 uint32_t port_index = mnl_attr_get_u32(attr_port_index);
1421
1422 if (strcmp(bus_name, opts->bus_name) != 0 ||
1423 strcmp(dev_name, opts->dev_name) != 0 ||
1424 port_index != opts->port_index)
1425 return false;
1426 }
1427 if (opts->present & DL_OPT_SB && attr_sb_index) {
1428 uint32_t sb_index = mnl_attr_get_u32(attr_sb_index);
1429
1430 if (sb_index != opts->sb_index)
1431 return false;
1432 }
1433 return true;
1434 }
1435
1436 static void cmd_dev_help(void)
1437 {
1438 pr_err("Usage: devlink dev show [ DEV ]\n");
1439 pr_err(" devlink dev eswitch set DEV [ mode { legacy | switchdev } ]\n");
1440 pr_err(" [ inline-mode { none | link | network | transport } ]\n");
1441 pr_err(" [ encap { disable | enable } ]\n");
1442 pr_err(" devlink dev eswitch show DEV\n");
1443 pr_err(" devlink dev param set DEV name PARAMETER value VALUE cmode { permanent | driverinit | runtime }\n");
1444 pr_err(" devlink dev param show [DEV name PARAMETER]\n");
1445 pr_err(" devlink dev reload DEV\n");
1446 }
1447
1448 static bool cmp_arr_last_handle(struct dl *dl, const char *bus_name,
1449 const char *dev_name)
1450 {
1451 if (!dl->arr_last.present)
1452 return false;
1453 return strcmp(dl->arr_last.bus_name, bus_name) == 0 &&
1454 strcmp(dl->arr_last.dev_name, dev_name) == 0;
1455 }
1456
1457 static void arr_last_handle_set(struct dl *dl, const char *bus_name,
1458 const char *dev_name)
1459 {
1460 dl->arr_last.present = true;
1461 free(dl->arr_last.dev_name);
1462 free(dl->arr_last.bus_name);
1463 dl->arr_last.bus_name = strdup(bus_name);
1464 dl->arr_last.dev_name = strdup(dev_name);
1465 }
1466
1467 static bool should_arr_last_handle_start(struct dl *dl, const char *bus_name,
1468 const char *dev_name)
1469 {
1470 return !cmp_arr_last_handle(dl, bus_name, dev_name);
1471 }
1472
1473 static bool should_arr_last_handle_end(struct dl *dl, const char *bus_name,
1474 const char *dev_name)
1475 {
1476 return dl->arr_last.present &&
1477 !cmp_arr_last_handle(dl, bus_name, dev_name);
1478 }
1479
1480 static void __pr_out_handle_start(struct dl *dl, struct nlattr **tb,
1481 bool content, bool array)
1482 {
1483 const char *bus_name = mnl_attr_get_str(tb[DEVLINK_ATTR_BUS_NAME]);
1484 const char *dev_name = mnl_attr_get_str(tb[DEVLINK_ATTR_DEV_NAME]);
1485 char buf[32];
1486
1487 sprintf(buf, "%s/%s", bus_name, dev_name);
1488
1489 if (dl->json_output) {
1490 if (array) {
1491 if (should_arr_last_handle_end(dl, bus_name, dev_name))
1492 jsonw_end_array(dl->jw);
1493 if (should_arr_last_handle_start(dl, bus_name,
1494 dev_name)) {
1495 jsonw_name(dl->jw, buf);
1496 jsonw_start_array(dl->jw);
1497 jsonw_start_object(dl->jw);
1498 arr_last_handle_set(dl, bus_name, dev_name);
1499 } else {
1500 jsonw_start_object(dl->jw);
1501 }
1502 } else {
1503 jsonw_name(dl->jw, buf);
1504 jsonw_start_object(dl->jw);
1505 }
1506 } else {
1507 if (array) {
1508 if (should_arr_last_handle_end(dl, bus_name, dev_name))
1509 __pr_out_indent_dec();
1510 if (should_arr_last_handle_start(dl, bus_name,
1511 dev_name)) {
1512 pr_out("%s%s", buf, content ? ":" : "");
1513 __pr_out_newline();
1514 __pr_out_indent_inc();
1515 arr_last_handle_set(dl, bus_name, dev_name);
1516 }
1517 } else {
1518 pr_out("%s%s", buf, content ? ":" : "");
1519 }
1520 }
1521 }
1522
1523 static void pr_out_handle_start_arr(struct dl *dl, struct nlattr **tb)
1524 {
1525 __pr_out_handle_start(dl, tb, true, true);
1526 }
1527
1528 static void pr_out_handle_end(struct dl *dl)
1529 {
1530 if (dl->json_output)
1531 jsonw_end_object(dl->jw);
1532 else
1533 __pr_out_newline();
1534 }
1535
1536 static void pr_out_handle(struct dl *dl, struct nlattr **tb)
1537 {
1538 __pr_out_handle_start(dl, tb, false, false);
1539 pr_out_handle_end(dl);
1540 }
1541
1542 static bool cmp_arr_last_port_handle(struct dl *dl, const char *bus_name,
1543 const char *dev_name, uint32_t port_index)
1544 {
1545 return cmp_arr_last_handle(dl, bus_name, dev_name) &&
1546 dl->arr_last.port_index == port_index;
1547 }
1548
1549 static void arr_last_port_handle_set(struct dl *dl, const char *bus_name,
1550 const char *dev_name, uint32_t port_index)
1551 {
1552 arr_last_handle_set(dl, bus_name, dev_name);
1553 dl->arr_last.port_index = port_index;
1554 }
1555
1556 static bool should_arr_last_port_handle_start(struct dl *dl,
1557 const char *bus_name,
1558 const char *dev_name,
1559 uint32_t port_index)
1560 {
1561 return !cmp_arr_last_port_handle(dl, bus_name, dev_name, port_index);
1562 }
1563
1564 static bool should_arr_last_port_handle_end(struct dl *dl,
1565 const char *bus_name,
1566 const char *dev_name,
1567 uint32_t port_index)
1568 {
1569 return dl->arr_last.present &&
1570 !cmp_arr_last_port_handle(dl, bus_name, dev_name, port_index);
1571 }
1572
1573 static void __pr_out_port_handle_start(struct dl *dl, const char *bus_name,
1574 const char *dev_name,
1575 uint32_t port_index, bool try_nice,
1576 bool array)
1577 {
1578 static char buf[32];
1579 char *ifname = NULL;
1580
1581 if (dl->no_nice_names || !try_nice ||
1582 ifname_map_rev_lookup(dl, bus_name, dev_name,
1583 port_index, &ifname) != 0)
1584 sprintf(buf, "%s/%s/%d", bus_name, dev_name, port_index);
1585 else
1586 sprintf(buf, "%s", ifname);
1587
1588 if (dl->json_output) {
1589 if (array) {
1590 if (should_arr_last_port_handle_end(dl, bus_name,
1591 dev_name,
1592 port_index))
1593 jsonw_end_array(dl->jw);
1594 if (should_arr_last_port_handle_start(dl, bus_name,
1595 dev_name,
1596 port_index)) {
1597 jsonw_name(dl->jw, buf);
1598 jsonw_start_array(dl->jw);
1599 jsonw_start_object(dl->jw);
1600 arr_last_port_handle_set(dl, bus_name, dev_name,
1601 port_index);
1602 } else {
1603 jsonw_start_object(dl->jw);
1604 }
1605 } else {
1606 jsonw_name(dl->jw, buf);
1607 jsonw_start_object(dl->jw);
1608 }
1609 } else {
1610 pr_out("%s:", buf);
1611 }
1612 }
1613
1614 static void pr_out_port_handle_start(struct dl *dl, struct nlattr **tb, bool try_nice)
1615 {
1616 const char *bus_name;
1617 const char *dev_name;
1618 uint32_t port_index;
1619
1620 bus_name = mnl_attr_get_str(tb[DEVLINK_ATTR_BUS_NAME]);
1621 dev_name = mnl_attr_get_str(tb[DEVLINK_ATTR_DEV_NAME]);
1622 port_index = mnl_attr_get_u32(tb[DEVLINK_ATTR_PORT_INDEX]);
1623 __pr_out_port_handle_start(dl, bus_name, dev_name, port_index, try_nice, false);
1624 }
1625
1626 static void pr_out_port_handle_start_arr(struct dl *dl, struct nlattr **tb, bool try_nice)
1627 {
1628 const char *bus_name;
1629 const char *dev_name;
1630 uint32_t port_index;
1631
1632 bus_name = mnl_attr_get_str(tb[DEVLINK_ATTR_BUS_NAME]);
1633 dev_name = mnl_attr_get_str(tb[DEVLINK_ATTR_DEV_NAME]);
1634 port_index = mnl_attr_get_u32(tb[DEVLINK_ATTR_PORT_INDEX]);
1635 __pr_out_port_handle_start(dl, bus_name, dev_name, port_index, try_nice, true);
1636 }
1637
1638 static void pr_out_port_handle_end(struct dl *dl)
1639 {
1640 if (dl->json_output)
1641 jsonw_end_object(dl->jw);
1642 else
1643 pr_out("\n");
1644 }
1645
1646
1647 static void pr_out_str(struct dl *dl, const char *name, const char *val)
1648 {
1649 if (dl->json_output) {
1650 jsonw_string_field(dl->jw, name, val);
1651 } else {
1652 if (g_indent_newline)
1653 pr_out("%s %s", name, val);
1654 else
1655 pr_out(" %s %s", name, val);
1656 }
1657 }
1658
1659 static void pr_out_bool(struct dl *dl, const char *name, bool val)
1660 {
1661 if (val)
1662 pr_out_str(dl, name, "true");
1663 else
1664 pr_out_str(dl, name, "false");
1665 }
1666
1667 static void pr_out_uint(struct dl *dl, const char *name, unsigned int val)
1668 {
1669 if (dl->json_output) {
1670 jsonw_uint_field(dl->jw, name, val);
1671 } else {
1672 if (g_indent_newline)
1673 pr_out("%s %u", name, val);
1674 else
1675 pr_out(" %s %u", name, val);
1676 }
1677 }
1678
1679 static void pr_out_u64(struct dl *dl, const char *name, uint64_t val)
1680 {
1681 if (val == (uint64_t) -1)
1682 return pr_out_str(dl, name, "unlimited");
1683
1684 return pr_out_uint(dl, name, val);
1685 }
1686
1687 static void pr_out_region_chunk_start(struct dl *dl, uint64_t addr)
1688 {
1689 if (dl->json_output) {
1690 jsonw_name(dl->jw, "address");
1691 jsonw_uint(dl->jw, addr);
1692 jsonw_name(dl->jw, "data");
1693 jsonw_start_array(dl->jw);
1694 }
1695 }
1696
1697 static void pr_out_region_chunk_end(struct dl *dl)
1698 {
1699 if (dl->json_output)
1700 jsonw_end_array(dl->jw);
1701 }
1702
1703 static void pr_out_region_chunk(struct dl *dl, uint8_t *data, uint32_t len,
1704 uint64_t addr)
1705 {
1706 static uint64_t align_val;
1707 uint32_t i = 0;
1708
1709 pr_out_region_chunk_start(dl, addr);
1710 while (i < len) {
1711 if (!dl->json_output)
1712 if (!(align_val % 16))
1713 pr_out("%s%016"PRIx64" ",
1714 align_val ? "\n" : "",
1715 addr);
1716
1717 align_val++;
1718
1719 if (dl->json_output)
1720 jsonw_printf(dl->jw, "%d", data[i]);
1721 else
1722 pr_out("%02x ", data[i]);
1723
1724 addr++;
1725 i++;
1726 }
1727 pr_out_region_chunk_end(dl);
1728 }
1729
1730 static void pr_out_dev(struct dl *dl, struct nlattr **tb)
1731 {
1732 pr_out_handle(dl, tb);
1733 }
1734
1735 static void pr_out_section_start(struct dl *dl, const char *name)
1736 {
1737 if (dl->json_output) {
1738 jsonw_start_object(dl->jw);
1739 jsonw_name(dl->jw, name);
1740 jsonw_start_object(dl->jw);
1741 }
1742 }
1743
1744 static void pr_out_section_end(struct dl *dl)
1745 {
1746 if (dl->json_output) {
1747 if (dl->arr_last.present)
1748 jsonw_end_array(dl->jw);
1749 jsonw_end_object(dl->jw);
1750 jsonw_end_object(dl->jw);
1751 }
1752 }
1753
1754 static void pr_out_array_start(struct dl *dl, const char *name)
1755 {
1756 if (dl->json_output) {
1757 jsonw_name(dl->jw, name);
1758 jsonw_start_array(dl->jw);
1759 } else {
1760 __pr_out_indent_inc();
1761 __pr_out_newline();
1762 pr_out("%s:", name);
1763 __pr_out_indent_inc();
1764 __pr_out_newline();
1765 }
1766 }
1767
1768 static void pr_out_array_end(struct dl *dl)
1769 {
1770 if (dl->json_output) {
1771 jsonw_end_array(dl->jw);
1772 } else {
1773 __pr_out_indent_dec();
1774 __pr_out_indent_dec();
1775 }
1776 }
1777
1778 static void pr_out_entry_start(struct dl *dl)
1779 {
1780 if (dl->json_output)
1781 jsonw_start_object(dl->jw);
1782 }
1783
1784 static void pr_out_entry_end(struct dl *dl)
1785 {
1786 if (dl->json_output)
1787 jsonw_end_object(dl->jw);
1788 else
1789 __pr_out_newline();
1790 }
1791
1792 static const char *param_cmode_name(uint8_t cmode)
1793 {
1794 switch (cmode) {
1795 case DEVLINK_PARAM_CMODE_RUNTIME:
1796 return PARAM_CMODE_RUNTIME_STR;
1797 case DEVLINK_PARAM_CMODE_DRIVERINIT:
1798 return PARAM_CMODE_DRIVERINIT_STR;
1799 case DEVLINK_PARAM_CMODE_PERMANENT:
1800 return PARAM_CMODE_PERMANENT_STR;
1801 default: return "<unknown type>";
1802 }
1803 }
1804
1805 static const char *eswitch_mode_name(uint32_t mode)
1806 {
1807 switch (mode) {
1808 case DEVLINK_ESWITCH_MODE_LEGACY: return ESWITCH_MODE_LEGACY;
1809 case DEVLINK_ESWITCH_MODE_SWITCHDEV: return ESWITCH_MODE_SWITCHDEV;
1810 default: return "<unknown mode>";
1811 }
1812 }
1813
1814 static const char *eswitch_inline_mode_name(uint32_t mode)
1815 {
1816 switch (mode) {
1817 case DEVLINK_ESWITCH_INLINE_MODE_NONE:
1818 return ESWITCH_INLINE_MODE_NONE;
1819 case DEVLINK_ESWITCH_INLINE_MODE_LINK:
1820 return ESWITCH_INLINE_MODE_LINK;
1821 case DEVLINK_ESWITCH_INLINE_MODE_NETWORK:
1822 return ESWITCH_INLINE_MODE_NETWORK;
1823 case DEVLINK_ESWITCH_INLINE_MODE_TRANSPORT:
1824 return ESWITCH_INLINE_MODE_TRANSPORT;
1825 default:
1826 return "<unknown mode>";
1827 }
1828 }
1829
1830 static void pr_out_eswitch(struct dl *dl, struct nlattr **tb)
1831 {
1832 __pr_out_handle_start(dl, tb, true, false);
1833
1834 if (tb[DEVLINK_ATTR_ESWITCH_MODE])
1835 pr_out_str(dl, "mode",
1836 eswitch_mode_name(mnl_attr_get_u16(tb[DEVLINK_ATTR_ESWITCH_MODE])));
1837
1838 if (tb[DEVLINK_ATTR_ESWITCH_INLINE_MODE])
1839 pr_out_str(dl, "inline-mode",
1840 eswitch_inline_mode_name(mnl_attr_get_u8(
1841 tb[DEVLINK_ATTR_ESWITCH_INLINE_MODE])));
1842
1843 if (tb[DEVLINK_ATTR_ESWITCH_ENCAP_MODE]) {
1844 bool encap_mode = !!mnl_attr_get_u8(tb[DEVLINK_ATTR_ESWITCH_ENCAP_MODE]);
1845
1846 pr_out_str(dl, "encap", encap_mode ? "enable" : "disable");
1847 }
1848
1849 pr_out_handle_end(dl);
1850 }
1851
1852 static int cmd_dev_eswitch_show_cb(const struct nlmsghdr *nlh, void *data)
1853 {
1854 struct dl *dl = data;
1855 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
1856 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
1857
1858 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
1859 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME])
1860 return MNL_CB_ERROR;
1861 pr_out_eswitch(dl, tb);
1862 return MNL_CB_OK;
1863 }
1864
1865 static int cmd_dev_eswitch_show(struct dl *dl)
1866 {
1867 struct nlmsghdr *nlh;
1868 int err;
1869
1870 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_ESWITCH_GET,
1871 NLM_F_REQUEST | NLM_F_ACK);
1872
1873 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, 0);
1874 if (err)
1875 return err;
1876
1877 pr_out_section_start(dl, "dev");
1878 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dev_eswitch_show_cb, dl);
1879 pr_out_section_end(dl);
1880 return err;
1881 }
1882
1883 static int cmd_dev_eswitch_set(struct dl *dl)
1884 {
1885 struct nlmsghdr *nlh;
1886 int err;
1887
1888 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_ESWITCH_SET,
1889 NLM_F_REQUEST | NLM_F_ACK);
1890
1891 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE,
1892 DL_OPT_ESWITCH_MODE |
1893 DL_OPT_ESWITCH_INLINE_MODE |
1894 DL_OPT_ESWITCH_ENCAP_MODE);
1895
1896 if (err)
1897 return err;
1898
1899 if (dl->opts.present == 1) {
1900 pr_err("Need to set at least one option\n");
1901 return -ENOENT;
1902 }
1903
1904 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
1905 }
1906
1907 static int cmd_dev_eswitch(struct dl *dl)
1908 {
1909 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
1910 cmd_dev_help();
1911 return 0;
1912 } else if (dl_argv_match(dl, "set")) {
1913 dl_arg_inc(dl);
1914 return cmd_dev_eswitch_set(dl);
1915 } else if (dl_argv_match(dl, "show")) {
1916 dl_arg_inc(dl);
1917 return cmd_dev_eswitch_show(dl);
1918 }
1919 pr_err("Command \"%s\" not found\n", dl_argv(dl));
1920 return -ENOENT;
1921 }
1922
1923 static void pr_out_param_value(struct dl *dl, int nla_type, struct nlattr *nl)
1924 {
1925 struct nlattr *nla_value[DEVLINK_ATTR_MAX + 1] = {};
1926 struct nlattr *val_attr;
1927 int err;
1928
1929 err = mnl_attr_parse_nested(nl, attr_cb, nla_value);
1930 if (err != MNL_CB_OK)
1931 return;
1932
1933 if (!nla_value[DEVLINK_ATTR_PARAM_VALUE_CMODE] ||
1934 (nla_type != MNL_TYPE_FLAG &&
1935 !nla_value[DEVLINK_ATTR_PARAM_VALUE_DATA]))
1936 return;
1937
1938 pr_out_str(dl, "cmode",
1939 param_cmode_name(mnl_attr_get_u8(nla_value[DEVLINK_ATTR_PARAM_VALUE_CMODE])));
1940 val_attr = nla_value[DEVLINK_ATTR_PARAM_VALUE_DATA];
1941
1942 switch (nla_type) {
1943 case MNL_TYPE_U8:
1944 pr_out_uint(dl, "value", mnl_attr_get_u8(val_attr));
1945 break;
1946 case MNL_TYPE_U16:
1947 pr_out_uint(dl, "value", mnl_attr_get_u16(val_attr));
1948 break;
1949 case MNL_TYPE_U32:
1950 pr_out_uint(dl, "value", mnl_attr_get_u32(val_attr));
1951 break;
1952 case MNL_TYPE_STRING:
1953 pr_out_str(dl, "value", mnl_attr_get_str(val_attr));
1954 break;
1955 case MNL_TYPE_FLAG:
1956 pr_out_bool(dl, "value", val_attr ? true : false);
1957 break;
1958 }
1959 }
1960
1961 static void pr_out_param(struct dl *dl, struct nlattr **tb, bool array)
1962 {
1963 struct nlattr *nla_param[DEVLINK_ATTR_MAX + 1] = {};
1964 struct nlattr *param_value_attr;
1965 int nla_type;
1966 int err;
1967
1968 err = mnl_attr_parse_nested(tb[DEVLINK_ATTR_PARAM], attr_cb, nla_param);
1969 if (err != MNL_CB_OK)
1970 return;
1971 if (!nla_param[DEVLINK_ATTR_PARAM_NAME] ||
1972 !nla_param[DEVLINK_ATTR_PARAM_TYPE] ||
1973 !nla_param[DEVLINK_ATTR_PARAM_VALUES_LIST])
1974 return;
1975
1976 if (array)
1977 pr_out_handle_start_arr(dl, tb);
1978 else
1979 __pr_out_handle_start(dl, tb, true, false);
1980
1981 nla_type = mnl_attr_get_u8(nla_param[DEVLINK_ATTR_PARAM_TYPE]);
1982
1983 pr_out_str(dl, "name",
1984 mnl_attr_get_str(nla_param[DEVLINK_ATTR_PARAM_NAME]));
1985
1986 if (!nla_param[DEVLINK_ATTR_PARAM_GENERIC])
1987 pr_out_str(dl, "type", "driver-specific");
1988 else
1989 pr_out_str(dl, "type", "generic");
1990
1991 pr_out_array_start(dl, "values");
1992 mnl_attr_for_each_nested(param_value_attr,
1993 nla_param[DEVLINK_ATTR_PARAM_VALUES_LIST]) {
1994 pr_out_entry_start(dl);
1995 pr_out_param_value(dl, nla_type, param_value_attr);
1996 pr_out_entry_end(dl);
1997 }
1998 pr_out_array_end(dl);
1999 pr_out_handle_end(dl);
2000 }
2001
2002 static int cmd_dev_param_show_cb(const struct nlmsghdr *nlh, void *data)
2003 {
2004 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
2005 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
2006 struct dl *dl = data;
2007
2008 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
2009 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
2010 !tb[DEVLINK_ATTR_PARAM])
2011 return MNL_CB_ERROR;
2012 pr_out_param(dl, tb, true);
2013 return MNL_CB_OK;
2014 }
2015
2016 struct param_ctx {
2017 struct dl *dl;
2018 int nla_type;
2019 union {
2020 uint8_t vu8;
2021 uint16_t vu16;
2022 uint32_t vu32;
2023 const char *vstr;
2024 bool vbool;
2025 } value;
2026 };
2027
2028 static int cmd_dev_param_set_cb(const struct nlmsghdr *nlh, void *data)
2029 {
2030 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
2031 struct nlattr *nla_param[DEVLINK_ATTR_MAX + 1] = {};
2032 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
2033 struct nlattr *param_value_attr;
2034 enum devlink_param_cmode cmode;
2035 struct param_ctx *ctx = data;
2036 struct dl *dl = ctx->dl;
2037 int nla_type;
2038 int err;
2039
2040 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
2041 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
2042 !tb[DEVLINK_ATTR_PARAM])
2043 return MNL_CB_ERROR;
2044
2045 err = mnl_attr_parse_nested(tb[DEVLINK_ATTR_PARAM], attr_cb, nla_param);
2046 if (err != MNL_CB_OK)
2047 return MNL_CB_ERROR;
2048
2049 if (!nla_param[DEVLINK_ATTR_PARAM_TYPE] ||
2050 !nla_param[DEVLINK_ATTR_PARAM_VALUES_LIST])
2051 return MNL_CB_ERROR;
2052
2053 nla_type = mnl_attr_get_u8(nla_param[DEVLINK_ATTR_PARAM_TYPE]);
2054 mnl_attr_for_each_nested(param_value_attr,
2055 nla_param[DEVLINK_ATTR_PARAM_VALUES_LIST]) {
2056 struct nlattr *nla_value[DEVLINK_ATTR_MAX + 1] = {};
2057 struct nlattr *val_attr;
2058
2059 err = mnl_attr_parse_nested(param_value_attr,
2060 attr_cb, nla_value);
2061 if (err != MNL_CB_OK)
2062 return MNL_CB_ERROR;
2063
2064 if (!nla_value[DEVLINK_ATTR_PARAM_VALUE_CMODE] ||
2065 (nla_type != MNL_TYPE_FLAG &&
2066 !nla_value[DEVLINK_ATTR_PARAM_VALUE_DATA]))
2067 return MNL_CB_ERROR;
2068
2069 cmode = mnl_attr_get_u8(nla_value[DEVLINK_ATTR_PARAM_VALUE_CMODE]);
2070 if (cmode == dl->opts.cmode) {
2071 val_attr = nla_value[DEVLINK_ATTR_PARAM_VALUE_DATA];
2072 switch (nla_type) {
2073 case MNL_TYPE_U8:
2074 ctx->value.vu8 = mnl_attr_get_u8(val_attr);
2075 break;
2076 case MNL_TYPE_U16:
2077 ctx->value.vu16 = mnl_attr_get_u16(val_attr);
2078 break;
2079 case MNL_TYPE_U32:
2080 ctx->value.vu32 = mnl_attr_get_u32(val_attr);
2081 break;
2082 case MNL_TYPE_STRING:
2083 ctx->value.vstr = mnl_attr_get_str(val_attr);
2084 break;
2085 case MNL_TYPE_FLAG:
2086 ctx->value.vbool = val_attr ? true : false;
2087 break;
2088 }
2089 break;
2090 }
2091 }
2092 ctx->nla_type = nla_type;
2093 return MNL_CB_OK;
2094 }
2095
2096 static int cmd_dev_param_set(struct dl *dl)
2097 {
2098 struct param_ctx ctx = {};
2099 struct nlmsghdr *nlh;
2100 uint32_t val_u32;
2101 uint16_t val_u16;
2102 uint8_t val_u8;
2103 bool val_bool;
2104 int err;
2105
2106 err = dl_argv_parse(dl, DL_OPT_HANDLE |
2107 DL_OPT_PARAM_NAME |
2108 DL_OPT_PARAM_VALUE |
2109 DL_OPT_PARAM_CMODE, 0);
2110 if (err)
2111 return err;
2112
2113 /* Get value type */
2114 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PARAM_GET,
2115 NLM_F_REQUEST | NLM_F_ACK);
2116 dl_opts_put(nlh, dl);
2117
2118 ctx.dl = dl;
2119 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dev_param_set_cb, &ctx);
2120 if (err)
2121 return err;
2122
2123 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PARAM_SET,
2124 NLM_F_REQUEST | NLM_F_ACK);
2125 dl_opts_put(nlh, dl);
2126
2127 mnl_attr_put_u8(nlh, DEVLINK_ATTR_PARAM_TYPE, ctx.nla_type);
2128 switch (ctx.nla_type) {
2129 case MNL_TYPE_U8:
2130 err = strtouint8_t(dl->opts.param_value, &val_u8);
2131 if (err)
2132 goto err_param_value_parse;
2133 if (val_u8 == ctx.value.vu8)
2134 return 0;
2135 mnl_attr_put_u8(nlh, DEVLINK_ATTR_PARAM_VALUE_DATA, val_u8);
2136 break;
2137 case MNL_TYPE_U16:
2138 err = strtouint16_t(dl->opts.param_value, &val_u16);
2139 if (err)
2140 goto err_param_value_parse;
2141 if (val_u16 == ctx.value.vu16)
2142 return 0;
2143 mnl_attr_put_u16(nlh, DEVLINK_ATTR_PARAM_VALUE_DATA, val_u16);
2144 break;
2145 case MNL_TYPE_U32:
2146 err = strtouint32_t(dl->opts.param_value, &val_u32);
2147 if (err)
2148 goto err_param_value_parse;
2149 if (val_u32 == ctx.value.vu32)
2150 return 0;
2151 mnl_attr_put_u32(nlh, DEVLINK_ATTR_PARAM_VALUE_DATA, val_u32);
2152 break;
2153 case MNL_TYPE_FLAG:
2154 err = strtobool(dl->opts.param_value, &val_bool);
2155 if (err)
2156 goto err_param_value_parse;
2157 if (val_bool == ctx.value.vbool)
2158 return 0;
2159 if (val_bool)
2160 mnl_attr_put(nlh, DEVLINK_ATTR_PARAM_VALUE_DATA,
2161 0, NULL);
2162 break;
2163 case MNL_TYPE_STRING:
2164 mnl_attr_put_strz(nlh, DEVLINK_ATTR_PARAM_VALUE_DATA,
2165 dl->opts.param_value);
2166 if (!strcmp(dl->opts.param_value, ctx.value.vstr))
2167 return 0;
2168 break;
2169 default:
2170 printf("Value type not supported\n");
2171 return -ENOTSUP;
2172 }
2173 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
2174
2175 err_param_value_parse:
2176 pr_err("Value \"%s\" is not a number or not within range\n",
2177 dl->opts.param_value);
2178 return err;
2179 }
2180
2181 static int cmd_dev_param_show(struct dl *dl)
2182 {
2183 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
2184 struct nlmsghdr *nlh;
2185 int err;
2186
2187 if (dl_argc(dl) == 0)
2188 flags |= NLM_F_DUMP;
2189
2190 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PARAM_GET, flags);
2191
2192 if (dl_argc(dl) > 0) {
2193 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE |
2194 DL_OPT_PARAM_NAME, 0);
2195 if (err)
2196 return err;
2197 }
2198
2199 pr_out_section_start(dl, "param");
2200 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dev_param_show_cb, dl);
2201 pr_out_section_end(dl);
2202 return err;
2203 }
2204
2205 static int cmd_dev_param(struct dl *dl)
2206 {
2207 if (dl_argv_match(dl, "help")) {
2208 cmd_dev_help();
2209 return 0;
2210 } else if (dl_argv_match(dl, "show") ||
2211 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
2212 dl_arg_inc(dl);
2213 return cmd_dev_param_show(dl);
2214 } else if (dl_argv_match(dl, "set")) {
2215 dl_arg_inc(dl);
2216 return cmd_dev_param_set(dl);
2217 }
2218 pr_err("Command \"%s\" not found\n", dl_argv(dl));
2219 return -ENOENT;
2220 }
2221 static int cmd_dev_show_cb(const struct nlmsghdr *nlh, void *data)
2222 {
2223 struct dl *dl = data;
2224 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
2225 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
2226
2227 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
2228 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME])
2229 return MNL_CB_ERROR;
2230 pr_out_dev(dl, tb);
2231 return MNL_CB_OK;
2232 }
2233
2234 static int cmd_dev_show(struct dl *dl)
2235 {
2236 struct nlmsghdr *nlh;
2237 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
2238 int err;
2239
2240 if (dl_argc(dl) == 0)
2241 flags |= NLM_F_DUMP;
2242
2243 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_GET, flags);
2244
2245 if (dl_argc(dl) > 0) {
2246 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, 0);
2247 if (err)
2248 return err;
2249 }
2250
2251 pr_out_section_start(dl, "dev");
2252 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dev_show_cb, dl);
2253 pr_out_section_end(dl);
2254 return err;
2255 }
2256
2257 static void cmd_dev_reload_help(void)
2258 {
2259 pr_err("Usage: devlink dev reload [ DEV ]\n");
2260 }
2261
2262 static int cmd_dev_reload(struct dl *dl)
2263 {
2264 struct nlmsghdr *nlh;
2265 int err;
2266
2267 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
2268 cmd_dev_reload_help();
2269 return 0;
2270 }
2271
2272 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_RELOAD,
2273 NLM_F_REQUEST | NLM_F_ACK);
2274
2275 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, 0);
2276 if (err)
2277 return err;
2278
2279 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
2280 }
2281
2282 static int cmd_dev(struct dl *dl)
2283 {
2284 if (dl_argv_match(dl, "help")) {
2285 cmd_dev_help();
2286 return 0;
2287 } else if (dl_argv_match(dl, "show") ||
2288 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
2289 dl_arg_inc(dl);
2290 return cmd_dev_show(dl);
2291 } else if (dl_argv_match(dl, "eswitch")) {
2292 dl_arg_inc(dl);
2293 return cmd_dev_eswitch(dl);
2294 } else if (dl_argv_match(dl, "reload")) {
2295 dl_arg_inc(dl);
2296 return cmd_dev_reload(dl);
2297 } else if (dl_argv_match(dl, "param")) {
2298 dl_arg_inc(dl);
2299 return cmd_dev_param(dl);
2300 }
2301 pr_err("Command \"%s\" not found\n", dl_argv(dl));
2302 return -ENOENT;
2303 }
2304
2305 static void cmd_port_help(void)
2306 {
2307 pr_err("Usage: devlink port show [ DEV/PORT_INDEX ]\n");
2308 pr_err(" devlink port set DEV/PORT_INDEX [ type { eth | ib | auto} ]\n");
2309 pr_err(" devlink port split DEV/PORT_INDEX count COUNT\n");
2310 pr_err(" devlink port unsplit DEV/PORT_INDEX\n");
2311 }
2312
2313 static const char *port_type_name(uint32_t type)
2314 {
2315 switch (type) {
2316 case DEVLINK_PORT_TYPE_NOTSET: return "notset";
2317 case DEVLINK_PORT_TYPE_AUTO: return "auto";
2318 case DEVLINK_PORT_TYPE_ETH: return "eth";
2319 case DEVLINK_PORT_TYPE_IB: return "ib";
2320 default: return "<unknown type>";
2321 }
2322 }
2323
2324 static const char *port_flavour_name(uint16_t flavour)
2325 {
2326 switch (flavour) {
2327 case DEVLINK_PORT_FLAVOUR_PHYSICAL:
2328 return "physical";
2329 case DEVLINK_PORT_FLAVOUR_CPU:
2330 return "cpu";
2331 case DEVLINK_PORT_FLAVOUR_DSA:
2332 return "dsa";
2333 default:
2334 return "<unknown flavour>";
2335 }
2336 }
2337
2338 static void pr_out_port(struct dl *dl, struct nlattr **tb)
2339 {
2340 struct nlattr *pt_attr = tb[DEVLINK_ATTR_PORT_TYPE];
2341 struct nlattr *dpt_attr = tb[DEVLINK_ATTR_PORT_DESIRED_TYPE];
2342
2343 pr_out_port_handle_start(dl, tb, false);
2344 if (pt_attr) {
2345 uint16_t port_type = mnl_attr_get_u16(pt_attr);
2346
2347 pr_out_str(dl, "type", port_type_name(port_type));
2348 if (dpt_attr) {
2349 uint16_t des_port_type = mnl_attr_get_u16(dpt_attr);
2350
2351 if (port_type != des_port_type)
2352 pr_out_str(dl, "des_type",
2353 port_type_name(des_port_type));
2354 }
2355 }
2356 if (tb[DEVLINK_ATTR_PORT_NETDEV_NAME])
2357 pr_out_str(dl, "netdev",
2358 mnl_attr_get_str(tb[DEVLINK_ATTR_PORT_NETDEV_NAME]));
2359 if (tb[DEVLINK_ATTR_PORT_IBDEV_NAME])
2360 pr_out_str(dl, "ibdev",
2361 mnl_attr_get_str(tb[DEVLINK_ATTR_PORT_IBDEV_NAME]));
2362 if (tb[DEVLINK_ATTR_PORT_FLAVOUR]) {
2363 uint16_t port_flavour =
2364 mnl_attr_get_u16(tb[DEVLINK_ATTR_PORT_FLAVOUR]);
2365
2366 pr_out_str(dl, "flavour", port_flavour_name(port_flavour));
2367 }
2368 if (tb[DEVLINK_ATTR_PORT_SPLIT_GROUP])
2369 pr_out_uint(dl, "split_group",
2370 mnl_attr_get_u32(tb[DEVLINK_ATTR_PORT_SPLIT_GROUP]));
2371 pr_out_port_handle_end(dl);
2372 }
2373
2374 static int cmd_port_show_cb(const struct nlmsghdr *nlh, void *data)
2375 {
2376 struct dl *dl = data;
2377 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
2378 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
2379
2380 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
2381 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
2382 !tb[DEVLINK_ATTR_PORT_INDEX])
2383 return MNL_CB_ERROR;
2384 pr_out_port(dl, tb);
2385 return MNL_CB_OK;
2386 }
2387
2388 static int cmd_port_show(struct dl *dl)
2389 {
2390 struct nlmsghdr *nlh;
2391 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
2392 int err;
2393
2394 if (dl_argc(dl) == 0)
2395 flags |= NLM_F_DUMP;
2396
2397 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PORT_GET, flags);
2398
2399 if (dl_argc(dl) > 0) {
2400 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP, 0);
2401 if (err)
2402 return err;
2403 }
2404
2405 pr_out_section_start(dl, "port");
2406 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_port_show_cb, dl);
2407 pr_out_section_end(dl);
2408 return err;
2409 }
2410
2411 static int cmd_port_set(struct dl *dl)
2412 {
2413 struct nlmsghdr *nlh;
2414 int err;
2415
2416 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PORT_SET,
2417 NLM_F_REQUEST | NLM_F_ACK);
2418
2419 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP | DL_OPT_PORT_TYPE, 0);
2420 if (err)
2421 return err;
2422
2423 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
2424 }
2425
2426 static int cmd_port_split(struct dl *dl)
2427 {
2428 struct nlmsghdr *nlh;
2429 int err;
2430
2431 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PORT_SPLIT,
2432 NLM_F_REQUEST | NLM_F_ACK);
2433
2434 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP | DL_OPT_PORT_COUNT, 0);
2435 if (err)
2436 return err;
2437
2438 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
2439 }
2440
2441 static int cmd_port_unsplit(struct dl *dl)
2442 {
2443 struct nlmsghdr *nlh;
2444 int err;
2445
2446 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PORT_UNSPLIT,
2447 NLM_F_REQUEST | NLM_F_ACK);
2448
2449 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP, 0);
2450 if (err)
2451 return err;
2452
2453 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
2454 }
2455
2456 static int cmd_port(struct dl *dl)
2457 {
2458 if (dl_argv_match(dl, "help")) {
2459 cmd_port_help();
2460 return 0;
2461 } else if (dl_argv_match(dl, "show") ||
2462 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
2463 dl_arg_inc(dl);
2464 return cmd_port_show(dl);
2465 } else if (dl_argv_match(dl, "set")) {
2466 dl_arg_inc(dl);
2467 return cmd_port_set(dl);
2468 } else if (dl_argv_match(dl, "split")) {
2469 dl_arg_inc(dl);
2470 return cmd_port_split(dl);
2471 } else if (dl_argv_match(dl, "unsplit")) {
2472 dl_arg_inc(dl);
2473 return cmd_port_unsplit(dl);
2474 }
2475 pr_err("Command \"%s\" not found\n", dl_argv(dl));
2476 return -ENOENT;
2477 }
2478
2479 static void cmd_sb_help(void)
2480 {
2481 pr_err("Usage: devlink sb show [ DEV [ sb SB_INDEX ] ]\n");
2482 pr_err(" devlink sb pool show [ DEV [ sb SB_INDEX ] pool POOL_INDEX ]\n");
2483 pr_err(" devlink sb pool set DEV [ sb SB_INDEX ] pool POOL_INDEX\n");
2484 pr_err(" size POOL_SIZE thtype { static | dynamic }\n");
2485 pr_err(" devlink sb port pool show [ DEV/PORT_INDEX [ sb SB_INDEX ]\n");
2486 pr_err(" pool POOL_INDEX ]\n");
2487 pr_err(" devlink sb port pool set DEV/PORT_INDEX [ sb SB_INDEX ]\n");
2488 pr_err(" pool POOL_INDEX th THRESHOLD\n");
2489 pr_err(" devlink sb tc bind show [ DEV/PORT_INDEX [ sb SB_INDEX ] tc TC_INDEX\n");
2490 pr_err(" type { ingress | egress } ]\n");
2491 pr_err(" devlink sb tc bind set DEV/PORT_INDEX [ sb SB_INDEX ] tc TC_INDEX\n");
2492 pr_err(" type { ingress | egress } pool POOL_INDEX\n");
2493 pr_err(" th THRESHOLD\n");
2494 pr_err(" devlink sb occupancy show { DEV | DEV/PORT_INDEX } [ sb SB_INDEX ]\n");
2495 pr_err(" devlink sb occupancy snapshot DEV [ sb SB_INDEX ]\n");
2496 pr_err(" devlink sb occupancy clearmax DEV [ sb SB_INDEX ]\n");
2497 }
2498
2499 static void pr_out_sb(struct dl *dl, struct nlattr **tb)
2500 {
2501 pr_out_handle_start_arr(dl, tb);
2502 pr_out_uint(dl, "sb",
2503 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_INDEX]));
2504 pr_out_uint(dl, "size",
2505 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_SIZE]));
2506 pr_out_uint(dl, "ing_pools",
2507 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_INGRESS_POOL_COUNT]));
2508 pr_out_uint(dl, "eg_pools",
2509 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_EGRESS_POOL_COUNT]));
2510 pr_out_uint(dl, "ing_tcs",
2511 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_INGRESS_TC_COUNT]));
2512 pr_out_uint(dl, "eg_tcs",
2513 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_EGRESS_TC_COUNT]));
2514 pr_out_handle_end(dl);
2515 }
2516
2517 static int cmd_sb_show_cb(const struct nlmsghdr *nlh, void *data)
2518 {
2519 struct dl *dl = data;
2520 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
2521 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
2522
2523 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
2524 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
2525 !tb[DEVLINK_ATTR_SB_INDEX] || !tb[DEVLINK_ATTR_SB_SIZE] ||
2526 !tb[DEVLINK_ATTR_SB_INGRESS_POOL_COUNT] ||
2527 !tb[DEVLINK_ATTR_SB_EGRESS_POOL_COUNT] ||
2528 !tb[DEVLINK_ATTR_SB_INGRESS_TC_COUNT] ||
2529 !tb[DEVLINK_ATTR_SB_EGRESS_TC_COUNT])
2530 return MNL_CB_ERROR;
2531 pr_out_sb(dl, tb);
2532 return MNL_CB_OK;
2533 }
2534
2535 static int cmd_sb_show(struct dl *dl)
2536 {
2537 struct nlmsghdr *nlh;
2538 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
2539 int err;
2540
2541 if (dl_argc(dl) == 0)
2542 flags |= NLM_F_DUMP;
2543
2544 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_GET, flags);
2545
2546 if (dl_argc(dl) > 0) {
2547 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, DL_OPT_SB);
2548 if (err)
2549 return err;
2550 }
2551
2552 pr_out_section_start(dl, "sb");
2553 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_sb_show_cb, dl);
2554 pr_out_section_end(dl);
2555 return err;
2556 }
2557
2558 static const char *pool_type_name(uint8_t type)
2559 {
2560 switch (type) {
2561 case DEVLINK_SB_POOL_TYPE_INGRESS: return "ingress";
2562 case DEVLINK_SB_POOL_TYPE_EGRESS: return "egress";
2563 default: return "<unknown type>";
2564 }
2565 }
2566
2567 static const char *threshold_type_name(uint8_t type)
2568 {
2569 switch (type) {
2570 case DEVLINK_SB_THRESHOLD_TYPE_STATIC: return "static";
2571 case DEVLINK_SB_THRESHOLD_TYPE_DYNAMIC: return "dynamic";
2572 default: return "<unknown type>";
2573 }
2574 }
2575
2576 static void pr_out_sb_pool(struct dl *dl, struct nlattr **tb)
2577 {
2578 pr_out_handle_start_arr(dl, tb);
2579 pr_out_uint(dl, "sb",
2580 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_INDEX]));
2581 pr_out_uint(dl, "pool",
2582 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_POOL_INDEX]));
2583 pr_out_str(dl, "type",
2584 pool_type_name(mnl_attr_get_u8(tb[DEVLINK_ATTR_SB_POOL_TYPE])));
2585 pr_out_uint(dl, "size",
2586 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_POOL_SIZE]));
2587 pr_out_str(dl, "thtype",
2588 threshold_type_name(mnl_attr_get_u8(tb[DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE])));
2589 pr_out_handle_end(dl);
2590 }
2591
2592 static int cmd_sb_pool_show_cb(const struct nlmsghdr *nlh, void *data)
2593 {
2594 struct dl *dl = data;
2595 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
2596 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
2597
2598 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
2599 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
2600 !tb[DEVLINK_ATTR_SB_INDEX] || !tb[DEVLINK_ATTR_SB_POOL_INDEX] ||
2601 !tb[DEVLINK_ATTR_SB_POOL_TYPE] || !tb[DEVLINK_ATTR_SB_POOL_SIZE] ||
2602 !tb[DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE])
2603 return MNL_CB_ERROR;
2604 pr_out_sb_pool(dl, tb);
2605 return MNL_CB_OK;
2606 }
2607
2608 static int cmd_sb_pool_show(struct dl *dl)
2609 {
2610 struct nlmsghdr *nlh;
2611 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
2612 int err;
2613
2614 if (dl_argc(dl) == 0)
2615 flags |= NLM_F_DUMP;
2616
2617 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_POOL_GET, flags);
2618
2619 if (dl_argc(dl) > 0) {
2620 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE | DL_OPT_SB_POOL,
2621 DL_OPT_SB);
2622 if (err)
2623 return err;
2624 }
2625
2626 pr_out_section_start(dl, "pool");
2627 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_sb_pool_show_cb, dl);
2628 pr_out_section_end(dl);
2629 return err;
2630 }
2631
2632 static int cmd_sb_pool_set(struct dl *dl)
2633 {
2634 struct nlmsghdr *nlh;
2635 int err;
2636
2637 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_POOL_SET,
2638 NLM_F_REQUEST | NLM_F_ACK);
2639
2640 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE | DL_OPT_SB_POOL |
2641 DL_OPT_SB_SIZE | DL_OPT_SB_THTYPE, DL_OPT_SB);
2642 if (err)
2643 return err;
2644
2645 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
2646 }
2647
2648 static int cmd_sb_pool(struct dl *dl)
2649 {
2650 if (dl_argv_match(dl, "help")) {
2651 cmd_sb_help();
2652 return 0;
2653 } else if (dl_argv_match(dl, "show") ||
2654 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
2655 dl_arg_inc(dl);
2656 return cmd_sb_pool_show(dl);
2657 } else if (dl_argv_match(dl, "set")) {
2658 dl_arg_inc(dl);
2659 return cmd_sb_pool_set(dl);
2660 }
2661 pr_err("Command \"%s\" not found\n", dl_argv(dl));
2662 return -ENOENT;
2663 }
2664
2665 static void pr_out_sb_port_pool(struct dl *dl, struct nlattr **tb)
2666 {
2667 pr_out_port_handle_start_arr(dl, tb, true);
2668 pr_out_uint(dl, "sb",
2669 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_INDEX]));
2670 pr_out_uint(dl, "pool",
2671 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_POOL_INDEX]));
2672 pr_out_uint(dl, "threshold",
2673 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_THRESHOLD]));
2674 pr_out_port_handle_end(dl);
2675 }
2676
2677 static int cmd_sb_port_pool_show_cb(const struct nlmsghdr *nlh, void *data)
2678 {
2679 struct dl *dl = data;
2680 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
2681 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
2682
2683 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
2684 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
2685 !tb[DEVLINK_ATTR_PORT_INDEX] || !tb[DEVLINK_ATTR_SB_INDEX] ||
2686 !tb[DEVLINK_ATTR_SB_POOL_INDEX] || !tb[DEVLINK_ATTR_SB_THRESHOLD])
2687 return MNL_CB_ERROR;
2688 pr_out_sb_port_pool(dl, tb);
2689 return MNL_CB_OK;
2690 }
2691
2692 static int cmd_sb_port_pool_show(struct dl *dl)
2693 {
2694 struct nlmsghdr *nlh;
2695 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
2696 int err;
2697
2698 if (dl_argc(dl) == 0)
2699 flags |= NLM_F_DUMP;
2700
2701 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_PORT_POOL_GET, flags);
2702
2703 if (dl_argc(dl) > 0) {
2704 err = dl_argv_parse_put(nlh, dl,
2705 DL_OPT_HANDLEP | DL_OPT_SB_POOL,
2706 DL_OPT_SB);
2707 if (err)
2708 return err;
2709 }
2710
2711 pr_out_section_start(dl, "port_pool");
2712 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_sb_port_pool_show_cb, dl);
2713 pr_out_section_end(dl);
2714 return 0;
2715 }
2716
2717 static int cmd_sb_port_pool_set(struct dl *dl)
2718 {
2719 struct nlmsghdr *nlh;
2720 int err;
2721
2722 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_PORT_POOL_SET,
2723 NLM_F_REQUEST | NLM_F_ACK);
2724
2725 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP | DL_OPT_SB_POOL |
2726 DL_OPT_SB_TH, DL_OPT_SB);
2727 if (err)
2728 return err;
2729
2730 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
2731 }
2732
2733 static int cmd_sb_port_pool(struct dl *dl)
2734 {
2735 if (dl_argv_match(dl, "help")) {
2736 cmd_sb_help();
2737 return 0;
2738 } else if (dl_argv_match(dl, "show") ||
2739 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
2740 dl_arg_inc(dl);
2741 return cmd_sb_port_pool_show(dl);
2742 } else if (dl_argv_match(dl, "set")) {
2743 dl_arg_inc(dl);
2744 return cmd_sb_port_pool_set(dl);
2745 }
2746 pr_err("Command \"%s\" not found\n", dl_argv(dl));
2747 return -ENOENT;
2748 }
2749
2750 static int cmd_sb_port(struct dl *dl)
2751 {
2752 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
2753 cmd_sb_help();
2754 return 0;
2755 } else if (dl_argv_match(dl, "pool")) {
2756 dl_arg_inc(dl);
2757 return cmd_sb_port_pool(dl);
2758 }
2759 pr_err("Command \"%s\" not found\n", dl_argv(dl));
2760 return -ENOENT;
2761 }
2762
2763 static void pr_out_sb_tc_bind(struct dl *dl, struct nlattr **tb)
2764 {
2765 pr_out_port_handle_start_arr(dl, tb, true);
2766 pr_out_uint(dl, "sb",
2767 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_INDEX]));
2768 pr_out_uint(dl, "tc",
2769 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_TC_INDEX]));
2770 pr_out_str(dl, "type",
2771 pool_type_name(mnl_attr_get_u8(tb[DEVLINK_ATTR_SB_POOL_TYPE])));
2772 pr_out_uint(dl, "pool",
2773 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_POOL_INDEX]));
2774 pr_out_uint(dl, "threshold",
2775 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_THRESHOLD]));
2776 pr_out_port_handle_end(dl);
2777 }
2778
2779 static int cmd_sb_tc_bind_show_cb(const struct nlmsghdr *nlh, void *data)
2780 {
2781 struct dl *dl = data;
2782 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
2783 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
2784
2785 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
2786 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
2787 !tb[DEVLINK_ATTR_PORT_INDEX] || !tb[DEVLINK_ATTR_SB_INDEX] ||
2788 !tb[DEVLINK_ATTR_SB_TC_INDEX] || !tb[DEVLINK_ATTR_SB_POOL_TYPE] ||
2789 !tb[DEVLINK_ATTR_SB_POOL_INDEX] || !tb[DEVLINK_ATTR_SB_THRESHOLD])
2790 return MNL_CB_ERROR;
2791 pr_out_sb_tc_bind(dl, tb);
2792 return MNL_CB_OK;
2793 }
2794
2795 static int cmd_sb_tc_bind_show(struct dl *dl)
2796 {
2797 struct nlmsghdr *nlh;
2798 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
2799 int err;
2800
2801 if (dl_argc(dl) == 0)
2802 flags |= NLM_F_DUMP;
2803
2804 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_TC_POOL_BIND_GET, flags);
2805
2806 if (dl_argc(dl) > 0) {
2807 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP | DL_OPT_SB_TC |
2808 DL_OPT_SB_TYPE, DL_OPT_SB);
2809 if (err)
2810 return err;
2811 }
2812
2813 pr_out_section_start(dl, "tc_bind");
2814 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_sb_tc_bind_show_cb, dl);
2815 pr_out_section_end(dl);
2816 return err;
2817 }
2818
2819 static int cmd_sb_tc_bind_set(struct dl *dl)
2820 {
2821 struct nlmsghdr *nlh;
2822 int err;
2823
2824 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_TC_POOL_BIND_SET,
2825 NLM_F_REQUEST | NLM_F_ACK);
2826
2827 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP | DL_OPT_SB_TC |
2828 DL_OPT_SB_TYPE | DL_OPT_SB_POOL | DL_OPT_SB_TH,
2829 DL_OPT_SB);
2830 if (err)
2831 return err;
2832
2833 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
2834 }
2835
2836 static int cmd_sb_tc_bind(struct dl *dl)
2837 {
2838 if (dl_argv_match(dl, "help")) {
2839 cmd_sb_help();
2840 return 0;
2841 } else if (dl_argv_match(dl, "show") ||
2842 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
2843 dl_arg_inc(dl);
2844 return cmd_sb_tc_bind_show(dl);
2845 } else if (dl_argv_match(dl, "set")) {
2846 dl_arg_inc(dl);
2847 return cmd_sb_tc_bind_set(dl);
2848 }
2849 pr_err("Command \"%s\" not found\n", dl_argv(dl));
2850 return -ENOENT;
2851 }
2852
2853 static int cmd_sb_tc(struct dl *dl)
2854 {
2855 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
2856 cmd_sb_help();
2857 return 0;
2858 } else if (dl_argv_match(dl, "bind")) {
2859 dl_arg_inc(dl);
2860 return cmd_sb_tc_bind(dl);
2861 }
2862 pr_err("Command \"%s\" not found\n", dl_argv(dl));
2863 return -ENOENT;
2864 }
2865
2866 struct occ_item {
2867 struct list_head list;
2868 uint32_t index;
2869 uint32_t cur;
2870 uint32_t max;
2871 uint32_t bound_pool_index;
2872 };
2873
2874 struct occ_port {
2875 struct list_head list;
2876 char *bus_name;
2877 char *dev_name;
2878 uint32_t port_index;
2879 uint32_t sb_index;
2880 struct list_head pool_list;
2881 struct list_head ing_tc_list;
2882 struct list_head eg_tc_list;
2883 };
2884
2885 struct occ_show {
2886 struct dl *dl;
2887 int err;
2888 struct list_head port_list;
2889 };
2890
2891 static struct occ_item *occ_item_alloc(void)
2892 {
2893 return calloc(1, sizeof(struct occ_item));
2894 }
2895
2896 static void occ_item_free(struct occ_item *occ_item)
2897 {
2898 free(occ_item);
2899 }
2900
2901 static struct occ_port *occ_port_alloc(uint32_t port_index)
2902 {
2903 struct occ_port *occ_port;
2904
2905 occ_port = calloc(1, sizeof(*occ_port));
2906 if (!occ_port)
2907 return NULL;
2908 occ_port->port_index = port_index;
2909 INIT_LIST_HEAD(&occ_port->pool_list);
2910 INIT_LIST_HEAD(&occ_port->ing_tc_list);
2911 INIT_LIST_HEAD(&occ_port->eg_tc_list);
2912 return occ_port;
2913 }
2914
2915 static void occ_port_free(struct occ_port *occ_port)
2916 {
2917 struct occ_item *occ_item, *tmp;
2918
2919 list_for_each_entry_safe(occ_item, tmp, &occ_port->pool_list, list)
2920 occ_item_free(occ_item);
2921 list_for_each_entry_safe(occ_item, tmp, &occ_port->ing_tc_list, list)
2922 occ_item_free(occ_item);
2923 list_for_each_entry_safe(occ_item, tmp, &occ_port->eg_tc_list, list)
2924 occ_item_free(occ_item);
2925 }
2926
2927 static struct occ_show *occ_show_alloc(struct dl *dl)
2928 {
2929 struct occ_show *occ_show;
2930
2931 occ_show = calloc(1, sizeof(*occ_show));
2932 if (!occ_show)
2933 return NULL;
2934 occ_show->dl = dl;
2935 INIT_LIST_HEAD(&occ_show->port_list);
2936 return occ_show;
2937 }
2938
2939 static void occ_show_free(struct occ_show *occ_show)
2940 {
2941 struct occ_port *occ_port, *tmp;
2942
2943 list_for_each_entry_safe(occ_port, tmp, &occ_show->port_list, list)
2944 occ_port_free(occ_port);
2945 }
2946
2947 static struct occ_port *occ_port_get(struct occ_show *occ_show,
2948 struct nlattr **tb)
2949 {
2950 struct occ_port *occ_port;
2951 uint32_t port_index;
2952
2953 port_index = mnl_attr_get_u32(tb[DEVLINK_ATTR_PORT_INDEX]);
2954
2955 list_for_each_entry_reverse(occ_port, &occ_show->port_list, list) {
2956 if (occ_port->port_index == port_index)
2957 return occ_port;
2958 }
2959 occ_port = occ_port_alloc(port_index);
2960 if (!occ_port)
2961 return NULL;
2962 list_add_tail(&occ_port->list, &occ_show->port_list);
2963 return occ_port;
2964 }
2965
2966 static void pr_out_occ_show_item_list(const char *label, struct list_head *list,
2967 bool bound_pool)
2968 {
2969 struct occ_item *occ_item;
2970 int i = 1;
2971
2972 pr_out_sp(7, " %s:", label);
2973 list_for_each_entry(occ_item, list, list) {
2974 if ((i - 1) % 4 == 0 && i != 1)
2975 pr_out_sp(7, " ");
2976 if (bound_pool)
2977 pr_out_sp(7, "%2u(%u):", occ_item->index,
2978 occ_item->bound_pool_index);
2979 else
2980 pr_out_sp(7, "%2u:", occ_item->index);
2981 pr_out_sp(15, "%7u/%u", occ_item->cur, occ_item->max);
2982 if (i++ % 4 == 0)
2983 pr_out("\n");
2984 }
2985 if ((i - 1) % 4 != 0)
2986 pr_out("\n");
2987 }
2988
2989 static void pr_out_json_occ_show_item_list(struct dl *dl, const char *label,
2990 struct list_head *list,
2991 bool bound_pool)
2992 {
2993 struct occ_item *occ_item;
2994 char buf[32];
2995
2996 jsonw_name(dl->jw, label);
2997 jsonw_start_object(dl->jw);
2998 list_for_each_entry(occ_item, list, list) {
2999 sprintf(buf, "%u", occ_item->index);
3000 jsonw_name(dl->jw, buf);
3001 jsonw_start_object(dl->jw);
3002 if (bound_pool)
3003 jsonw_uint_field(dl->jw, "bound_pool",
3004 occ_item->bound_pool_index);
3005 jsonw_uint_field(dl->jw, "current", occ_item->cur);
3006 jsonw_uint_field(dl->jw, "max", occ_item->max);
3007 jsonw_end_object(dl->jw);
3008 }
3009 jsonw_end_object(dl->jw);
3010 }
3011
3012 static void pr_out_occ_show_port(struct dl *dl, struct occ_port *occ_port)
3013 {
3014 if (dl->json_output) {
3015 pr_out_json_occ_show_item_list(dl, "pool",
3016 &occ_port->pool_list, false);
3017 pr_out_json_occ_show_item_list(dl, "itc",
3018 &occ_port->ing_tc_list, true);
3019 pr_out_json_occ_show_item_list(dl, "etc",
3020 &occ_port->eg_tc_list, true);
3021 } else {
3022 pr_out("\n");
3023 pr_out_occ_show_item_list("pool", &occ_port->pool_list, false);
3024 pr_out_occ_show_item_list("itc", &occ_port->ing_tc_list, true);
3025 pr_out_occ_show_item_list("etc", &occ_port->eg_tc_list, true);
3026 }
3027 }
3028
3029 static void pr_out_occ_show(struct occ_show *occ_show)
3030 {
3031 struct dl *dl = occ_show->dl;
3032 struct dl_opts *opts = &dl->opts;
3033 struct occ_port *occ_port;
3034
3035 list_for_each_entry(occ_port, &occ_show->port_list, list) {
3036 __pr_out_port_handle_start(dl, opts->bus_name, opts->dev_name,
3037 occ_port->port_index, true, false);
3038 pr_out_occ_show_port(dl, occ_port);
3039 pr_out_port_handle_end(dl);
3040 }
3041 }
3042
3043 static void cmd_sb_occ_port_pool_process(struct occ_show *occ_show,
3044 struct nlattr **tb)
3045 {
3046 struct occ_port *occ_port;
3047 struct occ_item *occ_item;
3048
3049 if (occ_show->err || !dl_dump_filter(occ_show->dl, tb))
3050 return;
3051
3052 occ_port = occ_port_get(occ_show, tb);
3053 if (!occ_port) {
3054 occ_show->err = -ENOMEM;
3055 return;
3056 }
3057
3058 occ_item = occ_item_alloc();
3059 if (!occ_item) {
3060 occ_show->err = -ENOMEM;
3061 return;
3062 }
3063 occ_item->index = mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_POOL_INDEX]);
3064 occ_item->cur = mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_OCC_CUR]);
3065 occ_item->max = mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_OCC_MAX]);
3066 list_add_tail(&occ_item->list, &occ_port->pool_list);
3067 }
3068
3069 static int cmd_sb_occ_port_pool_process_cb(const struct nlmsghdr *nlh, void *data)
3070 {
3071 struct occ_show *occ_show = data;
3072 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
3073 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
3074
3075 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
3076 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
3077 !tb[DEVLINK_ATTR_PORT_INDEX] || !tb[DEVLINK_ATTR_SB_INDEX] ||
3078 !tb[DEVLINK_ATTR_SB_POOL_INDEX] ||
3079 !tb[DEVLINK_ATTR_SB_OCC_CUR] || !tb[DEVLINK_ATTR_SB_OCC_MAX])
3080 return MNL_CB_ERROR;
3081 cmd_sb_occ_port_pool_process(occ_show, tb);
3082 return MNL_CB_OK;
3083 }
3084
3085 static void cmd_sb_occ_tc_pool_process(struct occ_show *occ_show,
3086 struct nlattr **tb)
3087 {
3088 struct occ_port *occ_port;
3089 struct occ_item *occ_item;
3090 uint8_t pool_type;
3091
3092 if (occ_show->err || !dl_dump_filter(occ_show->dl, tb))
3093 return;
3094
3095 occ_port = occ_port_get(occ_show, tb);
3096 if (!occ_port) {
3097 occ_show->err = -ENOMEM;
3098 return;
3099 }
3100
3101 occ_item = occ_item_alloc();
3102 if (!occ_item) {
3103 occ_show->err = -ENOMEM;
3104 return;
3105 }
3106 occ_item->index = mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_TC_INDEX]);
3107 occ_item->cur = mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_OCC_CUR]);
3108 occ_item->max = mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_OCC_MAX]);
3109 occ_item->bound_pool_index =
3110 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_POOL_INDEX]);
3111 pool_type = mnl_attr_get_u8(tb[DEVLINK_ATTR_SB_POOL_TYPE]);
3112 if (pool_type == DEVLINK_SB_POOL_TYPE_INGRESS)
3113 list_add_tail(&occ_item->list, &occ_port->ing_tc_list);
3114 else if (pool_type == DEVLINK_SB_POOL_TYPE_EGRESS)
3115 list_add_tail(&occ_item->list, &occ_port->eg_tc_list);
3116 else
3117 occ_item_free(occ_item);
3118 }
3119
3120 static int cmd_sb_occ_tc_pool_process_cb(const struct nlmsghdr *nlh, void *data)
3121 {
3122 struct occ_show *occ_show = data;
3123 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
3124 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
3125
3126 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
3127 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
3128 !tb[DEVLINK_ATTR_PORT_INDEX] || !tb[DEVLINK_ATTR_SB_INDEX] ||
3129 !tb[DEVLINK_ATTR_SB_TC_INDEX] || !tb[DEVLINK_ATTR_SB_POOL_TYPE] ||
3130 !tb[DEVLINK_ATTR_SB_POOL_INDEX] ||
3131 !tb[DEVLINK_ATTR_SB_OCC_CUR] || !tb[DEVLINK_ATTR_SB_OCC_MAX])
3132 return MNL_CB_ERROR;
3133 cmd_sb_occ_tc_pool_process(occ_show, tb);
3134 return MNL_CB_OK;
3135 }
3136
3137 static int cmd_sb_occ_show(struct dl *dl)
3138 {
3139 struct nlmsghdr *nlh;
3140 struct occ_show *occ_show;
3141 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK | NLM_F_DUMP;
3142 int err;
3143
3144 err = dl_argv_parse(dl, DL_OPT_HANDLE | DL_OPT_HANDLEP, DL_OPT_SB);
3145 if (err)
3146 return err;
3147
3148 occ_show = occ_show_alloc(dl);
3149 if (!occ_show)
3150 return -ENOMEM;
3151
3152 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_PORT_POOL_GET, flags);
3153
3154 err = _mnlg_socket_sndrcv(dl->nlg, nlh,
3155 cmd_sb_occ_port_pool_process_cb, occ_show);
3156 if (err)
3157 goto out;
3158
3159 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_TC_POOL_BIND_GET, flags);
3160
3161 err = _mnlg_socket_sndrcv(dl->nlg, nlh,
3162 cmd_sb_occ_tc_pool_process_cb, occ_show);
3163 if (err)
3164 goto out;
3165
3166 pr_out_section_start(dl, "occupancy");
3167 pr_out_occ_show(occ_show);
3168 pr_out_section_end(dl);
3169
3170 out:
3171 occ_show_free(occ_show);
3172 return err;
3173 }
3174
3175 static int cmd_sb_occ_snapshot(struct dl *dl)
3176 {
3177 struct nlmsghdr *nlh;
3178 int err;
3179
3180 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_OCC_SNAPSHOT,
3181 NLM_F_REQUEST | NLM_F_ACK);
3182
3183 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, DL_OPT_SB);
3184 if (err)
3185 return err;
3186
3187 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
3188 }
3189
3190 static int cmd_sb_occ_clearmax(struct dl *dl)
3191 {
3192 struct nlmsghdr *nlh;
3193 int err;
3194
3195 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_OCC_MAX_CLEAR,
3196 NLM_F_REQUEST | NLM_F_ACK);
3197
3198 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, DL_OPT_SB);
3199 if (err)
3200 return err;
3201
3202 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
3203 }
3204
3205 static int cmd_sb_occ(struct dl *dl)
3206 {
3207 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
3208 cmd_sb_help();
3209 return 0;
3210 } else if (dl_argv_match(dl, "show") ||
3211 dl_argv_match(dl, "list")) {
3212 dl_arg_inc(dl);
3213 return cmd_sb_occ_show(dl);
3214 } else if (dl_argv_match(dl, "snapshot")) {
3215 dl_arg_inc(dl);
3216 return cmd_sb_occ_snapshot(dl);
3217 } else if (dl_argv_match(dl, "clearmax")) {
3218 dl_arg_inc(dl);
3219 return cmd_sb_occ_clearmax(dl);
3220 }
3221 pr_err("Command \"%s\" not found\n", dl_argv(dl));
3222 return -ENOENT;
3223 }
3224
3225 static int cmd_sb(struct dl *dl)
3226 {
3227 if (dl_argv_match(dl, "help")) {
3228 cmd_sb_help();
3229 return 0;
3230 } else if (dl_argv_match(dl, "show") ||
3231 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
3232 dl_arg_inc(dl);
3233 return cmd_sb_show(dl);
3234 } else if (dl_argv_match(dl, "pool")) {
3235 dl_arg_inc(dl);
3236 return cmd_sb_pool(dl);
3237 } else if (dl_argv_match(dl, "port")) {
3238 dl_arg_inc(dl);
3239 return cmd_sb_port(dl);
3240 } else if (dl_argv_match(dl, "tc")) {
3241 dl_arg_inc(dl);
3242 return cmd_sb_tc(dl);
3243 } else if (dl_argv_match(dl, "occupancy")) {
3244 dl_arg_inc(dl);
3245 return cmd_sb_occ(dl);
3246 }
3247 pr_err("Command \"%s\" not found\n", dl_argv(dl));
3248 return -ENOENT;
3249 }
3250
3251 static const char *cmd_name(uint8_t cmd)
3252 {
3253 switch (cmd) {
3254 case DEVLINK_CMD_UNSPEC: return "unspec";
3255 case DEVLINK_CMD_GET: return "get";
3256 case DEVLINK_CMD_SET: return "set";
3257 case DEVLINK_CMD_NEW: return "new";
3258 case DEVLINK_CMD_DEL: return "del";
3259 case DEVLINK_CMD_PORT_GET: return "get";
3260 case DEVLINK_CMD_PORT_SET: return "set";
3261 case DEVLINK_CMD_PORT_NEW: return "new";
3262 case DEVLINK_CMD_PORT_DEL: return "del";
3263 case DEVLINK_CMD_PARAM_GET: return "get";
3264 case DEVLINK_CMD_PARAM_SET: return "set";
3265 case DEVLINK_CMD_PARAM_NEW: return "new";
3266 case DEVLINK_CMD_PARAM_DEL: return "del";
3267 case DEVLINK_CMD_REGION_GET: return "get";
3268 case DEVLINK_CMD_REGION_SET: return "set";
3269 case DEVLINK_CMD_REGION_NEW: return "new";
3270 case DEVLINK_CMD_REGION_DEL: return "del";
3271 default: return "<unknown cmd>";
3272 }
3273 }
3274
3275 static const char *cmd_obj(uint8_t cmd)
3276 {
3277 switch (cmd) {
3278 case DEVLINK_CMD_UNSPEC: return "unspec";
3279 case DEVLINK_CMD_GET:
3280 case DEVLINK_CMD_SET:
3281 case DEVLINK_CMD_NEW:
3282 case DEVLINK_CMD_DEL:
3283 return "dev";
3284 case DEVLINK_CMD_PORT_GET:
3285 case DEVLINK_CMD_PORT_SET:
3286 case DEVLINK_CMD_PORT_NEW:
3287 case DEVLINK_CMD_PORT_DEL:
3288 return "port";
3289 case DEVLINK_CMD_PARAM_GET:
3290 case DEVLINK_CMD_PARAM_SET:
3291 case DEVLINK_CMD_PARAM_NEW:
3292 case DEVLINK_CMD_PARAM_DEL:
3293 return "param";
3294 case DEVLINK_CMD_REGION_GET:
3295 case DEVLINK_CMD_REGION_SET:
3296 case DEVLINK_CMD_REGION_NEW:
3297 case DEVLINK_CMD_REGION_DEL:
3298 return "region";
3299 default: return "<unknown obj>";
3300 }
3301 }
3302
3303 static void pr_out_mon_header(uint8_t cmd)
3304 {
3305 pr_out("[%s,%s] ", cmd_obj(cmd), cmd_name(cmd));
3306 }
3307
3308 static bool cmd_filter_check(struct dl *dl, uint8_t cmd)
3309 {
3310 const char *obj = cmd_obj(cmd);
3311 unsigned int index = 0;
3312 const char *cur_obj;
3313
3314 if (dl_no_arg(dl))
3315 return true;
3316 while ((cur_obj = dl_argv_index(dl, index++))) {
3317 if (strcmp(cur_obj, obj) == 0 || strcmp(cur_obj, "all") == 0)
3318 return true;
3319 }
3320 return false;
3321 }
3322
3323 static void pr_out_region(struct dl *dl, struct nlattr **tb);
3324
3325 static int cmd_mon_show_cb(const struct nlmsghdr *nlh, void *data)
3326 {
3327 struct dl *dl = data;
3328 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
3329 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
3330 uint8_t cmd = genl->cmd;
3331
3332 if (!cmd_filter_check(dl, cmd))
3333 return MNL_CB_OK;
3334
3335 switch (cmd) {
3336 case DEVLINK_CMD_GET: /* fall through */
3337 case DEVLINK_CMD_SET: /* fall through */
3338 case DEVLINK_CMD_NEW: /* fall through */
3339 case DEVLINK_CMD_DEL:
3340 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
3341 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME])
3342 return MNL_CB_ERROR;
3343 pr_out_mon_header(genl->cmd);
3344 pr_out_dev(dl, tb);
3345 break;
3346 case DEVLINK_CMD_PORT_GET: /* fall through */
3347 case DEVLINK_CMD_PORT_SET: /* fall through */
3348 case DEVLINK_CMD_PORT_NEW: /* fall through */
3349 case DEVLINK_CMD_PORT_DEL:
3350 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
3351 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
3352 !tb[DEVLINK_ATTR_PORT_INDEX])
3353 return MNL_CB_ERROR;
3354 pr_out_mon_header(genl->cmd);
3355 pr_out_port(dl, tb);
3356 break;
3357 case DEVLINK_CMD_PARAM_GET: /* fall through */
3358 case DEVLINK_CMD_PARAM_SET: /* fall through */
3359 case DEVLINK_CMD_PARAM_NEW: /* fall through */
3360 case DEVLINK_CMD_PARAM_DEL:
3361 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
3362 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
3363 !tb[DEVLINK_ATTR_PARAM])
3364 return MNL_CB_ERROR;
3365 pr_out_mon_header(genl->cmd);
3366 pr_out_param(dl, tb, false);
3367 break;
3368 case DEVLINK_CMD_REGION_GET: /* fall through */
3369 case DEVLINK_CMD_REGION_SET: /* fall through */
3370 case DEVLINK_CMD_REGION_NEW: /* fall through */
3371 case DEVLINK_CMD_REGION_DEL:
3372 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
3373 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
3374 !tb[DEVLINK_ATTR_REGION_NAME])
3375 return MNL_CB_ERROR;
3376 pr_out_mon_header(genl->cmd);
3377 pr_out_region(dl, tb);
3378 break;
3379 }
3380 return MNL_CB_OK;
3381 }
3382
3383 static int cmd_mon_show(struct dl *dl)
3384 {
3385 int err;
3386 unsigned int index = 0;
3387 const char *cur_obj;
3388
3389 while ((cur_obj = dl_argv_index(dl, index++))) {
3390 if (strcmp(cur_obj, "all") != 0 &&
3391 strcmp(cur_obj, "dev") != 0 &&
3392 strcmp(cur_obj, "port") != 0) {
3393 pr_err("Unknown object \"%s\"\n", cur_obj);
3394 return -EINVAL;
3395 }
3396 }
3397 err = _mnlg_socket_group_add(dl->nlg, DEVLINK_GENL_MCGRP_CONFIG_NAME);
3398 if (err)
3399 return err;
3400 err = _mnlg_socket_recv_run(dl->nlg, cmd_mon_show_cb, dl);
3401 if (err)
3402 return err;
3403 return 0;
3404 }
3405
3406 static void cmd_mon_help(void)
3407 {
3408 pr_err("Usage: devlink monitor [ all | OBJECT-LIST ]\n"
3409 "where OBJECT-LIST := { dev | port }\n");
3410 }
3411
3412 static int cmd_mon(struct dl *dl)
3413 {
3414 if (dl_argv_match(dl, "help")) {
3415 cmd_mon_help();
3416 return 0;
3417 } else if (dl_no_arg(dl)) {
3418 dl_arg_inc(dl);
3419 return cmd_mon_show(dl);
3420 }
3421 pr_err("Command \"%s\" not found\n", dl_argv(dl));
3422 return -ENOENT;
3423 }
3424
3425 struct dpipe_field {
3426 char *name;
3427 unsigned int id;
3428 unsigned int bitwidth;
3429 enum devlink_dpipe_field_mapping_type mapping_type;
3430 };
3431
3432 struct dpipe_header {
3433 struct list_head list;
3434 char *name;
3435 unsigned int id;
3436 struct dpipe_field *fields;
3437 unsigned int fields_count;
3438 };
3439
3440 struct dpipe_table {
3441 struct list_head list;
3442 char *name;
3443 unsigned int resource_id;
3444 bool resource_valid;
3445 };
3446
3447 struct dpipe_tables {
3448 struct list_head table_list;
3449 };
3450
3451 struct resource {
3452 char *name;
3453 uint64_t size;
3454 uint64_t size_new;
3455 uint64_t size_min;
3456 uint64_t size_max;
3457 uint64_t size_gran;
3458 enum devlink_resource_unit unit;
3459 bool size_valid;
3460 uint64_t size_occ;
3461 bool occ_valid;
3462 uint64_t id;
3463 struct list_head list;
3464 struct list_head resource_list;
3465 struct resource *parent;
3466 };
3467
3468 struct resources {
3469 struct list_head resource_list;
3470 };
3471
3472 struct resource_ctx {
3473 struct dl *dl;
3474 int err;
3475 struct resources *resources;
3476 struct dpipe_tables *tables;
3477 bool print_resources;
3478 bool pending_change;
3479 };
3480
3481 static struct resource *resource_alloc(void)
3482 {
3483 struct resource *resource;
3484
3485 resource = calloc(1, sizeof(struct resource));
3486 if (!resource)
3487 return NULL;
3488 INIT_LIST_HEAD(&resource->resource_list);
3489 return resource;
3490 }
3491
3492 static void resource_free(struct resource *resource)
3493 {
3494 struct resource *child_resource, *tmp;
3495
3496 list_for_each_entry_safe(child_resource, tmp, &resource->resource_list,
3497 list) {
3498 free(child_resource->name);
3499 resource_free(child_resource);
3500 }
3501 free(resource);
3502 }
3503
3504 static struct resources *resources_alloc(void)
3505 {
3506 struct resources *resources;
3507
3508 resources = calloc(1, sizeof(struct resources));
3509 if (!resources)
3510 return NULL;
3511 INIT_LIST_HEAD(&resources->resource_list);
3512 return resources;
3513 }
3514
3515 static void resources_free(struct resources *resources)
3516 {
3517 struct resource *resource, *tmp;
3518
3519 list_for_each_entry_safe(resource, tmp, &resources->resource_list, list)
3520 resource_free(resource);
3521 }
3522
3523 static int resource_ctx_init(struct resource_ctx *ctx, struct dl *dl)
3524 {
3525 ctx->resources = resources_alloc();
3526 if (!ctx->resources)
3527 return -ENOMEM;
3528 ctx->dl = dl;
3529 return 0;
3530 }
3531
3532 static void resource_ctx_fini(struct resource_ctx *ctx)
3533 {
3534 resources_free(ctx->resources);
3535 }
3536
3537 struct dpipe_ctx {
3538 struct dl *dl;
3539 int err;
3540 struct list_head global_headers;
3541 struct list_head local_headers;
3542 struct dpipe_tables *tables;
3543 struct resources *resources;
3544 bool print_headers;
3545 bool print_tables;
3546 };
3547
3548 static struct dpipe_header *dpipe_header_alloc(unsigned int fields_count)
3549 {
3550 struct dpipe_header *header;
3551
3552 header = calloc(1, sizeof(struct dpipe_header));
3553 if (!header)
3554 return NULL;
3555 header->fields = calloc(fields_count, sizeof(struct dpipe_field));
3556 if (!header->fields)
3557 goto err_fields_alloc;
3558 header->fields_count = fields_count;
3559 return header;
3560
3561 err_fields_alloc:
3562 free(header);
3563 return NULL;
3564 }
3565
3566 static void dpipe_header_free(struct dpipe_header *header)
3567 {
3568 free(header->fields);
3569 free(header);
3570 }
3571
3572 static void dpipe_header_clear(struct dpipe_header *header)
3573 {
3574 struct dpipe_field *field;
3575 int i;
3576
3577 for (i = 0; i < header->fields_count; i++) {
3578 field = &header->fields[i];
3579 free(field->name);
3580 }
3581 free(header->name);
3582 }
3583
3584 static void dpipe_header_add(struct dpipe_ctx *ctx,
3585 struct dpipe_header *header, bool global)
3586 {
3587 if (global)
3588 list_add(&header->list, &ctx->global_headers);
3589 else
3590 list_add(&header->list, &ctx->local_headers);
3591 }
3592
3593 static void dpipe_header_del(struct dpipe_header *header)
3594 {
3595 list_del(&header->list);
3596 }
3597
3598 static struct dpipe_table *dpipe_table_alloc(void)
3599 {
3600 return calloc(1, sizeof(struct dpipe_table));
3601 }
3602
3603 static void dpipe_table_free(struct dpipe_table *table)
3604 {
3605 free(table);
3606 }
3607
3608 static struct dpipe_tables *dpipe_tables_alloc(void)
3609 {
3610 struct dpipe_tables *tables;
3611
3612 tables = calloc(1, sizeof(struct dpipe_tables));
3613 if (!tables)
3614 return NULL;
3615 INIT_LIST_HEAD(&tables->table_list);
3616 return tables;
3617 }
3618
3619 static void dpipe_tables_free(struct dpipe_tables *tables)
3620 {
3621 struct dpipe_table *table, *tmp;
3622
3623 list_for_each_entry_safe(table, tmp, &tables->table_list, list)
3624 dpipe_table_free(table);
3625 free(tables);
3626 }
3627
3628 static int dpipe_ctx_init(struct dpipe_ctx *ctx, struct dl *dl)
3629 {
3630 ctx->tables = dpipe_tables_alloc();
3631 if (!ctx->tables)
3632 return -ENOMEM;
3633
3634 ctx->dl = dl;
3635 INIT_LIST_HEAD(&ctx->global_headers);
3636 INIT_LIST_HEAD(&ctx->local_headers);
3637 return 0;
3638 }
3639
3640 static void dpipe_ctx_fini(struct dpipe_ctx *ctx)
3641 {
3642 struct dpipe_header *header, *tmp;
3643
3644 list_for_each_entry_safe(header, tmp, &ctx->global_headers,
3645 list) {
3646 dpipe_header_del(header);
3647 dpipe_header_clear(header);
3648 dpipe_header_free(header);
3649 }
3650 list_for_each_entry_safe(header, tmp, &ctx->local_headers,
3651 list) {
3652 dpipe_header_del(header);
3653 dpipe_header_clear(header);
3654 dpipe_header_free(header);
3655 }
3656 dpipe_tables_free(ctx->tables);
3657 }
3658
3659 static const char *dpipe_header_id2s(struct dpipe_ctx *ctx,
3660 uint32_t header_id, bool global)
3661 {
3662 struct list_head *header_list;
3663 struct dpipe_header *header;
3664
3665 if (global)
3666 header_list = &ctx->global_headers;
3667 else
3668 header_list = &ctx->local_headers;
3669 list_for_each_entry(header, header_list, list) {
3670 if (header->id != header_id)
3671 continue;
3672 return header->name;
3673 }
3674 return NULL;
3675 }
3676
3677 static const char *dpipe_field_id2s(struct dpipe_ctx *ctx,
3678 uint32_t header_id,
3679 uint32_t field_id, bool global)
3680 {
3681 struct list_head *header_list;
3682 struct dpipe_header *header;
3683
3684 if (global)
3685 header_list = &ctx->global_headers;
3686 else
3687 header_list = &ctx->local_headers;
3688 list_for_each_entry(header, header_list, list) {
3689 if (header->id != header_id)
3690 continue;
3691 return header->fields[field_id].name;
3692 }
3693 return NULL;
3694 }
3695
3696 static const char *
3697 dpipe_field_mapping_e2s(enum devlink_dpipe_field_mapping_type mapping_type)
3698 {
3699 switch (mapping_type) {
3700 case DEVLINK_DPIPE_FIELD_MAPPING_TYPE_NONE:
3701 return NULL;
3702 case DEVLINK_DPIPE_FIELD_MAPPING_TYPE_IFINDEX:
3703 return "ifindex";
3704 default:
3705 return "<unknown>";
3706 }
3707 }
3708
3709 static const char *
3710 dpipe_mapping_get(struct dpipe_ctx *ctx, uint32_t header_id,
3711 uint32_t field_id, bool global)
3712 {
3713 enum devlink_dpipe_field_mapping_type mapping_type;
3714 struct list_head *header_list;
3715 struct dpipe_header *header;
3716
3717 if (global)
3718 header_list = &ctx->global_headers;
3719 else
3720 header_list = &ctx->local_headers;
3721 list_for_each_entry(header, header_list, list) {
3722 if (header->id != header_id)
3723 continue;
3724 mapping_type = header->fields[field_id].mapping_type;
3725 return dpipe_field_mapping_e2s(mapping_type);
3726 }
3727 return NULL;
3728 }
3729
3730 static void pr_out_dpipe_fields(struct dpipe_ctx *ctx,
3731 struct dpipe_field *fields,
3732 unsigned int field_count)
3733 {
3734 struct dpipe_field *field;
3735 int i;
3736
3737 for (i = 0; i < field_count; i++) {
3738 field = &fields[i];
3739 pr_out_entry_start(ctx->dl);
3740 pr_out_str(ctx->dl, "name", field->name);
3741 if (ctx->dl->verbose)
3742 pr_out_uint(ctx->dl, "id", field->id);
3743 pr_out_uint(ctx->dl, "bitwidth", field->bitwidth);
3744 if (field->mapping_type)
3745 pr_out_str(ctx->dl, "mapping_type",
3746 dpipe_field_mapping_e2s(field->mapping_type));
3747 pr_out_entry_end(ctx->dl);
3748 }
3749 }
3750
3751 static void
3752 pr_out_dpipe_header(struct dpipe_ctx *ctx, struct nlattr **tb,
3753 struct dpipe_header *header, bool global)
3754 {
3755 pr_out_handle_start_arr(ctx->dl, tb);
3756 pr_out_str(ctx->dl, "name", header->name);
3757 if (ctx->dl->verbose) {
3758 pr_out_uint(ctx->dl, "id", header->id);
3759 pr_out_str(ctx->dl, "global",
3760 global ? "true" : "false");
3761 }
3762 pr_out_array_start(ctx->dl, "field");
3763 pr_out_dpipe_fields(ctx, header->fields,
3764 header->fields_count);
3765 pr_out_array_end(ctx->dl);
3766 pr_out_handle_end(ctx->dl);
3767 }
3768
3769 static void pr_out_dpipe_headers(struct dpipe_ctx *ctx,
3770 struct nlattr **tb)
3771 {
3772 struct dpipe_header *header;
3773
3774 list_for_each_entry(header, &ctx->local_headers, list)
3775 pr_out_dpipe_header(ctx, tb, header, false);
3776
3777 list_for_each_entry(header, &ctx->global_headers, list)
3778 pr_out_dpipe_header(ctx, tb, header, true);
3779 }
3780
3781 static int dpipe_header_field_get(struct nlattr *nl, struct dpipe_field *field)
3782 {
3783 struct nlattr *nla_field[DEVLINK_ATTR_MAX + 1] = {};
3784 const char *name;
3785 int err;
3786
3787 err = mnl_attr_parse_nested(nl, attr_cb, nla_field);
3788 if (err != MNL_CB_OK)
3789 return -EINVAL;
3790 if (!nla_field[DEVLINK_ATTR_DPIPE_FIELD_ID] ||
3791 !nla_field[DEVLINK_ATTR_DPIPE_FIELD_NAME] ||
3792 !nla_field[DEVLINK_ATTR_DPIPE_FIELD_BITWIDTH] ||
3793 !nla_field[DEVLINK_ATTR_DPIPE_FIELD_MAPPING_TYPE])
3794 return -EINVAL;
3795
3796 name = mnl_attr_get_str(nla_field[DEVLINK_ATTR_DPIPE_FIELD_NAME]);
3797 field->id = mnl_attr_get_u32(nla_field[DEVLINK_ATTR_DPIPE_FIELD_ID]);
3798 field->bitwidth = mnl_attr_get_u32(nla_field[DEVLINK_ATTR_DPIPE_FIELD_BITWIDTH]);
3799 field->name = strdup(name);
3800 if (!field->name)
3801 return -ENOMEM;
3802 field->mapping_type = mnl_attr_get_u32(nla_field[DEVLINK_ATTR_DPIPE_FIELD_MAPPING_TYPE]);
3803 return 0;
3804 }
3805
3806 static int dpipe_header_fields_get(struct nlattr *nla_fields,
3807 struct dpipe_field *fields)
3808 {
3809 struct nlattr *nla_field;
3810 int count = 0;
3811 int err;
3812
3813 mnl_attr_for_each_nested(nla_field, nla_fields) {
3814 err = dpipe_header_field_get(nla_field, &fields[count]);
3815 if (err)
3816 return err;
3817 count++;
3818 }
3819 return 0;
3820 }
3821
3822 static unsigned int dpipe_header_field_count_get(struct nlattr *nla_fields)
3823 {
3824 struct nlattr *nla_field;
3825 unsigned int count = 0;
3826
3827 mnl_attr_for_each_nested(nla_field, nla_fields)
3828 count++;
3829 return count;
3830 }
3831
3832 static int dpipe_header_get(struct dpipe_ctx *ctx, struct nlattr *nl)
3833 {
3834 struct nlattr *nla_header[DEVLINK_ATTR_MAX + 1] = {};
3835 struct dpipe_header *header;
3836 unsigned int fields_count;
3837 const char *header_name;
3838 bool global;
3839 int err;
3840
3841 err = mnl_attr_parse_nested(nl, attr_cb, nla_header);
3842 if (err != MNL_CB_OK)
3843 return -EINVAL;
3844
3845 if (!nla_header[DEVLINK_ATTR_DPIPE_HEADER_NAME] ||
3846 !nla_header[DEVLINK_ATTR_DPIPE_HEADER_ID] ||
3847 !nla_header[DEVLINK_ATTR_DPIPE_HEADER_FIELDS])
3848 return -EINVAL;
3849
3850 fields_count = dpipe_header_field_count_get(nla_header[DEVLINK_ATTR_DPIPE_HEADER_FIELDS]);
3851 header = dpipe_header_alloc(fields_count);
3852 if (!header)
3853 return -ENOMEM;
3854
3855 header_name = mnl_attr_get_str(nla_header[DEVLINK_ATTR_DPIPE_HEADER_NAME]);
3856 header->name = strdup(header_name);
3857 header->id = mnl_attr_get_u32(nla_header[DEVLINK_ATTR_DPIPE_HEADER_ID]);
3858 header->fields_count = fields_count;
3859 global = !!mnl_attr_get_u8(nla_header[DEVLINK_ATTR_DPIPE_HEADER_GLOBAL]);
3860
3861 err = dpipe_header_fields_get(nla_header[DEVLINK_ATTR_DPIPE_HEADER_FIELDS],
3862 header->fields);
3863 if (err)
3864 goto err_field_get;
3865 dpipe_header_add(ctx, header, global);
3866 return 0;
3867
3868 err_field_get:
3869 dpipe_header_free(header);
3870 return err;
3871 }
3872
3873 static int dpipe_headers_get(struct dpipe_ctx *ctx, struct nlattr **tb)
3874 {
3875 struct nlattr *nla_headers = tb[DEVLINK_ATTR_DPIPE_HEADERS];
3876 struct nlattr *nla_header;
3877 int err;
3878
3879 mnl_attr_for_each_nested(nla_header, nla_headers) {
3880 err = dpipe_header_get(ctx, nla_header);
3881 if (err)
3882 return err;
3883 }
3884 return 0;
3885 }
3886
3887 static int cmd_dpipe_header_cb(const struct nlmsghdr *nlh, void *data)
3888 {
3889 struct dpipe_ctx *ctx = data;
3890 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
3891 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
3892 int err;
3893
3894 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
3895 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
3896 !tb[DEVLINK_ATTR_DPIPE_HEADERS])
3897 return MNL_CB_ERROR;
3898 err = dpipe_headers_get(ctx, tb);
3899 if (err) {
3900 ctx->err = err;
3901 return MNL_CB_ERROR;
3902 }
3903
3904 if (ctx->print_headers)
3905 pr_out_dpipe_headers(ctx, tb);
3906 return MNL_CB_OK;
3907 }
3908
3909 static int cmd_dpipe_headers_show(struct dl *dl)
3910 {
3911 struct nlmsghdr *nlh;
3912 struct dpipe_ctx ctx = {};
3913 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
3914 int err;
3915
3916 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_HEADERS_GET, flags);
3917
3918 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, 0);
3919 if (err)
3920 return err;
3921
3922 err = dpipe_ctx_init(&ctx, dl);
3923 if (err)
3924 return err;
3925
3926 ctx.print_headers = true;
3927
3928 pr_out_section_start(dl, "header");
3929 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_header_cb, &ctx);
3930 if (err)
3931 pr_err("error get headers %s\n", strerror(ctx.err));
3932 pr_out_section_end(dl);
3933
3934 dpipe_ctx_fini(&ctx);
3935 return err;
3936 }
3937
3938 static void cmd_dpipe_header_help(void)
3939 {
3940 pr_err("Usage: devlink dpipe headers show DEV\n");
3941 }
3942
3943 static int cmd_dpipe_header(struct dl *dl)
3944 {
3945 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
3946 cmd_dpipe_header_help();
3947 return 0;
3948 } else if (dl_argv_match(dl, "show")) {
3949 dl_arg_inc(dl);
3950 return cmd_dpipe_headers_show(dl);
3951 }
3952 pr_err("Command \"%s\" not found\n", dl_argv(dl));
3953 return -ENOENT;
3954 }
3955
3956 static const char
3957 *dpipe_action_type_e2s(enum devlink_dpipe_action_type action_type)
3958 {
3959 switch (action_type) {
3960 case DEVLINK_DPIPE_ACTION_TYPE_FIELD_MODIFY:
3961 return "field_modify";
3962 default:
3963 return "<unknown>";
3964 }
3965 }
3966
3967 struct dpipe_op_info {
3968 uint32_t header_id;
3969 uint32_t field_id;
3970 bool header_global;
3971 };
3972
3973 struct dpipe_action {
3974 struct dpipe_op_info info;
3975 uint32_t type;
3976 };
3977
3978 static void pr_out_dpipe_action(struct dpipe_action *action,
3979 struct dpipe_ctx *ctx)
3980 {
3981 struct dpipe_op_info *op_info = &action->info;
3982 const char *mapping;
3983
3984 pr_out_str(ctx->dl, "type",
3985 dpipe_action_type_e2s(action->type));
3986 pr_out_str(ctx->dl, "header",
3987 dpipe_header_id2s(ctx, op_info->header_id,
3988 op_info->header_global));
3989 pr_out_str(ctx->dl, "field",
3990 dpipe_field_id2s(ctx, op_info->header_id,
3991 op_info->field_id,
3992 op_info->header_global));
3993 mapping = dpipe_mapping_get(ctx, op_info->header_id,
3994 op_info->field_id,
3995 op_info->header_global);
3996 if (mapping)
3997 pr_out_str(ctx->dl, "mapping", mapping);
3998 }
3999
4000 static int dpipe_action_parse(struct dpipe_action *action, struct nlattr *nl)
4001 {
4002 struct nlattr *nla_action[DEVLINK_ATTR_MAX + 1] = {};
4003 int err;
4004
4005 err = mnl_attr_parse_nested(nl, attr_cb, nla_action);
4006 if (err != MNL_CB_OK)
4007 return -EINVAL;
4008
4009 if (!nla_action[DEVLINK_ATTR_DPIPE_ACTION_TYPE] ||
4010 !nla_action[DEVLINK_ATTR_DPIPE_HEADER_INDEX] ||
4011 !nla_action[DEVLINK_ATTR_DPIPE_HEADER_ID] ||
4012 !nla_action[DEVLINK_ATTR_DPIPE_FIELD_ID]) {
4013 return -EINVAL;
4014 }
4015
4016 action->type = mnl_attr_get_u32(nla_action[DEVLINK_ATTR_DPIPE_ACTION_TYPE]);
4017 action->info.header_id = mnl_attr_get_u32(nla_action[DEVLINK_ATTR_DPIPE_HEADER_ID]);
4018 action->info.field_id = mnl_attr_get_u32(nla_action[DEVLINK_ATTR_DPIPE_FIELD_ID]);
4019 action->info.header_global = !!mnl_attr_get_u8(nla_action[DEVLINK_ATTR_DPIPE_HEADER_GLOBAL]);
4020
4021 return 0;
4022 }
4023
4024 static int dpipe_table_actions_show(struct dpipe_ctx *ctx,
4025 struct nlattr *nla_actions)
4026 {
4027 struct nlattr *nla_action;
4028 struct dpipe_action action;
4029
4030 mnl_attr_for_each_nested(nla_action, nla_actions) {
4031 pr_out_entry_start(ctx->dl);
4032 if (dpipe_action_parse(&action, nla_action))
4033 goto err_action_parse;
4034 pr_out_dpipe_action(&action, ctx);
4035 pr_out_entry_end(ctx->dl);
4036 }
4037 return 0;
4038
4039 err_action_parse:
4040 pr_out_entry_end(ctx->dl);
4041 return -EINVAL;
4042 }
4043
4044 static const char *
4045 dpipe_match_type_e2s(enum devlink_dpipe_match_type match_type)
4046 {
4047 switch (match_type) {
4048 case DEVLINK_DPIPE_MATCH_TYPE_FIELD_EXACT:
4049 return "field_exact";
4050 default:
4051 return "<unknown>";
4052 }
4053 }
4054
4055 struct dpipe_match {
4056 struct dpipe_op_info info;
4057 uint32_t type;
4058 };
4059
4060 static void pr_out_dpipe_match(struct dpipe_match *match,
4061 struct dpipe_ctx *ctx)
4062 {
4063 struct dpipe_op_info *op_info = &match->info;
4064 const char *mapping;
4065
4066 pr_out_str(ctx->dl, "type",
4067 dpipe_match_type_e2s(match->type));
4068 pr_out_str(ctx->dl, "header",
4069 dpipe_header_id2s(ctx, op_info->header_id,
4070 op_info->header_global));
4071 pr_out_str(ctx->dl, "field",
4072 dpipe_field_id2s(ctx, op_info->header_id,
4073 op_info->field_id,
4074 op_info->header_global));
4075 mapping = dpipe_mapping_get(ctx, op_info->header_id,
4076 op_info->field_id,
4077 op_info->header_global);
4078 if (mapping)
4079 pr_out_str(ctx->dl, "mapping", mapping);
4080 }
4081
4082 static int dpipe_match_parse(struct dpipe_match *match,
4083 struct nlattr *nl)
4084
4085 {
4086 struct nlattr *nla_match[DEVLINK_ATTR_MAX + 1] = {};
4087 int err;
4088
4089 err = mnl_attr_parse_nested(nl, attr_cb, nla_match);
4090 if (err != MNL_CB_OK)
4091 return -EINVAL;
4092
4093 if (!nla_match[DEVLINK_ATTR_DPIPE_MATCH_TYPE] ||
4094 !nla_match[DEVLINK_ATTR_DPIPE_HEADER_INDEX] ||
4095 !nla_match[DEVLINK_ATTR_DPIPE_HEADER_ID] ||
4096 !nla_match[DEVLINK_ATTR_DPIPE_FIELD_ID]) {
4097 return -EINVAL;
4098 }
4099
4100 match->type = mnl_attr_get_u32(nla_match[DEVLINK_ATTR_DPIPE_MATCH_TYPE]);
4101 match->info.header_id = mnl_attr_get_u32(nla_match[DEVLINK_ATTR_DPIPE_HEADER_ID]);
4102 match->info.field_id = mnl_attr_get_u32(nla_match[DEVLINK_ATTR_DPIPE_FIELD_ID]);
4103 match->info.header_global = !!mnl_attr_get_u8(nla_match[DEVLINK_ATTR_DPIPE_HEADER_GLOBAL]);
4104
4105 return 0;
4106 }
4107
4108 static int dpipe_table_matches_show(struct dpipe_ctx *ctx,
4109 struct nlattr *nla_matches)
4110 {
4111 struct nlattr *nla_match;
4112 struct dpipe_match match;
4113
4114 mnl_attr_for_each_nested(nla_match, nla_matches) {
4115 pr_out_entry_start(ctx->dl);
4116 if (dpipe_match_parse(&match, nla_match))
4117 goto err_match_parse;
4118 pr_out_dpipe_match(&match, ctx);
4119 pr_out_entry_end(ctx->dl);
4120 }
4121 return 0;
4122
4123 err_match_parse:
4124 pr_out_entry_end(ctx->dl);
4125 return -EINVAL;
4126 }
4127
4128 static struct resource *
4129 resource_find(struct resources *resources, struct resource *resource,
4130 uint64_t resource_id)
4131 {
4132 struct list_head *list_head;
4133
4134 if (!resource)
4135 list_head = &resources->resource_list;
4136 else
4137 list_head = &resource->resource_list;
4138
4139 list_for_each_entry(resource, list_head, list) {
4140 struct resource *child_resource;
4141
4142 if (resource->id == resource_id)
4143 return resource;
4144
4145 child_resource = resource_find(resources, resource,
4146 resource_id);
4147 if (child_resource)
4148 return child_resource;
4149 }
4150 return NULL;
4151 }
4152
4153 static void
4154 resource_path_print(struct dl *dl, struct resources *resources,
4155 uint64_t resource_id)
4156 {
4157 struct resource *resource, *parent_resource;
4158 const char del[] = "/";
4159 int path_len = 0;
4160 char *path;
4161
4162 resource = resource_find(resources, NULL, resource_id);
4163 if (!resource)
4164 return;
4165
4166 for (parent_resource = resource; parent_resource;
4167 parent_resource = parent_resource->parent)
4168 path_len += strlen(parent_resource->name) + 1;
4169
4170 path_len++;
4171 path = calloc(1, path_len);
4172 if (!path)
4173 return;
4174
4175 path += path_len - 1;
4176 for (parent_resource = resource; parent_resource;
4177 parent_resource = parent_resource->parent) {
4178 path -= strlen(parent_resource->name);
4179 memcpy(path, parent_resource->name,
4180 strlen(parent_resource->name));
4181 path -= strlen(del);
4182 memcpy(path, del, strlen(del));
4183 }
4184 pr_out_str(dl, "resource_path", path);
4185 free(path);
4186 }
4187
4188 static int dpipe_table_show(struct dpipe_ctx *ctx, struct nlattr *nl)
4189 {
4190 struct nlattr *nla_table[DEVLINK_ATTR_MAX + 1] = {};
4191 struct dpipe_table *table;
4192 uint32_t resource_units;
4193 bool counters_enabled;
4194 bool resource_valid;
4195 uint32_t size;
4196 int err;
4197
4198 err = mnl_attr_parse_nested(nl, attr_cb, nla_table);
4199 if (err != MNL_CB_OK)
4200 return -EINVAL;
4201
4202 if (!nla_table[DEVLINK_ATTR_DPIPE_TABLE_NAME] ||
4203 !nla_table[DEVLINK_ATTR_DPIPE_TABLE_SIZE] ||
4204 !nla_table[DEVLINK_ATTR_DPIPE_TABLE_ACTIONS] ||
4205 !nla_table[DEVLINK_ATTR_DPIPE_TABLE_MATCHES] ||
4206 !nla_table[DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED]) {
4207 return -EINVAL;
4208 }
4209
4210 table = dpipe_table_alloc();
4211 if (!table)
4212 return -ENOMEM;
4213
4214 table->name = strdup(mnl_attr_get_str(nla_table[DEVLINK_ATTR_DPIPE_TABLE_NAME]));
4215 size = mnl_attr_get_u32(nla_table[DEVLINK_ATTR_DPIPE_TABLE_SIZE]);
4216 counters_enabled = !!mnl_attr_get_u8(nla_table[DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED]);
4217
4218 resource_valid = !!nla_table[DEVLINK_ATTR_DPIPE_TABLE_RESOURCE_ID];
4219 if (resource_valid) {
4220 table->resource_id = mnl_attr_get_u64(nla_table[DEVLINK_ATTR_DPIPE_TABLE_RESOURCE_ID]);
4221 table->resource_valid = true;
4222 }
4223
4224 list_add_tail(&table->list, &ctx->tables->table_list);
4225 if (!ctx->print_tables)
4226 return 0;
4227
4228 pr_out_str(ctx->dl, "name", table->name);
4229 pr_out_uint(ctx->dl, "size", size);
4230 pr_out_str(ctx->dl, "counters_enabled",
4231 counters_enabled ? "true" : "false");
4232
4233 if (resource_valid) {
4234 resource_units = mnl_attr_get_u32(nla_table[DEVLINK_ATTR_DPIPE_TABLE_RESOURCE_UNITS]);
4235 resource_path_print(ctx->dl, ctx->resources,
4236 table->resource_id);
4237 pr_out_uint(ctx->dl, "resource_units", resource_units);
4238 }
4239
4240 pr_out_array_start(ctx->dl, "match");
4241 if (dpipe_table_matches_show(ctx, nla_table[DEVLINK_ATTR_DPIPE_TABLE_MATCHES]))
4242 goto err_matches_show;
4243 pr_out_array_end(ctx->dl);
4244
4245 pr_out_array_start(ctx->dl, "action");
4246 if (dpipe_table_actions_show(ctx, nla_table[DEVLINK_ATTR_DPIPE_TABLE_ACTIONS]))
4247 goto err_actions_show;
4248 pr_out_array_end(ctx->dl);
4249
4250 return 0;
4251
4252 err_actions_show:
4253 err_matches_show:
4254 pr_out_array_end(ctx->dl);
4255 return -EINVAL;
4256 }
4257
4258 static int dpipe_tables_show(struct dpipe_ctx *ctx, struct nlattr **tb)
4259 {
4260 struct nlattr *nla_tables = tb[DEVLINK_ATTR_DPIPE_TABLES];
4261 struct nlattr *nla_table;
4262
4263 mnl_attr_for_each_nested(nla_table, nla_tables) {
4264 if (ctx->print_tables)
4265 pr_out_handle_start_arr(ctx->dl, tb);
4266 if (dpipe_table_show(ctx, nla_table))
4267 goto err_table_show;
4268 if (ctx->print_tables)
4269 pr_out_handle_end(ctx->dl);
4270 }
4271 return 0;
4272
4273 err_table_show:
4274 if (ctx->print_tables)
4275 pr_out_handle_end(ctx->dl);
4276 return -EINVAL;
4277 }
4278
4279 static int cmd_dpipe_table_show_cb(const struct nlmsghdr *nlh, void *data)
4280 {
4281 struct dpipe_ctx *ctx = data;
4282 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
4283 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
4284
4285 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
4286 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
4287 !tb[DEVLINK_ATTR_DPIPE_TABLES])
4288 return MNL_CB_ERROR;
4289
4290 if (dpipe_tables_show(ctx, tb))
4291 return MNL_CB_ERROR;
4292 return MNL_CB_OK;
4293 }
4294
4295 static int cmd_resource_dump_cb(const struct nlmsghdr *nlh, void *data);
4296
4297 static int cmd_dpipe_table_show(struct dl *dl)
4298 {
4299 struct nlmsghdr *nlh;
4300 struct dpipe_ctx dpipe_ctx = {};
4301 struct resource_ctx resource_ctx = {};
4302 uint16_t flags = NLM_F_REQUEST;
4303 int err;
4304
4305 err = dl_argv_parse(dl, DL_OPT_HANDLE, DL_OPT_DPIPE_TABLE_NAME);
4306 if (err)
4307 return err;
4308
4309 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_HEADERS_GET, flags);
4310
4311 err = dpipe_ctx_init(&dpipe_ctx, dl);
4312 if (err)
4313 return err;
4314
4315 dpipe_ctx.print_tables = true;
4316
4317 dl_opts_put(nlh, dl);
4318 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_header_cb,
4319 &dpipe_ctx);
4320 if (err) {
4321 pr_err("error get headers %s\n", strerror(dpipe_ctx.err));
4322 goto err_headers_get;
4323 }
4324
4325 err = resource_ctx_init(&resource_ctx, dl);
4326 if (err)
4327 goto err_resource_ctx_init;
4328
4329 resource_ctx.print_resources = false;
4330 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_RESOURCE_DUMP, flags);
4331 dl_opts_put(nlh, dl);
4332 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_resource_dump_cb,
4333 &resource_ctx);
4334 if (err) {
4335 pr_err("error get resources %s\n", strerror(resource_ctx.err));
4336 goto err_resource_dump;
4337 }
4338
4339 dpipe_ctx.resources = resource_ctx.resources;
4340 flags = NLM_F_REQUEST | NLM_F_ACK;
4341 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_TABLE_GET, flags);
4342 dl_opts_put(nlh, dl);
4343
4344 pr_out_section_start(dl, "table");
4345 _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_table_show_cb, &dpipe_ctx);
4346 pr_out_section_end(dl);
4347
4348 resource_ctx_fini(&resource_ctx);
4349 dpipe_ctx_fini(&dpipe_ctx);
4350 return 0;
4351
4352 err_resource_dump:
4353 resource_ctx_fini(&resource_ctx);
4354 err_resource_ctx_init:
4355 err_headers_get:
4356 dpipe_ctx_fini(&dpipe_ctx);
4357 return err;
4358 }
4359
4360 static int cmd_dpipe_table_set(struct dl *dl)
4361 {
4362 struct nlmsghdr *nlh;
4363 int err;
4364
4365 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_TABLE_COUNTERS_SET,
4366 NLM_F_REQUEST | NLM_F_ACK);
4367
4368 err = dl_argv_parse_put(nlh, dl,
4369 DL_OPT_HANDLE | DL_OPT_DPIPE_TABLE_NAME |
4370 DL_OPT_DPIPE_TABLE_COUNTERS, 0);
4371 if (err)
4372 return err;
4373
4374 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
4375 }
4376
4377 enum dpipe_value_type {
4378 DPIPE_VALUE_TYPE_VALUE,
4379 DPIPE_VALUE_TYPE_MASK,
4380 };
4381
4382 static const char *
4383 dpipe_value_type_e2s(enum dpipe_value_type type)
4384 {
4385 switch (type) {
4386 case DPIPE_VALUE_TYPE_VALUE:
4387 return "value";
4388 case DPIPE_VALUE_TYPE_MASK:
4389 return "value_mask";
4390 default:
4391 return "<unknown>";
4392 }
4393 }
4394
4395 struct dpipe_field_printer {
4396 unsigned int field_id;
4397 void (*printer)(struct dpipe_ctx *, enum dpipe_value_type, void *);
4398 };
4399
4400 struct dpipe_header_printer {
4401 struct dpipe_field_printer *printers;
4402 unsigned int printers_count;
4403 unsigned int header_id;
4404 };
4405
4406 static void dpipe_field_printer_ipv4_addr(struct dpipe_ctx *ctx,
4407 enum dpipe_value_type type,
4408 void *value)
4409 {
4410 struct in_addr ip_addr;
4411
4412 ip_addr.s_addr = htonl(*(uint32_t *)value);
4413 pr_out_str(ctx->dl, dpipe_value_type_e2s(type), inet_ntoa(ip_addr));
4414 }
4415
4416 static void
4417 dpipe_field_printer_ethernet_addr(struct dpipe_ctx *ctx,
4418 enum dpipe_value_type type,
4419 void *value)
4420 {
4421 pr_out_str(ctx->dl, dpipe_value_type_e2s(type),
4422 ether_ntoa((struct ether_addr *)value));
4423 }
4424
4425 static void dpipe_field_printer_ipv6_addr(struct dpipe_ctx *ctx,
4426 enum dpipe_value_type type,
4427 void *value)
4428 {
4429 char str[INET6_ADDRSTRLEN];
4430
4431 inet_ntop(AF_INET6, value, str, INET6_ADDRSTRLEN);
4432 pr_out_str(ctx->dl, dpipe_value_type_e2s(type), str);
4433 }
4434
4435 static struct dpipe_field_printer dpipe_field_printers_ipv4[] = {
4436 {
4437 .printer = dpipe_field_printer_ipv4_addr,
4438 .field_id = DEVLINK_DPIPE_FIELD_IPV4_DST_IP,
4439 }
4440 };
4441
4442 static struct dpipe_header_printer dpipe_header_printer_ipv4 = {
4443 .printers = dpipe_field_printers_ipv4,
4444 .printers_count = ARRAY_SIZE(dpipe_field_printers_ipv4),
4445 .header_id = DEVLINK_DPIPE_HEADER_IPV4,
4446 };
4447
4448 static struct dpipe_field_printer dpipe_field_printers_ethernet[] = {
4449 {
4450 .printer = dpipe_field_printer_ethernet_addr,
4451 .field_id = DEVLINK_DPIPE_FIELD_ETHERNET_DST_MAC,
4452 },
4453 };
4454
4455 static struct dpipe_header_printer dpipe_header_printer_ethernet = {
4456 .printers = dpipe_field_printers_ethernet,
4457 .printers_count = ARRAY_SIZE(dpipe_field_printers_ethernet),
4458 .header_id = DEVLINK_DPIPE_HEADER_ETHERNET,
4459 };
4460
4461 static struct dpipe_field_printer dpipe_field_printers_ipv6[] = {
4462 {
4463 .printer = dpipe_field_printer_ipv6_addr,
4464 .field_id = DEVLINK_DPIPE_FIELD_IPV6_DST_IP,
4465 }
4466 };
4467
4468 static struct dpipe_header_printer dpipe_header_printer_ipv6 = {
4469 .printers = dpipe_field_printers_ipv6,
4470 .printers_count = ARRAY_SIZE(dpipe_field_printers_ipv6),
4471 .header_id = DEVLINK_DPIPE_HEADER_IPV6,
4472 };
4473
4474 static struct dpipe_header_printer *dpipe_header_printers[] = {
4475 &dpipe_header_printer_ipv4,
4476 &dpipe_header_printer_ethernet,
4477 &dpipe_header_printer_ipv6,
4478 };
4479
4480 static int dpipe_print_prot_header(struct dpipe_ctx *ctx,
4481 struct dpipe_op_info *info,
4482 enum dpipe_value_type type,
4483 void *value)
4484 {
4485 unsigned int header_printers_count = ARRAY_SIZE(dpipe_header_printers);
4486 struct dpipe_header_printer *header_printer;
4487 struct dpipe_field_printer *field_printer;
4488 unsigned int field_printers_count;
4489 int j;
4490 int i;
4491
4492 for (i = 0; i < header_printers_count; i++) {
4493 header_printer = dpipe_header_printers[i];
4494 if (header_printer->header_id != info->header_id)
4495 continue;
4496 field_printers_count = header_printer->printers_count;
4497 for (j = 0; j < field_printers_count; j++) {
4498 field_printer = &header_printer->printers[j];
4499 if (field_printer->field_id != info->field_id)
4500 continue;
4501 field_printer->printer(ctx, type, value);
4502 return 0;
4503 }
4504 }
4505
4506 return -EINVAL;
4507 }
4508
4509 static void __pr_out_entry_value(struct dpipe_ctx *ctx,
4510 void *value,
4511 unsigned int value_len,
4512 struct dpipe_op_info *info,
4513 enum dpipe_value_type type)
4514 {
4515 if (info->header_global &&
4516 !dpipe_print_prot_header(ctx, info, type, value))
4517 return;
4518
4519 if (value_len == sizeof(uint32_t)) {
4520 uint32_t *value_32 = value;
4521
4522 pr_out_uint(ctx->dl, dpipe_value_type_e2s(type), *value_32);
4523 }
4524 }
4525
4526 static void pr_out_dpipe_entry_value(struct dpipe_ctx *ctx,
4527 struct nlattr **nla_match_value,
4528 struct dpipe_op_info *info)
4529 {
4530 void *value, *value_mask;
4531 uint32_t value_mapping;
4532 uint16_t value_len;
4533 bool mask, mapping;
4534
4535 mask = !!nla_match_value[DEVLINK_ATTR_DPIPE_VALUE_MASK];
4536 mapping = !!nla_match_value[DEVLINK_ATTR_DPIPE_VALUE_MAPPING];
4537
4538 value_len = mnl_attr_get_payload_len(nla_match_value[DEVLINK_ATTR_DPIPE_VALUE]);
4539 value = mnl_attr_get_payload(nla_match_value[DEVLINK_ATTR_DPIPE_VALUE]);
4540
4541 if (mapping) {
4542 value_mapping = mnl_attr_get_u32(nla_match_value[DEVLINK_ATTR_DPIPE_VALUE_MAPPING]);
4543 pr_out_uint(ctx->dl, "mapping_value", value_mapping);
4544 }
4545
4546 if (mask) {
4547 value_mask = mnl_attr_get_payload(nla_match_value[DEVLINK_ATTR_DPIPE_VALUE]);
4548 __pr_out_entry_value(ctx, value_mask, value_len, info,
4549 DPIPE_VALUE_TYPE_MASK);
4550 }
4551
4552 __pr_out_entry_value(ctx, value, value_len, info, DPIPE_VALUE_TYPE_VALUE);
4553 }
4554
4555 static int dpipe_entry_match_value_show(struct dpipe_ctx *ctx,
4556 struct nlattr *nl)
4557 {
4558 struct nlattr *nla_match_value[DEVLINK_ATTR_MAX + 1] = {};
4559 struct dpipe_match match;
4560 int err;
4561
4562 err = mnl_attr_parse_nested(nl, attr_cb, nla_match_value);
4563 if (err != MNL_CB_OK)
4564 return -EINVAL;
4565
4566 if (!nla_match_value[DEVLINK_ATTR_DPIPE_MATCH] ||
4567 !nla_match_value[DEVLINK_ATTR_DPIPE_VALUE]) {
4568 return -EINVAL;
4569 }
4570
4571 pr_out_entry_start(ctx->dl);
4572 if (dpipe_match_parse(&match,
4573 nla_match_value[DEVLINK_ATTR_DPIPE_MATCH]))
4574 goto err_match_parse;
4575 pr_out_dpipe_match(&match, ctx);
4576 pr_out_dpipe_entry_value(ctx, nla_match_value, &match.info);
4577 pr_out_entry_end(ctx->dl);
4578
4579 return 0;
4580
4581 err_match_parse:
4582 pr_out_entry_end(ctx->dl);
4583 return -EINVAL;
4584 }
4585
4586 static int dpipe_entry_action_value_show(struct dpipe_ctx *ctx,
4587 struct nlattr *nl)
4588 {
4589 struct nlattr *nla_action_value[DEVLINK_ATTR_MAX + 1] = {};
4590 struct dpipe_action action;
4591 int err;
4592
4593 err = mnl_attr_parse_nested(nl, attr_cb, nla_action_value);
4594 if (err != MNL_CB_OK)
4595 return -EINVAL;
4596
4597 if (!nla_action_value[DEVLINK_ATTR_DPIPE_ACTION] ||
4598 !nla_action_value[DEVLINK_ATTR_DPIPE_VALUE]) {
4599 return -EINVAL;
4600 }
4601
4602 pr_out_entry_start(ctx->dl);
4603 if (dpipe_action_parse(&action,
4604 nla_action_value[DEVLINK_ATTR_DPIPE_ACTION]))
4605 goto err_action_parse;
4606 pr_out_dpipe_action(&action, ctx);
4607 pr_out_dpipe_entry_value(ctx, nla_action_value, &action.info);
4608 pr_out_entry_end(ctx->dl);
4609
4610 return 0;
4611
4612 err_action_parse:
4613 pr_out_entry_end(ctx->dl);
4614 return -EINVAL;
4615 }
4616
4617 static int
4618 dpipe_tables_action_values_show(struct dpipe_ctx *ctx,
4619 struct nlattr *nla_action_values)
4620 {
4621 struct nlattr *nla_action_value;
4622
4623 mnl_attr_for_each_nested(nla_action_value, nla_action_values) {
4624 if (dpipe_entry_action_value_show(ctx, nla_action_value))
4625 return -EINVAL;
4626 }
4627 return 0;
4628 }
4629
4630 static int
4631 dpipe_tables_match_values_show(struct dpipe_ctx *ctx,
4632 struct nlattr *nla_match_values)
4633 {
4634 struct nlattr *nla_match_value;
4635
4636 mnl_attr_for_each_nested(nla_match_value, nla_match_values) {
4637 if (dpipe_entry_match_value_show(ctx, nla_match_value))
4638 return -EINVAL;
4639 }
4640 return 0;
4641 }
4642
4643 static int dpipe_entry_show(struct dpipe_ctx *ctx, struct nlattr *nl)
4644 {
4645 struct nlattr *nla_entry[DEVLINK_ATTR_MAX + 1] = {};
4646 uint32_t entry_index;
4647 uint64_t counter;
4648 int err;
4649
4650 err = mnl_attr_parse_nested(nl, attr_cb, nla_entry);
4651 if (err != MNL_CB_OK)
4652 return -EINVAL;
4653
4654 if (!nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_INDEX] ||
4655 !nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_MATCH_VALUES] ||
4656 !nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_ACTION_VALUES]) {
4657 return -EINVAL;
4658 }
4659
4660 entry_index = mnl_attr_get_u32(nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_INDEX]);
4661 pr_out_uint(ctx->dl, "index", entry_index);
4662
4663 if (nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_COUNTER]) {
4664 counter = mnl_attr_get_u64(nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_COUNTER]);
4665 pr_out_uint(ctx->dl, "counter", counter);
4666 }
4667
4668 pr_out_array_start(ctx->dl, "match_value");
4669 if (dpipe_tables_match_values_show(ctx,
4670 nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_MATCH_VALUES]))
4671 goto err_match_values_show;
4672 pr_out_array_end(ctx->dl);
4673
4674 pr_out_array_start(ctx->dl, "action_value");
4675 if (dpipe_tables_action_values_show(ctx,
4676 nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_ACTION_VALUES]))
4677 goto err_action_values_show;
4678 pr_out_array_end(ctx->dl);
4679 return 0;
4680
4681 err_action_values_show:
4682 err_match_values_show:
4683 pr_out_array_end(ctx->dl);
4684 return -EINVAL;
4685 }
4686
4687 static int dpipe_table_entries_show(struct dpipe_ctx *ctx, struct nlattr **tb)
4688 {
4689 struct nlattr *nla_entries = tb[DEVLINK_ATTR_DPIPE_ENTRIES];
4690 struct nlattr *nla_entry;
4691
4692 mnl_attr_for_each_nested(nla_entry, nla_entries) {
4693 pr_out_handle_start_arr(ctx->dl, tb);
4694 if (dpipe_entry_show(ctx, nla_entry))
4695 goto err_entry_show;
4696 pr_out_handle_end(ctx->dl);
4697 }
4698 return 0;
4699
4700 err_entry_show:
4701 pr_out_handle_end(ctx->dl);
4702 return -EINVAL;
4703 }
4704
4705 static int cmd_dpipe_table_entry_dump_cb(const struct nlmsghdr *nlh, void *data)
4706 {
4707 struct dpipe_ctx *ctx = data;
4708 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
4709 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
4710
4711 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
4712 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
4713 !tb[DEVLINK_ATTR_DPIPE_ENTRIES])
4714 return MNL_CB_ERROR;
4715
4716 if (dpipe_table_entries_show(ctx, tb))
4717 return MNL_CB_ERROR;
4718 return MNL_CB_OK;
4719 }
4720
4721 static int cmd_dpipe_table_dump(struct dl *dl)
4722 {
4723 struct nlmsghdr *nlh;
4724 struct dpipe_ctx ctx = {};
4725 uint16_t flags = NLM_F_REQUEST;
4726 int err;
4727
4728 err = dpipe_ctx_init(&ctx, dl);
4729 if (err)
4730 return err;
4731
4732 err = dl_argv_parse(dl, DL_OPT_HANDLE | DL_OPT_DPIPE_TABLE_NAME, 0);
4733 if (err)
4734 goto out;
4735
4736 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_HEADERS_GET, flags);
4737 dl_opts_put(nlh, dl);
4738 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_header_cb, &ctx);
4739 if (err) {
4740 pr_err("error get headers %s\n", strerror(ctx.err));
4741 goto out;
4742 }
4743
4744 flags = NLM_F_REQUEST | NLM_F_ACK;
4745 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_ENTRIES_GET, flags);
4746 dl_opts_put(nlh, dl);
4747
4748 pr_out_section_start(dl, "table_entry");
4749 _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_table_entry_dump_cb, &ctx);
4750 pr_out_section_end(dl);
4751 out:
4752 dpipe_ctx_fini(&ctx);
4753 return err;
4754 }
4755
4756 static void cmd_dpipe_table_help(void)
4757 {
4758 pr_err("Usage: devlink dpipe table [ OBJECT-LIST ]\n"
4759 "where OBJECT-LIST := { show | set | dump }\n");
4760 }
4761
4762 static int cmd_dpipe_table(struct dl *dl)
4763 {
4764 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
4765 cmd_dpipe_table_help();
4766 return 0;
4767 } else if (dl_argv_match(dl, "show")) {
4768 dl_arg_inc(dl);
4769 return cmd_dpipe_table_show(dl);
4770 } else if (dl_argv_match(dl, "set")) {
4771 dl_arg_inc(dl);
4772 return cmd_dpipe_table_set(dl);
4773 } else if (dl_argv_match(dl, "dump")) {
4774 dl_arg_inc(dl);
4775 return cmd_dpipe_table_dump(dl);
4776 }
4777 pr_err("Command \"%s\" not found\n", dl_argv(dl));
4778 return -ENOENT;
4779 }
4780
4781 static void cmd_dpipe_help(void)
4782 {
4783 pr_err("Usage: devlink dpipe [ OBJECT-LIST ]\n"
4784 "where OBJECT-LIST := { header | table }\n");
4785 }
4786
4787 static int cmd_dpipe(struct dl *dl)
4788 {
4789 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
4790 cmd_dpipe_help();
4791 return 0;
4792 } else if (dl_argv_match(dl, "header")) {
4793 dl_arg_inc(dl);
4794 return cmd_dpipe_header(dl);
4795 } else if (dl_argv_match(dl, "table")) {
4796 dl_arg_inc(dl);
4797 return cmd_dpipe_table(dl);
4798 }
4799 pr_err("Command \"%s\" not found\n", dl_argv(dl));
4800 return -ENOENT;
4801 }
4802
4803 static int
4804 resource_parse(struct resource_ctx *ctx, struct resource *resource,
4805 struct nlattr **nla_resource)
4806 {
4807 if (!nla_resource[DEVLINK_ATTR_RESOURCE_NAME] ||
4808 !nla_resource[DEVLINK_ATTR_RESOURCE_SIZE] ||
4809 !nla_resource[DEVLINK_ATTR_RESOURCE_ID] ||
4810 !nla_resource[DEVLINK_ATTR_RESOURCE_UNIT] ||
4811 !nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_MIN] ||
4812 !nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_MAX] ||
4813 !nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_GRAN]) {
4814 return -EINVAL;
4815 }
4816
4817 resource->name = strdup(mnl_attr_get_str(nla_resource[DEVLINK_ATTR_RESOURCE_NAME]));
4818 resource->size = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE]);
4819 resource->id = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_ID]);
4820 resource->unit = mnl_attr_get_u8(nla_resource[DEVLINK_ATTR_RESOURCE_UNIT]);
4821 resource->size_min = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_MIN]);
4822 resource->size_max = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_MAX]);
4823 resource->size_gran = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_GRAN]);
4824
4825 if (nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_NEW])
4826 resource->size_new = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_NEW]);
4827 else
4828 resource->size_new = resource->size;
4829
4830 if (nla_resource[DEVLINK_ATTR_RESOURCE_OCC]) {
4831 resource->size_occ = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_OCC]);
4832 resource->occ_valid = true;
4833 }
4834
4835 if (resource->size_new != resource->size)
4836 ctx->pending_change = true;
4837
4838 return 0;
4839 }
4840
4841 static int
4842 resource_get(struct resource_ctx *ctx, struct resource *resource,
4843 struct resource *parent_resource, struct nlattr *nl)
4844 {
4845 struct nlattr *nla_resource[DEVLINK_ATTR_MAX + 1] = {};
4846 struct nlattr *nla_child_resource;
4847 struct nlattr *nla_resources;
4848 bool top = false;
4849 int err;
4850
4851 if (!resource) {
4852 nla_resources = nl;
4853 top = true;
4854 goto out;
4855 }
4856
4857 err = mnl_attr_parse_nested(nl, attr_cb, nla_resource);
4858 if (err != MNL_CB_OK)
4859 return -EINVAL;
4860
4861 err = resource_parse(ctx, resource, nla_resource);
4862 if (err)
4863 return err;
4864
4865 resource->parent = parent_resource;
4866 if (!nla_resource[DEVLINK_ATTR_RESOURCE_LIST])
4867 return 0;
4868
4869 resource->size_valid = !!mnl_attr_get_u8(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_VALID]);
4870 nla_resources = nla_resource[DEVLINK_ATTR_RESOURCE_LIST];
4871 out:
4872 mnl_attr_for_each_nested(nla_child_resource, nla_resources) {
4873 struct resource *child_resource;
4874 struct list_head *list;
4875
4876 child_resource = resource_alloc();
4877 if (!child_resource)
4878 return -ENOMEM;
4879
4880 if (top)
4881 list = &ctx->resources->resource_list;
4882 else
4883 list = &resource->resource_list;
4884
4885 list_add_tail(&child_resource->list, list);
4886 err = resource_get(ctx, child_resource, resource,
4887 nla_child_resource);
4888 if (err)
4889 return err;
4890 }
4891
4892 return 0;
4893 }
4894
4895 static const char *resource_unit_str_get(enum devlink_resource_unit unit)
4896 {
4897 switch (unit) {
4898 case DEVLINK_RESOURCE_UNIT_ENTRY: return "entry";
4899 default: return "<unknown unit>";
4900 }
4901 }
4902
4903 static void resource_show(struct resource *resource,
4904 struct resource_ctx *ctx)
4905 {
4906 struct resource *child_resource;
4907 struct dpipe_table *table;
4908 struct dl *dl = ctx->dl;
4909 bool array = false;
4910
4911 pr_out_str(dl, "name", resource->name);
4912 if (dl->verbose)
4913 resource_path_print(dl, ctx->resources, resource->id);
4914 pr_out_u64(dl, "size", resource->size);
4915 if (resource->size != resource->size_new)
4916 pr_out_u64(dl, "size_new", resource->size_new);
4917 if (resource->occ_valid)
4918 pr_out_uint(dl, "occ", resource->size_occ);
4919 pr_out_str(dl, "unit", resource_unit_str_get(resource->unit));
4920
4921 if (resource->size_min != resource->size_max) {
4922 pr_out_uint(dl, "size_min", resource->size_min);
4923 pr_out_u64(dl, "size_max", resource->size_max);
4924 pr_out_uint(dl, "size_gran", resource->size_gran);
4925 }
4926
4927 list_for_each_entry(table, &ctx->tables->table_list, list)
4928 if (table->resource_id == resource->id &&
4929 table->resource_valid)
4930 array = true;
4931
4932 if (array)
4933 pr_out_array_start(dl, "dpipe_tables");
4934 else
4935 pr_out_str(dl, "dpipe_tables", "none");
4936
4937 list_for_each_entry(table, &ctx->tables->table_list, list) {
4938 if (table->resource_id != resource->id ||
4939 !table->resource_valid)
4940 continue;
4941 pr_out_entry_start(dl);
4942 pr_out_str(dl, "table_name", table->name);
4943 pr_out_entry_end(dl);
4944 }
4945 if (array)
4946 pr_out_array_end(dl);
4947
4948 if (list_empty(&resource->resource_list))
4949 return;
4950
4951 if (ctx->pending_change)
4952 pr_out_str(dl, "size_valid", resource->size_valid ?
4953 "true" : "false");
4954 pr_out_array_start(dl, "resources");
4955 list_for_each_entry(child_resource, &resource->resource_list, list) {
4956 pr_out_entry_start(dl);
4957 resource_show(child_resource, ctx);
4958 pr_out_entry_end(dl);
4959 }
4960 pr_out_array_end(dl);
4961 }
4962
4963 static void
4964 resources_show(struct resource_ctx *ctx, struct nlattr **tb)
4965 {
4966 struct resources *resources = ctx->resources;
4967 struct resource *resource;
4968
4969 list_for_each_entry(resource, &resources->resource_list, list) {
4970 pr_out_handle_start_arr(ctx->dl, tb);
4971 resource_show(resource, ctx);
4972 pr_out_handle_end(ctx->dl);
4973 }
4974 }
4975
4976 static int resources_get(struct resource_ctx *ctx, struct nlattr **tb)
4977 {
4978 return resource_get(ctx, NULL, NULL, tb[DEVLINK_ATTR_RESOURCE_LIST]);
4979 }
4980
4981 static int cmd_resource_dump_cb(const struct nlmsghdr *nlh, void *data)
4982 {
4983 struct resource_ctx *ctx = data;
4984 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
4985 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
4986 int err;
4987
4988 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
4989 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
4990 !tb[DEVLINK_ATTR_RESOURCE_LIST])
4991 return MNL_CB_ERROR;
4992
4993 err = resources_get(ctx, tb);
4994 if (err) {
4995 ctx->err = err;
4996 return MNL_CB_ERROR;
4997 }
4998
4999 if (ctx->print_resources)
5000 resources_show(ctx, tb);
5001
5002 return MNL_CB_OK;
5003 }
5004
5005 static int cmd_resource_show(struct dl *dl)
5006 {
5007 struct nlmsghdr *nlh;
5008 struct dpipe_ctx dpipe_ctx = {};
5009 struct resource_ctx resource_ctx = {};
5010 int err;
5011
5012 err = dl_argv_parse(dl, DL_OPT_HANDLE, 0);
5013 if (err)
5014 return err;
5015
5016 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_TABLE_GET,
5017 NLM_F_REQUEST);
5018 dl_opts_put(nlh, dl);
5019
5020 err = dpipe_ctx_init(&dpipe_ctx, dl);
5021 if (err)
5022 return err;
5023
5024 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_table_show_cb,
5025 &dpipe_ctx);
5026 if (err) {
5027 pr_err("error get tables %s\n", strerror(dpipe_ctx.err));
5028 goto out;
5029 }
5030
5031 err = resource_ctx_init(&resource_ctx, dl);
5032 if (err)
5033 goto out;
5034
5035 resource_ctx.print_resources = true;
5036 resource_ctx.tables = dpipe_ctx.tables;
5037 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_RESOURCE_DUMP,
5038 NLM_F_REQUEST | NLM_F_ACK);
5039 dl_opts_put(nlh, dl);
5040 pr_out_section_start(dl, "resources");
5041 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_resource_dump_cb,
5042 &resource_ctx);
5043 pr_out_section_end(dl);
5044 resource_ctx_fini(&resource_ctx);
5045 out:
5046 dpipe_ctx_fini(&dpipe_ctx);
5047 return err;
5048 }
5049
5050 static void cmd_resource_help(void)
5051 {
5052 pr_err("Usage: devlink resource show DEV\n"
5053 " devlink resource set DEV path PATH size SIZE\n");
5054 }
5055
5056 static struct resource *
5057 resource_find_by_name(struct list_head *list, char *name)
5058 {
5059 struct resource *resource;
5060
5061 list_for_each_entry(resource, list, list) {
5062 if (!strcmp(resource->name, name))
5063 return resource;
5064 }
5065 return NULL;
5066 }
5067
5068 static int
5069 resource_path_parse(struct resource_ctx *ctx, const char *resource_path,
5070 uint32_t *p_resource_id, bool *p_resource_valid)
5071 {
5072 struct resource *resource;
5073 uint32_t resource_id = 0;
5074 char *resource_path_dup;
5075 struct list_head *list;
5076 const char del[] = "/";
5077 char *resource_name;
5078
5079 resource_path_dup = strdup(resource_path);
5080 list = &ctx->resources->resource_list;
5081 resource_name = strtok(resource_path_dup, del);
5082 while (resource_name != NULL) {
5083 resource = resource_find_by_name(list, resource_name);
5084 if (!resource)
5085 goto err_resource_lookup;
5086
5087 list = &resource->resource_list;
5088 resource_name = strtok(NULL, del);
5089 resource_id = resource->id;
5090 }
5091 free(resource_path_dup);
5092 *p_resource_valid = true;
5093 *p_resource_id = resource_id;
5094 return 0;
5095
5096 err_resource_lookup:
5097 free(resource_path_dup);
5098 return -EINVAL;
5099 }
5100
5101 static int cmd_resource_set(struct dl *dl)
5102 {
5103 struct nlmsghdr *nlh;
5104 struct resource_ctx ctx = {};
5105 int err;
5106
5107 err = resource_ctx_init(&ctx, dl);
5108 if (err)
5109 return err;
5110
5111 ctx.print_resources = false;
5112 err = dl_argv_parse(dl, DL_OPT_HANDLE | DL_OPT_RESOURCE_PATH |
5113 DL_OPT_RESOURCE_SIZE, 0);
5114 if (err)
5115 goto out;
5116
5117 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_RESOURCE_DUMP,
5118 NLM_F_REQUEST);
5119 dl_opts_put(nlh, dl);
5120 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_resource_dump_cb, &ctx);
5121 if (err) {
5122 pr_err("error getting resources %s\n", strerror(ctx.err));
5123 goto out;
5124 }
5125
5126 err = resource_path_parse(&ctx, dl->opts.resource_path,
5127 &dl->opts.resource_id,
5128 &dl->opts.resource_id_valid);
5129 if (err) {
5130 pr_err("error parsing resource path %s\n", strerror(-err));
5131 goto out;
5132 }
5133
5134 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_RESOURCE_SET,
5135 NLM_F_REQUEST | NLM_F_ACK);
5136
5137 dl_opts_put(nlh, dl);
5138 err = _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
5139 out:
5140 resource_ctx_fini(&ctx);
5141 return err;
5142 }
5143
5144 static int cmd_resource(struct dl *dl)
5145 {
5146 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
5147 cmd_resource_help();
5148 return 0;
5149 } else if (dl_argv_match(dl, "show")) {
5150 dl_arg_inc(dl);
5151 return cmd_resource_show(dl);
5152 } else if (dl_argv_match(dl, "set")) {
5153 dl_arg_inc(dl);
5154 return cmd_resource_set(dl);
5155 }
5156 pr_err("Command \"%s\" not found\n", dl_argv(dl));
5157 return -ENOENT;
5158 }
5159
5160 static void pr_out_region_handle_start(struct dl *dl, struct nlattr **tb)
5161 {
5162 const char *bus_name = mnl_attr_get_str(tb[DEVLINK_ATTR_BUS_NAME]);
5163 const char *dev_name = mnl_attr_get_str(tb[DEVLINK_ATTR_DEV_NAME]);
5164 const char *region_name = mnl_attr_get_str(tb[DEVLINK_ATTR_REGION_NAME]);
5165 char buf[256];
5166
5167 sprintf(buf, "%s/%s/%s", bus_name, dev_name, region_name);
5168 if (dl->json_output) {
5169 jsonw_name(dl->jw, buf);
5170 jsonw_start_object(dl->jw);
5171 } else {
5172 pr_out("%s:", buf);
5173 }
5174 }
5175
5176 static void pr_out_region_handle_end(struct dl *dl)
5177 {
5178 if (dl->json_output)
5179 jsonw_end_object(dl->jw);
5180 else
5181 pr_out("\n");
5182 }
5183
5184 static void pr_out_region_snapshots_start(struct dl *dl, bool array)
5185 {
5186 if (dl->json_output) {
5187 jsonw_name(dl->jw, "snapshot");
5188 jsonw_start_array(dl->jw);
5189 } else {
5190 if (g_indent_newline)
5191 pr_out("snapshot %s", array ? "[" : "");
5192 else
5193 pr_out(" snapshot %s", array ? "[" : "");
5194 }
5195 }
5196
5197 static void pr_out_region_snapshots_end(struct dl *dl, bool array)
5198 {
5199 if (dl->json_output)
5200 jsonw_end_array(dl->jw);
5201 else if (array)
5202 pr_out("]");
5203 }
5204
5205 static void pr_out_region_snapshots_id(struct dl *dl, struct nlattr **tb, int index)
5206 {
5207 uint32_t snapshot_id;
5208
5209 if (!tb[DEVLINK_ATTR_REGION_SNAPSHOT_ID])
5210 return;
5211
5212 snapshot_id = mnl_attr_get_u32(tb[DEVLINK_ATTR_REGION_SNAPSHOT_ID]);
5213
5214 if (dl->json_output)
5215 jsonw_uint(dl->jw, snapshot_id);
5216 else
5217 pr_out("%s%u", index ? " " : "", snapshot_id);
5218 }
5219
5220 static void pr_out_snapshots(struct dl *dl, struct nlattr **tb)
5221 {
5222 struct nlattr *tb_snapshot[DEVLINK_ATTR_MAX + 1] = {};
5223 struct nlattr *nla_sanpshot;
5224 int err, index = 0;
5225
5226 pr_out_region_snapshots_start(dl, true);
5227 mnl_attr_for_each_nested(nla_sanpshot, tb[DEVLINK_ATTR_REGION_SNAPSHOTS]) {
5228 err = mnl_attr_parse_nested(nla_sanpshot, attr_cb, tb_snapshot);
5229 if (err != MNL_CB_OK)
5230 return;
5231 pr_out_region_snapshots_id(dl, tb_snapshot, index++);
5232 }
5233 pr_out_region_snapshots_end(dl, true);
5234 }
5235
5236 static void pr_out_snapshot(struct dl *dl, struct nlattr **tb)
5237 {
5238 pr_out_region_snapshots_start(dl, false);
5239 pr_out_region_snapshots_id(dl, tb, 0);
5240 pr_out_region_snapshots_end(dl, false);
5241 }
5242
5243 static void pr_out_region(struct dl *dl, struct nlattr **tb)
5244 {
5245 pr_out_region_handle_start(dl, tb);
5246
5247 if (tb[DEVLINK_ATTR_REGION_SIZE])
5248 pr_out_u64(dl, "size",
5249 mnl_attr_get_u64(tb[DEVLINK_ATTR_REGION_SIZE]));
5250
5251 if (tb[DEVLINK_ATTR_REGION_SNAPSHOTS])
5252 pr_out_snapshots(dl, tb);
5253
5254 if (tb[DEVLINK_ATTR_REGION_SNAPSHOT_ID])
5255 pr_out_snapshot(dl, tb);
5256
5257 pr_out_region_handle_end(dl);
5258 }
5259
5260 static int cmd_region_show_cb(const struct nlmsghdr *nlh, void *data)
5261 {
5262 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
5263 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
5264 struct dl *dl = data;
5265
5266 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
5267 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
5268 !tb[DEVLINK_ATTR_REGION_NAME] || !tb[DEVLINK_ATTR_REGION_SIZE])
5269 return MNL_CB_ERROR;
5270
5271 pr_out_region(dl, tb);
5272
5273 return MNL_CB_OK;
5274 }
5275
5276 static int cmd_region_show(struct dl *dl)
5277 {
5278 struct nlmsghdr *nlh;
5279 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
5280 int err;
5281
5282 if (dl_argc(dl) == 0)
5283 flags |= NLM_F_DUMP;
5284
5285 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_REGION_GET, flags);
5286
5287 if (dl_argc(dl) > 0) {
5288 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE_REGION, 0);
5289 if (err)
5290 return err;
5291 }
5292
5293 pr_out_section_start(dl, "regions");
5294 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_region_show_cb, dl);
5295 pr_out_section_end(dl);
5296 return err;
5297 }
5298
5299 static int cmd_region_snapshot_del(struct dl *dl)
5300 {
5301 struct nlmsghdr *nlh;
5302 int err;
5303
5304 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_REGION_DEL,
5305 NLM_F_REQUEST | NLM_F_ACK);
5306
5307 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE_REGION |
5308 DL_OPT_REGION_SNAPSHOT_ID, 0);
5309 if (err)
5310 return err;
5311
5312 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
5313 }
5314
5315 static int cmd_region_read_cb(const struct nlmsghdr *nlh, void *data)
5316 {
5317 struct nlattr *nla_entry, *nla_chunk_data, *nla_chunk_addr;
5318 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
5319 struct nlattr *tb_field[DEVLINK_ATTR_MAX + 1] = {};
5320 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
5321 struct dl *dl = data;
5322 int err;
5323
5324 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
5325 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
5326 !tb[DEVLINK_ATTR_REGION_CHUNKS])
5327 return MNL_CB_ERROR;
5328
5329 mnl_attr_for_each_nested(nla_entry, tb[DEVLINK_ATTR_REGION_CHUNKS]) {
5330 err = mnl_attr_parse_nested(nla_entry, attr_cb, tb_field);
5331 if (err != MNL_CB_OK)
5332 return MNL_CB_ERROR;
5333
5334 nla_chunk_data = tb_field[DEVLINK_ATTR_REGION_CHUNK_DATA];
5335 if (!nla_chunk_data)
5336 continue;
5337
5338 nla_chunk_addr = tb_field[DEVLINK_ATTR_REGION_CHUNK_ADDR];
5339 if (!nla_chunk_addr)
5340 continue;
5341
5342 pr_out_region_chunk(dl, mnl_attr_get_payload(nla_chunk_data),
5343 mnl_attr_get_payload_len(nla_chunk_data),
5344 mnl_attr_get_u64(nla_chunk_addr));
5345 }
5346 return MNL_CB_OK;
5347 }
5348
5349 static int cmd_region_dump(struct dl *dl)
5350 {
5351 struct nlmsghdr *nlh;
5352 int err;
5353
5354 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_REGION_READ,
5355 NLM_F_REQUEST | NLM_F_ACK | NLM_F_DUMP);
5356
5357 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE_REGION |
5358 DL_OPT_REGION_SNAPSHOT_ID, 0);
5359 if (err)
5360 return err;
5361
5362 pr_out_section_start(dl, "dump");
5363 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_region_read_cb, dl);
5364 pr_out_section_end(dl);
5365 if (!dl->json_output)
5366 pr_out("\n");
5367 return err;
5368 }
5369
5370 static int cmd_region_read(struct dl *dl)
5371 {
5372 struct nlmsghdr *nlh;
5373 int err;
5374
5375 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_REGION_READ,
5376 NLM_F_REQUEST | NLM_F_ACK | NLM_F_DUMP);
5377
5378 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE_REGION |
5379 DL_OPT_REGION_ADDRESS | DL_OPT_REGION_LENGTH |
5380 DL_OPT_REGION_SNAPSHOT_ID, 0);
5381 if (err)
5382 return err;
5383
5384 pr_out_section_start(dl, "read");
5385 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_region_read_cb, dl);
5386 pr_out_section_end(dl);
5387 if (!dl->json_output)
5388 pr_out("\n");
5389 return err;
5390 }
5391
5392 static void cmd_region_help(void)
5393 {
5394 pr_err("Usage: devlink region show [ DEV/REGION ]\n");
5395 pr_err(" devlink region del DEV/REGION snapshot SNAPSHOT_ID\n");
5396 pr_err(" devlink region dump DEV/REGION [ snapshot SNAPSHOT_ID ]\n");
5397 pr_err(" devlink region read DEV/REGION [ snapshot SNAPSHOT_ID ] address ADDRESS length LENGTH\n");
5398 }
5399
5400 static int cmd_region(struct dl *dl)
5401 {
5402 if (dl_no_arg(dl)) {
5403 return cmd_region_show(dl);
5404 } else if (dl_argv_match(dl, "help")) {
5405 cmd_region_help();
5406 return 0;
5407 } else if (dl_argv_match(dl, "show")) {
5408 dl_arg_inc(dl);
5409 return cmd_region_show(dl);
5410 } else if (dl_argv_match(dl, "del")) {
5411 dl_arg_inc(dl);
5412 return cmd_region_snapshot_del(dl);
5413 } else if (dl_argv_match(dl, "dump")) {
5414 dl_arg_inc(dl);
5415 return cmd_region_dump(dl);
5416 } else if (dl_argv_match(dl, "read")) {
5417 dl_arg_inc(dl);
5418 return cmd_region_read(dl);
5419 }
5420 pr_err("Command \"%s\" not found\n", dl_argv(dl));
5421 return -ENOENT;
5422 }
5423
5424 static void help(void)
5425 {
5426 pr_err("Usage: devlink [ OPTIONS ] OBJECT { COMMAND | help }\n"
5427 " devlink [ -f[orce] ] -b[atch] filename\n"
5428 "where OBJECT := { dev | port | sb | monitor | dpipe | resource | region }\n"
5429 " OPTIONS := { -V[ersion] | -n[o-nice-names] | -j[son] | -p[retty] | -v[erbose] }\n");
5430 }
5431
5432 static int dl_cmd(struct dl *dl, int argc, char **argv)
5433 {
5434 dl->argc = argc;
5435 dl->argv = argv;
5436
5437 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
5438 help();
5439 return 0;
5440 } else if (dl_argv_match(dl, "dev")) {
5441 dl_arg_inc(dl);
5442 return cmd_dev(dl);
5443 } else if (dl_argv_match(dl, "port")) {
5444 dl_arg_inc(dl);
5445 return cmd_port(dl);
5446 } else if (dl_argv_match(dl, "sb")) {
5447 dl_arg_inc(dl);
5448 return cmd_sb(dl);
5449 } else if (dl_argv_match(dl, "monitor")) {
5450 dl_arg_inc(dl);
5451 return cmd_mon(dl);
5452 } else if (dl_argv_match(dl, "dpipe")) {
5453 dl_arg_inc(dl);
5454 return cmd_dpipe(dl);
5455 } else if (dl_argv_match(dl, "resource")) {
5456 dl_arg_inc(dl);
5457 return cmd_resource(dl);
5458 } else if (dl_argv_match(dl, "region")) {
5459 dl_arg_inc(dl);
5460 return cmd_region(dl);
5461 }
5462 pr_err("Object \"%s\" not found\n", dl_argv(dl));
5463 return -ENOENT;
5464 }
5465
5466 static int dl_init(struct dl *dl)
5467 {
5468 int err;
5469
5470 dl->nlg = mnlg_socket_open(DEVLINK_GENL_NAME, DEVLINK_GENL_VERSION);
5471 if (!dl->nlg) {
5472 pr_err("Failed to connect to devlink Netlink\n");
5473 return -errno;
5474 }
5475
5476 err = ifname_map_init(dl);
5477 if (err) {
5478 pr_err("Failed to create index map\n");
5479 goto err_ifname_map_create;
5480 }
5481 if (dl->json_output) {
5482 dl->jw = jsonw_new(stdout);
5483 if (!dl->jw) {
5484 pr_err("Failed to create JSON writer\n");
5485 goto err_json_new;
5486 }
5487 jsonw_pretty(dl->jw, dl->pretty_output);
5488 }
5489 return 0;
5490
5491 err_json_new:
5492 ifname_map_fini(dl);
5493 err_ifname_map_create:
5494 mnlg_socket_close(dl->nlg);
5495 return err;
5496 }
5497
5498 static void dl_fini(struct dl *dl)
5499 {
5500 if (dl->json_output)
5501 jsonw_destroy(&dl->jw);
5502 ifname_map_fini(dl);
5503 mnlg_socket_close(dl->nlg);
5504 }
5505
5506 static struct dl *dl_alloc(void)
5507 {
5508 struct dl *dl;
5509
5510 dl = calloc(1, sizeof(*dl));
5511 if (!dl)
5512 return NULL;
5513 return dl;
5514 }
5515
5516 static void dl_free(struct dl *dl)
5517 {
5518 free(dl);
5519 }
5520
5521 static int dl_batch(struct dl *dl, const char *name, bool force)
5522 {
5523 char *line = NULL;
5524 size_t len = 0;
5525 int ret = EXIT_SUCCESS;
5526
5527 if (name && strcmp(name, "-") != 0) {
5528 if (freopen(name, "r", stdin) == NULL) {
5529 fprintf(stderr,
5530 "Cannot open file \"%s\" for reading: %s\n",
5531 name, strerror(errno));
5532 return EXIT_FAILURE;
5533 }
5534 }
5535
5536 cmdlineno = 0;
5537 while (getcmdline(&line, &len, stdin) != -1) {
5538 char *largv[100];
5539 int largc;
5540
5541 largc = makeargs(line, largv, 100);
5542 if (!largc)
5543 continue; /* blank line */
5544
5545 if (dl_cmd(dl, largc, largv)) {
5546 fprintf(stderr, "Command failed %s:%d\n",
5547 name, cmdlineno);
5548 ret = EXIT_FAILURE;
5549 if (!force)
5550 break;
5551 }
5552 }
5553
5554 if (line)
5555 free(line);
5556
5557 return ret;
5558 }
5559
5560 int main(int argc, char **argv)
5561 {
5562 static const struct option long_options[] = {
5563 { "Version", no_argument, NULL, 'V' },
5564 { "force", no_argument, NULL, 'f' },
5565 { "batch", required_argument, NULL, 'b' },
5566 { "no-nice-names", no_argument, NULL, 'n' },
5567 { "json", no_argument, NULL, 'j' },
5568 { "pretty", no_argument, NULL, 'p' },
5569 { "verbose", no_argument, NULL, 'v' },
5570 { NULL, 0, NULL, 0 }
5571 };
5572 const char *batch_file = NULL;
5573 bool force = false;
5574 struct dl *dl;
5575 int opt;
5576 int err;
5577 int ret;
5578
5579 dl = dl_alloc();
5580 if (!dl) {
5581 pr_err("Failed to allocate memory for devlink\n");
5582 return EXIT_FAILURE;
5583 }
5584
5585 while ((opt = getopt_long(argc, argv, "Vfb:njpv",
5586 long_options, NULL)) >= 0) {
5587
5588 switch (opt) {
5589 case 'V':
5590 printf("devlink utility, iproute2-ss%s\n", SNAPSHOT);
5591 ret = EXIT_SUCCESS;
5592 goto dl_free;
5593 case 'f':
5594 force = true;
5595 break;
5596 case 'b':
5597 batch_file = optarg;
5598 break;
5599 case 'n':
5600 dl->no_nice_names = true;
5601 break;
5602 case 'j':
5603 dl->json_output = true;
5604 break;
5605 case 'p':
5606 dl->pretty_output = true;
5607 break;
5608 case 'v':
5609 dl->verbose = true;
5610 break;
5611 default:
5612 pr_err("Unknown option.\n");
5613 help();
5614 ret = EXIT_FAILURE;
5615 goto dl_free;
5616 }
5617 }
5618
5619 argc -= optind;
5620 argv += optind;
5621
5622 err = dl_init(dl);
5623 if (err) {
5624 ret = EXIT_FAILURE;
5625 goto dl_free;
5626 }
5627
5628 if (batch_file)
5629 err = dl_batch(dl, batch_file, force);
5630 else
5631 err = dl_cmd(dl, argc, argv);
5632
5633 if (err) {
5634 ret = EXIT_FAILURE;
5635 goto dl_fini;
5636 }
5637
5638 ret = EXIT_SUCCESS;
5639
5640 dl_fini:
5641 dl_fini(dl);
5642 dl_free:
5643 dl_free(dl);
5644
5645 return ret;
5646 }
Upstream mirror of iproute2