[linux-2.6-block.git] / drivers / net / dsa / sja1105 / sja1105_devlink.c

// SPDX-License-Identifier: GPL-2.0
/* Copyright (c) 2018-2019, Vladimir Oltean <olteanv@gmail.com>
 * Copyright 2020 NXP Semiconductors
 */
#include "sja1105.h"

/* Since devlink regions have a fixed size and the static config has a variable
 * size, we need to calculate the maximum possible static config size by
 * creating a dummy config with all table entries populated to the max, and get
 * its packed length. This is done dynamically as opposed to simply hardcoding
 * a number, since currently not all static config tables are implemented, so
 * we are avoiding a possible code desynchronization.
 */
static size_t sja1105_static_config_get_max_size(struct sja1105_private *priv)
{
	struct sja1105_static_config config;
	enum sja1105_blk_idx blk_idx;
	int rc;

	rc = sja1105_static_config_init(&config,
					priv->info->static_ops,
					priv->info->device_id);
	if (rc)
		return 0;

	for (blk_idx = 0; blk_idx < BLK_IDX_MAX; blk_idx++) {
		struct sja1105_table *table = &config.tables[blk_idx];

		table->entry_count = table->ops->max_entry_count;
	}

	return sja1105_static_config_get_length(&config);
}

static int
sja1105_region_static_config_snapshot(struct devlink *dl,
				      const struct devlink_region_ops *ops,
				      struct netlink_ext_ack *extack,
				      u8 **data)
{
	struct dsa_switch *ds = dsa_devlink_to_ds(dl);
	struct sja1105_private *priv = ds->priv;
	size_t max_len, len;

	len = sja1105_static_config_get_length(&priv->static_config);
	max_len = sja1105_static_config_get_max_size(priv);

	*data = kcalloc(max_len, sizeof(u8), GFP_KERNEL);
	if (!*data)
		return -ENOMEM;

	return static_config_buf_prepare_for_upload(priv, *data, len);
}

static struct devlink_region_ops sja1105_region_static_config_ops = {
	.name = "static-config",
	.snapshot = sja1105_region_static_config_snapshot,
	.destructor = kfree,
};

enum sja1105_region_id {
	SJA1105_REGION_STATIC_CONFIG = 0,
};

struct sja1105_region {
	const struct devlink_region_ops *ops;
	size_t (*get_size)(struct sja1105_private *priv);
};

static struct sja1105_region sja1105_regions[] = {
	[SJA1105_REGION_STATIC_CONFIG] = {
		.ops = &sja1105_region_static_config_ops,
		.get_size = sja1105_static_config_get_max_size,
	},
};

static int sja1105_setup_devlink_regions(struct dsa_switch *ds)
{
	int i, num_regions = ARRAY_SIZE(sja1105_regions);
	struct sja1105_private *priv = ds->priv;
	const struct devlink_region_ops *ops;
	struct devlink_region *region;
	u64 size;

	priv->regions = kcalloc(num_regions, sizeof(struct devlink_region *),
				GFP_KERNEL);
	if (!priv->regions)
		return -ENOMEM;

	for (i = 0; i < num_regions; i++) {
		size = sja1105_regions[i].get_size(priv);
		ops = sja1105_regions[i].ops;

		region = dsa_devlink_region_create(ds, ops, 1, size);
		if (IS_ERR(region)) {
			while (i-- >= 0)
				dsa_devlink_region_destroy(priv->regions[i]);
			return PTR_ERR(region);
		}

		priv->regions[i] = region;
	}

	return 0;
}

static void sja1105_teardown_devlink_regions(struct dsa_switch *ds)
{
	int i, num_regions = ARRAY_SIZE(sja1105_regions);
	struct sja1105_private *priv = ds->priv;

	for (i = 0; i < num_regions; i++)
		dsa_devlink_region_destroy(priv->regions[i]);

	kfree(priv->regions);
}

static int sja1105_best_effort_vlan_filtering_get(struct sja1105_private *priv,
						  bool *be_vlan)
{
	*be_vlan = priv->best_effort_vlan_filtering;

	return 0;
}

