]> git.proxmox.com Git - mirror_iproute2.git/blob - devlink/devlink.c
projects / mirror_iproute2.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
devlink: implement flash status monitoring
[mirror_iproute2.git] / devlink / devlink.c
1 /*
2 * devlink.c Devlink tool
3 *
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version
7 * 2 of the License, or (at your option) any later version.
8 *
9 * Authors: Jiri Pirko <jiri@mellanox.com>
10 */
11
12 #include <stdio.h>
13 #include <stdlib.h>
14 #include <stdarg.h>
15 #include <string.h>
16 #include <stdbool.h>
17 #include <unistd.h>
18 #include <getopt.h>
19 #include <limits.h>
20 #include <errno.h>
21 #include <inttypes.h>
22 #include <sys/sysinfo.h>
23 #define _LINUX_SYSINFO_H /* avoid collision with musl header */
24 #include <linux/genetlink.h>
25 #include <linux/devlink.h>
26 #include <libmnl/libmnl.h>
27 #include <netinet/ether.h>
28 #include <sys/types.h>
29
30 #include "SNAPSHOT.h"
31 #include "list.h"
32 #include "mnlg.h"
33 #include "json_writer.h"
34 #include "utils.h"
35
36 #define ESWITCH_MODE_LEGACY "legacy"
37 #define ESWITCH_MODE_SWITCHDEV "switchdev"
38 #define ESWITCH_INLINE_MODE_NONE "none"
39 #define ESWITCH_INLINE_MODE_LINK "link"
40 #define ESWITCH_INLINE_MODE_NETWORK "network"
41 #define ESWITCH_INLINE_MODE_TRANSPORT "transport"
42
43 #define PARAM_CMODE_RUNTIME_STR "runtime"
44 #define PARAM_CMODE_DRIVERINIT_STR "driverinit"
45 #define PARAM_CMODE_PERMANENT_STR "permanent"
46 #define DL_ARGS_REQUIRED_MAX_ERR_LEN 80
47
48 #define HEALTH_REPORTER_STATE_HEALTHY_STR "healthy"
49 #define HEALTH_REPORTER_STATE_ERROR_STR "error"
50 #define HEALTH_REPORTER_TIMESTAMP_FMT_LEN 80
51
52 static int g_new_line_count;
53 static int g_indent_level;
54 static bool g_indent_newline;
55
56 #define INDENT_STR_STEP 2
57 #define INDENT_STR_MAXLEN 32
58 static char g_indent_str[INDENT_STR_MAXLEN + 1] = "";
59
60 static void __attribute__((format(printf, 1, 2)))
61 pr_err(const char *fmt, ...)
62 {
63 va_list ap;
64
65 va_start(ap, fmt);
66 vfprintf(stderr, fmt, ap);
67 va_end(ap);
68 }
69
70 static void __attribute__((format(printf, 1, 2)))
71 pr_out(const char *fmt, ...)
72 {
73 va_list ap;
74
75 if (g_indent_newline) {
76 printf("%s", g_indent_str);
77 g_indent_newline = false;
78 }
79 va_start(ap, fmt);
80 vprintf(fmt, ap);
81 va_end(ap);
82 g_new_line_count = 0;
83 }
84
85 static void __attribute__((format(printf, 2, 3)))
86 pr_out_sp(unsigned int num, const char *fmt, ...)
87 {
88 va_list ap;
89 int ret;
90
91 va_start(ap, fmt);
92 ret = vprintf(fmt, ap);
93 va_end(ap);
94
95 if (ret < num)
96 printf("%*s", num - ret, "");
97 g_new_line_count = 0; \
98 }
99
100 static void __attribute__((format(printf, 1, 2)))
101 pr_out_tty(const char *fmt, ...)
102 {
103 va_list ap;
104
105 if (!isatty(STDOUT_FILENO))
106 return;
107 va_start(ap, fmt);
108 vprintf(fmt, ap);
109 va_end(ap);
110 }
111
112 static void __pr_out_indent_inc(void)
113 {
114 if (g_indent_level + INDENT_STR_STEP > INDENT_STR_MAXLEN)
115 return;
116 g_indent_level += INDENT_STR_STEP;
117 memset(g_indent_str, ' ', sizeof(g_indent_str));
118 g_indent_str[g_indent_level] = '\0';
119 }
120
121 static void __pr_out_indent_dec(void)
122 {
123 if (g_indent_level - INDENT_STR_STEP < 0)
124 return;
125 g_indent_level -= INDENT_STR_STEP;
126 g_indent_str[g_indent_level] = '\0';
127 }
128
129 static void __pr_out_newline(void)
130 {
131 if (g_new_line_count < 1) {
132 pr_out("\n");
133 g_indent_newline = true;
134 }
135 g_new_line_count++;
136 }
137
138 static int _mnlg_socket_recv_run(struct mnlg_socket *nlg,
139 mnl_cb_t data_cb, void *data)
140 {
141 int err;
142
143 err = mnlg_socket_recv_run(nlg, data_cb, data);
144 if (err < 0) {
145 pr_err("devlink answers: %s\n", strerror(errno));
146 return -errno;
147 }
148 return 0;
149 }
150
151 static int _mnlg_socket_send(struct mnlg_socket *nlg,
152 const struct nlmsghdr *nlh)
153 {
154 int err;
155
156 err = mnlg_socket_send(nlg, nlh);
157 if (err < 0) {
158 pr_err("Failed to call mnlg_socket_send\n");
159 return -errno;
160 }
161 return 0;
162 }
163
164 static int _mnlg_socket_sndrcv(struct mnlg_socket *nlg,
165 const struct nlmsghdr *nlh,
166 mnl_cb_t data_cb, void *data)
167 {
168 int err;
169
170 err = _mnlg_socket_send(nlg, nlh);
171 if (err)
172 return err;
173 return _mnlg_socket_recv_run(nlg, data_cb, data);
174 }
175
176 static int _mnlg_socket_group_add(struct mnlg_socket *nlg,
177 const char *group_name)
178 {
179 int err;
180
181 err = mnlg_socket_group_add(nlg, group_name);
182 if (err < 0) {
183 pr_err("Failed to call mnlg_socket_group_add\n");
184 return -errno;
185 }
186 return 0;
187 }
188
189 struct ifname_map {
190 struct list_head list;
191 char *bus_name;
192 char *dev_name;
193 uint32_t port_index;
194 char *ifname;
195 };
196
197 static struct ifname_map *ifname_map_alloc(const char *bus_name,
198 const char *dev_name,
199 uint32_t port_index,
200 const char *ifname)
201 {
202 struct ifname_map *ifname_map;
203
204 ifname_map = calloc(1, sizeof(*ifname_map));
205 if (!ifname_map)
206 return NULL;
207 ifname_map->bus_name = strdup(bus_name);
208 ifname_map->dev_name = strdup(dev_name);
209 ifname_map->port_index = port_index;
210 ifname_map->ifname = strdup(ifname);
211 if (!ifname_map->bus_name || !ifname_map->dev_name ||
212 !ifname_map->ifname) {
213 free(ifname_map->ifname);
214 free(ifname_map->dev_name);
215 free(ifname_map->bus_name);
216 free(ifname_map);
217 return NULL;
218 }
219 return ifname_map;
220 }
221
222 static void ifname_map_free(struct ifname_map *ifname_map)
223 {
224 free(ifname_map->ifname);
225 free(ifname_map->dev_name);
226 free(ifname_map->bus_name);
227 free(ifname_map);
228 }
229
230 #define DL_OPT_HANDLE BIT(0)
231 #define DL_OPT_HANDLEP BIT(1)
232 #define DL_OPT_PORT_TYPE BIT(2)
233 #define DL_OPT_PORT_COUNT BIT(3)
234 #define DL_OPT_SB BIT(4)
235 #define DL_OPT_SB_POOL BIT(5)
236 #define DL_OPT_SB_SIZE BIT(6)
237 #define DL_OPT_SB_TYPE BIT(7)
238 #define DL_OPT_SB_THTYPE BIT(8)
239 #define DL_OPT_SB_TH BIT(9)
240 #define DL_OPT_SB_TC BIT(10)
241 #define DL_OPT_ESWITCH_MODE BIT(11)
242 #define DL_OPT_ESWITCH_INLINE_MODE BIT(12)
243 #define DL_OPT_DPIPE_TABLE_NAME BIT(13)
244 #define DL_OPT_DPIPE_TABLE_COUNTERS BIT(14)
245 #define DL_OPT_ESWITCH_ENCAP_MODE BIT(15)
246 #define DL_OPT_RESOURCE_PATH BIT(16)
247 #define DL_OPT_RESOURCE_SIZE BIT(17)
248 #define DL_OPT_PARAM_NAME BIT(18)
249 #define DL_OPT_PARAM_VALUE BIT(19)
250 #define DL_OPT_PARAM_CMODE BIT(20)
251 #define DL_OPT_HANDLE_REGION BIT(21)
252 #define DL_OPT_REGION_SNAPSHOT_ID BIT(22)
253 #define DL_OPT_REGION_ADDRESS BIT(23)
254 #define DL_OPT_REGION_LENGTH BIT(24)
255 #define DL_OPT_FLASH_FILE_NAME BIT(25)
256 #define DL_OPT_FLASH_COMPONENT BIT(26)
257 #define DL_OPT_HEALTH_REPORTER_NAME BIT(27)
258 #define DL_OPT_HEALTH_REPORTER_GRACEFUL_PERIOD BIT(27)
259 #define DL_OPT_HEALTH_REPORTER_AUTO_RECOVER BIT(28)
260 #define DL_OPT_TRAP_NAME BIT(29)
261 #define DL_OPT_TRAP_ACTION BIT(30)
262 #define DL_OPT_TRAP_GROUP_NAME BIT(31)
263
264 struct dl_opts {
265 uint64_t present; /* flags of present items */
266 char *bus_name;
267 char *dev_name;
268 uint32_t port_index;
269 enum devlink_port_type port_type;
270 uint32_t port_count;
271 uint32_t sb_index;
272 uint16_t sb_pool_index;
273 uint32_t sb_pool_size;
274 enum devlink_sb_pool_type sb_pool_type;
275 enum devlink_sb_threshold_type sb_pool_thtype;
276 uint32_t sb_threshold;
277 uint16_t sb_tc_index;
278 enum devlink_eswitch_mode eswitch_mode;
279 enum devlink_eswitch_inline_mode eswitch_inline_mode;
280 const char *dpipe_table_name;
281 bool dpipe_counters_enable;
282 bool eswitch_encap_mode;
283 const char *resource_path;
284 uint32_t resource_size;
285 uint32_t resource_id;
286 bool resource_id_valid;
287 const char *param_name;
288 const char *param_value;
289 enum devlink_param_cmode cmode;
290 char *region_name;
291 uint32_t region_snapshot_id;
292 uint64_t region_address;
293 uint64_t region_length;
294 const char *flash_file_name;
295 const char *flash_component;
296 const char *reporter_name;
297 uint64_t reporter_graceful_period;
298 bool reporter_auto_recover;
299 const char *trap_name;
300 const char *trap_group_name;
301 enum devlink_trap_action trap_action;
302 };
303
304 struct dl {
305 struct mnlg_socket *nlg;
306 struct list_head ifname_map_list;
307 int argc;
308 char **argv;
309 bool no_nice_names;
310 struct dl_opts opts;
311 json_writer_t *jw;
312 bool json_output;
313 bool pretty_output;
314 bool verbose;
315 bool stats;
316 struct {
317 bool present;
318 char *bus_name;
319 char *dev_name;
320 uint32_t port_index;
321 } arr_last;
322 };
323
324 static int dl_argc(struct dl *dl)
325 {
326 return dl->argc;
327 }
328
329 static char *dl_argv(struct dl *dl)
330 {
331 if (dl_argc(dl) == 0)
332 return NULL;
333 return *dl->argv;
334 }
335
336 static void dl_arg_inc(struct dl *dl)
337 {
338 if (dl_argc(dl) == 0)
339 return;
340 dl->argc--;
341 dl->argv++;
342 }
343
344 static char *dl_argv_next(struct dl *dl)
345 {
346 char *ret;
347
348 if (dl_argc(dl) == 0)
349 return NULL;
350
351 ret = *dl->argv;
352 dl_arg_inc(dl);
353 return ret;
354 }
355
356 static char *dl_argv_index(struct dl *dl, unsigned int index)
357 {
358 if (index >= dl_argc(dl))
359 return NULL;
360 return dl->argv[index];
361 }
362
363 static int strcmpx(const char *str1, const char *str2)
364 {
365 if (strlen(str1) > strlen(str2))
366 return -1;
367 return strncmp(str1, str2, strlen(str1));
368 }
369
370 static bool dl_argv_match(struct dl *dl, const char *pattern)
371 {
372 if (dl_argc(dl) == 0)
373 return false;
374 return strcmpx(dl_argv(dl), pattern) == 0;
375 }
376
377 static bool dl_no_arg(struct dl *dl)
378 {
379 return dl_argc(dl) == 0;
380 }
381
382 static const enum mnl_attr_data_type devlink_policy[DEVLINK_ATTR_MAX + 1] = {
383 [DEVLINK_ATTR_BUS_NAME] = MNL_TYPE_NUL_STRING,
384 [DEVLINK_ATTR_DEV_NAME] = MNL_TYPE_NUL_STRING,
385 [DEVLINK_ATTR_PORT_INDEX] = MNL_TYPE_U32,
386 [DEVLINK_ATTR_PORT_TYPE] = MNL_TYPE_U16,
387 [DEVLINK_ATTR_PORT_DESIRED_TYPE] = MNL_TYPE_U16,
388 [DEVLINK_ATTR_PORT_NETDEV_IFINDEX] = MNL_TYPE_U32,
389 [DEVLINK_ATTR_PORT_NETDEV_NAME] = MNL_TYPE_NUL_STRING,
390 [DEVLINK_ATTR_PORT_IBDEV_NAME] = MNL_TYPE_NUL_STRING,
391 [DEVLINK_ATTR_SB_INDEX] = MNL_TYPE_U32,
392 [DEVLINK_ATTR_SB_SIZE] = MNL_TYPE_U32,
393 [DEVLINK_ATTR_SB_INGRESS_POOL_COUNT] = MNL_TYPE_U16,
394 [DEVLINK_ATTR_SB_EGRESS_POOL_COUNT] = MNL_TYPE_U16,
395 [DEVLINK_ATTR_SB_INGRESS_TC_COUNT] = MNL_TYPE_U16,
396 [DEVLINK_ATTR_SB_EGRESS_TC_COUNT] = MNL_TYPE_U16,
397 [DEVLINK_ATTR_SB_POOL_INDEX] = MNL_TYPE_U16,
398 [DEVLINK_ATTR_SB_POOL_TYPE] = MNL_TYPE_U8,
399 [DEVLINK_ATTR_SB_POOL_SIZE] = MNL_TYPE_U32,
400 [DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE] = MNL_TYPE_U8,
401 [DEVLINK_ATTR_SB_THRESHOLD] = MNL_TYPE_U32,
402 [DEVLINK_ATTR_SB_TC_INDEX] = MNL_TYPE_U16,
403 [DEVLINK_ATTR_SB_OCC_CUR] = MNL_TYPE_U32,
404 [DEVLINK_ATTR_SB_OCC_MAX] = MNL_TYPE_U32,
405 [DEVLINK_ATTR_ESWITCH_MODE] = MNL_TYPE_U16,
406 [DEVLINK_ATTR_ESWITCH_INLINE_MODE] = MNL_TYPE_U8,
407 [DEVLINK_ATTR_ESWITCH_ENCAP_MODE] = MNL_TYPE_U8,
408 [DEVLINK_ATTR_DPIPE_TABLES] = MNL_TYPE_NESTED,
409 [DEVLINK_ATTR_DPIPE_TABLE] = MNL_TYPE_NESTED,
410 [DEVLINK_ATTR_DPIPE_TABLE_NAME] = MNL_TYPE_STRING,
411 [DEVLINK_ATTR_DPIPE_TABLE_SIZE] = MNL_TYPE_U64,
412 [DEVLINK_ATTR_DPIPE_TABLE_MATCHES] = MNL_TYPE_NESTED,
413 [DEVLINK_ATTR_DPIPE_TABLE_ACTIONS] = MNL_TYPE_NESTED,
414 [DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED] = MNL_TYPE_U8,
415 [DEVLINK_ATTR_DPIPE_ENTRIES] = MNL_TYPE_NESTED,
416 [DEVLINK_ATTR_DPIPE_ENTRY] = MNL_TYPE_NESTED,
417 [DEVLINK_ATTR_DPIPE_ENTRY_INDEX] = MNL_TYPE_U64,
418 [DEVLINK_ATTR_DPIPE_ENTRY_MATCH_VALUES] = MNL_TYPE_NESTED,
419 [DEVLINK_ATTR_DPIPE_ENTRY_ACTION_VALUES] = MNL_TYPE_NESTED,
420 [DEVLINK_ATTR_DPIPE_ENTRY_COUNTER] = MNL_TYPE_U64,
421 [DEVLINK_ATTR_DPIPE_MATCH] = MNL_TYPE_NESTED,
422 [DEVLINK_ATTR_DPIPE_MATCH_VALUE] = MNL_TYPE_NESTED,
423 [DEVLINK_ATTR_DPIPE_MATCH_TYPE] = MNL_TYPE_U32,
424 [DEVLINK_ATTR_DPIPE_ACTION] = MNL_TYPE_NESTED,
425 [DEVLINK_ATTR_DPIPE_ACTION_VALUE] = MNL_TYPE_NESTED,
426 [DEVLINK_ATTR_DPIPE_ACTION_TYPE] = MNL_TYPE_U32,
427 [DEVLINK_ATTR_DPIPE_VALUE_MAPPING] = MNL_TYPE_U32,
428 [DEVLINK_ATTR_DPIPE_HEADERS] = MNL_TYPE_NESTED,
429 [DEVLINK_ATTR_DPIPE_HEADER] = MNL_TYPE_NESTED,
430 [DEVLINK_ATTR_DPIPE_HEADER_NAME] = MNL_TYPE_STRING,
431 [DEVLINK_ATTR_DPIPE_HEADER_ID] = MNL_TYPE_U32,
432 [DEVLINK_ATTR_DPIPE_HEADER_FIELDS] = MNL_TYPE_NESTED,
433 [DEVLINK_ATTR_DPIPE_HEADER_GLOBAL] = MNL_TYPE_U8,
434 [DEVLINK_ATTR_DPIPE_HEADER_INDEX] = MNL_TYPE_U32,
435 [DEVLINK_ATTR_DPIPE_FIELD] = MNL_TYPE_NESTED,
436 [DEVLINK_ATTR_DPIPE_FIELD_NAME] = MNL_TYPE_STRING,
437 [DEVLINK_ATTR_DPIPE_FIELD_ID] = MNL_TYPE_U32,
438 [DEVLINK_ATTR_DPIPE_FIELD_BITWIDTH] = MNL_TYPE_U32,
439 [DEVLINK_ATTR_DPIPE_FIELD_MAPPING_TYPE] = MNL_TYPE_U32,
440 [DEVLINK_ATTR_PARAM] = MNL_TYPE_NESTED,
441 [DEVLINK_ATTR_PARAM_NAME] = MNL_TYPE_STRING,
442 [DEVLINK_ATTR_PARAM_TYPE] = MNL_TYPE_U8,
443 [DEVLINK_ATTR_PARAM_VALUES_LIST] = MNL_TYPE_NESTED,
444 [DEVLINK_ATTR_PARAM_VALUE] = MNL_TYPE_NESTED,
445 [DEVLINK_ATTR_PARAM_VALUE_CMODE] = MNL_TYPE_U8,
446 [DEVLINK_ATTR_REGION_NAME] = MNL_TYPE_STRING,
447 [DEVLINK_ATTR_REGION_SIZE] = MNL_TYPE_U64,
448 [DEVLINK_ATTR_REGION_SNAPSHOTS] = MNL_TYPE_NESTED,
449 [DEVLINK_ATTR_REGION_SNAPSHOT] = MNL_TYPE_NESTED,
450 [DEVLINK_ATTR_REGION_SNAPSHOT_ID] = MNL_TYPE_U32,
451 [DEVLINK_ATTR_REGION_CHUNKS] = MNL_TYPE_NESTED,
452 [DEVLINK_ATTR_REGION_CHUNK] = MNL_TYPE_NESTED,
453 [DEVLINK_ATTR_REGION_CHUNK_DATA] = MNL_TYPE_BINARY,
454 [DEVLINK_ATTR_REGION_CHUNK_ADDR] = MNL_TYPE_U64,
455 [DEVLINK_ATTR_REGION_CHUNK_LEN] = MNL_TYPE_U64,
456 [DEVLINK_ATTR_INFO_DRIVER_NAME] = MNL_TYPE_STRING,
457 [DEVLINK_ATTR_INFO_SERIAL_NUMBER] = MNL_TYPE_STRING,
458 [DEVLINK_ATTR_INFO_VERSION_FIXED] = MNL_TYPE_NESTED,
459 [DEVLINK_ATTR_INFO_VERSION_RUNNING] = MNL_TYPE_NESTED,
460 [DEVLINK_ATTR_INFO_VERSION_STORED] = MNL_TYPE_NESTED,
461 [DEVLINK_ATTR_INFO_VERSION_NAME] = MNL_TYPE_STRING,
462 [DEVLINK_ATTR_INFO_VERSION_VALUE] = MNL_TYPE_STRING,
463 [DEVLINK_ATTR_HEALTH_REPORTER] = MNL_TYPE_NESTED,
464 [DEVLINK_ATTR_HEALTH_REPORTER_NAME] = MNL_TYPE_STRING,
465 [DEVLINK_ATTR_HEALTH_REPORTER_STATE] = MNL_TYPE_U8,
466 [DEVLINK_ATTR_HEALTH_REPORTER_ERR_COUNT] = MNL_TYPE_U64,
467 [DEVLINK_ATTR_HEALTH_REPORTER_RECOVER_COUNT] = MNL_TYPE_U64,
468 [DEVLINK_ATTR_HEALTH_REPORTER_DUMP_TS] = MNL_TYPE_U64,
469 [DEVLINK_ATTR_HEALTH_REPORTER_GRACEFUL_PERIOD] = MNL_TYPE_U64,
470 [DEVLINK_ATTR_FLASH_UPDATE_COMPONENT] = MNL_TYPE_STRING,
471 [DEVLINK_ATTR_FLASH_UPDATE_STATUS_MSG] = MNL_TYPE_STRING,
472 [DEVLINK_ATTR_FLASH_UPDATE_STATUS_DONE] = MNL_TYPE_U64,
473 [DEVLINK_ATTR_FLASH_UPDATE_STATUS_TOTAL] = MNL_TYPE_U64,
474 [DEVLINK_ATTR_STATS] = MNL_TYPE_NESTED,
475 [DEVLINK_ATTR_TRAP_NAME] = MNL_TYPE_STRING,
476 [DEVLINK_ATTR_TRAP_ACTION] = MNL_TYPE_U8,
477 [DEVLINK_ATTR_TRAP_TYPE] = MNL_TYPE_U8,
478 [DEVLINK_ATTR_TRAP_GENERIC] = MNL_TYPE_FLAG,
479 [DEVLINK_ATTR_TRAP_METADATA] = MNL_TYPE_NESTED,
480 [DEVLINK_ATTR_TRAP_GROUP_NAME] = MNL_TYPE_STRING,
481 };
482
483 static const enum mnl_attr_data_type
484 devlink_stats_policy[DEVLINK_ATTR_STATS_MAX + 1] = {
485 [DEVLINK_ATTR_STATS_RX_PACKETS] = MNL_TYPE_U64,
486 [DEVLINK_ATTR_STATS_RX_BYTES] = MNL_TYPE_U64,
487 };
488
489 static int attr_cb(const struct nlattr *attr, void *data)
490 {
491 const struct nlattr **tb = data;
492 int type;
493
494 if (mnl_attr_type_valid(attr, DEVLINK_ATTR_MAX) < 0)
495 return MNL_CB_OK;
496
497 type = mnl_attr_get_type(attr);
498 if (mnl_attr_validate(attr, devlink_policy[type]) < 0)
499 return MNL_CB_ERROR;
500
501 tb[type] = attr;
502 return MNL_CB_OK;
503 }
504
505 static int attr_stats_cb(const struct nlattr *attr, void *data)
506 {
507 const struct nlattr **tb = data;
508 int type;
509
510 /* Allow the tool to work on top of newer kernels that might contain
511 * more attributes.
512 */
513 if (mnl_attr_type_valid(attr, DEVLINK_ATTR_STATS_MAX) < 0)
514 return MNL_CB_OK;
515
516 type = mnl_attr_get_type(attr);
517 if (mnl_attr_validate(attr, devlink_stats_policy[type]) < 0)
518 return MNL_CB_ERROR;
519
520 tb[type] = attr;
521 return MNL_CB_OK;
522 }
523
524 static int ifname_map_cb(const struct nlmsghdr *nlh, void *data)
525 {
526 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
527 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
528 struct dl *dl = data;
529 struct ifname_map *ifname_map;
530 const char *bus_name;
531 const char *dev_name;
532 uint32_t port_ifindex;
533 const char *port_ifname;
534
535 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
536 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
537 !tb[DEVLINK_ATTR_PORT_INDEX])
538 return MNL_CB_ERROR;
539
540 if (!tb[DEVLINK_ATTR_PORT_NETDEV_NAME])
541 return MNL_CB_OK;
542
543 bus_name = mnl_attr_get_str(tb[DEVLINK_ATTR_BUS_NAME]);
544 dev_name = mnl_attr_get_str(tb[DEVLINK_ATTR_DEV_NAME]);
545 port_ifindex = mnl_attr_get_u32(tb[DEVLINK_ATTR_PORT_INDEX]);
546 port_ifname = mnl_attr_get_str(tb[DEVLINK_ATTR_PORT_NETDEV_NAME]);
547 ifname_map = ifname_map_alloc(bus_name, dev_name,
548 port_ifindex, port_ifname);
549 if (!ifname_map)
550 return MNL_CB_ERROR;
551 list_add(&ifname_map->list, &dl->ifname_map_list);
552
553 return MNL_CB_OK;
554 }
555
556 static void ifname_map_fini(struct dl *dl)
557 {
558 struct ifname_map *ifname_map, *tmp;
559
560 list_for_each_entry_safe(ifname_map, tmp,
561 &dl->ifname_map_list, list) {
562 list_del(&ifname_map->list);
563 ifname_map_free(ifname_map);
564 }
565 }
566
567 static int ifname_map_init(struct dl *dl)
568 {
569 struct nlmsghdr *nlh;
570 int err;
571
572 INIT_LIST_HEAD(&dl->ifname_map_list);
573
574 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PORT_GET,
575 NLM_F_REQUEST | NLM_F_ACK | NLM_F_DUMP);
576
577 err = _mnlg_socket_sndrcv(dl->nlg, nlh, ifname_map_cb, dl);
578 if (err) {
579 ifname_map_fini(dl);
580 return err;
581 }
582 return 0;
583 }
584
585 static int ifname_map_lookup(struct dl *dl, const char *ifname,
586 char **p_bus_name, char **p_dev_name,
587 uint32_t *p_port_index)
588 {
589 struct ifname_map *ifname_map;
590
591 list_for_each_entry(ifname_map, &dl->ifname_map_list, list) {
592 if (strcmp(ifname, ifname_map->ifname) == 0) {
593 *p_bus_name = ifname_map->bus_name;
594 *p_dev_name = ifname_map->dev_name;
595 *p_port_index = ifname_map->port_index;
596 return 0;
597 }
598 }
599 return -ENOENT;
600 }
601
602 static int ifname_map_rev_lookup(struct dl *dl, const char *bus_name,
603 const char *dev_name, uint32_t port_index,
604 char **p_ifname)
605 {
606 struct ifname_map *ifname_map;
607
608 list_for_each_entry(ifname_map, &dl->ifname_map_list, list) {
609 if (strcmp(bus_name, ifname_map->bus_name) == 0 &&
610 strcmp(dev_name, ifname_map->dev_name) == 0 &&
611 port_index == ifname_map->port_index) {
612 *p_ifname = ifname_map->ifname;
613 return 0;
614 }
615 }
616 return -ENOENT;
617 }
618
619 static unsigned int strslashcount(char *str)
620 {
621 unsigned int count = 0;
622 char *pos = str;
623
624 while ((pos = strchr(pos, '/'))) {
625 count++;
626 pos++;
627 }
628 return count;
629 }
630
631 static int strslashrsplit(char *str, char **before, char **after)
632 {
633 char *slash;
634
635 slash = strrchr(str, '/');
636 if (!slash)
637 return -EINVAL;
638 *slash = '\0';
639 *before = str;
640 *after = slash + 1;
641 return 0;
642 }
643
644 static int strtouint64_t(const char *str, uint64_t *p_val)
645 {
646 char *endptr;
647 unsigned long long int val;
648
649 val = strtoull(str, &endptr, 10);
650 if (endptr == str || *endptr != '\0')
651 return -EINVAL;
652 if (val > ULONG_MAX)
653 return -ERANGE;
654 *p_val = val;
655 return 0;
656 }
657
658 static int strtouint32_t(const char *str, uint32_t *p_val)
659 {
660 char *endptr;
661 unsigned long int val;
662
663 val = strtoul(str, &endptr, 10);
664 if (endptr == str || *endptr != '\0')
665 return -EINVAL;
666 if (val > UINT_MAX)
667 return -ERANGE;
668 *p_val = val;
669 return 0;
670 }
671
672 static int strtouint16_t(const char *str, uint16_t *p_val)
673 {
674 char *endptr;
675 unsigned long int val;
676
677 val = strtoul(str, &endptr, 10);
678 if (endptr == str || *endptr != '\0')
679 return -EINVAL;
680 if (val > USHRT_MAX)
681 return -ERANGE;
682 *p_val = val;
683 return 0;
684 }
685
686 static int strtouint8_t(const char *str, uint8_t *p_val)
687 {
688 char *endptr;
689 unsigned long int val;
690
691 val = strtoul(str, &endptr, 10);
692 if (endptr == str || *endptr != '\0')
693 return -EINVAL;
694 if (val > UCHAR_MAX)
695 return -ERANGE;
696 *p_val = val;
697 return 0;
698 }
699
700 static int strtobool(const char *str, bool *p_val)
701 {
702 bool val;
703
704 if (!strcmp(str, "true") || !strcmp(str, "1"))
705 val = true;
706 else if (!strcmp(str, "false") || !strcmp(str, "0"))
707 val = false;
708 else
709 return -EINVAL;
710 *p_val = val;
711 return 0;
712 }
713
714 static int __dl_argv_handle(char *str, char **p_bus_name, char **p_dev_name)
715 {
716 strslashrsplit(str, p_bus_name, p_dev_name);
717 return 0;
718 }
719
720 static int dl_argv_handle(struct dl *dl, char **p_bus_name, char **p_dev_name)
721 {
722 char *str = dl_argv_next(dl);
723
724 if (!str) {
725 pr_err("Devlink identification (\"bus_name/dev_name\") expected\n");
726 return -EINVAL;
727 }
728 if (strslashcount(str) != 1) {
729 pr_err("Wrong devlink identification string format.\n");
730 pr_err("Expected \"bus_name/dev_name\".\n");
731 return -EINVAL;
732 }
733 return __dl_argv_handle(str, p_bus_name, p_dev_name);
734 }
735
736 static int __dl_argv_handle_port(char *str,
737 char **p_bus_name, char **p_dev_name,
738 uint32_t *p_port_index)
739 {
740 char *handlestr;
741 char *portstr;
742 int err;
743
744 err = strslashrsplit(str, &handlestr, &portstr);
745 if (err) {
746 pr_err("Port identification \"%s\" is invalid\n", str);
747 return err;
748 }
749 err = strtouint32_t(portstr, p_port_index);
750 if (err) {
751 pr_err("Port index \"%s\" is not a number or not within range\n",
752 portstr);
753 return err;
754 }
755 err = strslashrsplit(handlestr, p_bus_name, p_dev_name);
756 if (err) {
757 pr_err("Port identification \"%s\" is invalid\n", str);
758 return err;
759 }
760 return 0;
761 }
762
763 static int __dl_argv_handle_port_ifname(struct dl *dl, char *str,
764 char **p_bus_name, char **p_dev_name,
765 uint32_t *p_port_index)
766 {
767 int err;
768
769 err = ifname_map_lookup(dl, str, p_bus_name, p_dev_name,
770 p_port_index);
771 if (err) {
772 pr_err("Netdevice \"%s\" not found\n", str);
773 return err;
774 }
775 return 0;
776 }
777
778 static int dl_argv_handle_port(struct dl *dl, char **p_bus_name,
779 char **p_dev_name, uint32_t *p_port_index)
780 {
781 char *str = dl_argv_next(dl);
782 unsigned int slash_count;
783
784 if (!str) {
785 pr_err("Port identification (\"bus_name/dev_name/port_index\" or \"netdev ifname\") expected.\n");
786 return -EINVAL;
787 }
788 slash_count = strslashcount(str);
789 switch (slash_count) {
790 case 0:
791 return __dl_argv_handle_port_ifname(dl, str, p_bus_name,
792 p_dev_name, p_port_index);
793 case 2:
794 return __dl_argv_handle_port(str, p_bus_name,
795 p_dev_name, p_port_index);
796 default:
797 pr_err("Wrong port identification string format.\n");
798 pr_err("Expected \"bus_name/dev_name/port_index\" or \"netdev_ifname\".\n");
799 return -EINVAL;
800 }
801 }
802
803 static int dl_argv_handle_both(struct dl *dl, char **p_bus_name,
804 char **p_dev_name, uint32_t *p_port_index,
805 uint64_t *p_handle_bit)
806 {
807 char *str = dl_argv_next(dl);
808 unsigned int slash_count;
809 int err;
810
811 if (!str) {
812 pr_err("One of following identifications expected:\n"
813 "Devlink identification (\"bus_name/dev_name\")\n"
814 "Port identification (\"bus_name/dev_name/port_index\" or \"netdev ifname\")\n");
815 return -EINVAL;
816 }
817 slash_count = strslashcount(str);
818 if (slash_count == 1) {
819 err = __dl_argv_handle(str, p_bus_name, p_dev_name);
820 if (err)
821 return err;
822 *p_handle_bit = DL_OPT_HANDLE;
823 } else if (slash_count == 2) {
824 err = __dl_argv_handle_port(str, p_bus_name,
825 p_dev_name, p_port_index);
826 if (err)
827 return err;
828 *p_handle_bit = DL_OPT_HANDLEP;
829 } else if (slash_count == 0) {
830 err = __dl_argv_handle_port_ifname(dl, str, p_bus_name,
831 p_dev_name, p_port_index);
832 if (err)
833 return err;
834 *p_handle_bit = DL_OPT_HANDLEP;
835 } else {
836 pr_err("Wrong port identification string format.\n");
837 pr_err("Expected \"bus_name/dev_name\" or \"bus_name/dev_name/port_index\" or \"netdev_ifname\".\n");
838 return -EINVAL;
839 }
840 return 0;
841 }
842
843 static int __dl_argv_handle_region(char *str, char **p_bus_name,
844 char **p_dev_name, char **p_region)
845 {
846 char *handlestr;
847 int err;
848
849 err = strslashrsplit(str, &handlestr, p_region);
850 if (err) {
851 pr_err("Region identification \"%s\" is invalid\n", str);
852 return err;
853 }
854 err = strslashrsplit(handlestr, p_bus_name, p_dev_name);
855 if (err) {
856 pr_err("Region identification \"%s\" is invalid\n", str);
857 return err;
858 }
859 return 0;
860 }
861
862 static int dl_argv_handle_region(struct dl *dl, char **p_bus_name,
863 char **p_dev_name, char **p_region)
864 {
865 char *str = dl_argv_next(dl);
866 unsigned int slash_count;
867
868 if (!str) {
869 pr_err("Expected \"bus_name/dev_name/region\" identification.\n");
870 return -EINVAL;
871 }
872
873 slash_count = strslashcount(str);
874 if (slash_count != 2) {
875 pr_err("Wrong region identification string format.\n");
876 pr_err("Expected \"bus_name/dev_name/region\" identification.\n"".\n");
877 return -EINVAL;
878 }
879
880 return __dl_argv_handle_region(str, p_bus_name, p_dev_name, p_region);
881 }
882
883 static int dl_argv_uint64_t(struct dl *dl, uint64_t *p_val)
884 {
885 char *str = dl_argv_next(dl);
886 int err;
887
888 if (!str) {
889 pr_err("Unsigned number argument expected\n");
890 return -EINVAL;
891 }
892
893 err = strtouint64_t(str, p_val);
894 if (err) {
895 pr_err("\"%s\" is not a number or not within range\n", str);
896 return err;
897 }
898 return 0;
899 }
900
901 static int dl_argv_uint32_t(struct dl *dl, uint32_t *p_val)
902 {
903 char *str = dl_argv_next(dl);
904 int err;
905
906 if (!str) {
907 pr_err("Unsigned number argument expected\n");
908 return -EINVAL;
909 }
910
911 err = strtouint32_t(str, p_val);
912 if (err) {
913 pr_err("\"%s\" is not a number or not within range\n", str);
914 return err;
915 }
916 return 0;
917 }
918
919 static int dl_argv_uint16_t(struct dl *dl, uint16_t *p_val)
920 {
921 char *str = dl_argv_next(dl);
922 int err;
923
924 if (!str) {
925 pr_err("Unsigned number argument expected\n");
926 return -EINVAL;
927 }
928
929 err = strtouint16_t(str, p_val);
930 if (err) {
931 pr_err("\"%s\" is not a number or not within range\n", str);
932 return err;
933 }
934 return 0;
935 }
936
937 static int dl_argv_bool(struct dl *dl, bool *p_val)
938 {
939 char *str = dl_argv_next(dl);
940 int err;
941
942 if (!str) {
943 pr_err("Boolean argument expected\n");
944 return -EINVAL;
945 }
946
947 err = strtobool(str, p_val);
948 if (err) {
949 pr_err("\"%s\" is not a valid boolean value\n", str);
950 return err;
951 }
952 return 0;
953 }
954
955 static int dl_argv_str(struct dl *dl, const char **p_str)
956 {
957 const char *str = dl_argv_next(dl);
958
959 if (!str) {
960 pr_err("String parameter expected\n");
961 return -EINVAL;
962 }
963 *p_str = str;
964 return 0;
965 }
966
967 static int port_type_get(const char *typestr, enum devlink_port_type *p_type)
968 {
969 if (strcmp(typestr, "auto") == 0) {
970 *p_type = DEVLINK_PORT_TYPE_AUTO;
971 } else if (strcmp(typestr, "eth") == 0) {
972 *p_type = DEVLINK_PORT_TYPE_ETH;
973 } else if (strcmp(typestr, "ib") == 0) {
974 *p_type = DEVLINK_PORT_TYPE_IB;
975 } else {
976 pr_err("Unknown port type \"%s\"\n", typestr);
977 return -EINVAL;
978 }
979 return 0;
980 }
981
982 static int pool_type_get(const char *typestr, enum devlink_sb_pool_type *p_type)
983 {
984 if (strcmp(typestr, "ingress") == 0) {
985 *p_type = DEVLINK_SB_POOL_TYPE_INGRESS;
986 } else if (strcmp(typestr, "egress") == 0) {
987 *p_type = DEVLINK_SB_POOL_TYPE_EGRESS;
988 } else {
989 pr_err("Unknown pool type \"%s\"\n", typestr);
990 return -EINVAL;
991 }
992 return 0;
993 }
994
995 static int threshold_type_get(const char *typestr,
996 enum devlink_sb_threshold_type *p_type)
997 {
998 if (strcmp(typestr, "static") == 0) {
999 *p_type = DEVLINK_SB_THRESHOLD_TYPE_STATIC;
1000 } else if (strcmp(typestr, "dynamic") == 0) {
1001 *p_type = DEVLINK_SB_THRESHOLD_TYPE_DYNAMIC;
1002 } else {
1003 pr_err("Unknown threshold type \"%s\"\n", typestr);
1004 return -EINVAL;
1005 }
1006 return 0;
1007 }
1008
1009 static int eswitch_mode_get(const char *typestr,
1010 enum devlink_eswitch_mode *p_mode)
1011 {
1012 if (strcmp(typestr, ESWITCH_MODE_LEGACY) == 0) {
1013 *p_mode = DEVLINK_ESWITCH_MODE_LEGACY;
1014 } else if (strcmp(typestr, ESWITCH_MODE_SWITCHDEV) == 0) {
1015 *p_mode = DEVLINK_ESWITCH_MODE_SWITCHDEV;
1016 } else {
1017 pr_err("Unknown eswitch mode \"%s\"\n", typestr);
1018 return -EINVAL;
1019 }
1020 return 0;
1021 }
1022
1023 static int eswitch_inline_mode_get(const char *typestr,
1024 enum devlink_eswitch_inline_mode *p_mode)
1025 {
1026 if (strcmp(typestr, ESWITCH_INLINE_MODE_NONE) == 0) {
1027 *p_mode = DEVLINK_ESWITCH_INLINE_MODE_NONE;
1028 } else if (strcmp(typestr, ESWITCH_INLINE_MODE_LINK) == 0) {
1029 *p_mode = DEVLINK_ESWITCH_INLINE_MODE_LINK;
1030 } else if (strcmp(typestr, ESWITCH_INLINE_MODE_NETWORK) == 0) {
1031 *p_mode = DEVLINK_ESWITCH_INLINE_MODE_NETWORK;
1032 } else if (strcmp(typestr, ESWITCH_INLINE_MODE_TRANSPORT) == 0) {
1033 *p_mode = DEVLINK_ESWITCH_INLINE_MODE_TRANSPORT;
1034 } else {
1035 pr_err("Unknown eswitch inline mode \"%s\"\n", typestr);
1036 return -EINVAL;
1037 }
1038 return 0;
1039 }
1040
1041 static int dpipe_counters_enable_get(const char *typestr,
1042 bool *counters_enable)
1043 {
1044 if (strcmp(typestr, "enable") == 0) {
1045 *counters_enable = 1;
1046 } else if (strcmp(typestr, "disable") == 0) {
1047 *counters_enable = 0;
1048 } else {
1049 pr_err("Unknown counter_state \"%s\"\n", typestr);
1050 return -EINVAL;
1051 }
1052 return 0;
1053 }
1054
1055 static int eswitch_encap_mode_get(const char *typestr, bool *p_mode)
1056 {
1057 if (strcmp(typestr, "enable") == 0) {
1058 *p_mode = true;
1059 } else if (strcmp(typestr, "disable") == 0) {
1060 *p_mode = false;
1061 } else {
1062 pr_err("Unknown eswitch encap mode \"%s\"\n", typestr);
1063 return -EINVAL;
1064 }
1065 return 0;
1066 }
1067
1068 static int param_cmode_get(const char *cmodestr,
1069 enum devlink_param_cmode *cmode)
1070 {
1071 if (strcmp(cmodestr, PARAM_CMODE_RUNTIME_STR) == 0) {
1072 *cmode = DEVLINK_PARAM_CMODE_RUNTIME;
1073 } else if (strcmp(cmodestr, PARAM_CMODE_DRIVERINIT_STR) == 0) {
1074 *cmode = DEVLINK_PARAM_CMODE_DRIVERINIT;
1075 } else if (strcmp(cmodestr, PARAM_CMODE_PERMANENT_STR) == 0) {
1076 *cmode = DEVLINK_PARAM_CMODE_PERMANENT;
1077 } else {
1078 pr_err("Unknown configuration mode \"%s\"\n", cmodestr);
1079 return -EINVAL;
1080 }
1081 return 0;
1082 }
1083
1084 static int trap_action_get(const char *actionstr,
1085 enum devlink_trap_action *p_action)
1086 {
1087 if (strcmp(actionstr, "drop") == 0) {
1088 *p_action = DEVLINK_TRAP_ACTION_DROP;
1089 } else if (strcmp(actionstr, "trap") == 0) {
1090 *p_action = DEVLINK_TRAP_ACTION_TRAP;
1091 } else {
1092 pr_err("Unknown trap action \"%s\"\n", actionstr);
1093 return -EINVAL;
1094 }
1095 return 0;
1096 }
1097
1098 struct dl_args_metadata {
1099 uint64_t o_flag;
1100 char err_msg[DL_ARGS_REQUIRED_MAX_ERR_LEN];
1101 };
1102
1103 static const struct dl_args_metadata dl_args_required[] = {
1104 {DL_OPT_PORT_TYPE, "Port type not set."},
1105 {DL_OPT_PORT_COUNT, "Port split count option expected."},
1106 {DL_OPT_SB_POOL, "Pool index option expected."},
1107 {DL_OPT_SB_SIZE, "Pool size option expected."},
1108 {DL_OPT_SB_TYPE, "Pool type option expected."},
1109 {DL_OPT_SB_THTYPE, "Pool threshold type option expected."},
1110 {DL_OPT_SB_TH, "Threshold option expected."},
1111 {DL_OPT_SB_TC, "TC index option expected."},
1112 {DL_OPT_ESWITCH_MODE, "E-Switch mode option expected."},
1113 {DL_OPT_ESWITCH_INLINE_MODE, "E-Switch inline-mode option expected."},
1114 {DL_OPT_DPIPE_TABLE_NAME, "Dpipe table name expected."},
1115 {DL_OPT_DPIPE_TABLE_COUNTERS, "Dpipe table counter state expected."},
1116 {DL_OPT_ESWITCH_ENCAP_MODE, "E-Switch encapsulation option expected."},
1117 {DL_OPT_PARAM_NAME, "Parameter name expected."},
1118 {DL_OPT_PARAM_VALUE, "Value to set expected."},
1119 {DL_OPT_PARAM_CMODE, "Configuration mode expected."},
1120 {DL_OPT_REGION_SNAPSHOT_ID, "Region snapshot id expected."},
1121 {DL_OPT_REGION_ADDRESS, "Region address value expected."},
1122 {DL_OPT_REGION_LENGTH, "Region length value expected."},
1123 {DL_OPT_HEALTH_REPORTER_NAME, "Reporter's name is expected."},
1124 {DL_OPT_TRAP_NAME, "Trap's name is expected."},
1125 {DL_OPT_TRAP_GROUP_NAME, "Trap group's name is expected."},
1126 };
1127
1128 static int dl_args_finding_required_validate(uint64_t o_required,
1129 uint64_t o_found)
1130 {
1131 uint64_t o_flag;
1132 int i;
1133
1134 for (i = 0; i < ARRAY_SIZE(dl_args_required); i++) {
1135 o_flag = dl_args_required[i].o_flag;
1136 if ((o_required & o_flag) && !(o_found & o_flag)) {
1137 pr_err("%s\n", dl_args_required[i].err_msg);
1138 return -EINVAL;
1139 }
1140 }
1141 return 0;
1142 }
1143
1144 static int dl_argv_parse(struct dl *dl, uint64_t o_required,
1145 uint64_t o_optional)
1146 {
1147 struct dl_opts *opts = &dl->opts;
1148 uint64_t o_all = o_required | o_optional;
1149 uint64_t o_found = 0;
1150 int err;
1151
1152 if (o_required & DL_OPT_HANDLE && o_required & DL_OPT_HANDLEP) {
1153 uint64_t handle_bit;
1154
1155 err = dl_argv_handle_both(dl, &opts->bus_name, &opts->dev_name,
1156 &opts->port_index, &handle_bit);
1157 if (err)
1158 return err;
1159 o_found |= handle_bit;
1160 } else if (o_required & DL_OPT_HANDLE) {
1161 err = dl_argv_handle(dl, &opts->bus_name, &opts->dev_name);
1162 if (err)
1163 return err;
1164 o_found |= DL_OPT_HANDLE;
1165 } else if (o_required & DL_OPT_HANDLEP) {
1166 err = dl_argv_handle_port(dl, &opts->bus_name, &opts->dev_name,
1167 &opts->port_index);
1168 if (err)
1169 return err;
1170 o_found |= DL_OPT_HANDLEP;
1171 } else if (o_required & DL_OPT_HANDLE_REGION) {
1172 err = dl_argv_handle_region(dl, &opts->bus_name,
1173 &opts->dev_name,
1174 &opts->region_name);
1175 if (err)
1176 return err;
1177 o_found |= DL_OPT_HANDLE_REGION;
1178 }
1179
1180 while (dl_argc(dl)) {
1181 if (dl_argv_match(dl, "type") &&
1182 (o_all & DL_OPT_PORT_TYPE)) {
1183 const char *typestr;
1184
1185 dl_arg_inc(dl);
1186 err = dl_argv_str(dl, &typestr);
1187 if (err)
1188 return err;
1189 err = port_type_get(typestr, &opts->port_type);
1190 if (err)
1191 return err;
1192 o_found |= DL_OPT_PORT_TYPE;
1193 } else if (dl_argv_match(dl, "count") &&
1194 (o_all & DL_OPT_PORT_COUNT)) {
1195 dl_arg_inc(dl);
1196 err = dl_argv_uint32_t(dl, &opts->port_count);
1197 if (err)
1198 return err;
1199 o_found |= DL_OPT_PORT_COUNT;
1200 } else if (dl_argv_match(dl, "sb") &&
1201 (o_all & DL_OPT_SB)) {
1202 dl_arg_inc(dl);
1203 err = dl_argv_uint32_t(dl, &opts->sb_index);
1204 if (err)
1205 return err;
1206 o_found |= DL_OPT_SB;
1207 } else if (dl_argv_match(dl, "pool") &&
1208 (o_all & DL_OPT_SB_POOL)) {
1209 dl_arg_inc(dl);
1210 err = dl_argv_uint16_t(dl, &opts->sb_pool_index);
1211 if (err)
1212 return err;
1213 o_found |= DL_OPT_SB_POOL;
1214 } else if (dl_argv_match(dl, "size") &&
1215 (o_all & DL_OPT_SB_SIZE)) {
1216 dl_arg_inc(dl);
1217 err = dl_argv_uint32_t(dl, &opts->sb_pool_size);
1218 if (err)
1219 return err;
1220 o_found |= DL_OPT_SB_SIZE;
1221 } else if (dl_argv_match(dl, "type") &&
1222 (o_all & DL_OPT_SB_TYPE)) {
1223 const char *typestr;
1224
1225 dl_arg_inc(dl);
1226 err = dl_argv_str(dl, &typestr);
1227 if (err)
1228 return err;
1229 err = pool_type_get(typestr, &opts->sb_pool_type);
1230 if (err)
1231 return err;
1232 o_found |= DL_OPT_SB_TYPE;
1233 } else if (dl_argv_match(dl, "thtype") &&
1234 (o_all & DL_OPT_SB_THTYPE)) {
1235 const char *typestr;
1236
1237 dl_arg_inc(dl);
1238 err = dl_argv_str(dl, &typestr);
1239 if (err)
1240 return err;
1241 err = threshold_type_get(typestr,
1242 &opts->sb_pool_thtype);
1243 if (err)
1244 return err;
1245 o_found |= DL_OPT_SB_THTYPE;
1246 } else if (dl_argv_match(dl, "th") &&
1247 (o_all & DL_OPT_SB_TH)) {
1248 dl_arg_inc(dl);
1249 err = dl_argv_uint32_t(dl, &opts->sb_threshold);
1250 if (err)
1251 return err;
1252 o_found |= DL_OPT_SB_TH;
1253 } else if (dl_argv_match(dl, "tc") &&
1254 (o_all & DL_OPT_SB_TC)) {
1255 dl_arg_inc(dl);
1256 err = dl_argv_uint16_t(dl, &opts->sb_tc_index);
1257 if (err)
1258 return err;
1259 o_found |= DL_OPT_SB_TC;
1260 } else if (dl_argv_match(dl, "mode") &&
1261 (o_all & DL_OPT_ESWITCH_MODE)) {
1262 const char *typestr;
1263
1264 dl_arg_inc(dl);
1265 err = dl_argv_str(dl, &typestr);
1266 if (err)
1267 return err;
1268 err = eswitch_mode_get(typestr, &opts->eswitch_mode);
1269 if (err)
1270 return err;
1271 o_found |= DL_OPT_ESWITCH_MODE;
1272 } else if (dl_argv_match(dl, "inline-mode") &&
1273 (o_all & DL_OPT_ESWITCH_INLINE_MODE)) {
1274 const char *typestr;
1275
1276 dl_arg_inc(dl);
1277 err = dl_argv_str(dl, &typestr);
1278 if (err)
1279 return err;
1280 err = eswitch_inline_mode_get(
1281 typestr, &opts->eswitch_inline_mode);
1282 if (err)
1283 return err;
1284 o_found |= DL_OPT_ESWITCH_INLINE_MODE;
1285 } else if (dl_argv_match(dl, "name") &&
1286 (o_all & DL_OPT_DPIPE_TABLE_NAME)) {
1287 dl_arg_inc(dl);
1288 err = dl_argv_str(dl, &opts->dpipe_table_name);
1289 if (err)
1290 return err;
1291 o_found |= DL_OPT_DPIPE_TABLE_NAME;
1292 } else if (dl_argv_match(dl, "counters") &&
1293 (o_all & DL_OPT_DPIPE_TABLE_COUNTERS)) {
1294 const char *typestr;
1295
1296 dl_arg_inc(dl);
1297 err = dl_argv_str(dl, &typestr);
1298 if (err)
1299 return err;
1300 err = dpipe_counters_enable_get(typestr,
1301 &opts->dpipe_counters_enable);
1302 if (err)
1303 return err;
1304 o_found |= DL_OPT_DPIPE_TABLE_COUNTERS;
1305 } else if (dl_argv_match(dl, "encap") &&
1306 (o_all & DL_OPT_ESWITCH_ENCAP_MODE)) {
1307 const char *typestr;
1308
1309 dl_arg_inc(dl);
1310 err = dl_argv_str(dl, &typestr);
1311 if (err)
1312 return err;
1313 err = eswitch_encap_mode_get(typestr,
1314 &opts->eswitch_encap_mode);
1315 if (err)
1316 return err;
1317 o_found |= DL_OPT_ESWITCH_ENCAP_MODE;
1318 } else if (dl_argv_match(dl, "path") &&
1319 (o_all & DL_OPT_RESOURCE_PATH)) {
1320 dl_arg_inc(dl);
1321 err = dl_argv_str(dl, &opts->resource_path);
1322 if (err)
1323 return err;
1324 o_found |= DL_OPT_RESOURCE_PATH;
1325 } else if (dl_argv_match(dl, "size") &&
1326 (o_all & DL_OPT_RESOURCE_SIZE)) {
1327 dl_arg_inc(dl);
1328 err = dl_argv_uint32_t(dl, &opts->resource_size);
1329 if (err)
1330 return err;
1331 o_found |= DL_OPT_RESOURCE_SIZE;
1332 } else if (dl_argv_match(dl, "name") &&
1333 (o_all & DL_OPT_PARAM_NAME)) {
1334 dl_arg_inc(dl);
1335 err = dl_argv_str(dl, &opts->param_name);
1336 if (err)
1337 return err;
1338 o_found |= DL_OPT_PARAM_NAME;
1339 } else if (dl_argv_match(dl, "value") &&
1340 (o_all & DL_OPT_PARAM_VALUE)) {
1341 dl_arg_inc(dl);
1342 err = dl_argv_str(dl, &opts->param_value);
1343 if (err)
1344 return err;
1345 o_found |= DL_OPT_PARAM_VALUE;
1346 } else if (dl_argv_match(dl, "cmode") &&
1347 (o_all & DL_OPT_PARAM_CMODE)) {
1348 const char *cmodestr;
1349
1350 dl_arg_inc(dl);
1351 err = dl_argv_str(dl, &cmodestr);
1352 if (err)
1353 return err;
1354 err = param_cmode_get(cmodestr, &opts->cmode);
1355 if (err)
1356 return err;
1357 o_found |= DL_OPT_PARAM_CMODE;
1358 } else if (dl_argv_match(dl, "snapshot") &&
1359 (o_all & DL_OPT_REGION_SNAPSHOT_ID)) {
1360 dl_arg_inc(dl);
1361 err = dl_argv_uint32_t(dl, &opts->region_snapshot_id);
1362 if (err)
1363 return err;
1364 o_found |= DL_OPT_REGION_SNAPSHOT_ID;
1365 } else if (dl_argv_match(dl, "address") &&
1366 (o_all & DL_OPT_REGION_ADDRESS)) {
1367 dl_arg_inc(dl);
1368 err = dl_argv_uint64_t(dl, &opts->region_address);
1369 if (err)
1370 return err;
1371 o_found |= DL_OPT_REGION_ADDRESS;
1372 } else if (dl_argv_match(dl, "length") &&
1373 (o_all & DL_OPT_REGION_LENGTH)) {
1374 dl_arg_inc(dl);
1375 err = dl_argv_uint64_t(dl, &opts->region_length);
1376 if (err)
1377 return err;
1378 o_found |= DL_OPT_REGION_LENGTH;
1379 } else if (dl_argv_match(dl, "file") &&
1380 (o_all & DL_OPT_FLASH_FILE_NAME)) {
1381 dl_arg_inc(dl);
1382 err = dl_argv_str(dl, &opts->flash_file_name);
1383 if (err)
1384 return err;
1385 o_found |= DL_OPT_FLASH_FILE_NAME;
1386 } else if (dl_argv_match(dl, "component") &&
1387 (o_all & DL_OPT_FLASH_COMPONENT)) {
1388 dl_arg_inc(dl);
1389 err = dl_argv_str(dl, &opts->flash_component);
1390 if (err)
1391 return err;
1392 o_found |= DL_OPT_FLASH_COMPONENT;
1393 } else if (dl_argv_match(dl, "reporter") &&
1394 (o_all & DL_OPT_HEALTH_REPORTER_NAME)) {
1395 dl_arg_inc(dl);
1396 err = dl_argv_str(dl, &opts->reporter_name);
1397 if (err)
1398 return err;
1399 o_found |= DL_OPT_HEALTH_REPORTER_NAME;
1400 } else if (dl_argv_match(dl, "grace_period") &&
1401 (o_all & DL_OPT_HEALTH_REPORTER_GRACEFUL_PERIOD)) {
1402 dl_arg_inc(dl);
1403 err = dl_argv_uint64_t(dl,
1404 &opts->reporter_graceful_period);
1405 if (err)
1406 return err;
1407 o_found |= DL_OPT_HEALTH_REPORTER_GRACEFUL_PERIOD;
1408 } else if (dl_argv_match(dl, "auto_recover") &&
1409 (o_all & DL_OPT_HEALTH_REPORTER_AUTO_RECOVER)) {
1410 dl_arg_inc(dl);
1411 err = dl_argv_bool(dl, &opts->reporter_auto_recover);
1412 if (err)
1413 return err;
1414 o_found |= DL_OPT_HEALTH_REPORTER_AUTO_RECOVER;
1415 } else if (dl_argv_match(dl, "trap") &&
1416 (o_all & DL_OPT_TRAP_NAME)) {
1417 dl_arg_inc(dl);
1418 err = dl_argv_str(dl, &opts->trap_name);
1419 if (err)
1420 return err;
1421 o_found |= DL_OPT_TRAP_NAME;
1422 } else if (dl_argv_match(dl, "group") &&
1423 (o_all & DL_OPT_TRAP_GROUP_NAME)) {
1424 dl_arg_inc(dl);
1425 err = dl_argv_str(dl, &opts->trap_group_name);
1426 if (err)
1427 return err;
1428 o_found |= DL_OPT_TRAP_GROUP_NAME;
1429 } else if (dl_argv_match(dl, "action") &&
1430 (o_all & DL_OPT_TRAP_ACTION)) {
1431 const char *actionstr;
1432
1433 dl_arg_inc(dl);
1434 err = dl_argv_str(dl, &actionstr);
1435 if (err)
1436 return err;
1437 err = trap_action_get(actionstr, &opts->trap_action);
1438 if (err)
1439 return err;
1440 o_found |= DL_OPT_TRAP_ACTION;
1441 } else {
1442 pr_err("Unknown option \"%s\"\n", dl_argv(dl));
1443 return -EINVAL;
1444 }
1445 }
1446
1447 opts->present = o_found;
1448
1449 if ((o_optional & DL_OPT_SB) && !(o_found & DL_OPT_SB)) {
1450 opts->sb_index = 0;
1451 opts->present |= DL_OPT_SB;
1452 }
1453
1454 return dl_args_finding_required_validate(o_required, o_found);
1455 }
1456
1457 static void dl_opts_put(struct nlmsghdr *nlh, struct dl *dl)
1458 {
1459 struct dl_opts *opts = &dl->opts;
1460
1461 if (opts->present & DL_OPT_HANDLE) {
1462 mnl_attr_put_strz(nlh, DEVLINK_ATTR_BUS_NAME, opts->bus_name);
1463 mnl_attr_put_strz(nlh, DEVLINK_ATTR_DEV_NAME, opts->dev_name);
1464 } else if (opts->present & DL_OPT_HANDLEP) {
1465 mnl_attr_put_strz(nlh, DEVLINK_ATTR_BUS_NAME, opts->bus_name);
1466 mnl_attr_put_strz(nlh, DEVLINK_ATTR_DEV_NAME, opts->dev_name);
1467 mnl_attr_put_u32(nlh, DEVLINK_ATTR_PORT_INDEX,
1468 opts->port_index);
1469 } else if (opts->present & DL_OPT_HANDLE_REGION) {
1470 mnl_attr_put_strz(nlh, DEVLINK_ATTR_BUS_NAME, opts->bus_name);
1471 mnl_attr_put_strz(nlh, DEVLINK_ATTR_DEV_NAME, opts->dev_name);
1472 mnl_attr_put_strz(nlh, DEVLINK_ATTR_REGION_NAME,
1473 opts->region_name);
1474 }
1475 if (opts->present & DL_OPT_PORT_TYPE)
1476 mnl_attr_put_u16(nlh, DEVLINK_ATTR_PORT_TYPE,
1477 opts->port_type);
1478 if (opts->present & DL_OPT_PORT_COUNT)
1479 mnl_attr_put_u32(nlh, DEVLINK_ATTR_PORT_SPLIT_COUNT,
1480 opts->port_count);
1481 if (opts->present & DL_OPT_SB)
1482 mnl_attr_put_u32(nlh, DEVLINK_ATTR_SB_INDEX,
1483 opts->sb_index);
1484 if (opts->present & DL_OPT_SB_POOL)
1485 mnl_attr_put_u16(nlh, DEVLINK_ATTR_SB_POOL_INDEX,
1486 opts->sb_pool_index);
1487 if (opts->present & DL_OPT_SB_SIZE)
1488 mnl_attr_put_u32(nlh, DEVLINK_ATTR_SB_POOL_SIZE,
1489 opts->sb_pool_size);
1490 if (opts->present & DL_OPT_SB_TYPE)
1491 mnl_attr_put_u8(nlh, DEVLINK_ATTR_SB_POOL_TYPE,
1492 opts->sb_pool_type);
1493 if (opts->present & DL_OPT_SB_THTYPE)
1494 mnl_attr_put_u8(nlh, DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE,
1495 opts->sb_pool_thtype);
1496 if (opts->present & DL_OPT_SB_TH)
1497 mnl_attr_put_u32(nlh, DEVLINK_ATTR_SB_THRESHOLD,
1498 opts->sb_threshold);
1499 if (opts->present & DL_OPT_SB_TC)
1500 mnl_attr_put_u16(nlh, DEVLINK_ATTR_SB_TC_INDEX,
1501 opts->sb_tc_index);
1502 if (opts->present & DL_OPT_ESWITCH_MODE)
1503 mnl_attr_put_u16(nlh, DEVLINK_ATTR_ESWITCH_MODE,
1504 opts->eswitch_mode);
1505 if (opts->present & DL_OPT_ESWITCH_INLINE_MODE)
1506 mnl_attr_put_u8(nlh, DEVLINK_ATTR_ESWITCH_INLINE_MODE,
1507 opts->eswitch_inline_mode);
1508 if (opts->present & DL_OPT_DPIPE_TABLE_NAME)
1509 mnl_attr_put_strz(nlh, DEVLINK_ATTR_DPIPE_TABLE_NAME,
1510 opts->dpipe_table_name);
1511 if (opts->present & DL_OPT_DPIPE_TABLE_COUNTERS)
1512 mnl_attr_put_u8(nlh, DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED,
1513 opts->dpipe_counters_enable);
1514 if (opts->present & DL_OPT_ESWITCH_ENCAP_MODE)
1515 mnl_attr_put_u8(nlh, DEVLINK_ATTR_ESWITCH_ENCAP_MODE,
1516 opts->eswitch_encap_mode);
1517 if ((opts->present & DL_OPT_RESOURCE_PATH) && opts->resource_id_valid)
1518 mnl_attr_put_u64(nlh, DEVLINK_ATTR_RESOURCE_ID,
1519 opts->resource_id);
1520 if (opts->present & DL_OPT_RESOURCE_SIZE)
1521 mnl_attr_put_u64(nlh, DEVLINK_ATTR_RESOURCE_SIZE,
1522 opts->resource_size);
1523 if (opts->present & DL_OPT_PARAM_NAME)
1524 mnl_attr_put_strz(nlh, DEVLINK_ATTR_PARAM_NAME,
1525 opts->param_name);
1526 if (opts->present & DL_OPT_PARAM_CMODE)
1527 mnl_attr_put_u8(nlh, DEVLINK_ATTR_PARAM_VALUE_CMODE,
1528 opts->cmode);
1529 if (opts->present & DL_OPT_REGION_SNAPSHOT_ID)
1530 mnl_attr_put_u32(nlh, DEVLINK_ATTR_REGION_SNAPSHOT_ID,
1531 opts->region_snapshot_id);
1532 if (opts->present & DL_OPT_REGION_ADDRESS)
1533 mnl_attr_put_u64(nlh, DEVLINK_ATTR_REGION_CHUNK_ADDR,
1534 opts->region_address);
1535 if (opts->present & DL_OPT_REGION_LENGTH)
1536 mnl_attr_put_u64(nlh, DEVLINK_ATTR_REGION_CHUNK_LEN,
1537 opts->region_length);
1538 if (opts->present & DL_OPT_FLASH_FILE_NAME)
1539 mnl_attr_put_strz(nlh, DEVLINK_ATTR_FLASH_UPDATE_FILE_NAME,
1540 opts->flash_file_name);
1541 if (opts->present & DL_OPT_FLASH_COMPONENT)
1542 mnl_attr_put_strz(nlh, DEVLINK_ATTR_FLASH_UPDATE_COMPONENT,
1543 opts->flash_component);
1544 if (opts->present & DL_OPT_HEALTH_REPORTER_NAME)
1545 mnl_attr_put_strz(nlh, DEVLINK_ATTR_HEALTH_REPORTER_NAME,
1546 opts->reporter_name);
1547 if (opts->present & DL_OPT_HEALTH_REPORTER_GRACEFUL_PERIOD)
1548 mnl_attr_put_u64(nlh,
1549 DEVLINK_ATTR_HEALTH_REPORTER_GRACEFUL_PERIOD,
1550 opts->reporter_graceful_period);
1551 if (opts->present & DL_OPT_HEALTH_REPORTER_AUTO_RECOVER)
1552 mnl_attr_put_u8(nlh, DEVLINK_ATTR_HEALTH_REPORTER_AUTO_RECOVER,
1553 opts->reporter_auto_recover);
1554 if (opts->present & DL_OPT_TRAP_NAME)
1555 mnl_attr_put_strz(nlh, DEVLINK_ATTR_TRAP_NAME,
1556 opts->trap_name);
1557 if (opts->present & DL_OPT_TRAP_GROUP_NAME)
1558 mnl_attr_put_strz(nlh, DEVLINK_ATTR_TRAP_GROUP_NAME,
1559 opts->trap_group_name);
1560 if (opts->present & DL_OPT_TRAP_ACTION)
1561 mnl_attr_put_u8(nlh, DEVLINK_ATTR_TRAP_ACTION,
1562 opts->trap_action);
1563
1564 }
1565
1566 static int dl_argv_parse_put(struct nlmsghdr *nlh, struct dl *dl,
1567 uint64_t o_required, uint64_t o_optional)
1568 {
1569 int err;
1570
1571 err = dl_argv_parse(dl, o_required, o_optional);
1572 if (err)
1573 return err;
1574 dl_opts_put(nlh, dl);
1575 return 0;
1576 }
1577
1578 static bool dl_dump_filter(struct dl *dl, struct nlattr **tb)
1579 {
1580 struct dl_opts *opts = &dl->opts;
1581 struct nlattr *attr_bus_name = tb[DEVLINK_ATTR_BUS_NAME];
1582 struct nlattr *attr_dev_name = tb[DEVLINK_ATTR_DEV_NAME];
1583 struct nlattr *attr_port_index = tb[DEVLINK_ATTR_PORT_INDEX];
1584 struct nlattr *attr_sb_index = tb[DEVLINK_ATTR_SB_INDEX];
1585
1586 if (opts->present & DL_OPT_HANDLE &&
1587 attr_bus_name && attr_dev_name) {
1588 const char *bus_name = mnl_attr_get_str(attr_bus_name);
1589 const char *dev_name = mnl_attr_get_str(attr_dev_name);
1590
1591 if (strcmp(bus_name, opts->bus_name) != 0 ||
1592 strcmp(dev_name, opts->dev_name) != 0)
1593 return false;
1594 }
1595 if (opts->present & DL_OPT_HANDLEP &&
1596 attr_bus_name && attr_dev_name && attr_port_index) {
1597 const char *bus_name = mnl_attr_get_str(attr_bus_name);
1598 const char *dev_name = mnl_attr_get_str(attr_dev_name);
1599 uint32_t port_index = mnl_attr_get_u32(attr_port_index);
1600
1601 if (strcmp(bus_name, opts->bus_name) != 0 ||
1602 strcmp(dev_name, opts->dev_name) != 0 ||
1603 port_index != opts->port_index)
1604 return false;
1605 }
1606 if (opts->present & DL_OPT_SB && attr_sb_index) {
1607 uint32_t sb_index = mnl_attr_get_u32(attr_sb_index);
1608
1609 if (sb_index != opts->sb_index)
1610 return false;
1611 }
1612 return true;
1613 }
1614
1615 static void cmd_dev_help(void)
1616 {
1617 pr_err("Usage: devlink dev show [ DEV ]\n");
1618 pr_err(" devlink dev eswitch set DEV [ mode { legacy | switchdev } ]\n");
1619 pr_err(" [ inline-mode { none | link | network | transport } ]\n");
1620 pr_err(" [ encap { disable | enable } ]\n");
1621 pr_err(" devlink dev eswitch show DEV\n");
1622 pr_err(" devlink dev param set DEV name PARAMETER value VALUE cmode { permanent | driverinit | runtime }\n");
1623 pr_err(" devlink dev param show [DEV name PARAMETER]\n");
1624 pr_err(" devlink dev reload DEV\n");
1625 pr_err(" devlink dev info [ DEV ]\n");
1626 pr_err(" devlink dev flash DEV file PATH [ component NAME ]\n");
1627 }
1628
1629 static bool cmp_arr_last_handle(struct dl *dl, const char *bus_name,
1630 const char *dev_name)
1631 {
1632 if (!dl->arr_last.present)
1633 return false;
1634 return strcmp(dl->arr_last.bus_name, bus_name) == 0 &&
1635 strcmp(dl->arr_last.dev_name, dev_name) == 0;
1636 }
1637
1638 static void arr_last_handle_set(struct dl *dl, const char *bus_name,
1639 const char *dev_name)
1640 {
1641 dl->arr_last.present = true;
1642 free(dl->arr_last.dev_name);
1643 free(dl->arr_last.bus_name);
1644 dl->arr_last.bus_name = strdup(bus_name);
1645 dl->arr_last.dev_name = strdup(dev_name);
1646 }
1647
1648 static bool should_arr_last_handle_start(struct dl *dl, const char *bus_name,
1649 const char *dev_name)
1650 {
1651 return !cmp_arr_last_handle(dl, bus_name, dev_name);
1652 }
1653
1654 static bool should_arr_last_handle_end(struct dl *dl, const char *bus_name,
1655 const char *dev_name)
1656 {
1657 return dl->arr_last.present &&
1658 !cmp_arr_last_handle(dl, bus_name, dev_name);
1659 }
1660
1661 static void __pr_out_handle_start(struct dl *dl, struct nlattr **tb,
1662 bool content, bool array)
1663 {
1664 const char *bus_name = mnl_attr_get_str(tb[DEVLINK_ATTR_BUS_NAME]);
1665 const char *dev_name = mnl_attr_get_str(tb[DEVLINK_ATTR_DEV_NAME]);
1666 char buf[64];
1667
1668 sprintf(buf, "%s/%s", bus_name, dev_name);
1669
1670 if (dl->json_output) {
1671 if (array) {
1672 if (should_arr_last_handle_end(dl, bus_name, dev_name))
1673 jsonw_end_array(dl->jw);
1674 if (should_arr_last_handle_start(dl, bus_name,
1675 dev_name)) {
1676 jsonw_name(dl->jw, buf);
1677 jsonw_start_array(dl->jw);
1678 jsonw_start_object(dl->jw);
1679 arr_last_handle_set(dl, bus_name, dev_name);
1680 } else {
1681 jsonw_start_object(dl->jw);
1682 }
1683 } else {
1684 jsonw_name(dl->jw, buf);
1685 jsonw_start_object(dl->jw);
1686 }
1687 } else {
1688 if (array) {
1689 if (should_arr_last_handle_end(dl, bus_name, dev_name))
1690 __pr_out_indent_dec();
1691 if (should_arr_last_handle_start(dl, bus_name,
1692 dev_name)) {
1693 pr_out("%s%s", buf, content ? ":" : "");
1694 __pr_out_newline();
1695 __pr_out_indent_inc();
1696 arr_last_handle_set(dl, bus_name, dev_name);
1697 }
1698 } else {
1699 pr_out("%s%s", buf, content ? ":" : "");
1700 }
1701 }
1702 }
1703
1704 static void pr_out_handle_start_arr(struct dl *dl, struct nlattr **tb)
1705 {
1706 __pr_out_handle_start(dl, tb, true, true);
1707 }
1708
1709 static void pr_out_handle_end(struct dl *dl)
1710 {
1711 if (dl->json_output)
1712 jsonw_end_object(dl->jw);
1713 else
1714 __pr_out_newline();
1715 }
1716
1717 static void pr_out_handle(struct dl *dl, struct nlattr **tb)
1718 {
1719 __pr_out_handle_start(dl, tb, false, false);
1720 pr_out_handle_end(dl);
1721 }
1722
1723 static bool cmp_arr_last_port_handle(struct dl *dl, const char *bus_name,
1724 const char *dev_name, uint32_t port_index)
1725 {
1726 return cmp_arr_last_handle(dl, bus_name, dev_name) &&
1727 dl->arr_last.port_index == port_index;
1728 }
1729
1730 static void arr_last_port_handle_set(struct dl *dl, const char *bus_name,
1731 const char *dev_name, uint32_t port_index)
1732 {
1733 arr_last_handle_set(dl, bus_name, dev_name);
1734 dl->arr_last.port_index = port_index;
1735 }
1736
1737 static bool should_arr_last_port_handle_start(struct dl *dl,
1738 const char *bus_name,
1739 const char *dev_name,
1740 uint32_t port_index)
1741 {
1742 return !cmp_arr_last_port_handle(dl, bus_name, dev_name, port_index);
1743 }
1744
1745 static bool should_arr_last_port_handle_end(struct dl *dl,
1746 const char *bus_name,
1747 const char *dev_name,
1748 uint32_t port_index)
1749 {
1750 return dl->arr_last.present &&
1751 !cmp_arr_last_port_handle(dl, bus_name, dev_name, port_index);
1752 }
1753
1754 static void __pr_out_port_handle_start(struct dl *dl, const char *bus_name,
1755 const char *dev_name,
1756 uint32_t port_index, bool try_nice,
1757 bool array)
1758 {
1759 static char buf[64];
1760 char *ifname = NULL;
1761
1762 if (dl->no_nice_names || !try_nice ||
1763 ifname_map_rev_lookup(dl, bus_name, dev_name,
1764 port_index, &ifname) != 0)
1765 sprintf(buf, "%s/%s/%d", bus_name, dev_name, port_index);
1766 else
1767 sprintf(buf, "%s", ifname);
1768
1769 if (dl->json_output) {
1770 if (array) {
1771 if (should_arr_last_port_handle_end(dl, bus_name,
1772 dev_name,
1773 port_index))
1774 jsonw_end_array(dl->jw);
1775 if (should_arr_last_port_handle_start(dl, bus_name,
1776 dev_name,
1777 port_index)) {
1778 jsonw_name(dl->jw, buf);
1779 jsonw_start_array(dl->jw);
1780 jsonw_start_object(dl->jw);
1781 arr_last_port_handle_set(dl, bus_name, dev_name,
1782 port_index);
1783 } else {
1784 jsonw_start_object(dl->jw);
1785 }
1786 } else {
1787 jsonw_name(dl->jw, buf);
1788 jsonw_start_object(dl->jw);
1789 }
1790 } else {
1791 pr_out("%s:", buf);
1792 }
1793 }
1794
1795 static void pr_out_port_handle_start(struct dl *dl, struct nlattr **tb, bool try_nice)
1796 {
1797 const char *bus_name;
1798 const char *dev_name;
1799 uint32_t port_index;
1800
1801 bus_name = mnl_attr_get_str(tb[DEVLINK_ATTR_BUS_NAME]);
1802 dev_name = mnl_attr_get_str(tb[DEVLINK_ATTR_DEV_NAME]);
1803 port_index = mnl_attr_get_u32(tb[DEVLINK_ATTR_PORT_INDEX]);
1804 __pr_out_port_handle_start(dl, bus_name, dev_name, port_index, try_nice, false);
1805 }
1806
1807 static void pr_out_port_handle_start_arr(struct dl *dl, struct nlattr **tb, bool try_nice)
1808 {
1809 const char *bus_name;
1810 const char *dev_name;
1811 uint32_t port_index;
1812
1813 bus_name = mnl_attr_get_str(tb[DEVLINK_ATTR_BUS_NAME]);
1814 dev_name = mnl_attr_get_str(tb[DEVLINK_ATTR_DEV_NAME]);
1815 port_index = mnl_attr_get_u32(tb[DEVLINK_ATTR_PORT_INDEX]);
1816 __pr_out_port_handle_start(dl, bus_name, dev_name, port_index, try_nice, true);
1817 }
1818
1819 static void pr_out_port_handle_end(struct dl *dl)
1820 {
1821 if (dl->json_output)
1822 jsonw_end_object(dl->jw);
1823 else
1824 pr_out("\n");
1825 }
1826
1827
1828 static void pr_out_str(struct dl *dl, const char *name, const char *val)
1829 {
1830 if (dl->json_output) {
1831 jsonw_string_field(dl->jw, name, val);
1832 } else {
1833 if (g_indent_newline)
1834 pr_out("%s %s", name, val);
1835 else
1836 pr_out(" %s %s", name, val);
1837 }
1838 }
1839
1840 static void pr_out_bool(struct dl *dl, const char *name, bool val)
1841 {
1842 if (dl->json_output)
1843 jsonw_bool_field(dl->jw, name, val);
1844 else
1845 pr_out_str(dl, name, val ? "true" : "false");
1846 }
1847
1848 static void pr_out_uint(struct dl *dl, const char *name, unsigned int val)
1849 {
1850 if (dl->json_output) {
1851 jsonw_uint_field(dl->jw, name, val);
1852 } else {
1853 if (g_indent_newline)
1854 pr_out("%s %u", name, val);
1855 else
1856 pr_out(" %s %u", name, val);
1857 }
1858 }
1859
1860 static void pr_out_u64(struct dl *dl, const char *name, uint64_t val)
1861 {
1862 if (val == (uint64_t) -1)
1863 return pr_out_str(dl, name, "unlimited");
1864
1865 if (dl->json_output) {
1866 jsonw_u64_field(dl->jw, name, val);
1867 } else {
1868 if (g_indent_newline)
1869 pr_out("%s %"PRIu64, name, val);
1870 else
1871 pr_out(" %s %"PRIu64, name, val);
1872 }
1873 }
1874
1875 static void pr_out_bool_value(struct dl *dl, bool value)
1876 {
1877 if (dl->json_output)
1878 jsonw_bool(dl->jw, value);
1879 else
1880 pr_out(" %s", value ? "true" : "false");
1881 }
1882
1883 static void pr_out_uint_value(struct dl *dl, unsigned int value)
1884 {
1885 if (dl->json_output)
1886 jsonw_uint(dl->jw, value);
1887 else
1888 pr_out(" %u", value);
1889 }
1890
1891 static void pr_out_uint64_value(struct dl *dl, uint64_t value)
1892 {
1893 if (dl->json_output)
1894 jsonw_u64(dl->jw, value);
1895 else
1896 pr_out(" %"PRIu64, value);
1897 }
1898
1899 static bool is_binary_eol(int i)
1900 {
1901 return !(i%16);
1902 }
1903
1904 static void pr_out_binary_value(struct dl *dl, uint8_t *data, uint32_t len)
1905 {
1906 int i = 0;
1907
1908 while (i < len) {
1909 if (dl->json_output)
1910 jsonw_printf(dl->jw, "%d", data[i]);
1911 else
1912 pr_out("%02x ", data[i]);
1913 i++;
1914 if (!dl->json_output && is_binary_eol(i))
1915 __pr_out_newline();
1916 }
1917 if (!dl->json_output && !is_binary_eol(i))
1918 __pr_out_newline();
1919 }
1920
1921 static void pr_out_str_value(struct dl *dl, const char *value)
1922 {
1923 if (dl->json_output)
1924 jsonw_string(dl->jw, value);
1925 else
1926 pr_out(" %s", value);
1927 }
1928
1929 static void pr_out_name(struct dl *dl, const char *name)
1930 {
1931 if (dl->json_output)
1932 jsonw_name(dl->jw, name);
1933 else
1934 pr_out(" %s:", name);
1935 }
1936
1937 static void pr_out_region_chunk_start(struct dl *dl, uint64_t addr)
1938 {
1939 if (dl->json_output) {
1940 jsonw_name(dl->jw, "address");
1941 jsonw_uint(dl->jw, addr);
1942 jsonw_name(dl->jw, "data");
1943 jsonw_start_array(dl->jw);
1944 }
1945 }
1946
1947 static void pr_out_region_chunk_end(struct dl *dl)
1948 {
1949 if (dl->json_output)
1950 jsonw_end_array(dl->jw);
1951 }
1952
1953 static void pr_out_region_chunk(struct dl *dl, uint8_t *data, uint32_t len,
1954 uint64_t addr)
1955 {
1956 static uint64_t align_val;
1957 uint32_t i = 0;
1958
1959 pr_out_region_chunk_start(dl, addr);
1960 while (i < len) {
1961 if (!dl->json_output)
1962 if (!(align_val % 16))
1963 pr_out("%s%016"PRIx64" ",
1964 align_val ? "\n" : "",
1965 addr);
1966
1967 align_val++;
1968
1969 if (dl->json_output)
1970 jsonw_printf(dl->jw, "%d", data[i]);
1971 else
1972 pr_out("%02x ", data[i]);
1973
1974 addr++;
1975 i++;
1976 }
1977 pr_out_region_chunk_end(dl);
1978 }
1979
1980 static void pr_out_dev(struct dl *dl, struct nlattr **tb)
1981 {
1982 pr_out_handle(dl, tb);
1983 }
1984
1985 static void pr_out_section_start(struct dl *dl, const char *name)
1986 {
1987 if (dl->json_output) {
1988 jsonw_start_object(dl->jw);
1989 jsonw_name(dl->jw, name);
1990 jsonw_start_object(dl->jw);
1991 }
1992 }
1993
1994 static void pr_out_section_end(struct dl *dl)
1995 {
1996 if (dl->json_output) {
1997 if (dl->arr_last.present)
1998 jsonw_end_array(dl->jw);
1999 jsonw_end_object(dl->jw);
2000 jsonw_end_object(dl->jw);
2001 }
2002 }
2003
2004 static void pr_out_array_start(struct dl *dl, const char *name)
2005 {
2006 if (dl->json_output) {
2007 jsonw_name(dl->jw, name);
2008 jsonw_start_array(dl->jw);
2009 } else {
2010 __pr_out_indent_inc();
2011 __pr_out_newline();
2012 pr_out("%s:", name);
2013 __pr_out_indent_inc();
2014 __pr_out_newline();
2015 }
2016 }
2017
2018 static void pr_out_array_end(struct dl *dl)
2019 {
2020 if (dl->json_output) {
2021 jsonw_end_array(dl->jw);
2022 } else {
2023 __pr_out_indent_dec();
2024 __pr_out_indent_dec();
2025 }
2026 }
2027
2028 static void pr_out_object_start(struct dl *dl, const char *name)
2029 {
2030 if (dl->json_output) {
2031 jsonw_name(dl->jw, name);
2032 jsonw_start_object(dl->jw);
2033 } else {
2034 __pr_out_indent_inc();
2035 __pr_out_newline();
2036 pr_out("%s:", name);
2037 __pr_out_indent_inc();
2038 __pr_out_newline();
2039 }
2040 }
2041
2042 static void pr_out_object_end(struct dl *dl)
2043 {
2044 if (dl->json_output) {
2045 jsonw_end_object(dl->jw);
2046 } else {
2047 __pr_out_indent_dec();
2048 __pr_out_indent_dec();
2049 }
2050 }
2051
2052 static void pr_out_entry_start(struct dl *dl)
2053 {
2054 if (dl->json_output)
2055 jsonw_start_object(dl->jw);
2056 }
2057
2058 static void pr_out_entry_end(struct dl *dl)
2059 {
2060 if (dl->json_output)
2061 jsonw_end_object(dl->jw);
2062 else
2063 __pr_out_newline();
2064 }
2065
2066 static void pr_out_stats(struct dl *dl, struct nlattr *nla_stats)
2067 {
2068 struct nlattr *tb[DEVLINK_ATTR_STATS_MAX + 1] = {};
2069 int err;
2070
2071 if (!dl->stats)
2072 return;
2073
2074 err = mnl_attr_parse_nested(nla_stats, attr_stats_cb, tb);
2075 if (err != MNL_CB_OK)
2076 return;
2077
2078 pr_out_object_start(dl, "stats");
2079 pr_out_object_start(dl, "rx");
2080 if (tb[DEVLINK_ATTR_STATS_RX_BYTES])
2081 pr_out_u64(dl, "bytes",
2082 mnl_attr_get_u64(tb[DEVLINK_ATTR_STATS_RX_BYTES]));
2083 if (tb[DEVLINK_ATTR_STATS_RX_PACKETS])
2084 pr_out_u64(dl, "packets",
2085 mnl_attr_get_u64(tb[DEVLINK_ATTR_STATS_RX_PACKETS]));
2086 pr_out_object_end(dl);
2087 pr_out_object_end(dl);
2088 }
2089
2090 static const char *param_cmode_name(uint8_t cmode)
2091 {
2092 switch (cmode) {
2093 case DEVLINK_PARAM_CMODE_RUNTIME:
2094 return PARAM_CMODE_RUNTIME_STR;
2095 case DEVLINK_PARAM_CMODE_DRIVERINIT:
2096 return PARAM_CMODE_DRIVERINIT_STR;
2097 case DEVLINK_PARAM_CMODE_PERMANENT:
2098 return PARAM_CMODE_PERMANENT_STR;
2099 default: return "<unknown type>";
2100 }
2101 }
2102
2103 static const char *eswitch_mode_name(uint32_t mode)
2104 {
2105 switch (mode) {
2106 case DEVLINK_ESWITCH_MODE_LEGACY: return ESWITCH_MODE_LEGACY;
2107 case DEVLINK_ESWITCH_MODE_SWITCHDEV: return ESWITCH_MODE_SWITCHDEV;
2108 default: return "<unknown mode>";
2109 }
2110 }
2111
2112 static const char *eswitch_inline_mode_name(uint32_t mode)
2113 {
2114 switch (mode) {
2115 case DEVLINK_ESWITCH_INLINE_MODE_NONE:
2116 return ESWITCH_INLINE_MODE_NONE;
2117 case DEVLINK_ESWITCH_INLINE_MODE_LINK:
2118 return ESWITCH_INLINE_MODE_LINK;
2119 case DEVLINK_ESWITCH_INLINE_MODE_NETWORK:
2120 return ESWITCH_INLINE_MODE_NETWORK;
2121 case DEVLINK_ESWITCH_INLINE_MODE_TRANSPORT:
2122 return ESWITCH_INLINE_MODE_TRANSPORT;
2123 default:
2124 return "<unknown mode>";
2125 }
2126 }
2127
2128 static void pr_out_eswitch(struct dl *dl, struct nlattr **tb)
2129 {
2130 __pr_out_handle_start(dl, tb, true, false);
2131
2132 if (tb[DEVLINK_ATTR_ESWITCH_MODE])
2133 pr_out_str(dl, "mode",
2134 eswitch_mode_name(mnl_attr_get_u16(tb[DEVLINK_ATTR_ESWITCH_MODE])));
2135
2136 if (tb[DEVLINK_ATTR_ESWITCH_INLINE_MODE])
2137 pr_out_str(dl, "inline-mode",
2138 eswitch_inline_mode_name(mnl_attr_get_u8(
2139 tb[DEVLINK_ATTR_ESWITCH_INLINE_MODE])));
2140
2141 if (tb[DEVLINK_ATTR_ESWITCH_ENCAP_MODE]) {
2142 bool encap_mode = !!mnl_attr_get_u8(tb[DEVLINK_ATTR_ESWITCH_ENCAP_MODE]);
2143
2144 pr_out_str(dl, "encap", encap_mode ? "enable" : "disable");
2145 }
2146
2147 pr_out_handle_end(dl);
2148 }
2149
2150 static int cmd_dev_eswitch_show_cb(const struct nlmsghdr *nlh, void *data)
2151 {
2152 struct dl *dl = data;
2153 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
2154 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
2155
2156 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
2157 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME])
2158 return MNL_CB_ERROR;
2159 pr_out_eswitch(dl, tb);
2160 return MNL_CB_OK;
2161 }
2162
2163 static int cmd_dev_eswitch_show(struct dl *dl)
2164 {
2165 struct nlmsghdr *nlh;
2166 int err;
2167
2168 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_ESWITCH_GET,
2169 NLM_F_REQUEST | NLM_F_ACK);
2170
2171 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, 0);
2172 if (err)
2173 return err;
2174
2175 pr_out_section_start(dl, "dev");
2176 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dev_eswitch_show_cb, dl);
2177 pr_out_section_end(dl);
2178 return err;
2179 }
2180
2181 static int cmd_dev_eswitch_set(struct dl *dl)
2182 {
2183 struct nlmsghdr *nlh;
2184 int err;
2185
2186 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_ESWITCH_SET,
2187 NLM_F_REQUEST | NLM_F_ACK);
2188
2189 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE,
2190 DL_OPT_ESWITCH_MODE |
2191 DL_OPT_ESWITCH_INLINE_MODE |
2192 DL_OPT_ESWITCH_ENCAP_MODE);
2193
2194 if (err)
2195 return err;
2196
2197 if (dl->opts.present == 1) {
2198 pr_err("Need to set at least one option\n");
2199 return -ENOENT;
2200 }
2201
2202 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
2203 }
2204
2205 static int cmd_dev_eswitch(struct dl *dl)
2206 {
2207 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
2208 cmd_dev_help();
2209 return 0;
2210 } else if (dl_argv_match(dl, "set")) {
2211 dl_arg_inc(dl);
2212 return cmd_dev_eswitch_set(dl);
2213 } else if (dl_argv_match(dl, "show")) {
2214 dl_arg_inc(dl);
2215 return cmd_dev_eswitch_show(dl);
2216 }
2217 pr_err("Command \"%s\" not found\n", dl_argv(dl));
2218 return -ENOENT;
2219 }
2220
2221 struct param_val_conv {
2222 const char *name;
2223 const char *vstr;
2224 uint32_t vuint;
2225 };
2226
2227 static bool param_val_conv_exists(const struct param_val_conv *param_val_conv,
2228 uint32_t len, const char *name)
2229 {
2230 uint32_t i;
2231
2232 for (i = 0; i < len; i++)
2233 if (!strcmp(param_val_conv[i].name, name))
2234 return true;
2235
2236 return false;
2237 }
2238
2239 static int
2240 param_val_conv_uint_get(const struct param_val_conv *param_val_conv,
2241 uint32_t len, const char *name, const char *vstr,
2242 uint32_t *vuint)
2243 {
2244 uint32_t i;
2245
2246 for (i = 0; i < len; i++)
2247 if (!strcmp(param_val_conv[i].name, name) &&
2248 !strcmp(param_val_conv[i].vstr, vstr)) {
2249 *vuint = param_val_conv[i].vuint;
2250 return 0;
2251 }
2252
2253 return -ENOENT;
2254 }
2255
2256 static int
2257 param_val_conv_str_get(const struct param_val_conv *param_val_conv,
2258 uint32_t len, const char *name, uint32_t vuint,
2259 const char **vstr)
2260 {
2261 uint32_t i;
2262
2263 for (i = 0; i < len; i++)
2264 if (!strcmp(param_val_conv[i].name, name) &&
2265 param_val_conv[i].vuint == vuint) {
2266 *vstr = param_val_conv[i].vstr;
2267 return 0;
2268 }
2269
2270 return -ENOENT;
2271 }
2272
2273 static const struct param_val_conv param_val_conv[] = {
2274 {
2275 .name = "fw_load_policy",
2276 .vstr = "driver",
2277 .vuint = DEVLINK_PARAM_FW_LOAD_POLICY_VALUE_DRIVER,
2278 },
2279 {
2280 .name = "fw_load_policy",
2281 .vstr = "flash",
2282 .vuint = DEVLINK_PARAM_FW_LOAD_POLICY_VALUE_FLASH,
2283 },
2284 {
2285 .name = "reset_dev_on_drv_probe",
2286 .vstr = "unknown",
2287 .vuint = DEVLINK_PARAM_RESET_DEV_ON_DRV_PROBE_VALUE_UNKNOWN,
2288 },
2289 {
2290 .name = "fw_load_policy",
2291 .vstr = "unknown",
2292 .vuint = DEVLINK_PARAM_FW_LOAD_POLICY_VALUE_UNKNOWN,
2293 },
2294 {
2295 .name = "reset_dev_on_drv_probe",
2296 .vstr = "always",
2297 .vuint = DEVLINK_PARAM_RESET_DEV_ON_DRV_PROBE_VALUE_ALWAYS,
2298 },
2299 {
2300 .name = "reset_dev_on_drv_probe",
2301 .vstr = "never",
2302 .vuint = DEVLINK_PARAM_RESET_DEV_ON_DRV_PROBE_VALUE_NEVER,
2303 },
2304 {
2305 .name = "reset_dev_on_drv_probe",
2306 .vstr = "disk",
2307 .vuint = DEVLINK_PARAM_RESET_DEV_ON_DRV_PROBE_VALUE_DISK,
2308 },
2309 };
2310
2311 #define PARAM_VAL_CONV_LEN ARRAY_SIZE(param_val_conv)
2312
2313 static void pr_out_param_value(struct dl *dl, const char *nla_name,
2314 int nla_type, struct nlattr *nl)
2315 {
2316 struct nlattr *nla_value[DEVLINK_ATTR_MAX + 1] = {};
2317 struct nlattr *val_attr;
2318 const char *vstr;
2319 bool conv_exists;
2320 int err;
2321
2322 err = mnl_attr_parse_nested(nl, attr_cb, nla_value);
2323 if (err != MNL_CB_OK)
2324 return;
2325
2326 if (!nla_value[DEVLINK_ATTR_PARAM_VALUE_CMODE] ||
2327 (nla_type != MNL_TYPE_FLAG &&
2328 !nla_value[DEVLINK_ATTR_PARAM_VALUE_DATA]))
2329 return;
2330
2331 pr_out_str(dl, "cmode",
2332 param_cmode_name(mnl_attr_get_u8(nla_value[DEVLINK_ATTR_PARAM_VALUE_CMODE])));
2333 val_attr = nla_value[DEVLINK_ATTR_PARAM_VALUE_DATA];
2334
2335 conv_exists = param_val_conv_exists(param_val_conv, PARAM_VAL_CONV_LEN,
2336 nla_name);
2337
2338 switch (nla_type) {
2339 case MNL_TYPE_U8:
2340 if (conv_exists) {
2341 err = param_val_conv_str_get(param_val_conv,
2342 PARAM_VAL_CONV_LEN,
2343 nla_name,
2344 mnl_attr_get_u8(val_attr),
2345 &vstr);
2346 if (err)
2347 return;
2348 pr_out_str(dl, "value", vstr);
2349 } else {
2350 pr_out_uint(dl, "value", mnl_attr_get_u8(val_attr));
2351 }
2352 break;
2353 case MNL_TYPE_U16:
2354 if (conv_exists) {
2355 err = param_val_conv_str_get(param_val_conv,
2356 PARAM_VAL_CONV_LEN,
2357 nla_name,
2358 mnl_attr_get_u16(val_attr),
2359 &vstr);
2360 if (err)
2361 return;
2362 pr_out_str(dl, "value", vstr);
2363 } else {
2364 pr_out_uint(dl, "value", mnl_attr_get_u16(val_attr));
2365 }
2366 break;
2367 case MNL_TYPE_U32:
2368 if (conv_exists) {
2369 err = param_val_conv_str_get(param_val_conv,
2370 PARAM_VAL_CONV_LEN,
2371 nla_name,
2372 mnl_attr_get_u32(val_attr),
2373 &vstr);
2374 if (err)
2375 return;
2376 pr_out_str(dl, "value", vstr);
2377 } else {
2378 pr_out_uint(dl, "value", mnl_attr_get_u32(val_attr));
2379 }
2380 break;
2381 case MNL_TYPE_STRING:
2382 pr_out_str(dl, "value", mnl_attr_get_str(val_attr));
2383 break;
2384 case MNL_TYPE_FLAG:
2385 pr_out_bool(dl, "value", val_attr ? true : false);
2386 break;
2387 }
2388 }
2389
2390 static void pr_out_param(struct dl *dl, struct nlattr **tb, bool array)
2391 {
2392 struct nlattr *nla_param[DEVLINK_ATTR_MAX + 1] = {};
2393 struct nlattr *param_value_attr;
2394 const char *nla_name;
2395 int nla_type;
2396 int err;
2397
2398 err = mnl_attr_parse_nested(tb[DEVLINK_ATTR_PARAM], attr_cb, nla_param);
2399 if (err != MNL_CB_OK)
2400 return;
2401 if (!nla_param[DEVLINK_ATTR_PARAM_NAME] ||
2402 !nla_param[DEVLINK_ATTR_PARAM_TYPE] ||
2403 !nla_param[DEVLINK_ATTR_PARAM_VALUES_LIST])
2404 return;
2405
2406 if (array)
2407 pr_out_handle_start_arr(dl, tb);
2408 else
2409 __pr_out_handle_start(dl, tb, true, false);
2410
2411 nla_type = mnl_attr_get_u8(nla_param[DEVLINK_ATTR_PARAM_TYPE]);
2412
2413 nla_name = mnl_attr_get_str(nla_param[DEVLINK_ATTR_PARAM_NAME]);
2414 pr_out_str(dl, "name", nla_name);
2415
2416 if (!nla_param[DEVLINK_ATTR_PARAM_GENERIC])
2417 pr_out_str(dl, "type", "driver-specific");
2418 else
2419 pr_out_str(dl, "type", "generic");
2420
2421 pr_out_array_start(dl, "values");
2422 mnl_attr_for_each_nested(param_value_attr,
2423 nla_param[DEVLINK_ATTR_PARAM_VALUES_LIST]) {
2424 pr_out_entry_start(dl);
2425 pr_out_param_value(dl, nla_name, nla_type, param_value_attr);
2426 pr_out_entry_end(dl);
2427 }
2428 pr_out_array_end(dl);
2429 pr_out_handle_end(dl);
2430 }
2431
2432 static int cmd_dev_param_show_cb(const struct nlmsghdr *nlh, void *data)
2433 {
2434 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
2435 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
2436 struct dl *dl = data;
2437
2438 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
2439 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
2440 !tb[DEVLINK_ATTR_PARAM])
2441 return MNL_CB_ERROR;
2442 pr_out_param(dl, tb, true);
2443 return MNL_CB_OK;
2444 }
2445
2446 struct param_ctx {
2447 struct dl *dl;
2448 int nla_type;
2449 union {
2450 uint8_t vu8;
2451 uint16_t vu16;
2452 uint32_t vu32;
2453 const char *vstr;
2454 bool vbool;
2455 } value;
2456 };
2457
2458 static int cmd_dev_param_set_cb(const struct nlmsghdr *nlh, void *data)
2459 {
2460 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
2461 struct nlattr *nla_param[DEVLINK_ATTR_MAX + 1] = {};
2462 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
2463 struct nlattr *param_value_attr;
2464 enum devlink_param_cmode cmode;
2465 struct param_ctx *ctx = data;
2466 struct dl *dl = ctx->dl;
2467 int nla_type;
2468 int err;
2469
2470 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
2471 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
2472 !tb[DEVLINK_ATTR_PARAM])
2473 return MNL_CB_ERROR;
2474
2475 err = mnl_attr_parse_nested(tb[DEVLINK_ATTR_PARAM], attr_cb, nla_param);
2476 if (err != MNL_CB_OK)
2477 return MNL_CB_ERROR;
2478
2479 if (!nla_param[DEVLINK_ATTR_PARAM_TYPE] ||
2480 !nla_param[DEVLINK_ATTR_PARAM_VALUES_LIST])
2481 return MNL_CB_ERROR;
2482
2483 nla_type = mnl_attr_get_u8(nla_param[DEVLINK_ATTR_PARAM_TYPE]);
2484 mnl_attr_for_each_nested(param_value_attr,
2485 nla_param[DEVLINK_ATTR_PARAM_VALUES_LIST]) {
2486 struct nlattr *nla_value[DEVLINK_ATTR_MAX + 1] = {};
2487 struct nlattr *val_attr;
2488
2489 err = mnl_attr_parse_nested(param_value_attr,
2490 attr_cb, nla_value);
2491 if (err != MNL_CB_OK)
2492 return MNL_CB_ERROR;
2493
2494 if (!nla_value[DEVLINK_ATTR_PARAM_VALUE_CMODE] ||
2495 (nla_type != MNL_TYPE_FLAG &&
2496 !nla_value[DEVLINK_ATTR_PARAM_VALUE_DATA]))
2497 return MNL_CB_ERROR;
2498
2499 cmode = mnl_attr_get_u8(nla_value[DEVLINK_ATTR_PARAM_VALUE_CMODE]);
2500 if (cmode == dl->opts.cmode) {
2501 val_attr = nla_value[DEVLINK_ATTR_PARAM_VALUE_DATA];
2502 switch (nla_type) {
2503 case MNL_TYPE_U8:
2504 ctx->value.vu8 = mnl_attr_get_u8(val_attr);
2505 break;
2506 case MNL_TYPE_U16:
2507 ctx->value.vu16 = mnl_attr_get_u16(val_attr);
2508 break;
2509 case MNL_TYPE_U32:
2510 ctx->value.vu32 = mnl_attr_get_u32(val_attr);
2511 break;
2512 case MNL_TYPE_STRING:
2513 ctx->value.vstr = mnl_attr_get_str(val_attr);
2514 break;
2515 case MNL_TYPE_FLAG:
2516 ctx->value.vbool = val_attr ? true : false;
2517 break;
2518 }
2519 break;
2520 }
2521 }
2522 ctx->nla_type = nla_type;
2523 return MNL_CB_OK;
2524 }
2525
2526 static int cmd_dev_param_set(struct dl *dl)
2527 {
2528 struct param_ctx ctx = {};
2529 struct nlmsghdr *nlh;
2530 bool conv_exists;
2531 uint32_t val_u32;
2532 uint16_t val_u16;
2533 uint8_t val_u8;
2534 bool val_bool;
2535 int err;
2536
2537 err = dl_argv_parse(dl, DL_OPT_HANDLE |
2538 DL_OPT_PARAM_NAME |
2539 DL_OPT_PARAM_VALUE |
2540 DL_OPT_PARAM_CMODE, 0);
2541 if (err)
2542 return err;
2543
2544 /* Get value type */
2545 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PARAM_GET,
2546 NLM_F_REQUEST | NLM_F_ACK);
2547 dl_opts_put(nlh, dl);
2548
2549 ctx.dl = dl;
2550 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dev_param_set_cb, &ctx);
2551 if (err)
2552 return err;
2553
2554 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PARAM_SET,
2555 NLM_F_REQUEST | NLM_F_ACK);
2556 dl_opts_put(nlh, dl);
2557
2558 conv_exists = param_val_conv_exists(param_val_conv, PARAM_VAL_CONV_LEN,
2559 dl->opts.param_name);
2560
2561 mnl_attr_put_u8(nlh, DEVLINK_ATTR_PARAM_TYPE, ctx.nla_type);
2562 switch (ctx.nla_type) {
2563 case MNL_TYPE_U8:
2564 if (conv_exists) {
2565 err = param_val_conv_uint_get(param_val_conv,
2566 PARAM_VAL_CONV_LEN,
2567 dl->opts.param_name,
2568 dl->opts.param_value,
2569 &val_u32);
2570 val_u8 = val_u32;
2571 } else {
2572 err = strtouint8_t(dl->opts.param_value, &val_u8);
2573 }
2574 if (err)
2575 goto err_param_value_parse;
2576 if (val_u8 == ctx.value.vu8)
2577 return 0;
2578 mnl_attr_put_u8(nlh, DEVLINK_ATTR_PARAM_VALUE_DATA, val_u8);
2579 break;
2580 case MNL_TYPE_U16:
2581 if (conv_exists) {
2582 err = param_val_conv_uint_get(param_val_conv,
2583 PARAM_VAL_CONV_LEN,
2584 dl->opts.param_name,
2585 dl->opts.param_value,
2586 &val_u32);
2587 val_u16 = val_u32;
2588 } else {
2589 err = strtouint16_t(dl->opts.param_value, &val_u16);
2590 }
2591 if (err)
2592 goto err_param_value_parse;
2593 if (val_u16 == ctx.value.vu16)
2594 return 0;
2595 mnl_attr_put_u16(nlh, DEVLINK_ATTR_PARAM_VALUE_DATA, val_u16);
2596 break;
2597 case MNL_TYPE_U32:
2598 if (conv_exists)
2599 err = param_val_conv_uint_get(param_val_conv,
2600 PARAM_VAL_CONV_LEN,
2601 dl->opts.param_name,
2602 dl->opts.param_value,
2603 &val_u32);
2604 else
2605 err = strtouint32_t(dl->opts.param_value, &val_u32);
2606 if (err)
2607 goto err_param_value_parse;
2608 if (val_u32 == ctx.value.vu32)
2609 return 0;
2610 mnl_attr_put_u32(nlh, DEVLINK_ATTR_PARAM_VALUE_DATA, val_u32);
2611 break;
2612 case MNL_TYPE_FLAG:
2613 err = strtobool(dl->opts.param_value, &val_bool);
2614 if (err)
2615 goto err_param_value_parse;
2616 if (val_bool == ctx.value.vbool)
2617 return 0;
2618 if (val_bool)
2619 mnl_attr_put(nlh, DEVLINK_ATTR_PARAM_VALUE_DATA,
2620 0, NULL);
2621 break;
2622 case MNL_TYPE_STRING:
2623 mnl_attr_put_strz(nlh, DEVLINK_ATTR_PARAM_VALUE_DATA,
2624 dl->opts.param_value);
2625 if (!strcmp(dl->opts.param_value, ctx.value.vstr))
2626 return 0;
2627 break;
2628 default:
2629 printf("Value type not supported\n");
2630 return -ENOTSUP;
2631 }
2632 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
2633
2634 err_param_value_parse:
2635 pr_err("Value \"%s\" is not a number or not within range\n",
2636 dl->opts.param_value);
2637 return err;
2638 }
2639
2640 static int cmd_dev_param_show(struct dl *dl)
2641 {
2642 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
2643 struct nlmsghdr *nlh;
2644 int err;
2645
2646 if (dl_argc(dl) == 0)
2647 flags |= NLM_F_DUMP;
2648
2649 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PARAM_GET, flags);
2650
2651 if (dl_argc(dl) > 0) {
2652 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE |
2653 DL_OPT_PARAM_NAME, 0);
2654 if (err)
2655 return err;
2656 }
2657
2658 pr_out_section_start(dl, "param");
2659 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dev_param_show_cb, dl);
2660 pr_out_section_end(dl);
2661 return err;
2662 }
2663
2664 static int cmd_dev_param(struct dl *dl)
2665 {
2666 if (dl_argv_match(dl, "help")) {
2667 cmd_dev_help();
2668 return 0;
2669 } else if (dl_argv_match(dl, "show") ||
2670 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
2671 dl_arg_inc(dl);
2672 return cmd_dev_param_show(dl);
2673 } else if (dl_argv_match(dl, "set")) {
2674 dl_arg_inc(dl);
2675 return cmd_dev_param_set(dl);
2676 }
2677 pr_err("Command \"%s\" not found\n", dl_argv(dl));
2678 return -ENOENT;
2679 }
2680 static int cmd_dev_show_cb(const struct nlmsghdr *nlh, void *data)
2681 {
2682 struct dl *dl = data;
2683 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
2684 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
2685
2686 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
2687 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME])
2688 return MNL_CB_ERROR;
2689 pr_out_dev(dl, tb);
2690 return MNL_CB_OK;
2691 }
2692
2693 static int cmd_dev_show(struct dl *dl)
2694 {
2695 struct nlmsghdr *nlh;
2696 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
2697 int err;
2698
2699 if (dl_argc(dl) == 0)
2700 flags |= NLM_F_DUMP;
2701
2702 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_GET, flags);
2703
2704 if (dl_argc(dl) > 0) {
2705 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, 0);
2706 if (err)
2707 return err;
2708 }
2709
2710 pr_out_section_start(dl, "dev");
2711 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dev_show_cb, dl);
2712 pr_out_section_end(dl);
2713 return err;
2714 }
2715
2716 static void cmd_dev_reload_help(void)
2717 {
2718 pr_err("Usage: devlink dev reload [ DEV ]\n");
2719 }
2720
2721 static int cmd_dev_reload(struct dl *dl)
2722 {
2723 struct nlmsghdr *nlh;
2724 int err;
2725
2726 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
2727 cmd_dev_reload_help();
2728 return 0;
2729 }
2730
2731 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_RELOAD,
2732 NLM_F_REQUEST | NLM_F_ACK);
2733
2734 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, 0);
2735 if (err)
2736 return err;
2737
2738 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
2739 }
2740
2741 static void pr_out_versions_single(struct dl *dl, const struct nlmsghdr *nlh,
2742 const char *name, int type)
2743 {
2744 struct nlattr *version;
2745
2746 mnl_attr_for_each(version, nlh, sizeof(struct genlmsghdr)) {
2747 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
2748 const char *ver_value;
2749 const char *ver_name;
2750 int err;
2751
2752 if (mnl_attr_get_type(version) != type)
2753 continue;
2754
2755 err = mnl_attr_parse_nested(version, attr_cb, tb);
2756 if (err != MNL_CB_OK)
2757 continue;
2758
2759 if (!tb[DEVLINK_ATTR_INFO_VERSION_NAME] ||
2760 !tb[DEVLINK_ATTR_INFO_VERSION_VALUE])
2761 continue;
2762
2763 if (name) {
2764 pr_out_object_start(dl, name);
2765 name = NULL;
2766 }
2767
2768 ver_name = mnl_attr_get_str(tb[DEVLINK_ATTR_INFO_VERSION_NAME]);
2769 ver_value = mnl_attr_get_str(tb[DEVLINK_ATTR_INFO_VERSION_VALUE]);
2770
2771 pr_out_str(dl, ver_name, ver_value);
2772 if (!dl->json_output)
2773 __pr_out_newline();
2774 }
2775
2776 if (!name)
2777 pr_out_object_end(dl);
2778 }
2779
2780 static void pr_out_info(struct dl *dl, const struct nlmsghdr *nlh,
2781 struct nlattr **tb, bool has_versions)
2782 {
2783 __pr_out_handle_start(dl, tb, true, false);
2784
2785 __pr_out_indent_inc();
2786 if (tb[DEVLINK_ATTR_INFO_DRIVER_NAME]) {
2787 struct nlattr *nla_drv = tb[DEVLINK_ATTR_INFO_DRIVER_NAME];
2788
2789 if (!dl->json_output)
2790 __pr_out_newline();
2791 pr_out_str(dl, "driver", mnl_attr_get_str(nla_drv));
2792 }
2793
2794 if (tb[DEVLINK_ATTR_INFO_SERIAL_NUMBER]) {
2795 struct nlattr *nla_sn = tb[DEVLINK_ATTR_INFO_SERIAL_NUMBER];
2796
2797 if (!dl->json_output)
2798 __pr_out_newline();
2799 pr_out_str(dl, "serial_number", mnl_attr_get_str(nla_sn));
2800 }
2801 __pr_out_indent_dec();
2802
2803 if (has_versions) {
2804 pr_out_object_start(dl, "versions");
2805
2806 pr_out_versions_single(dl, nlh, "fixed",
2807 DEVLINK_ATTR_INFO_VERSION_FIXED);
2808 pr_out_versions_single(dl, nlh, "running",
2809 DEVLINK_ATTR_INFO_VERSION_RUNNING);
2810 pr_out_versions_single(dl, nlh, "stored",
2811 DEVLINK_ATTR_INFO_VERSION_STORED);
2812
2813 pr_out_object_end(dl);
2814 }
2815
2816 pr_out_handle_end(dl);
2817 }
2818
2819 static int cmd_versions_show_cb(const struct nlmsghdr *nlh, void *data)
2820 {
2821 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
2822 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
2823 bool has_versions, has_info;
2824 struct dl *dl = data;
2825
2826 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
2827
2828 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME])
2829 return MNL_CB_ERROR;
2830
2831 has_versions = tb[DEVLINK_ATTR_INFO_VERSION_FIXED] ||
2832 tb[DEVLINK_ATTR_INFO_VERSION_RUNNING] ||
2833 tb[DEVLINK_ATTR_INFO_VERSION_STORED];
2834 has_info = tb[DEVLINK_ATTR_INFO_DRIVER_NAME] ||
2835 tb[DEVLINK_ATTR_INFO_SERIAL_NUMBER] ||
2836 has_versions;
2837
2838 if (has_info)
2839 pr_out_info(dl, nlh, tb, has_versions);
2840
2841 return MNL_CB_OK;
2842 }
2843
2844 static void cmd_dev_info_help(void)
2845 {
2846 pr_err("Usage: devlink dev info [ DEV ]\n");
2847 }
2848
2849 static int cmd_dev_info(struct dl *dl)
2850 {
2851 struct nlmsghdr *nlh;
2852 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
2853 int err;
2854
2855 if (dl_argv_match(dl, "help")) {
2856 cmd_dev_info_help();
2857 return 0;
2858 }
2859
2860 if (dl_argc(dl) == 0)
2861 flags |= NLM_F_DUMP;
2862
2863 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_INFO_GET, flags);
2864
2865 if (dl_argc(dl) > 0) {
2866 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, 0);
2867 if (err)
2868 return err;
2869 }
2870
2871 pr_out_section_start(dl, "info");
2872 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_versions_show_cb, dl);
2873 pr_out_section_end(dl);
2874 return err;
2875 }
2876
2877 static void cmd_dev_flash_help(void)
2878 {
2879 pr_err("Usage: devlink dev flash DEV file PATH [ component NAME ]\n");
2880 }
2881
2882
2883 struct cmd_dev_flash_status_ctx {
2884 struct dl *dl;
2885 char *last_msg;
2886 char *last_component;
2887 uint8_t not_first:1,
2888 last_pc:1,
2889 received_end:1,
2890 flash_done:1;
2891 };
2892
2893 static int nullstrcmp(const char *str1, const char *str2)
2894 {
2895 if (str1 && str2)
2896 return strcmp(str1, str2);
2897 if (!str1 && !str2)
2898 return 0;
2899 return str1 ? 1 : -1;
2900 }
2901
2902 static int cmd_dev_flash_status_cb(const struct nlmsghdr *nlh, void *data)
2903 {
2904 struct cmd_dev_flash_status_ctx *ctx = data;
2905 struct dl_opts *opts = &ctx->dl->opts;
2906 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
2907 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
2908 const char *component = NULL;
2909 uint64_t done = 0, total = 0;
2910 const char *msg = NULL;
2911 const char *bus_name;
2912 const char *dev_name;
2913
2914 if (genl->cmd != DEVLINK_CMD_FLASH_UPDATE_STATUS &&
2915 genl->cmd != DEVLINK_CMD_FLASH_UPDATE_END)
2916 return MNL_CB_STOP;
2917
2918 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
2919 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME])
2920 return MNL_CB_ERROR;
2921 bus_name = mnl_attr_get_str(tb[DEVLINK_ATTR_BUS_NAME]);
2922 dev_name = mnl_attr_get_str(tb[DEVLINK_ATTR_DEV_NAME]);
2923 if (strcmp(bus_name, opts->bus_name) ||
2924 strcmp(dev_name, opts->dev_name))
2925 return MNL_CB_ERROR;
2926
2927 if (genl->cmd == DEVLINK_CMD_FLASH_UPDATE_END && ctx->not_first) {
2928 pr_out("\n");
2929 free(ctx->last_msg);
2930 free(ctx->last_component);
2931 ctx->received_end = 1;
2932 return MNL_CB_STOP;
2933 }
2934
2935 if (tb[DEVLINK_ATTR_FLASH_UPDATE_STATUS_MSG])
2936 msg = mnl_attr_get_str(tb[DEVLINK_ATTR_FLASH_UPDATE_STATUS_MSG]);
2937 if (tb[DEVLINK_ATTR_FLASH_UPDATE_COMPONENT])
2938 component = mnl_attr_get_str(tb[DEVLINK_ATTR_FLASH_UPDATE_COMPONENT]);
2939 if (tb[DEVLINK_ATTR_FLASH_UPDATE_STATUS_DONE])
2940 done = mnl_attr_get_u64(tb[DEVLINK_ATTR_FLASH_UPDATE_STATUS_DONE]);
2941 if (tb[DEVLINK_ATTR_FLASH_UPDATE_STATUS_TOTAL])
2942 total = mnl_attr_get_u64(tb[DEVLINK_ATTR_FLASH_UPDATE_STATUS_TOTAL]);
2943
2944 if (!nullstrcmp(msg, ctx->last_msg) &&
2945 !nullstrcmp(component, ctx->last_component) &&
2946 ctx->last_pc && ctx->not_first) {
2947 pr_out_tty("\b\b\b\b\b"); /* clean percentage */
2948 } else {
2949 if (ctx->not_first)
2950 pr_out("\n");
2951 if (component) {
2952 pr_out("[%s] ", component);
2953 free(ctx->last_component);
2954 ctx->last_component = strdup(component);
2955 }
2956 if (msg) {
2957 pr_out("%s", msg);
2958 free(ctx->last_msg);
2959 ctx->last_msg = strdup(msg);
2960 }
2961 }
2962 if (total) {
2963 pr_out_tty(" %3lu%%", (done * 100) / total);
2964 ctx->last_pc = 1;
2965 } else {
2966 ctx->last_pc = 0;
2967 }
2968 fflush(stdout);
2969 ctx->not_first = 1;
2970
2971 return MNL_CB_STOP;
2972 }
2973
2974 static int cmd_dev_flash_fds_process(struct cmd_dev_flash_status_ctx *ctx,
2975 struct mnlg_socket *nlg_ntf,
2976 int pipe_r)
2977 {
2978 int nlfd = mnlg_socket_get_fd(nlg_ntf);
2979 fd_set fds[3];
2980 int fdmax;
2981 int i;
2982 int err;
2983 int err2;
2984
2985 for (i = 0; i < 3; i++)
2986 FD_ZERO(&fds[i]);
2987 FD_SET(pipe_r, &fds[0]);
2988 fdmax = pipe_r + 1;
2989 FD_SET(nlfd, &fds[0]);
2990 if (nlfd >= fdmax)
2991 fdmax = nlfd + 1;
2992
2993 while (select(fdmax, &fds[0], &fds[1], &fds[2], NULL) < 0) {
2994 if (errno == EINTR)
2995 continue;
2996 pr_err("select() failed\n");
2997 return -errno;
2998 }
2999 if (FD_ISSET(nlfd, &fds[0])) {
3000 err = _mnlg_socket_recv_run(nlg_ntf,
3001 cmd_dev_flash_status_cb, ctx);
3002 if (err)
3003 return err;
3004 }
3005 if (FD_ISSET(pipe_r, &fds[0])) {
3006 err = read(pipe_r, &err2, sizeof(err2));
3007 if (err == -1) {
3008 pr_err("Failed to read pipe\n");
3009 return -errno;
3010 }
3011 if (err2)
3012 return err2;
3013 ctx->flash_done = 1;
3014 }
3015 return 0;
3016 }
3017
3018
3019 static int cmd_dev_flash(struct dl *dl)
3020 {
3021 struct cmd_dev_flash_status_ctx ctx = {.dl = dl,};
3022 struct mnlg_socket *nlg_ntf;
3023 struct nlmsghdr *nlh;
3024 int pipe_r, pipe_w;
3025 int pipe_fds[2];
3026 pid_t pid;
3027 int err;
3028
3029 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
3030 cmd_dev_flash_help();
3031 return 0;
3032 }
3033
3034 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_FLASH_UPDATE,
3035 NLM_F_REQUEST | NLM_F_ACK);
3036
3037 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE | DL_OPT_FLASH_FILE_NAME,
3038 DL_OPT_FLASH_COMPONENT);
3039 if (err)
3040 return err;
3041
3042 nlg_ntf = mnlg_socket_open(DEVLINK_GENL_NAME, DEVLINK_GENL_VERSION);
3043 if (!nlg_ntf)
3044 return err;
3045
3046 err = _mnlg_socket_group_add(nlg_ntf, DEVLINK_GENL_MCGRP_CONFIG_NAME);
3047 if (err)
3048 return err;
3049
3050 err = pipe(pipe_fds);
3051 if (err == -1)
3052 return -errno;
3053 pipe_r = pipe_fds[0];
3054 pipe_w = pipe_fds[1];
3055
3056 pid = fork();
3057 if (pid == -1) {
3058 close(pipe_r);
3059 close(pipe_w);
3060 return -errno;
3061 } else if (!pid) {
3062 /* In child, just execute the flash and pass returned
3063 * value through pipe once it is done.
3064 */
3065 close(pipe_r);
3066 err = _mnlg_socket_send(dl->nlg, nlh);
3067 write(pipe_w, &err, sizeof(err));
3068 close(pipe_w);
3069 exit(0);
3070 }
3071 close(pipe_w);
3072
3073 do {
3074 err = cmd_dev_flash_fds_process(&ctx, nlg_ntf, pipe_r);
3075 if (err)
3076 goto out;
3077 } while (!ctx.flash_done || (ctx.not_first && !ctx.received_end));
3078
3079 err = _mnlg_socket_recv_run(dl->nlg, NULL, NULL);
3080 out:
3081 close(pipe_r);
3082 mnlg_socket_close(nlg_ntf);
3083 return err;
3084 }
3085
3086 static int cmd_dev(struct dl *dl)
3087 {
3088 if (dl_argv_match(dl, "help")) {
3089 cmd_dev_help();
3090 return 0;
3091 } else if (dl_argv_match(dl, "show") ||
3092 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
3093 dl_arg_inc(dl);
3094 return cmd_dev_show(dl);
3095 } else if (dl_argv_match(dl, "eswitch")) {
3096 dl_arg_inc(dl);
3097 return cmd_dev_eswitch(dl);
3098 } else if (dl_argv_match(dl, "reload")) {
3099 dl_arg_inc(dl);
3100 return cmd_dev_reload(dl);
3101 } else if (dl_argv_match(dl, "param")) {
3102 dl_arg_inc(dl);
3103 return cmd_dev_param(dl);
3104 } else if (dl_argv_match(dl, "info")) {
3105 dl_arg_inc(dl);
3106 return cmd_dev_info(dl);
3107 } else if (dl_argv_match(dl, "flash")) {
3108 dl_arg_inc(dl);
3109 return cmd_dev_flash(dl);
3110 }
3111 pr_err("Command \"%s\" not found\n", dl_argv(dl));
3112 return -ENOENT;
3113 }
3114
3115 static void cmd_port_help(void)
3116 {
3117 pr_err("Usage: devlink port show [ DEV/PORT_INDEX ]\n");
3118 pr_err(" devlink port set DEV/PORT_INDEX [ type { eth | ib | auto} ]\n");
3119 pr_err(" devlink port split DEV/PORT_INDEX count COUNT\n");
3120 pr_err(" devlink port unsplit DEV/PORT_INDEX\n");
3121 }
3122
3123 static const char *port_type_name(uint32_t type)
3124 {
3125 switch (type) {
3126 case DEVLINK_PORT_TYPE_NOTSET: return "notset";
3127 case DEVLINK_PORT_TYPE_AUTO: return "auto";
3128 case DEVLINK_PORT_TYPE_ETH: return "eth";
3129 case DEVLINK_PORT_TYPE_IB: return "ib";
3130 default: return "<unknown type>";
3131 }
3132 }
3133
3134 static const char *port_flavour_name(uint16_t flavour)
3135 {
3136 switch (flavour) {
3137 case DEVLINK_PORT_FLAVOUR_PHYSICAL:
3138 return "physical";
3139 case DEVLINK_PORT_FLAVOUR_CPU:
3140 return "cpu";
3141 case DEVLINK_PORT_FLAVOUR_DSA:
3142 return "dsa";
3143 case DEVLINK_PORT_FLAVOUR_PCI_PF:
3144 return "pcipf";
3145 case DEVLINK_PORT_FLAVOUR_PCI_VF:
3146 return "pcivf";
3147 default:
3148 return "<unknown flavour>";
3149 }
3150 }
3151
3152 static void pr_out_port_pfvf_num(struct dl *dl, struct nlattr **tb)
3153 {
3154 uint16_t fn_num;
3155
3156 if (tb[DEVLINK_ATTR_PORT_PCI_PF_NUMBER]) {
3157 fn_num = mnl_attr_get_u16(tb[DEVLINK_ATTR_PORT_PCI_PF_NUMBER]);
3158 pr_out_uint(dl, "pfnum", fn_num);
3159 }
3160 if (tb[DEVLINK_ATTR_PORT_PCI_VF_NUMBER]) {
3161 fn_num = mnl_attr_get_u16(tb[DEVLINK_ATTR_PORT_PCI_VF_NUMBER]);
3162 pr_out_uint(dl, "vfnum", fn_num);
3163 }
3164 }
3165
3166 static void pr_out_port(struct dl *dl, struct nlattr **tb)
3167 {
3168 struct nlattr *pt_attr = tb[DEVLINK_ATTR_PORT_TYPE];
3169 struct nlattr *dpt_attr = tb[DEVLINK_ATTR_PORT_DESIRED_TYPE];
3170
3171 pr_out_port_handle_start(dl, tb, false);
3172 if (pt_attr) {
3173 uint16_t port_type = mnl_attr_get_u16(pt_attr);
3174
3175 pr_out_str(dl, "type", port_type_name(port_type));
3176 if (dpt_attr) {
3177 uint16_t des_port_type = mnl_attr_get_u16(dpt_attr);
3178
3179 if (port_type != des_port_type)
3180 pr_out_str(dl, "des_type",
3181 port_type_name(des_port_type));
3182 }
3183 }
3184 if (tb[DEVLINK_ATTR_PORT_NETDEV_NAME])
3185 pr_out_str(dl, "netdev",
3186 mnl_attr_get_str(tb[DEVLINK_ATTR_PORT_NETDEV_NAME]));
3187 if (tb[DEVLINK_ATTR_PORT_IBDEV_NAME])
3188 pr_out_str(dl, "ibdev",
3189 mnl_attr_get_str(tb[DEVLINK_ATTR_PORT_IBDEV_NAME]));
3190 if (tb[DEVLINK_ATTR_PORT_FLAVOUR]) {
3191 uint16_t port_flavour =
3192 mnl_attr_get_u16(tb[DEVLINK_ATTR_PORT_FLAVOUR]);
3193
3194 pr_out_str(dl, "flavour", port_flavour_name(port_flavour));
3195
3196 switch (port_flavour) {
3197 case DEVLINK_PORT_FLAVOUR_PCI_PF:
3198 case DEVLINK_PORT_FLAVOUR_PCI_VF:
3199 pr_out_port_pfvf_num(dl, tb);
3200 break;
3201 default:
3202 break;
3203 }
3204 }
3205 if (tb[DEVLINK_ATTR_PORT_NUMBER]) {
3206 uint32_t port_number;
3207
3208 port_number = mnl_attr_get_u32(tb[DEVLINK_ATTR_PORT_NUMBER]);
3209 pr_out_uint(dl, "port", port_number);
3210 }
3211 if (tb[DEVLINK_ATTR_PORT_SPLIT_GROUP])
3212 pr_out_uint(dl, "split_group",
3213 mnl_attr_get_u32(tb[DEVLINK_ATTR_PORT_SPLIT_GROUP]));
3214 pr_out_port_handle_end(dl);
3215 }
3216
3217 static int cmd_port_show_cb(const struct nlmsghdr *nlh, void *data)
3218 {
3219 struct dl *dl = data;
3220 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
3221 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
3222
3223 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
3224 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
3225 !tb[DEVLINK_ATTR_PORT_INDEX])
3226 return MNL_CB_ERROR;
3227 pr_out_port(dl, tb);
3228 return MNL_CB_OK;
3229 }
3230
3231 static int cmd_port_show(struct dl *dl)
3232 {
3233 struct nlmsghdr *nlh;
3234 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
3235 int err;
3236
3237 if (dl_argc(dl) == 0)
3238 flags |= NLM_F_DUMP;
3239
3240 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PORT_GET, flags);
3241
3242 if (dl_argc(dl) > 0) {
3243 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP, 0);
3244 if (err)
3245 return err;
3246 }
3247
3248 pr_out_section_start(dl, "port");
3249 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_port_show_cb, dl);
3250 pr_out_section_end(dl);
3251 return err;
3252 }
3253
3254 static int cmd_port_set(struct dl *dl)
3255 {
3256 struct nlmsghdr *nlh;
3257 int err;
3258
3259 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PORT_SET,
3260 NLM_F_REQUEST | NLM_F_ACK);
3261
3262 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP | DL_OPT_PORT_TYPE, 0);
3263 if (err)
3264 return err;
3265
3266 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
3267 }
3268
3269 static int cmd_port_split(struct dl *dl)
3270 {
3271 struct nlmsghdr *nlh;
3272 int err;
3273
3274 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PORT_SPLIT,
3275 NLM_F_REQUEST | NLM_F_ACK);
3276
3277 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP | DL_OPT_PORT_COUNT, 0);
3278 if (err)
3279 return err;
3280
3281 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
3282 }
3283
3284 static int cmd_port_unsplit(struct dl *dl)
3285 {
3286 struct nlmsghdr *nlh;
3287 int err;
3288
3289 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PORT_UNSPLIT,
3290 NLM_F_REQUEST | NLM_F_ACK);
3291
3292 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP, 0);
3293 if (err)
3294 return err;
3295
3296 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
3297 }
3298
3299 static int cmd_port(struct dl *dl)
3300 {
3301 if (dl_argv_match(dl, "help")) {
3302 cmd_port_help();
3303 return 0;
3304 } else if (dl_argv_match(dl, "show") ||
3305 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
3306 dl_arg_inc(dl);
3307 return cmd_port_show(dl);
3308 } else if (dl_argv_match(dl, "set")) {
3309 dl_arg_inc(dl);
3310 return cmd_port_set(dl);
3311 } else if (dl_argv_match(dl, "split")) {
3312 dl_arg_inc(dl);
3313 return cmd_port_split(dl);
3314 } else if (dl_argv_match(dl, "unsplit")) {
3315 dl_arg_inc(dl);
3316 return cmd_port_unsplit(dl);
3317 }
3318 pr_err("Command \"%s\" not found\n", dl_argv(dl));
3319 return -ENOENT;
3320 }
3321
3322 static void cmd_sb_help(void)
3323 {
3324 pr_err("Usage: devlink sb show [ DEV [ sb SB_INDEX ] ]\n");
3325 pr_err(" devlink sb pool show [ DEV [ sb SB_INDEX ] pool POOL_INDEX ]\n");
3326 pr_err(" devlink sb pool set DEV [ sb SB_INDEX ] pool POOL_INDEX\n");
3327 pr_err(" size POOL_SIZE thtype { static | dynamic }\n");
3328 pr_err(" devlink sb port pool show [ DEV/PORT_INDEX [ sb SB_INDEX ]\n");
3329 pr_err(" pool POOL_INDEX ]\n");
3330 pr_err(" devlink sb port pool set DEV/PORT_INDEX [ sb SB_INDEX ]\n");
3331 pr_err(" pool POOL_INDEX th THRESHOLD\n");
3332 pr_err(" devlink sb tc bind show [ DEV/PORT_INDEX [ sb SB_INDEX ] tc TC_INDEX\n");
3333 pr_err(" type { ingress | egress } ]\n");
3334 pr_err(" devlink sb tc bind set DEV/PORT_INDEX [ sb SB_INDEX ] tc TC_INDEX\n");
3335 pr_err(" type { ingress | egress } pool POOL_INDEX\n");
3336 pr_err(" th THRESHOLD\n");
3337 pr_err(" devlink sb occupancy show { DEV | DEV/PORT_INDEX } [ sb SB_INDEX ]\n");
3338 pr_err(" devlink sb occupancy snapshot DEV [ sb SB_INDEX ]\n");
3339 pr_err(" devlink sb occupancy clearmax DEV [ sb SB_INDEX ]\n");
3340 }
3341
3342 static void pr_out_sb(struct dl *dl, struct nlattr **tb)
3343 {
3344 pr_out_handle_start_arr(dl, tb);
3345 pr_out_uint(dl, "sb",
3346 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_INDEX]));
3347 pr_out_uint(dl, "size",
3348 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_SIZE]));
3349 pr_out_uint(dl, "ing_pools",
3350 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_INGRESS_POOL_COUNT]));
3351 pr_out_uint(dl, "eg_pools",
3352 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_EGRESS_POOL_COUNT]));
3353 pr_out_uint(dl, "ing_tcs",
3354 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_INGRESS_TC_COUNT]));
3355 pr_out_uint(dl, "eg_tcs",
3356 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_EGRESS_TC_COUNT]));
3357 pr_out_handle_end(dl);
3358 }
3359
3360 static int cmd_sb_show_cb(const struct nlmsghdr *nlh, void *data)
3361 {
3362 struct dl *dl = data;
3363 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
3364 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
3365
3366 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
3367 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
3368 !tb[DEVLINK_ATTR_SB_INDEX] || !tb[DEVLINK_ATTR_SB_SIZE] ||
3369 !tb[DEVLINK_ATTR_SB_INGRESS_POOL_COUNT] ||
3370 !tb[DEVLINK_ATTR_SB_EGRESS_POOL_COUNT] ||
3371 !tb[DEVLINK_ATTR_SB_INGRESS_TC_COUNT] ||
3372 !tb[DEVLINK_ATTR_SB_EGRESS_TC_COUNT])
3373 return MNL_CB_ERROR;
3374 pr_out_sb(dl, tb);
3375 return MNL_CB_OK;
3376 }
3377
3378 static int cmd_sb_show(struct dl *dl)
3379 {
3380 struct nlmsghdr *nlh;
3381 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
3382 int err;
3383
3384 if (dl_argc(dl) == 0)
3385 flags |= NLM_F_DUMP;
3386
3387 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_GET, flags);
3388
3389 if (dl_argc(dl) > 0) {
3390 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, DL_OPT_SB);
3391 if (err)
3392 return err;
3393 }
3394
3395 pr_out_section_start(dl, "sb");
3396 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_sb_show_cb, dl);
3397 pr_out_section_end(dl);
3398 return err;
3399 }
3400
3401 static const char *pool_type_name(uint8_t type)
3402 {
3403 switch (type) {
3404 case DEVLINK_SB_POOL_TYPE_INGRESS: return "ingress";
3405 case DEVLINK_SB_POOL_TYPE_EGRESS: return "egress";
3406 default: return "<unknown type>";
3407 }
3408 }
3409
3410 static const char *threshold_type_name(uint8_t type)
3411 {
3412 switch (type) {
3413 case DEVLINK_SB_THRESHOLD_TYPE_STATIC: return "static";
3414 case DEVLINK_SB_THRESHOLD_TYPE_DYNAMIC: return "dynamic";
3415 default: return "<unknown type>";
3416 }
3417 }
3418
3419 static void pr_out_sb_pool(struct dl *dl, struct nlattr **tb)
3420 {
3421 pr_out_handle_start_arr(dl, tb);
3422 pr_out_uint(dl, "sb",
3423 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_INDEX]));
3424 pr_out_uint(dl, "pool",
3425 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_POOL_INDEX]));
3426 pr_out_str(dl, "type",
3427 pool_type_name(mnl_attr_get_u8(tb[DEVLINK_ATTR_SB_POOL_TYPE])));
3428 pr_out_uint(dl, "size",
3429 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_POOL_SIZE]));
3430 pr_out_str(dl, "thtype",
3431 threshold_type_name(mnl_attr_get_u8(tb[DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE])));
3432 if (tb[DEVLINK_ATTR_SB_POOL_CELL_SIZE])
3433 pr_out_uint(dl, "cell_size",
3434 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_POOL_CELL_SIZE]));
3435 pr_out_handle_end(dl);
3436 }
3437
3438 static int cmd_sb_pool_show_cb(const struct nlmsghdr *nlh, void *data)
3439 {
3440 struct dl *dl = data;
3441 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
3442 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
3443
3444 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
3445 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
3446 !tb[DEVLINK_ATTR_SB_INDEX] || !tb[DEVLINK_ATTR_SB_POOL_INDEX] ||
3447 !tb[DEVLINK_ATTR_SB_POOL_TYPE] || !tb[DEVLINK_ATTR_SB_POOL_SIZE] ||
3448 !tb[DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE])
3449 return MNL_CB_ERROR;
3450 pr_out_sb_pool(dl, tb);
3451 return MNL_CB_OK;
3452 }
3453
3454 static int cmd_sb_pool_show(struct dl *dl)
3455 {
3456 struct nlmsghdr *nlh;
3457 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
3458 int err;
3459
3460 if (dl_argc(dl) == 0)
3461 flags |= NLM_F_DUMP;
3462
3463 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_POOL_GET, flags);
3464
3465 if (dl_argc(dl) > 0) {
3466 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE | DL_OPT_SB_POOL,
3467 DL_OPT_SB);
3468 if (err)
3469 return err;
3470 }
3471
3472 pr_out_section_start(dl, "pool");
3473 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_sb_pool_show_cb, dl);
3474 pr_out_section_end(dl);
3475 return err;
3476 }
3477
3478 static int cmd_sb_pool_set(struct dl *dl)
3479 {
3480 struct nlmsghdr *nlh;
3481 int err;
3482
3483 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_POOL_SET,
3484 NLM_F_REQUEST | NLM_F_ACK);
3485
3486 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE | DL_OPT_SB_POOL |
3487 DL_OPT_SB_SIZE | DL_OPT_SB_THTYPE, DL_OPT_SB);
3488 if (err)
3489 return err;
3490
3491 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
3492 }
3493
3494 static int cmd_sb_pool(struct dl *dl)
3495 {
3496 if (dl_argv_match(dl, "help")) {
3497 cmd_sb_help();
3498 return 0;
3499 } else if (dl_argv_match(dl, "show") ||
3500 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
3501 dl_arg_inc(dl);
3502 return cmd_sb_pool_show(dl);
3503 } else if (dl_argv_match(dl, "set")) {
3504 dl_arg_inc(dl);
3505 return cmd_sb_pool_set(dl);
3506 }
3507 pr_err("Command \"%s\" not found\n", dl_argv(dl));
3508 return -ENOENT;
3509 }
3510
3511 static void pr_out_sb_port_pool(struct dl *dl, struct nlattr **tb)
3512 {
3513 pr_out_port_handle_start_arr(dl, tb, true);
3514 pr_out_uint(dl, "sb",
3515 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_INDEX]));
3516 pr_out_uint(dl, "pool",
3517 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_POOL_INDEX]));
3518 pr_out_uint(dl, "threshold",
3519 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_THRESHOLD]));
3520 pr_out_port_handle_end(dl);
3521 }
3522
3523 static int cmd_sb_port_pool_show_cb(const struct nlmsghdr *nlh, void *data)
3524 {
3525 struct dl *dl = data;
3526 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
3527 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
3528
3529 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
3530 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
3531 !tb[DEVLINK_ATTR_PORT_INDEX] || !tb[DEVLINK_ATTR_SB_INDEX] ||
3532 !tb[DEVLINK_ATTR_SB_POOL_INDEX] || !tb[DEVLINK_ATTR_SB_THRESHOLD])
3533 return MNL_CB_ERROR;
3534 pr_out_sb_port_pool(dl, tb);
3535 return MNL_CB_OK;
3536 }
3537
3538 static int cmd_sb_port_pool_show(struct dl *dl)
3539 {
3540 struct nlmsghdr *nlh;
3541 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
3542 int err;
3543
3544 if (dl_argc(dl) == 0)
3545 flags |= NLM_F_DUMP;
3546
3547 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_PORT_POOL_GET, flags);
3548
3549 if (dl_argc(dl) > 0) {
3550 err = dl_argv_parse_put(nlh, dl,
3551 DL_OPT_HANDLEP | DL_OPT_SB_POOL,
3552 DL_OPT_SB);
3553 if (err)
3554 return err;
3555 }
3556
3557 pr_out_section_start(dl, "port_pool");
3558 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_sb_port_pool_show_cb, dl);
3559 pr_out_section_end(dl);
3560 return 0;
3561 }
3562
3563 static int cmd_sb_port_pool_set(struct dl *dl)
3564 {
3565 struct nlmsghdr *nlh;
3566 int err;
3567
3568 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_PORT_POOL_SET,
3569 NLM_F_REQUEST | NLM_F_ACK);
3570
3571 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP | DL_OPT_SB_POOL |
3572 DL_OPT_SB_TH, DL_OPT_SB);
3573 if (err)
3574 return err;
3575
3576 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
3577 }
3578
3579 static int cmd_sb_port_pool(struct dl *dl)
3580 {
3581 if (dl_argv_match(dl, "help")) {
3582 cmd_sb_help();
3583 return 0;
3584 } else if (dl_argv_match(dl, "show") ||
3585 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
3586 dl_arg_inc(dl);
3587 return cmd_sb_port_pool_show(dl);
3588 } else if (dl_argv_match(dl, "set")) {
3589 dl_arg_inc(dl);
3590 return cmd_sb_port_pool_set(dl);
3591 }
3592 pr_err("Command \"%s\" not found\n", dl_argv(dl));
3593 return -ENOENT;
3594 }
3595
3596 static int cmd_sb_port(struct dl *dl)
3597 {
3598 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
3599 cmd_sb_help();
3600 return 0;
3601 } else if (dl_argv_match(dl, "pool")) {
3602 dl_arg_inc(dl);
3603 return cmd_sb_port_pool(dl);
3604 }
3605 pr_err("Command \"%s\" not found\n", dl_argv(dl));
3606 return -ENOENT;
3607 }
3608
3609 static void pr_out_sb_tc_bind(struct dl *dl, struct nlattr **tb)
3610 {
3611 pr_out_port_handle_start_arr(dl, tb, true);
3612 pr_out_uint(dl, "sb",
3613 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_INDEX]));
3614 pr_out_uint(dl, "tc",
3615 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_TC_INDEX]));
3616 pr_out_str(dl, "type",
3617 pool_type_name(mnl_attr_get_u8(tb[DEVLINK_ATTR_SB_POOL_TYPE])));
3618 pr_out_uint(dl, "pool",
3619 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_POOL_INDEX]));
3620 pr_out_uint(dl, "threshold",
3621 mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_THRESHOLD]));
3622 pr_out_port_handle_end(dl);
3623 }
3624
3625 static int cmd_sb_tc_bind_show_cb(const struct nlmsghdr *nlh, void *data)
3626 {
3627 struct dl *dl = data;
3628 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
3629 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
3630
3631 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
3632 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
3633 !tb[DEVLINK_ATTR_PORT_INDEX] || !tb[DEVLINK_ATTR_SB_INDEX] ||
3634 !tb[DEVLINK_ATTR_SB_TC_INDEX] || !tb[DEVLINK_ATTR_SB_POOL_TYPE] ||
3635 !tb[DEVLINK_ATTR_SB_POOL_INDEX] || !tb[DEVLINK_ATTR_SB_THRESHOLD])
3636 return MNL_CB_ERROR;
3637 pr_out_sb_tc_bind(dl, tb);
3638 return MNL_CB_OK;
3639 }
3640
3641 static int cmd_sb_tc_bind_show(struct dl *dl)
3642 {
3643 struct nlmsghdr *nlh;
3644 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
3645 int err;
3646
3647 if (dl_argc(dl) == 0)
3648 flags |= NLM_F_DUMP;
3649
3650 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_TC_POOL_BIND_GET, flags);
3651
3652 if (dl_argc(dl) > 0) {
3653 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP | DL_OPT_SB_TC |
3654 DL_OPT_SB_TYPE, DL_OPT_SB);
3655 if (err)
3656 return err;
3657 }
3658
3659 pr_out_section_start(dl, "tc_bind");
3660 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_sb_tc_bind_show_cb, dl);
3661 pr_out_section_end(dl);
3662 return err;
3663 }
3664
3665 static int cmd_sb_tc_bind_set(struct dl *dl)
3666 {
3667 struct nlmsghdr *nlh;
3668 int err;
3669
3670 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_TC_POOL_BIND_SET,
3671 NLM_F_REQUEST | NLM_F_ACK);
3672
3673 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP | DL_OPT_SB_TC |
3674 DL_OPT_SB_TYPE | DL_OPT_SB_POOL | DL_OPT_SB_TH,
3675 DL_OPT_SB);
3676 if (err)
3677 return err;
3678
3679 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
3680 }
3681
3682 static int cmd_sb_tc_bind(struct dl *dl)
3683 {
3684 if (dl_argv_match(dl, "help")) {
3685 cmd_sb_help();
3686 return 0;
3687 } else if (dl_argv_match(dl, "show") ||
3688 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
3689 dl_arg_inc(dl);
3690 return cmd_sb_tc_bind_show(dl);
3691 } else if (dl_argv_match(dl, "set")) {
3692 dl_arg_inc(dl);
3693 return cmd_sb_tc_bind_set(dl);
3694 }
3695 pr_err("Command \"%s\" not found\n", dl_argv(dl));
3696 return -ENOENT;
3697 }
3698
3699 static int cmd_sb_tc(struct dl *dl)
3700 {
3701 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
3702 cmd_sb_help();
3703 return 0;
3704 } else if (dl_argv_match(dl, "bind")) {
3705 dl_arg_inc(dl);
3706 return cmd_sb_tc_bind(dl);
3707 }
3708 pr_err("Command \"%s\" not found\n", dl_argv(dl));
3709 return -ENOENT;
3710 }
3711
3712 struct occ_item {
3713 struct list_head list;
3714 uint32_t index;
3715 uint32_t cur;
3716 uint32_t max;
3717 uint32_t bound_pool_index;
3718 };
3719
3720 struct occ_port {
3721 struct list_head list;
3722 char *bus_name;
3723 char *dev_name;
3724 uint32_t port_index;
3725 uint32_t sb_index;
3726 struct list_head pool_list;
3727 struct list_head ing_tc_list;
3728 struct list_head eg_tc_list;
3729 };
3730
3731 struct occ_show {
3732 struct dl *dl;
3733 int err;
3734 struct list_head port_list;
3735 };
3736
3737 static struct occ_item *occ_item_alloc(void)
3738 {
3739 return calloc(1, sizeof(struct occ_item));
3740 }
3741
3742 static void occ_item_free(struct occ_item *occ_item)
3743 {
3744 free(occ_item);
3745 }
3746
3747 static struct occ_port *occ_port_alloc(uint32_t port_index)
3748 {
3749 struct occ_port *occ_port;
3750
3751 occ_port = calloc(1, sizeof(*occ_port));
3752 if (!occ_port)
3753 return NULL;
3754 occ_port->port_index = port_index;
3755 INIT_LIST_HEAD(&occ_port->pool_list);
3756 INIT_LIST_HEAD(&occ_port->ing_tc_list);
3757 INIT_LIST_HEAD(&occ_port->eg_tc_list);
3758 return occ_port;
3759 }
3760
3761 static void occ_port_free(struct occ_port *occ_port)
3762 {
3763 struct occ_item *occ_item, *tmp;
3764
3765 list_for_each_entry_safe(occ_item, tmp, &occ_port->pool_list, list)
3766 occ_item_free(occ_item);
3767 list_for_each_entry_safe(occ_item, tmp, &occ_port->ing_tc_list, list)
3768 occ_item_free(occ_item);
3769 list_for_each_entry_safe(occ_item, tmp, &occ_port->eg_tc_list, list)
3770 occ_item_free(occ_item);
3771 }
3772
3773 static struct occ_show *occ_show_alloc(struct dl *dl)
3774 {
3775 struct occ_show *occ_show;
3776
3777 occ_show = calloc(1, sizeof(*occ_show));
3778 if (!occ_show)
3779 return NULL;
3780 occ_show->dl = dl;
3781 INIT_LIST_HEAD(&occ_show->port_list);
3782 return occ_show;
3783 }
3784
3785 static void occ_show_free(struct occ_show *occ_show)
3786 {
3787 struct occ_port *occ_port, *tmp;
3788
3789 list_for_each_entry_safe(occ_port, tmp, &occ_show->port_list, list)
3790 occ_port_free(occ_port);
3791 }
3792
3793 static struct occ_port *occ_port_get(struct occ_show *occ_show,
3794 struct nlattr **tb)
3795 {
3796 struct occ_port *occ_port;
3797 uint32_t port_index;
3798
3799 port_index = mnl_attr_get_u32(tb[DEVLINK_ATTR_PORT_INDEX]);
3800
3801 list_for_each_entry_reverse(occ_port, &occ_show->port_list, list) {
3802 if (occ_port->port_index == port_index)
3803 return occ_port;
3804 }
3805 occ_port = occ_port_alloc(port_index);
3806 if (!occ_port)
3807 return NULL;
3808 list_add_tail(&occ_port->list, &occ_show->port_list);
3809 return occ_port;
3810 }
3811
3812 static void pr_out_occ_show_item_list(const char *label, struct list_head *list,
3813 bool bound_pool)
3814 {
3815 struct occ_item *occ_item;
3816 int i = 1;
3817
3818 pr_out_sp(7, " %s:", label);
3819 list_for_each_entry(occ_item, list, list) {
3820 if ((i - 1) % 4 == 0 && i != 1)
3821 pr_out_sp(7, " ");
3822 if (bound_pool)
3823 pr_out_sp(7, "%2u(%u):", occ_item->index,
3824 occ_item->bound_pool_index);
3825 else
3826 pr_out_sp(7, "%2u:", occ_item->index);
3827 pr_out_sp(21, "%10u/%u", occ_item->cur, occ_item->max);
3828 if (i++ % 4 == 0)
3829 pr_out("\n");
3830 }
3831 if ((i - 1) % 4 != 0)
3832 pr_out("\n");
3833 }
3834
3835 static void pr_out_json_occ_show_item_list(struct dl *dl, const char *label,
3836 struct list_head *list,
3837 bool bound_pool)
3838 {
3839 struct occ_item *occ_item;
3840 char buf[32];
3841
3842 jsonw_name(dl->jw, label);
3843 jsonw_start_object(dl->jw);
3844 list_for_each_entry(occ_item, list, list) {
3845 sprintf(buf, "%u", occ_item->index);
3846 jsonw_name(dl->jw, buf);
3847 jsonw_start_object(dl->jw);
3848 if (bound_pool)
3849 jsonw_uint_field(dl->jw, "bound_pool",
3850 occ_item->bound_pool_index);
3851 jsonw_uint_field(dl->jw, "current", occ_item->cur);
3852 jsonw_uint_field(dl->jw, "max", occ_item->max);
3853 jsonw_end_object(dl->jw);
3854 }
3855 jsonw_end_object(dl->jw);
3856 }
3857
3858 static void pr_out_occ_show_port(struct dl *dl, struct occ_port *occ_port)
3859 {
3860 if (dl->json_output) {
3861 pr_out_json_occ_show_item_list(dl, "pool",
3862 &occ_port->pool_list, false);
3863 pr_out_json_occ_show_item_list(dl, "itc",
3864 &occ_port->ing_tc_list, true);
3865 pr_out_json_occ_show_item_list(dl, "etc",
3866 &occ_port->eg_tc_list, true);
3867 } else {
3868 pr_out("\n");
3869 pr_out_occ_show_item_list("pool", &occ_port->pool_list, false);
3870 pr_out_occ_show_item_list("itc", &occ_port->ing_tc_list, true);
3871 pr_out_occ_show_item_list("etc", &occ_port->eg_tc_list, true);
3872 }
3873 }
3874
3875 static void pr_out_occ_show(struct occ_show *occ_show)
3876 {
3877 struct dl *dl = occ_show->dl;
3878 struct dl_opts *opts = &dl->opts;
3879 struct occ_port *occ_port;
3880
3881 list_for_each_entry(occ_port, &occ_show->port_list, list) {
3882 __pr_out_port_handle_start(dl, opts->bus_name, opts->dev_name,
3883 occ_port->port_index, true, false);
3884 pr_out_occ_show_port(dl, occ_port);
3885 pr_out_port_handle_end(dl);
3886 }
3887 }
3888
3889 static void cmd_sb_occ_port_pool_process(struct occ_show *occ_show,
3890 struct nlattr **tb)
3891 {
3892 struct occ_port *occ_port;
3893 struct occ_item *occ_item;
3894
3895 if (occ_show->err || !dl_dump_filter(occ_show->dl, tb))
3896 return;
3897
3898 occ_port = occ_port_get(occ_show, tb);
3899 if (!occ_port) {
3900 occ_show->err = -ENOMEM;
3901 return;
3902 }
3903
3904 occ_item = occ_item_alloc();
3905 if (!occ_item) {
3906 occ_show->err = -ENOMEM;
3907 return;
3908 }
3909 occ_item->index = mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_POOL_INDEX]);
3910 occ_item->cur = mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_OCC_CUR]);
3911 occ_item->max = mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_OCC_MAX]);
3912 list_add_tail(&occ_item->list, &occ_port->pool_list);
3913 }
3914
3915 static int cmd_sb_occ_port_pool_process_cb(const struct nlmsghdr *nlh, void *data)
3916 {
3917 struct occ_show *occ_show = data;
3918 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
3919 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
3920
3921 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
3922 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
3923 !tb[DEVLINK_ATTR_PORT_INDEX] || !tb[DEVLINK_ATTR_SB_INDEX] ||
3924 !tb[DEVLINK_ATTR_SB_POOL_INDEX] ||
3925 !tb[DEVLINK_ATTR_SB_OCC_CUR] || !tb[DEVLINK_ATTR_SB_OCC_MAX])
3926 return MNL_CB_ERROR;
3927 cmd_sb_occ_port_pool_process(occ_show, tb);
3928 return MNL_CB_OK;
3929 }
3930
3931 static void cmd_sb_occ_tc_pool_process(struct occ_show *occ_show,
3932 struct nlattr **tb)
3933 {
3934 struct occ_port *occ_port;
3935 struct occ_item *occ_item;
3936 uint8_t pool_type;
3937
3938 if (occ_show->err || !dl_dump_filter(occ_show->dl, tb))
3939 return;
3940
3941 occ_port = occ_port_get(occ_show, tb);
3942 if (!occ_port) {
3943 occ_show->err = -ENOMEM;
3944 return;
3945 }
3946
3947 occ_item = occ_item_alloc();
3948 if (!occ_item) {
3949 occ_show->err = -ENOMEM;
3950 return;
3951 }
3952 occ_item->index = mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_TC_INDEX]);
3953 occ_item->cur = mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_OCC_CUR]);
3954 occ_item->max = mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_OCC_MAX]);
3955 occ_item->bound_pool_index =
3956 mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_POOL_INDEX]);
3957 pool_type = mnl_attr_get_u8(tb[DEVLINK_ATTR_SB_POOL_TYPE]);
3958 if (pool_type == DEVLINK_SB_POOL_TYPE_INGRESS)
3959 list_add_tail(&occ_item->list, &occ_port->ing_tc_list);
3960 else if (pool_type == DEVLINK_SB_POOL_TYPE_EGRESS)
3961 list_add_tail(&occ_item->list, &occ_port->eg_tc_list);
3962 else
3963 occ_item_free(occ_item);
3964 }
3965
3966 static int cmd_sb_occ_tc_pool_process_cb(const struct nlmsghdr *nlh, void *data)
3967 {
3968 struct occ_show *occ_show = data;
3969 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
3970 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
3971
3972 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
3973 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
3974 !tb[DEVLINK_ATTR_PORT_INDEX] || !tb[DEVLINK_ATTR_SB_INDEX] ||
3975 !tb[DEVLINK_ATTR_SB_TC_INDEX] || !tb[DEVLINK_ATTR_SB_POOL_TYPE] ||
3976 !tb[DEVLINK_ATTR_SB_POOL_INDEX] ||
3977 !tb[DEVLINK_ATTR_SB_OCC_CUR] || !tb[DEVLINK_ATTR_SB_OCC_MAX])
3978 return MNL_CB_ERROR;
3979 cmd_sb_occ_tc_pool_process(occ_show, tb);
3980 return MNL_CB_OK;
3981 }
3982
3983 static int cmd_sb_occ_show(struct dl *dl)
3984 {
3985 struct nlmsghdr *nlh;
3986 struct occ_show *occ_show;
3987 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK | NLM_F_DUMP;
3988 int err;
3989
3990 err = dl_argv_parse(dl, DL_OPT_HANDLE | DL_OPT_HANDLEP, DL_OPT_SB);
3991 if (err)
3992 return err;
3993
3994 occ_show = occ_show_alloc(dl);
3995 if (!occ_show)
3996 return -ENOMEM;
3997
3998 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_PORT_POOL_GET, flags);
3999
4000 err = _mnlg_socket_sndrcv(dl->nlg, nlh,
4001 cmd_sb_occ_port_pool_process_cb, occ_show);
4002 if (err)
4003 goto out;
4004
4005 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_TC_POOL_BIND_GET, flags);
4006
4007 err = _mnlg_socket_sndrcv(dl->nlg, nlh,
4008 cmd_sb_occ_tc_pool_process_cb, occ_show);
4009 if (err)
4010 goto out;
4011
4012 pr_out_section_start(dl, "occupancy");
4013 pr_out_occ_show(occ_show);
4014 pr_out_section_end(dl);
4015
4016 out:
4017 occ_show_free(occ_show);
4018 return err;
4019 }
4020
4021 static int cmd_sb_occ_snapshot(struct dl *dl)
4022 {
4023 struct nlmsghdr *nlh;
4024 int err;
4025
4026 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_OCC_SNAPSHOT,
4027 NLM_F_REQUEST | NLM_F_ACK);
4028
4029 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, DL_OPT_SB);
4030 if (err)
4031 return err;
4032
4033 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
4034 }
4035
4036 static int cmd_sb_occ_clearmax(struct dl *dl)
4037 {
4038 struct nlmsghdr *nlh;
4039 int err;
4040
4041 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_OCC_MAX_CLEAR,
4042 NLM_F_REQUEST | NLM_F_ACK);
4043
4044 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, DL_OPT_SB);
4045 if (err)
4046 return err;
4047
4048 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
4049 }
4050
4051 static int cmd_sb_occ(struct dl *dl)
4052 {
4053 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
4054 cmd_sb_help();
4055 return 0;
4056 } else if (dl_argv_match(dl, "show") ||
4057 dl_argv_match(dl, "list")) {
4058 dl_arg_inc(dl);
4059 return cmd_sb_occ_show(dl);
4060 } else if (dl_argv_match(dl, "snapshot")) {
4061 dl_arg_inc(dl);
4062 return cmd_sb_occ_snapshot(dl);
4063 } else if (dl_argv_match(dl, "clearmax")) {
4064 dl_arg_inc(dl);
4065 return cmd_sb_occ_clearmax(dl);
4066 }
4067 pr_err("Command \"%s\" not found\n", dl_argv(dl));
4068 return -ENOENT;
4069 }
4070
4071 static int cmd_sb(struct dl *dl)
4072 {
4073 if (dl_argv_match(dl, "help")) {
4074 cmd_sb_help();
4075 return 0;
4076 } else if (dl_argv_match(dl, "show") ||
4077 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
4078 dl_arg_inc(dl);
4079 return cmd_sb_show(dl);
4080 } else if (dl_argv_match(dl, "pool")) {
4081 dl_arg_inc(dl);
4082 return cmd_sb_pool(dl);
4083 } else if (dl_argv_match(dl, "port")) {
4084 dl_arg_inc(dl);
4085 return cmd_sb_port(dl);
4086 } else if (dl_argv_match(dl, "tc")) {
4087 dl_arg_inc(dl);
4088 return cmd_sb_tc(dl);
4089 } else if (dl_argv_match(dl, "occupancy")) {
4090 dl_arg_inc(dl);
4091 return cmd_sb_occ(dl);
4092 }
4093 pr_err("Command \"%s\" not found\n", dl_argv(dl));
4094 return -ENOENT;
4095 }
4096
4097 static const char *cmd_name(uint8_t cmd)
4098 {
4099 switch (cmd) {
4100 case DEVLINK_CMD_UNSPEC: return "unspec";
4101 case DEVLINK_CMD_GET: return "get";
4102 case DEVLINK_CMD_SET: return "set";
4103 case DEVLINK_CMD_NEW: return "new";
4104 case DEVLINK_CMD_DEL: return "del";
4105 case DEVLINK_CMD_PORT_GET: return "get";
4106 case DEVLINK_CMD_PORT_SET: return "set";
4107 case DEVLINK_CMD_PORT_NEW: return "new";
4108 case DEVLINK_CMD_PORT_DEL: return "del";
4109 case DEVLINK_CMD_PARAM_GET: return "get";
4110 case DEVLINK_CMD_PARAM_SET: return "set";
4111 case DEVLINK_CMD_PARAM_NEW: return "new";
4112 case DEVLINK_CMD_PARAM_DEL: return "del";
4113 case DEVLINK_CMD_REGION_GET: return "get";
4114 case DEVLINK_CMD_REGION_SET: return "set";
4115 case DEVLINK_CMD_REGION_NEW: return "new";
4116 case DEVLINK_CMD_REGION_DEL: return "del";
4117 case DEVLINK_CMD_FLASH_UPDATE: return "begin";
4118 case DEVLINK_CMD_FLASH_UPDATE_END: return "end";
4119 case DEVLINK_CMD_FLASH_UPDATE_STATUS: return "status";
4120 case DEVLINK_CMD_TRAP_GET: return "get";
4121 case DEVLINK_CMD_TRAP_SET: return "set";
4122 case DEVLINK_CMD_TRAP_NEW: return "new";
4123 case DEVLINK_CMD_TRAP_DEL: return "del";
4124 case DEVLINK_CMD_TRAP_GROUP_GET: return "get";
4125 case DEVLINK_CMD_TRAP_GROUP_SET: return "set";
4126 case DEVLINK_CMD_TRAP_GROUP_NEW: return "new";
4127 case DEVLINK_CMD_TRAP_GROUP_DEL: return "del";
4128 default: return "<unknown cmd>";
4129 }
4130 }
4131
4132 static const char *cmd_obj(uint8_t cmd)
4133 {
4134 switch (cmd) {
4135 case DEVLINK_CMD_UNSPEC: return "unspec";
4136 case DEVLINK_CMD_GET:
4137 case DEVLINK_CMD_SET:
4138 case DEVLINK_CMD_NEW:
4139 case DEVLINK_CMD_DEL:
4140 return "dev";
4141 case DEVLINK_CMD_PORT_GET:
4142 case DEVLINK_CMD_PORT_SET:
4143 case DEVLINK_CMD_PORT_NEW:
4144 case DEVLINK_CMD_PORT_DEL:
4145 return "port";
4146 case DEVLINK_CMD_PARAM_GET:
4147 case DEVLINK_CMD_PARAM_SET:
4148 case DEVLINK_CMD_PARAM_NEW:
4149 case DEVLINK_CMD_PARAM_DEL:
4150 return "param";
4151 case DEVLINK_CMD_REGION_GET:
4152 case DEVLINK_CMD_REGION_SET:
4153 case DEVLINK_CMD_REGION_NEW:
4154 case DEVLINK_CMD_REGION_DEL:
4155 return "region";
4156 case DEVLINK_CMD_FLASH_UPDATE:
4157 case DEVLINK_CMD_FLASH_UPDATE_END:
4158 case DEVLINK_CMD_FLASH_UPDATE_STATUS:
4159 return "flash";
4160 case DEVLINK_CMD_TRAP_GET:
4161 case DEVLINK_CMD_TRAP_SET:
4162 case DEVLINK_CMD_TRAP_NEW:
4163 case DEVLINK_CMD_TRAP_DEL:
4164 return "trap";
4165 case DEVLINK_CMD_TRAP_GROUP_GET:
4166 case DEVLINK_CMD_TRAP_GROUP_SET:
4167 case DEVLINK_CMD_TRAP_GROUP_NEW:
4168 case DEVLINK_CMD_TRAP_GROUP_DEL:
4169 return "trap-group";
4170 default: return "<unknown obj>";
4171 }
4172 }
4173
4174 static void pr_out_mon_header(uint8_t cmd)
4175 {
4176 pr_out("[%s,%s] ", cmd_obj(cmd), cmd_name(cmd));
4177 }
4178
4179 static bool cmd_filter_check(struct dl *dl, uint8_t cmd)
4180 {
4181 const char *obj = cmd_obj(cmd);
4182 unsigned int index = 0;
4183 const char *cur_obj;
4184
4185 if (dl_no_arg(dl))
4186 return true;
4187 while ((cur_obj = dl_argv_index(dl, index++))) {
4188 if (strcmp(cur_obj, obj) == 0 || strcmp(cur_obj, "all") == 0)
4189 return true;
4190 }
4191 return false;
4192 }
4193
4194 static void pr_out_flash_update(struct dl *dl, struct nlattr **tb)
4195 {
4196 __pr_out_handle_start(dl, tb, true, false);
4197
4198 if (tb[DEVLINK_ATTR_FLASH_UPDATE_STATUS_MSG])
4199 pr_out_str(dl, "msg",
4200 mnl_attr_get_str(tb[DEVLINK_ATTR_FLASH_UPDATE_STATUS_MSG]));
4201
4202 if (tb[DEVLINK_ATTR_FLASH_UPDATE_COMPONENT])
4203 pr_out_str(dl, "component",
4204 mnl_attr_get_str(tb[DEVLINK_ATTR_FLASH_UPDATE_COMPONENT]));
4205
4206 if (tb[DEVLINK_ATTR_FLASH_UPDATE_STATUS_DONE])
4207 pr_out_u64(dl, "done",
4208 mnl_attr_get_u64(tb[DEVLINK_ATTR_FLASH_UPDATE_STATUS_DONE]));
4209
4210 if (tb[DEVLINK_ATTR_FLASH_UPDATE_STATUS_TOTAL])
4211 pr_out_u64(dl, "total",
4212 mnl_attr_get_u64(tb[DEVLINK_ATTR_FLASH_UPDATE_STATUS_TOTAL]));
4213
4214 pr_out_handle_end(dl);
4215 }
4216
4217 static void pr_out_region(struct dl *dl, struct nlattr **tb);
4218 static void pr_out_trap(struct dl *dl, struct nlattr **tb, bool array);
4219 static void pr_out_trap_group(struct dl *dl, struct nlattr **tb, bool array);
4220
4221 static int cmd_mon_show_cb(const struct nlmsghdr *nlh, void *data)
4222 {
4223 struct dl *dl = data;
4224 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
4225 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
4226 uint8_t cmd = genl->cmd;
4227
4228 if (!cmd_filter_check(dl, cmd))
4229 return MNL_CB_OK;
4230
4231 switch (cmd) {
4232 case DEVLINK_CMD_GET: /* fall through */
4233 case DEVLINK_CMD_SET: /* fall through */
4234 case DEVLINK_CMD_NEW: /* fall through */
4235 case DEVLINK_CMD_DEL:
4236 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
4237 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME])
4238 return MNL_CB_ERROR;
4239 pr_out_mon_header(genl->cmd);
4240 pr_out_dev(dl, tb);
4241 break;
4242 case DEVLINK_CMD_PORT_GET: /* fall through */
4243 case DEVLINK_CMD_PORT_SET: /* fall through */
4244 case DEVLINK_CMD_PORT_NEW: /* fall through */
4245 case DEVLINK_CMD_PORT_DEL:
4246 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
4247 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
4248 !tb[DEVLINK_ATTR_PORT_INDEX])
4249 return MNL_CB_ERROR;
4250 pr_out_mon_header(genl->cmd);
4251 pr_out_port(dl, tb);
4252 break;
4253 case DEVLINK_CMD_PARAM_GET: /* fall through */
4254 case DEVLINK_CMD_PARAM_SET: /* fall through */
4255 case DEVLINK_CMD_PARAM_NEW: /* fall through */
4256 case DEVLINK_CMD_PARAM_DEL:
4257 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
4258 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
4259 !tb[DEVLINK_ATTR_PARAM])
4260 return MNL_CB_ERROR;
4261 pr_out_mon_header(genl->cmd);
4262 pr_out_param(dl, tb, false);
4263 break;
4264 case DEVLINK_CMD_REGION_GET: /* fall through */
4265 case DEVLINK_CMD_REGION_SET: /* fall through */
4266 case DEVLINK_CMD_REGION_NEW: /* fall through */
4267 case DEVLINK_CMD_REGION_DEL:
4268 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
4269 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
4270 !tb[DEVLINK_ATTR_REGION_NAME])
4271 return MNL_CB_ERROR;
4272 pr_out_mon_header(genl->cmd);
4273 pr_out_region(dl, tb);
4274 break;
4275 case DEVLINK_CMD_FLASH_UPDATE: /* fall through */
4276 case DEVLINK_CMD_FLASH_UPDATE_END: /* fall through */
4277 case DEVLINK_CMD_FLASH_UPDATE_STATUS:
4278 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
4279 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME])
4280 return MNL_CB_ERROR;
4281 pr_out_mon_header(genl->cmd);
4282 pr_out_flash_update(dl, tb);
4283 break;
4284 case DEVLINK_CMD_TRAP_GET: /* fall through */
4285 case DEVLINK_CMD_TRAP_SET: /* fall through */
4286 case DEVLINK_CMD_TRAP_NEW: /* fall through */
4287 case DEVLINK_CMD_TRAP_DEL:
4288 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
4289 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
4290 !tb[DEVLINK_ATTR_TRAP_NAME] ||
4291 !tb[DEVLINK_ATTR_TRAP_TYPE] ||
4292 !tb[DEVLINK_ATTR_TRAP_ACTION] ||
4293 !tb[DEVLINK_ATTR_TRAP_GROUP_NAME] ||
4294 !tb[DEVLINK_ATTR_TRAP_METADATA] ||
4295 !tb[DEVLINK_ATTR_STATS])
4296 return MNL_CB_ERROR;
4297 pr_out_mon_header(genl->cmd);
4298 pr_out_trap(dl, tb, false);
4299 break;
4300 case DEVLINK_CMD_TRAP_GROUP_GET: /* fall through */
4301 case DEVLINK_CMD_TRAP_GROUP_SET: /* fall through */
4302 case DEVLINK_CMD_TRAP_GROUP_NEW: /* fall through */
4303 case DEVLINK_CMD_TRAP_GROUP_DEL:
4304 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
4305 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
4306 !tb[DEVLINK_ATTR_TRAP_GROUP_NAME] ||
4307 !tb[DEVLINK_ATTR_STATS])
4308 return MNL_CB_ERROR;
4309 pr_out_mon_header(genl->cmd);
4310 pr_out_trap_group(dl, tb, false);
4311 break;
4312 }
4313 return MNL_CB_OK;
4314 }
4315
4316 static int cmd_mon_show(struct dl *dl)
4317 {
4318 int err;
4319 unsigned int index = 0;
4320 const char *cur_obj;
4321
4322 while ((cur_obj = dl_argv_index(dl, index++))) {
4323 if (strcmp(cur_obj, "all") != 0 &&
4324 strcmp(cur_obj, "dev") != 0 &&
4325 strcmp(cur_obj, "port") != 0 &&
4326 strcmp(cur_obj, "trap") != 0 &&
4327 strcmp(cur_obj, "trap-group") != 0) {
4328 pr_err("Unknown object \"%s\"\n", cur_obj);
4329 return -EINVAL;
4330 }
4331 }
4332 err = _mnlg_socket_group_add(dl->nlg, DEVLINK_GENL_MCGRP_CONFIG_NAME);
4333 if (err)
4334 return err;
4335 err = _mnlg_socket_recv_run(dl->nlg, cmd_mon_show_cb, dl);
4336 if (err)
4337 return err;
4338 return 0;
4339 }
4340
4341 static void cmd_mon_help(void)
4342 {
4343 pr_err("Usage: devlink monitor [ all | OBJECT-LIST ]\n"
4344 "where OBJECT-LIST := { dev | port | trap | trap-group }\n");
4345 }
4346
4347 static int cmd_mon(struct dl *dl)
4348 {
4349 if (dl_argv_match(dl, "help")) {
4350 cmd_mon_help();
4351 return 0;
4352 }
4353 return cmd_mon_show(dl);
4354 }
4355
4356 struct dpipe_field {
4357 char *name;
4358 unsigned int id;
4359 unsigned int bitwidth;
4360 enum devlink_dpipe_field_mapping_type mapping_type;
4361 };
4362
4363 struct dpipe_header {
4364 struct list_head list;
4365 char *name;
4366 unsigned int id;
4367 struct dpipe_field *fields;
4368 unsigned int fields_count;
4369 };
4370
4371 struct dpipe_table {
4372 struct list_head list;
4373 char *name;
4374 unsigned int resource_id;
4375 bool resource_valid;
4376 };
4377
4378 struct dpipe_tables {
4379 struct list_head table_list;
4380 };
4381
4382 struct resource {
4383 char *name;
4384 uint64_t size;
4385 uint64_t size_new;
4386 uint64_t size_min;
4387 uint64_t size_max;
4388 uint64_t size_gran;
4389 enum devlink_resource_unit unit;
4390 bool size_valid;
4391 uint64_t size_occ;
4392 bool occ_valid;
4393 uint64_t id;
4394 struct list_head list;
4395 struct list_head resource_list;
4396 struct resource *parent;
4397 };
4398
4399 struct resources {
4400 struct list_head resource_list;
4401 };
4402
4403 struct resource_ctx {
4404 struct dl *dl;
4405 int err;
4406 struct resources *resources;
4407 struct dpipe_tables *tables;
4408 bool print_resources;
4409 bool pending_change;
4410 };
4411
4412 static struct resource *resource_alloc(void)
4413 {
4414 struct resource *resource;
4415
4416 resource = calloc(1, sizeof(struct resource));
4417 if (!resource)
4418 return NULL;
4419 INIT_LIST_HEAD(&resource->resource_list);
4420 return resource;
4421 }
4422
4423 static void resource_free(struct resource *resource)
4424 {
4425 struct resource *child_resource, *tmp;
4426
4427 list_for_each_entry_safe(child_resource, tmp, &resource->resource_list,
4428 list) {
4429 free(child_resource->name);
4430 resource_free(child_resource);
4431 }
4432 free(resource);
4433 }
4434
4435 static struct resources *resources_alloc(void)
4436 {
4437 struct resources *resources;
4438
4439 resources = calloc(1, sizeof(struct resources));
4440 if (!resources)
4441 return NULL;
4442 INIT_LIST_HEAD(&resources->resource_list);
4443 return resources;
4444 }
4445
4446 static void resources_free(struct resources *resources)
4447 {
4448 struct resource *resource, *tmp;
4449
4450 list_for_each_entry_safe(resource, tmp, &resources->resource_list, list)
4451 resource_free(resource);
4452 }
4453
4454 static int resource_ctx_init(struct resource_ctx *ctx, struct dl *dl)
4455 {
4456 ctx->resources = resources_alloc();
4457 if (!ctx->resources)
4458 return -ENOMEM;
4459 ctx->dl = dl;
4460 return 0;
4461 }
4462
4463 static void resource_ctx_fini(struct resource_ctx *ctx)
4464 {
4465 resources_free(ctx->resources);
4466 }
4467
4468 struct dpipe_ctx {
4469 struct dl *dl;
4470 int err;
4471 struct list_head global_headers;
4472 struct list_head local_headers;
4473 struct dpipe_tables *tables;
4474 struct resources *resources;
4475 bool print_headers;
4476 bool print_tables;
4477 };
4478
4479 static struct dpipe_header *dpipe_header_alloc(unsigned int fields_count)
4480 {
4481 struct dpipe_header *header;
4482
4483 header = calloc(1, sizeof(struct dpipe_header));
4484 if (!header)
4485 return NULL;
4486 header->fields = calloc(fields_count, sizeof(struct dpipe_field));
4487 if (!header->fields)
4488 goto err_fields_alloc;
4489 header->fields_count = fields_count;
4490 return header;
4491
4492 err_fields_alloc:
4493 free(header);
4494 return NULL;
4495 }
4496
4497 static void dpipe_header_free(struct dpipe_header *header)
4498 {
4499 free(header->fields);
4500 free(header);
4501 }
4502
4503 static void dpipe_header_clear(struct dpipe_header *header)
4504 {
4505 struct dpipe_field *field;
4506 int i;
4507
4508 for (i = 0; i < header->fields_count; i++) {
4509 field = &header->fields[i];
4510 free(field->name);
4511 }
4512 free(header->name);
4513 }
4514
4515 static void dpipe_header_add(struct dpipe_ctx *ctx,
4516 struct dpipe_header *header, bool global)
4517 {
4518 if (global)
4519 list_add(&header->list, &ctx->global_headers);
4520 else
4521 list_add(&header->list, &ctx->local_headers);
4522 }
4523
4524 static void dpipe_header_del(struct dpipe_header *header)
4525 {
4526 list_del(&header->list);
4527 }
4528
4529 static struct dpipe_table *dpipe_table_alloc(void)
4530 {
4531 return calloc(1, sizeof(struct dpipe_table));
4532 }
4533
4534 static void dpipe_table_free(struct dpipe_table *table)
4535 {
4536 free(table);
4537 }
4538
4539 static struct dpipe_tables *dpipe_tables_alloc(void)
4540 {
4541 struct dpipe_tables *tables;
4542
4543 tables = calloc(1, sizeof(struct dpipe_tables));
4544 if (!tables)
4545 return NULL;
4546 INIT_LIST_HEAD(&tables->table_list);
4547 return tables;
4548 }
4549
4550 static void dpipe_tables_free(struct dpipe_tables *tables)
4551 {
4552 struct dpipe_table *table, *tmp;
4553
4554 list_for_each_entry_safe(table, tmp, &tables->table_list, list)
4555 dpipe_table_free(table);
4556 free(tables);
4557 }
4558
4559 static int dpipe_ctx_init(struct dpipe_ctx *ctx, struct dl *dl)
4560 {
4561 ctx->tables = dpipe_tables_alloc();
4562 if (!ctx->tables)
4563 return -ENOMEM;
4564
4565 ctx->dl = dl;
4566 INIT_LIST_HEAD(&ctx->global_headers);
4567 INIT_LIST_HEAD(&ctx->local_headers);
4568 return 0;
4569 }
4570
4571 static void dpipe_ctx_fini(struct dpipe_ctx *ctx)
4572 {
4573 struct dpipe_header *header, *tmp;
4574
4575 list_for_each_entry_safe(header, tmp, &ctx->global_headers,
4576 list) {
4577 dpipe_header_del(header);
4578 dpipe_header_clear(header);
4579 dpipe_header_free(header);
4580 }
4581 list_for_each_entry_safe(header, tmp, &ctx->local_headers,
4582 list) {
4583 dpipe_header_del(header);
4584 dpipe_header_clear(header);
4585 dpipe_header_free(header);
4586 }
4587 dpipe_tables_free(ctx->tables);
4588 }
4589
4590 static const char *dpipe_header_id2s(struct dpipe_ctx *ctx,
4591 uint32_t header_id, bool global)
4592 {
4593 struct list_head *header_list;
4594 struct dpipe_header *header;
4595
4596 if (global)
4597 header_list = &ctx->global_headers;
4598 else
4599 header_list = &ctx->local_headers;
4600 list_for_each_entry(header, header_list, list) {
4601 if (header->id != header_id)
4602 continue;
4603 return header->name;
4604 }
4605 return NULL;
4606 }
4607
4608 static const char *dpipe_field_id2s(struct dpipe_ctx *ctx,
4609 uint32_t header_id,
4610 uint32_t field_id, bool global)
4611 {
4612 struct list_head *header_list;
4613 struct dpipe_header *header;
4614
4615 if (global)
4616 header_list = &ctx->global_headers;
4617 else
4618 header_list = &ctx->local_headers;
4619 list_for_each_entry(header, header_list, list) {
4620 if (header->id != header_id)
4621 continue;
4622 return header->fields[field_id].name;
4623 }
4624 return NULL;
4625 }
4626
4627 static const char *
4628 dpipe_field_mapping_e2s(enum devlink_dpipe_field_mapping_type mapping_type)
4629 {
4630 switch (mapping_type) {
4631 case DEVLINK_DPIPE_FIELD_MAPPING_TYPE_NONE:
4632 return NULL;
4633 case DEVLINK_DPIPE_FIELD_MAPPING_TYPE_IFINDEX:
4634 return "ifindex";
4635 default:
4636 return "<unknown>";
4637 }
4638 }
4639
4640 static const char *
4641 dpipe_mapping_get(struct dpipe_ctx *ctx, uint32_t header_id,
4642 uint32_t field_id, bool global)
4643 {
4644 enum devlink_dpipe_field_mapping_type mapping_type;
4645 struct list_head *header_list;
4646 struct dpipe_header *header;
4647
4648 if (global)
4649 header_list = &ctx->global_headers;
4650 else
4651 header_list = &ctx->local_headers;
4652 list_for_each_entry(header, header_list, list) {
4653 if (header->id != header_id)
4654 continue;
4655 mapping_type = header->fields[field_id].mapping_type;
4656 return dpipe_field_mapping_e2s(mapping_type);
4657 }
4658 return NULL;
4659 }
4660
4661 static void pr_out_dpipe_fields(struct dpipe_ctx *ctx,
4662 struct dpipe_field *fields,
4663 unsigned int field_count)
4664 {
4665 struct dpipe_field *field;
4666 int i;
4667
4668 for (i = 0; i < field_count; i++) {
4669 field = &fields[i];
4670 pr_out_entry_start(ctx->dl);
4671 pr_out_str(ctx->dl, "name", field->name);
4672 if (ctx->dl->verbose)
4673 pr_out_uint(ctx->dl, "id", field->id);
4674 pr_out_uint(ctx->dl, "bitwidth", field->bitwidth);
4675 if (field->mapping_type)
4676 pr_out_str(ctx->dl, "mapping_type",
4677 dpipe_field_mapping_e2s(field->mapping_type));
4678 pr_out_entry_end(ctx->dl);
4679 }
4680 }
4681
4682 static void
4683 pr_out_dpipe_header(struct dpipe_ctx *ctx, struct nlattr **tb,
4684 struct dpipe_header *header, bool global)
4685 {
4686 pr_out_handle_start_arr(ctx->dl, tb);
4687 pr_out_str(ctx->dl, "name", header->name);
4688 if (ctx->dl->verbose) {
4689 pr_out_uint(ctx->dl, "id", header->id);
4690 pr_out_str(ctx->dl, "global",
4691 global ? "true" : "false");
4692 }
4693 pr_out_array_start(ctx->dl, "field");
4694 pr_out_dpipe_fields(ctx, header->fields,
4695 header->fields_count);
4696 pr_out_array_end(ctx->dl);
4697 pr_out_handle_end(ctx->dl);
4698 }
4699
4700 static void pr_out_dpipe_headers(struct dpipe_ctx *ctx,
4701 struct nlattr **tb)
4702 {
4703 struct dpipe_header *header;
4704
4705 list_for_each_entry(header, &ctx->local_headers, list)
4706 pr_out_dpipe_header(ctx, tb, header, false);
4707
4708 list_for_each_entry(header, &ctx->global_headers, list)
4709 pr_out_dpipe_header(ctx, tb, header, true);
4710 }
4711
4712 static int dpipe_header_field_get(struct nlattr *nl, struct dpipe_field *field)
4713 {
4714 struct nlattr *nla_field[DEVLINK_ATTR_MAX + 1] = {};
4715 const char *name;
4716 int err;
4717
4718 err = mnl_attr_parse_nested(nl, attr_cb, nla_field);
4719 if (err != MNL_CB_OK)
4720 return -EINVAL;
4721 if (!nla_field[DEVLINK_ATTR_DPIPE_FIELD_ID] ||
4722 !nla_field[DEVLINK_ATTR_DPIPE_FIELD_NAME] ||
4723 !nla_field[DEVLINK_ATTR_DPIPE_FIELD_BITWIDTH] ||
4724 !nla_field[DEVLINK_ATTR_DPIPE_FIELD_MAPPING_TYPE])
4725 return -EINVAL;
4726
4727 name = mnl_attr_get_str(nla_field[DEVLINK_ATTR_DPIPE_FIELD_NAME]);
4728 field->id = mnl_attr_get_u32(nla_field[DEVLINK_ATTR_DPIPE_FIELD_ID]);
4729 field->bitwidth = mnl_attr_get_u32(nla_field[DEVLINK_ATTR_DPIPE_FIELD_BITWIDTH]);
4730 field->name = strdup(name);
4731 if (!field->name)
4732 return -ENOMEM;
4733 field->mapping_type = mnl_attr_get_u32(nla_field[DEVLINK_ATTR_DPIPE_FIELD_MAPPING_TYPE]);
4734 return 0;
4735 }
4736
4737 static int dpipe_header_fields_get(struct nlattr *nla_fields,
4738 struct dpipe_field *fields)
4739 {
4740 struct nlattr *nla_field;
4741 int count = 0;
4742 int err;
4743
4744 mnl_attr_for_each_nested(nla_field, nla_fields) {
4745 err = dpipe_header_field_get(nla_field, &fields[count]);
4746 if (err)
4747 return err;
4748 count++;
4749 }
4750 return 0;
4751 }
4752
4753 static unsigned int dpipe_header_field_count_get(struct nlattr *nla_fields)
4754 {
4755 struct nlattr *nla_field;
4756 unsigned int count = 0;
4757
4758 mnl_attr_for_each_nested(nla_field, nla_fields)
4759 count++;
4760 return count;
4761 }
4762
4763 static int dpipe_header_get(struct dpipe_ctx *ctx, struct nlattr *nl)
4764 {
4765 struct nlattr *nla_header[DEVLINK_ATTR_MAX + 1] = {};
4766 struct dpipe_header *header;
4767 unsigned int fields_count;
4768 const char *header_name;
4769 bool global;
4770 int err;
4771
4772 err = mnl_attr_parse_nested(nl, attr_cb, nla_header);
4773 if (err != MNL_CB_OK)
4774 return -EINVAL;
4775
4776 if (!nla_header[DEVLINK_ATTR_DPIPE_HEADER_NAME] ||
4777 !nla_header[DEVLINK_ATTR_DPIPE_HEADER_ID] ||
4778 !nla_header[DEVLINK_ATTR_DPIPE_HEADER_FIELDS])
4779 return -EINVAL;
4780
4781 fields_count = dpipe_header_field_count_get(nla_header[DEVLINK_ATTR_DPIPE_HEADER_FIELDS]);
4782 header = dpipe_header_alloc(fields_count);
4783 if (!header)
4784 return -ENOMEM;
4785
4786 header_name = mnl_attr_get_str(nla_header[DEVLINK_ATTR_DPIPE_HEADER_NAME]);
4787 header->name = strdup(header_name);
4788 header->id = mnl_attr_get_u32(nla_header[DEVLINK_ATTR_DPIPE_HEADER_ID]);
4789 header->fields_count = fields_count;
4790 global = !!mnl_attr_get_u8(nla_header[DEVLINK_ATTR_DPIPE_HEADER_GLOBAL]);
4791
4792 err = dpipe_header_fields_get(nla_header[DEVLINK_ATTR_DPIPE_HEADER_FIELDS],
4793 header->fields);
4794 if (err)
4795 goto err_field_get;
4796 dpipe_header_add(ctx, header, global);
4797 return 0;
4798
4799 err_field_get:
4800 dpipe_header_free(header);
4801 return err;
4802 }
4803
4804 static int dpipe_headers_get(struct dpipe_ctx *ctx, struct nlattr **tb)
4805 {
4806 struct nlattr *nla_headers = tb[DEVLINK_ATTR_DPIPE_HEADERS];
4807 struct nlattr *nla_header;
4808 int err;
4809
4810 mnl_attr_for_each_nested(nla_header, nla_headers) {
4811 err = dpipe_header_get(ctx, nla_header);
4812 if (err)
4813 return err;
4814 }
4815 return 0;
4816 }
4817
4818 static int cmd_dpipe_header_cb(const struct nlmsghdr *nlh, void *data)
4819 {
4820 struct dpipe_ctx *ctx = data;
4821 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
4822 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
4823 int err;
4824
4825 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
4826 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
4827 !tb[DEVLINK_ATTR_DPIPE_HEADERS])
4828 return MNL_CB_ERROR;
4829 err = dpipe_headers_get(ctx, tb);
4830 if (err) {
4831 ctx->err = err;
4832 return MNL_CB_ERROR;
4833 }
4834
4835 if (ctx->print_headers)
4836 pr_out_dpipe_headers(ctx, tb);
4837 return MNL_CB_OK;
4838 }
4839
4840 static int cmd_dpipe_headers_show(struct dl *dl)
4841 {
4842 struct nlmsghdr *nlh;
4843 struct dpipe_ctx ctx = {};
4844 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
4845 int err;
4846
4847 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_HEADERS_GET, flags);
4848
4849 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, 0);
4850 if (err)
4851 return err;
4852
4853 err = dpipe_ctx_init(&ctx, dl);
4854 if (err)
4855 return err;
4856
4857 ctx.print_headers = true;
4858
4859 pr_out_section_start(dl, "header");
4860 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_header_cb, &ctx);
4861 if (err)
4862 pr_err("error get headers %s\n", strerror(ctx.err));
4863 pr_out_section_end(dl);
4864
4865 dpipe_ctx_fini(&ctx);
4866 return err;
4867 }
4868
4869 static void cmd_dpipe_header_help(void)
4870 {
4871 pr_err("Usage: devlink dpipe headers show DEV\n");
4872 }
4873
4874 static int cmd_dpipe_header(struct dl *dl)
4875 {
4876 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
4877 cmd_dpipe_header_help();
4878 return 0;
4879 } else if (dl_argv_match(dl, "show")) {
4880 dl_arg_inc(dl);
4881 return cmd_dpipe_headers_show(dl);
4882 }
4883 pr_err("Command \"%s\" not found\n", dl_argv(dl));
4884 return -ENOENT;
4885 }
4886
4887 static const char
4888 *dpipe_action_type_e2s(enum devlink_dpipe_action_type action_type)
4889 {
4890 switch (action_type) {
4891 case DEVLINK_DPIPE_ACTION_TYPE_FIELD_MODIFY:
4892 return "field_modify";
4893 default:
4894 return "<unknown>";
4895 }
4896 }
4897
4898 struct dpipe_op_info {
4899 uint32_t header_id;
4900 uint32_t field_id;
4901 bool header_global;
4902 };
4903
4904 struct dpipe_action {
4905 struct dpipe_op_info info;
4906 uint32_t type;
4907 };
4908
4909 static void pr_out_dpipe_action(struct dpipe_action *action,
4910 struct dpipe_ctx *ctx)
4911 {
4912 struct dpipe_op_info *op_info = &action->info;
4913 const char *mapping;
4914
4915 pr_out_str(ctx->dl, "type",
4916 dpipe_action_type_e2s(action->type));
4917 pr_out_str(ctx->dl, "header",
4918 dpipe_header_id2s(ctx, op_info->header_id,
4919 op_info->header_global));
4920 pr_out_str(ctx->dl, "field",
4921 dpipe_field_id2s(ctx, op_info->header_id,
4922 op_info->field_id,
4923 op_info->header_global));
4924 mapping = dpipe_mapping_get(ctx, op_info->header_id,
4925 op_info->field_id,
4926 op_info->header_global);
4927 if (mapping)
4928 pr_out_str(ctx->dl, "mapping", mapping);
4929 }
4930
4931 static int dpipe_action_parse(struct dpipe_action *action, struct nlattr *nl)
4932 {
4933 struct nlattr *nla_action[DEVLINK_ATTR_MAX + 1] = {};
4934 int err;
4935
4936 err = mnl_attr_parse_nested(nl, attr_cb, nla_action);
4937 if (err != MNL_CB_OK)
4938 return -EINVAL;
4939
4940 if (!nla_action[DEVLINK_ATTR_DPIPE_ACTION_TYPE] ||
4941 !nla_action[DEVLINK_ATTR_DPIPE_HEADER_INDEX] ||
4942 !nla_action[DEVLINK_ATTR_DPIPE_HEADER_ID] ||
4943 !nla_action[DEVLINK_ATTR_DPIPE_FIELD_ID]) {
4944 return -EINVAL;
4945 }
4946
4947 action->type = mnl_attr_get_u32(nla_action[DEVLINK_ATTR_DPIPE_ACTION_TYPE]);
4948 action->info.header_id = mnl_attr_get_u32(nla_action[DEVLINK_ATTR_DPIPE_HEADER_ID]);
4949 action->info.field_id = mnl_attr_get_u32(nla_action[DEVLINK_ATTR_DPIPE_FIELD_ID]);
4950 action->info.header_global = !!mnl_attr_get_u8(nla_action[DEVLINK_ATTR_DPIPE_HEADER_GLOBAL]);
4951
4952 return 0;
4953 }
4954
4955 static int dpipe_table_actions_show(struct dpipe_ctx *ctx,
4956 struct nlattr *nla_actions)
4957 {
4958 struct nlattr *nla_action;
4959 struct dpipe_action action;
4960
4961 mnl_attr_for_each_nested(nla_action, nla_actions) {
4962 pr_out_entry_start(ctx->dl);
4963 if (dpipe_action_parse(&action, nla_action))
4964 goto err_action_parse;
4965 pr_out_dpipe_action(&action, ctx);
4966 pr_out_entry_end(ctx->dl);
4967 }
4968 return 0;
4969
4970 err_action_parse:
4971 pr_out_entry_end(ctx->dl);
4972 return -EINVAL;
4973 }
4974
4975 static const char *
4976 dpipe_match_type_e2s(enum devlink_dpipe_match_type match_type)
4977 {
4978 switch (match_type) {
4979 case DEVLINK_DPIPE_MATCH_TYPE_FIELD_EXACT:
4980 return "field_exact";
4981 default:
4982 return "<unknown>";
4983 }
4984 }
4985
4986 struct dpipe_match {
4987 struct dpipe_op_info info;
4988 uint32_t type;
4989 };
4990
4991 static void pr_out_dpipe_match(struct dpipe_match *match,
4992 struct dpipe_ctx *ctx)
4993 {
4994 struct dpipe_op_info *op_info = &match->info;
4995 const char *mapping;
4996
4997 pr_out_str(ctx->dl, "type",
4998 dpipe_match_type_e2s(match->type));
4999 pr_out_str(ctx->dl, "header",
5000 dpipe_header_id2s(ctx, op_info->header_id,
5001 op_info->header_global));
5002 pr_out_str(ctx->dl, "field",
5003 dpipe_field_id2s(ctx, op_info->header_id,
5004 op_info->field_id,
5005 op_info->header_global));
5006 mapping = dpipe_mapping_get(ctx, op_info->header_id,
5007 op_info->field_id,
5008 op_info->header_global);
5009 if (mapping)
5010 pr_out_str(ctx->dl, "mapping", mapping);
5011 }
5012
5013 static int dpipe_match_parse(struct dpipe_match *match,
5014 struct nlattr *nl)
5015
5016 {
5017 struct nlattr *nla_match[DEVLINK_ATTR_MAX + 1] = {};
5018 int err;
5019
5020 err = mnl_attr_parse_nested(nl, attr_cb, nla_match);
5021 if (err != MNL_CB_OK)
5022 return -EINVAL;
5023
5024 if (!nla_match[DEVLINK_ATTR_DPIPE_MATCH_TYPE] ||
5025 !nla_match[DEVLINK_ATTR_DPIPE_HEADER_INDEX] ||
5026 !nla_match[DEVLINK_ATTR_DPIPE_HEADER_ID] ||
5027 !nla_match[DEVLINK_ATTR_DPIPE_FIELD_ID]) {
5028 return -EINVAL;
5029 }
5030
5031 match->type = mnl_attr_get_u32(nla_match[DEVLINK_ATTR_DPIPE_MATCH_TYPE]);
5032 match->info.header_id = mnl_attr_get_u32(nla_match[DEVLINK_ATTR_DPIPE_HEADER_ID]);
5033 match->info.field_id = mnl_attr_get_u32(nla_match[DEVLINK_ATTR_DPIPE_FIELD_ID]);
5034 match->info.header_global = !!mnl_attr_get_u8(nla_match[DEVLINK_ATTR_DPIPE_HEADER_GLOBAL]);
5035
5036 return 0;
5037 }
5038
5039 static int dpipe_table_matches_show(struct dpipe_ctx *ctx,
5040 struct nlattr *nla_matches)
5041 {
5042 struct nlattr *nla_match;
5043 struct dpipe_match match;
5044
5045 mnl_attr_for_each_nested(nla_match, nla_matches) {
5046 pr_out_entry_start(ctx->dl);
5047 if (dpipe_match_parse(&match, nla_match))
5048 goto err_match_parse;
5049 pr_out_dpipe_match(&match, ctx);
5050 pr_out_entry_end(ctx->dl);
5051 }
5052 return 0;
5053
5054 err_match_parse:
5055 pr_out_entry_end(ctx->dl);
5056 return -EINVAL;
5057 }
5058
5059 static struct resource *
5060 resource_find(struct resources *resources, struct resource *resource,
5061 uint64_t resource_id)
5062 {
5063 struct list_head *list_head;
5064
5065 if (!resource)
5066 list_head = &resources->resource_list;
5067 else
5068 list_head = &resource->resource_list;
5069
5070 list_for_each_entry(resource, list_head, list) {
5071 struct resource *child_resource;
5072
5073 if (resource->id == resource_id)
5074 return resource;
5075
5076 child_resource = resource_find(resources, resource,
5077 resource_id);
5078 if (child_resource)
5079 return child_resource;
5080 }
5081 return NULL;
5082 }
5083
5084 static void
5085 resource_path_print(struct dl *dl, struct resources *resources,
5086 uint64_t resource_id)
5087 {
5088 struct resource *resource, *parent_resource;
5089 const char del[] = "/";
5090 int path_len = 0;
5091 char *path;
5092
5093 resource = resource_find(resources, NULL, resource_id);
5094 if (!resource)
5095 return;
5096
5097 for (parent_resource = resource; parent_resource;
5098 parent_resource = parent_resource->parent)
5099 path_len += strlen(parent_resource->name) + 1;
5100
5101 path_len++;
5102 path = calloc(1, path_len);
5103 if (!path)
5104 return;
5105
5106 path += path_len - 1;
5107 for (parent_resource = resource; parent_resource;
5108 parent_resource = parent_resource->parent) {
5109 path -= strlen(parent_resource->name);
5110 memcpy(path, parent_resource->name,
5111 strlen(parent_resource->name));
5112 path -= strlen(del);
5113 memcpy(path, del, strlen(del));
5114 }
5115 pr_out_str(dl, "resource_path", path);
5116 free(path);
5117 }
5118
5119 static int dpipe_table_show(struct dpipe_ctx *ctx, struct nlattr *nl)
5120 {
5121 struct nlattr *nla_table[DEVLINK_ATTR_MAX + 1] = {};
5122 struct dpipe_table *table;
5123 uint32_t resource_units;
5124 bool counters_enabled;
5125 bool resource_valid;
5126 uint32_t size;
5127 int err;
5128
5129 err = mnl_attr_parse_nested(nl, attr_cb, nla_table);
5130 if (err != MNL_CB_OK)
5131 return -EINVAL;
5132
5133 if (!nla_table[DEVLINK_ATTR_DPIPE_TABLE_NAME] ||
5134 !nla_table[DEVLINK_ATTR_DPIPE_TABLE_SIZE] ||
5135 !nla_table[DEVLINK_ATTR_DPIPE_TABLE_ACTIONS] ||
5136 !nla_table[DEVLINK_ATTR_DPIPE_TABLE_MATCHES] ||
5137 !nla_table[DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED]) {
5138 return -EINVAL;
5139 }
5140
5141 table = dpipe_table_alloc();
5142 if (!table)
5143 return -ENOMEM;
5144
5145 table->name = strdup(mnl_attr_get_str(nla_table[DEVLINK_ATTR_DPIPE_TABLE_NAME]));
5146 size = mnl_attr_get_u32(nla_table[DEVLINK_ATTR_DPIPE_TABLE_SIZE]);
5147 counters_enabled = !!mnl_attr_get_u8(nla_table[DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED]);
5148
5149 resource_valid = nla_table[DEVLINK_ATTR_DPIPE_TABLE_RESOURCE_ID] &&
5150 ctx->resources;
5151 if (resource_valid) {
5152 table->resource_id = mnl_attr_get_u64(nla_table[DEVLINK_ATTR_DPIPE_TABLE_RESOURCE_ID]);
5153 table->resource_valid = true;
5154 }
5155
5156 list_add_tail(&table->list, &ctx->tables->table_list);
5157 if (!ctx->print_tables)
5158 return 0;
5159
5160 pr_out_str(ctx->dl, "name", table->name);
5161 pr_out_uint(ctx->dl, "size", size);
5162 pr_out_str(ctx->dl, "counters_enabled",
5163 counters_enabled ? "true" : "false");
5164
5165 if (resource_valid) {
5166 resource_units = mnl_attr_get_u32(nla_table[DEVLINK_ATTR_DPIPE_TABLE_RESOURCE_UNITS]);
5167 resource_path_print(ctx->dl, ctx->resources,
5168 table->resource_id);
5169 pr_out_uint(ctx->dl, "resource_units", resource_units);
5170 }
5171
5172 pr_out_array_start(ctx->dl, "match");
5173 if (dpipe_table_matches_show(ctx, nla_table[DEVLINK_ATTR_DPIPE_TABLE_MATCHES]))
5174 goto err_matches_show;
5175 pr_out_array_end(ctx->dl);
5176
5177 pr_out_array_start(ctx->dl, "action");
5178 if (dpipe_table_actions_show(ctx, nla_table[DEVLINK_ATTR_DPIPE_TABLE_ACTIONS]))
5179 goto err_actions_show;
5180 pr_out_array_end(ctx->dl);
5181
5182 return 0;
5183
5184 err_actions_show:
5185 err_matches_show:
5186 pr_out_array_end(ctx->dl);
5187 return -EINVAL;
5188 }
5189
5190 static int dpipe_tables_show(struct dpipe_ctx *ctx, struct nlattr **tb)
5191 {
5192 struct nlattr *nla_tables = tb[DEVLINK_ATTR_DPIPE_TABLES];
5193 struct nlattr *nla_table;
5194
5195 mnl_attr_for_each_nested(nla_table, nla_tables) {
5196 if (ctx->print_tables)
5197 pr_out_handle_start_arr(ctx->dl, tb);
5198 if (dpipe_table_show(ctx, nla_table))
5199 goto err_table_show;
5200 if (ctx->print_tables)
5201 pr_out_handle_end(ctx->dl);
5202 }
5203 return 0;
5204
5205 err_table_show:
5206 if (ctx->print_tables)
5207 pr_out_handle_end(ctx->dl);
5208 return -EINVAL;
5209 }
5210
5211 static int cmd_dpipe_table_show_cb(const struct nlmsghdr *nlh, void *data)
5212 {
5213 struct dpipe_ctx *ctx = data;
5214 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
5215 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
5216
5217 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
5218 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
5219 !tb[DEVLINK_ATTR_DPIPE_TABLES])
5220 return MNL_CB_ERROR;
5221
5222 if (dpipe_tables_show(ctx, tb))
5223 return MNL_CB_ERROR;
5224 return MNL_CB_OK;
5225 }
5226
5227 static int cmd_resource_dump_cb(const struct nlmsghdr *nlh, void *data);
5228
5229 static int cmd_dpipe_table_show(struct dl *dl)
5230 {
5231 struct nlmsghdr *nlh;
5232 struct dpipe_ctx dpipe_ctx = {};
5233 struct resource_ctx resource_ctx = {};
5234 uint16_t flags = NLM_F_REQUEST;
5235 int err;
5236
5237 err = dl_argv_parse(dl, DL_OPT_HANDLE, DL_OPT_DPIPE_TABLE_NAME);
5238 if (err)
5239 return err;
5240
5241 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_HEADERS_GET, flags);
5242
5243 err = dpipe_ctx_init(&dpipe_ctx, dl);
5244 if (err)
5245 return err;
5246
5247 dpipe_ctx.print_tables = true;
5248
5249 dl_opts_put(nlh, dl);
5250 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_header_cb,
5251 &dpipe_ctx);
5252 if (err) {
5253 pr_err("error get headers %s\n", strerror(dpipe_ctx.err));
5254 goto err_headers_get;
5255 }
5256
5257 err = resource_ctx_init(&resource_ctx, dl);
5258 if (err)
5259 goto err_resource_ctx_init;
5260
5261 resource_ctx.print_resources = false;
5262 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_RESOURCE_DUMP, flags);
5263 dl_opts_put(nlh, dl);
5264 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_resource_dump_cb,
5265 &resource_ctx);
5266 if (!err)
5267 dpipe_ctx.resources = resource_ctx.resources;
5268
5269 flags = NLM_F_REQUEST | NLM_F_ACK;
5270 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_TABLE_GET, flags);
5271 dl_opts_put(nlh, dl);
5272
5273 pr_out_section_start(dl, "table");
5274 _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_table_show_cb, &dpipe_ctx);
5275 pr_out_section_end(dl);
5276
5277 resource_ctx_fini(&resource_ctx);
5278 dpipe_ctx_fini(&dpipe_ctx);
5279 return 0;
5280
5281 err_resource_ctx_init:
5282 err_headers_get:
5283 dpipe_ctx_fini(&dpipe_ctx);
5284 return err;
5285 }
5286
5287 static int cmd_dpipe_table_set(struct dl *dl)
5288 {
5289 struct nlmsghdr *nlh;
5290 int err;
5291
5292 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_TABLE_COUNTERS_SET,
5293 NLM_F_REQUEST | NLM_F_ACK);
5294
5295 err = dl_argv_parse_put(nlh, dl,
5296 DL_OPT_HANDLE | DL_OPT_DPIPE_TABLE_NAME |
5297 DL_OPT_DPIPE_TABLE_COUNTERS, 0);
5298 if (err)
5299 return err;
5300
5301 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
5302 }
5303
5304 enum dpipe_value_type {
5305 DPIPE_VALUE_TYPE_VALUE,
5306 DPIPE_VALUE_TYPE_MASK,
5307 };
5308
5309 static const char *
5310 dpipe_value_type_e2s(enum dpipe_value_type type)
5311 {
5312 switch (type) {
5313 case DPIPE_VALUE_TYPE_VALUE:
5314 return "value";
5315 case DPIPE_VALUE_TYPE_MASK:
5316 return "value_mask";
5317 default:
5318 return "<unknown>";
5319 }
5320 }
5321
5322 struct dpipe_field_printer {
5323 unsigned int field_id;
5324 void (*printer)(struct dpipe_ctx *, enum dpipe_value_type, void *);
5325 };
5326
5327 struct dpipe_header_printer {
5328 struct dpipe_field_printer *printers;
5329 unsigned int printers_count;
5330 unsigned int header_id;
5331 };
5332
5333 static void dpipe_field_printer_ipv4_addr(struct dpipe_ctx *ctx,
5334 enum dpipe_value_type type,
5335 void *value)
5336 {
5337 struct in_addr ip_addr;
5338
5339 ip_addr.s_addr = htonl(*(uint32_t *)value);
5340 pr_out_str(ctx->dl, dpipe_value_type_e2s(type), inet_ntoa(ip_addr));
5341 }
5342
5343 static void
5344 dpipe_field_printer_ethernet_addr(struct dpipe_ctx *ctx,
5345 enum dpipe_value_type type,
5346 void *value)
5347 {
5348 pr_out_str(ctx->dl, dpipe_value_type_e2s(type),
5349 ether_ntoa((struct ether_addr *)value));
5350 }
5351
5352 static void dpipe_field_printer_ipv6_addr(struct dpipe_ctx *ctx,
5353 enum dpipe_value_type type,
5354 void *value)
5355 {
5356 char str[INET6_ADDRSTRLEN];
5357
5358 inet_ntop(AF_INET6, value, str, INET6_ADDRSTRLEN);
5359 pr_out_str(ctx->dl, dpipe_value_type_e2s(type), str);
5360 }
5361
5362 static struct dpipe_field_printer dpipe_field_printers_ipv4[] = {
5363 {
5364 .printer = dpipe_field_printer_ipv4_addr,
5365 .field_id = DEVLINK_DPIPE_FIELD_IPV4_DST_IP,
5366 }
5367 };
5368
5369 static struct dpipe_header_printer dpipe_header_printer_ipv4 = {
5370 .printers = dpipe_field_printers_ipv4,
5371 .printers_count = ARRAY_SIZE(dpipe_field_printers_ipv4),
5372 .header_id = DEVLINK_DPIPE_HEADER_IPV4,
5373 };
5374
5375 static struct dpipe_field_printer dpipe_field_printers_ethernet[] = {
5376 {
5377 .printer = dpipe_field_printer_ethernet_addr,
5378 .field_id = DEVLINK_DPIPE_FIELD_ETHERNET_DST_MAC,
5379 },
5380 };
5381
5382 static struct dpipe_header_printer dpipe_header_printer_ethernet = {
5383 .printers = dpipe_field_printers_ethernet,
5384 .printers_count = ARRAY_SIZE(dpipe_field_printers_ethernet),
5385 .header_id = DEVLINK_DPIPE_HEADER_ETHERNET,
5386 };
5387
5388 static struct dpipe_field_printer dpipe_field_printers_ipv6[] = {
5389 {
5390 .printer = dpipe_field_printer_ipv6_addr,
5391 .field_id = DEVLINK_DPIPE_FIELD_IPV6_DST_IP,
5392 }
5393 };
5394
5395 static struct dpipe_header_printer dpipe_header_printer_ipv6 = {
5396 .printers = dpipe_field_printers_ipv6,
5397 .printers_count = ARRAY_SIZE(dpipe_field_printers_ipv6),
5398 .header_id = DEVLINK_DPIPE_HEADER_IPV6,
5399 };
5400
5401 static struct dpipe_header_printer *dpipe_header_printers[] = {
5402 &dpipe_header_printer_ipv4,
5403 &dpipe_header_printer_ethernet,
5404 &dpipe_header_printer_ipv6,
5405 };
5406
5407 static int dpipe_print_prot_header(struct dpipe_ctx *ctx,
5408 struct dpipe_op_info *info,
5409 enum dpipe_value_type type,
5410 void *value)
5411 {
5412 unsigned int header_printers_count = ARRAY_SIZE(dpipe_header_printers);
5413 struct dpipe_header_printer *header_printer;
5414 struct dpipe_field_printer *field_printer;
5415 unsigned int field_printers_count;
5416 int j;
5417 int i;
5418
5419 for (i = 0; i < header_printers_count; i++) {
5420 header_printer = dpipe_header_printers[i];
5421 if (header_printer->header_id != info->header_id)
5422 continue;
5423 field_printers_count = header_printer->printers_count;
5424 for (j = 0; j < field_printers_count; j++) {
5425 field_printer = &header_printer->printers[j];
5426 if (field_printer->field_id != info->field_id)
5427 continue;
5428 field_printer->printer(ctx, type, value);
5429 return 0;
5430 }
5431 }
5432
5433 return -EINVAL;
5434 }
5435
5436 static void __pr_out_entry_value(struct dpipe_ctx *ctx,
5437 void *value,
5438 unsigned int value_len,
5439 struct dpipe_op_info *info,
5440 enum dpipe_value_type type)
5441 {
5442 if (info->header_global &&
5443 !dpipe_print_prot_header(ctx, info, type, value))
5444 return;
5445
5446 if (value_len == sizeof(uint32_t)) {
5447 uint32_t *value_32 = value;
5448
5449 pr_out_uint(ctx->dl, dpipe_value_type_e2s(type), *value_32);
5450 }
5451 }
5452
5453 static void pr_out_dpipe_entry_value(struct dpipe_ctx *ctx,
5454 struct nlattr **nla_match_value,
5455 struct dpipe_op_info *info)
5456 {
5457 void *value, *value_mask;
5458 uint32_t value_mapping;
5459 uint16_t value_len;
5460 bool mask, mapping;
5461
5462 mask = !!nla_match_value[DEVLINK_ATTR_DPIPE_VALUE_MASK];
5463 mapping = !!nla_match_value[DEVLINK_ATTR_DPIPE_VALUE_MAPPING];
5464
5465 value_len = mnl_attr_get_payload_len(nla_match_value[DEVLINK_ATTR_DPIPE_VALUE]);
5466 value = mnl_attr_get_payload(nla_match_value[DEVLINK_ATTR_DPIPE_VALUE]);
5467
5468 if (mapping) {
5469 value_mapping = mnl_attr_get_u32(nla_match_value[DEVLINK_ATTR_DPIPE_VALUE_MAPPING]);
5470 pr_out_uint(ctx->dl, "mapping_value", value_mapping);
5471 }
5472
5473 if (mask) {
5474 value_mask = mnl_attr_get_payload(nla_match_value[DEVLINK_ATTR_DPIPE_VALUE]);
5475 __pr_out_entry_value(ctx, value_mask, value_len, info,
5476 DPIPE_VALUE_TYPE_MASK);
5477 }
5478
5479 __pr_out_entry_value(ctx, value, value_len, info, DPIPE_VALUE_TYPE_VALUE);
5480 }
5481
5482 static int dpipe_entry_match_value_show(struct dpipe_ctx *ctx,
5483 struct nlattr *nl)
5484 {
5485 struct nlattr *nla_match_value[DEVLINK_ATTR_MAX + 1] = {};
5486 struct dpipe_match match;
5487 int err;
5488
5489 err = mnl_attr_parse_nested(nl, attr_cb, nla_match_value);
5490 if (err != MNL_CB_OK)
5491 return -EINVAL;
5492
5493 if (!nla_match_value[DEVLINK_ATTR_DPIPE_MATCH] ||
5494 !nla_match_value[DEVLINK_ATTR_DPIPE_VALUE]) {
5495 return -EINVAL;
5496 }
5497
5498 pr_out_entry_start(ctx->dl);
5499 if (dpipe_match_parse(&match,
5500 nla_match_value[DEVLINK_ATTR_DPIPE_MATCH]))
5501 goto err_match_parse;
5502 pr_out_dpipe_match(&match, ctx);
5503 pr_out_dpipe_entry_value(ctx, nla_match_value, &match.info);
5504 pr_out_entry_end(ctx->dl);
5505
5506 return 0;
5507
5508 err_match_parse:
5509 pr_out_entry_end(ctx->dl);
5510 return -EINVAL;
5511 }
5512
5513 static int dpipe_entry_action_value_show(struct dpipe_ctx *ctx,
5514 struct nlattr *nl)
5515 {
5516 struct nlattr *nla_action_value[DEVLINK_ATTR_MAX + 1] = {};
5517 struct dpipe_action action;
5518 int err;
5519
5520 err = mnl_attr_parse_nested(nl, attr_cb, nla_action_value);
5521 if (err != MNL_CB_OK)
5522 return -EINVAL;
5523
5524 if (!nla_action_value[DEVLINK_ATTR_DPIPE_ACTION] ||
5525 !nla_action_value[DEVLINK_ATTR_DPIPE_VALUE]) {
5526 return -EINVAL;
5527 }
5528
5529 pr_out_entry_start(ctx->dl);
5530 if (dpipe_action_parse(&action,
5531 nla_action_value[DEVLINK_ATTR_DPIPE_ACTION]))
5532 goto err_action_parse;
5533 pr_out_dpipe_action(&action, ctx);
5534 pr_out_dpipe_entry_value(ctx, nla_action_value, &action.info);
5535 pr_out_entry_end(ctx->dl);
5536
5537 return 0;
5538
5539 err_action_parse:
5540 pr_out_entry_end(ctx->dl);
5541 return -EINVAL;
5542 }
5543
5544 static int
5545 dpipe_tables_action_values_show(struct dpipe_ctx *ctx,
5546 struct nlattr *nla_action_values)
5547 {
5548 struct nlattr *nla_action_value;
5549
5550 mnl_attr_for_each_nested(nla_action_value, nla_action_values) {
5551 if (dpipe_entry_action_value_show(ctx, nla_action_value))
5552 return -EINVAL;
5553 }
5554 return 0;
5555 }
5556
5557 static int
5558 dpipe_tables_match_values_show(struct dpipe_ctx *ctx,
5559 struct nlattr *nla_match_values)
5560 {
5561 struct nlattr *nla_match_value;
5562
5563 mnl_attr_for_each_nested(nla_match_value, nla_match_values) {
5564 if (dpipe_entry_match_value_show(ctx, nla_match_value))
5565 return -EINVAL;
5566 }
5567 return 0;
5568 }
5569
5570 static int dpipe_entry_show(struct dpipe_ctx *ctx, struct nlattr *nl)
5571 {
5572 struct nlattr *nla_entry[DEVLINK_ATTR_MAX + 1] = {};
5573 uint32_t entry_index;
5574 uint64_t counter;
5575 int err;
5576
5577 err = mnl_attr_parse_nested(nl, attr_cb, nla_entry);
5578 if (err != MNL_CB_OK)
5579 return -EINVAL;
5580
5581 if (!nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_INDEX] ||
5582 !nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_MATCH_VALUES] ||
5583 !nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_ACTION_VALUES]) {
5584 return -EINVAL;
5585 }
5586
5587 entry_index = mnl_attr_get_u32(nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_INDEX]);
5588 pr_out_uint(ctx->dl, "index", entry_index);
5589
5590 if (nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_COUNTER]) {
5591 counter = mnl_attr_get_u64(nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_COUNTER]);
5592 pr_out_uint(ctx->dl, "counter", counter);
5593 }
5594
5595 pr_out_array_start(ctx->dl, "match_value");
5596 if (dpipe_tables_match_values_show(ctx,
5597 nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_MATCH_VALUES]))
5598 goto err_match_values_show;
5599 pr_out_array_end(ctx->dl);
5600
5601 pr_out_array_start(ctx->dl, "action_value");
5602 if (dpipe_tables_action_values_show(ctx,
5603 nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_ACTION_VALUES]))
5604 goto err_action_values_show;
5605 pr_out_array_end(ctx->dl);
5606 return 0;
5607
5608 err_action_values_show:
5609 err_match_values_show:
5610 pr_out_array_end(ctx->dl);
5611 return -EINVAL;
5612 }
5613
5614 static int dpipe_table_entries_show(struct dpipe_ctx *ctx, struct nlattr **tb)
5615 {
5616 struct nlattr *nla_entries = tb[DEVLINK_ATTR_DPIPE_ENTRIES];
5617 struct nlattr *nla_entry;
5618
5619 mnl_attr_for_each_nested(nla_entry, nla_entries) {
5620 pr_out_handle_start_arr(ctx->dl, tb);
5621 if (dpipe_entry_show(ctx, nla_entry))
5622 goto err_entry_show;
5623 pr_out_handle_end(ctx->dl);
5624 }
5625 return 0;
5626
5627 err_entry_show:
5628 pr_out_handle_end(ctx->dl);
5629 return -EINVAL;
5630 }
5631
5632 static int cmd_dpipe_table_entry_dump_cb(const struct nlmsghdr *nlh, void *data)
5633 {
5634 struct dpipe_ctx *ctx = data;
5635 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
5636 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
5637
5638 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
5639 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
5640 !tb[DEVLINK_ATTR_DPIPE_ENTRIES])
5641 return MNL_CB_ERROR;
5642
5643 if (dpipe_table_entries_show(ctx, tb))
5644 return MNL_CB_ERROR;
5645 return MNL_CB_OK;
5646 }
5647
5648 static int cmd_dpipe_table_dump(struct dl *dl)
5649 {
5650 struct nlmsghdr *nlh;
5651 struct dpipe_ctx ctx = {};
5652 uint16_t flags = NLM_F_REQUEST;
5653 int err;
5654
5655 err = dpipe_ctx_init(&ctx, dl);
5656 if (err)
5657 return err;
5658
5659 err = dl_argv_parse(dl, DL_OPT_HANDLE | DL_OPT_DPIPE_TABLE_NAME, 0);
5660 if (err)
5661 goto out;
5662
5663 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_HEADERS_GET, flags);
5664 dl_opts_put(nlh, dl);
5665 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_header_cb, &ctx);
5666 if (err) {
5667 pr_err("error get headers %s\n", strerror(ctx.err));
5668 goto out;
5669 }
5670
5671 flags = NLM_F_REQUEST | NLM_F_ACK;
5672 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_ENTRIES_GET, flags);
5673 dl_opts_put(nlh, dl);
5674
5675 pr_out_section_start(dl, "table_entry");
5676 _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_table_entry_dump_cb, &ctx);
5677 pr_out_section_end(dl);
5678 out:
5679 dpipe_ctx_fini(&ctx);
5680 return err;
5681 }
5682
5683 static void cmd_dpipe_table_help(void)
5684 {
5685 pr_err("Usage: devlink dpipe table [ OBJECT-LIST ]\n"
5686 "where OBJECT-LIST := { show | set | dump }\n");
5687 }
5688
5689 static int cmd_dpipe_table(struct dl *dl)
5690 {
5691 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
5692 cmd_dpipe_table_help();
5693 return 0;
5694 } else if (dl_argv_match(dl, "show")) {
5695 dl_arg_inc(dl);
5696 return cmd_dpipe_table_show(dl);
5697 } else if (dl_argv_match(dl, "set")) {
5698 dl_arg_inc(dl);
5699 return cmd_dpipe_table_set(dl);
5700 } else if (dl_argv_match(dl, "dump")) {
5701 dl_arg_inc(dl);
5702 return cmd_dpipe_table_dump(dl);
5703 }
5704 pr_err("Command \"%s\" not found\n", dl_argv(dl));
5705 return -ENOENT;
5706 }
5707
5708 static void cmd_dpipe_help(void)
5709 {
5710 pr_err("Usage: devlink dpipe [ OBJECT-LIST ]\n"
5711 "where OBJECT-LIST := { header | table }\n");
5712 }
5713
5714 static int cmd_dpipe(struct dl *dl)
5715 {
5716 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
5717 cmd_dpipe_help();
5718 return 0;
5719 } else if (dl_argv_match(dl, "header")) {
5720 dl_arg_inc(dl);
5721 return cmd_dpipe_header(dl);
5722 } else if (dl_argv_match(dl, "table")) {
5723 dl_arg_inc(dl);
5724 return cmd_dpipe_table(dl);
5725 }
5726 pr_err("Command \"%s\" not found\n", dl_argv(dl));
5727 return -ENOENT;
5728 }
5729
5730 static int
5731 resource_parse(struct resource_ctx *ctx, struct resource *resource,
5732 struct nlattr **nla_resource)
5733 {
5734 if (!nla_resource[DEVLINK_ATTR_RESOURCE_NAME] ||
5735 !nla_resource[DEVLINK_ATTR_RESOURCE_SIZE] ||
5736 !nla_resource[DEVLINK_ATTR_RESOURCE_ID] ||
5737 !nla_resource[DEVLINK_ATTR_RESOURCE_UNIT] ||
5738 !nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_MIN] ||
5739 !nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_MAX] ||
5740 !nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_GRAN]) {
5741 return -EINVAL;
5742 }
5743
5744 resource->name = strdup(mnl_attr_get_str(nla_resource[DEVLINK_ATTR_RESOURCE_NAME]));
5745 resource->size = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE]);
5746 resource->id = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_ID]);
5747 resource->unit = mnl_attr_get_u8(nla_resource[DEVLINK_ATTR_RESOURCE_UNIT]);
5748 resource->size_min = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_MIN]);
5749 resource->size_max = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_MAX]);
5750 resource->size_gran = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_GRAN]);
5751
5752 if (nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_NEW])
5753 resource->size_new = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_NEW]);
5754 else
5755 resource->size_new = resource->size;
5756
5757 if (nla_resource[DEVLINK_ATTR_RESOURCE_OCC]) {
5758 resource->size_occ = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_OCC]);
5759 resource->occ_valid = true;
5760 }
5761
5762 if (resource->size_new != resource->size)
5763 ctx->pending_change = true;
5764
5765 return 0;
5766 }
5767
5768 static int
5769 resource_get(struct resource_ctx *ctx, struct resource *resource,
5770 struct resource *parent_resource, struct nlattr *nl)
5771 {
5772 struct nlattr *nla_resource[DEVLINK_ATTR_MAX + 1] = {};
5773 struct nlattr *nla_child_resource;
5774 struct nlattr *nla_resources;
5775 bool top = false;
5776 int err;
5777
5778 if (!resource) {
5779 nla_resources = nl;
5780 top = true;
5781 goto out;
5782 }
5783
5784 err = mnl_attr_parse_nested(nl, attr_cb, nla_resource);
5785 if (err != MNL_CB_OK)
5786 return -EINVAL;
5787
5788 err = resource_parse(ctx, resource, nla_resource);
5789 if (err)
5790 return err;
5791
5792 resource->parent = parent_resource;
5793 if (!nla_resource[DEVLINK_ATTR_RESOURCE_LIST])
5794 return 0;
5795
5796 resource->size_valid = !!mnl_attr_get_u8(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_VALID]);
5797 nla_resources = nla_resource[DEVLINK_ATTR_RESOURCE_LIST];
5798 out:
5799 mnl_attr_for_each_nested(nla_child_resource, nla_resources) {
5800 struct resource *child_resource;
5801 struct list_head *list;
5802
5803 child_resource = resource_alloc();
5804 if (!child_resource)
5805 return -ENOMEM;
5806
5807 if (top)
5808 list = &ctx->resources->resource_list;
5809 else
5810 list = &resource->resource_list;
5811
5812 list_add_tail(&child_resource->list, list);
5813 err = resource_get(ctx, child_resource, resource,
5814 nla_child_resource);
5815 if (err)
5816 return err;
5817 }
5818
5819 return 0;
5820 }
5821
5822 static const char *resource_unit_str_get(enum devlink_resource_unit unit)
5823 {
5824 switch (unit) {
5825 case DEVLINK_RESOURCE_UNIT_ENTRY: return "entry";
5826 default: return "<unknown unit>";
5827 }
5828 }
5829
5830 static void resource_show(struct resource *resource,
5831 struct resource_ctx *ctx)
5832 {
5833 struct resource *child_resource;
5834 struct dpipe_table *table;
5835 struct dl *dl = ctx->dl;
5836 bool array = false;
5837
5838 pr_out_str(dl, "name", resource->name);
5839 if (dl->verbose)
5840 resource_path_print(dl, ctx->resources, resource->id);
5841 pr_out_u64(dl, "size", resource->size);
5842 if (resource->size != resource->size_new)
5843 pr_out_u64(dl, "size_new", resource->size_new);
5844 if (resource->occ_valid)
5845 pr_out_uint(dl, "occ", resource->size_occ);
5846 pr_out_str(dl, "unit", resource_unit_str_get(resource->unit));
5847
5848 if (resource->size_min != resource->size_max) {
5849 pr_out_uint(dl, "size_min", resource->size_min);
5850 pr_out_u64(dl, "size_max", resource->size_max);
5851 pr_out_uint(dl, "size_gran", resource->size_gran);
5852 }
5853
5854 list_for_each_entry(table, &ctx->tables->table_list, list)
5855 if (table->resource_id == resource->id &&
5856 table->resource_valid)
5857 array = true;
5858
5859 if (array)
5860 pr_out_array_start(dl, "dpipe_tables");
5861 else
5862 pr_out_str(dl, "dpipe_tables", "none");
5863
5864 list_for_each_entry(table, &ctx->tables->table_list, list) {
5865 if (table->resource_id != resource->id ||
5866 !table->resource_valid)
5867 continue;
5868 pr_out_entry_start(dl);
5869 pr_out_str(dl, "table_name", table->name);
5870 pr_out_entry_end(dl);
5871 }
5872 if (array)
5873 pr_out_array_end(dl);
5874
5875 if (list_empty(&resource->resource_list))
5876 return;
5877
5878 if (ctx->pending_change)
5879 pr_out_str(dl, "size_valid", resource->size_valid ?
5880 "true" : "false");
5881 pr_out_array_start(dl, "resources");
5882 list_for_each_entry(child_resource, &resource->resource_list, list) {
5883 pr_out_entry_start(dl);
5884 resource_show(child_resource, ctx);
5885 pr_out_entry_end(dl);
5886 }
5887 pr_out_array_end(dl);
5888 }
5889
5890 static void
5891 resources_show(struct resource_ctx *ctx, struct nlattr **tb)
5892 {
5893 struct resources *resources = ctx->resources;
5894 struct resource *resource;
5895
5896 list_for_each_entry(resource, &resources->resource_list, list) {
5897 pr_out_handle_start_arr(ctx->dl, tb);
5898 resource_show(resource, ctx);
5899 pr_out_handle_end(ctx->dl);
5900 }
5901 }
5902
5903 static int resources_get(struct resource_ctx *ctx, struct nlattr **tb)
5904 {
5905 return resource_get(ctx, NULL, NULL, tb[DEVLINK_ATTR_RESOURCE_LIST]);
5906 }
5907
5908 static int cmd_resource_dump_cb(const struct nlmsghdr *nlh, void *data)
5909 {
5910 struct resource_ctx *ctx = data;
5911 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
5912 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
5913 int err;
5914
5915 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
5916 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
5917 !tb[DEVLINK_ATTR_RESOURCE_LIST])
5918 return MNL_CB_ERROR;
5919
5920 err = resources_get(ctx, tb);
5921 if (err) {
5922 ctx->err = err;
5923 return MNL_CB_ERROR;
5924 }
5925
5926 if (ctx->print_resources)
5927 resources_show(ctx, tb);
5928
5929 return MNL_CB_OK;
5930 }
5931
5932 static int cmd_resource_show(struct dl *dl)
5933 {
5934 struct nlmsghdr *nlh;
5935 struct dpipe_ctx dpipe_ctx = {};
5936 struct resource_ctx resource_ctx = {};
5937 int err;
5938
5939 err = dl_argv_parse(dl, DL_OPT_HANDLE, 0);
5940 if (err)
5941 return err;
5942
5943 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_TABLE_GET,
5944 NLM_F_REQUEST);
5945 dl_opts_put(nlh, dl);
5946
5947 err = dpipe_ctx_init(&dpipe_ctx, dl);
5948 if (err)
5949 return err;
5950
5951 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_table_show_cb,
5952 &dpipe_ctx);
5953 if (err) {
5954 pr_err("error get tables %s\n", strerror(dpipe_ctx.err));
5955 goto out;
5956 }
5957
5958 err = resource_ctx_init(&resource_ctx, dl);
5959 if (err)
5960 goto out;
5961
5962 resource_ctx.print_resources = true;
5963 resource_ctx.tables = dpipe_ctx.tables;
5964 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_RESOURCE_DUMP,
5965 NLM_F_REQUEST | NLM_F_ACK);
5966 dl_opts_put(nlh, dl);
5967 pr_out_section_start(dl, "resources");
5968 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_resource_dump_cb,
5969 &resource_ctx);
5970 pr_out_section_end(dl);
5971 resource_ctx_fini(&resource_ctx);
5972 out:
5973 dpipe_ctx_fini(&dpipe_ctx);
5974 return err;
5975 }
5976
5977 static void cmd_resource_help(void)
5978 {
5979 pr_err("Usage: devlink resource show DEV\n"
5980 " devlink resource set DEV path PATH size SIZE\n");
5981 }
5982
5983 static struct resource *
5984 resource_find_by_name(struct list_head *list, char *name)
5985 {
5986 struct resource *resource;
5987
5988 list_for_each_entry(resource, list, list) {
5989 if (!strcmp(resource->name, name))
5990 return resource;
5991 }
5992 return NULL;
5993 }
5994
5995 static int
5996 resource_path_parse(struct resource_ctx *ctx, const char *resource_path,
5997 uint32_t *p_resource_id, bool *p_resource_valid)
5998 {
5999 struct resource *resource;
6000 uint32_t resource_id = 0;
6001 char *resource_path_dup;
6002 struct list_head *list;
6003 const char del[] = "/";
6004 char *resource_name;
6005
6006 resource_path_dup = strdup(resource_path);
6007 list = &ctx->resources->resource_list;
6008 resource_name = strtok(resource_path_dup, del);
6009 while (resource_name != NULL) {
6010 resource = resource_find_by_name(list, resource_name);
6011 if (!resource)
6012 goto err_resource_lookup;
6013
6014 list = &resource->resource_list;
6015 resource_name = strtok(NULL, del);
6016 resource_id = resource->id;
6017 }
6018 free(resource_path_dup);
6019 *p_resource_valid = true;
6020 *p_resource_id = resource_id;
6021 return 0;
6022
6023 err_resource_lookup:
6024 free(resource_path_dup);
6025 return -EINVAL;
6026 }
6027
6028 static int cmd_resource_set(struct dl *dl)
6029 {
6030 struct nlmsghdr *nlh;
6031 struct resource_ctx ctx = {};
6032 int err;
6033
6034 err = resource_ctx_init(&ctx, dl);
6035 if (err)
6036 return err;
6037
6038 ctx.print_resources = false;
6039 err = dl_argv_parse(dl, DL_OPT_HANDLE | DL_OPT_RESOURCE_PATH |
6040 DL_OPT_RESOURCE_SIZE, 0);
6041 if (err)
6042 goto out;
6043
6044 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_RESOURCE_DUMP,
6045 NLM_F_REQUEST);
6046 dl_opts_put(nlh, dl);
6047 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_resource_dump_cb, &ctx);
6048 if (err) {
6049 pr_err("error getting resources %s\n", strerror(ctx.err));
6050 goto out;
6051 }
6052
6053 err = resource_path_parse(&ctx, dl->opts.resource_path,
6054 &dl->opts.resource_id,
6055 &dl->opts.resource_id_valid);
6056 if (err) {
6057 pr_err("error parsing resource path %s\n", strerror(-err));
6058 goto out;
6059 }
6060
6061 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_RESOURCE_SET,
6062 NLM_F_REQUEST | NLM_F_ACK);
6063
6064 dl_opts_put(nlh, dl);
6065 err = _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
6066 out:
6067 resource_ctx_fini(&ctx);
6068 return err;
6069 }
6070
6071 static int cmd_resource(struct dl *dl)
6072 {
6073 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
6074 cmd_resource_help();
6075 return 0;
6076 } else if (dl_argv_match(dl, "show")) {
6077 dl_arg_inc(dl);
6078 return cmd_resource_show(dl);
6079 } else if (dl_argv_match(dl, "set")) {
6080 dl_arg_inc(dl);
6081 return cmd_resource_set(dl);
6082 }
6083 pr_err("Command \"%s\" not found\n", dl_argv(dl));
6084 return -ENOENT;
6085 }
6086
6087 static void pr_out_region_handle_start(struct dl *dl, struct nlattr **tb)
6088 {
6089 const char *bus_name = mnl_attr_get_str(tb[DEVLINK_ATTR_BUS_NAME]);
6090 const char *dev_name = mnl_attr_get_str(tb[DEVLINK_ATTR_DEV_NAME]);
6091 const char *region_name = mnl_attr_get_str(tb[DEVLINK_ATTR_REGION_NAME]);
6092 char buf[256];
6093
6094 sprintf(buf, "%s/%s/%s", bus_name, dev_name, region_name);
6095 if (dl->json_output) {
6096 jsonw_name(dl->jw, buf);
6097 jsonw_start_object(dl->jw);
6098 } else {
6099 pr_out("%s:", buf);
6100 }
6101 }
6102
6103 static void pr_out_region_handle_end(struct dl *dl)
6104 {
6105 if (dl->json_output)
6106 jsonw_end_object(dl->jw);
6107 else
6108 pr_out("\n");
6109 }
6110
6111 static void pr_out_region_snapshots_start(struct dl *dl, bool array)
6112 {
6113 if (dl->json_output) {
6114 jsonw_name(dl->jw, "snapshot");
6115 jsonw_start_array(dl->jw);
6116 } else {
6117 if (g_indent_newline)
6118 pr_out("snapshot %s", array ? "[" : "");
6119 else
6120 pr_out(" snapshot %s", array ? "[" : "");
6121 }
6122 }
6123
6124 static void pr_out_region_snapshots_end(struct dl *dl, bool array)
6125 {
6126 if (dl->json_output)
6127 jsonw_end_array(dl->jw);
6128 else if (array)
6129 pr_out("]");
6130 }
6131
6132 static void pr_out_region_snapshots_id(struct dl *dl, struct nlattr **tb, int index)
6133 {
6134 uint32_t snapshot_id;
6135
6136 if (!tb[DEVLINK_ATTR_REGION_SNAPSHOT_ID])
6137 return;
6138
6139 snapshot_id = mnl_attr_get_u32(tb[DEVLINK_ATTR_REGION_SNAPSHOT_ID]);
6140
6141 if (dl->json_output)
6142 jsonw_uint(dl->jw, snapshot_id);
6143 else
6144 pr_out("%s%u", index ? " " : "", snapshot_id);
6145 }
6146
6147 static void pr_out_snapshots(struct dl *dl, struct nlattr **tb)
6148 {
6149 struct nlattr *tb_snapshot[DEVLINK_ATTR_MAX + 1] = {};
6150 struct nlattr *nla_sanpshot;
6151 int err, index = 0;
6152
6153 pr_out_region_snapshots_start(dl, true);
6154 mnl_attr_for_each_nested(nla_sanpshot, tb[DEVLINK_ATTR_REGION_SNAPSHOTS]) {
6155 err = mnl_attr_parse_nested(nla_sanpshot, attr_cb, tb_snapshot);
6156 if (err != MNL_CB_OK)
6157 return;
6158 pr_out_region_snapshots_id(dl, tb_snapshot, index++);
6159 }
6160 pr_out_region_snapshots_end(dl, true);
6161 }
6162
6163 static void pr_out_snapshot(struct dl *dl, struct nlattr **tb)
6164 {
6165 pr_out_region_snapshots_start(dl, false);
6166 pr_out_region_snapshots_id(dl, tb, 0);
6167 pr_out_region_snapshots_end(dl, false);
6168 }
6169
6170 static void pr_out_region(struct dl *dl, struct nlattr **tb)
6171 {
6172 pr_out_region_handle_start(dl, tb);
6173
6174 if (tb[DEVLINK_ATTR_REGION_SIZE])
6175 pr_out_u64(dl, "size",
6176 mnl_attr_get_u64(tb[DEVLINK_ATTR_REGION_SIZE]));
6177
6178 if (tb[DEVLINK_ATTR_REGION_SNAPSHOTS])
6179 pr_out_snapshots(dl, tb);
6180
6181 if (tb[DEVLINK_ATTR_REGION_SNAPSHOT_ID])
6182 pr_out_snapshot(dl, tb);
6183
6184 pr_out_region_handle_end(dl);
6185 }
6186
6187 static int cmd_region_show_cb(const struct nlmsghdr *nlh, void *data)
6188 {
6189 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
6190 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
6191 struct dl *dl = data;
6192
6193 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
6194 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
6195 !tb[DEVLINK_ATTR_REGION_NAME] || !tb[DEVLINK_ATTR_REGION_SIZE])
6196 return MNL_CB_ERROR;
6197
6198 pr_out_region(dl, tb);
6199
6200 return MNL_CB_OK;
6201 }
6202
6203 static int cmd_region_show(struct dl *dl)
6204 {
6205 struct nlmsghdr *nlh;
6206 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
6207 int err;
6208
6209 if (dl_argc(dl) == 0)
6210 flags |= NLM_F_DUMP;
6211
6212 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_REGION_GET, flags);
6213
6214 if (dl_argc(dl) > 0) {
6215 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE_REGION, 0);
6216 if (err)
6217 return err;
6218 }
6219
6220 pr_out_section_start(dl, "regions");
6221 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_region_show_cb, dl);
6222 pr_out_section_end(dl);
6223 return err;
6224 }
6225
6226 static int cmd_region_snapshot_del(struct dl *dl)
6227 {
6228 struct nlmsghdr *nlh;
6229 int err;
6230
6231 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_REGION_DEL,
6232 NLM_F_REQUEST | NLM_F_ACK);
6233
6234 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE_REGION |
6235 DL_OPT_REGION_SNAPSHOT_ID, 0);
6236 if (err)
6237 return err;
6238
6239 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
6240 }
6241
6242 static int cmd_region_read_cb(const struct nlmsghdr *nlh, void *data)
6243 {
6244 struct nlattr *nla_entry, *nla_chunk_data, *nla_chunk_addr;
6245 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
6246 struct nlattr *tb_field[DEVLINK_ATTR_MAX + 1] = {};
6247 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
6248 struct dl *dl = data;
6249 int err;
6250
6251 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
6252 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
6253 !tb[DEVLINK_ATTR_REGION_CHUNKS])
6254 return MNL_CB_ERROR;
6255
6256 mnl_attr_for_each_nested(nla_entry, tb[DEVLINK_ATTR_REGION_CHUNKS]) {
6257 err = mnl_attr_parse_nested(nla_entry, attr_cb, tb_field);
6258 if (err != MNL_CB_OK)
6259 return MNL_CB_ERROR;
6260
6261 nla_chunk_data = tb_field[DEVLINK_ATTR_REGION_CHUNK_DATA];
6262 if (!nla_chunk_data)
6263 continue;
6264
6265 nla_chunk_addr = tb_field[DEVLINK_ATTR_REGION_CHUNK_ADDR];
6266 if (!nla_chunk_addr)
6267 continue;
6268
6269 pr_out_region_chunk(dl, mnl_attr_get_payload(nla_chunk_data),
6270 mnl_attr_get_payload_len(nla_chunk_data),
6271 mnl_attr_get_u64(nla_chunk_addr));
6272 }
6273 return MNL_CB_OK;
6274 }
6275
6276 static int cmd_region_dump(struct dl *dl)
6277 {
6278 struct nlmsghdr *nlh;
6279 int err;
6280
6281 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_REGION_READ,
6282 NLM_F_REQUEST | NLM_F_ACK | NLM_F_DUMP);
6283
6284 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE_REGION |
6285 DL_OPT_REGION_SNAPSHOT_ID, 0);
6286 if (err)
6287 return err;
6288
6289 pr_out_section_start(dl, "dump");
6290 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_region_read_cb, dl);
6291 pr_out_section_end(dl);
6292 if (!dl->json_output)
6293 pr_out("\n");
6294 return err;
6295 }
6296
6297 static int cmd_region_read(struct dl *dl)
6298 {
6299 struct nlmsghdr *nlh;
6300 int err;
6301
6302 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_REGION_READ,
6303 NLM_F_REQUEST | NLM_F_ACK | NLM_F_DUMP);
6304
6305 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE_REGION |
6306 DL_OPT_REGION_ADDRESS | DL_OPT_REGION_LENGTH |
6307 DL_OPT_REGION_SNAPSHOT_ID, 0);
6308 if (err)
6309 return err;
6310
6311 pr_out_section_start(dl, "read");
6312 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_region_read_cb, dl);
6313 pr_out_section_end(dl);
6314 if (!dl->json_output)
6315 pr_out("\n");
6316 return err;
6317 }
6318
6319 static void cmd_region_help(void)
6320 {
6321 pr_err("Usage: devlink region show [ DEV/REGION ]\n");
6322 pr_err(" devlink region del DEV/REGION snapshot SNAPSHOT_ID\n");
6323 pr_err(" devlink region dump DEV/REGION [ snapshot SNAPSHOT_ID ]\n");
6324 pr_err(" devlink region read DEV/REGION [ snapshot SNAPSHOT_ID ] address ADDRESS length LENGTH\n");
6325 }
6326
6327 static int cmd_region(struct dl *dl)
6328 {
6329 if (dl_no_arg(dl)) {
6330 return cmd_region_show(dl);
6331 } else if (dl_argv_match(dl, "help")) {
6332 cmd_region_help();
6333 return 0;
6334 } else if (dl_argv_match(dl, "show")) {
6335 dl_arg_inc(dl);
6336 return cmd_region_show(dl);
6337 } else if (dl_argv_match(dl, "del")) {
6338 dl_arg_inc(dl);
6339 return cmd_region_snapshot_del(dl);
6340 } else if (dl_argv_match(dl, "dump")) {
6341 dl_arg_inc(dl);
6342 return cmd_region_dump(dl);
6343 } else if (dl_argv_match(dl, "read")) {
6344 dl_arg_inc(dl);
6345 return cmd_region_read(dl);
6346 }
6347 pr_err("Command \"%s\" not found\n", dl_argv(dl));
6348 return -ENOENT;
6349 }
6350
6351 static int cmd_health_set_params(struct dl *dl)
6352 {
6353 struct nlmsghdr *nlh;
6354 int err;
6355
6356 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_HEALTH_REPORTER_SET,
6357 NLM_F_REQUEST | NLM_F_ACK);
6358 err = dl_argv_parse(dl, DL_OPT_HANDLE | DL_OPT_HEALTH_REPORTER_NAME,
6359 DL_OPT_HEALTH_REPORTER_GRACEFUL_PERIOD |
6360 DL_OPT_HEALTH_REPORTER_AUTO_RECOVER);
6361 if (err)
6362 return err;
6363
6364 dl_opts_put(nlh, dl);
6365 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
6366 }
6367
6368 static int cmd_health_dump_clear(struct dl *dl)
6369 {
6370 struct nlmsghdr *nlh;
6371 int err;
6372
6373 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_HEALTH_REPORTER_DUMP_CLEAR,
6374 NLM_F_REQUEST | NLM_F_ACK);
6375
6376 err = dl_argv_parse_put(nlh, dl,
6377 DL_OPT_HANDLE | DL_OPT_HEALTH_REPORTER_NAME, 0);
6378 if (err)
6379 return err;
6380
6381 dl_opts_put(nlh, dl);
6382 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
6383 }
6384
6385 static int fmsg_value_show(struct dl *dl, int type, struct nlattr *nl_data)
6386 {
6387 uint8_t *data;
6388 uint32_t len;
6389
6390 switch (type) {
6391 case MNL_TYPE_FLAG:
6392 pr_out_bool_value(dl, mnl_attr_get_u8(nl_data));
6393 break;
6394 case MNL_TYPE_U8:
6395 pr_out_uint_value(dl, mnl_attr_get_u8(nl_data));
6396 break;
6397 case MNL_TYPE_U16:
6398 pr_out_uint_value(dl, mnl_attr_get_u16(nl_data));
6399 break;
6400 case MNL_TYPE_U32:
6401 pr_out_uint_value(dl, mnl_attr_get_u32(nl_data));
6402 break;
6403 case MNL_TYPE_U64:
6404 pr_out_uint64_value(dl, mnl_attr_get_u64(nl_data));
6405 break;
6406 case MNL_TYPE_NUL_STRING:
6407 pr_out_str_value(dl, mnl_attr_get_str(nl_data));
6408 break;
6409 case MNL_TYPE_BINARY:
6410 len = mnl_attr_get_payload_len(nl_data);
6411 data = mnl_attr_get_payload(nl_data);
6412 pr_out_binary_value(dl, data, len);
6413 break;
6414 default:
6415 return -EINVAL;
6416 }
6417 return MNL_CB_OK;
6418 }
6419
6420 struct nest_entry {
6421 int attr_type;
6422 struct list_head list;
6423 };
6424
6425 struct fmsg_cb_data {
6426 struct dl *dl;
6427 uint8_t value_type;
6428 struct list_head entry_list;
6429 };
6430
6431 static int cmd_fmsg_nest_queue(struct fmsg_cb_data *fmsg_data,
6432 uint8_t *attr_value, bool insert)
6433 {
6434 struct nest_entry *entry;
6435
6436 if (insert) {
6437 entry = malloc(sizeof(struct nest_entry));
6438 if (!entry)
6439 return -ENOMEM;
6440
6441 entry->attr_type = *attr_value;
6442 list_add(&entry->list, &fmsg_data->entry_list);
6443 } else {
6444 if (list_empty(&fmsg_data->entry_list))
6445 return MNL_CB_ERROR;
6446 entry = list_first_entry(&fmsg_data->entry_list,
6447 struct nest_entry, list);
6448 *attr_value = entry->attr_type;
6449 list_del(&entry->list);
6450 free(entry);
6451 }
6452 return MNL_CB_OK;
6453 }
6454
6455 static int cmd_fmsg_nest(struct fmsg_cb_data *fmsg_data, uint8_t nest_value,
6456 bool start)
6457 {
6458 struct dl *dl = fmsg_data->dl;
6459 uint8_t value = nest_value;
6460 int err;
6461
6462 err = cmd_fmsg_nest_queue(fmsg_data, &value, start);
6463 if (err != MNL_CB_OK)
6464 return err;
6465
6466 switch (value) {
6467 case DEVLINK_ATTR_FMSG_OBJ_NEST_START:
6468 if (start)
6469 pr_out_entry_start(dl);
6470 else
6471 pr_out_entry_end(dl);
6472 break;
6473 case DEVLINK_ATTR_FMSG_PAIR_NEST_START:
6474 break;
6475 case DEVLINK_ATTR_FMSG_ARR_NEST_START:
6476 if (dl->json_output) {
6477 if (start)
6478 jsonw_start_array(dl->jw);
6479 else
6480 jsonw_end_array(dl->jw);
6481 } else {
6482 if (start) {
6483 __pr_out_newline();
6484 __pr_out_indent_inc();
6485 } else {
6486 __pr_out_indent_dec();
6487 }
6488 }
6489 break;
6490 default:
6491 return -EINVAL;
6492 }
6493 return MNL_CB_OK;
6494 }
6495
6496 static int cmd_fmsg_object_cb(const struct nlmsghdr *nlh, void *data)
6497 {
6498 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
6499 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
6500 struct fmsg_cb_data *fmsg_data = data;
6501 struct dl *dl = fmsg_data->dl;
6502 struct nlattr *nla_object;
6503 int attr_type;
6504 int err;
6505
6506 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
6507 if (!tb[DEVLINK_ATTR_FMSG])
6508 return MNL_CB_ERROR;
6509
6510 mnl_attr_for_each_nested(nla_object, tb[DEVLINK_ATTR_FMSG]) {
6511 attr_type = mnl_attr_get_type(nla_object);
6512 switch (attr_type) {
6513 case DEVLINK_ATTR_FMSG_OBJ_NEST_START:
6514 case DEVLINK_ATTR_FMSG_PAIR_NEST_START:
6515 case DEVLINK_ATTR_FMSG_ARR_NEST_START:
6516 err = cmd_fmsg_nest(fmsg_data, attr_type, true);
6517 if (err != MNL_CB_OK)
6518 return err;
6519 break;
6520 case DEVLINK_ATTR_FMSG_NEST_END:
6521 err = cmd_fmsg_nest(fmsg_data, attr_type, false);
6522 if (err != MNL_CB_OK)
6523 return err;
6524 break;
6525 case DEVLINK_ATTR_FMSG_OBJ_NAME:
6526 pr_out_name(dl, mnl_attr_get_str(nla_object));
6527 break;
6528 case DEVLINK_ATTR_FMSG_OBJ_VALUE_TYPE:
6529 fmsg_data->value_type = mnl_attr_get_u8(nla_object);
6530 break;
6531 case DEVLINK_ATTR_FMSG_OBJ_VALUE_DATA:
6532 err = fmsg_value_show(dl, fmsg_data->value_type,
6533 nla_object);
6534 if (err != MNL_CB_OK)
6535 return err;
6536 break;
6537 default:
6538 return -EINVAL;
6539 }
6540 }
6541 return MNL_CB_OK;
6542 }
6543
6544 static int cmd_health_object_common(struct dl *dl, uint8_t cmd, uint16_t flags)
6545 {
6546 struct fmsg_cb_data data;
6547 struct nlmsghdr *nlh;
6548 int err;
6549
6550 nlh = mnlg_msg_prepare(dl->nlg, cmd, flags | NLM_F_REQUEST | NLM_F_ACK);
6551
6552 err = dl_argv_parse_put(nlh, dl,
6553 DL_OPT_HANDLE | DL_OPT_HEALTH_REPORTER_NAME, 0);
6554 if (err)
6555 return err;
6556
6557 data.dl = dl;
6558 INIT_LIST_HEAD(&data.entry_list);
6559 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_fmsg_object_cb, &data);
6560 return err;
6561 }
6562
6563 static int cmd_health_dump_show(struct dl *dl)
6564 {
6565 return cmd_health_object_common(dl,
6566 DEVLINK_CMD_HEALTH_REPORTER_DUMP_GET,
6567 NLM_F_DUMP);
6568 }
6569
6570 static int cmd_health_diagnose(struct dl *dl)
6571 {
6572 return cmd_health_object_common(dl,
6573 DEVLINK_CMD_HEALTH_REPORTER_DIAGNOSE,
6574 0);
6575 }
6576
6577 static int cmd_health_recover(struct dl *dl)
6578 {
6579 struct nlmsghdr *nlh;
6580 int err;
6581
6582 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_HEALTH_REPORTER_RECOVER,
6583 NLM_F_REQUEST | NLM_F_ACK);
6584
6585 err = dl_argv_parse_put(nlh, dl,
6586 DL_OPT_HANDLE | DL_OPT_HEALTH_REPORTER_NAME, 0);
6587 if (err)
6588 return err;
6589
6590 dl_opts_put(nlh, dl);
6591 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
6592 }
6593
6594 enum devlink_health_reporter_state {
6595 DEVLINK_HEALTH_REPORTER_STATE_HEALTHY,
6596 DEVLINK_HEALTH_REPORTER_STATE_ERROR,
6597 };
6598
6599 static const char *health_state_name(uint8_t state)
6600 {
6601 switch (state) {
6602 case DEVLINK_HEALTH_REPORTER_STATE_HEALTHY:
6603 return HEALTH_REPORTER_STATE_HEALTHY_STR;
6604 case DEVLINK_HEALTH_REPORTER_STATE_ERROR:
6605 return HEALTH_REPORTER_STATE_ERROR_STR;
6606 default:
6607 return "<unknown state>";
6608 }
6609 }
6610
6611 static void format_logtime(uint64_t time_ms, char *ts_date, char *ts_time)
6612 {
6613 struct sysinfo s_info;
6614 struct tm *info;
6615 time_t now, sec;
6616 int err;
6617
6618 time(&now);
6619 info = localtime(&now);
6620 err = sysinfo(&s_info);
6621 if (err)
6622 goto out;
6623 /* Subtract uptime in sec from now yields the time of system
6624 * uptime. To this, add time_ms which is the amount of
6625 * milliseconds elapsed between uptime and the dump taken.
6626 */
6627 sec = now - s_info.uptime + time_ms / 1000;
6628 info = localtime(&sec);
6629 out:
6630 strftime(ts_date, HEALTH_REPORTER_TIMESTAMP_FMT_LEN, "%Y-%m-%d", info);
6631 strftime(ts_time, HEALTH_REPORTER_TIMESTAMP_FMT_LEN, "%H:%M:%S", info);
6632 }
6633
6634 static void pr_out_health(struct dl *dl, struct nlattr **tb_health)
6635 {
6636 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
6637 enum devlink_health_reporter_state state;
6638 const struct nlattr *attr;
6639 uint64_t time_ms;
6640 int err;
6641
6642 err = mnl_attr_parse_nested(tb_health[DEVLINK_ATTR_HEALTH_REPORTER],
6643 attr_cb, tb);
6644 if (err != MNL_CB_OK)
6645 return;
6646
6647 if (!tb[DEVLINK_ATTR_HEALTH_REPORTER_NAME] ||
6648 !tb[DEVLINK_ATTR_HEALTH_REPORTER_ERR_COUNT] ||
6649 !tb[DEVLINK_ATTR_HEALTH_REPORTER_RECOVER_COUNT] ||
6650 !tb[DEVLINK_ATTR_HEALTH_REPORTER_STATE])
6651 return;
6652
6653 pr_out_handle_start_arr(dl, tb_health);
6654
6655 pr_out_str(dl, "name",
6656 mnl_attr_get_str(tb[DEVLINK_ATTR_HEALTH_REPORTER_NAME]));
6657 if (!dl->json_output) {
6658 __pr_out_newline();
6659 __pr_out_indent_inc();
6660 }
6661 state = mnl_attr_get_u8(tb[DEVLINK_ATTR_HEALTH_REPORTER_STATE]);
6662 pr_out_str(dl, "state", health_state_name(state));
6663 pr_out_u64(dl, "error",
6664 mnl_attr_get_u64(tb[DEVLINK_ATTR_HEALTH_REPORTER_ERR_COUNT]));
6665 pr_out_u64(dl, "recover",
6666 mnl_attr_get_u64(tb[DEVLINK_ATTR_HEALTH_REPORTER_RECOVER_COUNT]));
6667 if (tb[DEVLINK_ATTR_HEALTH_REPORTER_DUMP_TS]) {
6668 char dump_date[HEALTH_REPORTER_TIMESTAMP_FMT_LEN];
6669 char dump_time[HEALTH_REPORTER_TIMESTAMP_FMT_LEN];
6670
6671 attr = tb[DEVLINK_ATTR_HEALTH_REPORTER_DUMP_TS];
6672 time_ms = mnl_attr_get_u64(attr);
6673 format_logtime(time_ms, dump_date, dump_time);
6674
6675 pr_out_str(dl, "last_dump_date", dump_date);
6676 pr_out_str(dl, "last_dump_time", dump_time);
6677 }
6678 if (tb[DEVLINK_ATTR_HEALTH_REPORTER_GRACEFUL_PERIOD])
6679 pr_out_u64(dl, "grace_period",
6680 mnl_attr_get_u64(tb[DEVLINK_ATTR_HEALTH_REPORTER_GRACEFUL_PERIOD]));
6681 if (tb[DEVLINK_ATTR_HEALTH_REPORTER_AUTO_RECOVER])
6682 pr_out_bool(dl, "auto_recover",
6683 mnl_attr_get_u8(tb[DEVLINK_ATTR_HEALTH_REPORTER_AUTO_RECOVER]));
6684
6685 __pr_out_indent_dec();
6686 pr_out_handle_end(dl);
6687 }
6688
6689 static int cmd_health_show_cb(const struct nlmsghdr *nlh, void *data)
6690 {
6691 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
6692 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
6693 struct dl *dl = data;
6694
6695 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
6696 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
6697 !tb[DEVLINK_ATTR_HEALTH_REPORTER])
6698 return MNL_CB_ERROR;
6699
6700 pr_out_health(dl, tb);
6701
6702 return MNL_CB_OK;
6703 }
6704
6705 static int cmd_health_show(struct dl *dl)
6706 {
6707 struct nlmsghdr *nlh;
6708 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
6709 int err;
6710
6711 if (dl_argc(dl) == 0)
6712 flags |= NLM_F_DUMP;
6713 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_HEALTH_REPORTER_GET,
6714 flags);
6715
6716 if (dl_argc(dl) > 0) {
6717 err = dl_argv_parse_put(nlh, dl,
6718 DL_OPT_HANDLE |
6719 DL_OPT_HEALTH_REPORTER_NAME, 0);
6720 if (err)
6721 return err;
6722 }
6723 pr_out_section_start(dl, "health");
6724
6725 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_health_show_cb, dl);
6726 pr_out_section_end(dl);
6727 return err;
6728 }
6729
6730 static void cmd_health_help(void)
6731 {
6732 pr_err("Usage: devlink health show [ dev DEV reporter REPORTER_NAME ]\n");
6733 pr_err(" devlink health recover DEV reporter REPORTER_NAME\n");
6734 pr_err(" devlink health diagnose DEV reporter REPORTER_NAME\n");
6735 pr_err(" devlink health dump show DEV reporter REPORTER_NAME\n");
6736 pr_err(" devlink health dump clear DEV reporter REPORTER_NAME\n");
6737 pr_err(" devlink health set DEV reporter REPORTER_NAME { grace_period | auto_recover } { msec | boolean }\n");
6738 }
6739
6740 static int cmd_health(struct dl *dl)
6741 {
6742 if (dl_argv_match(dl, "help")) {
6743 cmd_health_help();
6744 return 0;
6745 } else if (dl_argv_match(dl, "show") ||
6746 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
6747 dl_arg_inc(dl);
6748 return cmd_health_show(dl);
6749 } else if (dl_argv_match(dl, "recover")) {
6750 dl_arg_inc(dl);
6751 return cmd_health_recover(dl);
6752 } else if (dl_argv_match(dl, "diagnose")) {
6753 dl_arg_inc(dl);
6754 return cmd_health_diagnose(dl);
6755 } else if (dl_argv_match(dl, "dump")) {
6756 dl_arg_inc(dl);
6757 if (dl_argv_match(dl, "show")) {
6758 dl_arg_inc(dl);
6759 return cmd_health_dump_show(dl);
6760 } else if (dl_argv_match(dl, "clear")) {
6761 dl_arg_inc(dl);
6762 return cmd_health_dump_clear(dl);
6763 }
6764 } else if (dl_argv_match(dl, "set")) {
6765 dl_arg_inc(dl);
6766 return cmd_health_set_params(dl);
6767 }
6768 pr_err("Command \"%s\" not found\n", dl_argv(dl));
6769 return -ENOENT;
6770 }
6771
6772 static const char *trap_type_name(uint8_t type)
6773 {
6774 switch (type) {
6775 case DEVLINK_TRAP_TYPE_DROP:
6776 return "drop";
6777 case DEVLINK_TRAP_TYPE_EXCEPTION:
6778 return "exception";
6779 default:
6780 return "<unknown type>";
6781 }
6782 }
6783
6784 static const char *trap_action_name(uint8_t action)
6785 {
6786 switch (action) {
6787 case DEVLINK_TRAP_ACTION_DROP:
6788 return "drop";
6789 case DEVLINK_TRAP_ACTION_TRAP:
6790 return "trap";
6791 default:
6792 return "<unknown action>";
6793 }
6794 }
6795
6796 static const char *trap_metadata_name(const struct nlattr *attr)
6797 {
6798 switch (attr->nla_type) {
6799 case DEVLINK_ATTR_TRAP_METADATA_TYPE_IN_PORT:
6800 return "input_port";
6801 default:
6802 return "<unknown metadata type>";
6803 }
6804 }
6805 static void pr_out_trap_metadata(struct dl *dl, struct nlattr *attr)
6806 {
6807 struct nlattr *attr_metadata;
6808
6809 pr_out_array_start(dl, "metadata");
6810 mnl_attr_for_each_nested(attr_metadata, attr)
6811 pr_out_str_value(dl, trap_metadata_name(attr_metadata));
6812 pr_out_array_end(dl);
6813 }
6814
6815 static void pr_out_trap(struct dl *dl, struct nlattr **tb, bool array)
6816 {
6817 uint8_t action = mnl_attr_get_u8(tb[DEVLINK_ATTR_TRAP_ACTION]);
6818 uint8_t type = mnl_attr_get_u8(tb[DEVLINK_ATTR_TRAP_TYPE]);
6819
6820 if (array)
6821 pr_out_handle_start_arr(dl, tb);
6822 else
6823 __pr_out_handle_start(dl, tb, true, false);
6824
6825 pr_out_str(dl, "name", mnl_attr_get_str(tb[DEVLINK_ATTR_TRAP_NAME]));
6826 pr_out_str(dl, "type", trap_type_name(type));
6827 pr_out_bool(dl, "generic", !!tb[DEVLINK_ATTR_TRAP_GENERIC]);
6828 pr_out_str(dl, "action", trap_action_name(action));
6829 pr_out_str(dl, "group",
6830 mnl_attr_get_str(tb[DEVLINK_ATTR_TRAP_GROUP_NAME]));
6831 if (dl->verbose)
6832 pr_out_trap_metadata(dl, tb[DEVLINK_ATTR_TRAP_METADATA]);
6833 pr_out_stats(dl, tb[DEVLINK_ATTR_STATS]);
6834 pr_out_handle_end(dl);
6835 }
6836
6837 static int cmd_trap_show_cb(const struct nlmsghdr *nlh, void *data)
6838 {
6839 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
6840 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
6841 struct dl *dl = data;
6842
6843 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
6844 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
6845 !tb[DEVLINK_ATTR_TRAP_NAME] || !tb[DEVLINK_ATTR_TRAP_TYPE] ||
6846 !tb[DEVLINK_ATTR_TRAP_ACTION] ||
6847 !tb[DEVLINK_ATTR_TRAP_GROUP_NAME] ||
6848 !tb[DEVLINK_ATTR_TRAP_METADATA] || !tb[DEVLINK_ATTR_STATS])
6849 return MNL_CB_ERROR;
6850
6851 pr_out_trap(dl, tb, true);
6852
6853 return MNL_CB_OK;
6854 }
6855
6856 static void cmd_trap_help(void)
6857 {
6858 pr_err("Usage: devlink trap set DEV trap TRAP [ action { trap | drop } ]\n");
6859 pr_err(" devlink trap show [ DEV trap TRAP ]\n");
6860 pr_err(" devlink trap group set DEV group GROUP [ action { trap | drop } ]\n");
6861 pr_err(" devlink trap group show [ DEV group GROUP ]\n");
6862 }
6863
6864 static int cmd_trap_show(struct dl *dl)
6865 {
6866 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
6867 struct nlmsghdr *nlh;
6868 int err;
6869
6870 if (dl_argc(dl) == 0)
6871 flags |= NLM_F_DUMP;
6872
6873 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_TRAP_GET, flags);
6874
6875 if (dl_argc(dl) > 0) {
6876 err = dl_argv_parse_put(nlh, dl,
6877 DL_OPT_HANDLE | DL_OPT_TRAP_NAME, 0);
6878 if (err)
6879 return err;
6880 }
6881
6882 pr_out_section_start(dl, "trap");
6883 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_trap_show_cb, dl);
6884 pr_out_section_end(dl);
6885
6886 return err;
6887 }
6888
6889 static int cmd_trap_set(struct dl *dl)
6890 {
6891 struct nlmsghdr *nlh;
6892 int err;
6893
6894 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_TRAP_SET,
6895 NLM_F_REQUEST | NLM_F_ACK);
6896
6897 err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE | DL_OPT_TRAP_NAME,
6898 DL_OPT_TRAP_ACTION);
6899 if (err)
6900 return err;
6901
6902 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
6903 }
6904
6905 static void pr_out_trap_group(struct dl *dl, struct nlattr **tb, bool array)
6906 {
6907 if (array)
6908 pr_out_handle_start_arr(dl, tb);
6909 else
6910 __pr_out_handle_start(dl, tb, true, false);
6911
6912 pr_out_str(dl, "name",
6913 mnl_attr_get_str(tb[DEVLINK_ATTR_TRAP_GROUP_NAME]));
6914 pr_out_bool(dl, "generic", !!tb[DEVLINK_ATTR_TRAP_GENERIC]);
6915 pr_out_stats(dl, tb[DEVLINK_ATTR_STATS]);
6916 pr_out_handle_end(dl);
6917 }
6918
6919 static int cmd_trap_group_show_cb(const struct nlmsghdr *nlh, void *data)
6920 {
6921 struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
6922 struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
6923 struct dl *dl = data;
6924
6925 mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
6926 if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
6927 !tb[DEVLINK_ATTR_TRAP_GROUP_NAME] || !tb[DEVLINK_ATTR_STATS])
6928 return MNL_CB_ERROR;
6929
6930 pr_out_trap_group(dl, tb, true);
6931
6932 return MNL_CB_OK;
6933 }
6934
6935 static int cmd_trap_group_show(struct dl *dl)
6936 {
6937 uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
6938 struct nlmsghdr *nlh;
6939 int err;
6940
6941 if (dl_argc(dl) == 0)
6942 flags |= NLM_F_DUMP;
6943
6944 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_TRAP_GROUP_GET, flags);
6945
6946 if (dl_argc(dl) > 0) {
6947 err = dl_argv_parse_put(nlh, dl,
6948 DL_OPT_HANDLE | DL_OPT_TRAP_GROUP_NAME,
6949 0);
6950 if (err)
6951 return err;
6952 }
6953
6954 pr_out_section_start(dl, "trap_group");
6955 err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_trap_group_show_cb, dl);
6956 pr_out_section_end(dl);
6957
6958 return err;
6959 }
6960
6961 static int cmd_trap_group_set(struct dl *dl)
6962 {
6963 struct nlmsghdr *nlh;
6964 int err;
6965
6966 nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_TRAP_GROUP_SET,
6967 NLM_F_REQUEST | NLM_F_ACK);
6968
6969 err = dl_argv_parse_put(nlh, dl,
6970 DL_OPT_HANDLE | DL_OPT_TRAP_GROUP_NAME,
6971 DL_OPT_TRAP_ACTION);
6972 if (err)
6973 return err;
6974
6975 return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
6976 }
6977
6978 static int cmd_trap_group(struct dl *dl)
6979 {
6980 if (dl_argv_match(dl, "help")) {
6981 cmd_trap_help();
6982 return 0;
6983 } else if (dl_argv_match(dl, "show") ||
6984 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
6985 dl_arg_inc(dl);
6986 return cmd_trap_group_show(dl);
6987 } else if (dl_argv_match(dl, "set")) {
6988 dl_arg_inc(dl);
6989 return cmd_trap_group_set(dl);
6990 }
6991 pr_err("Command \"%s\" not found\n", dl_argv(dl));
6992 return -ENOENT;
6993 }
6994
6995 static int cmd_trap(struct dl *dl)
6996 {
6997 if (dl_argv_match(dl, "help")) {
6998 cmd_trap_help();
6999 return 0;
7000 } else if (dl_argv_match(dl, "show") ||
7001 dl_argv_match(dl, "list") || dl_no_arg(dl)) {
7002 dl_arg_inc(dl);
7003 return cmd_trap_show(dl);
7004 } else if (dl_argv_match(dl, "set")) {
7005 dl_arg_inc(dl);
7006 return cmd_trap_set(dl);
7007 } else if (dl_argv_match(dl, "group")) {
7008 dl_arg_inc(dl);
7009 return cmd_trap_group(dl);
7010 }
7011 pr_err("Command \"%s\" not found\n", dl_argv(dl));
7012 return -ENOENT;
7013 }
7014
7015 static void help(void)
7016 {
7017 pr_err("Usage: devlink [ OPTIONS ] OBJECT { COMMAND | help }\n"
7018 " devlink [ -f[orce] ] -b[atch] filename\n"
7019 "where OBJECT := { dev | port | sb | monitor | dpipe | resource | region | health | trap }\n"
7020 " OPTIONS := { -V[ersion] | -n[o-nice-names] | -j[son] | -p[retty] | -v[erbose] -s[tatistics] }\n");
7021 }
7022
7023 static int dl_cmd(struct dl *dl, int argc, char **argv)
7024 {
7025 dl->argc = argc;
7026 dl->argv = argv;
7027
7028 if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
7029 help();
7030 return 0;
7031 } else if (dl_argv_match(dl, "dev")) {
7032 dl_arg_inc(dl);
7033 return cmd_dev(dl);
7034 } else if (dl_argv_match(dl, "port")) {
7035 dl_arg_inc(dl);
7036 return cmd_port(dl);
7037 } else if (dl_argv_match(dl, "sb")) {
7038 dl_arg_inc(dl);
7039 return cmd_sb(dl);
7040 } else if (dl_argv_match(dl, "monitor")) {
7041 dl_arg_inc(dl);
7042 return cmd_mon(dl);
7043 } else if (dl_argv_match(dl, "dpipe")) {
7044 dl_arg_inc(dl);
7045 return cmd_dpipe(dl);
7046 } else if (dl_argv_match(dl, "resource")) {
7047 dl_arg_inc(dl);
7048 return cmd_resource(dl);
7049 } else if (dl_argv_match(dl, "region")) {
7050 dl_arg_inc(dl);
7051 return cmd_region(dl);
7052 } else if (dl_argv_match(dl, "health")) {
7053 dl_arg_inc(dl);
7054 return cmd_health(dl);
7055 } else if (dl_argv_match(dl, "trap")) {
7056 dl_arg_inc(dl);
7057 return cmd_trap(dl);
7058 }
7059 pr_err("Object \"%s\" not found\n", dl_argv(dl));
7060 return -ENOENT;
7061 }
7062
7063 static int dl_init(struct dl *dl)
7064 {
7065 int err;
7066
7067 dl->nlg = mnlg_socket_open(DEVLINK_GENL_NAME, DEVLINK_GENL_VERSION);
7068 if (!dl->nlg) {
7069 pr_err("Failed to connect to devlink Netlink\n");
7070 return -errno;
7071 }
7072
7073 err = ifname_map_init(dl);
7074 if (err) {
7075 pr_err("Failed to create index map\n");
7076 goto err_ifname_map_create;
7077 }
7078 if (dl->json_output) {
7079 dl->jw = jsonw_new(stdout);
7080 if (!dl->jw) {
7081 pr_err("Failed to create JSON writer\n");
7082 goto err_json_new;
7083 }
7084 jsonw_pretty(dl->jw, dl->pretty_output);
7085 }
7086 return 0;
7087
7088 err_json_new:
7089 ifname_map_fini(dl);
7090 err_ifname_map_create:
7091 mnlg_socket_close(dl->nlg);
7092 return err;
7093 }
7094
7095 static void dl_fini(struct dl *dl)
7096 {
7097 if (dl->json_output)
7098 jsonw_destroy(&dl->jw);
7099 ifname_map_fini(dl);
7100 mnlg_socket_close(dl->nlg);
7101 }
7102
7103 static struct dl *dl_alloc(void)
7104 {
7105 struct dl *dl;
7106
7107 dl = calloc(1, sizeof(*dl));
7108 if (!dl)
7109 return NULL;
7110 return dl;
7111 }
7112
7113 static void dl_free(struct dl *dl)
7114 {
7115 free(dl);
7116 }
7117
7118 static int dl_batch(struct dl *dl, const char *name, bool force)
7119 {
7120 char *line = NULL;
7121 size_t len = 0;
7122 int ret = EXIT_SUCCESS;
7123
7124 if (name && strcmp(name, "-") != 0) {
7125 if (freopen(name, "r", stdin) == NULL) {
7126 fprintf(stderr,
7127 "Cannot open file \"%s\" for reading: %s\n",
7128 name, strerror(errno));
7129 return EXIT_FAILURE;
7130 }
7131 }
7132
7133 cmdlineno = 0;
7134 while (getcmdline(&line, &len, stdin) != -1) {
7135 char *largv[100];
7136 int largc;
7137
7138 largc = makeargs(line, largv, 100);
7139 if (!largc)
7140 continue; /* blank line */
7141
7142 if (dl_cmd(dl, largc, largv)) {
7143 fprintf(stderr, "Command failed %s:%d\n",
7144 name, cmdlineno);
7145 ret = EXIT_FAILURE;
7146 if (!force)
7147 break;
7148 }
7149 }
7150
7151 if (line)
7152 free(line);
7153
7154 return ret;
7155 }
7156
7157 int main(int argc, char **argv)
7158 {
7159 static const struct option long_options[] = {
7160 { "Version", no_argument, NULL, 'V' },
7161 { "force", no_argument, NULL, 'f' },
7162 { "batch", required_argument, NULL, 'b' },
7163 { "no-nice-names", no_argument, NULL, 'n' },
7164 { "json", no_argument, NULL, 'j' },
7165 { "pretty", no_argument, NULL, 'p' },
7166 { "verbose", no_argument, NULL, 'v' },
7167 { "statistics", no_argument, NULL, 's' },
7168 { NULL, 0, NULL, 0 }
7169 };
7170 const char *batch_file = NULL;
7171 bool force = false;
7172 struct dl *dl;
7173 int opt;
7174 int err;
7175 int ret;
7176
7177 dl = dl_alloc();
7178 if (!dl) {
7179 pr_err("Failed to allocate memory for devlink\n");
7180 return EXIT_FAILURE;
7181 }
7182
7183 while ((opt = getopt_long(argc, argv, "Vfb:njpvs",
7184 long_options, NULL)) >= 0) {
7185
7186 switch (opt) {
7187 case 'V':
7188 printf("devlink utility, iproute2-ss%s\n", SNAPSHOT);
7189 ret = EXIT_SUCCESS;
7190 goto dl_free;
7191 case 'f':
7192 force = true;
7193 break;
7194 case 'b':
7195 batch_file = optarg;
7196 break;
7197 case 'n':
7198 dl->no_nice_names = true;
7199 break;
7200 case 'j':
7201 dl->json_output = true;
7202 break;
7203 case 'p':
7204 dl->pretty_output = true;
7205 break;
7206 case 'v':
7207 dl->verbose = true;
7208 break;
7209 case 's':
7210 dl->stats = true;
7211 break;
7212 default:
7213 pr_err("Unknown option.\n");
7214 help();
7215 ret = EXIT_FAILURE;
7216 goto dl_free;
7217 }
7218 }
7219
7220 argc -= optind;
7221 argv += optind;
7222
7223 err = dl_init(dl);
7224 if (err) {
7225 ret = EXIT_FAILURE;
7226 goto dl_free;
7227 }
7228
7229 if (batch_file)
7230 err = dl_batch(dl, batch_file, force);
7231 else
7232 err = dl_cmd(dl, argc, argv);
7233
7234 if (err) {
7235 ret = EXIT_FAILURE;
7236 goto dl_fini;
7237 }
7238
7239 ret = EXIT_SUCCESS;
7240
7241 dl_fini:
7242 dl_fini(dl);
7243 dl_free:
7244 dl_free(dl);
7245
7246 return ret;
7247 }
Upstream mirror of iproute2