]> git.proxmox.com Git - mirror_iproute2.git/blame - devlink/devlink.c
projects / mirror_iproute2.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
rdma: align uapi headers with 4.20-rc5
[mirror_iproute2.git] / devlink / devlink.c
CommitLineData
a3c4b484
JP		 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>
8b4fbf0b 20#include <inttypes.h>
a3c4b484
JP		 21#include <linux/genetlink.h>
22#include <linux/devlink.h>
23#include <libmnl/libmnl.h>
b2947f8b 24#include <netinet/ether.h>
a3c4b484
JP		 25
26#include "SNAPSHOT.h"
27#include "list.h"
28#include "mnlg.h"
e3d0f0c0 29#include "json_writer.h"
afdc1194 30#include "utils.h"
a3c4b484 31
f57856fa
OG		 32#define ESWITCH_MODE_LEGACY "legacy"
33#define ESWITCH_MODE_SWITCHDEV "switchdev"
6566ca8c
RD		 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"
f57856fa 38
13925ae9
MS		 39#define PARAM_CMODE_RUNTIME_STR "runtime"
40#define PARAM_CMODE_DRIVERINIT_STR "driverinit"
41#define PARAM_CMODE_PERMANENT_STR "permanent"
42
844646a5
AS		 43static int g_new_line_count;
44
a3c4b484 45#define pr_err(args...) fprintf(stderr, ##args)
153c1a9b
AS		 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); \
844646a5 53 g_new_line_count = 0; \
153c1a9b
AS		 54 } while (0)
55
25ec49be
JP		 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, ""); \
844646a5 61 g_new_line_count = 0; \
25ec49be 62 } while (0)
a3c4b484 63
153c1a9b
AS		 64static int g_indent_level;
65static bool g_indent_newline;
66#define INDENT_STR_STEP 2
67#define INDENT_STR_MAXLEN 32
68static char g_indent_str[INDENT_STR_MAXLEN + 1] = "";
69
70static 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
79static 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
87static void __pr_out_newline(void)
88{
844646a5
AS		 89 if (g_new_line_count < 1) {
90 pr_out("\n");
91 g_indent_newline = true;
92 }
93 g_new_line_count++;
153c1a9b
AS		 94}
95
a3c4b484
JP		 96static 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
109static 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
123static 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
136struct 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
144static 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
169static 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
6563a6eb
JP		 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)
e6d7367d
JP		 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)
f57856fa 188#define DL_OPT_ESWITCH_MODE BIT(11)
6566ca8c 189#define DL_OPT_ESWITCH_INLINE_MODE BIT(12)
153c1a9b
AS		 190#define DL_OPT_DPIPE_TABLE_NAME BIT(13)
191#define DL_OPT_DPIPE_TABLE_COUNTERS BIT(14)
d315b706 192#define DL_OPT_ESWITCH_ENCAP_MODE BIT(15)
8cd64409
AS		 193#define DL_OPT_RESOURCE_PATH BIT(16)
194#define DL_OPT_RESOURCE_SIZE BIT(17)
13925ae9
MS		 195#define DL_OPT_PARAM_NAME BIT(18)
196#define DL_OPT_PARAM_VALUE BIT(19)
197#define DL_OPT_PARAM_CMODE BIT(20)
8b4fbf0b
AV		 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)
6563a6eb
JP		 202
203struct 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;
e6d7367d
JP		 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;
f57856fa 217 enum devlink_eswitch_mode eswitch_mode;
6566ca8c 218 enum devlink_eswitch_inline_mode eswitch_inline_mode;
153c1a9b
AS		 219 const char *dpipe_table_name;
220 bool dpipe_counters_enable;
d315b706 221 bool eswitch_encap_mode;
8cd64409
AS		 222 const char *resource_path;
223 uint32_t resource_size;
224 uint32_t resource_id;
225 bool resource_id_valid;
13925ae9
MS		 226 const char *param_name;
227 const char *param_value;
228 enum devlink_param_cmode cmode;
8b4fbf0b
AV		 229 char *region_name;
230 uint32_t region_snapshot_id;
231 uint64_t region_address;
232 uint64_t region_length;
6563a6eb
JP		 233};
234
a3c4b484
JP		 235struct dl {
236 struct mnlg_socket *nlg;
237 struct list_head ifname_map_list;
238 int argc;
239 char **argv;
43f35be4 240 bool no_nice_names;
6563a6eb 241 struct dl_opts opts;
e3d0f0c0
JP		 242 json_writer_t *jw;
243 bool json_output;
244 bool pretty_output;
153c1a9b 245 bool verbose;
e3d0f0c0
JP		 246 struct {
247 bool present;
248 char *bus_name;
249 char *dev_name;
250 uint32_t port_index;
251 } arr_last;
a3c4b484
JP		 252};
253
254static int dl_argc(struct dl *dl)
255{
256 return dl->argc;
257}
258
259static char *dl_argv(struct dl *dl)
260{
261 if (dl_argc(dl) == 0)
262 return NULL;
263 return *dl->argv;
264}
265
266static void dl_arg_inc(struct dl *dl)
267{
268 if (dl_argc(dl) == 0)
269 return;
270 dl->argc--;
271 dl->argv++;
272}
273
274static 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
286static 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
293static 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
300static 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
307static bool dl_no_arg(struct dl *dl)
308{
309 return dl_argc(dl) == 0;
310}
311
4f10cede
AS		 312static 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,
d315b706 337 [DEVLINK_ATTR_ESWITCH_ENCAP_MODE] = MNL_TYPE_U8,
153c1a9b
AS		 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,
13925ae9
MS		 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,
8b4fbf0b
AV		 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,
4f10cede
AS		 386};
387
a3c4b484
JP		 388static int attr_cb(const struct nlattr *attr, void *data)
389{
390 const struct nlattr **tb = data;
391 int type;
392
a3c4b484 393 if (mnl_attr_type_valid(attr, DEVLINK_ATTR_MAX) < 0)
c619f2be 394 return MNL_CB_OK;
a3c4b484 395
4f10cede
AS		 396 type = mnl_attr_get_type(attr);
397 if (mnl_attr_validate(attr, devlink_policy[type]) < 0)
6566ca8c 398 return MNL_CB_ERROR;
4f10cede 399
a3c4b484
JP		 400 tb[type] = attr;
401 return MNL_CB_OK;
402}
403
404static 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
436static 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
447static 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
465static 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
e6d7367d
JP		 482static 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
a3c4b484
JP		 499static 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
511static 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
8b4fbf0b
AV		 524static 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
a3c4b484
JP		 538static 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
e6d7367d
JP		 552static 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
13925ae9
MS		 566static 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
580static 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
2f85a9c5
JP		 594static 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
6563a6eb 600static int dl_argv_handle(struct dl *dl, char **p_bus_name, char **p_dev_name)
a3c4b484
JP		 601{
602 char *str = dl_argv_next(dl);
a3c4b484
JP		 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 }
2f85a9c5
JP		 613 return __dl_argv_handle(str, p_bus_name, p_dev_name);
614}
a3c4b484 615
2f85a9c5
JP		 616static int __dl_argv_handle_port(char *str,
617 char **p_bus_name, char **p_dev_name,
618 uint32_t *p_port_index)
619{
6e33f7b0
PS		 620 char *handlestr;
621 char *portstr;
2f85a9c5
JP		 622 int err;
623
6e33f7b0
PS		 624 err = strslashrsplit(str, &handlestr, &portstr);
625 if (err) {
626 pr_err("Port identification \"%s\" is invalid\n", str);
627 return err;
628 }
2f85a9c5
JP		 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 }
6e33f7b0
PS		 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 }
2f85a9c5
JP		 640 return 0;
641}
642
643static 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 }
a3c4b484
JP		 655 return 0;
656}
657
6563a6eb
JP		 658static int dl_argv_handle_port(struct dl *dl, char **p_bus_name,
659 char **p_dev_name, uint32_t *p_port_index)
a3c4b484
JP		 660{
661 char *str = dl_argv_next(dl);
662 unsigned int slash_count;
a3c4b484
JP		 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);
7a34b9d0
HL		 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:
a3c4b484
JP		 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 }
2f85a9c5
JP		 681}
682
683static 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)
a3c4b484 701 return err;
2f85a9c5
JP		 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;
a3c4b484 709 } else if (slash_count == 0) {
2f85a9c5
JP		 710 err = __dl_argv_handle_port_ifname(dl, str, p_bus_name,
711 p_dev_name, p_port_index);
712 if (err)
a3c4b484 713 return err;
2f85a9c5
JP		 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;
a3c4b484 719 }
a3c4b484
JP		 720 return 0;
721}
722
8b4fbf0b
AV		 723static 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
742static 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
763static 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
a3c4b484
JP		 781static 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
e6d7367d
JP		 799static 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
a3c4b484
JP		 817static 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
829static 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
e6d7367d
JP		 844static 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
857static 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
7c55d770
SH		 871static int eswitch_mode_get(const char *typestr,
872 enum devlink_eswitch_mode *p_mode)
f57856fa
OG		 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
6566ca8c
RD		 885static 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
153c1a9b
AS		 903static 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
d315b706
RD		 917static 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
13925ae9
MS		 930static 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
6563a6eb
JP		 946static int dl_argv_parse(struct dl *dl, uint32_t o_required,
947 uint32_t o_optional)
a3c4b484 948{
6563a6eb 949 struct dl_opts *opts = &dl->opts;
a3c4b484
JP		 950 uint32_t o_all = o_required | o_optional;
951 uint32_t o_found = 0;
952 int err;
953
2f85a9c5 954 if (o_required & DL_OPT_HANDLE && o_required & DL_OPT_HANDLEP) {
8579a398 955 uint32_t handle_bit;
2f85a9c5
JP		 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) {
6563a6eb 963 err = dl_argv_handle(dl, &opts->bus_name, &opts->dev_name);
a3c4b484
JP		 964 if (err)
965 return err;
6563a6eb 966 o_found |= DL_OPT_HANDLE;
a3c4b484 967 } else if (o_required & DL_OPT_HANDLEP) {
6563a6eb
JP		 968 err = dl_argv_handle_port(dl, &opts->bus_name, &opts->dev_name,
969 &opts->port_index);
a3c4b484
JP		 970 if (err)
971 return err;
6563a6eb 972 o_found |= DL_OPT_HANDLEP;
8b4fbf0b
AV		 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;
a3c4b484
JP		 980 }
981
982 while (dl_argc(dl)) {
983 if (dl_argv_match(dl, "type") &&
984 (o_all & DL_OPT_PORT_TYPE)) {
a3c4b484
JP		 985 const char *typestr;
986
987 dl_arg_inc(dl);
988 err = dl_argv_str(dl, &typestr);
989 if (err)
990 return err;
6563a6eb 991 err = port_type_get(typestr, &opts->port_type);
a3c4b484
JP		 992 if (err)
993 return err;
a3c4b484
JP		 994 o_found |= DL_OPT_PORT_TYPE;
995 } else if (dl_argv_match(dl, "count") &&
996 (o_all & DL_OPT_PORT_COUNT)) {
a3c4b484 997 dl_arg_inc(dl);
6563a6eb 998 err = dl_argv_uint32_t(dl, &opts->port_count);
a3c4b484
JP		 999 if (err)
1000 return err;
a3c4b484 1001 o_found |= DL_OPT_PORT_COUNT;
e6d7367d
JP		 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;
f57856fa
OG		 1062 } else if (dl_argv_match(dl, "mode") &&
1063 (o_all & DL_OPT_ESWITCH_MODE)) {
1064 const char *typestr;
7c55d770 1065
f57856fa
OG		 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;
6566ca8c
RD		 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;
153c1a9b
AS		 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;
d315b706
RD		 1107 } else if (dl_argv_match(dl, "encap") &&
1108 (o_all & DL_OPT_ESWITCH_ENCAP_MODE)) {
1109 const char *typestr;
153c1a9b 1110
d315b706
RD		 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;
8cd64409
AS		 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;
13925ae9
MS		 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;
8b4fbf0b
AV		 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;
a3c4b484
JP		 1181 } else {
1182 pr_err("Unknown option \"%s\"\n", dl_argv(dl));
1183 return -EINVAL;
1184 }
1185 }
1186
6563a6eb
JP		 1187 opts->present = o_found;
1188
e6d7367d
JP		 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
a3c4b484
JP		 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
e6d7367d
JP		 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 }
f57856fa 1234
7c55d770
SH		 1235 if ((o_required & DL_OPT_ESWITCH_MODE) &&
1236 !(o_found & DL_OPT_ESWITCH_MODE)) {
f57856fa
OG		 1237 pr_err("E-Switch mode option expected.\n");
1238 return -EINVAL;
1239 }
1240
6566ca8c
RD		 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
153c1a9b
AS		 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 }
d315b706
RD		 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
13925ae9
MS		 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
8b4fbf0b
AV		 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
a3c4b484
JP		 1301 return 0;
1302}
1303
6563a6eb
JP		 1304static 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);
8b4fbf0b
AV		 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);
6563a6eb
JP		 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);
e6d7367d
JP		 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);
f57856fa
OG		 1349 if (opts->present & DL_OPT_ESWITCH_MODE)
1350 mnl_attr_put_u16(nlh, DEVLINK_ATTR_ESWITCH_MODE,
1351 opts->eswitch_mode);
6566ca8c
RD		 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);
153c1a9b
AS		 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);
d315b706
RD		 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);
8cd64409
AS		 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);
13925ae9
MS		 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);
8b4fbf0b
AV		 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);
6563a6eb
JP		 1385}
1386
1387static 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
25ec49be
JP		 1399static 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}
707a91c5 1435
a3c4b484
JP		 1436static void cmd_dev_help(void)
1437{
7a9466db 1438 pr_err("Usage: devlink dev show [ DEV ]\n");
a93b6bb3 1439 pr_err(" devlink dev eswitch set DEV [ mode { legacy | switchdev } ]\n");
6566ca8c 1440 pr_err(" [ inline-mode { none | link | network | transport } ]\n");
d315b706 1441 pr_err(" [ encap { disable | enable } ]\n");
a93b6bb3 1442 pr_err(" devlink dev eswitch show DEV\n");
13925ae9
MS		 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");
06dd94f9 1445 pr_err(" devlink dev reload DEV\n");
a3c4b484
JP		 1446}
1447
e3d0f0c0
JP		 1448static bool cmp_arr_last_handle(struct dl *dl, const char *bus_name,
1449 const char *dev_name)
43f35be4 1450{
e3d0f0c0
JP		 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;
43f35be4
JP		 1455}
1456
e3d0f0c0
JP		 1457static void arr_last_handle_set(struct dl *dl, const char *bus_name,
1458 const char *dev_name)
a3c4b484 1459{
e3d0f0c0
JP		 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);
a3c4b484
JP		 1465}
1466
e3d0f0c0
JP		 1467static bool should_arr_last_handle_start(struct dl *dl, const char *bus_name,
1468 const char *dev_name)
43f35be4 1469{
e3d0f0c0 1470 return !cmp_arr_last_handle(dl, bus_name, dev_name);
43f35be4
JP		 1471}
1472
e3d0f0c0
JP		 1473static bool should_arr_last_handle_end(struct dl *dl, const char *bus_name,
1474 const char *dev_name)
68cab0ba 1475{
e3d0f0c0
JP		 1476 return dl->arr_last.present &&
1477 !cmp_arr_last_handle(dl, bus_name, dev_name);
43f35be4
JP		 1478}
1479
e3d0f0c0
JP		 1480static void __pr_out_handle_start(struct dl *dl, struct nlattr **tb,
1481 bool content, bool array)
e6d7367d 1482{
e3d0f0c0
JP		 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];
e6d7367d 1486
e3d0f0c0 1487 sprintf(buf, "%s/%s", bus_name, dev_name);
e6d7367d 1488
e3d0f0c0
JP		 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 {
153c1a9b
AS		 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 }
e3d0f0c0
JP		 1520 }
1521}
e6d7367d 1522
e3d0f0c0
JP		 1523static void pr_out_handle_start_arr(struct dl *dl, struct nlattr **tb)
1524{
1525 __pr_out_handle_start(dl, tb, true, true);
e6d7367d
JP		 1526}
1527
e3d0f0c0
JP		 1528static void pr_out_handle_end(struct dl *dl)
1529{
1530 if (dl->json_output)
1531 jsonw_end_object(dl->jw);
1532 else
153c1a9b 1533 __pr_out_newline();
e3d0f0c0
JP		 1534}
1535
1536static 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
1542static 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
1549static 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
1556static 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
1564static 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
1573static 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
1614static void pr_out_port_handle_start(struct dl *dl, struct nlattr **tb, bool try_nice)
e6d7367d
JP		 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]);
e3d0f0c0
JP		 1623 __pr_out_port_handle_start(dl, bus_name, dev_name, port_index, try_nice, false);
1624}
1625
1626static 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;
e6d7367d 1631
e3d0f0c0
JP		 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);
e6d7367d
JP		 1636}
1637
e3d0f0c0 1638static void pr_out_port_handle_end(struct dl *dl)
a3c4b484 1639{
e3d0f0c0
JP		 1640 if (dl->json_output)
1641 jsonw_end_object(dl->jw);
1642 else
1643 pr_out("\n");
1644}
1645
1646
1647static void pr_out_str(struct dl *dl, const char *name, const char *val)
1648{
153c1a9b 1649 if (dl->json_output) {
e3d0f0c0 1650 jsonw_string_field(dl->jw, name, val);
153c1a9b
AS		 1651 } else {
1652 if (g_indent_newline)
1653 pr_out("%s %s", name, val);
1654 else
1655 pr_out(" %s %s", name, val);
1656 }
e3d0f0c0
JP		 1657}
1658
13925ae9
MS		 1659static 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
e3d0f0c0
JP		 1667static void pr_out_uint(struct dl *dl, const char *name, unsigned int val)
1668{
153c1a9b 1669 if (dl->json_output) {
e3d0f0c0 1670 jsonw_uint_field(dl->jw, name, val);
153c1a9b
AS		 1671 } else {
1672 if (g_indent_newline)
1673 pr_out("%s %u", name, val);
1674 else
1675 pr_out(" %s %u", name, val);
1676 }
e3d0f0c0
JP		 1677}
1678
43eb8728
DA		 1679static 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
8b4fbf0b
AV		 1687static 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
1697static void pr_out_region_chunk_end(struct dl *dl)
1698{
1699 if (dl->json_output)
1700 jsonw_end_array(dl->jw);
1701}
1702
1703static 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
e3d0f0c0
JP		 1730static void pr_out_dev(struct dl *dl, struct nlattr **tb)
1731{
1732 pr_out_handle(dl, tb);
1733}
1734
1735static 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
1744static 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 }
a3c4b484
JP		 1752}
1753
153c1a9b
AS		 1754static 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 {
844646a5 1760 __pr_out_indent_inc();
153c1a9b 1761 __pr_out_newline();
844646a5 1762 pr_out("%s:", name);
153c1a9b 1763 __pr_out_indent_inc();
844646a5 1764 __pr_out_newline();
153c1a9b
AS		 1765 }
1766}
1767
1768static void pr_out_array_end(struct dl *dl)
1769{
844646a5 1770 if (dl->json_output) {
153c1a9b 1771 jsonw_end_array(dl->jw);
844646a5
AS		 1772 } else {
1773 __pr_out_indent_dec();
153c1a9b 1774 __pr_out_indent_dec();
844646a5 1775 }
153c1a9b
AS		 1776}
1777
1778static void pr_out_entry_start(struct dl *dl)
1779{
1780 if (dl->json_output)
1781 jsonw_start_object(dl->jw);
1782}
1783
1784static 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
13925ae9
MS		 1792static 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
f57856fa
OG		 1805static 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
6566ca8c
RD		 1814static 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
f57856fa
OG		 1830static 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])));
6566ca8c
RD		 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
d315b706
RD		 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
f57856fa
OG		 1849 pr_out_handle_end(dl);
1850}
1851
1852static 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
1865static int cmd_dev_eswitch_show(struct dl *dl)
1866{
1867 struct nlmsghdr *nlh;
1868 int err;
1869
cdd2f7cc 1870 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_ESWITCH_GET,
f57856fa
OG		 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
1883static int cmd_dev_eswitch_set(struct dl *dl)
1884{
1885 struct nlmsghdr *nlh;
1886 int err;
1887
cdd2f7cc 1888 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_ESWITCH_SET,
f57856fa
OG		 1889 NLM_F_REQUEST | NLM_F_ACK);
1890
6566ca8c
RD		 1891 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE,
1892 DL_OPT_ESWITCH_MODE |
d315b706
RD		 1893 DL_OPT_ESWITCH_INLINE_MODE |
1894 DL_OPT_ESWITCH_ENCAP_MODE);
6566ca8c 1895
f57856fa
OG		 1896 if (err)
1897 return err;
1898
6566ca8c
RD		 1899 if (dl->opts.present == 1) {
1900 pr_err("Need to set at least one option\n");
1901 return -ENOENT;
1902 }
1903
f57856fa
OG		 1904 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
1905}
1906
1907static int cmd_dev_eswitch(struct dl *dl)
1908{
a93b6bb3
RD		 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")) {
f57856fa
OG		 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
13925ae9
MS		 1923static 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
1961static 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
2002static 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
2016struct 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
2028static 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
2096static 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
2175err_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
2181static 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
2205static 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}
a3c4b484
JP		 2221static int cmd_dev_show_cb(const struct nlmsghdr *nlh, void *data)
2222{
e3d0f0c0 2223 struct dl *dl = data;
a3c4b484
JP		 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;
e3d0f0c0 2230 pr_out_dev(dl, tb);
a3c4b484
JP		 2231 return MNL_CB_OK;
2232}
2233
2234static 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
e3d0f0c0
JP		 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;
a3c4b484
JP		 2255}
2256
06dd94f9
AS		 2257static void cmd_dev_reload_help(void)
2258{
2259 pr_err("Usage: devlink dev reload [ DEV ]\n");
2260}
2261
2262static 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
a3c4b484
JP		 2282static 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);
f57856fa
OG		 2291 } else if (dl_argv_match(dl, "eswitch")) {
2292 dl_arg_inc(dl);
2293 return cmd_dev_eswitch(dl);
06dd94f9
AS		 2294 } else if (dl_argv_match(dl, "reload")) {
2295 dl_arg_inc(dl);
2296 return cmd_dev_reload(dl);
13925ae9
MS		 2297 } else if (dl_argv_match(dl, "param")) {
2298 dl_arg_inc(dl);
2299 return cmd_dev_param(dl);
a3c4b484
JP		 2300 }
2301 pr_err("Command \"%s\" not found\n", dl_argv(dl));
2302 return -ENOENT;
2303}
2304
2305static void cmd_port_help(void)
2306{
7a9466db
JP		 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");
a3c4b484
JP		 2311}
2312
2313static 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
852ed605
JP		 2324static 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
e3d0f0c0 2338static void pr_out_port(struct dl *dl, struct nlattr **tb)
a3c4b484
JP		 2339{
2340 struct nlattr *pt_attr = tb[DEVLINK_ATTR_PORT_TYPE];
2341 struct nlattr *dpt_attr = tb[DEVLINK_ATTR_PORT_DESIRED_TYPE];
2342
e3d0f0c0 2343 pr_out_port_handle_start(dl, tb, false);
a3c4b484
JP		 2344 if (pt_attr) {
2345 uint16_t port_type = mnl_attr_get_u16(pt_attr);
2346
e3d0f0c0 2347 pr_out_str(dl, "type", port_type_name(port_type));
a3c4b484
JP		 2348 if (dpt_attr) {
2349 uint16_t des_port_type = mnl_attr_get_u16(dpt_attr);
2350
2351 if (port_type != des_port_type)
e3d0f0c0
JP		 2352 pr_out_str(dl, "des_type",
2353 port_type_name(des_port_type));
a3c4b484
JP		 2354 }
2355 }
2356 if (tb[DEVLINK_ATTR_PORT_NETDEV_NAME])
e3d0f0c0
JP		 2357 pr_out_str(dl, "netdev",
2358 mnl_attr_get_str(tb[DEVLINK_ATTR_PORT_NETDEV_NAME]));
a3c4b484 2359 if (tb[DEVLINK_ATTR_PORT_IBDEV_NAME])
e3d0f0c0
JP		 2360 pr_out_str(dl, "ibdev",
2361 mnl_attr_get_str(tb[DEVLINK_ATTR_PORT_IBDEV_NAME]));
852ed605
JP		 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 }
a3c4b484 2368 if (tb[DEVLINK_ATTR_PORT_SPLIT_GROUP])
e3d0f0c0
JP		 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);
a3c4b484
JP		 2372}
2373
2374static int cmd_port_show_cb(const struct nlmsghdr *nlh, void *data)
2375{
e3d0f0c0 2376 struct dl *dl = data;
a3c4b484
JP		 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;
e3d0f0c0 2384 pr_out_port(dl, tb);
a3c4b484
JP		 2385 return MNL_CB_OK;
2386}
2387
2388static 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
e3d0f0c0
JP		 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;
a3c4b484
JP		 2409}
2410
2411static 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
2426static 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
2441static 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
2456static 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
e6d7367d
JP		 2479static void cmd_sb_help(void)
2480{
7a9466db
JP		 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");
e6d7367d
JP		 2497}
2498
e3d0f0c0 2499static void pr_out_sb(struct dl *dl, struct nlattr **tb)
e6d7367d 2500{
e3d0f0c0
JP		 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);
e6d7367d
JP		 2515}
2516
2517static int cmd_sb_show_cb(const struct nlmsghdr *nlh, void *data)
2518{
e3d0f0c0 2519 struct dl *dl = data;
e6d7367d
JP		 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;
e3d0f0c0 2531 pr_out_sb(dl, tb);
e6d7367d
JP		 2532 return MNL_CB_OK;
2533}
2534
2535static 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
e3d0f0c0
JP		 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;
e6d7367d
JP		 2556}
2557
2558static 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
2567static 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
e3d0f0c0 2576static void pr_out_sb_pool(struct dl *dl, struct nlattr **tb)
e6d7367d 2577{
e3d0f0c0
JP		 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);
e6d7367d
JP		 2590}
2591
2592static int cmd_sb_pool_show_cb(const struct nlmsghdr *nlh, void *data)
2593{
e3d0f0c0 2594 struct dl *dl = data;
e6d7367d
JP		 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;
e3d0f0c0 2604 pr_out_sb_pool(dl, tb);
e6d7367d
JP		 2605 return MNL_CB_OK;
2606}
2607
2608static 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
e3d0f0c0
JP		 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;
e6d7367d
JP		 2630}
2631
2632static 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
2648static 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
2665static void pr_out_sb_port_pool(struct dl *dl, struct nlattr **tb)
2666{
e3d0f0c0
JP		 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);
e6d7367d
JP		 2675}
2676
2677static 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
2692static 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
e3d0f0c0
JP		 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;
e6d7367d
JP		 2715}
2716
2717static 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
2733static 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
2750static 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
2763static void pr_out_sb_tc_bind(struct dl *dl, struct nlattr **tb)
2764{
e3d0f0c0
JP		 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",
e6d7367d 2775 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_THRESHOLD]));
e3d0f0c0 2776 pr_out_port_handle_end(dl);
e6d7367d
JP		 2777}
2778
2779static 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
2795static 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
e3d0f0c0
JP		 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;
e6d7367d
JP		 2817}
2818
2819static 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
2836static 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
2853static 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
25ec49be
JP		 2866struct 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
2874struct 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
2885struct occ_show {
2886 struct dl *dl;
2887 int err;
2888 struct list_head port_list;
2889};
2890
2891static struct occ_item *occ_item_alloc(void)
2892{
2893 return calloc(1, sizeof(struct occ_item));
2894}
2895
2896static void occ_item_free(struct occ_item *occ_item)
2897{
2898 free(occ_item);
2899}
2900
2901static 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
2915static 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
2927static 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
2939static 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
2947static 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
2966static 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
e3d0f0c0
JP		 2989static 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
3012static void pr_out_occ_show_port(struct dl *dl, struct occ_port *occ_port)
25ec49be 3013{
e3d0f0c0
JP		 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 }
25ec49be
JP		 3027}
3028
3029static 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) {
e3d0f0c0
JP		 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);
25ec49be
JP		 3040 }
3041}
3042
3043static 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
3069static 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
3085static 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
3120static 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
3137static 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
e3d0f0c0 3166 pr_out_section_start(dl, "occupancy");
25ec49be 3167 pr_out_occ_show(occ_show);
e3d0f0c0 3168 pr_out_section_end(dl);
25ec49be
JP		 3169
3170out:
3171 occ_show_free(occ_show);
3172 return err;
3173}
3174
3175static 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
3190static 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
3205static 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
e6d7367d
JP		 3225static 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);
25ec49be
JP		 3243 } else if (dl_argv_match(dl, "occupancy")) {
3244 dl_arg_inc(dl);
3245 return cmd_sb_occ(dl);
e6d7367d
JP		 3246 }
3247 pr_err("Command \"%s\" not found\n", dl_argv(dl));
3248 return -ENOENT;
3249}
3250
a3c4b484
JP		 3251static 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";
da7a1aa7 3261 case DEVLINK_CMD_PORT_NEW: return "new";
a3c4b484 3262 case DEVLINK_CMD_PORT_DEL: return "del";
13925ae9
MS		 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";
8b4fbf0b
AV		 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";
a3c4b484
JP		 3271 default: return "<unknown cmd>";
3272 }
3273}
3274
3275static 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";
13925ae9
MS		 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";
8b4fbf0b
AV		 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";
a3c4b484
JP		 3299 default: return "<unknown obj>";
3300 }
3301}
3302
3303static void pr_out_mon_header(uint8_t cmd)
3304{
3305 pr_out("[%s,%s] ", cmd_obj(cmd), cmd_name(cmd));
3306}
3307
3308static 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
8b4fbf0b
AV		 3323static void pr_out_region(struct dl *dl, struct nlattr **tb);
3324
a3c4b484
JP		 3325static 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);
e3d0f0c0 3344 pr_out_dev(dl, tb);
a3c4b484
JP		 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);
e3d0f0c0 3355 pr_out_port(dl, tb);
a3c4b484 3356 break;
13925ae9
MS		 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;
8b4fbf0b
AV		 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;
a3c4b484
JP		 3379 }
3380 return MNL_CB_OK;
3381}
3382
3383static 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
3406static void cmd_mon_help(void)
3407{
7a9466db 3408 pr_err("Usage: devlink monitor [ all | OBJECT-LIST ]\n"
a3c4b484
JP		 3409 "where OBJECT-LIST := { dev | port }\n");
3410}
3411
3412static 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
153c1a9b
AS		 3425struct dpipe_field {
3426 char *name;
3427 unsigned int id;
3428 unsigned int bitwidth;
3429 enum devlink_dpipe_field_mapping_type mapping_type;
3430};
3431
3432struct 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
ead18027
AS		 3440struct dpipe_table {
3441 struct list_head list;
3442 char *name;
3443 unsigned int resource_id;
3444 bool resource_valid;
3445};
3446
3447struct dpipe_tables {
3448 struct list_head table_list;
3449};
3450
8cd64409
AS		 3451struct 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
3468struct resources {
3469 struct list_head resource_list;
3470};
3471
3472struct resource_ctx {
3473 struct dl *dl;
3474 int err;
3475 struct resources *resources;
ead18027 3476 struct dpipe_tables *tables;
8cd64409
AS		 3477 bool print_resources;
3478 bool pending_change;
3479};
3480
3481static 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
3492static 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
3504static 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
3515static 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
3523static 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
3532static void resource_ctx_fini(struct resource_ctx *ctx)
3533{
3534 resources_free(ctx->resources);
3535}
3536
153c1a9b
AS		 3537struct dpipe_ctx {
3538 struct dl *dl;
3539 int err;
3540 struct list_head global_headers;
3541 struct list_head local_headers;
ead18027
AS		 3542 struct dpipe_tables *tables;
3543 struct resources *resources;
153c1a9b 3544 bool print_headers;
ead18027 3545 bool print_tables;
153c1a9b
AS		 3546};
3547
3548static struct dpipe_header *dpipe_header_alloc(unsigned int fields_count)
a3c4b484 3549{
153c1a9b
AS		 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
3561err_fields_alloc:
3562 free(header);
3563 return NULL;
a3c4b484
JP		 3564}
3565
153c1a9b 3566static void dpipe_header_free(struct dpipe_header *header)
a3c4b484 3567{
153c1a9b
AS		 3568 free(header->fields);
3569 free(header);
3570}
3571
3572static 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);
a3c4b484 3580 }
153c1a9b 3581 free(header->name);
a3c4b484
JP		 3582}
3583
153c1a9b
AS		 3584static void dpipe_header_add(struct dpipe_ctx *ctx,
3585 struct dpipe_header *header, bool global)
a3c4b484 3586{
153c1a9b
AS		 3587 if (global)
3588 list_add(&header->list, &ctx->global_headers);
3589 else
3590 list_add(&header->list, &ctx->local_headers);
3591}
a3c4b484 3592
153c1a9b
AS		 3593static void dpipe_header_del(struct dpipe_header *header)
3594{
3595 list_del(&header->list);
3596}
a3c4b484 3597
ead18027
AS		 3598static struct dpipe_table *dpipe_table_alloc(void)
3599{
3600 return calloc(1, sizeof(struct dpipe_table));
3601}
3602
3603static void dpipe_table_free(struct dpipe_table *table)
3604{
3605 free(table);
3606}
3607
3608static 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
3619static 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
06a2cda9 3628static int dpipe_ctx_init(struct dpipe_ctx *ctx, struct dl *dl)
153c1a9b 3629{
ead18027
AS		 3630 ctx->tables = dpipe_tables_alloc();
3631 if (!ctx->tables)
3632 return -ENOMEM;
3633
153c1a9b
AS		 3634 ctx->dl = dl;
3635 INIT_LIST_HEAD(&ctx->global_headers);
3636 INIT_LIST_HEAD(&ctx->local_headers);
06a2cda9 3637 return 0;
153c1a9b
AS		 3638}
3639
06a2cda9 3640static void dpipe_ctx_fini(struct dpipe_ctx *ctx)
153c1a9b
AS		 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);
a3c4b484 3655 }
ead18027 3656 dpipe_tables_free(ctx->tables);
153c1a9b 3657}
a3c4b484 3658
153c1a9b
AS		 3659static 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;
a3c4b484 3673 }
153c1a9b
AS		 3674 return NULL;
3675}
3676
3677static 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;
e3d0f0c0 3692 }
153c1a9b
AS		 3693 return NULL;
3694}
a3c4b484 3695
153c1a9b
AS		 3696static const char *
3697dpipe_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 }
a3c4b484
JP		 3707}
3708
153c1a9b
AS		 3709static const char *
3710dpipe_mapping_get(struct dpipe_ctx *ctx, uint32_t header_id,
3711 uint32_t field_id, bool global)
a3c4b484 3712{
153c1a9b
AS		 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;
a3c4b484
JP		 3728}
3729
153c1a9b
AS		 3730static void pr_out_dpipe_fields(struct dpipe_ctx *ctx,
3731 struct dpipe_field *fields,
3732 unsigned int field_count)
a3c4b484 3733{
153c1a9b
AS		 3734 struct dpipe_field *field;
3735 int i;
a3c4b484 3736
153c1a9b
AS		 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 }
a3c4b484
JP		 3749}
3750
153c1a9b
AS		 3751static void
3752pr_out_dpipe_header(struct dpipe_ctx *ctx, struct nlattr **tb,
3753 struct dpipe_header *header, bool global)
a3c4b484 3754{
153c1a9b
AS		 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);
a3c4b484
JP		 3767}
3768
153c1a9b
AS		 3769static void pr_out_dpipe_headers(struct dpipe_ctx *ctx,
3770 struct nlattr **tb)
a3c4b484 3771{
153c1a9b
AS		 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
3781static 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;
a3c4b484 3785 int err;
a3c4b484 3786
153c1a9b
AS		 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
3806static 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++;
43f35be4 3818 }
153c1a9b
AS		 3819 return 0;
3820}
43f35be4 3821
153c1a9b
AS		 3822static unsigned int dpipe_header_field_count_get(struct nlattr *nla_fields)
3823{
3824 struct nlattr *nla_field;
3825 unsigned int count = 0;
a3c4b484 3826
153c1a9b
AS		 3827 mnl_attr_for_each_nested(nla_field, nla_fields)
3828 count++;
3829 return count;
3830}
3831
3832static 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
3868err_field_get:
3869 dpipe_header_free(header);
3870 return err;
3871}
3872
3873static 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
3887static 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
3909static int cmd_dpipe_headers_show(struct dl *dl)
3910{
3911 struct nlmsghdr *nlh;
06a2cda9 3912 struct dpipe_ctx ctx = {};
153c1a9b
AS		 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
06a2cda9
AS		 3922 err = dpipe_ctx_init(&ctx, dl);
3923 if (err)
3924 return err;
153c1a9b 3925
06a2cda9 3926 ctx.print_headers = true;
153c1a9b
AS		 3927
3928 pr_out_section_start(dl, "header");
06a2cda9 3929 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_header_cb, &ctx);
153c1a9b 3930 if (err)
06a2cda9 3931 pr_err("error get headers %s\n", strerror(ctx.err));
153c1a9b
AS		 3932 pr_out_section_end(dl);
3933
06a2cda9 3934 dpipe_ctx_fini(&ctx);
153c1a9b
AS		 3935 return err;
3936}
3937
3938static void cmd_dpipe_header_help(void)
3939{
3940 pr_err("Usage: devlink dpipe headers show DEV\n");
3941}
3942
3943static 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
3956static 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
92b2a5bb
AS		 3967struct dpipe_op_info {
3968 uint32_t header_id;
3969 uint32_t field_id;
3970 bool header_global;
3971};
3972
3973struct dpipe_action {
3974 struct dpipe_op_info info;
3975 uint32_t type;
3976};
3977
3978static void pr_out_dpipe_action(struct dpipe_action *action,
3979 struct dpipe_ctx *ctx)
153c1a9b 3980{
92b2a5bb 3981 struct dpipe_op_info *op_info = &action->info;
153c1a9b
AS		 3982 const char *mapping;
3983
92b2a5bb
AS		 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);
153c1a9b
AS		 3996 if (mapping)
3997 pr_out_str(ctx->dl, "mapping", mapping);
3998}
3999
92b2a5bb 4000static int dpipe_action_parse(struct dpipe_action *action, struct nlattr *nl)
153c1a9b
AS		 4001{
4002 struct nlattr *nla_action[DEVLINK_ATTR_MAX + 1] = {};
153c1a9b
AS		 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
92b2a5bb
AS		 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]);
153c1a9b 4020
153c1a9b
AS		 4021 return 0;
4022}
4023
4024static int dpipe_table_actions_show(struct dpipe_ctx *ctx,
4025 struct nlattr *nla_actions)
4026{
4027 struct nlattr *nla_action;
92b2a5bb 4028 struct dpipe_action action;
153c1a9b
AS		 4029
4030 mnl_attr_for_each_nested(nla_action, nla_actions) {
4031 pr_out_entry_start(ctx->dl);
92b2a5bb
AS		 4032 if (dpipe_action_parse(&action, nla_action))
4033 goto err_action_parse;
4034 pr_out_dpipe_action(&action, ctx);
153c1a9b
AS		 4035 pr_out_entry_end(ctx->dl);
4036 }
4037 return 0;
4038
92b2a5bb 4039err_action_parse:
153c1a9b
AS		 4040 pr_out_entry_end(ctx->dl);
4041 return -EINVAL;
4042}
4043
4044static const char *
4045dpipe_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
92b2a5bb
AS		 4055struct dpipe_match {
4056 struct dpipe_op_info info;
4057 uint32_t type;
4058};
4059
4060static void pr_out_dpipe_match(struct dpipe_match *match,
4061 struct dpipe_ctx *ctx)
153c1a9b 4062{
92b2a5bb 4063 struct dpipe_op_info *op_info = &match->info;
153c1a9b
AS		 4064 const char *mapping;
4065
92b2a5bb
AS		 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);
153c1a9b
AS		 4078 if (mapping)
4079 pr_out_str(ctx->dl, "mapping", mapping);
153c1a9b
AS		 4080}
4081
92b2a5bb
AS		 4082static int dpipe_match_parse(struct dpipe_match *match,
4083 struct nlattr *nl)
4084
153c1a9b
AS		 4085{
4086 struct nlattr *nla_match[DEVLINK_ATTR_MAX + 1] = {};
153c1a9b
AS		 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
92b2a5bb
AS		 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]);
153c1a9b 4104
153c1a9b
AS		 4105 return 0;
4106}
4107
4108static int dpipe_table_matches_show(struct dpipe_ctx *ctx,
4109 struct nlattr *nla_matches)
4110{
4111 struct nlattr *nla_match;
92b2a5bb 4112 struct dpipe_match match;
153c1a9b
AS		 4113
4114 mnl_attr_for_each_nested(nla_match, nla_matches) {
4115 pr_out_entry_start(ctx->dl);
92b2a5bb
AS		 4116 if (dpipe_match_parse(&match, nla_match))
4117 goto err_match_parse;
4118 pr_out_dpipe_match(&match, ctx);
153c1a9b
AS		 4119 pr_out_entry_end(ctx->dl);
4120 }
4121 return 0;
4122
92b2a5bb 4123err_match_parse:
153c1a9b
AS		 4124 pr_out_entry_end(ctx->dl);
4125 return -EINVAL;
4126}
4127
8cd64409
AS		 4128static struct resource *
4129resource_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
4153static void
4154resource_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
153c1a9b
AS		 4188static int dpipe_table_show(struct dpipe_ctx *ctx, struct nlattr *nl)
4189{
4190 struct nlattr *nla_table[DEVLINK_ATTR_MAX + 1] = {};
ead18027
AS		 4191 struct dpipe_table *table;
4192 uint32_t resource_units;
153c1a9b 4193 bool counters_enabled;
ead18027 4194 bool resource_valid;
153c1a9b
AS		 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
ead18027
AS		 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]));
153c1a9b
AS		 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
ead18027
AS		 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);
153c1a9b
AS		 4229 pr_out_uint(ctx->dl, "size", size);
4230 pr_out_str(ctx->dl, "counters_enabled",
4231 counters_enabled ? "true" : "false");
4232
ead18027
AS		 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
153c1a9b
AS		 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
4252err_actions_show:
4253err_matches_show:
4254 pr_out_array_end(ctx->dl);
4255 return -EINVAL;
4256}
4257
4258static 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) {
ead18027
AS		 4264 if (ctx->print_tables)
4265 pr_out_handle_start_arr(ctx->dl, tb);
153c1a9b
AS		 4266 if (dpipe_table_show(ctx, nla_table))
4267 goto err_table_show;
ead18027
AS		 4268 if (ctx->print_tables)
4269 pr_out_handle_end(ctx->dl);
153c1a9b
AS		 4270 }
4271 return 0;
4272
4273err_table_show:
ead18027
AS		 4274 if (ctx->print_tables)
4275 pr_out_handle_end(ctx->dl);
153c1a9b
AS		 4276 return -EINVAL;
4277}
4278
4279static 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
ead18027
AS		 4295static int cmd_resource_dump_cb(const struct nlmsghdr *nlh, void *data);
4296
153c1a9b
AS		 4297static int cmd_dpipe_table_show(struct dl *dl)
4298{
4299 struct nlmsghdr *nlh;
ead18027
AS		 4300 struct dpipe_ctx dpipe_ctx = {};
4301 struct resource_ctx resource_ctx = {};
153c1a9b
AS		 4302 uint16_t flags = NLM_F_REQUEST;
4303 int err;
4304
ead18027 4305 err = dl_argv_parse(dl, DL_OPT_HANDLE, DL_OPT_DPIPE_TABLE_NAME);
06a2cda9
AS		 4306 if (err)
4307 return err;
153c1a9b 4308
ead18027
AS		 4309 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_HEADERS_GET, flags);
4310
4311 err = dpipe_ctx_init(&dpipe_ctx, dl);
153c1a9b 4312 if (err)
ead18027
AS		 4313 return err;
4314
4315 dpipe_ctx.print_tables = true;
153c1a9b 4316
153c1a9b 4317 dl_opts_put(nlh, dl);
ead18027
AS		 4318 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_header_cb,
4319 &dpipe_ctx);
153c1a9b 4320 if (err) {
ead18027
AS		 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;
153c1a9b
AS		 4337 }
4338
ead18027 4339 dpipe_ctx.resources = resource_ctx.resources;
153c1a9b
AS		 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");
ead18027 4345 _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_table_show_cb, &dpipe_ctx);
153c1a9b 4346 pr_out_section_end(dl);
ead18027
AS		 4347
4348 resource_ctx_fini(&resource_ctx);
4349 dpipe_ctx_fini(&dpipe_ctx);
4350 return 0;
4351
4352err_resource_dump:
4353 resource_ctx_fini(&resource_ctx);
4354err_resource_ctx_init:
4355err_headers_get:
4356 dpipe_ctx_fini(&dpipe_ctx);
153c1a9b
AS		 4357 return err;
4358}
4359
4360static 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
31639589
AS		 4377enum dpipe_value_type {
4378 DPIPE_VALUE_TYPE_VALUE,
4379 DPIPE_VALUE_TYPE_MASK,
4380};
4381
4382static const char *
4383dpipe_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
4395struct dpipe_field_printer {
4396 unsigned int field_id;
4397 void (*printer)(struct dpipe_ctx *, enum dpipe_value_type, void *);
4398};
4399
4400struct dpipe_header_printer {
4401 struct dpipe_field_printer *printers;
4402 unsigned int printers_count;
4403 unsigned int header_id;
4404};
4405
b2947f8b
AS		 4406static 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
4416static void
4417dpipe_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
4425static 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
4435static 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
4442static 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
4448static 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
4455static 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
4461static 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
4468static 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
4474static struct dpipe_header_printer *dpipe_header_printers[] = {
4475 &dpipe_header_printer_ipv4,
4476 &dpipe_header_printer_ethernet,
4477 &dpipe_header_printer_ipv6,
4478};
31639589
AS		 4479
4480static int dpipe_print_prot_header(struct dpipe_ctx *ctx,
4481 struct dpipe_op_info *info,
4482 enum dpipe_value_type type,
4483 void *value)
153c1a9b 4484{
31639589
AS		 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
4509static 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
4526static 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;
153c1a9b
AS		 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]);
31639589 4539 value = mnl_attr_get_payload(nla_match_value[DEVLINK_ATTR_DPIPE_VALUE]);
153c1a9b 4540
31639589
AS		 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 }
153c1a9b 4545
31639589
AS		 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);
153c1a9b
AS		 4550 }
4551
31639589 4552 __pr_out_entry_value(ctx, value, value_len, info, DPIPE_VALUE_TYPE_VALUE);
153c1a9b
AS		 4553}
4554
4555static 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] = {};
92b2a5bb 4559 struct dpipe_match match;
153c1a9b
AS		 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);
92b2a5bb
AS		 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);
31639589 4576 pr_out_dpipe_entry_value(ctx, nla_match_value, &match.info);
153c1a9b
AS		 4577 pr_out_entry_end(ctx->dl);
4578
4579 return 0;
4580
92b2a5bb 4581err_match_parse:
153c1a9b
AS		 4582 pr_out_entry_end(ctx->dl);
4583 return -EINVAL;
4584}
4585
4586static 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] = {};
92b2a5bb 4590 struct dpipe_action action;
153c1a9b
AS		 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);
92b2a5bb
AS		 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);
31639589 4607 pr_out_dpipe_entry_value(ctx, nla_action_value, &action.info);
153c1a9b
AS		 4608 pr_out_entry_end(ctx->dl);
4609
4610 return 0;
4611
92b2a5bb 4612err_action_parse:
153c1a9b
AS		 4613 pr_out_entry_end(ctx->dl);
4614 return -EINVAL;
4615}
4616
4617static int
4618dpipe_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
4630static int
4631dpipe_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
4643static 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
4681err_action_values_show:
4682err_match_values_show:
4683 pr_out_array_end(ctx->dl);
4684 return -EINVAL;
4685}
4686
4687static 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
4700err_entry_show:
4701 pr_out_handle_end(ctx->dl);
4702 return -EINVAL;
4703}
4704
4705static 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
4721static int cmd_dpipe_table_dump(struct dl *dl)
4722{
4723 struct nlmsghdr *nlh;
06a2cda9 4724 struct dpipe_ctx ctx = {};
153c1a9b
AS		 4725 uint16_t flags = NLM_F_REQUEST;
4726 int err;
4727
06a2cda9
AS		 4728 err = dpipe_ctx_init(&ctx, dl);
4729 if (err)
4730 return err;
153c1a9b
AS		 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);
06a2cda9 4738 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_header_cb, &ctx);
153c1a9b 4739 if (err) {
06a2cda9 4740 pr_err("error get headers %s\n", strerror(ctx.err));
153c1a9b
AS		 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");
06a2cda9 4749 _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_table_entry_dump_cb, &ctx);
153c1a9b
AS		 4750 pr_out_section_end(dl);
4751out:
06a2cda9 4752 dpipe_ctx_fini(&ctx);
153c1a9b
AS		 4753 return err;
4754}
4755
4756static 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
4762static 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
4781static void cmd_dpipe_help(void)
4782{
4783 pr_err("Usage: devlink dpipe [ OBJECT-LIST ]\n"
4784 "where OBJECT-LIST := { header | table }\n");
4785}
4786
4787static 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
8cd64409
AS		 4803static int
4804resource_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
4841static int
4842resource_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];
4871out:
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
4895static 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
4903static void resource_show(struct resource *resource,
4904 struct resource_ctx *ctx)
4905{
4906 struct resource *child_resource;
ead18027 4907 struct dpipe_table *table;
8cd64409 4908 struct dl *dl = ctx->dl;
ead18027 4909 bool array = false;
8cd64409
AS		 4910
4911 pr_out_str(dl, "name", resource->name);
4912 if (dl->verbose)
4913 resource_path_print(dl, ctx->resources, resource->id);
43eb8728 4914 pr_out_u64(dl, "size", resource->size);
8cd64409 4915 if (resource->size != resource->size_new)
43eb8728 4916 pr_out_u64(dl, "size_new", resource->size_new);
8cd64409
AS		 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);
43eb8728 4923 pr_out_u64(dl, "size_max", resource->size_max);
8cd64409
AS		 4924 pr_out_uint(dl, "size_gran", resource->size_gran);
4925 }
4926
ead18027
AS		 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
8cd64409
AS		 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
4963static void
4964resources_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
4976static 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
4981static 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
5005static int cmd_resource_show(struct dl *dl)
5006{
5007 struct nlmsghdr *nlh;
ead18027
AS		 5008 struct dpipe_ctx dpipe_ctx = {};
5009 struct resource_ctx resource_ctx = {};
8cd64409
AS		 5010 int err;
5011
ead18027 5012 err = dl_argv_parse(dl, DL_OPT_HANDLE, 0);
8cd64409
AS		 5013 if (err)
5014 return err;
5015
ead18027
AS		 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);
8cd64409
AS		 5021 if (err)
5022 return err;
5023
ead18027
AS		 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);
8cd64409 5040 pr_out_section_start(dl, "resources");
ead18027
AS		 5041 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_resource_dump_cb,
5042 &resource_ctx);
8cd64409 5043 pr_out_section_end(dl);
ead18027
AS		 5044 resource_ctx_fini(&resource_ctx);
5045out:
5046 dpipe_ctx_fini(&dpipe_ctx);
8cd64409
AS		 5047 return err;
5048}
5049
5050static 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
5056static struct resource *
5057resource_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
5068static int
5069resource_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
5096err_resource_lookup:
5097 free(resource_path_dup);
5098 return -EINVAL;
5099}
5100
5101static 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) {
b1ffc1f4 5130 pr_err("error parsing resource path %s\n", strerror(-err));
8cd64409
AS		 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);
5139out:
5140 resource_ctx_fini(&ctx);
5141 return err;
5142}
5143
5144static 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
8b4fbf0b
AV		 5160static 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
5176static 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
5184static 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
5197static 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
5205static 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
5220static 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
5236static 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
5243static 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
5260static 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
5276static 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
5299static 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
5315static 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
5349static 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
5370static 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
5392static 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
5400static 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
153c1a9b
AS		 5424static void help(void)
5425{
5426 pr_err("Usage: devlink [ OPTIONS ] OBJECT { COMMAND | help }\n"
3e897912 5427 " devlink [ -f[orce] ] -b[atch] filename\n"
8b4fbf0b 5428 "where OBJECT := { dev | port | sb | monitor | dpipe | resource | region }\n"
bb75b9bf 5429 " OPTIONS := { -V[ersion] | -n[o-nice-names] | -j[son] | -p[retty] | -v[erbose] }\n");
153c1a9b
AS		 5430}
5431
3e897912 5432static int dl_cmd(struct dl *dl, int argc, char **argv)
153c1a9b 5433{
3e897912
IV		 5434 dl->argc = argc;
5435 dl->argv = argv;
5436
153c1a9b
AS		 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);
8cd64409
AS		 5455 } else if (dl_argv_match(dl, "resource")) {
5456 dl_arg_inc(dl);
5457 return cmd_resource(dl);
8b4fbf0b
AV		 5458 } else if (dl_argv_match(dl, "region")) {
5459 dl_arg_inc(dl);
5460 return cmd_region(dl);
153c1a9b
AS		 5461 }
5462 pr_err("Object \"%s\" not found\n", dl_argv(dl));
5463 return -ENOENT;
5464}
5465
3e897912 5466static int dl_init(struct dl *dl)
153c1a9b
AS		 5467{
5468 int err;
5469
153c1a9b
AS		 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
5491err_json_new:
5492 ifname_map_fini(dl);
5493err_ifname_map_create:
5494 mnlg_socket_close(dl->nlg);
5495 return err;
5496}
5497
5498static 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
5506static 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
5516static void dl_free(struct dl *dl)
5517{
5518 free(dl);
5519}
5520
3e897912
IV		 5521static 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
153c1a9b
AS		 5560int main(int argc, char **argv)
5561{
5562 static const struct option long_options[] = {
5563 { "Version", no_argument, NULL, 'V' },
3e897912
IV		 5564 { "force", no_argument, NULL, 'f' },
5565 { "batch", required_argument, NULL, 'b' },
153c1a9b
AS		 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 };
3e897912
IV		 5572 const char *batch_file = NULL;
5573 bool force = false;
153c1a9b
AS		 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
3e897912 5585 while ((opt = getopt_long(argc, argv, "Vfb:njpv",
153c1a9b
AS		 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;
3e897912
IV		 5593 case 'f':
5594 force = true;
5595 break;
5596 case 'b':
5597 batch_file = optarg;
5598 break;
153c1a9b
AS		 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;
e3d0f0c0 5610 break;
a3c4b484
JP		 5611 default:
5612 pr_err("Unknown option.\n");
5613 help();
b77c77d2
LR		 5614 ret = EXIT_FAILURE;
5615 goto dl_free;
a3c4b484
JP		 5616 }
5617 }
5618
5619 argc -= optind;
5620 argv += optind;
5621
3e897912 5622 err = dl_init(dl);
a3c4b484
JP		 5623 if (err) {
5624 ret = EXIT_FAILURE;
5625 goto dl_free;
5626 }
5627
3e897912
IV		 5628 if (batch_file)
5629 err = dl_batch(dl, batch_file, force);
5630 else
5631 err = dl_cmd(dl, argc, argv);
5632
a3c4b484
JP		 5633 if (err) {
5634 ret = EXIT_FAILURE;
5635 goto dl_fini;
5636 }
5637
5638 ret = EXIT_SUCCESS;
5639
5640dl_fini:
5641 dl_fini(dl);
5642dl_free:
5643 dl_free(dl);
5644
5645 return ret;
5646}
Upstream mirror of iproute2