1// SPDX-License-Identifier: GPL-2.0
2/* Copyright (c) 2018-2019, Vladimir Oltean <olteanv@gmail.com>
3 * Copyright 2020 NXP Semiconductors
4 */
5#include "sja1105.h"
6
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 */
14static 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
35static int
36sja1105_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
55static 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
61enum sja1105_region_id {
62	SJA1105_REGION_STATIC_CONFIG = 0,
63};
64
65struct sja1105_region {
66	const struct devlink_region_ops *ops;
67	size_t (*get_size)(struct sja1105_private *priv);
68};
69
70static 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
77static 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
99			kfree(priv->regions);
100			return PTR_ERR(region);
101		}
102
103		priv->regions[i] = region;
104	}
105
106	return 0;
107}
108
109static void sja1105_teardown_devlink_regions(struct dsa_switch *ds)
110{
111	int i, num_regions = ARRAY_SIZE(sja1105_regions);
112	struct sja1105_private *priv = ds->priv;
113
114	for (i = 0; i < num_regions; i++)
115		dsa_devlink_region_destroy(priv->regions[i]);
116
117	kfree(priv->regions);
118}
119
120static int sja1105_best_effort_vlan_filtering_get(struct sja1105_private *priv,
121						  bool *be_vlan)
122{
123	*be_vlan = priv->best_effort_vlan_filtering;
124
125	return 0;
126}
127
128static int sja1105_best_effort_vlan_filtering_set(struct sja1105_private *priv,
129						  bool be_vlan)
130{
131	struct dsa_switch *ds = priv->ds;
132	bool vlan_filtering;
133	int port;
134	int rc;
135
136	priv->best_effort_vlan_filtering = be_vlan;
137
138	rtnl_lock();
139	for (port = 0; port < ds->num_ports; port++) {
140		struct switchdev_trans trans;
141		struct dsa_port *dp;
142
143		if (!dsa_is_user_port(ds, port))
144			continue;
145
146		dp = dsa_to_port(ds, port);
147		vlan_filtering = dsa_port_is_vlan_filtering(dp);
148
149		trans.ph_prepare = true;
150		rc = sja1105_vlan_filtering(ds, port, vlan_filtering, &trans);
151		if (rc)
152			break;
153
154		trans.ph_prepare = false;
155		rc = sja1105_vlan_filtering(ds, port, vlan_filtering, &trans);
156		if (rc)
157			break;
158	}
159	rtnl_unlock();
160
161	return rc;
162}
163
164enum sja1105_devlink_param_id {
165	SJA1105_DEVLINK_PARAM_ID_BASE = DEVLINK_PARAM_GENERIC_ID_MAX,
166	SJA1105_DEVLINK_PARAM_ID_BEST_EFFORT_VLAN_FILTERING,
167};
168
169int sja1105_devlink_param_get(struct dsa_switch *ds, u32 id,
170			      struct devlink_param_gset_ctx *ctx)
171{
172	struct sja1105_private *priv = ds->priv;
173	int err;
174
175	switch (id) {
176	case SJA1105_DEVLINK_PARAM_ID_BEST_EFFORT_VLAN_FILTERING:
177		err = sja1105_best_effort_vlan_filtering_get(priv,
178							     &ctx->val.vbool);
179		break;
180	default:
181		err = -EOPNOTSUPP;
182		break;
183	}
184
185	return err;
186}
187
188int sja1105_devlink_param_set(struct dsa_switch *ds, u32 id,
189			      struct devlink_param_gset_ctx *ctx)
190{
191	struct sja1105_private *priv = ds->priv;
192	int err;
193
194	switch (id) {
195	case SJA1105_DEVLINK_PARAM_ID_BEST_EFFORT_VLAN_FILTERING:
196		err = sja1105_best_effort_vlan_filtering_set(priv,
197							     ctx->val.vbool);
198		break;
199	default:
200		err = -EOPNOTSUPP;
201		break;
202	}
203
204	return err;
205}
206
207static const struct devlink_param sja1105_devlink_params[] = {
208	DSA_DEVLINK_PARAM_DRIVER(SJA1105_DEVLINK_PARAM_ID_BEST_EFFORT_VLAN_FILTERING,
209				 "best_effort_vlan_filtering",
210				 DEVLINK_PARAM_TYPE_BOOL,
211				 BIT(DEVLINK_PARAM_CMODE_RUNTIME)),
212};
213
214static int sja1105_setup_devlink_params(struct dsa_switch *ds)
215{
216	return dsa_devlink_params_register(ds, sja1105_devlink_params,
217					   ARRAY_SIZE(sja1105_devlink_params));
218}
219
220static void sja1105_teardown_devlink_params(struct dsa_switch *ds)
221{
222	dsa_devlink_params_unregister(ds, sja1105_devlink_params,
223				      ARRAY_SIZE(sja1105_devlink_params));
224}
225
226int sja1105_devlink_info_get(struct dsa_switch *ds,
227			     struct devlink_info_req *req,
228			     struct netlink_ext_ack *extack)
229{
230	struct sja1105_private *priv = ds->priv;
231	int rc;
232
233	rc = devlink_info_driver_name_put(req, "sja1105");
234	if (rc)
235		return rc;
236
237	rc = devlink_info_version_fixed_put(req,
238					    DEVLINK_INFO_VERSION_GENERIC_ASIC_ID,
239					    priv->info->name);
240	return rc;
241}
242
243int sja1105_devlink_setup(struct dsa_switch *ds)
244{
245	int rc;
246
247	rc = sja1105_setup_devlink_params(ds);
248	if (rc)
249		return rc;
250
251	rc = sja1105_setup_devlink_regions(ds);
252	if (rc < 0) {
253		sja1105_teardown_devlink_params(ds);
254		return rc;
255	}
256
257	return 0;
258}
259
260void sja1105_devlink_teardown(struct dsa_switch *ds)
261{
262	sja1105_teardown_devlink_params(ds);
263	sja1105_teardown_devlink_regions(ds);
264}
265