mirror of
				https://git.proxmox.com/git/mirror_iproute2
				synced 2025-10-31 16:53:53 +00:00 
			
		
		
		
	
		
			
				
	
	
		
			5953 lines
		
	
	
		
			150 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			5953 lines
		
	
	
		
			150 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * devlink.c	Devlink tool
 | |
|  *
 | |
|  *              This program is free software; you can redistribute it and/or
 | |
|  *              modify it under the terms of the GNU General Public License
 | |
|  *              as published by the Free Software Foundation; either version
 | |
|  *              2 of the License, or (at your option) any later version.
 | |
|  *
 | |
|  * Authors:     Jiri Pirko <jiri@mellanox.com>
 | |
|  */
 | |
| 
 | |
| #include <stdio.h>
 | |
| #include <stdlib.h>
 | |
| #include <string.h>
 | |
| #include <stdbool.h>
 | |
| #include <unistd.h>
 | |
| #include <getopt.h>
 | |
| #include <limits.h>
 | |
| #include <errno.h>
 | |
| #include <inttypes.h>
 | |
| #include <linux/genetlink.h>
 | |
| #include <linux/devlink.h>
 | |
| #include <libmnl/libmnl.h>
 | |
| #include <netinet/ether.h>
 | |
| 
 | |
| #include "SNAPSHOT.h"
 | |
| #include "list.h"
 | |
| #include "mnlg.h"
 | |
| #include "json_writer.h"
 | |
| #include "utils.h"
 | |
| 
 | |
| #define ESWITCH_MODE_LEGACY "legacy"
 | |
| #define ESWITCH_MODE_SWITCHDEV "switchdev"
 | |
| #define ESWITCH_INLINE_MODE_NONE "none"
 | |
| #define ESWITCH_INLINE_MODE_LINK "link"
 | |
| #define ESWITCH_INLINE_MODE_NETWORK "network"
 | |
| #define ESWITCH_INLINE_MODE_TRANSPORT "transport"
 | |
| 
 | |
| #define PARAM_CMODE_RUNTIME_STR "runtime"
 | |
| #define PARAM_CMODE_DRIVERINIT_STR "driverinit"
 | |
| #define PARAM_CMODE_PERMANENT_STR "permanent"
 | |
| 
 | |
| static int g_new_line_count;
 | |
| 
 | |
| #define pr_err(args...) fprintf(stderr, ##args)
 | |
| #define pr_out(args...)						\
 | |
| 	do {							\
 | |
| 		if (g_indent_newline) {				\
 | |
| 			fprintf(stdout, "%s", g_indent_str);	\
 | |
| 			g_indent_newline = false;		\
 | |
| 		}						\
 | |
| 		fprintf(stdout, ##args);			\
 | |
| 		g_new_line_count = 0;				\
 | |
| 	} while (0)
 | |
| 
 | |
| #define pr_out_sp(num, args...)					\
 | |
| 	do {							\
 | |
| 		int ret = fprintf(stdout, ##args);		\
 | |
| 		if (ret < num)					\
 | |
| 			fprintf(stdout, "%*s", num - ret, "");	\
 | |
| 		g_new_line_count = 0;				\
 | |
| 	} while (0)
 | |
| 
 | |
| static int g_indent_level;
 | |
| static bool g_indent_newline;
 | |
| #define INDENT_STR_STEP 2
 | |
| #define INDENT_STR_MAXLEN 32
 | |
| static char g_indent_str[INDENT_STR_MAXLEN + 1] = "";
 | |
| 
 | |
| static void __pr_out_indent_inc(void)
 | |
| {
 | |
| 	if (g_indent_level + INDENT_STR_STEP > INDENT_STR_MAXLEN)
 | |
| 		return;
 | |
| 	g_indent_level += INDENT_STR_STEP;
 | |
| 	memset(g_indent_str, ' ', sizeof(g_indent_str));
 | |
| 	g_indent_str[g_indent_level] = '\0';
 | |
| }
 | |
| 
 | |
| static void __pr_out_indent_dec(void)
 | |
| {
 | |
| 	if (g_indent_level - INDENT_STR_STEP < 0)
 | |
| 		return;
 | |
| 	g_indent_level -= INDENT_STR_STEP;
 | |
| 	g_indent_str[g_indent_level] = '\0';
 | |
| }
 | |
| 
 | |
| static void __pr_out_newline(void)
 | |
| {
 | |
| 	if (g_new_line_count < 1) {
 | |
| 		pr_out("\n");
 | |
| 		g_indent_newline = true;
 | |
| 	}
 | |
| 	g_new_line_count++;
 | |
| }
 | |
| 
 | |
| static int _mnlg_socket_recv_run(struct mnlg_socket *nlg,
 | |
| 				 mnl_cb_t data_cb, void *data)
 | |
| {
 | |
| 	int err;
 | |
| 
 | |
| 	err = mnlg_socket_recv_run(nlg, data_cb, data);
 | |
| 	if (err < 0) {
 | |
| 		pr_err("devlink answers: %s\n", strerror(errno));
 | |
| 		return -errno;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int _mnlg_socket_sndrcv(struct mnlg_socket *nlg,
 | |
| 			       const struct nlmsghdr *nlh,
 | |
| 			       mnl_cb_t data_cb, void *data)
 | |
| {
 | |
| 	int err;
 | |
| 
 | |
| 	err = mnlg_socket_send(nlg, nlh);
 | |
| 	if (err < 0) {
 | |
| 		pr_err("Failed to call mnlg_socket_send\n");
 | |
| 		return -errno;
 | |
| 	}
 | |
| 	return _mnlg_socket_recv_run(nlg, data_cb, data);
 | |
| }
 | |
| 
 | |
| static int _mnlg_socket_group_add(struct mnlg_socket *nlg,
 | |
| 				  const char *group_name)
 | |
| {
 | |
| 	int err;
 | |
| 
 | |
| 	err = mnlg_socket_group_add(nlg, group_name);
 | |
| 	if (err < 0) {
 | |
| 		pr_err("Failed to call mnlg_socket_group_add\n");
 | |
| 		return -errno;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| struct ifname_map {
 | |
| 	struct list_head list;
 | |
| 	char *bus_name;
 | |
| 	char *dev_name;
 | |
| 	uint32_t port_index;
 | |
| 	char *ifname;
 | |
| };
 | |
| 
 | |
| static struct ifname_map *ifname_map_alloc(const char *bus_name,
 | |
| 					   const char *dev_name,
 | |
| 					   uint32_t port_index,
 | |
| 					   const char *ifname)
 | |
| {
 | |
| 	struct ifname_map *ifname_map;
 | |
| 
 | |
| 	ifname_map = calloc(1, sizeof(*ifname_map));
 | |
| 	if (!ifname_map)
 | |
| 		return NULL;
 | |
| 	ifname_map->bus_name = strdup(bus_name);
 | |
| 	ifname_map->dev_name = strdup(dev_name);
 | |
| 	ifname_map->port_index = port_index;
 | |
| 	ifname_map->ifname = strdup(ifname);
 | |
| 	if (!ifname_map->bus_name || !ifname_map->dev_name ||
 | |
| 	    !ifname_map->ifname) {
 | |
| 		free(ifname_map->ifname);
 | |
| 		free(ifname_map->dev_name);
 | |
| 		free(ifname_map->bus_name);
 | |
| 		free(ifname_map);
 | |
| 		return NULL;
 | |
| 	}
 | |
| 	return ifname_map;
 | |
| }
 | |
| 
 | |
| static void ifname_map_free(struct ifname_map *ifname_map)
 | |
| {
 | |
| 	free(ifname_map->ifname);
 | |
| 	free(ifname_map->dev_name);
 | |
| 	free(ifname_map->bus_name);
 | |
| 	free(ifname_map);
 | |
| }
 | |
| 
 | |
| #define DL_OPT_HANDLE		BIT(0)
 | |
| #define DL_OPT_HANDLEP		BIT(1)
 | |
| #define DL_OPT_PORT_TYPE	BIT(2)
 | |
| #define DL_OPT_PORT_COUNT	BIT(3)
 | |
| #define DL_OPT_SB		BIT(4)
 | |
| #define DL_OPT_SB_POOL		BIT(5)
 | |
| #define DL_OPT_SB_SIZE		BIT(6)
 | |
| #define DL_OPT_SB_TYPE		BIT(7)
 | |
| #define DL_OPT_SB_THTYPE	BIT(8)
 | |
| #define DL_OPT_SB_TH		BIT(9)
 | |
| #define DL_OPT_SB_TC		BIT(10)
 | |
| #define DL_OPT_ESWITCH_MODE	BIT(11)
 | |
| #define DL_OPT_ESWITCH_INLINE_MODE	BIT(12)
 | |
| #define DL_OPT_DPIPE_TABLE_NAME	BIT(13)
 | |
| #define DL_OPT_DPIPE_TABLE_COUNTERS	BIT(14)
 | |
| #define DL_OPT_ESWITCH_ENCAP_MODE	BIT(15)
 | |
| #define DL_OPT_RESOURCE_PATH	BIT(16)
 | |
| #define DL_OPT_RESOURCE_SIZE	BIT(17)
 | |
| #define DL_OPT_PARAM_NAME	BIT(18)
 | |
| #define DL_OPT_PARAM_VALUE	BIT(19)
 | |
| #define DL_OPT_PARAM_CMODE	BIT(20)
 | |
| #define DL_OPT_HANDLE_REGION		BIT(21)
 | |
| #define DL_OPT_REGION_SNAPSHOT_ID	BIT(22)
 | |
| #define DL_OPT_REGION_ADDRESS		BIT(23)
 | |
| #define DL_OPT_REGION_LENGTH		BIT(24)
 | |
| 
 | |
| struct dl_opts {
 | |
| 	uint32_t present; /* flags of present items */
 | |
| 	char *bus_name;
 | |
| 	char *dev_name;
 | |
| 	uint32_t port_index;
 | |
| 	enum devlink_port_type port_type;
 | |
| 	uint32_t port_count;
 | |
| 	uint32_t sb_index;
 | |
| 	uint16_t sb_pool_index;
 | |
| 	uint32_t sb_pool_size;
 | |
| 	enum devlink_sb_pool_type sb_pool_type;
 | |
| 	enum devlink_sb_threshold_type sb_pool_thtype;
 | |
| 	uint32_t sb_threshold;
 | |
| 	uint16_t sb_tc_index;
 | |
| 	enum devlink_eswitch_mode eswitch_mode;
 | |
| 	enum devlink_eswitch_inline_mode eswitch_inline_mode;
 | |
| 	const char *dpipe_table_name;
 | |
| 	bool dpipe_counters_enable;
 | |
| 	bool eswitch_encap_mode;
 | |
| 	const char *resource_path;
 | |
| 	uint32_t resource_size;
 | |
| 	uint32_t resource_id;
 | |
| 	bool resource_id_valid;
 | |
| 	const char *param_name;
 | |
| 	const char *param_value;
 | |
| 	enum devlink_param_cmode cmode;
 | |
| 	char *region_name;
 | |
| 	uint32_t region_snapshot_id;
 | |
| 	uint64_t region_address;
 | |
| 	uint64_t region_length;
 | |
| };
 | |
| 
 | |
| struct dl {
 | |
| 	struct mnlg_socket *nlg;
 | |
| 	struct list_head ifname_map_list;
 | |
| 	int argc;
 | |
| 	char **argv;
 | |
| 	bool no_nice_names;
 | |
| 	struct dl_opts opts;
 | |
| 	json_writer_t *jw;
 | |
| 	bool json_output;
 | |
| 	bool pretty_output;
 | |
| 	bool verbose;
 | |
| 	struct {
 | |
| 		bool present;
 | |
| 		char *bus_name;
 | |
| 		char *dev_name;
 | |
| 		uint32_t port_index;
 | |
| 	} arr_last;
 | |
| };
 | |
| 
 | |
| static int dl_argc(struct dl *dl)
 | |
| {
 | |
| 	return dl->argc;
 | |
| }
 | |
| 
 | |
| static char *dl_argv(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argc(dl) == 0)
 | |
| 		return NULL;
 | |
| 	return *dl->argv;
 | |
| }
 | |
| 
 | |
| static void dl_arg_inc(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argc(dl) == 0)
 | |
| 		return;
 | |
| 	dl->argc--;
 | |
| 	dl->argv++;
 | |
| }
 | |
| 
 | |
| static char *dl_argv_next(struct dl *dl)
 | |
| {
 | |
| 	char *ret;
 | |
| 
 | |
| 	if (dl_argc(dl) == 0)
 | |
| 		return NULL;
 | |
| 
 | |
| 	ret = *dl->argv;
 | |
| 	dl_arg_inc(dl);
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| static char *dl_argv_index(struct dl *dl, unsigned int index)
 | |
| {
 | |
| 	if (index >= dl_argc(dl))
 | |
| 		return NULL;
 | |
| 	return dl->argv[index];
 | |
| }
 | |
| 
 | |
| static int strcmpx(const char *str1, const char *str2)
 | |
| {
 | |
| 	if (strlen(str1) > strlen(str2))
 | |
| 		return -1;
 | |
| 	return strncmp(str1, str2, strlen(str1));
 | |
| }
 | |
| 
 | |
| static bool dl_argv_match(struct dl *dl, const char *pattern)
 | |
| {
 | |
| 	if (dl_argc(dl) == 0)
 | |
| 		return false;
 | |
| 	return strcmpx(dl_argv(dl), pattern) == 0;
 | |
| }
 | |
| 
 | |
| static bool dl_no_arg(struct dl *dl)
 | |
| {
 | |
| 	return dl_argc(dl) == 0;
 | |
| }
 | |
| 
 | |
| static const enum mnl_attr_data_type devlink_policy[DEVLINK_ATTR_MAX + 1] = {
 | |
| 	[DEVLINK_ATTR_BUS_NAME] = MNL_TYPE_NUL_STRING,
 | |
| 	[DEVLINK_ATTR_DEV_NAME] = MNL_TYPE_NUL_STRING,
 | |
| 	[DEVLINK_ATTR_PORT_INDEX] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_PORT_TYPE] = MNL_TYPE_U16,
 | |
| 	[DEVLINK_ATTR_PORT_DESIRED_TYPE] = MNL_TYPE_U16,
 | |
| 	[DEVLINK_ATTR_PORT_NETDEV_IFINDEX] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_PORT_NETDEV_NAME] = MNL_TYPE_NUL_STRING,
 | |
| 	[DEVLINK_ATTR_PORT_IBDEV_NAME] = MNL_TYPE_NUL_STRING,
 | |
| 	[DEVLINK_ATTR_SB_INDEX] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_SB_SIZE] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_SB_INGRESS_POOL_COUNT] = MNL_TYPE_U16,
 | |
| 	[DEVLINK_ATTR_SB_EGRESS_POOL_COUNT] = MNL_TYPE_U16,
 | |
| 	[DEVLINK_ATTR_SB_INGRESS_TC_COUNT] = MNL_TYPE_U16,
 | |
| 	[DEVLINK_ATTR_SB_EGRESS_TC_COUNT] = MNL_TYPE_U16,
 | |
| 	[DEVLINK_ATTR_SB_POOL_INDEX] = MNL_TYPE_U16,
 | |
| 	[DEVLINK_ATTR_SB_POOL_TYPE] = MNL_TYPE_U8,
 | |
| 	[DEVLINK_ATTR_SB_POOL_SIZE] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE] = MNL_TYPE_U8,
 | |
| 	[DEVLINK_ATTR_SB_THRESHOLD] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_SB_TC_INDEX] = MNL_TYPE_U16,
 | |
| 	[DEVLINK_ATTR_SB_OCC_CUR] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_SB_OCC_MAX] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_ESWITCH_MODE] = MNL_TYPE_U16,
 | |
| 	[DEVLINK_ATTR_ESWITCH_INLINE_MODE] = MNL_TYPE_U8,
 | |
| 	[DEVLINK_ATTR_ESWITCH_ENCAP_MODE] = MNL_TYPE_U8,
 | |
| 	[DEVLINK_ATTR_DPIPE_TABLES] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_DPIPE_TABLE] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_DPIPE_TABLE_NAME] = MNL_TYPE_STRING,
 | |
| 	[DEVLINK_ATTR_DPIPE_TABLE_SIZE] = MNL_TYPE_U64,
 | |
| 	[DEVLINK_ATTR_DPIPE_TABLE_MATCHES] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_DPIPE_TABLE_ACTIONS] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED] =  MNL_TYPE_U8,
 | |
| 	[DEVLINK_ATTR_DPIPE_ENTRIES] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_DPIPE_ENTRY] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_DPIPE_ENTRY_INDEX] = MNL_TYPE_U64,
 | |
| 	[DEVLINK_ATTR_DPIPE_ENTRY_MATCH_VALUES] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_DPIPE_ENTRY_ACTION_VALUES] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_DPIPE_ENTRY_COUNTER] = MNL_TYPE_U64,
 | |
| 	[DEVLINK_ATTR_DPIPE_MATCH] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_DPIPE_MATCH_VALUE] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_DPIPE_MATCH_TYPE] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_DPIPE_ACTION] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_DPIPE_ACTION_VALUE] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_DPIPE_ACTION_TYPE] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_DPIPE_VALUE_MAPPING] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_DPIPE_HEADERS] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_DPIPE_HEADER] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_DPIPE_HEADER_NAME] = MNL_TYPE_STRING,
 | |
| 	[DEVLINK_ATTR_DPIPE_HEADER_ID] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_DPIPE_HEADER_FIELDS] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_DPIPE_HEADER_GLOBAL] = MNL_TYPE_U8,
 | |
| 	[DEVLINK_ATTR_DPIPE_HEADER_INDEX] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_DPIPE_FIELD] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_DPIPE_FIELD_NAME] = MNL_TYPE_STRING,
 | |
| 	[DEVLINK_ATTR_DPIPE_FIELD_ID] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_DPIPE_FIELD_BITWIDTH] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_DPIPE_FIELD_MAPPING_TYPE] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_PARAM] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_PARAM_NAME] = MNL_TYPE_STRING,
 | |
| 	[DEVLINK_ATTR_PARAM_TYPE] = MNL_TYPE_U8,
 | |
| 	[DEVLINK_ATTR_PARAM_VALUES_LIST] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_PARAM_VALUE] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_PARAM_VALUE_CMODE] = MNL_TYPE_U8,
 | |
| 	[DEVLINK_ATTR_REGION_NAME] = MNL_TYPE_STRING,
 | |
| 	[DEVLINK_ATTR_REGION_SIZE] = MNL_TYPE_U64,
 | |
| 	[DEVLINK_ATTR_REGION_SNAPSHOTS] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_REGION_SNAPSHOT] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_REGION_SNAPSHOT_ID] = MNL_TYPE_U32,
 | |
| 	[DEVLINK_ATTR_REGION_CHUNKS] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_REGION_CHUNK] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_REGION_CHUNK_DATA] = MNL_TYPE_BINARY,
 | |
| 	[DEVLINK_ATTR_REGION_CHUNK_ADDR] = MNL_TYPE_U64,
 | |
| 	[DEVLINK_ATTR_REGION_CHUNK_LEN] = MNL_TYPE_U64,
 | |
| 	[DEVLINK_ATTR_INFO_DRIVER_NAME] = MNL_TYPE_STRING,
 | |
| 	[DEVLINK_ATTR_INFO_SERIAL_NUMBER] = MNL_TYPE_STRING,
 | |
| 	[DEVLINK_ATTR_INFO_VERSION_FIXED] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_INFO_VERSION_RUNNING] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_INFO_VERSION_STORED] = MNL_TYPE_NESTED,
 | |
| 	[DEVLINK_ATTR_INFO_VERSION_NAME] = MNL_TYPE_STRING,
 | |
| 	[DEVLINK_ATTR_INFO_VERSION_VALUE] = MNL_TYPE_STRING,
 | |
| };
 | |
| 
 | |
| static int attr_cb(const struct nlattr *attr, void *data)
 | |
| {
 | |
| 	const struct nlattr **tb = data;
 | |
| 	int type;
 | |
| 
 | |
| 	if (mnl_attr_type_valid(attr, DEVLINK_ATTR_MAX) < 0)
 | |
| 		return MNL_CB_OK;
 | |
| 
 | |
| 	type = mnl_attr_get_type(attr);
 | |
| 	if (mnl_attr_validate(attr, devlink_policy[type]) < 0)
 | |
| 		return MNL_CB_ERROR;
 | |
| 
 | |
| 	tb[type] = attr;
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int ifname_map_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 	struct dl *dl = data;
 | |
| 	struct ifname_map *ifname_map;
 | |
| 	const char *bus_name;
 | |
| 	const char *dev_name;
 | |
| 	uint32_t port_ifindex;
 | |
| 	const char *port_ifname;
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 	    !tb[DEVLINK_ATTR_PORT_INDEX])
 | |
| 		return MNL_CB_ERROR;
 | |
| 
 | |
| 	if (!tb[DEVLINK_ATTR_PORT_NETDEV_NAME])
 | |
| 		return MNL_CB_OK;
 | |
| 
 | |
| 	bus_name = mnl_attr_get_str(tb[DEVLINK_ATTR_BUS_NAME]);
 | |
| 	dev_name = mnl_attr_get_str(tb[DEVLINK_ATTR_DEV_NAME]);
 | |
| 	port_ifindex = mnl_attr_get_u32(tb[DEVLINK_ATTR_PORT_INDEX]);
 | |
| 	port_ifname = mnl_attr_get_str(tb[DEVLINK_ATTR_PORT_NETDEV_NAME]);
 | |
| 	ifname_map = ifname_map_alloc(bus_name, dev_name,
 | |
| 				      port_ifindex, port_ifname);
 | |
| 	if (!ifname_map)
 | |
| 		return MNL_CB_ERROR;
 | |
| 	list_add(&ifname_map->list, &dl->ifname_map_list);
 | |
| 
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static void ifname_map_fini(struct dl *dl)
 | |