static int sja1105_best_effort_vlan_filtering_set(struct sja1105_private *priv,
						  bool be_vlan)
{
	struct dsa_switch *ds = priv->ds;
	bool vlan_filtering;
	int port;
	int rc;

	priv->best_effort_vlan_filtering = be_vlan;

	rtnl_lock();
	for (port = 0; port < ds->num_ports; port++) {
		struct dsa_port *dp;

		if (!dsa_is_user_port(ds, port))
			continue;

		dp = dsa_to_port(ds, port);
		vlan_filtering = dsa_port_is_vlan_filtering(dp);

		rc = sja1105_vlan_filtering(ds, port, vlan_filtering, NULL);
		if (rc)
			break;
	}
	rtnl_unlock();

	return rc;
}

enum sja1105_devlink_param_id {
	SJA1105_DEVLINK_PARAM_ID_BASE = DEVLINK_PARAM_GENERIC_ID_MAX,
	SJA1105_DEVLINK_PARAM_ID_BEST_EFFORT_VLAN_FILTERING,
};

int sja1105_devlink_param_get(struct dsa_switch *ds, u32 id,
			      struct devlink_param_gset_ctx *ctx)
{
	struct sja1105_private *priv = ds->priv;
	int err;

	switch (id) {
	case SJA1105_DEVLINK_PARAM_ID_BEST_EFFORT_VLAN_FILTERING:
		err = sja1105_best_effort_vlan_filtering_get(priv,
							     &ctx->val.vbool);
		break;
	default:
		err = -EOPNOTSUPP;
		break;
	}

	return err;
}

int sja1105_devlink_param_set(struct dsa_switch *ds, u32 id,
			      struct devlink_param_gset_ctx *ctx)
{
	struct sja1105_private *priv = ds->priv;
	int err;

	switch (id) {
	case SJA1105_DEVLINK_PARAM_ID_BEST_EFFORT_VLAN_FILTERING:
		err = sja1105_best_effort_vlan_filtering_set(priv,
							     ctx->val.vbool);
		break;
	default:
		err = -EOPNOTSUPP;
		break;
	}

	return err;
}

static const struct devlink_param sja1105_devlink_params[] = {
	DSA_DEVLINK_PARAM_DRIVER(SJA1105_DEVLINK_PARAM_ID_BEST_EFFORT_VLAN_FILTERING,
				 "best_effort_vlan_filtering",
				 DEVLINK_PARAM_TYPE_BOOL,
				 BIT(DEVLINK_PARAM_CMODE_RUNTIME)),
};

static int sja1105_setup_devlink_params(struct dsa_switch *ds)
{
	return dsa_devlink_params_register(ds, sja1105_devlink_params,
					   ARRAY_SIZE(sja1105_devlink_params));
}

static void sja1105_teardown_devlink_params(struct dsa_switch *ds)
{
	dsa_devlink_params_unregister(ds, sja1105_devlink_params,
				      ARRAY_SIZE(sja1105_devlink_params));
}

int sja1105_devlink_info_get(struct dsa_switch *ds,
			     struct devlink_info_req *req,
			     struct netlink_ext_ack *extack)
{
	struct sja1105_private *priv = ds->priv;
	int rc;

	rc = devlink_info_driver_name_put(req, "sja1105");
	if (rc)
		return rc;

	rc = devlink_info_version_fixed_put(req,
					    DEVLINK_INFO_VERSION_GENERIC_ASIC_ID,
					    priv->info->name);
	return rc;
}

int sja1105_devlink_setup(struct dsa_switch *ds)
{
	int rc;

	rc = sja1105_setup_devlink_params(ds);
	if (rc)
		return rc;

	rc = sja1105_setup_devlink_regions(ds);
	if (rc < 0) {
		sja1105_teardown_devlink_params(ds);
		return rc;
	}

	return 0;
}

void sja1105_devlink_teardown(struct dsa_switch *ds)
{
	sja1105_teardown_devlink_params(ds);
	sja1105_teardown_devlink_regions(ds);
}
Commit	Line	Data
0a7bdbc2 VO	1	// SPDX-License-Identifier: GPL-2.0
0a7bdbc2 VO	2	/* Copyright (c) 2018-2019, Vladimir Oltean <olteanv@gmail.com>
bf425b82	3	* Copyright 2020 NXP Semiconductors
0a7bdbc2 VO	4	*/
	5	#include "sja1105.h"
	6