| {
 | |
| 	struct ifname_map *ifname_map, *tmp;
 | |
| 
 | |
| 	list_for_each_entry_safe(ifname_map, tmp,
 | |
| 				 &dl->ifname_map_list, list) {
 | |
| 		list_del(&ifname_map->list);
 | |
| 		ifname_map_free(ifname_map);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static int ifname_map_init(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	INIT_LIST_HEAD(&dl->ifname_map_list);
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PORT_GET,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK | NLM_F_DUMP);
 | |
| 
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, ifname_map_cb, dl);
 | |
| 	if (err) {
 | |
| 		ifname_map_fini(dl);
 | |
| 		return err;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int ifname_map_lookup(struct dl *dl, const char *ifname,
 | |
| 			     char **p_bus_name, char **p_dev_name,
 | |
| 			     uint32_t *p_port_index)
 | |
| {
 | |
| 	struct ifname_map *ifname_map;
 | |
| 
 | |
| 	list_for_each_entry(ifname_map, &dl->ifname_map_list, list) {
 | |
| 		if (strcmp(ifname, ifname_map->ifname) == 0) {
 | |
| 			*p_bus_name = ifname_map->bus_name;
 | |
| 			*p_dev_name = ifname_map->dev_name;
 | |
| 			*p_port_index = ifname_map->port_index;
 | |
| 			return 0;
 | |
| 		}
 | |
| 	}
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static int ifname_map_rev_lookup(struct dl *dl, const char *bus_name,
 | |
| 				 const char *dev_name, uint32_t port_index,
 | |
| 				 char **p_ifname)
 | |
| {
 | |
| 	struct ifname_map *ifname_map;
 | |
| 
 | |
| 	list_for_each_entry(ifname_map, &dl->ifname_map_list, list) {
 | |
| 		if (strcmp(bus_name, ifname_map->bus_name) == 0 &&
 | |
| 		    strcmp(dev_name, ifname_map->dev_name) == 0 &&
 | |
| 		    port_index == ifname_map->port_index) {
 | |
| 			*p_ifname = ifname_map->ifname;
 | |
| 			return 0;
 | |
| 		}
 | |
| 	}
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static unsigned int strslashcount(char *str)
 | |
| {
 | |
| 	unsigned int count = 0;
 | |
| 	char *pos = str;
 | |
| 
 | |
| 	while ((pos = strchr(pos, '/'))) {
 | |
| 		count++;
 | |
| 		pos++;
 | |
| 	}
 | |
| 	return count;
 | |
| }
 | |
| 
 | |
| static int strslashrsplit(char *str, char **before, char **after)
 | |
| {
 | |
| 	char *slash;
 | |
| 
 | |
| 	slash = strrchr(str, '/');
 | |
| 	if (!slash)
 | |
| 		return -EINVAL;
 | |
| 	*slash = '\0';
 | |
| 	*before = str;
 | |
| 	*after = slash + 1;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int strtouint64_t(const char *str, uint64_t *p_val)
 | |
| {
 | |
| 	char *endptr;
 | |
| 	unsigned long long int val;
 | |
| 
 | |
| 	val = strtoull(str, &endptr, 10);
 | |
| 	if (endptr == str || *endptr != '\0')
 | |
| 		return -EINVAL;
 | |
| 	if (val > ULONG_MAX)
 | |
| 		return -ERANGE;
 | |
| 	*p_val = val;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int strtouint32_t(const char *str, uint32_t *p_val)
 | |
| {
 | |
| 	char *endptr;
 | |
| 	unsigned long int val;
 | |
| 
 | |
| 	val = strtoul(str, &endptr, 10);
 | |
| 	if (endptr == str || *endptr != '\0')
 | |
| 		return -EINVAL;
 | |
| 	if (val > UINT_MAX)
 | |
| 		return -ERANGE;
 | |
| 	*p_val = val;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int strtouint16_t(const char *str, uint16_t *p_val)
 | |
| {
 | |
| 	char *endptr;
 | |
| 	unsigned long int val;
 | |
| 
 | |
| 	val = strtoul(str, &endptr, 10);
 | |
| 	if (endptr == str || *endptr != '\0')
 | |
| 		return -EINVAL;
 | |
| 	if (val > USHRT_MAX)
 | |
| 		return -ERANGE;
 | |
| 	*p_val = val;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int strtouint8_t(const char *str, uint8_t *p_val)
 | |
| {
 | |
| 	char *endptr;
 | |
| 	unsigned long int val;
 | |
| 
 | |
| 	val = strtoul(str, &endptr, 10);
 | |
| 	if (endptr == str || *endptr != '\0')
 | |
| 		return -EINVAL;
 | |
| 	if (val > UCHAR_MAX)
 | |
| 		return -ERANGE;
 | |
| 	*p_val = val;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int strtobool(const char *str, bool *p_val)
 | |
| {
 | |
| 	bool val;
 | |
| 
 | |
| 	if (!strcmp(str, "true") || !strcmp(str, "1"))
 | |
| 		val = true;
 | |
| 	else if (!strcmp(str, "false") || !strcmp(str, "0"))
 | |
| 		val = false;
 | |
| 	else
 | |
| 		return -EINVAL;
 | |
| 	*p_val = val;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int __dl_argv_handle(char *str, char **p_bus_name, char **p_dev_name)
 | |
| {
 | |
| 	strslashrsplit(str, p_bus_name, p_dev_name);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int dl_argv_handle(struct dl *dl, char **p_bus_name, char **p_dev_name)
 | |
| {
 | |
| 	char *str = dl_argv_next(dl);
 | |
| 
 | |
| 	if (!str) {
 | |
| 		pr_err("Devlink identification (\"bus_name/dev_name\") expected\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	if (strslashcount(str) != 1) {
 | |
| 		pr_err("Wrong devlink identification string format.\n");
 | |
| 		pr_err("Expected \"bus_name/dev_name\".\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	return __dl_argv_handle(str, p_bus_name, p_dev_name);
 | |
| }
 | |
| 
 | |
| static int __dl_argv_handle_port(char *str,
 | |
| 				 char **p_bus_name, char **p_dev_name,
 | |
| 				 uint32_t *p_port_index)
 | |
| {
 | |
| 	char *handlestr;
 | |
| 	char *portstr;
 | |
| 	int err;
 | |
| 
 | |
| 	err = strslashrsplit(str, &handlestr, &portstr);
 | |
| 	if (err) {
 | |
| 		pr_err("Port identification \"%s\" is invalid\n", str);
 | |
| 		return err;
 | |
| 	}
 | |
| 	err = strtouint32_t(portstr, p_port_index);
 | |
| 	if (err) {
 | |
| 		pr_err("Port index \"%s\" is not a number or not within range\n",
 | |
| 		       portstr);
 | |
| 		return err;
 | |
| 	}
 | |
| 	err = strslashrsplit(handlestr, p_bus_name, p_dev_name);
 | |
| 	if (err) {
 | |
| 		pr_err("Port identification \"%s\" is invalid\n", str);
 | |
| 		return err;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int __dl_argv_handle_port_ifname(struct dl *dl, char *str,
 | |
| 					char **p_bus_name, char **p_dev_name,
 | |
| 					uint32_t *p_port_index)
 | |
| {
 | |
| 	int err;
 | |
| 
 | |
| 	err = ifname_map_lookup(dl, str, p_bus_name, p_dev_name,
 | |
| 				p_port_index);
 | |
| 	if (err) {
 | |
| 		pr_err("Netdevice \"%s\" not found\n", str);
 | |
| 		return err;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int dl_argv_handle_port(struct dl *dl, char **p_bus_name,
 | |
| 			       char **p_dev_name, uint32_t *p_port_index)
 | |
| {
 | |
| 	char *str = dl_argv_next(dl);
 | |
| 	unsigned int slash_count;
 | |
| 
 | |
| 	if (!str) {
 | |
| 		pr_err("Port identification (\"bus_name/dev_name/port_index\" or \"netdev ifname\") expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	slash_count = strslashcount(str);
 | |
| 	switch (slash_count) {
 | |
| 	case 0:
 | |
| 		return __dl_argv_handle_port_ifname(dl, str, p_bus_name,
 | |
| 						    p_dev_name, p_port_index);
 | |
| 	case 2:
 | |
| 		return __dl_argv_handle_port(str, p_bus_name,
 | |
| 					     p_dev_name, p_port_index);
 | |
| 	default:
 | |
| 		pr_err("Wrong port identification string format.\n");
 | |
| 		pr_err("Expected \"bus_name/dev_name/port_index\" or \"netdev_ifname\".\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static int dl_argv_handle_both(struct dl *dl, char **p_bus_name,
 | |
| 			       char **p_dev_name, uint32_t *p_port_index,
 | |
| 			       uint32_t *p_handle_bit)
 | |
| {
 | |
| 	char *str = dl_argv_next(dl);
 | |
| 	unsigned int slash_count;
 | |
| 	int err;
 | |
| 
 | |
| 	if (!str) {
 | |
| 		pr_err("One of following identifications expected:\n"
 | |
| 		       "Devlink identification (\"bus_name/dev_name\")\n"
 | |
| 		       "Port identification (\"bus_name/dev_name/port_index\" or \"netdev ifname\")\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	slash_count = strslashcount(str);
 | |
| 	if (slash_count == 1) {
 | |
| 		err = __dl_argv_handle(str, p_bus_name, p_dev_name);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 		*p_handle_bit = DL_OPT_HANDLE;
 | |
| 	} else if (slash_count == 2) {
 | |
| 		err = __dl_argv_handle_port(str, p_bus_name,
 | |
| 					    p_dev_name, p_port_index);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 		*p_handle_bit = DL_OPT_HANDLEP;
 | |
| 	} else if (slash_count == 0) {
 | |
| 		err = __dl_argv_handle_port_ifname(dl, str, p_bus_name,
 | |
| 						   p_dev_name, p_port_index);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 		*p_handle_bit = DL_OPT_HANDLEP;
 | |
| 	} else {
 | |
| 		pr_err("Wrong port identification string format.\n");
 | |
| 		pr_err("Expected \"bus_name/dev_name\" or \"bus_name/dev_name/port_index\" or \"netdev_ifname\".\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int __dl_argv_handle_region(char *str, char **p_bus_name,
 | |
| 				   char **p_dev_name, char **p_region)
 | |
| {
 | |
| 	char *handlestr;
 | |
| 	int err;
 | |
| 
 | |
| 	err = strslashrsplit(str, &handlestr, p_region);
 | |
| 	if (err) {
 | |
| 		pr_err("Region identification \"%s\" is invalid\n", str);
 | |
| 		return err;
 | |
| 	}
 | |
| 	err = strslashrsplit(handlestr, p_bus_name, p_dev_name);
 | |
| 	if (err) {
 | |
| 		pr_err("Region identification \"%s\" is invalid\n", str);
 | |
| 		return err;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int dl_argv_handle_region(struct dl *dl, char **p_bus_name,
 | |
| 					char **p_dev_name, char **p_region)
 | |
| {
 | |
| 	char *str = dl_argv_next(dl);
 | |
| 	unsigned int slash_count;
 | |
| 
 | |
| 	if (!str) {
 | |
| 		pr_err("Expected \"bus_name/dev_name/region\" identification.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	slash_count = strslashcount(str);
 | |
| 	if (slash_count != 2) {
 | |
| 		pr_err("Wrong region identification string format.\n");
 | |
| 		pr_err("Expected \"bus_name/dev_name/region\" identification.\n"".\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	return __dl_argv_handle_region(str, p_bus_name, p_dev_name, p_region);
 | |
| }
 | |
| 
 | |
| static int dl_argv_uint64_t(struct dl *dl, uint64_t *p_val)
 | |
| {
 | |
| 	char *str = dl_argv_next(dl);
 | |
| 	int err;
 | |
| 
 | |
| 	if (!str) {
 | |
| 		pr_err("Unsigned number argument expected\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	err = strtouint64_t(str, p_val);
 | |
| 	if (err) {
 | |
| 		pr_err("\"%s\" is not a number or not within range\n", str);
 | |
| 		return err;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int dl_argv_uint32_t(struct dl *dl, uint32_t *p_val)
 | |
| {
 | |
| 	char *str = dl_argv_next(dl);
 | |
| 	int err;
 | |
| 
 | |
| 	if (!str) {
 | |
| 		pr_err("Unsigned number argument expected\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	err = strtouint32_t(str, p_val);
 | |
| 	if (err) {
 | |
| 		pr_err("\"%s\" is not a number or not within range\n", str);
 | |
| 		return err;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int dl_argv_uint16_t(struct dl *dl, uint16_t *p_val)
 | |
| {
 | |
| 	char *str = dl_argv_next(dl);
 | |
| 	int err;
 | |
| 
 | |
| 	if (!str) {
 | |
| 		pr_err("Unsigned number argument expected\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	err = strtouint16_t(str, p_val);
 | |
| 	if (err) {
 | |
| 		pr_err("\"%s\" is not a number or not within range\n", str);
 | |
| 		return err;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int dl_argv_str(struct dl *dl, const char **p_str)
 | |
| {
 | |
| 	const char *str = dl_argv_next(dl);
 | |
| 
 | |
| 	if (!str) {
 | |
| 		pr_err("String parameter expected\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	*p_str = str;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int port_type_get(const char *typestr, enum devlink_port_type *p_type)
 | |
| {
 | |
| 	if (strcmp(typestr, "auto") == 0) {
 | |
| 		*p_type = DEVLINK_PORT_TYPE_AUTO;
 | |
| 	} else if (strcmp(typestr, "eth") == 0) {
 | |
| 		*p_type = DEVLINK_PORT_TYPE_ETH;
 | |
| 	} else if (strcmp(typestr, "ib") == 0) {
 | |
| 		*p_type = DEVLINK_PORT_TYPE_IB;
 | |
| 	} else {
 | |
| 		pr_err("Unknown port type \"%s\"\n", typestr);
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int pool_type_get(const char *typestr, enum devlink_sb_pool_type *p_type)
 | |
| {
 | |
| 	if (strcmp(typestr, "ingress") == 0) {
 | |
| 		*p_type = DEVLINK_SB_POOL_TYPE_INGRESS;
 | |
| 	} else if (strcmp(typestr, "egress") == 0) {
 | |
| 		*p_type = DEVLINK_SB_POOL_TYPE_EGRESS;
 | |
| 	} else {
 | |
| 		pr_err("Unknown pool type \"%s\"\n", typestr);
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int threshold_type_get(const char *typestr,
 | |
| 			      enum devlink_sb_threshold_type *p_type)
 | |
| {
 | |
| 	if (strcmp(typestr, "static") == 0) {
 | |
| 		*p_type = DEVLINK_SB_THRESHOLD_TYPE_STATIC;
 | |
| 	} else if (strcmp(typestr, "dynamic") == 0) {
 | |
| 		*p_type = DEVLINK_SB_THRESHOLD_TYPE_DYNAMIC;
 | |
| 	} else {
 | |
| 		pr_err("Unknown threshold type \"%s\"\n", typestr);
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int eswitch_mode_get(const char *typestr,
 | |
| 			    enum devlink_eswitch_mode *p_mode)
 | |
| {
 | |
| 	if (strcmp(typestr, ESWITCH_MODE_LEGACY) == 0) {
 | |
| 		*p_mode = DEVLINK_ESWITCH_MODE_LEGACY;
 | |
| 	} else if (strcmp(typestr, ESWITCH_MODE_SWITCHDEV) == 0) {
 | |
| 		*p_mode = DEVLINK_ESWITCH_MODE_SWITCHDEV;
 | |
| 	} else {
 | |
| 		pr_err("Unknown eswitch mode \"%s\"\n", typestr);
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int eswitch_inline_mode_get(const char *typestr,
 | |
| 				   enum devlink_eswitch_inline_mode *p_mode)
 | |
| {
 | |
| 	if (strcmp(typestr, ESWITCH_INLINE_MODE_NONE) == 0) {
 | |
| 		*p_mode = DEVLINK_ESWITCH_INLINE_MODE_NONE;
 | |
| 	} else if (strcmp(typestr, ESWITCH_INLINE_MODE_LINK) == 0) {
 | |
| 		*p_mode = DEVLINK_ESWITCH_INLINE_MODE_LINK;
 | |
| 	} else if (strcmp(typestr, ESWITCH_INLINE_MODE_NETWORK) == 0) {
 | |
| 		*p_mode = DEVLINK_ESWITCH_INLINE_MODE_NETWORK;
 | |
| 	} else if (strcmp(typestr, ESWITCH_INLINE_MODE_TRANSPORT) == 0) {
 | |
| 		*p_mode = DEVLINK_ESWITCH_INLINE_MODE_TRANSPORT;
 | |
| 	} else {
 | |
| 		pr_err("Unknown eswitch inline mode \"%s\"\n", typestr);
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int dpipe_counters_enable_get(const char *typestr,
 | |
| 				     bool *counters_enable)
 | |
| {
 | |
| 	if (strcmp(typestr, "enable") == 0) {
 | |
| 		*counters_enable = 1;
 | |
| 	} else if (strcmp(typestr, "disable") == 0) {
 | |
| 		*counters_enable = 0;
 | |
| 	} else {
 | |
| 		pr_err("Unknown counter_state \"%s\"\n", typestr);
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int eswitch_encap_mode_get(const char *typestr, bool *p_mode)
 | |
| {
 | |
| 	if (strcmp(typestr, "enable") == 0) {
 | |
| 		*p_mode = true;
 | |
| 	} else if (strcmp(typestr, "disable") == 0) {
 | |
| 		*p_mode = false;
 | |
| 	} else {
 | |
| 		pr_err("Unknown eswitch encap mode \"%s\"\n", typestr);
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int param_cmode_get(const char *cmodestr,
 | |
| 			   enum devlink_param_cmode *cmode)
 | |
| {
 | |
| 	if (strcmp(cmodestr, PARAM_CMODE_RUNTIME_STR) == 0) {
 | |
| 		*cmode = DEVLINK_PARAM_CMODE_RUNTIME;
 | |
| 	} else if (strcmp(cmodestr, PARAM_CMODE_DRIVERINIT_STR) == 0) {
 | |
| 		*cmode = DEVLINK_PARAM_CMODE_DRIVERINIT;
 | |
| 	} else if (strcmp(cmodestr, PARAM_CMODE_PERMANENT_STR) == 0) {
 | |
| 		*cmode = DEVLINK_PARAM_CMODE_PERMANENT;
 | |
| 	} else {
 | |
| 		pr_err("Unknown configuration mode \"%s\"\n", cmodestr);
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int dl_argv_parse(struct dl *dl, uint32_t o_required,
 | |
| 			 uint32_t o_optional)
 | |
| {
 | |
| 	struct dl_opts *opts = &dl->opts;
 | |
| 	uint32_t o_all = o_required | o_optional;
 | |
| 	uint32_t o_found = 0;
 | |
| 	int err;
 | |
| 
 | |
| 	if (o_required & DL_OPT_HANDLE && o_required & DL_OPT_HANDLEP) {
 | |
| 		uint32_t handle_bit;
 | |
| 
 | |
| 		err = dl_argv_handle_both(dl, &opts->bus_name, &opts->dev_name,
 | |
| 					  &opts->port_index, &handle_bit);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 		o_found |= handle_bit;
 | |
| 	} else if (o_required & DL_OPT_HANDLE) {
 | |
| 		err = dl_argv_handle(dl, &opts->bus_name, &opts->dev_name);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 		o_found |= DL_OPT_HANDLE;
 | |
| 	} else if (o_required & DL_OPT_HANDLEP) {
 | |
| 		err = dl_argv_handle_port(dl, &opts->bus_name, &opts->dev_name,
 | |
| 					  &opts->port_index);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 		o_found |= DL_OPT_HANDLEP;
 | |
| 	} else if (o_required & DL_OPT_HANDLE_REGION) {
 | |
| 		err = dl_argv_handle_region(dl, &opts->bus_name,
 | |
| 					    &opts->dev_name,
 | |
| 					    &opts->region_name);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 		o_found |= DL_OPT_HANDLE_REGION;
 | |
| 	}
 | |
| 
 | |
| 	while (dl_argc(dl)) {
 | |
| 		if (dl_argv_match(dl, "type") &&
 | |
| 		    (o_all & DL_OPT_PORT_TYPE)) {
 | |
| 			const char *typestr;
 | |
| 
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_str(dl, &typestr);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			err = port_type_get(typestr, &opts->port_type);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_PORT_TYPE;
 | |
| 		} else if (dl_argv_match(dl, "count") &&
 | |
| 			   (o_all & DL_OPT_PORT_COUNT)) {
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_uint32_t(dl, &opts->port_count);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_PORT_COUNT;
 | |
| 		} else if (dl_argv_match(dl, "sb") &&
 | |
| 			   (o_all & DL_OPT_SB)) {
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_uint32_t(dl, &opts->sb_index);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_SB;
 | |
| 		} else if (dl_argv_match(dl, "pool") &&
 | |
| 			   (o_all & DL_OPT_SB_POOL)) {
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_uint16_t(dl, &opts->sb_pool_index);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_SB_POOL;
 | |
| 		} else if (dl_argv_match(dl, "size") &&
 | |
| 			   (o_all & DL_OPT_SB_SIZE)) {
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_uint32_t(dl, &opts->sb_pool_size);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_SB_SIZE;
 | |
| 		} else if (dl_argv_match(dl, "type") &&
 | |
| 			   (o_all & DL_OPT_SB_TYPE)) {
 | |
| 			const char *typestr;
 | |
| 
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_str(dl, &typestr);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			err = pool_type_get(typestr, &opts->sb_pool_type);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_SB_TYPE;
 | |
| 		} else if (dl_argv_match(dl, "thtype") &&
 | |
| 			   (o_all & DL_OPT_SB_THTYPE)) {
 | |
| 			const char *typestr;
 | |
| 
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_str(dl, &typestr);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			err = threshold_type_get(typestr,
 | |
| 						 &opts->sb_pool_thtype);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_SB_THTYPE;
 | |
| 		} else if (dl_argv_match(dl, "th") &&
 | |
| 			   (o_all & DL_OPT_SB_TH)) {
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_uint32_t(dl, &opts->sb_threshold);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_SB_TH;
 | |
| 		} else if (dl_argv_match(dl, "tc") &&
 | |
| 			   (o_all & DL_OPT_SB_TC)) {
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_uint16_t(dl, &opts->sb_tc_index);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_SB_TC;
 | |
| 		} else if (dl_argv_match(dl, "mode") &&
 | |
| 			   (o_all & DL_OPT_ESWITCH_MODE)) {
 | |
| 			const char *typestr;
 | |
| 
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_str(dl, &typestr);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			err = eswitch_mode_get(typestr, &opts->eswitch_mode);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_ESWITCH_MODE;
 | |
| 		} else if (dl_argv_match(dl, "inline-mode") &&
 | |
| 			   (o_all & DL_OPT_ESWITCH_INLINE_MODE)) {
 | |
| 			const char *typestr;
 | |
| 
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_str(dl, &typestr);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			err = eswitch_inline_mode_get(
 | |
| 				typestr, &opts->eswitch_inline_mode);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_ESWITCH_INLINE_MODE;
 | |
| 		} else if (dl_argv_match(dl, "name") &&
 | |
| 			   (o_all & DL_OPT_DPIPE_TABLE_NAME)) {
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_str(dl, &opts->dpipe_table_name);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_DPIPE_TABLE_NAME;
 | |
| 		} else if (dl_argv_match(dl, "counters") &&
 | |
| 			   (o_all & DL_OPT_DPIPE_TABLE_COUNTERS)) {
 | |
| 			const char *typestr;
 | |
| 
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_str(dl, &typestr);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			err = dpipe_counters_enable_get(typestr,
 | |
| 							&opts->dpipe_counters_enable);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_DPIPE_TABLE_COUNTERS;
 | |
| 		} else if (dl_argv_match(dl, "encap") &&
 | |
| 			   (o_all & DL_OPT_ESWITCH_ENCAP_MODE)) {
 | |
| 			const char *typestr;
 | |
| 
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_str(dl, &typestr);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			err = eswitch_encap_mode_get(typestr,
 | |
| 						     &opts->eswitch_encap_mode);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_ESWITCH_ENCAP_MODE;
 | |
| 		} else if (dl_argv_match(dl, "path") &&
 | |
| 			   (o_all & DL_OPT_RESOURCE_PATH)) {
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_str(dl, &opts->resource_path);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_RESOURCE_PATH;
 | |
| 		} else if (dl_argv_match(dl, "size") &&
 | |
| 			   (o_all & DL_OPT_RESOURCE_SIZE)) {
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_uint32_t(dl, &opts->resource_size);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_RESOURCE_SIZE;
 | |
| 		} else if (dl_argv_match(dl, "name") &&
 | |
| 			   (o_all & DL_OPT_PARAM_NAME)) {
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_str(dl, &opts->param_name);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_PARAM_NAME;
 | |
| 		} else if (dl_argv_match(dl, "value") &&
 | |
| 			   (o_all & DL_OPT_PARAM_VALUE)) {
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_str(dl, &opts->param_value);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_PARAM_VALUE;
 | |
| 		} else if (dl_argv_match(dl, "cmode") &&
 | |
| 			   (o_all & DL_OPT_PARAM_CMODE)) {
 | |
| 			const char *cmodestr;
 | |
| 
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_str(dl, &cmodestr);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			err = param_cmode_get(cmodestr, &opts->cmode);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_PARAM_CMODE;
 | |
| 		} else if (dl_argv_match(dl, "snapshot") &&
 | |
| 			   (o_all & DL_OPT_REGION_SNAPSHOT_ID)) {
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_uint32_t(dl, &opts->region_snapshot_id);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_REGION_SNAPSHOT_ID;
 | |
| 		} else if (dl_argv_match(dl, "address") &&
 | |
| 			   (o_all & DL_OPT_REGION_ADDRESS)) {
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_uint64_t(dl, &opts->region_address);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_REGION_ADDRESS;
 | |
| 		} else if (dl_argv_match(dl, "length") &&
 | |
| 			   (o_all & DL_OPT_REGION_LENGTH)) {
 | |
| 			dl_arg_inc(dl);
 | |
| 			err = dl_argv_uint64_t(dl, &opts->region_length);
 | |
| 			if (err)
 | |
| 				return err;
 | |
| 			o_found |= DL_OPT_REGION_LENGTH;
 | |
| 		} else {
 | |
| 			pr_err("Unknown option \"%s\"\n", dl_argv(dl));
 | |
| 			return -EINVAL;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	opts->present = o_found;
 | |
| 
 | |
| 	if ((o_optional & DL_OPT_SB) && !(o_found & DL_OPT_SB)) {
 | |
| 		opts->sb_index = 0;
 | |
| 		opts->present |= DL_OPT_SB;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_PORT_TYPE) && !(o_found & DL_OPT_PORT_TYPE)) {
 | |
| 		pr_err("Port type option expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_PORT_COUNT) &&
 | |
| 	    !(o_found & DL_OPT_PORT_COUNT)) {
 | |
| 		pr_err("Port split count option expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_SB_POOL) && !(o_found & DL_OPT_SB_POOL)) {
 | |
| 		pr_err("Pool index option expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_SB_SIZE) && !(o_found & DL_OPT_SB_SIZE)) {
 | |
| 		pr_err("Pool size option expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_SB_TYPE) && !(o_found & DL_OPT_SB_TYPE)) {
 | |
| 		pr_err("Pool type option expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_SB_THTYPE) && !(o_found & DL_OPT_SB_THTYPE)) {
 | |
| 		pr_err("Pool threshold type option expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_SB_TH) && !(o_found & DL_OPT_SB_TH)) {
 | |
| 		pr_err("Threshold option expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_SB_TC) && !(o_found & DL_OPT_SB_TC)) {
 | |
| 		pr_err("TC index option expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_ESWITCH_MODE) &&
 | |
| 	    !(o_found & DL_OPT_ESWITCH_MODE)) {
 | |
| 		pr_err("E-Switch mode option expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_ESWITCH_INLINE_MODE) &&
 | |
| 	    !(o_found & DL_OPT_ESWITCH_INLINE_MODE)) {
 | |
| 		pr_err("E-Switch inline-mode option expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_DPIPE_TABLE_NAME) &&
 | |
| 	    !(o_found & DL_OPT_DPIPE_TABLE_NAME)) {
 | |
| 		pr_err("Dpipe table name expected\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_DPIPE_TABLE_COUNTERS) &&
 | |
| 	    !(o_found & DL_OPT_DPIPE_TABLE_COUNTERS)) {
 | |
| 		pr_err("Dpipe table counter state expected\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_ESWITCH_ENCAP_MODE) &&
 | |
| 	    !(o_found & DL_OPT_ESWITCH_ENCAP_MODE)) {
 | |
| 		pr_err("E-Switch encapsulation option expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_PARAM_NAME) &&
 | |
| 	    !(o_found & DL_OPT_PARAM_NAME)) {
 | |
| 		pr_err("Parameter name expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_PARAM_VALUE) &&
 | |
| 	    !(o_found & DL_OPT_PARAM_VALUE)) {
 | |
| 		pr_err("Value to set expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_PARAM_CMODE) &&
 | |
| 	    !(o_found & DL_OPT_PARAM_CMODE)) {
 | |
| 		pr_err("Configuration mode expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_REGION_SNAPSHOT_ID) &&
 | |
| 	    !(o_found & DL_OPT_REGION_SNAPSHOT_ID)) {
 | |
| 		pr_err("Region snapshot id expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_REGION_ADDRESS) &&
 | |
| 	    !(o_found & DL_OPT_REGION_ADDRESS)) {
 | |
| 		pr_err("Region address value expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	if ((o_required & DL_OPT_REGION_LENGTH) &&
 | |
| 	    !(o_found & DL_OPT_REGION_LENGTH)) {
 | |
| 		pr_err("Region length value expected.\n");
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void dl_opts_put(struct nlmsghdr *nlh, struct dl *dl)
 | |
| {
 | |
| 	struct dl_opts *opts = &dl->opts;
 | |
| 
 | |
| 	if (opts->present & DL_OPT_HANDLE) {
 | |
| 		mnl_attr_put_strz(nlh, DEVLINK_ATTR_BUS_NAME, opts->bus_name);
 | |
| 		mnl_attr_put_strz(nlh, DEVLINK_ATTR_DEV_NAME, opts->dev_name);
 | |
| 	} else if (opts->present & DL_OPT_HANDLEP) {
 | |
| 		mnl_attr_put_strz(nlh, DEVLINK_ATTR_BUS_NAME, opts->bus_name);
 | |
| 		mnl_attr_put_strz(nlh, DEVLINK_ATTR_DEV_NAME, opts->dev_name);
 | |
| 		mnl_attr_put_u32(nlh, DEVLINK_ATTR_PORT_INDEX,
 | |
| 				 opts->port_index);
 | |
| 	} else if (opts->present & DL_OPT_HANDLE_REGION) {
 | |
| 		mnl_attr_put_strz(nlh, DEVLINK_ATTR_BUS_NAME, opts->bus_name);
 | |
| 		mnl_attr_put_strz(nlh, DEVLINK_ATTR_DEV_NAME, opts->dev_name);
 | |
| 		mnl_attr_put_strz(nlh, DEVLINK_ATTR_REGION_NAME,
 | |
| 				  opts->region_name);
 | |
| 	}
 | |
| 	if (opts->present & DL_OPT_PORT_TYPE)
 | |
| 		mnl_attr_put_u16(nlh, DEVLINK_ATTR_PORT_TYPE,
 | |
| 				 opts->port_type);
 | |
| 	if (opts->present & DL_OPT_PORT_COUNT)
 | |
| 		mnl_attr_put_u32(nlh, DEVLINK_ATTR_PORT_SPLIT_COUNT,
 | |
| 				 opts->port_count);
 | |
| 	if (opts->present & DL_OPT_SB)
 | |
| 		mnl_attr_put_u32(nlh, DEVLINK_ATTR_SB_INDEX,
 | |
| 				 opts->sb_index);
 | |
| 	if (opts->present & DL_OPT_SB_POOL)
 | |
| 		mnl_attr_put_u16(nlh, DEVLINK_ATTR_SB_POOL_INDEX,
 | |
| 				 opts->sb_pool_index);
 | |
| 	if (opts->present & DL_OPT_SB_SIZE)
 | |
| 		mnl_attr_put_u32(nlh, DEVLINK_ATTR_SB_POOL_SIZE,
 | |
| 				 opts->sb_pool_size);
 | |
| 	if (opts->present & DL_OPT_SB_TYPE)
 | |
| 		mnl_attr_put_u8(nlh, DEVLINK_ATTR_SB_POOL_TYPE,
 | |
| 				opts->sb_pool_type);
 | |
| 	if (opts->present & DL_OPT_SB_THTYPE)
 | |
| 		mnl_attr_put_u8(nlh, DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE,
 | |
| 				opts->sb_pool_thtype);
 | |
| 	if (opts->present & DL_OPT_SB_TH)
 | |
| 		mnl_attr_put_u32(nlh, DEVLINK_ATTR_SB_THRESHOLD,
 | |
| 				 opts->sb_threshold);
 | |
| 	if (opts->present & DL_OPT_SB_TC)
 | |
| 		mnl_attr_put_u16(nlh, DEVLINK_ATTR_SB_TC_INDEX,
 | |
| 				 opts->sb_tc_index);
 | |
| 	if (opts->present & DL_OPT_ESWITCH_MODE)
 | |
| 		mnl_attr_put_u16(nlh, DEVLINK_ATTR_ESWITCH_MODE,
 | |
| 				 opts->eswitch_mode);
 | |
| 	if (opts->present & DL_OPT_ESWITCH_INLINE_MODE)
 | |
| 		mnl_attr_put_u8(nlh, DEVLINK_ATTR_ESWITCH_INLINE_MODE,
 | |
| 				opts->eswitch_inline_mode);
 | |
| 	if (opts->present & DL_OPT_DPIPE_TABLE_NAME)
 | |
| 		mnl_attr_put_strz(nlh, DEVLINK_ATTR_DPIPE_TABLE_NAME,
 | |
| 				  opts->dpipe_table_name);
 | |
| 	if (opts->present & DL_OPT_DPIPE_TABLE_COUNTERS)
 | |
| 		mnl_attr_put_u8(nlh, DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED,
 | |
| 				opts->dpipe_counters_enable);
 | |
| 	if (opts->present & DL_OPT_ESWITCH_ENCAP_MODE)
 | |
| 		mnl_attr_put_u8(nlh, DEVLINK_ATTR_ESWITCH_ENCAP_MODE,
 | |
| 				opts->eswitch_encap_mode);
 | |
| 	if ((opts->present & DL_OPT_RESOURCE_PATH) && opts->resource_id_valid)
 | |
| 		mnl_attr_put_u64(nlh, DEVLINK_ATTR_RESOURCE_ID,
 | |
| 				 opts->resource_id);
 | |
| 	if (opts->present & DL_OPT_RESOURCE_SIZE)
 | |
| 		mnl_attr_put_u64(nlh, DEVLINK_ATTR_RESOURCE_SIZE,
 | |
| 				 opts->resource_size);
 | |
| 	if (opts->present & DL_OPT_PARAM_NAME)
 | |
| 		mnl_attr_put_strz(nlh, DEVLINK_ATTR_PARAM_NAME,
 | |
| 				  opts->param_name);
 | |
| 	if (opts->present & DL_OPT_PARAM_CMODE)
 | |
| 		mnl_attr_put_u8(nlh, DEVLINK_ATTR_PARAM_VALUE_CMODE,
 | |
| 				opts->cmode);
 | |
| 	if (opts->present & DL_OPT_REGION_SNAPSHOT_ID)
 | |
| 		mnl_attr_put_u32(nlh, DEVLINK_ATTR_REGION_SNAPSHOT_ID,
 | |
| 				 opts->region_snapshot_id);
 | |
| 	if (opts->present & DL_OPT_REGION_ADDRESS)
 | |
| 		mnl_attr_put_u64(nlh, DEVLINK_ATTR_REGION_CHUNK_ADDR,
 | |
| 				 opts->region_address);
 | |
| 	if (opts->present & DL_OPT_REGION_LENGTH)
 | |
| 		mnl_attr_put_u64(nlh, DEVLINK_ATTR_REGION_CHUNK_LEN,
 | |
| 				 opts->region_length);
 | |
| }
 | |
| 
 | |
| static int dl_argv_parse_put(struct nlmsghdr *nlh, struct dl *dl,
 | |
| 			     uint32_t o_required, uint32_t o_optional)
 | |
| {
 | |
| 	int err;
 | |
| 
 | |
| 	err = dl_argv_parse(dl, o_required, o_optional);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 	dl_opts_put(nlh, dl);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static bool dl_dump_filter(struct dl *dl, struct nlattr **tb)
 | |
| {
 | |
| 	struct dl_opts *opts = &dl->opts;
 | |
| 	struct nlattr *attr_bus_name = tb[DEVLINK_ATTR_BUS_NAME];
 | |
| 	struct nlattr *attr_dev_name = tb[DEVLINK_ATTR_DEV_NAME];
 | |
| 	struct nlattr *attr_port_index = tb[DEVLINK_ATTR_PORT_INDEX];
 | |
| 	struct nlattr *attr_sb_index = tb[DEVLINK_ATTR_SB_INDEX];
 | |
| 
 | |
| 	if (opts->present & DL_OPT_HANDLE &&
 | |
| 	    attr_bus_name && attr_dev_name) {
 | |
| 		const char *bus_name = mnl_attr_get_str(attr_bus_name);
 | |
| 		const char *dev_name = mnl_attr_get_str(attr_dev_name);
 | |
| 
 | |
| 		if (strcmp(bus_name, opts->bus_name) != 0 ||
 | |
| 		    strcmp(dev_name, opts->dev_name) != 0)
 | |
| 			return false;
 | |
| 	}
 | |
| 	if (opts->present & DL_OPT_HANDLEP &&
 | |
| 	    attr_bus_name && attr_dev_name && attr_port_index) {
 | |
| 		const char *bus_name = mnl_attr_get_str(attr_bus_name);
 | |
| 		const char *dev_name = mnl_attr_get_str(attr_dev_name);
 | |
| 		uint32_t port_index = mnl_attr_get_u32(attr_port_index);
 | |
| 
 | |
| 		if (strcmp(bus_name, opts->bus_name) != 0 ||
 | |
| 		    strcmp(dev_name, opts->dev_name) != 0 ||
 | |
| 		    port_index != opts->port_index)
 | |
| 			return false;
 | |
| 	}
 | |
| 	if (opts->present & DL_OPT_SB && attr_sb_index) {
 | |
| 		uint32_t sb_index = mnl_attr_get_u32(attr_sb_index);
 | |
| 
 | |
| 		if (sb_index != opts->sb_index)
 | |
| 			return false;
 | |
| 	}
 | |
| 	return true;
 | |
| }
 | |
| 
 | |
| static void cmd_dev_help(void)
 | |
| {
 | |
| 	pr_err("Usage: devlink dev show [ DEV ]\n");
 | |
| 	pr_err("       devlink dev eswitch set DEV [ mode { legacy | switchdev } ]\n");
 | |
| 	pr_err("                               [ inline-mode { none | link | network | transport } ]\n");
 | |
| 	pr_err("                               [ encap { disable | enable } ]\n");
 | |
| 	pr_err("       devlink dev eswitch show DEV\n");
 | |
| 	pr_err("       devlink dev param set DEV name PARAMETER value VALUE cmode { permanent | driverinit | runtime }\n");
 | |
| 	pr_err("       devlink dev param show [DEV name PARAMETER]\n");
 | |
| 	pr_err("       devlink dev reload DEV\n");
 | |
| 	pr_err("       devlink dev info [ DEV ]\n");
 | |
| }
 | |
| 
 | |
| static bool cmp_arr_last_handle(struct dl *dl, const char *bus_name,
 | |
| 				const char *dev_name)
 | |
| {
 | |
| 	if (!dl->arr_last.present)
 | |
| 		return false;
 | |
| 	return strcmp(dl->arr_last.bus_name, bus_name) == 0 &&
 | |
| 	       strcmp(dl->arr_last.dev_name, dev_name) == 0;
 | |
| }
 | |
| 
 | |
| static void arr_last_handle_set(struct dl *dl, const char *bus_name,
 | |
| 				const char *dev_name)
 | |
| {
 | |
| 	dl->arr_last.present = true;
 | |
| 	free(dl->arr_last.dev_name);
 | |
| 	free(dl->arr_last.bus_name);
 | |
| 	dl->arr_last.bus_name = strdup(bus_name);
 | |
| 	dl->arr_last.dev_name = strdup(dev_name);
 | |
| }
 | |
| 
 | |
| static bool should_arr_last_handle_start(struct dl *dl, const char *bus_name,
 | |
| 					 const char *dev_name)
 | |
| {
 | |
| 	return !cmp_arr_last_handle(dl, bus_name, dev_name);
 | |
| }
 | |
| 
 | |
| static bool should_arr_last_handle_end(struct dl *dl, const char *bus_name,
 | |
| 				       const char *dev_name)
 | |
| {
 | |
| 	return dl->arr_last.present &&
 | |
| 	       !cmp_arr_last_handle(dl, bus_name, dev_name);
 | |
| }
 | |
| 
 | |
| static void __pr_out_handle_start(struct dl *dl, struct nlattr **tb,
 | |
| 				  bool content, bool array)
 | |
| {
 | |
| 	const char *bus_name = mnl_attr_get_str(tb[DEVLINK_ATTR_BUS_NAME]);
 | |
| 	const char *dev_name = mnl_attr_get_str(tb[DEVLINK_ATTR_DEV_NAME]);
 | |
| 	char buf[32];
 | |
| 
 | |
| 	sprintf(buf, "%s/%s", bus_name, dev_name);
 | |
| 
 | |
| 	if (dl->json_output) {
 | |
| 		if (array) {
 | |
| 			if (should_arr_last_handle_end(dl, bus_name, dev_name))
 | |
| 				jsonw_end_array(dl->jw);
 | |
| 			if (should_arr_last_handle_start(dl, bus_name,
 | |
| 							 dev_name)) {
 | |
| 				jsonw_name(dl->jw, buf);
 | |
| 				jsonw_start_array(dl->jw);
 | |
| 				jsonw_start_object(dl->jw);
 | |
| 				arr_last_handle_set(dl, bus_name, dev_name);
 | |
| 			} else {
 | |
| 				jsonw_start_object(dl->jw);
 | |
| 			}
 | |
| 		} else {
 | |
| 			jsonw_name(dl->jw, buf);
 | |
| 			jsonw_start_object(dl->jw);
 | |
| 		}
 | |
| 	} else {
 | |
| 		if (array) {
 | |
| 			if (should_arr_last_handle_end(dl, bus_name, dev_name))
 | |
| 				__pr_out_indent_dec();
 | |
| 			if (should_arr_last_handle_start(dl, bus_name,
 | |
| 							 dev_name)) {
 | |
| 				pr_out("%s%s", buf, content ? ":" : "");
 | |
| 				__pr_out_newline();
 | |
| 				__pr_out_indent_inc();
 | |
| 				arr_last_handle_set(dl, bus_name, dev_name);
 | |
| 			}
 | |
| 		} else {
 | |
| 			pr_out("%s%s", buf, content ? ":" : "");
 | |
| 		}
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_handle_start_arr(struct dl *dl, struct nlattr **tb)
 | |
| {
 | |
| 	__pr_out_handle_start(dl, tb, true, true);
 | |
| }
 | |
| 
 | |
| static void pr_out_handle_end(struct dl *dl)
 | |
| {
 | |
| 	if (dl->json_output)
 | |
| 		jsonw_end_object(dl->jw);
 | |
| 	else
 | |
| 		__pr_out_newline();
 | |
| }
 | |
| 
 | |
| static void pr_out_handle(struct dl *dl, struct nlattr **tb)
 | |
| {
 | |
| 	__pr_out_handle_start(dl, tb, false, false);
 | |
| 	pr_out_handle_end(dl);
 | |
| }
 | |
| 
 | |
| static bool cmp_arr_last_port_handle(struct dl *dl, const char *bus_name,
 | |
| 				     const char *dev_name, uint32_t port_index)
 | |
| {
 | |
| 	return cmp_arr_last_handle(dl, bus_name, dev_name) &&
 | |
| 	       dl->arr_last.port_index == port_index;
 | |
| }
 | |
| 
 | |
| static void arr_last_port_handle_set(struct dl *dl, const char *bus_name,
 | |
| 				     const char *dev_name, uint32_t port_index)
 | |
| {
 | |
| 	arr_last_handle_set(dl, bus_name, dev_name);
 | |
| 	dl->arr_last.port_index = port_index;
 | |
| }
 | |
| 
 | |
| static bool should_arr_last_port_handle_start(struct dl *dl,
 | |
| 					      const char *bus_name,
 | |
| 					      const char *dev_name,
 | |
| 					      uint32_t port_index)
 | |
| {
 | |
| 	return !cmp_arr_last_port_handle(dl, bus_name, dev_name, port_index);
 | |
| }
 | |
| 
 | |
| static bool should_arr_last_port_handle_end(struct dl *dl,
 | |
| 					    const char *bus_name,
 | |
| 					    const char *dev_name,
 | |
| 					    uint32_t port_index)
 | |
| {
 | |
| 	return dl->arr_last.present &&
 | |
| 	       !cmp_arr_last_port_handle(dl, bus_name, dev_name, port_index);
 | |
| }
 | |
| 
 | |
| static void __pr_out_port_handle_start(struct dl *dl, const char *bus_name,
 | |
| 				       const char *dev_name,
 | |
| 				       uint32_t port_index, bool try_nice,
 | |
| 				       bool array)
 | |
| {
 | |
| 	static char buf[32];
 | |
| 	char *ifname = NULL;
 | |
| 
 | |
| 	if (dl->no_nice_names || !try_nice ||
 | |
| 	    ifname_map_rev_lookup(dl, bus_name, dev_name,
 | |
| 				  port_index, &ifname) != 0)
 | |
| 		sprintf(buf, "%s/%s/%d", bus_name, dev_name, port_index);
 | |
| 	else
 | |
| 		sprintf(buf, "%s", ifname);
 | |
| 
 | |
| 	if (dl->json_output) {
 | |
| 		if (array) {
 | |
| 			if (should_arr_last_port_handle_end(dl, bus_name,
 | |
| 							    dev_name,
 | |
| 							    port_index))
 | |
| 				jsonw_end_array(dl->jw);
 | |
| 			if (should_arr_last_port_handle_start(dl, bus_name,
 | |
| 							      dev_name,
 | |
| 							      port_index)) {
 | |
| 				jsonw_name(dl->jw, buf);
 | |
| 				jsonw_start_array(dl->jw);
 | |
| 				jsonw_start_object(dl->jw);
 | |
| 				arr_last_port_handle_set(dl, bus_name, dev_name,
 | |
| 							 port_index);
 | |
| 			} else {
 | |
| 				jsonw_start_object(dl->jw);
 | |
| 			}
 | |
| 		} else {
 | |
| 			jsonw_name(dl->jw, buf);
 | |
| 			jsonw_start_object(dl->jw);
 | |
| 		}
 | |
| 	} else {
 | |
| 		pr_out("%s:", buf);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_port_handle_start(struct dl *dl, struct nlattr **tb, bool try_nice)
 | |
| {
 | |
| 	const char *bus_name;
 | |
| 	const char *dev_name;
 | |
| 	uint32_t port_index;
 | |
| 
 | |
| 	bus_name = mnl_attr_get_str(tb[DEVLINK_ATTR_BUS_NAME]);
 | |
| 	dev_name = mnl_attr_get_str(tb[DEVLINK_ATTR_DEV_NAME]);
 | |
| 	port_index = mnl_attr_get_u32(tb[DEVLINK_ATTR_PORT_INDEX]);
 | |
| 	__pr_out_port_handle_start(dl, bus_name, dev_name, port_index, try_nice, false);
 | |
| }
 | |
| 
 | |
| static void pr_out_port_handle_start_arr(struct dl *dl, struct nlattr **tb, bool try_nice)
 | |
| {
 | |
| 	const char *bus_name;
 | |
| 	const char *dev_name;
 | |
| 	uint32_t port_index;
 | |
| 
 | |
| 	bus_name = mnl_attr_get_str(tb[DEVLINK_ATTR_BUS_NAME]);
 | |
| 	dev_name = mnl_attr_get_str(tb[DEVLINK_ATTR_DEV_NAME]);
 | |
| 	port_index = mnl_attr_get_u32(tb[DEVLINK_ATTR_PORT_INDEX]);
 | |
| 	__pr_out_port_handle_start(dl, bus_name, dev_name, port_index, try_nice, true);
 | |
| }
 | |
| 
 | |
| static void pr_out_port_handle_end(struct dl *dl)
 | |
| {
 | |
| 	if (dl->json_output)
 | |
| 		jsonw_end_object(dl->jw);
 | |
| 	else
 | |
| 		pr_out("\n");
 | |
| }
 | |
| 
 | |
| 
 | |
| static void pr_out_str(struct dl *dl, const char *name, const char *val)
 | |
| {
 | |
| 	if (dl->json_output) {
 | |
| 		jsonw_string_field(dl->jw, name, val);
 | |
| 	} else {
 | |
| 		if (g_indent_newline)
 | |
| 			pr_out("%s %s", name, val);
 | |
| 		else
 | |
| 			pr_out(" %s %s", name, val);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_bool(struct dl *dl, const char *name, bool val)
 | |
| {
 | |
| 	if (val)
 | |
| 		pr_out_str(dl, name, "true");
 | |
| 	else
 | |
| 		pr_out_str(dl, name, "false");
 | |
| }
 | |
| 
 | |
| static void pr_out_uint(struct dl *dl, const char *name, unsigned int val)
 | |
| {
 | |
| 	if (dl->json_output) {
 | |
| 		jsonw_uint_field(dl->jw, name, val);
 | |
| 	} else {
 | |
| 		if (g_indent_newline)
 | |
| 			pr_out("%s %u", name, val);
 | |
| 		else
 | |
| 			pr_out(" %s %u", name, val);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_u64(struct dl *dl, const char *name, uint64_t val)
 | |
| {
 | |
| 	if (val == (uint64_t) -1)
 | |
| 		return pr_out_str(dl, name, "unlimited");
 | |
| 
 | |
| 	return pr_out_uint(dl, name, val);
 | |
| }
 | |
| 
 | |
| static void pr_out_region_chunk_start(struct dl *dl, uint64_t addr)
 | |
| {
 | |
| 	if (dl->json_output) {
 | |
| 		jsonw_name(dl->jw, "address");
 | |
| 		jsonw_uint(dl->jw, addr);
 | |
| 		jsonw_name(dl->jw, "data");
 | |
| 		jsonw_start_array(dl->jw);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_region_chunk_end(struct dl *dl)
 | |
| {
 | |
| 	if (dl->json_output)
 | |
| 		jsonw_end_array(dl->jw);
 | |
| }
 | |
| 
 | |
| static void pr_out_region_chunk(struct dl *dl, uint8_t *data, uint32_t len,
 | |
| 				uint64_t addr)
 | |
| {
 | |
| 	static uint64_t align_val;
 | |
| 	uint32_t i = 0;
 | |
| 
 | |
| 	pr_out_region_chunk_start(dl, addr);
 | |
| 	while (i < len) {
 | |
| 		if (!dl->json_output)
 | |
| 			if (!(align_val % 16))
 | |
| 				pr_out("%s%016"PRIx64" ",
 | |
| 				       align_val ? "\n" : "",
 | |
| 				       addr);
 | |
| 
 | |
| 		align_val++;
 | |
| 
 | |
| 		if (dl->json_output)
 | |
| 			jsonw_printf(dl->jw, "%d", data[i]);
 | |
| 		else
 | |
| 			pr_out("%02x ", data[i]);
 | |
| 
 | |
| 		addr++;
 | |
| 		i++;
 | |
| 	}
 | |
| 	pr_out_region_chunk_end(dl);
 | |
| }
 | |
| 
 | |
| static void pr_out_dev(struct dl *dl, struct nlattr **tb)
 | |
| {
 | |
| 	pr_out_handle(dl, tb);
 | |
| }
 | |
| 
 | |
| static void pr_out_section_start(struct dl *dl, const char *name)
 | |
| {
 | |
| 	if (dl->json_output) {
 | |
| 		jsonw_start_object(dl->jw);
 | |
| 		jsonw_name(dl->jw, name);
 | |
| 		jsonw_start_object(dl->jw);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_section_end(struct dl *dl)
 | |
| {
 | |
| 	if (dl->json_output) {
 | |
| 		if (dl->arr_last.present)
 | |
| 			jsonw_end_array(dl->jw);
 | |
| 		jsonw_end_object(dl->jw);
 | |
| 		jsonw_end_object(dl->jw);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_array_start(struct dl *dl, const char *name)
 | |
| {
 | |
| 	if (dl->json_output) {
 | |
| 		jsonw_name(dl->jw, name);
 | |
| 		jsonw_start_array(dl->jw);
 | |
| 	} else {
 | |
| 		__pr_out_indent_inc();
 | |
| 		__pr_out_newline();
 | |
| 		pr_out("%s:", name);
 | |
| 		__pr_out_indent_inc();
 | |
| 		__pr_out_newline();
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_array_end(struct dl *dl)
 | |
| {
 | |
| 	if (dl->json_output) {
 | |
| 		jsonw_end_array(dl->jw);
 | |
| 	} else {
 | |
| 		__pr_out_indent_dec();
 | |
| 		__pr_out_indent_dec();
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_object_start(struct dl *dl, const char *name)
 | |
| {
 | |
| 	if (dl->json_output) {
 | |
| 		jsonw_name(dl->jw, name);
 | |
| 		jsonw_start_object(dl->jw);
 | |
| 	} else {
 | |
| 		__pr_out_indent_inc();
 | |
| 		__pr_out_newline();
 | |
| 		pr_out("%s:", name);
 | |
| 		__pr_out_indent_inc();
 | |
| 		__pr_out_newline();
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_object_end(struct dl *dl)
 | |
| {
 | |
| 	if (dl->json_output) {
 | |
| 		jsonw_end_object(dl->jw);
 | |
| 	} else {
 | |
| 		__pr_out_indent_dec();
 | |
| 		__pr_out_indent_dec();
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_entry_start(struct dl *dl)
 | |
| {
 | |
| 	if (dl->json_output)
 | |
| 		jsonw_start_object(dl->jw);
 | |
| }
 | |
| 
 | |
| static void pr_out_entry_end(struct dl *dl)
 | |
| {
 | |
| 	if (dl->json_output)
 | |
| 		jsonw_end_object(dl->jw);
 | |
| 	else
 | |
| 		__pr_out_newline();
 | |
| }
 | |
| 
 | |
| static const char *param_cmode_name(uint8_t cmode)
 | |
| {
 | |
| 	switch (cmode) {
 | |
| 	case DEVLINK_PARAM_CMODE_RUNTIME:
 | |
| 		return PARAM_CMODE_RUNTIME_STR;
 | |
| 	case DEVLINK_PARAM_CMODE_DRIVERINIT:
 | |
| 		return PARAM_CMODE_DRIVERINIT_STR;
 | |
| 	case DEVLINK_PARAM_CMODE_PERMANENT:
 | |
| 		return PARAM_CMODE_PERMANENT_STR;
 | |
| 	default: return "<unknown type>";
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static const char *eswitch_mode_name(uint32_t mode)
 | |
| {
 | |
| 	switch (mode) {
 | |
| 	case DEVLINK_ESWITCH_MODE_LEGACY: return ESWITCH_MODE_LEGACY;
 | |
| 	case DEVLINK_ESWITCH_MODE_SWITCHDEV: return ESWITCH_MODE_SWITCHDEV;
 | |
| 	default: return "<unknown mode>";
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static const char *eswitch_inline_mode_name(uint32_t mode)
 | |
| {
 | |
| 	switch (mode) {
 | |
| 	case DEVLINK_ESWITCH_INLINE_MODE_NONE:
 | |
| 		return ESWITCH_INLINE_MODE_NONE;
 | |
| 	case DEVLINK_ESWITCH_INLINE_MODE_LINK:
 | |
| 		return ESWITCH_INLINE_MODE_LINK;
 | |
| 	case DEVLINK_ESWITCH_INLINE_MODE_NETWORK:
 | |
| 		return ESWITCH_INLINE_MODE_NETWORK;
 | |
| 	case DEVLINK_ESWITCH_INLINE_MODE_TRANSPORT:
 | |
| 		return ESWITCH_INLINE_MODE_TRANSPORT;
 | |
| 	default:
 | |
| 		return "<unknown mode>";
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_eswitch(struct dl *dl, struct nlattr **tb)
 | |
| {
 | |
| 	__pr_out_handle_start(dl, tb, true, false);
 | |
| 
 | |
| 	if (tb[DEVLINK_ATTR_ESWITCH_MODE])
 | |
| 		pr_out_str(dl, "mode",
 | |
| 			   eswitch_mode_name(mnl_attr_get_u16(tb[DEVLINK_ATTR_ESWITCH_MODE])));
 | |
| 
 | |
| 	if (tb[DEVLINK_ATTR_ESWITCH_INLINE_MODE])
 | |
| 		pr_out_str(dl, "inline-mode",
 | |
| 			   eswitch_inline_mode_name(mnl_attr_get_u8(
 | |
| 				   tb[DEVLINK_ATTR_ESWITCH_INLINE_MODE])));
 | |
| 
 | |
| 	if (tb[DEVLINK_ATTR_ESWITCH_ENCAP_MODE]) {
 | |
| 		bool encap_mode = !!mnl_attr_get_u8(tb[DEVLINK_ATTR_ESWITCH_ENCAP_MODE]);
 | |
| 
 | |
| 		pr_out_str(dl, "encap", encap_mode ? "enable" : "disable");
 | |
| 	}
 | |
| 
 | |
| 	pr_out_handle_end(dl);
 | |
| }
 | |
| 
 | |
| static int cmd_dev_eswitch_show_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct dl *dl = data;
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME])
 | |
| 		return MNL_CB_ERROR;
 | |
| 	pr_out_eswitch(dl, tb);
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int cmd_dev_eswitch_show(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_ESWITCH_GET,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 
 | |
| 	err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, 0);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	pr_out_section_start(dl, "dev");
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dev_eswitch_show_cb, dl);
 | |
| 	pr_out_section_end(dl);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int cmd_dev_eswitch_set(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_ESWITCH_SET,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 
 | |
| 	err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE,
 | |
| 				DL_OPT_ESWITCH_MODE |
 | |
| 				DL_OPT_ESWITCH_INLINE_MODE |
 | |
| 				DL_OPT_ESWITCH_ENCAP_MODE);
 | |
| 
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	if (dl->opts.present == 1) {
 | |
| 		pr_err("Need to set at least one option\n");
 | |
| 		return -ENOENT;
 | |
| 	}
 | |
| 
 | |
| 	return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
 | |
| }
 | |
| 
 | |
| static int cmd_dev_eswitch(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
 | |
| 		cmd_dev_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "set")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dev_eswitch_set(dl);
 | |
| 	} else if (dl_argv_match(dl, "show")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dev_eswitch_show(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| struct param_val_conv {
 | |
| 	const char *name;
 | |
| 	const char *vstr;
 | |
| 	uint32_t vuint;
 | |
| };
 | |
| 
 | |
| static bool param_val_conv_exists(const struct param_val_conv *param_val_conv,
 | |
| 				  uint32_t len, const char *name)
 | |
| {
 | |
| 	uint32_t i;
 | |
| 
 | |
| 	for (i = 0; i < len; i++)
 | |
| 		if (!strcmp(param_val_conv[i].name, name))
 | |
| 			return true;
 | |
| 
 | |
| 	return false;
 | |
| }
 | |
| 
 | |
| static int
 | |
| param_val_conv_uint_get(const struct param_val_conv *param_val_conv,
 | |
| 			uint32_t len, const char *name, const char *vstr,
 | |
| 			uint32_t *vuint)
 | |
| {
 | |
| 	uint32_t i;
 | |
| 
 | |
| 	for (i = 0; i < len; i++)
 | |
| 		if (!strcmp(param_val_conv[i].name, name) &&
 | |
| 		    !strcmp(param_val_conv[i].vstr, vstr)) {
 | |
| 			*vuint = param_val_conv[i].vuint;
 | |
| 			return 0;
 | |
| 		}
 | |
| 
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static int
 | |
| param_val_conv_str_get(const struct param_val_conv *param_val_conv,
 | |
| 		       uint32_t len, const char *name, uint32_t vuint,
 | |
| 		       const char **vstr)
 | |
| {
 | |
| 	uint32_t i;
 | |
| 
 | |
| 	for (i = 0; i < len; i++)
 | |
| 		if (!strcmp(param_val_conv[i].name, name) &&
 | |
| 		    param_val_conv[i].vuint == vuint) {
 | |
| 			*vstr = param_val_conv[i].vstr;
 | |
| 			return 0;
 | |
| 		}
 | |
| 
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static const struct param_val_conv param_val_conv[] = {
 | |
| 	{
 | |
| 		.name = "fw_load_policy",
 | |
| 		.vstr = "driver",
 | |
| 		.vuint = DEVLINK_PARAM_FW_LOAD_POLICY_VALUE_DRIVER,
 | |
| 	},
 | |
| 	{
 | |
| 		.name = "fw_load_policy",
 | |
| 		.vstr = "flash",
 | |
| 		.vuint = DEVLINK_PARAM_FW_LOAD_POLICY_VALUE_FLASH,
 | |
| 	},
 | |
| };
 | |
| 
 | |
| #define PARAM_VAL_CONV_LEN ARRAY_SIZE(param_val_conv)
 | |
| 
 | |
| static void pr_out_param_value(struct dl *dl, const char *nla_name,
 | |
| 			       int nla_type, struct nlattr *nl)
 | |
| {
 | |
| 	struct nlattr *nla_value[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct nlattr *val_attr;
 | |
| 	const char *vstr;
 | |
| 	bool conv_exists;
 | |
| 	int err;
 | |
| 
 | |
| 	err = mnl_attr_parse_nested(nl, attr_cb, nla_value);
 | |
| 	if (err != MNL_CB_OK)
 | |
| 		return;
 | |
| 
 | |
| 	if (!nla_value[DEVLINK_ATTR_PARAM_VALUE_CMODE] ||
 | |
| 	    (nla_type != MNL_TYPE_FLAG &&
 | |
| 	     !nla_value[DEVLINK_ATTR_PARAM_VALUE_DATA]))
 | |
| 		return;
 | |
| 
 | |
| 	pr_out_str(dl, "cmode",
 | |
| 		   param_cmode_name(mnl_attr_get_u8(nla_value[DEVLINK_ATTR_PARAM_VALUE_CMODE])));
 | |
| 	val_attr = nla_value[DEVLINK_ATTR_PARAM_VALUE_DATA];
 | |
| 
 | |
| 	conv_exists = param_val_conv_exists(param_val_conv, PARAM_VAL_CONV_LEN,
 | |
| 					    nla_name);
 | |
| 
 | |
| 	switch (nla_type) {
 | |
| 	case MNL_TYPE_U8:
 | |
| 		if (conv_exists) {
 | |
| 			err = param_val_conv_str_get(param_val_conv,
 | |
| 						     PARAM_VAL_CONV_LEN,
 | |
| 						     nla_name,
 | |
| 						     mnl_attr_get_u8(val_attr),
 | |
| 						     &vstr);
 | |
| 			if (err)
 | |
| 				return;
 | |
| 			pr_out_str(dl, "value", vstr);
 | |
| 		} else {
 | |
| 			pr_out_uint(dl, "value", mnl_attr_get_u8(val_attr));
 | |
| 		}
 | |
| 		break;
 | |
| 	case MNL_TYPE_U16:
 | |
| 		if (conv_exists) {
 | |
| 			err = param_val_conv_str_get(param_val_conv,
 | |
| 						     PARAM_VAL_CONV_LEN,
 | |
| 						     nla_name,
 | |
| 						     mnl_attr_get_u16(val_attr),
 | |
| 						     &vstr);
 | |
| 			if (err)
 | |
| 				return;
 | |
| 			pr_out_str(dl, "value", vstr);
 | |
| 		} else {
 | |
| 			pr_out_uint(dl, "value", mnl_attr_get_u16(val_attr));
 | |
| 		}
 | |
| 		break;
 | |
| 	case MNL_TYPE_U32:
 | |
| 		if (conv_exists) {
 | |
| 			err = param_val_conv_str_get(param_val_conv,
 | |
| 						     PARAM_VAL_CONV_LEN,
 | |
| 						     nla_name,
 | |
| 						     mnl_attr_get_u32(val_attr),
 | |
| 						     &vstr);
 | |
| 			if (err)
 | |
| 				return;
 | |
| 			pr_out_str(dl, "value", vstr);
 | |
| 		} else {
 | |
| 			pr_out_uint(dl, "value", mnl_attr_get_u32(val_attr));
 | |
| 		}
 | |
| 		break;
 | |
| 	case MNL_TYPE_STRING:
 | |
| 		pr_out_str(dl, "value", mnl_attr_get_str(val_attr));
 | |
| 		break;
 | |
| 	case MNL_TYPE_FLAG:
 | |
| 		pr_out_bool(dl, "value", val_attr ? true : false);
 | |
| 		break;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_param(struct dl *dl, struct nlattr **tb, bool array)
 | |
| {
 | |
| 	struct nlattr *nla_param[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct nlattr *param_value_attr;
 | |
| 	const char *nla_name;
 | |
| 	int nla_type;
 | |
| 	int err;
 | |
| 
 | |
| 	err = mnl_attr_parse_nested(tb[DEVLINK_ATTR_PARAM], attr_cb, nla_param);
 | |
| 	if (err != MNL_CB_OK)
 | |
| 		return;
 | |
| 	if (!nla_param[DEVLINK_ATTR_PARAM_NAME] ||
 | |
| 	    !nla_param[DEVLINK_ATTR_PARAM_TYPE] ||
 | |
| 	    !nla_param[DEVLINK_ATTR_PARAM_VALUES_LIST])
 | |
| 		return;
 | |
| 
 | |
| 	if (array)
 | |
| 		pr_out_handle_start_arr(dl, tb);
 | |
| 	else
 | |
| 		__pr_out_handle_start(dl, tb, true, false);
 | |
| 
 | |
| 	nla_type = mnl_attr_get_u8(nla_param[DEVLINK_ATTR_PARAM_TYPE]);
 | |
| 
 | |
| 	nla_name = mnl_attr_get_str(nla_param[DEVLINK_ATTR_PARAM_NAME]);
 | |
| 	pr_out_str(dl, "name", nla_name);
 | |
| 
 | |
| 	if (!nla_param[DEVLINK_ATTR_PARAM_GENERIC])
 | |
| 		pr_out_str(dl, "type", "driver-specific");
 | |
| 	else
 | |
| 		pr_out_str(dl, "type", "generic");
 | |
| 
 | |
| 	pr_out_array_start(dl, "values");
 | |
| 	mnl_attr_for_each_nested(param_value_attr,
 | |
| 				 nla_param[DEVLINK_ATTR_PARAM_VALUES_LIST]) {
 | |
| 		pr_out_entry_start(dl);
 | |
| 		pr_out_param_value(dl, nla_name, nla_type, param_value_attr);
 | |
| 		pr_out_entry_end(dl);
 | |
| 	}
 | |
| 	pr_out_array_end(dl);
 | |
| 	pr_out_handle_end(dl);
 | |
| }
 | |
| 
 | |
| static int cmd_dev_param_show_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct dl *dl = data;
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 	    !tb[DEVLINK_ATTR_PARAM])
 | |
| 		return MNL_CB_ERROR;
 | |
| 	pr_out_param(dl, tb, true);
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| struct param_ctx {
 | |
| 	struct dl *dl;
 | |
| 	int nla_type;
 | |
| 	union {
 | |
| 		uint8_t vu8;
 | |
| 		uint16_t vu16;
 | |
| 		uint32_t vu32;
 | |
| 		const char *vstr;
 | |
| 		bool vbool;
 | |
| 	} value;
 | |
| };
 | |
| 
 | |
| static int cmd_dev_param_set_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 	struct nlattr *nla_param[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct nlattr *param_value_attr;
 | |
| 	enum devlink_param_cmode cmode;
 | |
| 	struct param_ctx *ctx = data;
 | |
| 	struct dl *dl = ctx->dl;
 | |
| 	int nla_type;
 | |
| 	int err;
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 	    !tb[DEVLINK_ATTR_PARAM])
 | |
| 		return MNL_CB_ERROR;
 | |
| 
 | |
| 	err = mnl_attr_parse_nested(tb[DEVLINK_ATTR_PARAM], attr_cb, nla_param);
 | |
| 	if (err != MNL_CB_OK)
 | |
| 		return MNL_CB_ERROR;
 | |
| 
 | |
| 	if (!nla_param[DEVLINK_ATTR_PARAM_TYPE] ||
 | |
| 	    !nla_param[DEVLINK_ATTR_PARAM_VALUES_LIST])
 | |
| 		return MNL_CB_ERROR;
 | |
| 
 | |
| 	nla_type = mnl_attr_get_u8(nla_param[DEVLINK_ATTR_PARAM_TYPE]);
 | |
| 	mnl_attr_for_each_nested(param_value_attr,
 | |
| 				 nla_param[DEVLINK_ATTR_PARAM_VALUES_LIST]) {
 | |
| 		struct nlattr *nla_value[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 		struct nlattr *val_attr;
 | |
| 
 | |
| 		err = mnl_attr_parse_nested(param_value_attr,
 | |
| 					    attr_cb, nla_value);
 | |
| 		if (err != MNL_CB_OK)
 | |
| 			return MNL_CB_ERROR;
 | |
| 
 | |
| 		if (!nla_value[DEVLINK_ATTR_PARAM_VALUE_CMODE] ||
 | |
| 		    (nla_type != MNL_TYPE_FLAG &&
 | |
| 		     !nla_value[DEVLINK_ATTR_PARAM_VALUE_DATA]))
 | |
| 			return MNL_CB_ERROR;
 | |
| 
 | |
| 		cmode = mnl_attr_get_u8(nla_value[DEVLINK_ATTR_PARAM_VALUE_CMODE]);
 | |
| 		if (cmode == dl->opts.cmode) {
 | |
| 			val_attr = nla_value[DEVLINK_ATTR_PARAM_VALUE_DATA];
 | |
| 			switch (nla_type) {
 | |
| 			case MNL_TYPE_U8:
 | |
| 				ctx->value.vu8 = mnl_attr_get_u8(val_attr);
 | |
| 				break;
 | |
| 			case MNL_TYPE_U16:
 | |
| 				ctx->value.vu16 = mnl_attr_get_u16(val_attr);
 | |
| 				break;
 | |
| 			case MNL_TYPE_U32:
 | |
| 				ctx->value.vu32 = mnl_attr_get_u32(val_attr);
 | |
| 				break;
 | |
| 			case MNL_TYPE_STRING:
 | |
| 				ctx->value.vstr = mnl_attr_get_str(val_attr);
 | |
| 				break;
 | |
| 			case MNL_TYPE_FLAG:
 | |
| 				ctx->value.vbool = val_attr ? true : false;
 | |
| 				break;
 | |
| 			}
 | |
| 			break;
 | |
| 		}
 | |
| 	}
 | |
| 	ctx->nla_type = nla_type;
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int cmd_dev_param_set(struct dl *dl)
 | |
| {
 | |
| 	struct param_ctx ctx = {};
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	bool conv_exists;
 | |
| 	uint32_t val_u32;
 | |
| 	uint16_t val_u16;
 | |
| 	uint8_t val_u8;
 | |
| 	bool val_bool;
 | |
| 	int err;
 | |
| 
 | |
| 	err = dl_argv_parse(dl, DL_OPT_HANDLE |
 | |
| 			    DL_OPT_PARAM_NAME |
 | |
| 			    DL_OPT_PARAM_VALUE |
 | |
| 			    DL_OPT_PARAM_CMODE, 0);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	/* Get value type */
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PARAM_GET,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 	dl_opts_put(nlh, dl);
 | |
| 
 | |
| 	ctx.dl = dl;
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dev_param_set_cb, &ctx);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PARAM_SET,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 	dl_opts_put(nlh, dl);
 | |
| 
 | |
| 	conv_exists = param_val_conv_exists(param_val_conv, PARAM_VAL_CONV_LEN,
 | |
| 					    dl->opts.param_name);
 | |
| 
 | |
| 	mnl_attr_put_u8(nlh, DEVLINK_ATTR_PARAM_TYPE, ctx.nla_type);
 | |
| 	switch (ctx.nla_type) {
 | |
| 	case MNL_TYPE_U8:
 | |
| 		if (conv_exists) {
 | |
| 			err = param_val_conv_uint_get(param_val_conv,
 | |
| 						      PARAM_VAL_CONV_LEN,
 | |
| 						      dl->opts.param_name,
 | |
| 						      dl->opts.param_value,
 | |
| 						      &val_u32);
 | |
| 			val_u8 = val_u32;
 | |
| 		} else {
 | |
| 			err = strtouint8_t(dl->opts.param_value, &val_u8);
 | |
| 		}
 | |
| 		if (err)
 | |
| 			goto err_param_value_parse;
 | |
| 		if (val_u8 == ctx.value.vu8)
 | |
| 			return 0;
 | |
| 		mnl_attr_put_u8(nlh, DEVLINK_ATTR_PARAM_VALUE_DATA, val_u8);
 | |
| 		break;
 | |
| 	case MNL_TYPE_U16:
 | |
| 		if (conv_exists) {
 | |
| 			err = param_val_conv_uint_get(param_val_conv,
 | |
| 						      PARAM_VAL_CONV_LEN,
 | |
| 						      dl->opts.param_name,
 | |
| 						      dl->opts.param_value,
 | |
| 						      &val_u32);
 | |
| 			val_u16 = val_u32;
 | |
| 		} else {
 | |
| 			err = strtouint16_t(dl->opts.param_value, &val_u16);
 | |
| 		}
 | |
| 		if (err)
 | |
| 			goto err_param_value_parse;
 | |
| 		if (val_u16 == ctx.value.vu16)
 | |
| 			return 0;
 | |
| 		mnl_attr_put_u16(nlh, DEVLINK_ATTR_PARAM_VALUE_DATA, val_u16);
 | |
| 		break;
 | |
| 	case MNL_TYPE_U32:
 | |
| 		if (conv_exists)
 | |
| 			err = param_val_conv_uint_get(param_val_conv,
 | |
| 						      PARAM_VAL_CONV_LEN,
 | |
| 						      dl->opts.param_name,
 | |
| 						      dl->opts.param_value,
 | |
| 						      &val_u32);
 | |
| 		else
 | |
| 			err = strtouint32_t(dl->opts.param_value, &val_u32);
 | |
| 		if (err)
 | |
| 			goto err_param_value_parse;
 | |
| 		if (val_u32 == ctx.value.vu32)
 | |
| 			return 0;
 | |
| 		mnl_attr_put_u32(nlh, DEVLINK_ATTR_PARAM_VALUE_DATA, val_u32);
 | |
| 		break;
 | |
| 	case MNL_TYPE_FLAG:
 | |
| 		err = strtobool(dl->opts.param_value, &val_bool);
 | |
| 		if (err)
 | |
| 			goto err_param_value_parse;
 | |
| 		if (val_bool == ctx.value.vbool)
 | |
| 			return 0;
 | |
| 		if (val_bool)
 | |
| 			mnl_attr_put(nlh, DEVLINK_ATTR_PARAM_VALUE_DATA,
 | |
| 				     0, NULL);
 | |
| 		break;
 | |
| 	case MNL_TYPE_STRING:
 | |
| 		mnl_attr_put_strz(nlh, DEVLINK_ATTR_PARAM_VALUE_DATA,
 | |
| 				  dl->opts.param_value);
 | |
| 		if (!strcmp(dl->opts.param_value, ctx.value.vstr))
 | |
| 			return 0;
 | |
| 		break;
 | |
| 	default:
 | |
| 		printf("Value type not supported\n");
 | |
| 		return -ENOTSUP;
 | |
| 	}
 | |
| 	return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
 | |
| 
 | |
| err_param_value_parse:
 | |
| 	pr_err("Value \"%s\" is not a number or not within range\n",
 | |
| 	       dl->opts.param_value);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int cmd_dev_param_show(struct dl *dl)
 | |
| {
 | |
| 	uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	if (dl_argc(dl) == 0)
 | |
| 		flags |= NLM_F_DUMP;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PARAM_GET, flags);
 | |
| 
 | |
| 	if (dl_argc(dl) > 0) {
 | |
| 		err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE |
 | |
| 					DL_OPT_PARAM_NAME, 0);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 	}
 | |
| 
 | |
| 	pr_out_section_start(dl, "param");
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dev_param_show_cb, dl);
 | |
| 	pr_out_section_end(dl);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int cmd_dev_param(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argv_match(dl, "help")) {
 | |
| 		cmd_dev_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "show") ||
 | |
| 		   dl_argv_match(dl, "list") || dl_no_arg(dl)) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dev_param_show(dl);
 | |
| 	} else if (dl_argv_match(dl, "set")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dev_param_set(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| static int cmd_dev_show_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct dl *dl = data;
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME])
 | |
| 		return MNL_CB_ERROR;
 | |
| 	pr_out_dev(dl, tb);
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int cmd_dev_show(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
 | |
| 	int err;
 | |
| 
 | |
| 	if (dl_argc(dl) == 0)
 | |
| 		flags |= NLM_F_DUMP;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_GET, flags);
 | |
| 
 | |
| 	if (dl_argc(dl) > 0) {
 | |
| 		err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, 0);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 	}
 | |
| 
 | |
| 	pr_out_section_start(dl, "dev");
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dev_show_cb, dl);
 | |
| 	pr_out_section_end(dl);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static void cmd_dev_reload_help(void)
 | |
| {
 | |
| 	pr_err("Usage: devlink dev reload [ DEV ]\n");
 | |
| }
 | |
| 
 | |
| static int cmd_dev_reload(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
 | |
| 		cmd_dev_reload_help();
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_RELOAD,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 
 | |
| 	err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, 0);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
 | |
| }
 | |
| 
 | |
| static void pr_out_versions_single(struct dl *dl, const struct nlmsghdr *nlh,
 | |
| 				   const char *name, int type)
 | |
| {
 | |
| 	struct nlattr *version;
 | |
| 
 | |
| 	mnl_attr_for_each(version, nlh, sizeof(struct genlmsghdr)) {
 | |
| 		struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 		const char *ver_value;
 | |
| 		const char *ver_name;
 | |
| 		int err;
 | |
| 
 | |
| 		if (mnl_attr_get_type(version) != type)
 | |
| 			continue;
 | |
| 
 | |
| 		err = mnl_attr_parse_nested(version, attr_cb, tb);
 | |
| 		if (err != MNL_CB_OK)
 | |
| 			continue;
 | |
| 
 | |
| 		if (!tb[DEVLINK_ATTR_INFO_VERSION_NAME] ||
 | |
| 		    !tb[DEVLINK_ATTR_INFO_VERSION_VALUE])
 | |
| 			continue;
 | |
| 
 | |
| 		if (name) {
 | |
| 			pr_out_object_start(dl, name);
 | |
| 			name = NULL;
 | |
| 		}
 | |
| 
 | |
| 		ver_name = mnl_attr_get_str(tb[DEVLINK_ATTR_INFO_VERSION_NAME]);
 | |
| 		ver_value = mnl_attr_get_str(tb[DEVLINK_ATTR_INFO_VERSION_VALUE]);
 | |
| 
 | |
| 		pr_out_str(dl, ver_name, ver_value);
 | |
| 		if (!dl->json_output)
 | |
| 			__pr_out_newline();
 | |
| 	}
 | |
| 
 | |
| 	if (!name)
 | |
| 		pr_out_object_end(dl);
 | |
| }
 | |
| 
 | |
| static void pr_out_info(struct dl *dl, const struct nlmsghdr *nlh,
 | |
| 			struct nlattr **tb, bool has_versions)
 | |
| {
 | |
| 	__pr_out_handle_start(dl, tb, true, false);
 | |
| 
 | |
| 	__pr_out_indent_inc();
 | |
| 	if (tb[DEVLINK_ATTR_INFO_DRIVER_NAME]) {
 | |
| 		struct nlattr *nla_drv = tb[DEVLINK_ATTR_INFO_DRIVER_NAME];
 | |
| 
 | |
| 		if (!dl->json_output)
 | |
| 			__pr_out_newline();
 | |
| 		pr_out_str(dl, "driver", mnl_attr_get_str(nla_drv));
 | |
| 	}
 | |
| 
 | |
| 	if (tb[DEVLINK_ATTR_INFO_SERIAL_NUMBER]) {
 | |
| 		struct nlattr *nla_sn = tb[DEVLINK_ATTR_INFO_SERIAL_NUMBER];
 | |
| 
 | |
| 		if (!dl->json_output)
 | |
| 			__pr_out_newline();
 | |
| 		pr_out_str(dl, "serial_number", mnl_attr_get_str(nla_sn));
 | |
| 	}
 | |
| 	__pr_out_indent_dec();
 | |
| 
 | |
| 	if (has_versions) {
 | |
| 		pr_out_object_start(dl, "versions");
 | |
| 
 | |
| 		pr_out_versions_single(dl, nlh, "fixed",
 | |
| 				       DEVLINK_ATTR_INFO_VERSION_FIXED);
 | |
| 		pr_out_versions_single(dl, nlh, "running",
 | |
| 				       DEVLINK_ATTR_INFO_VERSION_RUNNING);
 | |
| 		pr_out_versions_single(dl, nlh, "stored",
 | |
| 				       DEVLINK_ATTR_INFO_VERSION_STORED);
 | |
| 
 | |
| 		pr_out_object_end(dl);
 | |
| 	}
 | |
| 
 | |
| 	pr_out_handle_end(dl);
 | |
| }
 | |
| 
 | |
| static int cmd_versions_show_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	bool has_versions, has_info;
 | |
| 	struct dl *dl = data;
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME])
 | |
| 		return MNL_CB_ERROR;
 | |
| 
 | |
| 	has_versions = tb[DEVLINK_ATTR_INFO_VERSION_FIXED] ||
 | |
| 		tb[DEVLINK_ATTR_INFO_VERSION_RUNNING] ||
 | |
| 		tb[DEVLINK_ATTR_INFO_VERSION_STORED];
 | |
| 	has_info = tb[DEVLINK_ATTR_INFO_DRIVER_NAME] ||
 | |
| 		tb[DEVLINK_ATTR_INFO_SERIAL_NUMBER] ||
 | |
| 		has_versions;
 | |
| 
 | |
| 	if (has_info)
 | |
| 		pr_out_info(dl, nlh, tb, has_versions);
 | |
| 
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static void cmd_dev_info_help(void)
 | |
| {
 | |
| 	pr_err("Usage: devlink dev info [ DEV ]\n");
 | |
| }
 | |
| 
 | |
| static int cmd_dev_info(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
 | |
| 	int err;
 | |
| 
 | |
| 	if (dl_argv_match(dl, "help")) {
 | |
| 		cmd_dev_info_help();
 | |
| 		return 0;
 | |
| 	}
 | |
| 
 | |
| 	if (dl_argc(dl) == 0)
 | |
| 		flags |= NLM_F_DUMP;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_INFO_GET, flags);
 | |
| 
 | |
| 	if (dl_argc(dl) > 0) {
 | |
| 		err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, 0);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 	}
 | |
| 
 | |
| 	pr_out_section_start(dl, "info");
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_versions_show_cb, dl);
 | |
| 	pr_out_section_end(dl);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int cmd_dev(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argv_match(dl, "help")) {
 | |
| 		cmd_dev_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "show") ||
 | |
| 		   dl_argv_match(dl, "list") || dl_no_arg(dl)) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dev_show(dl);
 | |
| 	} else if (dl_argv_match(dl, "eswitch")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dev_eswitch(dl);
 | |
| 	} else if (dl_argv_match(dl, "reload")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dev_reload(dl);
 | |
| 	} else if (dl_argv_match(dl, "param")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dev_param(dl);
 | |
| 	} else if (dl_argv_match(dl, "info")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dev_info(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static void cmd_port_help(void)
 | |
| {
 | |
| 	pr_err("Usage: devlink port show [ DEV/PORT_INDEX ]\n");
 | |
| 	pr_err("       devlink port set DEV/PORT_INDEX [ type { eth | ib | auto} ]\n");
 | |
| 	pr_err("       devlink port split DEV/PORT_INDEX count COUNT\n");
 | |
| 	pr_err("       devlink port unsplit DEV/PORT_INDEX\n");
 | |
| }
 | |
| 
 | |
| static const char *port_type_name(uint32_t type)
 | |
| {
 | |
| 	switch (type) {
 | |
| 	case DEVLINK_PORT_TYPE_NOTSET: return "notset";
 | |
| 	case DEVLINK_PORT_TYPE_AUTO: return "auto";
 | |
| 	case DEVLINK_PORT_TYPE_ETH: return "eth";
 | |
| 	case DEVLINK_PORT_TYPE_IB: return "ib";
 | |
| 	default: return "<unknown type>";
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static const char *port_flavour_name(uint16_t flavour)
 | |
| {
 | |
| 	switch (flavour) {
 | |
| 	case DEVLINK_PORT_FLAVOUR_PHYSICAL:
 | |
| 		return "physical";
 | |
| 	case DEVLINK_PORT_FLAVOUR_CPU:
 | |
| 		return "cpu";
 | |
| 	case DEVLINK_PORT_FLAVOUR_DSA:
 | |
| 		return "dsa";
 | |
| 	default:
 | |
| 		return "<unknown flavour>";
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_port(struct dl *dl, struct nlattr **tb)
 | |
| {
 | |
| 	struct nlattr *pt_attr = tb[DEVLINK_ATTR_PORT_TYPE];
 | |
| 	struct nlattr *dpt_attr = tb[DEVLINK_ATTR_PORT_DESIRED_TYPE];
 | |
| 
 | |
| 	pr_out_port_handle_start(dl, tb, false);
 | |
| 	if (pt_attr) {
 | |
| 		uint16_t port_type = mnl_attr_get_u16(pt_attr);
 | |
| 
 | |
| 		pr_out_str(dl, "type", port_type_name(port_type));
 | |
| 		if (dpt_attr) {
 | |
| 			uint16_t des_port_type = mnl_attr_get_u16(dpt_attr);
 | |
| 
 | |
| 			if (port_type != des_port_type)
 | |
| 				pr_out_str(dl, "des_type",
 | |
| 					   port_type_name(des_port_type));
 | |
| 		}
 | |
| 	}
 | |
| 	if (tb[DEVLINK_ATTR_PORT_NETDEV_NAME])
 | |
| 		pr_out_str(dl, "netdev",
 | |
| 			   mnl_attr_get_str(tb[DEVLINK_ATTR_PORT_NETDEV_NAME]));
 | |
| 	if (tb[DEVLINK_ATTR_PORT_IBDEV_NAME])
 | |
| 		pr_out_str(dl, "ibdev",
 | |
| 			   mnl_attr_get_str(tb[DEVLINK_ATTR_PORT_IBDEV_NAME]));
 | |
| 	if (tb[DEVLINK_ATTR_PORT_FLAVOUR]) {
 | |
| 		uint16_t port_flavour =
 | |
| 				mnl_attr_get_u16(tb[DEVLINK_ATTR_PORT_FLAVOUR]);
 | |
| 
 | |
| 		pr_out_str(dl, "flavour", port_flavour_name(port_flavour));
 | |
| 	}
 | |
| 	if (tb[DEVLINK_ATTR_PORT_SPLIT_GROUP])
 | |
| 		pr_out_uint(dl, "split_group",
 | |
| 			    mnl_attr_get_u32(tb[DEVLINK_ATTR_PORT_SPLIT_GROUP]));
 | |
| 	pr_out_port_handle_end(dl);
 | |
| }
 | |
| 
 | |
| static int cmd_port_show_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct dl *dl = data;
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 	    !tb[DEVLINK_ATTR_PORT_INDEX])
 | |
| 		return MNL_CB_ERROR;
 | |
| 	pr_out_port(dl, tb);
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int cmd_port_show(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
 | |
| 	int err;
 | |
| 
 | |
| 	if (dl_argc(dl) == 0)
 | |
| 		flags |= NLM_F_DUMP;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PORT_GET, flags);
 | |
| 
 | |
| 	if (dl_argc(dl) > 0) {
 | |
| 		err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP, 0);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 	}
 | |
| 
 | |
| 	pr_out_section_start(dl, "port");
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_port_show_cb, dl);
 | |
| 	pr_out_section_end(dl);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int cmd_port_set(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PORT_SET,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 
 | |
| 	err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP | DL_OPT_PORT_TYPE, 0);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
 | |
| }
 | |
| 
 | |
| static int cmd_port_split(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PORT_SPLIT,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 
 | |
| 	err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP | DL_OPT_PORT_COUNT, 0);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
 | |
| }
 | |
| 
 | |
| static int cmd_port_unsplit(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_PORT_UNSPLIT,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 
 | |
| 	err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP, 0);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
 | |
| }
 | |
| 
 | |
| static int cmd_port(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argv_match(dl, "help")) {
 | |
| 		cmd_port_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "show") ||
 | |
| 		   dl_argv_match(dl, "list") ||  dl_no_arg(dl)) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_port_show(dl);
 | |
| 	} else if (dl_argv_match(dl, "set")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_port_set(dl);
 | |
| 	} else if (dl_argv_match(dl, "split")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_port_split(dl);
 | |
| 	} else if (dl_argv_match(dl, "unsplit")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_port_unsplit(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static void cmd_sb_help(void)
 | |
| {
 | |
| 	pr_err("Usage: devlink sb show [ DEV [ sb SB_INDEX ] ]\n");
 | |
| 	pr_err("       devlink sb pool show [ DEV [ sb SB_INDEX ] pool POOL_INDEX ]\n");
 | |
| 	pr_err("       devlink sb pool set DEV [ sb SB_INDEX ] pool POOL_INDEX\n");
 | |
| 	pr_err("                           size POOL_SIZE thtype { static | dynamic }\n");
 | |
| 	pr_err("       devlink sb port pool show [ DEV/PORT_INDEX [ sb SB_INDEX ]\n");
 | |
| 	pr_err("                                   pool POOL_INDEX ]\n");
 | |
| 	pr_err("       devlink sb port pool set DEV/PORT_INDEX [ sb SB_INDEX ]\n");
 | |
| 	pr_err("                                pool POOL_INDEX th THRESHOLD\n");
 | |
| 	pr_err("       devlink sb tc bind show [ DEV/PORT_INDEX [ sb SB_INDEX ] tc TC_INDEX\n");
 | |
| 	pr_err("                                 type { ingress | egress } ]\n");
 | |
| 	pr_err("       devlink sb tc bind set DEV/PORT_INDEX [ sb SB_INDEX ] tc TC_INDEX\n");
 | |
| 	pr_err("                              type { ingress | egress } pool POOL_INDEX\n");
 | |
| 	pr_err("                              th THRESHOLD\n");
 | |
| 	pr_err("       devlink sb occupancy show { DEV | DEV/PORT_INDEX } [ sb SB_INDEX ]\n");
 | |
| 	pr_err("       devlink sb occupancy snapshot DEV [ sb SB_INDEX ]\n");
 | |
| 	pr_err("       devlink sb occupancy clearmax DEV [ sb SB_INDEX ]\n");
 | |
| }
 | |
| 
 | |
| static void pr_out_sb(struct dl *dl, struct nlattr **tb)
 | |
| {
 | |
| 	pr_out_handle_start_arr(dl, tb);
 | |
| 	pr_out_uint(dl, "sb",
 | |
| 		    mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_INDEX]));
 | |
| 	pr_out_uint(dl, "size",
 | |
| 		    mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_SIZE]));
 | |
| 	pr_out_uint(dl, "ing_pools",
 | |
| 		    mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_INGRESS_POOL_COUNT]));
 | |
| 	pr_out_uint(dl, "eg_pools",
 | |
| 		    mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_EGRESS_POOL_COUNT]));
 | |
| 	pr_out_uint(dl, "ing_tcs",
 | |
| 		    mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_INGRESS_TC_COUNT]));
 | |
| 	pr_out_uint(dl, "eg_tcs",
 | |
| 		    mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_EGRESS_TC_COUNT]));
 | |
| 	pr_out_handle_end(dl);
 | |
| }
 | |
| 
 | |
| static int cmd_sb_show_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct dl *dl = data;
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 	    !tb[DEVLINK_ATTR_SB_INDEX] || !tb[DEVLINK_ATTR_SB_SIZE] ||
 | |
| 	    !tb[DEVLINK_ATTR_SB_INGRESS_POOL_COUNT] ||
 | |
| 	    !tb[DEVLINK_ATTR_SB_EGRESS_POOL_COUNT] ||
 | |
| 	    !tb[DEVLINK_ATTR_SB_INGRESS_TC_COUNT] ||
 | |
| 	    !tb[DEVLINK_ATTR_SB_EGRESS_TC_COUNT])
 | |
| 		return MNL_CB_ERROR;
 | |
| 	pr_out_sb(dl, tb);
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int cmd_sb_show(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
 | |
| 	int err;
 | |
| 
 | |
| 	if (dl_argc(dl) == 0)
 | |
| 		flags |= NLM_F_DUMP;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_GET, flags);
 | |
| 
 | |
| 	if (dl_argc(dl) > 0) {
 | |
| 		err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, DL_OPT_SB);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 	}
 | |
| 
 | |
| 	pr_out_section_start(dl, "sb");
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_sb_show_cb, dl);
 | |
| 	pr_out_section_end(dl);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static const char *pool_type_name(uint8_t type)
 | |
| {
 | |
| 	switch (type) {
 | |
| 	case DEVLINK_SB_POOL_TYPE_INGRESS: return "ingress";
 | |
| 	case DEVLINK_SB_POOL_TYPE_EGRESS: return "egress";
 | |
| 	default: return "<unknown type>";
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static const char *threshold_type_name(uint8_t type)
 | |
| {
 | |
| 	switch (type) {
 | |
| 	case DEVLINK_SB_THRESHOLD_TYPE_STATIC: return "static";
 | |
| 	case DEVLINK_SB_THRESHOLD_TYPE_DYNAMIC: return "dynamic";
 | |
| 	default: return "<unknown type>";
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_sb_pool(struct dl *dl, struct nlattr **tb)
 | |
| {
 | |
| 	pr_out_handle_start_arr(dl, tb);
 | |
| 	pr_out_uint(dl, "sb",
 | |
| 		    mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_INDEX]));
 | |
| 	pr_out_uint(dl, "pool",
 | |
| 		    mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_POOL_INDEX]));
 | |
| 	pr_out_str(dl, "type",
 | |
| 		   pool_type_name(mnl_attr_get_u8(tb[DEVLINK_ATTR_SB_POOL_TYPE])));
 | |
| 	pr_out_uint(dl, "size",
 | |
| 		    mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_POOL_SIZE]));
 | |
| 	pr_out_str(dl, "thtype",
 | |
| 		   threshold_type_name(mnl_attr_get_u8(tb[DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE])));
 | |
| 	if (tb[DEVLINK_ATTR_SB_POOL_CELL_SIZE])
 | |
| 		pr_out_uint(dl, "cell_size",
 | |
| 			    mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_POOL_CELL_SIZE]));
 | |
| 	pr_out_handle_end(dl);
 | |
| }
 | |
| 
 | |
| static int cmd_sb_pool_show_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct dl *dl = data;
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 	    !tb[DEVLINK_ATTR_SB_INDEX] || !tb[DEVLINK_ATTR_SB_POOL_INDEX] ||
 | |
| 	    !tb[DEVLINK_ATTR_SB_POOL_TYPE] || !tb[DEVLINK_ATTR_SB_POOL_SIZE] ||
 | |
| 	    !tb[DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE])
 | |
| 		return MNL_CB_ERROR;
 | |
| 	pr_out_sb_pool(dl, tb);
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int cmd_sb_pool_show(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
 | |
| 	int err;
 | |
| 
 | |
| 	if (dl_argc(dl) == 0)
 | |
| 		flags |= NLM_F_DUMP;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_POOL_GET, flags);
 | |
| 
 | |
| 	if (dl_argc(dl) > 0) {
 | |
| 		err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE | DL_OPT_SB_POOL,
 | |
| 					DL_OPT_SB);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 	}
 | |
| 
 | |
| 	pr_out_section_start(dl, "pool");
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_sb_pool_show_cb, dl);
 | |
| 	pr_out_section_end(dl);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int cmd_sb_pool_set(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_POOL_SET,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 
 | |
| 	err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE | DL_OPT_SB_POOL |
 | |
| 				DL_OPT_SB_SIZE | DL_OPT_SB_THTYPE, DL_OPT_SB);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
 | |
| }
 | |
| 
 | |
| static int cmd_sb_pool(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argv_match(dl, "help")) {
 | |
| 		cmd_sb_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "show") ||
 | |
| 		   dl_argv_match(dl, "list") || dl_no_arg(dl)) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb_pool_show(dl);
 | |
| 	} else if (dl_argv_match(dl, "set")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb_pool_set(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static void pr_out_sb_port_pool(struct dl *dl, struct nlattr **tb)
 | |
| {
 | |
| 	pr_out_port_handle_start_arr(dl, tb, true);
 | |
| 	pr_out_uint(dl, "sb",
 | |
| 		    mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_INDEX]));
 | |
| 	pr_out_uint(dl, "pool",
 | |
| 		    mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_POOL_INDEX]));
 | |
| 	pr_out_uint(dl, "threshold",
 | |
| 		    mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_THRESHOLD]));
 | |
| 	pr_out_port_handle_end(dl);
 | |
| }
 | |
| 
 | |
| static int cmd_sb_port_pool_show_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct dl *dl = data;
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 	    !tb[DEVLINK_ATTR_PORT_INDEX] || !tb[DEVLINK_ATTR_SB_INDEX] ||
 | |
| 	    !tb[DEVLINK_ATTR_SB_POOL_INDEX] || !tb[DEVLINK_ATTR_SB_THRESHOLD])
 | |
| 		return MNL_CB_ERROR;
 | |
| 	pr_out_sb_port_pool(dl, tb);
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int cmd_sb_port_pool_show(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
 | |
| 	int err;
 | |
| 
 | |
| 	if (dl_argc(dl) == 0)
 | |
| 		flags |= NLM_F_DUMP;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_PORT_POOL_GET, flags);
 | |
| 
 | |
| 	if (dl_argc(dl) > 0) {
 | |
| 		err = dl_argv_parse_put(nlh, dl,
 | |
| 					DL_OPT_HANDLEP | DL_OPT_SB_POOL,
 | |
| 					DL_OPT_SB);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 	}
 | |
| 
 | |
| 	pr_out_section_start(dl, "port_pool");
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_sb_port_pool_show_cb, dl);
 | |
| 	pr_out_section_end(dl);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int cmd_sb_port_pool_set(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_PORT_POOL_SET,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 
 | |
| 	err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP | DL_OPT_SB_POOL |
 | |
| 				DL_OPT_SB_TH, DL_OPT_SB);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
 | |
| }
 | |
| 
 | |
| static int cmd_sb_port_pool(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argv_match(dl, "help")) {
 | |
| 		cmd_sb_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "show") ||
 | |
| 		   dl_argv_match(dl, "list") || dl_no_arg(dl)) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb_port_pool_show(dl);
 | |
| 	} else if (dl_argv_match(dl, "set")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb_port_pool_set(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static int cmd_sb_port(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
 | |
| 		cmd_sb_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "pool")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb_port_pool(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static void pr_out_sb_tc_bind(struct dl *dl, struct nlattr **tb)
 | |
| {
 | |
| 	pr_out_port_handle_start_arr(dl, tb, true);
 | |
| 	pr_out_uint(dl, "sb",
 | |
| 	       mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_INDEX]));
 | |
| 	pr_out_uint(dl, "tc",
 | |
| 	       mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_TC_INDEX]));
 | |
| 	pr_out_str(dl, "type",
 | |
| 	       pool_type_name(mnl_attr_get_u8(tb[DEVLINK_ATTR_SB_POOL_TYPE])));
 | |
| 	pr_out_uint(dl, "pool",
 | |
| 	       mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_POOL_INDEX]));
 | |
| 	pr_out_uint(dl, "threshold",
 | |
| 	       mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_THRESHOLD]));
 | |
| 	pr_out_port_handle_end(dl);
 | |
| }
 | |
| 
 | |
| static int cmd_sb_tc_bind_show_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct dl *dl = data;
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 	    !tb[DEVLINK_ATTR_PORT_INDEX] || !tb[DEVLINK_ATTR_SB_INDEX] ||
 | |
| 	    !tb[DEVLINK_ATTR_SB_TC_INDEX] || !tb[DEVLINK_ATTR_SB_POOL_TYPE] ||
 | |
| 	    !tb[DEVLINK_ATTR_SB_POOL_INDEX] || !tb[DEVLINK_ATTR_SB_THRESHOLD])
 | |
| 		return MNL_CB_ERROR;
 | |
| 	pr_out_sb_tc_bind(dl, tb);
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int cmd_sb_tc_bind_show(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
 | |
| 	int err;
 | |
| 
 | |
| 	if (dl_argc(dl) == 0)
 | |
| 		flags |= NLM_F_DUMP;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_TC_POOL_BIND_GET, flags);
 | |
| 
 | |
| 	if (dl_argc(dl) > 0) {
 | |
| 		err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP | DL_OPT_SB_TC |
 | |
| 					DL_OPT_SB_TYPE, DL_OPT_SB);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 	}
 | |
| 
 | |
| 	pr_out_section_start(dl, "tc_bind");
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_sb_tc_bind_show_cb, dl);
 | |
| 	pr_out_section_end(dl);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int cmd_sb_tc_bind_set(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_TC_POOL_BIND_SET,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 
 | |
| 	err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLEP | DL_OPT_SB_TC |
 | |
| 				DL_OPT_SB_TYPE | DL_OPT_SB_POOL | DL_OPT_SB_TH,
 | |
| 				DL_OPT_SB);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
 | |
| }
 | |
| 
 | |
| static int cmd_sb_tc_bind(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argv_match(dl, "help")) {
 | |
| 		cmd_sb_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "show") ||
 | |
| 		   dl_argv_match(dl, "list") || dl_no_arg(dl)) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb_tc_bind_show(dl);
 | |
| 	} else if (dl_argv_match(dl, "set")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb_tc_bind_set(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static int cmd_sb_tc(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
 | |
| 		cmd_sb_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "bind")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb_tc_bind(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| struct occ_item {
 | |
| 	struct list_head list;
 | |
| 	uint32_t index;
 | |
| 	uint32_t cur;
 | |
| 	uint32_t max;
 | |
| 	uint32_t bound_pool_index;
 | |
| };
 | |
| 
 | |
| struct occ_port {
 | |
| 	struct list_head list;
 | |
| 	char *bus_name;
 | |
| 	char *dev_name;
 | |
| 	uint32_t port_index;
 | |
| 	uint32_t sb_index;
 | |
| 	struct list_head pool_list;
 | |
| 	struct list_head ing_tc_list;
 | |
| 	struct list_head eg_tc_list;
 | |
| };
 | |
| 
 | |
| struct occ_show {
 | |
| 	struct dl *dl;
 | |
| 	int err;
 | |
| 	struct list_head port_list;
 | |
| };
 | |
| 
 | |
| static struct occ_item *occ_item_alloc(void)
 | |
| {
 | |
| 	return calloc(1, sizeof(struct occ_item));
 | |
| }
 | |
| 
 | |
| static void occ_item_free(struct occ_item *occ_item)
 | |
| {
 | |
| 	free(occ_item);
 | |
| }
 | |
| 
 | |
| static struct occ_port *occ_port_alloc(uint32_t port_index)
 | |
| {
 | |
| 	struct occ_port *occ_port;
 | |
| 
 | |
| 	occ_port = calloc(1, sizeof(*occ_port));
 | |
| 	if (!occ_port)
 | |
| 		return NULL;
 | |
| 	occ_port->port_index = port_index;
 | |
| 	INIT_LIST_HEAD(&occ_port->pool_list);
 | |
| 	INIT_LIST_HEAD(&occ_port->ing_tc_list);
 | |
| 	INIT_LIST_HEAD(&occ_port->eg_tc_list);
 | |
| 	return occ_port;
 | |
| }
 | |
| 
 | |
| static void occ_port_free(struct occ_port *occ_port)
 | |
| {
 | |
| 	struct occ_item *occ_item, *tmp;
 | |
| 
 | |
| 	list_for_each_entry_safe(occ_item, tmp, &occ_port->pool_list, list)
 | |
| 		occ_item_free(occ_item);
 | |
| 	list_for_each_entry_safe(occ_item, tmp, &occ_port->ing_tc_list, list)
 | |
| 		occ_item_free(occ_item);
 | |
| 	list_for_each_entry_safe(occ_item, tmp, &occ_port->eg_tc_list, list)
 | |
| 		occ_item_free(occ_item);
 | |
| }
 | |
| 
 | |
| static struct occ_show *occ_show_alloc(struct dl *dl)
 | |
| {
 | |
| 	struct occ_show *occ_show;
 | |
| 
 | |
| 	occ_show = calloc(1, sizeof(*occ_show));
 | |
| 	if (!occ_show)
 | |
| 		return NULL;
 | |
| 	occ_show->dl = dl;
 | |
| 	INIT_LIST_HEAD(&occ_show->port_list);
 | |
| 	return occ_show;
 | |
| }
 | |
| 
 | |
| static void occ_show_free(struct occ_show *occ_show)
 | |
| {
 | |
| 	struct occ_port *occ_port, *tmp;
 | |
| 
 | |
| 	list_for_each_entry_safe(occ_port, tmp, &occ_show->port_list, list)
 | |
| 		occ_port_free(occ_port);
 | |
| }
 | |
| 
 | |
| static struct occ_port *occ_port_get(struct occ_show *occ_show,
 | |
| 				     struct nlattr **tb)
 | |
| {
 | |
| 	struct occ_port *occ_port;
 | |
| 	uint32_t port_index;
 | |
| 
 | |
| 	port_index = mnl_attr_get_u32(tb[DEVLINK_ATTR_PORT_INDEX]);
 | |
| 
 | |
| 	list_for_each_entry_reverse(occ_port, &occ_show->port_list, list) {
 | |
| 		if (occ_port->port_index == port_index)
 | |
| 			return occ_port;
 | |
| 	}
 | |
| 	occ_port = occ_port_alloc(port_index);
 | |
| 	if (!occ_port)
 | |
| 		return NULL;
 | |
| 	list_add_tail(&occ_port->list, &occ_show->port_list);
 | |
| 	return occ_port;
 | |
| }
 | |
| 
 | |
| static void pr_out_occ_show_item_list(const char *label, struct list_head *list,
 | |
| 				      bool bound_pool)
 | |
| {
 | |
| 	struct occ_item *occ_item;
 | |
| 	int i = 1;
 | |
| 
 | |
| 	pr_out_sp(7, "  %s:", label);
 | |
| 	list_for_each_entry(occ_item, list, list) {
 | |
| 		if ((i - 1) % 4 == 0 && i != 1)
 | |
| 			pr_out_sp(7, " ");
 | |
| 		if (bound_pool)
 | |
| 			pr_out_sp(7, "%2u(%u):", occ_item->index,
 | |
| 				  occ_item->bound_pool_index);
 | |
| 		else
 | |
| 			pr_out_sp(7, "%2u:", occ_item->index);
 | |
| 		pr_out_sp(15, "%7u/%u", occ_item->cur, occ_item->max);
 | |
| 		if (i++ % 4 == 0)
 | |
| 			pr_out("\n");
 | |
| 	}
 | |
| 	if ((i - 1) % 4 != 0)
 | |
| 		pr_out("\n");
 | |
| }
 | |
| 
 | |
| static void pr_out_json_occ_show_item_list(struct dl *dl, const char *label,
 | |
| 					   struct list_head *list,
 | |
| 					   bool bound_pool)
 | |
| {
 | |
| 	struct occ_item *occ_item;
 | |
| 	char buf[32];
 | |
| 
 | |
| 	jsonw_name(dl->jw, label);
 | |
| 	jsonw_start_object(dl->jw);
 | |
| 	list_for_each_entry(occ_item, list, list) {
 | |
| 		sprintf(buf, "%u", occ_item->index);
 | |
| 		jsonw_name(dl->jw, buf);
 | |
| 		jsonw_start_object(dl->jw);
 | |
| 		if (bound_pool)
 | |
| 			jsonw_uint_field(dl->jw, "bound_pool",
 | |
| 					 occ_item->bound_pool_index);
 | |
| 		jsonw_uint_field(dl->jw, "current", occ_item->cur);
 | |
| 		jsonw_uint_field(dl->jw, "max", occ_item->max);
 | |
| 		jsonw_end_object(dl->jw);
 | |
| 	}
 | |
| 	jsonw_end_object(dl->jw);
 | |
| }
 | |
| 
 | |
| static void pr_out_occ_show_port(struct dl *dl, struct occ_port *occ_port)
 | |
| {
 | |
| 	if (dl->json_output) {
 | |
| 		pr_out_json_occ_show_item_list(dl, "pool",
 | |
| 					       &occ_port->pool_list, false);
 | |
| 		pr_out_json_occ_show_item_list(dl, "itc",
 | |
| 					       &occ_port->ing_tc_list, true);
 | |
| 		pr_out_json_occ_show_item_list(dl, "etc",
 | |
| 					       &occ_port->eg_tc_list, true);
 | |
| 	} else {
 | |
| 		pr_out("\n");
 | |
| 		pr_out_occ_show_item_list("pool", &occ_port->pool_list, false);
 | |
| 		pr_out_occ_show_item_list("itc", &occ_port->ing_tc_list, true);
 | |
| 		pr_out_occ_show_item_list("etc", &occ_port->eg_tc_list, true);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_occ_show(struct occ_show *occ_show)
 | |
| {
 | |
| 	struct dl *dl = occ_show->dl;
 | |
| 	struct dl_opts *opts = &dl->opts;
 | |
| 	struct occ_port *occ_port;
 | |
| 
 | |
| 	list_for_each_entry(occ_port, &occ_show->port_list, list) {
 | |
| 		__pr_out_port_handle_start(dl, opts->bus_name, opts->dev_name,
 | |
| 					   occ_port->port_index, true, false);
 | |
| 		pr_out_occ_show_port(dl, occ_port);
 | |
| 		pr_out_port_handle_end(dl);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void cmd_sb_occ_port_pool_process(struct occ_show *occ_show,
 | |
| 					 struct nlattr **tb)
 | |
| {
 | |
| 	struct occ_port *occ_port;
 | |
| 	struct occ_item *occ_item;
 | |
| 
 | |
| 	if (occ_show->err || !dl_dump_filter(occ_show->dl, tb))
 | |
| 		return;
 | |
| 
 | |
| 	occ_port = occ_port_get(occ_show, tb);
 | |
| 	if (!occ_port) {
 | |
| 		occ_show->err = -ENOMEM;
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	occ_item = occ_item_alloc();
 | |
| 	if (!occ_item) {
 | |
| 		occ_show->err = -ENOMEM;
 | |
| 		return;
 | |
| 	}
 | |
| 	occ_item->index = mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_POOL_INDEX]);
 | |
| 	occ_item->cur = mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_OCC_CUR]);
 | |
| 	occ_item->max = mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_OCC_MAX]);
 | |
| 	list_add_tail(&occ_item->list, &occ_port->pool_list);
 | |
| }
 | |
| 
 | |
| static int cmd_sb_occ_port_pool_process_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct occ_show *occ_show = data;
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 	    !tb[DEVLINK_ATTR_PORT_INDEX] || !tb[DEVLINK_ATTR_SB_INDEX] ||
 | |
| 	    !tb[DEVLINK_ATTR_SB_POOL_INDEX] ||
 | |
| 	    !tb[DEVLINK_ATTR_SB_OCC_CUR] || !tb[DEVLINK_ATTR_SB_OCC_MAX])
 | |
| 		return MNL_CB_ERROR;
 | |
| 	cmd_sb_occ_port_pool_process(occ_show, tb);
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static void cmd_sb_occ_tc_pool_process(struct occ_show *occ_show,
 | |
| 				       struct nlattr **tb)
 | |
| {
 | |
| 	struct occ_port *occ_port;
 | |
| 	struct occ_item *occ_item;
 | |
| 	uint8_t pool_type;
 | |
| 
 | |
| 	if (occ_show->err || !dl_dump_filter(occ_show->dl, tb))
 | |
| 		return;
 | |
| 
 | |
| 	occ_port = occ_port_get(occ_show, tb);
 | |
| 	if (!occ_port) {
 | |
| 		occ_show->err = -ENOMEM;
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	occ_item = occ_item_alloc();
 | |
| 	if (!occ_item) {
 | |
| 		occ_show->err = -ENOMEM;
 | |
| 		return;
 | |
| 	}
 | |
| 	occ_item->index = mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_TC_INDEX]);
 | |
| 	occ_item->cur = mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_OCC_CUR]);
 | |
| 	occ_item->max = mnl_attr_get_u32(tb[DEVLINK_ATTR_SB_OCC_MAX]);
 | |
| 	occ_item->bound_pool_index =
 | |
| 			mnl_attr_get_u16(tb[DEVLINK_ATTR_SB_POOL_INDEX]);
 | |
| 	pool_type = mnl_attr_get_u8(tb[DEVLINK_ATTR_SB_POOL_TYPE]);
 | |
| 	if (pool_type == DEVLINK_SB_POOL_TYPE_INGRESS)
 | |
| 		list_add_tail(&occ_item->list, &occ_port->ing_tc_list);
 | |
| 	else if (pool_type == DEVLINK_SB_POOL_TYPE_EGRESS)
 | |
| 		list_add_tail(&occ_item->list, &occ_port->eg_tc_list);
 | |
| 	else
 | |
| 		occ_item_free(occ_item);
 | |
| }
 | |
| 
 | |
| static int cmd_sb_occ_tc_pool_process_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct occ_show *occ_show = data;
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 	    !tb[DEVLINK_ATTR_PORT_INDEX] || !tb[DEVLINK_ATTR_SB_INDEX] ||
 | |
| 	    !tb[DEVLINK_ATTR_SB_TC_INDEX] || !tb[DEVLINK_ATTR_SB_POOL_TYPE] ||
 | |
| 	    !tb[DEVLINK_ATTR_SB_POOL_INDEX] ||
 | |
| 	    !tb[DEVLINK_ATTR_SB_OCC_CUR] || !tb[DEVLINK_ATTR_SB_OCC_MAX])
 | |
| 		return MNL_CB_ERROR;
 | |
| 	cmd_sb_occ_tc_pool_process(occ_show, tb);
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int cmd_sb_occ_show(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	struct occ_show *occ_show;
 | |
| 	uint16_t flags = NLM_F_REQUEST | NLM_F_ACK | NLM_F_DUMP;
 | |
| 	int err;
 | |
| 
 | |
| 	err = dl_argv_parse(dl, DL_OPT_HANDLE | DL_OPT_HANDLEP, DL_OPT_SB);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	occ_show = occ_show_alloc(dl);
 | |
| 	if (!occ_show)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_PORT_POOL_GET, flags);
 | |
| 
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh,
 | |
| 				  cmd_sb_occ_port_pool_process_cb, occ_show);
 | |
| 	if (err)
 | |
| 		goto out;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_TC_POOL_BIND_GET, flags);
 | |
| 
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh,
 | |
| 				  cmd_sb_occ_tc_pool_process_cb, occ_show);
 | |
| 	if (err)
 | |
| 		goto out;
 | |
| 
 | |
| 	pr_out_section_start(dl, "occupancy");
 | |
| 	pr_out_occ_show(occ_show);
 | |
| 	pr_out_section_end(dl);
 | |
| 
 | |
| out:
 | |
| 	occ_show_free(occ_show);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int cmd_sb_occ_snapshot(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_OCC_SNAPSHOT,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 
 | |
| 	err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, DL_OPT_SB);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
 | |
| }
 | |
| 
 | |
| static int cmd_sb_occ_clearmax(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_SB_OCC_MAX_CLEAR,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 
 | |
| 	err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, DL_OPT_SB);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
 | |
| }
 | |
| 
 | |
| static int cmd_sb_occ(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
 | |
| 		cmd_sb_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "show") ||
 | |
| 		   dl_argv_match(dl, "list")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb_occ_show(dl);
 | |
| 	} else if (dl_argv_match(dl, "snapshot")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb_occ_snapshot(dl);
 | |
| 	} else if (dl_argv_match(dl, "clearmax")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb_occ_clearmax(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static int cmd_sb(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argv_match(dl, "help")) {
 | |
| 		cmd_sb_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "show") ||
 | |
| 		   dl_argv_match(dl, "list") || dl_no_arg(dl)) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb_show(dl);
 | |
| 	} else if (dl_argv_match(dl, "pool")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb_pool(dl);
 | |
| 	} else if (dl_argv_match(dl, "port")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb_port(dl);
 | |
| 	} else if (dl_argv_match(dl, "tc")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb_tc(dl);
 | |
| 	} else if (dl_argv_match(dl, "occupancy")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb_occ(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static const char *cmd_name(uint8_t cmd)
 | |
| {
 | |
| 	switch (cmd) {
 | |
| 	case DEVLINK_CMD_UNSPEC: return "unspec";
 | |
| 	case DEVLINK_CMD_GET: return "get";
 | |
| 	case DEVLINK_CMD_SET: return "set";
 | |
| 	case DEVLINK_CMD_NEW: return "new";
 | |
| 	case DEVLINK_CMD_DEL: return "del";
 | |
| 	case DEVLINK_CMD_PORT_GET: return "get";
 | |
| 	case DEVLINK_CMD_PORT_SET: return "set";
 | |
| 	case DEVLINK_CMD_PORT_NEW: return "new";
 | |
| 	case DEVLINK_CMD_PORT_DEL: return "del";
 | |
| 	case DEVLINK_CMD_PARAM_GET: return "get";
 | |
| 	case DEVLINK_CMD_PARAM_SET: return "set";
 | |
| 	case DEVLINK_CMD_PARAM_NEW: return "new";
 | |
| 	case DEVLINK_CMD_PARAM_DEL: return "del";
 | |
| 	case DEVLINK_CMD_REGION_GET: return "get";
 | |
| 	case DEVLINK_CMD_REGION_SET: return "set";
 | |
| 	case DEVLINK_CMD_REGION_NEW: return "new";
 | |
| 	case DEVLINK_CMD_REGION_DEL: return "del";
 | |
| 	default: return "<unknown cmd>";
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static const char *cmd_obj(uint8_t cmd)
 | |
| {
 | |
| 	switch (cmd) {
 | |
| 	case DEVLINK_CMD_UNSPEC: return "unspec";
 | |
| 	case DEVLINK_CMD_GET:
 | |
| 	case DEVLINK_CMD_SET:
 | |
| 	case DEVLINK_CMD_NEW:
 | |
| 	case DEVLINK_CMD_DEL:
 | |
| 		return "dev";
 | |
| 	case DEVLINK_CMD_PORT_GET:
 | |
| 	case DEVLINK_CMD_PORT_SET:
 | |
| 	case DEVLINK_CMD_PORT_NEW:
 | |
| 	case DEVLINK_CMD_PORT_DEL:
 | |
| 		return "port";
 | |
| 	case DEVLINK_CMD_PARAM_GET:
 | |
| 	case DEVLINK_CMD_PARAM_SET:
 | |
| 	case DEVLINK_CMD_PARAM_NEW:
 | |
| 	case DEVLINK_CMD_PARAM_DEL:
 | |
| 		return "param";
 | |
| 	case DEVLINK_CMD_REGION_GET:
 | |
| 	case DEVLINK_CMD_REGION_SET:
 | |
| 	case DEVLINK_CMD_REGION_NEW:
 | |
| 	case DEVLINK_CMD_REGION_DEL:
 | |
| 		return "region";
 | |
| 	default: return "<unknown obj>";
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_mon_header(uint8_t cmd)
 | |
| {
 | |
| 	pr_out("[%s,%s] ", cmd_obj(cmd), cmd_name(cmd));
 | |
| }
 | |
| 
 | |
| static bool cmd_filter_check(struct dl *dl, uint8_t cmd)
 | |
| {
 | |
| 	const char *obj = cmd_obj(cmd);
 | |
| 	unsigned int index = 0;
 | |
| 	const char *cur_obj;
 | |
| 
 | |
| 	if (dl_no_arg(dl))
 | |
| 		return true;
 | |
| 	while ((cur_obj = dl_argv_index(dl, index++))) {
 | |
| 		if (strcmp(cur_obj, obj) == 0 || strcmp(cur_obj, "all") == 0)
 | |
| 			return true;
 | |
| 	}
 | |
| 	return false;
 | |
| }
 | |
| 
 | |
| static void pr_out_region(struct dl *dl, struct nlattr **tb);
 | |
| 
 | |
| static int cmd_mon_show_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct dl *dl = data;
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 	uint8_t cmd = genl->cmd;
 | |
| 
 | |
| 	if (!cmd_filter_check(dl, cmd))
 | |
| 		return MNL_CB_OK;
 | |
| 
 | |
| 	switch (cmd) {
 | |
| 	case DEVLINK_CMD_GET: /* fall through */
 | |
| 	case DEVLINK_CMD_SET: /* fall through */
 | |
| 	case DEVLINK_CMD_NEW: /* fall through */
 | |
| 	case DEVLINK_CMD_DEL:
 | |
| 		mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 		if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME])
 | |
| 			return MNL_CB_ERROR;
 | |
| 		pr_out_mon_header(genl->cmd);
 | |
| 		pr_out_dev(dl, tb);
 | |
| 		break;
 | |
| 	case DEVLINK_CMD_PORT_GET: /* fall through */
 | |
| 	case DEVLINK_CMD_PORT_SET: /* fall through */
 | |
| 	case DEVLINK_CMD_PORT_NEW: /* fall through */
 | |
| 	case DEVLINK_CMD_PORT_DEL:
 | |
| 		mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 		if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 		    !tb[DEVLINK_ATTR_PORT_INDEX])
 | |
| 			return MNL_CB_ERROR;
 | |
| 		pr_out_mon_header(genl->cmd);
 | |
| 		pr_out_port(dl, tb);
 | |
| 		break;
 | |
| 	case DEVLINK_CMD_PARAM_GET: /* fall through */
 | |
| 	case DEVLINK_CMD_PARAM_SET: /* fall through */
 | |
| 	case DEVLINK_CMD_PARAM_NEW: /* fall through */
 | |
| 	case DEVLINK_CMD_PARAM_DEL:
 | |
| 		mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 		if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 		    !tb[DEVLINK_ATTR_PARAM])
 | |
| 			return MNL_CB_ERROR;
 | |
| 		pr_out_mon_header(genl->cmd);
 | |
| 		pr_out_param(dl, tb, false);
 | |
| 		break;
 | |
| 	case DEVLINK_CMD_REGION_GET: /* fall through */
 | |
| 	case DEVLINK_CMD_REGION_SET: /* fall through */
 | |
| 	case DEVLINK_CMD_REGION_NEW: /* fall through */
 | |
| 	case DEVLINK_CMD_REGION_DEL:
 | |
| 		mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 		if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 		    !tb[DEVLINK_ATTR_REGION_NAME])
 | |
| 			return MNL_CB_ERROR;
 | |
| 		pr_out_mon_header(genl->cmd);
 | |
| 		pr_out_region(dl, tb);
 | |
| 		break;
 | |
| 	}
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int cmd_mon_show(struct dl *dl)
 | |
| {
 | |
| 	int err;
 | |
| 	unsigned int index = 0;
 | |
| 	const char *cur_obj;
 | |
| 
 | |
| 	while ((cur_obj = dl_argv_index(dl, index++))) {
 | |
| 		if (strcmp(cur_obj, "all") != 0 &&
 | |
| 		    strcmp(cur_obj, "dev") != 0 &&
 | |
| 		    strcmp(cur_obj, "port") != 0) {
 | |
| 			pr_err("Unknown object \"%s\"\n", cur_obj);
 | |
| 			return -EINVAL;
 | |
| 		}
 | |
| 	}
 | |
| 	err = _mnlg_socket_group_add(dl->nlg, DEVLINK_GENL_MCGRP_CONFIG_NAME);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 	err = _mnlg_socket_recv_run(dl->nlg, cmd_mon_show_cb, dl);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void cmd_mon_help(void)
 | |
| {
 | |
| 	pr_err("Usage: devlink monitor [ all | OBJECT-LIST ]\n"
 | |
| 	       "where  OBJECT-LIST := { dev | port }\n");
 | |
| }
 | |
| 
 | |
| static int cmd_mon(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argv_match(dl, "help")) {
 | |
| 		cmd_mon_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_no_arg(dl)) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_mon_show(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| struct dpipe_field {
 | |
| 	char *name;
 | |
| 	unsigned int id;
 | |
| 	unsigned int bitwidth;
 | |
| 	enum devlink_dpipe_field_mapping_type mapping_type;
 | |
| };
 | |
| 
 | |
| struct dpipe_header {
 | |
| 	struct list_head list;
 | |
| 	char *name;
 | |
| 	unsigned int id;
 | |
| 	struct dpipe_field *fields;
 | |
| 	unsigned int fields_count;
 | |
| };
 | |
| 
 | |
| struct dpipe_table {
 | |
| 	struct list_head list;
 | |
| 	char *name;
 | |
| 	unsigned int resource_id;
 | |
| 	bool resource_valid;
 | |
| };
 | |
| 
 | |
| struct dpipe_tables {
 | |
| 	struct list_head table_list;
 | |
| };
 | |
| 
 | |
| struct resource {
 | |
| 	char *name;
 | |
| 	uint64_t size;
 | |
| 	uint64_t size_new;
 | |
| 	uint64_t size_min;
 | |
| 	uint64_t size_max;
 | |
| 	uint64_t size_gran;
 | |
| 	enum devlink_resource_unit unit;
 | |
| 	bool size_valid;
 | |
| 	uint64_t size_occ;
 | |
| 	bool occ_valid;
 | |
| 	uint64_t id;
 | |
| 	struct list_head list;
 | |
| 	struct list_head resource_list;
 | |
| 	struct resource *parent;
 | |
| };
 | |
| 
 | |
| struct resources {
 | |
| 	struct list_head resource_list;
 | |
| };
 | |
| 
 | |
| struct resource_ctx {
 | |
| 	struct dl *dl;
 | |
| 	int err;
 | |
| 	struct resources *resources;
 | |
| 	struct dpipe_tables *tables;
 | |
| 	bool print_resources;
 | |
| 	bool pending_change;
 | |
| };
 | |
| 
 | |
| static struct resource *resource_alloc(void)
 | |
| {
 | |
| 	struct resource *resource;
 | |
| 
 | |
| 	resource = calloc(1, sizeof(struct resource));
 | |
| 	if (!resource)
 | |
| 		return NULL;
 | |
| 	INIT_LIST_HEAD(&resource->resource_list);
 | |
| 	return resource;
 | |
| }
 | |
| 
 | |
| static void resource_free(struct resource *resource)
 | |
| {
 | |
| 	struct resource *child_resource, *tmp;
 | |
| 
 | |
| 	list_for_each_entry_safe(child_resource, tmp, &resource->resource_list,
 | |
| 				 list) {
 | |
| 		free(child_resource->name);
 | |
| 		resource_free(child_resource);
 | |
| 	}
 | |
| 	free(resource);
 | |
| }
 | |
| 
 | |
| static struct resources *resources_alloc(void)
 | |
| {
 | |
| 	struct resources *resources;
 | |
| 
 | |
| 	resources = calloc(1, sizeof(struct resources));
 | |
| 	if (!resources)
 | |
| 		return NULL;
 | |
| 	INIT_LIST_HEAD(&resources->resource_list);
 | |
| 	return resources;
 | |
| }
 | |
| 
 | |
| static void resources_free(struct resources *resources)
 | |
| {
 | |
| 	struct resource *resource, *tmp;
 | |
| 
 | |
| 	list_for_each_entry_safe(resource, tmp, &resources->resource_list, list)
 | |
| 		resource_free(resource);
 | |
| }
 | |
| 
 | |
| static int resource_ctx_init(struct resource_ctx *ctx, struct dl *dl)
 | |
| {
 | |
| 	ctx->resources = resources_alloc();
 | |
| 	if (!ctx->resources)
 | |
| 		return -ENOMEM;
 | |
| 	ctx->dl = dl;
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void resource_ctx_fini(struct resource_ctx *ctx)
 | |
| {
 | |
| 	resources_free(ctx->resources);
 | |
| }
 | |
| 
 | |
| struct dpipe_ctx {
 | |
| 	struct dl *dl;
 | |
| 	int err;
 | |
| 	struct list_head global_headers;
 | |
| 	struct list_head local_headers;
 | |
| 	struct dpipe_tables *tables;
 | |
| 	struct resources *resources;
 | |
| 	bool print_headers;
 | |
| 	bool print_tables;
 | |
| };
 | |
| 
 | |
| static struct dpipe_header *dpipe_header_alloc(unsigned int fields_count)
 | |
| {
 | |
| 	struct dpipe_header *header;
 | |
| 
 | |
| 	header = calloc(1, sizeof(struct dpipe_header));
 | |
| 	if (!header)
 | |
| 		return NULL;
 | |
| 	header->fields = calloc(fields_count, sizeof(struct dpipe_field));
 | |
| 	if (!header->fields)
 | |
| 		goto err_fields_alloc;
 | |
| 	header->fields_count = fields_count;
 | |
| 	return header;
 | |
| 
 | |
| err_fields_alloc:
 | |
| 	free(header);
 | |
| 	return NULL;
 | |
| }
 | |
| 
 | |
| static void dpipe_header_free(struct dpipe_header *header)
 | |
| {
 | |
| 	free(header->fields);
 | |
| 	free(header);
 | |
| }
 | |
| 
 | |
| static void dpipe_header_clear(struct dpipe_header *header)
 | |
| {
 | |
| 	struct dpipe_field *field;
 | |
| 	int i;
 | |
| 
 | |
| 	for (i = 0; i < header->fields_count; i++) {
 | |
| 		field = &header->fields[i];
 | |
| 		free(field->name);
 | |
| 	}
 | |
| 	free(header->name);
 | |
| }
 | |
| 
 | |
| static void dpipe_header_add(struct dpipe_ctx *ctx,
 | |
| 			     struct dpipe_header *header, bool global)
 | |
| {
 | |
| 	if (global)
 | |
| 		list_add(&header->list, &ctx->global_headers);
 | |
| 	else
 | |
| 		list_add(&header->list, &ctx->local_headers);
 | |
| }
 | |
| 
 | |
| static void dpipe_header_del(struct dpipe_header *header)
 | |
| {
 | |
| 	list_del(&header->list);
 | |
| }
 | |
| 
 | |
| static struct dpipe_table *dpipe_table_alloc(void)
 | |
| {
 | |
| 	return calloc(1, sizeof(struct dpipe_table));
 | |
| }
 | |
| 
 | |
| static void dpipe_table_free(struct dpipe_table *table)
 | |
| {
 | |
| 	free(table);
 | |
| }
 | |
| 
 | |
| static struct dpipe_tables *dpipe_tables_alloc(void)
 | |
| {
 | |
| 	struct dpipe_tables *tables;
 | |
| 
 | |
| 	tables = calloc(1, sizeof(struct dpipe_tables));
 | |
| 	if (!tables)
 | |
| 		return NULL;
 | |
| 	INIT_LIST_HEAD(&tables->table_list);
 | |
| 	return tables;
 | |
| }
 | |
| 
 | |
| static void dpipe_tables_free(struct dpipe_tables *tables)
 | |
| {
 | |
| 	struct dpipe_table *table, *tmp;
 | |
| 
 | |
| 	list_for_each_entry_safe(table, tmp, &tables->table_list, list)
 | |
| 		dpipe_table_free(table);
 | |
| 	free(tables);
 | |
| }
 | |
| 
 | |
| static int dpipe_ctx_init(struct dpipe_ctx *ctx, struct dl *dl)
 | |
| {
 | |
| 	ctx->tables = dpipe_tables_alloc();
 | |
| 	if (!ctx->tables)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	ctx->dl = dl;
 | |
| 	INIT_LIST_HEAD(&ctx->global_headers);
 | |
| 	INIT_LIST_HEAD(&ctx->local_headers);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void dpipe_ctx_fini(struct dpipe_ctx *ctx)
 | |
| {
 | |
| 	struct dpipe_header *header, *tmp;
 | |
| 
 | |
| 	list_for_each_entry_safe(header, tmp, &ctx->global_headers,
 | |
| 				 list) {
 | |
| 		dpipe_header_del(header);
 | |
| 		dpipe_header_clear(header);
 | |
| 		dpipe_header_free(header);
 | |
| 	}
 | |
| 	list_for_each_entry_safe(header, tmp, &ctx->local_headers,
 | |
| 				 list) {
 | |
| 		dpipe_header_del(header);
 | |
| 		dpipe_header_clear(header);
 | |
| 		dpipe_header_free(header);
 | |
| 	}
 | |
| 	dpipe_tables_free(ctx->tables);
 | |
| }
 | |
| 
 | |
| static const char *dpipe_header_id2s(struct dpipe_ctx *ctx,
 | |
| 				     uint32_t header_id, bool global)
 | |
| {
 | |
| 	struct list_head *header_list;
 | |
| 	struct dpipe_header *header;
 | |
| 
 | |
| 	if (global)
 | |
| 		header_list = &ctx->global_headers;
 | |
| 	else
 | |
| 		header_list = &ctx->local_headers;
 | |
| 	list_for_each_entry(header, header_list, list) {
 | |
| 		if (header->id != header_id)
 | |
| 			continue;
 | |
| 		return header->name;
 | |
| 	}
 | |
| 	return NULL;
 | |
| }
 | |
| 
 | |
| static const char *dpipe_field_id2s(struct dpipe_ctx *ctx,
 | |
| 				    uint32_t header_id,
 | |
| 				    uint32_t field_id, bool global)
 | |
| {
 | |
| 	struct list_head *header_list;
 | |
| 	struct dpipe_header *header;
 | |
| 
 | |
| 	if (global)
 | |
| 		header_list = &ctx->global_headers;
 | |
| 	else
 | |
| 		header_list = &ctx->local_headers;
 | |
| 	list_for_each_entry(header, header_list, list) {
 | |
| 		if (header->id != header_id)
 | |
| 			continue;
 | |
| 		return header->fields[field_id].name;
 | |
| 	}
 | |
| 	return NULL;
 | |
| }
 | |
| 
 | |
| static const char *
 | |
| dpipe_field_mapping_e2s(enum devlink_dpipe_field_mapping_type mapping_type)
 | |
| {
 | |
| 	switch (mapping_type) {
 | |
| 	case DEVLINK_DPIPE_FIELD_MAPPING_TYPE_NONE:
 | |
| 		return NULL;
 | |
| 	case DEVLINK_DPIPE_FIELD_MAPPING_TYPE_IFINDEX:
 | |
| 		return "ifindex";
 | |
| 	default:
 | |
| 		return "<unknown>";
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static const char *
 | |
| dpipe_mapping_get(struct dpipe_ctx *ctx, uint32_t header_id,
 | |
| 		  uint32_t field_id, bool global)
 | |
| {
 | |
| 	enum devlink_dpipe_field_mapping_type mapping_type;
 | |
| 	struct list_head *header_list;
 | |
| 	struct dpipe_header *header;
 | |
| 
 | |
| 	if (global)
 | |
| 		header_list = &ctx->global_headers;
 | |
| 	else
 | |
| 		header_list = &ctx->local_headers;
 | |
| 	list_for_each_entry(header, header_list, list) {
 | |
| 		if (header->id != header_id)
 | |
| 			continue;
 | |
| 		mapping_type = header->fields[field_id].mapping_type;
 | |
| 		return dpipe_field_mapping_e2s(mapping_type);
 | |
| 	}
 | |
| 	return NULL;
 | |
| }
 | |
| 
 | |
| static void pr_out_dpipe_fields(struct dpipe_ctx *ctx,
 | |
| 				struct dpipe_field *fields,
 | |
| 				unsigned int field_count)
 | |
| {
 | |
| 	struct dpipe_field *field;
 | |
| 	int i;
 | |
| 
 | |
| 	for (i = 0; i < field_count; i++) {
 | |
| 		field = &fields[i];
 | |
| 		pr_out_entry_start(ctx->dl);
 | |
| 		pr_out_str(ctx->dl, "name", field->name);
 | |
| 		if (ctx->dl->verbose)
 | |
| 			pr_out_uint(ctx->dl, "id", field->id);
 | |
| 		pr_out_uint(ctx->dl, "bitwidth", field->bitwidth);
 | |
| 		if (field->mapping_type)
 | |
| 			pr_out_str(ctx->dl, "mapping_type",
 | |
| 				   dpipe_field_mapping_e2s(field->mapping_type));
 | |
| 		pr_out_entry_end(ctx->dl);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void
 | |
| pr_out_dpipe_header(struct dpipe_ctx *ctx, struct nlattr **tb,
 | |
| 		    struct dpipe_header *header, bool global)
 | |
| {
 | |
| 	pr_out_handle_start_arr(ctx->dl, tb);
 | |
| 	pr_out_str(ctx->dl, "name", header->name);
 | |
| 	if (ctx->dl->verbose) {
 | |
| 		pr_out_uint(ctx->dl, "id", header->id);
 | |
| 		pr_out_str(ctx->dl, "global",
 | |
| 			   global ? "true" : "false");
 | |
| 	}
 | |
| 	pr_out_array_start(ctx->dl, "field");
 | |
| 	pr_out_dpipe_fields(ctx, header->fields,
 | |
| 			    header->fields_count);
 | |
| 	pr_out_array_end(ctx->dl);
 | |
| 	pr_out_handle_end(ctx->dl);
 | |
| }
 | |
| 
 | |
| static void pr_out_dpipe_headers(struct dpipe_ctx *ctx,
 | |
| 				 struct nlattr **tb)
 | |
| {
 | |
| 	struct dpipe_header *header;
 | |
| 
 | |
| 	list_for_each_entry(header, &ctx->local_headers, list)
 | |
| 		pr_out_dpipe_header(ctx, tb, header, false);
 | |
| 
 | |
| 	list_for_each_entry(header, &ctx->global_headers, list)
 | |
| 		pr_out_dpipe_header(ctx, tb, header, true);
 | |
| }
 | |
| 
 | |
| static int dpipe_header_field_get(struct nlattr *nl, struct dpipe_field *field)
 | |
| {
 | |
| 	struct nlattr *nla_field[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	const char *name;
 | |
| 	int err;
 | |
| 
 | |
| 	err = mnl_attr_parse_nested(nl, attr_cb, nla_field);
 | |
| 	if (err != MNL_CB_OK)
 | |
| 		return -EINVAL;
 | |
| 	if (!nla_field[DEVLINK_ATTR_DPIPE_FIELD_ID] ||
 | |
| 	    !nla_field[DEVLINK_ATTR_DPIPE_FIELD_NAME] ||
 | |
| 	    !nla_field[DEVLINK_ATTR_DPIPE_FIELD_BITWIDTH] ||
 | |
| 	    !nla_field[DEVLINK_ATTR_DPIPE_FIELD_MAPPING_TYPE])
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	name = mnl_attr_get_str(nla_field[DEVLINK_ATTR_DPIPE_FIELD_NAME]);
 | |
| 	field->id = mnl_attr_get_u32(nla_field[DEVLINK_ATTR_DPIPE_FIELD_ID]);
 | |
| 	field->bitwidth = mnl_attr_get_u32(nla_field[DEVLINK_ATTR_DPIPE_FIELD_BITWIDTH]);
 | |
| 	field->name = strdup(name);
 | |
| 	if (!field->name)
 | |
| 		return -ENOMEM;
 | |
| 	field->mapping_type = mnl_attr_get_u32(nla_field[DEVLINK_ATTR_DPIPE_FIELD_MAPPING_TYPE]);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int dpipe_header_fields_get(struct nlattr *nla_fields,
 | |
| 				   struct dpipe_field *fields)
 | |
| {
 | |
| 	struct nlattr *nla_field;
 | |
| 	int count = 0;
 | |
| 	int err;
 | |
| 
 | |
| 	mnl_attr_for_each_nested(nla_field, nla_fields) {
 | |
| 		err = dpipe_header_field_get(nla_field, &fields[count]);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 		count++;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static unsigned int dpipe_header_field_count_get(struct nlattr *nla_fields)
 | |
| {
 | |
| 	struct nlattr *nla_field;
 | |
| 	unsigned int count = 0;
 | |
| 
 | |
| 	mnl_attr_for_each_nested(nla_field, nla_fields)
 | |
| 		count++;
 | |
| 	return count;
 | |
| }
 | |
| 
 | |
| static int dpipe_header_get(struct dpipe_ctx *ctx, struct nlattr *nl)
 | |
| {
 | |
| 	struct nlattr *nla_header[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct dpipe_header *header;
 | |
| 	unsigned int fields_count;
 | |
| 	const char *header_name;
 | |
| 	bool global;
 | |
| 	int err;
 | |
| 
 | |
| 	err = mnl_attr_parse_nested(nl, attr_cb, nla_header);
 | |
| 	if (err != MNL_CB_OK)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (!nla_header[DEVLINK_ATTR_DPIPE_HEADER_NAME] ||
 | |
| 	    !nla_header[DEVLINK_ATTR_DPIPE_HEADER_ID] ||
 | |
| 	    !nla_header[DEVLINK_ATTR_DPIPE_HEADER_FIELDS])
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	fields_count = dpipe_header_field_count_get(nla_header[DEVLINK_ATTR_DPIPE_HEADER_FIELDS]);
 | |
| 	header = dpipe_header_alloc(fields_count);
 | |
| 	if (!header)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	header_name = mnl_attr_get_str(nla_header[DEVLINK_ATTR_DPIPE_HEADER_NAME]);
 | |
| 	header->name = strdup(header_name);
 | |
| 	header->id = mnl_attr_get_u32(nla_header[DEVLINK_ATTR_DPIPE_HEADER_ID]);
 | |
| 	header->fields_count = fields_count;
 | |
| 	global = !!mnl_attr_get_u8(nla_header[DEVLINK_ATTR_DPIPE_HEADER_GLOBAL]);
 | |
| 
 | |
| 	err = dpipe_header_fields_get(nla_header[DEVLINK_ATTR_DPIPE_HEADER_FIELDS],
 | |
| 				      header->fields);
 | |
| 	if (err)
 | |
| 		goto err_field_get;
 | |
| 	dpipe_header_add(ctx, header, global);
 | |
| 	return 0;
 | |
| 
 | |
| err_field_get:
 | |
| 	dpipe_header_free(header);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int dpipe_headers_get(struct dpipe_ctx *ctx, struct nlattr **tb)
 | |
| {
 | |
| 	struct nlattr *nla_headers = tb[DEVLINK_ATTR_DPIPE_HEADERS];
 | |
| 	struct nlattr *nla_header;
 | |
| 	int err;
 | |
| 
 | |
| 	mnl_attr_for_each_nested(nla_header, nla_headers) {
 | |
| 		err = dpipe_header_get(ctx, nla_header);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int cmd_dpipe_header_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct dpipe_ctx *ctx = data;
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 	int err;
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 	    !tb[DEVLINK_ATTR_DPIPE_HEADERS])
 | |
| 		return MNL_CB_ERROR;
 | |
| 	err = dpipe_headers_get(ctx, tb);
 | |
| 	if (err) {
 | |
| 		ctx->err = err;
 | |
| 		return MNL_CB_ERROR;
 | |
| 	}
 | |
| 
 | |
| 	if (ctx->print_headers)
 | |
| 		pr_out_dpipe_headers(ctx, tb);
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int cmd_dpipe_headers_show(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	struct dpipe_ctx ctx = {};
 | |
| 	uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
 | |
| 	int err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_HEADERS_GET, flags);
 | |
| 
 | |
| 	err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE, 0);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	err = dpipe_ctx_init(&ctx, dl);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	ctx.print_headers = true;
 | |
| 
 | |
| 	pr_out_section_start(dl, "header");
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_header_cb, &ctx);
 | |
| 	if (err)
 | |
| 		pr_err("error get headers %s\n", strerror(ctx.err));
 | |
| 	pr_out_section_end(dl);
 | |
| 
 | |
| 	dpipe_ctx_fini(&ctx);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static void cmd_dpipe_header_help(void)
 | |
| {
 | |
| 	pr_err("Usage: devlink dpipe headers show DEV\n");
 | |
| }
 | |
| 
 | |
| static int cmd_dpipe_header(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
 | |
| 		cmd_dpipe_header_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "show")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dpipe_headers_show(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static const char
 | |
| *dpipe_action_type_e2s(enum devlink_dpipe_action_type action_type)
 | |
| {
 | |
| 	switch (action_type) {
 | |
| 	case DEVLINK_DPIPE_ACTION_TYPE_FIELD_MODIFY:
 | |
| 		return "field_modify";
 | |
| 	default:
 | |
| 		return "<unknown>";
 | |
| 	}
 | |
| }
 | |
| 
 | |
| struct dpipe_op_info {
 | |
| 	uint32_t header_id;
 | |
| 	uint32_t field_id;
 | |
| 	bool header_global;
 | |
| };
 | |
| 
 | |
| struct dpipe_action {
 | |
| 	struct dpipe_op_info info;
 | |
| 	uint32_t type;
 | |
| };
 | |
| 
 | |
| static void pr_out_dpipe_action(struct dpipe_action *action,
 | |
| 				struct dpipe_ctx *ctx)
 | |
| {
 | |
| 	struct dpipe_op_info *op_info = &action->info;
 | |
| 	const char *mapping;
 | |
| 
 | |
| 	pr_out_str(ctx->dl, "type",
 | |
| 		   dpipe_action_type_e2s(action->type));
 | |
| 	pr_out_str(ctx->dl, "header",
 | |
| 		   dpipe_header_id2s(ctx, op_info->header_id,
 | |
| 				     op_info->header_global));
 | |
| 	pr_out_str(ctx->dl, "field",
 | |
| 		   dpipe_field_id2s(ctx, op_info->header_id,
 | |
| 				    op_info->field_id,
 | |
| 				    op_info->header_global));
 | |
| 	mapping = dpipe_mapping_get(ctx, op_info->header_id,
 | |
| 				    op_info->field_id,
 | |
| 				    op_info->header_global);
 | |
| 	if (mapping)
 | |
| 		pr_out_str(ctx->dl, "mapping", mapping);
 | |
| }
 | |
| 
 | |
| static int dpipe_action_parse(struct dpipe_action *action, struct nlattr *nl)
 | |
| {
 | |
| 	struct nlattr *nla_action[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	int err;
 | |
| 
 | |
| 	err = mnl_attr_parse_nested(nl, attr_cb, nla_action);
 | |
| 	if (err != MNL_CB_OK)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (!nla_action[DEVLINK_ATTR_DPIPE_ACTION_TYPE] ||
 | |
| 	    !nla_action[DEVLINK_ATTR_DPIPE_HEADER_INDEX] ||
 | |
| 	    !nla_action[DEVLINK_ATTR_DPIPE_HEADER_ID] ||
 | |
| 	    !nla_action[DEVLINK_ATTR_DPIPE_FIELD_ID]) {
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	action->type = mnl_attr_get_u32(nla_action[DEVLINK_ATTR_DPIPE_ACTION_TYPE]);
 | |
| 	action->info.header_id = mnl_attr_get_u32(nla_action[DEVLINK_ATTR_DPIPE_HEADER_ID]);
 | |
| 	action->info.field_id = mnl_attr_get_u32(nla_action[DEVLINK_ATTR_DPIPE_FIELD_ID]);
 | |
| 	action->info.header_global = !!mnl_attr_get_u8(nla_action[DEVLINK_ATTR_DPIPE_HEADER_GLOBAL]);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int dpipe_table_actions_show(struct dpipe_ctx *ctx,
 | |
| 				    struct nlattr *nla_actions)
 | |
| {
 | |
| 	struct nlattr *nla_action;
 | |
| 	struct dpipe_action action;
 | |
| 
 | |
| 	mnl_attr_for_each_nested(nla_action, nla_actions) {
 | |
| 		pr_out_entry_start(ctx->dl);
 | |
| 		if (dpipe_action_parse(&action, nla_action))
 | |
| 			goto err_action_parse;
 | |
| 		pr_out_dpipe_action(&action, ctx);
 | |
| 		pr_out_entry_end(ctx->dl);
 | |
| 	}
 | |
| 	return 0;
 | |
| 
 | |
| err_action_parse:
 | |
| 	pr_out_entry_end(ctx->dl);
 | |
| 	return -EINVAL;
 | |
| }
 | |
| 
 | |
| static const char *
 | |
| dpipe_match_type_e2s(enum devlink_dpipe_match_type match_type)
 | |
| {
 | |
| 	switch (match_type) {
 | |
| 	case DEVLINK_DPIPE_MATCH_TYPE_FIELD_EXACT:
 | |
| 		return "field_exact";
 | |
| 	default:
 | |
| 		return "<unknown>";
 | |
| 	}
 | |
| }
 | |
| 
 | |
| struct dpipe_match {
 | |
| 	struct dpipe_op_info info;
 | |
| 	uint32_t type;
 | |
| };
 | |
| 
 | |
| static void pr_out_dpipe_match(struct dpipe_match *match,
 | |
| 			       struct dpipe_ctx *ctx)
 | |
| {
 | |
| 	struct dpipe_op_info *op_info = &match->info;
 | |
| 	const char *mapping;
 | |
| 
 | |
| 	pr_out_str(ctx->dl, "type",
 | |
| 		   dpipe_match_type_e2s(match->type));
 | |
| 	pr_out_str(ctx->dl, "header",
 | |
| 		   dpipe_header_id2s(ctx, op_info->header_id,
 | |
| 				     op_info->header_global));
 | |
| 	pr_out_str(ctx->dl, "field",
 | |
| 		   dpipe_field_id2s(ctx, op_info->header_id,
 | |
| 				    op_info->field_id,
 | |
| 				    op_info->header_global));
 | |
| 	mapping = dpipe_mapping_get(ctx, op_info->header_id,
 | |
| 				    op_info->field_id,
 | |
| 				    op_info->header_global);
 | |
| 	if (mapping)
 | |
| 		pr_out_str(ctx->dl, "mapping", mapping);
 | |
| }
 | |
| 
 | |
| static int dpipe_match_parse(struct dpipe_match *match,
 | |
| 			     struct nlattr *nl)
 | |
| 
 | |
| {
 | |
| 	struct nlattr *nla_match[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	int err;
 | |
| 
 | |
| 	err = mnl_attr_parse_nested(nl, attr_cb, nla_match);
 | |
| 	if (err != MNL_CB_OK)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (!nla_match[DEVLINK_ATTR_DPIPE_MATCH_TYPE] ||
 | |
| 	    !nla_match[DEVLINK_ATTR_DPIPE_HEADER_INDEX] ||
 | |
| 	    !nla_match[DEVLINK_ATTR_DPIPE_HEADER_ID] ||
 | |
| 	    !nla_match[DEVLINK_ATTR_DPIPE_FIELD_ID]) {
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	match->type = mnl_attr_get_u32(nla_match[DEVLINK_ATTR_DPIPE_MATCH_TYPE]);
 | |
| 	match->info.header_id = mnl_attr_get_u32(nla_match[DEVLINK_ATTR_DPIPE_HEADER_ID]);
 | |
| 	match->info.field_id = mnl_attr_get_u32(nla_match[DEVLINK_ATTR_DPIPE_FIELD_ID]);
 | |
| 	match->info.header_global = !!mnl_attr_get_u8(nla_match[DEVLINK_ATTR_DPIPE_HEADER_GLOBAL]);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int dpipe_table_matches_show(struct dpipe_ctx *ctx,
 | |
| 				    struct nlattr *nla_matches)
 | |
| {
 | |
| 	struct nlattr *nla_match;
 | |
| 	struct dpipe_match match;
 | |
| 
 | |
| 	mnl_attr_for_each_nested(nla_match, nla_matches) {
 | |
| 		pr_out_entry_start(ctx->dl);
 | |
| 		if (dpipe_match_parse(&match, nla_match))
 | |
| 			goto err_match_parse;
 | |
| 		pr_out_dpipe_match(&match, ctx);
 | |
| 		pr_out_entry_end(ctx->dl);
 | |
| 	}
 | |
| 	return 0;
 | |
| 
 | |
| err_match_parse:
 | |
| 	pr_out_entry_end(ctx->dl);
 | |
| 	return -EINVAL;
 | |
| }
 | |
| 
 | |
| static struct resource *
 | |
| resource_find(struct resources *resources, struct resource *resource,
 | |
| 	      uint64_t resource_id)
 | |
| {
 | |
| 	struct list_head *list_head;
 | |
| 
 | |
| 	if (!resource)
 | |
| 		list_head = &resources->resource_list;
 | |
| 	else
 | |
| 		list_head = &resource->resource_list;
 | |
| 
 | |
| 	list_for_each_entry(resource, list_head, list) {
 | |
| 		struct resource *child_resource;
 | |
| 
 | |
| 		if (resource->id == resource_id)
 | |
| 			return resource;
 | |
| 
 | |
| 		child_resource = resource_find(resources, resource,
 | |
| 					       resource_id);
 | |
| 		if (child_resource)
 | |
| 			return child_resource;
 | |
| 	}
 | |
| 	return NULL;
 | |
| }
 | |
| 
 | |
| static void
 | |
| resource_path_print(struct dl *dl, struct resources *resources,
 | |
| 		    uint64_t resource_id)
 | |
| {
 | |
| 	struct resource *resource, *parent_resource;
 | |
| 	const char del[] = "/";
 | |
| 	int path_len = 0;
 | |
| 	char *path;
 | |
| 
 | |
| 	resource = resource_find(resources, NULL, resource_id);
 | |
| 	if (!resource)
 | |
| 		return;
 | |
| 
 | |
| 	for (parent_resource = resource; parent_resource;
 | |
| 	     parent_resource = parent_resource->parent)
 | |
| 		path_len += strlen(parent_resource->name) + 1;
 | |
| 
 | |
| 	path_len++;
 | |
| 	path = calloc(1, path_len);
 | |
| 	if (!path)
 | |
| 		return;
 | |
| 
 | |
| 	path += path_len - 1;
 | |
| 	for (parent_resource = resource; parent_resource;
 | |
| 		parent_resource = parent_resource->parent) {
 | |
| 		path -= strlen(parent_resource->name);
 | |
| 		memcpy(path, parent_resource->name,
 | |
| 		       strlen(parent_resource->name));
 | |
| 		path -= strlen(del);
 | |
| 		memcpy(path, del, strlen(del));
 | |
| 	}
 | |
| 	pr_out_str(dl, "resource_path", path);
 | |
| 	free(path);
 | |
| }
 | |
| 
 | |
| static int dpipe_table_show(struct dpipe_ctx *ctx, struct nlattr *nl)
 | |
| {
 | |
| 	struct nlattr *nla_table[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct dpipe_table *table;
 | |
| 	uint32_t resource_units;
 | |
| 	bool counters_enabled;
 | |
| 	bool resource_valid;
 | |
| 	uint32_t size;
 | |
| 	int err;
 | |
| 
 | |
| 	err = mnl_attr_parse_nested(nl, attr_cb, nla_table);
 | |
| 	if (err != MNL_CB_OK)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (!nla_table[DEVLINK_ATTR_DPIPE_TABLE_NAME] ||
 | |
| 	    !nla_table[DEVLINK_ATTR_DPIPE_TABLE_SIZE] ||
 | |
| 	    !nla_table[DEVLINK_ATTR_DPIPE_TABLE_ACTIONS] ||
 | |
| 	    !nla_table[DEVLINK_ATTR_DPIPE_TABLE_MATCHES] ||
 | |
| 	    !nla_table[DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED]) {
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	table = dpipe_table_alloc();
 | |
| 	if (!table)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	table->name = strdup(mnl_attr_get_str(nla_table[DEVLINK_ATTR_DPIPE_TABLE_NAME]));
 | |
| 	size = mnl_attr_get_u32(nla_table[DEVLINK_ATTR_DPIPE_TABLE_SIZE]);
 | |
| 	counters_enabled = !!mnl_attr_get_u8(nla_table[DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED]);
 | |
| 
 | |
| 	resource_valid = nla_table[DEVLINK_ATTR_DPIPE_TABLE_RESOURCE_ID] &&
 | |
| 			 ctx->resources;
 | |
| 	if (resource_valid) {
 | |
| 		table->resource_id = mnl_attr_get_u64(nla_table[DEVLINK_ATTR_DPIPE_TABLE_RESOURCE_ID]);
 | |
| 		table->resource_valid = true;
 | |
| 	}
 | |
| 
 | |
| 	list_add_tail(&table->list, &ctx->tables->table_list);
 | |
| 	if (!ctx->print_tables)
 | |
| 		return 0;
 | |
| 
 | |
| 	pr_out_str(ctx->dl, "name", table->name);
 | |
| 	pr_out_uint(ctx->dl, "size", size);
 | |
| 	pr_out_str(ctx->dl, "counters_enabled",
 | |
| 		   counters_enabled ? "true" : "false");
 | |
| 
 | |
| 	if (resource_valid) {
 | |
| 		resource_units = mnl_attr_get_u32(nla_table[DEVLINK_ATTR_DPIPE_TABLE_RESOURCE_UNITS]);
 | |
| 		resource_path_print(ctx->dl, ctx->resources,
 | |
| 				    table->resource_id);
 | |
| 		pr_out_uint(ctx->dl, "resource_units", resource_units);
 | |
| 	}
 | |
| 
 | |
| 	pr_out_array_start(ctx->dl, "match");
 | |
| 	if (dpipe_table_matches_show(ctx, nla_table[DEVLINK_ATTR_DPIPE_TABLE_MATCHES]))
 | |
| 		goto err_matches_show;
 | |
| 	pr_out_array_end(ctx->dl);
 | |
| 
 | |
| 	pr_out_array_start(ctx->dl, "action");
 | |
| 	if (dpipe_table_actions_show(ctx, nla_table[DEVLINK_ATTR_DPIPE_TABLE_ACTIONS]))
 | |
| 		goto err_actions_show;
 | |
| 	pr_out_array_end(ctx->dl);
 | |
| 
 | |
| 	return 0;
 | |
| 
 | |
| err_actions_show:
 | |
| err_matches_show:
 | |
| 	pr_out_array_end(ctx->dl);
 | |
| 	return -EINVAL;
 | |
| }
 | |
| 
 | |
| static int dpipe_tables_show(struct dpipe_ctx *ctx, struct nlattr **tb)
 | |
| {
 | |
| 	struct nlattr *nla_tables = tb[DEVLINK_ATTR_DPIPE_TABLES];
 | |
| 	struct nlattr *nla_table;
 | |
| 
 | |
| 	mnl_attr_for_each_nested(nla_table, nla_tables) {
 | |
| 		if (ctx->print_tables)
 | |
| 			pr_out_handle_start_arr(ctx->dl, tb);
 | |
| 		if (dpipe_table_show(ctx, nla_table))
 | |
| 			goto err_table_show;
 | |
| 		if (ctx->print_tables)
 | |
| 			pr_out_handle_end(ctx->dl);
 | |
| 	}
 | |
| 	return 0;
 | |
| 
 | |
| err_table_show:
 | |
| 	if (ctx->print_tables)
 | |
| 		pr_out_handle_end(ctx->dl);
 | |
| 	return -EINVAL;
 | |
| }
 | |
| 
 | |
| static int cmd_dpipe_table_show_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct dpipe_ctx *ctx = data;
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 	    !tb[DEVLINK_ATTR_DPIPE_TABLES])
 | |
| 		return MNL_CB_ERROR;
 | |
| 
 | |
| 	if (dpipe_tables_show(ctx, tb))
 | |
| 		return MNL_CB_ERROR;
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int cmd_resource_dump_cb(const struct nlmsghdr *nlh, void *data);
 | |
| 
 | |
| static int cmd_dpipe_table_show(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	struct dpipe_ctx dpipe_ctx = {};
 | |
| 	struct resource_ctx resource_ctx = {};
 | |
| 	uint16_t flags = NLM_F_REQUEST;
 | |
| 	int err;
 | |
| 
 | |
| 	err = dl_argv_parse(dl, DL_OPT_HANDLE, DL_OPT_DPIPE_TABLE_NAME);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_HEADERS_GET, flags);
 | |
| 
 | |
| 	err = dpipe_ctx_init(&dpipe_ctx, dl);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	dpipe_ctx.print_tables = true;
 | |
| 
 | |
| 	dl_opts_put(nlh, dl);
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_header_cb,
 | |
| 				  &dpipe_ctx);
 | |
| 	if (err) {
 | |
| 		pr_err("error get headers %s\n", strerror(dpipe_ctx.err));
 | |
| 		goto err_headers_get;
 | |
| 	}
 | |
| 
 | |
| 	err = resource_ctx_init(&resource_ctx, dl);
 | |
| 	if (err)
 | |
| 		goto err_resource_ctx_init;
 | |
| 
 | |
| 	resource_ctx.print_resources = false;
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_RESOURCE_DUMP, flags);
 | |
| 	dl_opts_put(nlh, dl);
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_resource_dump_cb,
 | |
| 				  &resource_ctx);
 | |
| 	if (!err)
 | |
| 		dpipe_ctx.resources = resource_ctx.resources;
 | |
| 
 | |
| 	flags = NLM_F_REQUEST | NLM_F_ACK;
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_TABLE_GET, flags);
 | |
| 	dl_opts_put(nlh, dl);
 | |
| 
 | |
| 	pr_out_section_start(dl, "table");
 | |
| 	_mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_table_show_cb, &dpipe_ctx);
 | |
| 	pr_out_section_end(dl);
 | |
| 
 | |
| 	resource_ctx_fini(&resource_ctx);
 | |
| 	dpipe_ctx_fini(&dpipe_ctx);
 | |
| 	return 0;
 | |
| 
 | |
| err_resource_ctx_init:
 | |
| err_headers_get:
 | |
| 	dpipe_ctx_fini(&dpipe_ctx);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int cmd_dpipe_table_set(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_TABLE_COUNTERS_SET,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 
 | |
| 	err = dl_argv_parse_put(nlh, dl,
 | |
| 				DL_OPT_HANDLE | DL_OPT_DPIPE_TABLE_NAME |
 | |
| 				DL_OPT_DPIPE_TABLE_COUNTERS, 0);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
 | |
| }
 | |
| 
 | |
| enum dpipe_value_type {
 | |
| 	DPIPE_VALUE_TYPE_VALUE,
 | |
| 	DPIPE_VALUE_TYPE_MASK,
 | |
| };
 | |
| 
 | |
| static const char *
 | |
| dpipe_value_type_e2s(enum dpipe_value_type type)
 | |
| {
 | |
| 	switch (type) {
 | |
| 	case DPIPE_VALUE_TYPE_VALUE:
 | |
| 		return "value";
 | |
| 	case DPIPE_VALUE_TYPE_MASK:
 | |
| 		return "value_mask";
 | |
| 	default:
 | |
| 		return "<unknown>";
 | |
| 	}
 | |
| }
 | |
| 
 | |
| struct dpipe_field_printer {
 | |
| 	unsigned int field_id;
 | |
| 	void (*printer)(struct dpipe_ctx *, enum dpipe_value_type, void *);
 | |
| };
 | |
| 
 | |
| struct dpipe_header_printer {
 | |
| 	struct dpipe_field_printer *printers;
 | |
| 	unsigned int printers_count;
 | |
| 	unsigned int header_id;
 | |
| };
 | |
| 
 | |
| static void dpipe_field_printer_ipv4_addr(struct dpipe_ctx *ctx,
 | |
| 					  enum dpipe_value_type type,
 | |
| 					  void *value)
 | |
| {
 | |
| 	struct in_addr ip_addr;
 | |
| 
 | |
| 	ip_addr.s_addr = htonl(*(uint32_t *)value);
 | |
| 	pr_out_str(ctx->dl, dpipe_value_type_e2s(type), inet_ntoa(ip_addr));
 | |
| }
 | |
| 
 | |
| static void
 | |
| dpipe_field_printer_ethernet_addr(struct dpipe_ctx *ctx,
 | |
| 				  enum dpipe_value_type type,
 | |
| 				  void *value)
 | |
| {
 | |
| 	pr_out_str(ctx->dl, dpipe_value_type_e2s(type),
 | |
| 		   ether_ntoa((struct ether_addr *)value));
 | |
| }
 | |
| 
 | |
| static void dpipe_field_printer_ipv6_addr(struct dpipe_ctx *ctx,
 | |
| 					  enum dpipe_value_type type,
 | |
| 					  void *value)
 | |
| {
 | |
| 	char str[INET6_ADDRSTRLEN];
 | |
| 
 | |
| 	inet_ntop(AF_INET6, value, str, INET6_ADDRSTRLEN);
 | |
| 	pr_out_str(ctx->dl, dpipe_value_type_e2s(type), str);
 | |
| }
 | |
| 
 | |
| static struct dpipe_field_printer dpipe_field_printers_ipv4[] = {
 | |
| 	{
 | |
| 		.printer = dpipe_field_printer_ipv4_addr,
 | |
| 		.field_id = DEVLINK_DPIPE_FIELD_IPV4_DST_IP,
 | |
| 	}
 | |
| };
 | |
| 
 | |
| static struct dpipe_header_printer dpipe_header_printer_ipv4  = {
 | |
| 	.printers = dpipe_field_printers_ipv4,
 | |
| 	.printers_count = ARRAY_SIZE(dpipe_field_printers_ipv4),
 | |
| 	.header_id = DEVLINK_DPIPE_HEADER_IPV4,
 | |
| };
 | |
| 
 | |
| static struct dpipe_field_printer dpipe_field_printers_ethernet[] = {
 | |
| 	{
 | |
| 		.printer = dpipe_field_printer_ethernet_addr,
 | |
| 		.field_id = DEVLINK_DPIPE_FIELD_ETHERNET_DST_MAC,
 | |
| 	},
 | |
| };
 | |
| 
 | |
| static struct dpipe_header_printer dpipe_header_printer_ethernet = {
 | |
| 	.printers = dpipe_field_printers_ethernet,
 | |
| 	.printers_count = ARRAY_SIZE(dpipe_field_printers_ethernet),
 | |
| 	.header_id = DEVLINK_DPIPE_HEADER_ETHERNET,
 | |
| };
 | |
| 
 | |
| static struct dpipe_field_printer dpipe_field_printers_ipv6[] = {
 | |
| 	{
 | |
| 		.printer = dpipe_field_printer_ipv6_addr,
 | |
| 		.field_id = DEVLINK_DPIPE_FIELD_IPV6_DST_IP,
 | |
| 	}
 | |
| };
 | |
| 
 | |
| static struct dpipe_header_printer dpipe_header_printer_ipv6 = {
 | |
| 	.printers = dpipe_field_printers_ipv6,
 | |
| 	.printers_count = ARRAY_SIZE(dpipe_field_printers_ipv6),
 | |
| 	.header_id = DEVLINK_DPIPE_HEADER_IPV6,
 | |
| };
 | |
| 
 | |
| static struct dpipe_header_printer *dpipe_header_printers[] = {
 | |
| 	&dpipe_header_printer_ipv4,
 | |
| 	&dpipe_header_printer_ethernet,
 | |
| 	&dpipe_header_printer_ipv6,
 | |
| };
 | |
| 
 | |
| static int dpipe_print_prot_header(struct dpipe_ctx *ctx,
 | |
| 				   struct dpipe_op_info *info,
 | |
| 				   enum dpipe_value_type type,
 | |
| 				   void *value)
 | |
| {
 | |
| 	unsigned int header_printers_count = ARRAY_SIZE(dpipe_header_printers);
 | |
| 	struct dpipe_header_printer *header_printer;
 | |
| 	struct dpipe_field_printer *field_printer;
 | |
| 	unsigned int field_printers_count;
 | |
| 	int j;
 | |
| 	int i;
 | |
| 
 | |
| 	for (i = 0; i < header_printers_count; i++) {
 | |
| 		header_printer = dpipe_header_printers[i];
 | |
| 		if (header_printer->header_id != info->header_id)
 | |
| 			continue;
 | |
| 		field_printers_count = header_printer->printers_count;
 | |
| 		for (j = 0; j < field_printers_count; j++) {
 | |
| 			field_printer = &header_printer->printers[j];
 | |
| 			if (field_printer->field_id != info->field_id)
 | |
| 				continue;
 | |
| 			field_printer->printer(ctx, type, value);
 | |
| 			return 0;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	return -EINVAL;
 | |
| }
 | |
| 
 | |
| static void __pr_out_entry_value(struct dpipe_ctx *ctx,
 | |
| 				 void *value,
 | |
| 				 unsigned int value_len,
 | |
| 				 struct dpipe_op_info *info,
 | |
| 				 enum dpipe_value_type type)
 | |
| {
 | |
| 	if (info->header_global &&
 | |
| 	    !dpipe_print_prot_header(ctx, info, type, value))
 | |
| 		return;
 | |
| 
 | |
| 	if (value_len == sizeof(uint32_t)) {
 | |
| 		uint32_t *value_32 = value;
 | |
| 
 | |
| 		pr_out_uint(ctx->dl, dpipe_value_type_e2s(type), *value_32);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_dpipe_entry_value(struct dpipe_ctx *ctx,
 | |
| 				     struct nlattr **nla_match_value,
 | |
| 				     struct dpipe_op_info *info)
 | |
| {
 | |
| 	void *value, *value_mask;
 | |
| 	uint32_t value_mapping;
 | |
| 	uint16_t value_len;
 | |
| 	bool mask, mapping;
 | |
| 
 | |
| 	mask = !!nla_match_value[DEVLINK_ATTR_DPIPE_VALUE_MASK];
 | |
| 	mapping = !!nla_match_value[DEVLINK_ATTR_DPIPE_VALUE_MAPPING];
 | |
| 
 | |
| 	value_len = mnl_attr_get_payload_len(nla_match_value[DEVLINK_ATTR_DPIPE_VALUE]);
 | |
| 	value = mnl_attr_get_payload(nla_match_value[DEVLINK_ATTR_DPIPE_VALUE]);
 | |
| 
 | |
| 	if (mapping) {
 | |
| 		value_mapping = mnl_attr_get_u32(nla_match_value[DEVLINK_ATTR_DPIPE_VALUE_MAPPING]);
 | |
| 		pr_out_uint(ctx->dl, "mapping_value", value_mapping);
 | |
| 	}
 | |
| 
 | |
| 	if (mask) {
 | |
| 		value_mask = mnl_attr_get_payload(nla_match_value[DEVLINK_ATTR_DPIPE_VALUE]);
 | |
| 		__pr_out_entry_value(ctx, value_mask, value_len, info,
 | |
| 				     DPIPE_VALUE_TYPE_MASK);
 | |
| 	}
 | |
| 
 | |
| 	__pr_out_entry_value(ctx, value, value_len, info, DPIPE_VALUE_TYPE_VALUE);
 | |
| }
 | |
| 
 | |
| static int dpipe_entry_match_value_show(struct dpipe_ctx *ctx,
 | |
| 					struct nlattr *nl)
 | |
| {
 | |
| 	struct nlattr *nla_match_value[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct dpipe_match match;
 | |
| 	int err;
 | |
| 
 | |
| 	err = mnl_attr_parse_nested(nl, attr_cb, nla_match_value);
 | |
| 	if (err != MNL_CB_OK)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (!nla_match_value[DEVLINK_ATTR_DPIPE_MATCH] ||
 | |
| 	    !nla_match_value[DEVLINK_ATTR_DPIPE_VALUE]) {
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	pr_out_entry_start(ctx->dl);
 | |
| 	if (dpipe_match_parse(&match,
 | |
| 			      nla_match_value[DEVLINK_ATTR_DPIPE_MATCH]))
 | |
| 		goto err_match_parse;
 | |
| 	pr_out_dpipe_match(&match, ctx);
 | |
| 	pr_out_dpipe_entry_value(ctx, nla_match_value, &match.info);
 | |
| 	pr_out_entry_end(ctx->dl);
 | |
| 
 | |
| 	return 0;
 | |
| 
 | |
| err_match_parse:
 | |
| 	pr_out_entry_end(ctx->dl);
 | |
| 	return -EINVAL;
 | |
| }
 | |
| 
 | |
| static int dpipe_entry_action_value_show(struct dpipe_ctx *ctx,
 | |
| 					 struct nlattr *nl)
 | |
| {
 | |
| 	struct nlattr *nla_action_value[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct dpipe_action action;
 | |
| 	int err;
 | |
| 
 | |
| 	err = mnl_attr_parse_nested(nl, attr_cb, nla_action_value);
 | |
| 	if (err != MNL_CB_OK)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (!nla_action_value[DEVLINK_ATTR_DPIPE_ACTION] ||
 | |
| 	    !nla_action_value[DEVLINK_ATTR_DPIPE_VALUE]) {
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	pr_out_entry_start(ctx->dl);
 | |
| 	if (dpipe_action_parse(&action,
 | |
| 			       nla_action_value[DEVLINK_ATTR_DPIPE_ACTION]))
 | |
| 		goto err_action_parse;
 | |
| 	pr_out_dpipe_action(&action, ctx);
 | |
| 	pr_out_dpipe_entry_value(ctx, nla_action_value, &action.info);
 | |
| 	pr_out_entry_end(ctx->dl);
 | |
| 
 | |
| 	return 0;
 | |
| 
 | |
| err_action_parse:
 | |
| 	pr_out_entry_end(ctx->dl);
 | |
| 	return -EINVAL;
 | |
| }
 | |
| 
 | |
| static int
 | |
| dpipe_tables_action_values_show(struct dpipe_ctx *ctx,
 | |
| 				struct nlattr *nla_action_values)
 | |
| {
 | |
| 	struct nlattr *nla_action_value;
 | |
| 
 | |
| 	mnl_attr_for_each_nested(nla_action_value, nla_action_values) {
 | |
| 		if (dpipe_entry_action_value_show(ctx, nla_action_value))
 | |
| 			return -EINVAL;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int
 | |
| dpipe_tables_match_values_show(struct dpipe_ctx *ctx,
 | |
| 			       struct nlattr *nla_match_values)
 | |
| {
 | |
| 	struct nlattr *nla_match_value;
 | |
| 
 | |
| 	mnl_attr_for_each_nested(nla_match_value, nla_match_values) {
 | |
| 		if (dpipe_entry_match_value_show(ctx, nla_match_value))
 | |
| 			return -EINVAL;
 | |
| 	}
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int dpipe_entry_show(struct dpipe_ctx *ctx, struct nlattr *nl)
 | |
| {
 | |
| 	struct nlattr *nla_entry[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	uint32_t entry_index;
 | |
| 	uint64_t counter;
 | |
| 	int err;
 | |
| 
 | |
| 	err = mnl_attr_parse_nested(nl, attr_cb, nla_entry);
 | |
| 	if (err != MNL_CB_OK)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (!nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_INDEX] ||
 | |
| 	    !nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_MATCH_VALUES] ||
 | |
| 	    !nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_ACTION_VALUES]) {
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	entry_index = mnl_attr_get_u32(nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_INDEX]);
 | |
| 	pr_out_uint(ctx->dl, "index", entry_index);
 | |
| 
 | |
| 	if (nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_COUNTER]) {
 | |
| 		counter = mnl_attr_get_u64(nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_COUNTER]);
 | |
| 		pr_out_uint(ctx->dl, "counter", counter);
 | |
| 	}
 | |
| 
 | |
| 	pr_out_array_start(ctx->dl, "match_value");
 | |
| 	if (dpipe_tables_match_values_show(ctx,
 | |
| 					   nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_MATCH_VALUES]))
 | |
| 		goto err_match_values_show;
 | |
| 	pr_out_array_end(ctx->dl);
 | |
| 
 | |
| 	pr_out_array_start(ctx->dl, "action_value");
 | |
| 	if (dpipe_tables_action_values_show(ctx,
 | |
| 					    nla_entry[DEVLINK_ATTR_DPIPE_ENTRY_ACTION_VALUES]))
 | |
| 		goto err_action_values_show;
 | |
| 	pr_out_array_end(ctx->dl);
 | |
| 	return 0;
 | |
| 
 | |
| err_action_values_show:
 | |
| err_match_values_show:
 | |
| 	pr_out_array_end(ctx->dl);
 | |
| 	return -EINVAL;
 | |
| }
 | |
| 
 | |
| static int dpipe_table_entries_show(struct dpipe_ctx *ctx, struct nlattr **tb)
 | |
| {
 | |
| 	struct nlattr *nla_entries = tb[DEVLINK_ATTR_DPIPE_ENTRIES];
 | |
| 	struct nlattr *nla_entry;
 | |
| 
 | |
| 	mnl_attr_for_each_nested(nla_entry, nla_entries) {
 | |
| 		pr_out_handle_start_arr(ctx->dl, tb);
 | |
| 		if (dpipe_entry_show(ctx, nla_entry))
 | |
| 			goto err_entry_show;
 | |
| 		pr_out_handle_end(ctx->dl);
 | |
| 	}
 | |
| 	return 0;
 | |
| 
 | |
| err_entry_show:
 | |
| 	pr_out_handle_end(ctx->dl);
 | |
| 	return -EINVAL;
 | |
| }
 | |
| 
 | |
| static int cmd_dpipe_table_entry_dump_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct dpipe_ctx *ctx = data;
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 	    !tb[DEVLINK_ATTR_DPIPE_ENTRIES])
 | |
| 		return MNL_CB_ERROR;
 | |
| 
 | |
| 	if (dpipe_table_entries_show(ctx, tb))
 | |
| 		return MNL_CB_ERROR;
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int cmd_dpipe_table_dump(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	struct dpipe_ctx ctx = {};
 | |
| 	uint16_t flags = NLM_F_REQUEST;
 | |
| 	int err;
 | |
| 
 | |
| 	err = dpipe_ctx_init(&ctx, dl);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	err = dl_argv_parse(dl, DL_OPT_HANDLE | DL_OPT_DPIPE_TABLE_NAME, 0);
 | |
| 	if (err)
 | |
| 		goto out;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_HEADERS_GET, flags);
 | |
| 	dl_opts_put(nlh, dl);
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_header_cb, &ctx);
 | |
| 	if (err) {
 | |
| 		pr_err("error get headers %s\n", strerror(ctx.err));
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| 	flags = NLM_F_REQUEST | NLM_F_ACK;
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_ENTRIES_GET, flags);
 | |
| 	dl_opts_put(nlh, dl);
 | |
| 
 | |
| 	pr_out_section_start(dl, "table_entry");
 | |
| 	_mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_table_entry_dump_cb, &ctx);
 | |
| 	pr_out_section_end(dl);
 | |
| out:
 | |
| 	dpipe_ctx_fini(&ctx);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static void cmd_dpipe_table_help(void)
 | |
| {
 | |
| 	pr_err("Usage: devlink dpipe table [ OBJECT-LIST ]\n"
 | |
| 	       "where  OBJECT-LIST := { show | set | dump }\n");
 | |
| }
 | |
| 
 | |
| static int cmd_dpipe_table(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
 | |
| 		cmd_dpipe_table_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "show")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dpipe_table_show(dl);
 | |
| 	} else if (dl_argv_match(dl, "set")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dpipe_table_set(dl);
 | |
| 	}  else if (dl_argv_match(dl, "dump")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dpipe_table_dump(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static void cmd_dpipe_help(void)
 | |
| {
 | |
| 	pr_err("Usage: devlink dpipe [ OBJECT-LIST ]\n"
 | |
| 	       "where  OBJECT-LIST := { header | table }\n");
 | |
| }
 | |
| 
 | |
| static int cmd_dpipe(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
 | |
| 		cmd_dpipe_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "header")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dpipe_header(dl);
 | |
| 	} else if (dl_argv_match(dl, "table")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dpipe_table(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static int
 | |
| resource_parse(struct resource_ctx *ctx, struct resource *resource,
 | |
| 	       struct nlattr **nla_resource)
 | |
| {
 | |
| 	if (!nla_resource[DEVLINK_ATTR_RESOURCE_NAME] ||
 | |
| 	    !nla_resource[DEVLINK_ATTR_RESOURCE_SIZE] ||
 | |
| 	    !nla_resource[DEVLINK_ATTR_RESOURCE_ID] ||
 | |
| 	    !nla_resource[DEVLINK_ATTR_RESOURCE_UNIT] ||
 | |
| 	    !nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_MIN] ||
 | |
| 	    !nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_MAX] ||
 | |
| 	    !nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_GRAN]) {
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	resource->name = strdup(mnl_attr_get_str(nla_resource[DEVLINK_ATTR_RESOURCE_NAME]));
 | |
| 	resource->size = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE]);
 | |
| 	resource->id = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_ID]);
 | |
| 	resource->unit = mnl_attr_get_u8(nla_resource[DEVLINK_ATTR_RESOURCE_UNIT]);
 | |
| 	resource->size_min = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_MIN]);
 | |
| 	resource->size_max = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_MAX]);
 | |
| 	resource->size_gran = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_GRAN]);
 | |
| 
 | |
| 	if (nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_NEW])
 | |
| 		resource->size_new = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_NEW]);
 | |
| 	else
 | |
| 		resource->size_new = resource->size;
 | |
| 
 | |
| 	if (nla_resource[DEVLINK_ATTR_RESOURCE_OCC]) {
 | |
| 		resource->size_occ = mnl_attr_get_u64(nla_resource[DEVLINK_ATTR_RESOURCE_OCC]);
 | |
| 		resource->occ_valid = true;
 | |
| 	}
 | |
| 
 | |
| 	if (resource->size_new != resource->size)
 | |
| 		ctx->pending_change = true;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int
 | |
| resource_get(struct resource_ctx *ctx, struct resource *resource,
 | |
| 	     struct resource *parent_resource, struct nlattr *nl)
 | |
| {
 | |
| 	struct nlattr *nla_resource[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct nlattr *nla_child_resource;
 | |
| 	struct nlattr *nla_resources;
 | |
| 	bool top = false;
 | |
| 	int err;
 | |
| 
 | |
| 	if (!resource) {
 | |
| 		nla_resources = nl;
 | |
| 		top = true;
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| 	err = mnl_attr_parse_nested(nl, attr_cb, nla_resource);
 | |
| 	if (err != MNL_CB_OK)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	err = resource_parse(ctx, resource, nla_resource);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	resource->parent = parent_resource;
 | |
| 	if (!nla_resource[DEVLINK_ATTR_RESOURCE_LIST])
 | |
| 		return 0;
 | |
| 
 | |
| 	resource->size_valid = !!mnl_attr_get_u8(nla_resource[DEVLINK_ATTR_RESOURCE_SIZE_VALID]);
 | |
| 	nla_resources = nla_resource[DEVLINK_ATTR_RESOURCE_LIST];
 | |
| out:
 | |
| 	mnl_attr_for_each_nested(nla_child_resource, nla_resources) {
 | |
| 		struct resource *child_resource;
 | |
| 		struct list_head *list;
 | |
| 
 | |
| 		child_resource = resource_alloc();
 | |
| 		if (!child_resource)
 | |
| 			return -ENOMEM;
 | |
| 
 | |
| 		if (top)
 | |
| 			list = &ctx->resources->resource_list;
 | |
| 		else
 | |
| 			list = &resource->resource_list;
 | |
| 
 | |
| 		list_add_tail(&child_resource->list, list);
 | |
| 		err = resource_get(ctx, child_resource, resource,
 | |
| 				   nla_child_resource);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static const char *resource_unit_str_get(enum devlink_resource_unit unit)
 | |
| {
 | |
| 	switch (unit) {
 | |
| 	case DEVLINK_RESOURCE_UNIT_ENTRY: return "entry";
 | |
| 	default: return "<unknown unit>";
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void resource_show(struct resource *resource,
 | |
| 			  struct resource_ctx *ctx)
 | |
| {
 | |
| 	struct resource *child_resource;
 | |
| 	struct dpipe_table *table;
 | |
| 	struct dl *dl = ctx->dl;
 | |
| 	bool array = false;
 | |
| 
 | |
| 	pr_out_str(dl, "name", resource->name);
 | |
| 	if (dl->verbose)
 | |
| 		resource_path_print(dl, ctx->resources, resource->id);
 | |
| 	pr_out_u64(dl, "size", resource->size);
 | |
| 	if (resource->size != resource->size_new)
 | |
| 		pr_out_u64(dl, "size_new", resource->size_new);
 | |
| 	if (resource->occ_valid)
 | |
| 		pr_out_uint(dl, "occ", resource->size_occ);
 | |
| 	pr_out_str(dl, "unit", resource_unit_str_get(resource->unit));
 | |
| 
 | |
| 	if (resource->size_min != resource->size_max) {
 | |
| 		pr_out_uint(dl, "size_min", resource->size_min);
 | |
| 		pr_out_u64(dl, "size_max", resource->size_max);
 | |
| 		pr_out_uint(dl, "size_gran", resource->size_gran);
 | |
| 	}
 | |
| 
 | |
| 	list_for_each_entry(table, &ctx->tables->table_list, list)
 | |
| 		if (table->resource_id == resource->id &&
 | |
| 		    table->resource_valid)
 | |
| 			array = true;
 | |
| 
 | |
| 	if (array)
 | |
| 		pr_out_array_start(dl, "dpipe_tables");
 | |
| 	else
 | |
| 		pr_out_str(dl, "dpipe_tables", "none");
 | |
| 
 | |
| 	list_for_each_entry(table, &ctx->tables->table_list, list) {
 | |
| 		if (table->resource_id != resource->id ||
 | |
| 		    !table->resource_valid)
 | |
| 			continue;
 | |
| 		pr_out_entry_start(dl);
 | |
| 		pr_out_str(dl, "table_name", table->name);
 | |
| 		pr_out_entry_end(dl);
 | |
| 	}
 | |
| 	if (array)
 | |
| 		pr_out_array_end(dl);
 | |
| 
 | |
| 	if (list_empty(&resource->resource_list))
 | |
| 		return;
 | |
| 
 | |
| 	if (ctx->pending_change)
 | |
| 		pr_out_str(dl, "size_valid", resource->size_valid ?
 | |
| 			   "true" : "false");
 | |
| 	pr_out_array_start(dl, "resources");
 | |
| 	list_for_each_entry(child_resource, &resource->resource_list, list) {
 | |
| 		pr_out_entry_start(dl);
 | |
| 		resource_show(child_resource, ctx);
 | |
| 		pr_out_entry_end(dl);
 | |
| 	}
 | |
| 	pr_out_array_end(dl);
 | |
| }
 | |
| 
 | |
| static void
 | |
| resources_show(struct resource_ctx *ctx, struct nlattr **tb)
 | |
| {
 | |
| 	struct resources *resources = ctx->resources;
 | |
| 	struct resource *resource;
 | |
| 
 | |
| 	list_for_each_entry(resource, &resources->resource_list, list) {
 | |
| 		pr_out_handle_start_arr(ctx->dl, tb);
 | |
| 		resource_show(resource, ctx);
 | |
| 		pr_out_handle_end(ctx->dl);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static int resources_get(struct resource_ctx *ctx, struct nlattr **tb)
 | |
| {
 | |
| 	return resource_get(ctx, NULL, NULL, tb[DEVLINK_ATTR_RESOURCE_LIST]);
 | |
| }
 | |
| 
 | |
| static int cmd_resource_dump_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct resource_ctx *ctx = data;
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 	int err;
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 	    !tb[DEVLINK_ATTR_RESOURCE_LIST])
 | |
| 		return MNL_CB_ERROR;
 | |
| 
 | |
| 	err = resources_get(ctx, tb);
 | |
| 	if (err) {
 | |
| 		ctx->err = err;
 | |
| 		return MNL_CB_ERROR;
 | |
| 	}
 | |
| 
 | |
| 	if (ctx->print_resources)
 | |
| 		resources_show(ctx, tb);
 | |
| 
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int cmd_resource_show(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	struct dpipe_ctx dpipe_ctx = {};
 | |
| 	struct resource_ctx resource_ctx = {};
 | |
| 	int err;
 | |
| 
 | |
| 	err = dl_argv_parse(dl, DL_OPT_HANDLE, 0);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_DPIPE_TABLE_GET,
 | |
| 			       NLM_F_REQUEST);
 | |
| 	dl_opts_put(nlh, dl);
 | |
| 
 | |
| 	err = dpipe_ctx_init(&dpipe_ctx, dl);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_dpipe_table_show_cb,
 | |
| 				  &dpipe_ctx);
 | |
| 	if (err) {
 | |
| 		pr_err("error get tables %s\n", strerror(dpipe_ctx.err));
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| 	err = resource_ctx_init(&resource_ctx, dl);
 | |
| 	if (err)
 | |
| 		goto out;
 | |
| 
 | |
| 	resource_ctx.print_resources = true;
 | |
| 	resource_ctx.tables = dpipe_ctx.tables;
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_RESOURCE_DUMP,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 	dl_opts_put(nlh, dl);
 | |
| 	pr_out_section_start(dl, "resources");
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_resource_dump_cb,
 | |
| 				  &resource_ctx);
 | |
| 	pr_out_section_end(dl);
 | |
| 	resource_ctx_fini(&resource_ctx);
 | |
| out:
 | |
| 	dpipe_ctx_fini(&dpipe_ctx);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static void cmd_resource_help(void)
 | |
| {
 | |
| 	pr_err("Usage: devlink resource show DEV\n"
 | |
| 	       "       devlink resource set DEV path PATH size SIZE\n");
 | |
| }
 | |
| 
 | |
| static struct resource *
 | |
| resource_find_by_name(struct list_head *list, char *name)
 | |
| {
 | |
| 	struct resource *resource;
 | |
| 
 | |
| 	list_for_each_entry(resource, list, list) {
 | |
| 		if (!strcmp(resource->name, name))
 | |
| 			return resource;
 | |
| 	}
 | |
| 	return NULL;
 | |
| }
 | |
| 
 | |
| static int
 | |
| resource_path_parse(struct resource_ctx *ctx, const char *resource_path,
 | |
| 		    uint32_t *p_resource_id, bool *p_resource_valid)
 | |
| {
 | |
| 	struct resource *resource;
 | |
| 	uint32_t resource_id = 0;
 | |
| 	char *resource_path_dup;
 | |
| 	struct list_head *list;
 | |
| 	const char del[] = "/";
 | |
| 	char *resource_name;
 | |
| 
 | |
| 	resource_path_dup = strdup(resource_path);
 | |
| 	list = &ctx->resources->resource_list;
 | |
| 	resource_name = strtok(resource_path_dup, del);
 | |
| 	while (resource_name != NULL) {
 | |
| 		resource = resource_find_by_name(list, resource_name);
 | |
| 		if (!resource)
 | |
| 			goto err_resource_lookup;
 | |
| 
 | |
| 		list = &resource->resource_list;
 | |
| 		resource_name = strtok(NULL, del);
 | |
| 		resource_id = resource->id;
 | |
| 	}
 | |
| 	free(resource_path_dup);
 | |
| 	*p_resource_valid = true;
 | |
| 	*p_resource_id = resource_id;
 | |
| 	return 0;
 | |
| 
 | |
| err_resource_lookup:
 | |
| 	free(resource_path_dup);
 | |
| 	return -EINVAL;
 | |
| }
 | |
| 
 | |
| static int cmd_resource_set(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	struct resource_ctx ctx = {};
 | |
| 	int err;
 | |
| 
 | |
| 	err = resource_ctx_init(&ctx, dl);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	ctx.print_resources = false;
 | |
| 	err = dl_argv_parse(dl, DL_OPT_HANDLE | DL_OPT_RESOURCE_PATH |
 | |
| 			    DL_OPT_RESOURCE_SIZE, 0);
 | |
| 	if (err)
 | |
| 		goto out;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_RESOURCE_DUMP,
 | |
| 			       NLM_F_REQUEST);
 | |
| 	dl_opts_put(nlh, dl);
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_resource_dump_cb, &ctx);
 | |
| 	if (err) {
 | |
| 		pr_err("error getting resources %s\n", strerror(ctx.err));
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| 	err = resource_path_parse(&ctx, dl->opts.resource_path,
 | |
| 				  &dl->opts.resource_id,
 | |
| 				  &dl->opts.resource_id_valid);
 | |
| 	if (err) {
 | |
| 		pr_err("error parsing resource path %s\n", strerror(-err));
 | |
| 		goto out;
 | |
| 	}
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_RESOURCE_SET,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 
 | |
| 	dl_opts_put(nlh, dl);
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
 | |
| out:
 | |
| 	resource_ctx_fini(&ctx);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int cmd_resource(struct dl *dl)
 | |
| {
 | |
| 	if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
 | |
| 		cmd_resource_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "show")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_resource_show(dl);
 | |
| 	} else if (dl_argv_match(dl, "set")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_resource_set(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static void pr_out_region_handle_start(struct dl *dl, struct nlattr **tb)
 | |
| {
 | |
| 	const char *bus_name = mnl_attr_get_str(tb[DEVLINK_ATTR_BUS_NAME]);
 | |
| 	const char *dev_name = mnl_attr_get_str(tb[DEVLINK_ATTR_DEV_NAME]);
 | |
| 	const char *region_name = mnl_attr_get_str(tb[DEVLINK_ATTR_REGION_NAME]);
 | |
| 	char buf[256];
 | |
| 
 | |
| 	sprintf(buf, "%s/%s/%s", bus_name, dev_name, region_name);
 | |
| 	if (dl->json_output) {
 | |
| 		jsonw_name(dl->jw, buf);
 | |
| 		jsonw_start_object(dl->jw);
 | |
| 	} else {
 | |
| 		pr_out("%s:", buf);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_region_handle_end(struct dl *dl)
 | |
| {
 | |
| 	if (dl->json_output)
 | |
| 		jsonw_end_object(dl->jw);
 | |
| 	else
 | |
| 		pr_out("\n");
 | |
| }
 | |
| 
 | |
| static void pr_out_region_snapshots_start(struct dl *dl, bool array)
 | |
| {
 | |
| 	if (dl->json_output) {
 | |
| 		jsonw_name(dl->jw, "snapshot");
 | |
| 		jsonw_start_array(dl->jw);
 | |
| 	} else {
 | |
| 		if (g_indent_newline)
 | |
| 			pr_out("snapshot %s", array ? "[" : "");
 | |
| 		else
 | |
| 			pr_out(" snapshot %s", array ? "[" : "");
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pr_out_region_snapshots_end(struct dl *dl, bool array)
 | |
| {
 | |
| 	if (dl->json_output)
 | |
| 		jsonw_end_array(dl->jw);
 | |
| 	else if (array)
 | |
| 		pr_out("]");
 | |
| }
 | |
| 
 | |
| static void pr_out_region_snapshots_id(struct dl *dl, struct nlattr **tb, int index)
 | |
| {
 | |
| 	uint32_t snapshot_id;
 | |
| 
 | |
| 	if (!tb[DEVLINK_ATTR_REGION_SNAPSHOT_ID])
 | |
| 		return;
 | |
| 
 | |
| 	snapshot_id = mnl_attr_get_u32(tb[DEVLINK_ATTR_REGION_SNAPSHOT_ID]);
 | |
| 
 | |
| 	if (dl->json_output)
 | |
| 		jsonw_uint(dl->jw, snapshot_id);
 | |
| 	else
 | |
| 		pr_out("%s%u", index ? " " : "", snapshot_id);
 | |
| }
 | |
| 
 | |
| static void pr_out_snapshots(struct dl *dl, struct nlattr **tb)
 | |
| {
 | |
| 	struct nlattr *tb_snapshot[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct nlattr *nla_sanpshot;
 | |
| 	int err, index = 0;
 | |
| 
 | |
| 	pr_out_region_snapshots_start(dl, true);
 | |
| 	mnl_attr_for_each_nested(nla_sanpshot, tb[DEVLINK_ATTR_REGION_SNAPSHOTS]) {
 | |
| 		err = mnl_attr_parse_nested(nla_sanpshot, attr_cb, tb_snapshot);
 | |
| 		if (err != MNL_CB_OK)
 | |
| 			return;
 | |
| 		pr_out_region_snapshots_id(dl, tb_snapshot, index++);
 | |
| 	}
 | |
| 	pr_out_region_snapshots_end(dl, true);
 | |
| }
 | |
| 
 | |
| static void pr_out_snapshot(struct dl *dl, struct nlattr **tb)
 | |
| {
 | |
| 	pr_out_region_snapshots_start(dl, false);
 | |
| 	pr_out_region_snapshots_id(dl, tb, 0);
 | |
| 	pr_out_region_snapshots_end(dl, false);
 | |
| }
 | |
| 
 | |
| static void pr_out_region(struct dl *dl, struct nlattr **tb)
 | |
| {
 | |
| 	pr_out_region_handle_start(dl, tb);
 | |
| 
 | |
| 	if (tb[DEVLINK_ATTR_REGION_SIZE])
 | |
| 		pr_out_u64(dl, "size",
 | |
| 			   mnl_attr_get_u64(tb[DEVLINK_ATTR_REGION_SIZE]));
 | |
| 
 | |
| 	if (tb[DEVLINK_ATTR_REGION_SNAPSHOTS])
 | |
| 		pr_out_snapshots(dl, tb);
 | |
| 
 | |
| 	if (tb[DEVLINK_ATTR_REGION_SNAPSHOT_ID])
 | |
| 		pr_out_snapshot(dl, tb);
 | |
| 
 | |
| 	pr_out_region_handle_end(dl);
 | |
| }
 | |
| 
 | |
| static int cmd_region_show_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct dl *dl = data;
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 	    !tb[DEVLINK_ATTR_REGION_NAME] || !tb[DEVLINK_ATTR_REGION_SIZE])
 | |
| 		return MNL_CB_ERROR;
 | |
| 
 | |
| 	pr_out_region(dl, tb);
 | |
| 
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int cmd_region_show(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	uint16_t flags = NLM_F_REQUEST | NLM_F_ACK;
 | |
| 	int err;
 | |
| 
 | |
| 	if (dl_argc(dl) == 0)
 | |
| 		flags |= NLM_F_DUMP;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_REGION_GET, flags);
 | |
| 
 | |
| 	if (dl_argc(dl) > 0) {
 | |
| 		err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE_REGION, 0);
 | |
| 		if (err)
 | |
| 			return err;
 | |
| 	}
 | |
| 
 | |
| 	pr_out_section_start(dl, "regions");
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_region_show_cb, dl);
 | |
| 	pr_out_section_end(dl);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int cmd_region_snapshot_del(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_REGION_DEL,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK);
 | |
| 
 | |
| 	err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE_REGION |
 | |
| 				DL_OPT_REGION_SNAPSHOT_ID, 0);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	return _mnlg_socket_sndrcv(dl->nlg, nlh, NULL, NULL);
 | |
| }
 | |
| 
 | |
| static int cmd_region_read_cb(const struct nlmsghdr *nlh, void *data)
 | |
| {
 | |
| 	struct nlattr *nla_entry, *nla_chunk_data, *nla_chunk_addr;
 | |
| 	struct genlmsghdr *genl = mnl_nlmsg_get_payload(nlh);
 | |
| 	struct nlattr *tb_field[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct nlattr *tb[DEVLINK_ATTR_MAX + 1] = {};
 | |
| 	struct dl *dl = data;
 | |
| 	int err;
 | |
| 
 | |
| 	mnl_attr_parse(nlh, sizeof(*genl), attr_cb, tb);
 | |
| 	if (!tb[DEVLINK_ATTR_BUS_NAME] || !tb[DEVLINK_ATTR_DEV_NAME] ||
 | |
| 	    !tb[DEVLINK_ATTR_REGION_CHUNKS])
 | |
| 		return MNL_CB_ERROR;
 | |
| 
 | |
| 	mnl_attr_for_each_nested(nla_entry, tb[DEVLINK_ATTR_REGION_CHUNKS]) {
 | |
| 		err = mnl_attr_parse_nested(nla_entry, attr_cb, tb_field);
 | |
| 		if (err != MNL_CB_OK)
 | |
| 			return MNL_CB_ERROR;
 | |
| 
 | |
| 		nla_chunk_data = tb_field[DEVLINK_ATTR_REGION_CHUNK_DATA];
 | |
| 		if (!nla_chunk_data)
 | |
| 			continue;
 | |
| 
 | |
| 		nla_chunk_addr = tb_field[DEVLINK_ATTR_REGION_CHUNK_ADDR];
 | |
| 		if (!nla_chunk_addr)
 | |
| 			continue;
 | |
| 
 | |
| 		pr_out_region_chunk(dl, mnl_attr_get_payload(nla_chunk_data),
 | |
| 				    mnl_attr_get_payload_len(nla_chunk_data),
 | |
| 				    mnl_attr_get_u64(nla_chunk_addr));
 | |
| 	}
 | |
| 	return MNL_CB_OK;
 | |
| }
 | |
| 
 | |
| static int cmd_region_dump(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_REGION_READ,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK | NLM_F_DUMP);
 | |
| 
 | |
| 	err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE_REGION |
 | |
| 				DL_OPT_REGION_SNAPSHOT_ID, 0);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	pr_out_section_start(dl, "dump");
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_region_read_cb, dl);
 | |
| 	pr_out_section_end(dl);
 | |
| 	if (!dl->json_output)
 | |
| 		pr_out("\n");
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static int cmd_region_read(struct dl *dl)
 | |
| {
 | |
| 	struct nlmsghdr *nlh;
 | |
| 	int err;
 | |
| 
 | |
| 	nlh = mnlg_msg_prepare(dl->nlg, DEVLINK_CMD_REGION_READ,
 | |
| 			       NLM_F_REQUEST | NLM_F_ACK | NLM_F_DUMP);
 | |
| 
 | |
| 	err = dl_argv_parse_put(nlh, dl, DL_OPT_HANDLE_REGION |
 | |
| 				DL_OPT_REGION_ADDRESS | DL_OPT_REGION_LENGTH |
 | |
| 				DL_OPT_REGION_SNAPSHOT_ID, 0);
 | |
| 	if (err)
 | |
| 		return err;
 | |
| 
 | |
| 	pr_out_section_start(dl, "read");
 | |
| 	err = _mnlg_socket_sndrcv(dl->nlg, nlh, cmd_region_read_cb, dl);
 | |
| 	pr_out_section_end(dl);
 | |
| 	if (!dl->json_output)
 | |
| 		pr_out("\n");
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static void cmd_region_help(void)
 | |
| {
 | |
| 	pr_err("Usage: devlink region show [ DEV/REGION ]\n");
 | |
| 	pr_err("       devlink region del DEV/REGION snapshot SNAPSHOT_ID\n");
 | |
| 	pr_err("       devlink region dump DEV/REGION [ snapshot SNAPSHOT_ID ]\n");
 | |
| 	pr_err("       devlink region read DEV/REGION [ snapshot SNAPSHOT_ID ] address ADDRESS length LENGTH\n");
 | |
| }
 | |
| 
 | |
| static int cmd_region(struct dl *dl)
 | |
| {
 | |
| 	if (dl_no_arg(dl)) {
 | |
| 		return cmd_region_show(dl);
 | |
| 	} else if (dl_argv_match(dl, "help")) {
 | |
| 		cmd_region_help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "show")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_region_show(dl);
 | |
| 	} else if (dl_argv_match(dl, "del")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_region_snapshot_del(dl);
 | |
| 	} else if (dl_argv_match(dl, "dump")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_region_dump(dl);
 | |
| 	} else if (dl_argv_match(dl, "read")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_region_read(dl);
 | |
| 	}
 | |
| 	pr_err("Command \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static void help(void)
 | |
| {
 | |
| 	pr_err("Usage: devlink [ OPTIONS ] OBJECT { COMMAND | help }\n"
 | |
| 	       "       devlink [ -f[orce] ] -b[atch] filename\n"
 | |
| 	       "where  OBJECT := { dev | port | sb | monitor | dpipe | resource | region }\n"
 | |
| 	       "       OPTIONS := { -V[ersion] | -n[o-nice-names] | -j[son] | -p[retty] | -v[erbose] }\n");
 | |
| }
 | |
| 
 | |
| static int dl_cmd(struct dl *dl, int argc, char **argv)
 | |
| {
 | |
| 	dl->argc = argc;
 | |
| 	dl->argv = argv;
 | |
| 
 | |
| 	if (dl_argv_match(dl, "help") || dl_no_arg(dl)) {
 | |
| 		help();
 | |
| 		return 0;
 | |
| 	} else if (dl_argv_match(dl, "dev")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dev(dl);
 | |
| 	} else if (dl_argv_match(dl, "port")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_port(dl);
 | |
| 	} else if (dl_argv_match(dl, "sb")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_sb(dl);
 | |
| 	} else if (dl_argv_match(dl, "monitor")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_mon(dl);
 | |
| 	} else if (dl_argv_match(dl, "dpipe")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_dpipe(dl);
 | |
| 	} else if (dl_argv_match(dl, "resource")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_resource(dl);
 | |
| 	} else if (dl_argv_match(dl, "region")) {
 | |
| 		dl_arg_inc(dl);
 | |
| 		return cmd_region(dl);
 | |
| 	}
 | |
| 	pr_err("Object \"%s\" not found\n", dl_argv(dl));
 | |
| 	return -ENOENT;
 | |
| }
 | |
| 
 | |
| static int dl_init(struct dl *dl)
 | |
| {
 | |
| 	int err;
 | |
| 
 | |
| 	dl->nlg = mnlg_socket_open(DEVLINK_GENL_NAME, DEVLINK_GENL_VERSION);
 | |
| 	if (!dl->nlg) {
 | |
| 		pr_err("Failed to connect to devlink Netlink\n");
 | |
| 		return -errno;
 | |
| 	}
 | |
| 
 | |
| 	err = ifname_map_init(dl);
 | |
| 	if (err) {
 | |
| 		pr_err("Failed to create index map\n");
 | |
| 		goto err_ifname_map_create;
 | |
| 	}
 | |
| 	if (dl->json_output) {
 | |
| 		dl->jw = jsonw_new(stdout);
 | |
| 		if (!dl->jw) {
 | |
| 			pr_err("Failed to create JSON writer\n");
 | |
| 			goto err_json_new;
 | |
| 		}
 | |
| 		jsonw_pretty(dl->jw, dl->pretty_output);
 | |
| 	}
 | |
| 	return 0;
 | |
| 
 | |
| err_json_new:
 | |
| 	ifname_map_fini(dl);
 | |
| err_ifname_map_create:
 | |
| 	mnlg_socket_close(dl->nlg);
 | |
| 	return err;
 | |
| }
 | |
| 
 | |
| static void dl_fini(struct dl *dl)
 | |
| {
 | |
| 	if (dl->json_output)
 | |
| 		jsonw_destroy(&dl->jw);
 | |
| 	ifname_map_fini(dl);
 | |
| 	mnlg_socket_close(dl->nlg);
 | |
| }
 | |
| 
 | |
| static struct dl *dl_alloc(void)
 | |
| {
 | |
| 	struct dl *dl;
 | |
| 
 | |
| 	dl = calloc(1, sizeof(*dl));
 | |
| 	if (!dl)
 | |
| 		return NULL;
 | |
| 	return dl;
 | |
| }
 | |
| 
 | |
| static void dl_free(struct dl *dl)
 | |
| {
 | |
| 	free(dl);
 | |
| }
 | |
| 
 | |
| static int dl_batch(struct dl *dl, const char *name, bool force)
 | |
| {
 | |
| 	char *line = NULL;
 | |
| 	size_t len = 0;
 | |
| 	int ret = EXIT_SUCCESS;
 | |
| 
 | |
| 	if (name && strcmp(name, "-") != 0) {
 | |
| 		if (freopen(name, "r", stdin) == NULL) {
 | |
| 			fprintf(stderr,
 | |
| 				"Cannot open file \"%s\" for reading: %s\n",
 | |
| 				name, strerror(errno));
 | |
| 			return EXIT_FAILURE;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	cmdlineno = 0;
 | |
| 	while (getcmdline(&line, &len, stdin) != -1) {
 | |
| 		char *largv[100];
 | |
| 		int largc;
 | |
| 
 | |
| 		largc = makeargs(line, largv, 100);
 | |
| 		if (!largc)
 | |
| 			continue;	/* blank line */
 | |
| 
 | |
| 		if (dl_cmd(dl, largc, largv)) {
 | |
| 			fprintf(stderr, "Command failed %s:%d\n",
 | |
| 				name, cmdlineno);
 | |
| 			ret = EXIT_FAILURE;
 | |
| 			if (!force)
 | |
| 				break;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	if (line)
 | |
| 		free(line);
 | |
| 
 | |
| 	return ret;
 | |
| }
 | |
| 
 | |
| int main(int argc, char **argv)
 | |
| {
 | |
| 	static const struct option long_options[] = {
 | |
| 		{ "Version",		no_argument,		NULL, 'V' },
 | |
| 		{ "force",		no_argument,		NULL, 'f' },
 | |
| 		{ "batch",		required_argument,	NULL, 'b' },
 | |
| 		{ "no-nice-names",	no_argument,		NULL, 'n' },
 | |
| 		{ "json",		no_argument,		NULL, 'j' },
 | |
| 		{ "pretty",		no_argument,		NULL, 'p' },
 | |
| 		{ "verbose",		no_argument,		NULL, 'v' },
 | |
| 		{ NULL, 0, NULL, 0 }
 | |
| 	};
 | |
| 	const char *batch_file = NULL;
 | |
| 	bool force = false;
 | |
| 	struct dl *dl;
 | |
| 	int opt;
 | |
| 	int err;
 | |
| 	int ret;
 | |
| 
 | |
| 	dl = dl_alloc();
 | |
| 	if (!dl) {
 | |
| 		pr_err("Failed to allocate memory for devlink\n");
 | |
| 		return EXIT_FAILURE;
 | |
| 	}
 | |
| 
 | |
| 	while ((opt = getopt_long(argc, argv, "Vfb:njpv",
 | |
| 				  long_options, NULL)) >= 0) {
 | |
| 
 | |
| 		switch (opt) {
 | |
| 		case 'V':
 | |
| 			printf("devlink utility, iproute2-ss%s\n", SNAPSHOT);
 | |
| 			ret = EXIT_SUCCESS;
 | |
| 			goto dl_free;
 | |
| 		case 'f':
 | |
| 			force = true;
 | |
| 			break;
 | |
| 		case 'b':
 | |
| 			batch_file = optarg;
 | |
| 			break;
 | |
| 		case 'n':
 | |
| 			dl->no_nice_names = true;
 | |
| 			break;
 | |
| 		case 'j':
 | |
| 			dl->json_output = true;
 | |
| 			break;
 | |
| 		case 'p':
 | |
| 			dl->pretty_output = true;
 | |
| 			break;
 | |
| 		case 'v':
 | |
| 			dl->verbose = true;
 | |
| 			break;
 | |
| 		default:
 | |
| 			pr_err("Unknown option.\n");
 | |
| 			help();
 | |
| 			ret = EXIT_FAILURE;
 | |
| 			goto dl_free;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	argc -= optind;
 | |
| 	argv += optind;
 | |
| 
 | |
| 	err = dl_init(dl);
 | |
| 	if (err) {
 | |
| 		ret = EXIT_FAILURE;
 | |
| 		goto dl_free;
 | |
| 	}
 | |
| 
 | |
| 	if (batch_file)
 | |
| 		err = dl_batch(dl, batch_file, force);
 | |
| 	else
 | |
| 		err = dl_cmd(dl, argc, argv);
 | |
| 
 | |
| 	if (err) {
 | |
| 		ret = EXIT_FAILURE;
 | |
| 		goto dl_fini;
 | |
| 	}
 | |
| 
 | |
| 	ret = EXIT_SUCCESS;
 | |
| 
 | |
| dl_fini:
 | |
| 	dl_fini(dl);
 | |
| dl_free:
 | |
| 	dl_free(dl);
 | |
| 
 | |
| 	return ret;
 | |
| }
 | 