bf425b82 VO	7	/* Since devlink regions have a fixed size and the static config has a variable
	8	* size, we need to calculate the maximum possible static config size by
	9	* creating a dummy config with all table entries populated to the max, and get
	10	* its packed length. This is done dynamically as opposed to simply hardcoding
	11	* a number, since currently not all static config tables are implemented, so
	12	* we are avoiding a possible code desynchronization.
	13	*/
	14	static size_t sja1105_static_config_get_max_size(struct sja1105_private *priv)
	15	{
	16	struct sja1105_static_config config;
	17	enum sja1105_blk_idx blk_idx;
	18	int rc;
	19
	20	rc = sja1105_static_config_init(&config,
	21	priv->info->static_ops,
	22	priv->info->device_id);
	23	if (rc)
	24	return 0;
	25
	26	for (blk_idx = 0; blk_idx < BLK_IDX_MAX; blk_idx++) {
	27	struct sja1105_table *table = &config.tables[blk_idx];
	28
	29	table->entry_count = table->ops->max_entry_count;
	30	}
	31
	32	return sja1105_static_config_get_length(&config);
	33	}
	34
	35	static int
	36	sja1105_region_static_config_snapshot(struct devlink *dl,
	37	const struct devlink_region_ops *ops,
	38	struct netlink_ext_ack *extack,
	39	u8 **data)
	40	{
	41	struct dsa_switch *ds = dsa_devlink_to_ds(dl);
	42	struct sja1105_private *priv = ds->priv;
	43	size_t max_len, len;
	44
	45	len = sja1105_static_config_get_length(&priv->static_config);
	46	max_len = sja1105_static_config_get_max_size(priv);
	47
	48	*data = kcalloc(max_len, sizeof(u8), GFP_KERNEL);
	49	if (!*data)
	50	return -ENOMEM;
	51
	52	return static_config_buf_prepare_for_upload(priv, *data, len);
	53	}
	54
	55	static struct devlink_region_ops sja1105_region_static_config_ops = {
	56	.name = "static-config",
	57	.snapshot = sja1105_region_static_config_snapshot,
	58	.destructor = kfree,
	59	};
	60
	61	enum sja1105_region_id {
	62	SJA1105_REGION_STATIC_CONFIG = 0,
	63	};
	64
	65	struct sja1105_region {
	66	const struct devlink_region_ops *ops;
	67	size_t (get_size)(struct sja1105_private priv);
	68	};
	69
	70	static struct sja1105_region sja1105_regions[] = {
71	[SJA1105_REGION_STATIC_CONFIG] = {
72	.ops = &sja1105_region_static_config_ops,
73	.get_size = sja1105_static_config_get_max_size,
74	},
75	};
76
77	static int sja1105_setup_devlink_regions(struct dsa_switch *ds)
78	{
79	int i, num_regions = ARRAY_SIZE(sja1105_regions);
80	struct sja1105_private *priv = ds->priv;
81	const struct devlink_region_ops *ops;
82	struct devlink_region *region;
83	u64 size;
84
85	priv->regions = kcalloc(num_regions, sizeof(struct devlink_region *),
86	GFP_KERNEL);
87	if (!priv->regions)
88	return -ENOMEM;
89
90	for (i = 0; i < num_regions; i++) {
91	size = sja1105_regions[i].get_size(priv);
92	ops = sja1105_regions[i].ops;
93
94	region = dsa_devlink_region_create(ds, ops, 1, size);
95	if (IS_ERR(region)) {
96	while (i-- >= 0)
97	dsa_devlink_region_destroy(priv->regions[i]);
98	return PTR_ERR(region);
99	}
100
101	priv->regions[i] = region;
102	}
103
104	return 0;
105	}
106
107	static void sja1105_teardown_devlink_regions(struct dsa_switch *ds)
108	{
109	int i, num_regions = ARRAY_SIZE(sja1105_regions);
110	struct sja1105_private *priv = ds->priv;
111
112	for (i = 0; i < num_regions; i++)
113	dsa_devlink_region_destroy(priv->regions[i]);
114
115	kfree(priv->regions);
116	}
117
0a7bdbc2 VO	118	static int sja1105_best_effort_vlan_filtering_get(struct sja1105_private *priv,
	119	bool *be_vlan)
	120	{
	121	*be_vlan = priv->best_effort_vlan_filtering;
	122
	123	return 0;
	124	}
	125
	126	static int sja1105_best_effort_vlan_filtering_set(struct sja1105_private *priv,
	127	bool be_vlan)
	128	{
	129	struct dsa_switch *ds = priv->ds;
	130	bool vlan_filtering;
	131	int port;
	132	int rc;
	133
	134	priv->best_effort_vlan_filtering = be_vlan;
	135
	136	rtnl_lock();
	137	for (port = 0; port < ds->num_ports; port++) {
	138	struct dsa_port *dp;
	139
	140	if (!dsa_is_user_port(ds, port))
	141	continue;
	142
	143	dp = dsa_to_port(ds, port);
	144	vlan_filtering = dsa_port_is_vlan_filtering(dp);
	145
89153ed6	146	rc = sja1105_vlan_filtering(ds, port, vlan_filtering, NULL);
0a7bdbc2 VO	147	if (rc)
	148	break;
	149	}
	150	rtnl_unlock();
	151
	152	return rc;
	153	}
	154
	155	enum sja1105_devlink_param_id {
	156	SJA1105_DEVLINK_PARAM_ID_BASE = DEVLINK_PARAM_GENERIC_ID_MAX,
	157	SJA1105_DEVLINK_PARAM_ID_BEST_EFFORT_VLAN_FILTERING,
	158	};
	159
	160	int sja1105_devlink_param_get(struct dsa_switch *ds, u32 id,
	161	struct devlink_param_gset_ctx *ctx)
	162	{
	163	struct sja1105_private *priv = ds->priv;
	164	int err;
	165
	166	switch (id) {
	167	case SJA1105_DEVLINK_PARAM_ID_BEST_EFFORT_VLAN_FILTERING:
	168	err = sja1105_best_effort_vlan_filtering_get(priv,
	169	&ctx->val.vbool);
	170	break;
	171	default:
	172	err = -EOPNOTSUPP;
	173	break;
	174	}
	175
	176	return err;
	177	}
	178
	179	int sja1105_devlink_param_set(struct dsa_switch *ds, u32 id,
	180	struct devlink_param_gset_ctx *ctx)
	181	{
	182	struct sja1105_private *priv = ds->priv;
	183	int err;
	184
	185	switch (id) {
	186	case SJA1105_DEVLINK_PARAM_ID_BEST_EFFORT_VLAN_FILTERING:
	187	err = sja1105_best_effort_vlan_filtering_set(priv,
	188	ctx->val.vbool);
	189	break;
	190	default:
	191	err = -EOPNOTSUPP;
	192	break;
	193	}
	194
	195	return err;
	196	}
	197
	198	static const struct devlink_param sja1105_devlink_params[] = {
	199	DSA_DEVLINK_PARAM_DRIVER(SJA1105_DEVLINK_PARAM_ID_BEST_EFFORT_VLAN_FILTERING,
	200	"best_effort_vlan_filtering",
	201	DEVLINK_PARAM_TYPE_BOOL,
	202	BIT(DEVLINK_PARAM_CMODE_RUNTIME)),
	203	};
	204
	205	static int sja1105_setup_devlink_params(struct dsa_switch *ds)
	206	{
	207	return dsa_devlink_params_register(ds, sja1105_devlink_params,
	208	ARRAY_SIZE(sja1105_devlink_params));
	209	}
	210
211	static void sja1105_teardown_devlink_params(struct dsa_switch *ds)
212	{
213	dsa_devlink_params_unregister(ds, sja1105_devlink_params,
214	ARRAY_SIZE(sja1105_devlink_params));
215	}
216
ff4cf8ea VO	217	int sja1105_devlink_info_get(struct dsa_switch *ds,
	218	struct devlink_info_req *req,
	219	struct netlink_ext_ack *extack)
	220	{
	221	struct sja1105_private *priv = ds->priv;
	222	int rc;
	223
	224	rc = devlink_info_driver_name_put(req, "sja1105");
	225	if (rc)
	226	return rc;
	227
	228	rc = devlink_info_version_fixed_put(req,
	229	DEVLINK_INFO_VERSION_GENERIC_ASIC_ID,
	230	priv->info->name);
	231	return rc;
	232	}
	233
0a7bdbc2 VO	234	int sja1105_devlink_setup(struct dsa_switch *ds)
	235	{
	236	int rc;
	237
	238	rc = sja1105_setup_devlink_params(ds);
	239	if (rc)
	240	return rc;
	241
bf425b82 VO	242	rc = sja1105_setup_devlink_regions(ds);
	243	if (rc < 0) {
	244	sja1105_teardown_devlink_params(ds);
	245	return rc;
	246	}
	247
0a7bdbc2 VO	248	return 0;
	249	}
	250
	251	void sja1105_devlink_teardown(struct dsa_switch *ds)
	252	{
	253	sja1105_teardown_devlink_params(ds);
bf425b82	254	sja1105_teardown_devlink_regions(ds);
0a7bdbc2	255	}