1 // SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
2 /* Copyright (C) 2017-2018 Netronome Systems, Inc. */
3 
4 #include <linux/rtnetlink.h>
5 #include <net/devlink.h>
6 
7 #include "nfpcore/nfp.h"
8 #include "nfpcore/nfp_nsp.h"
9 #include "nfp_app.h"
10 #include "nfp_main.h"
11 #include "nfp_port.h"
12 
13 static int
nfp_devlink_fill_eth_port(struct nfp_port * port,struct nfp_eth_table_port * copy)14 nfp_devlink_fill_eth_port(struct nfp_port *port,
15 			  struct nfp_eth_table_port *copy)
16 {
17 	struct nfp_eth_table_port *eth_port;
18 
19 	eth_port = __nfp_port_get_eth_port(port);
20 	if (!eth_port)
21 		return -EINVAL;
22 
23 	memcpy(copy, eth_port, sizeof(*eth_port));
24 
25 	return 0;
26 }
27 
28 static int
nfp_devlink_fill_eth_port_from_id(struct nfp_pf * pf,struct devlink_port * dl_port,struct nfp_eth_table_port * copy)29 nfp_devlink_fill_eth_port_from_id(struct nfp_pf *pf,
30 				  struct devlink_port *dl_port,
31 				  struct nfp_eth_table_port *copy)
32 {
33 	struct nfp_port *port = container_of(dl_port, struct nfp_port, dl_port);
34 
35 	return nfp_devlink_fill_eth_port(port, copy);
36 }
37 
38 static int
nfp_devlink_set_lanes(struct nfp_pf * pf,unsigned int idx,unsigned int lanes)39 nfp_devlink_set_lanes(struct nfp_pf *pf, unsigned int idx, unsigned int lanes)
40 {
41 	struct nfp_nsp *nsp;
42 	int ret;
43 
44 	nsp = nfp_eth_config_start(pf->cpp, idx);
45 	if (IS_ERR(nsp))
46 		return PTR_ERR(nsp);
47 
48 	ret = __nfp_eth_set_split(nsp, lanes);
49 	if (ret) {
50 		nfp_eth_config_cleanup_end(nsp);
51 		return ret;
52 	}
53 
54 	ret = nfp_eth_config_commit_end(nsp);
55 	if (ret < 0)
56 		return ret;
57 	if (ret) /* no change */
58 		return 0;
59 
60 	return nfp_net_refresh_port_table_sync(pf);
61 }
62 
63 static int
nfp_devlink_port_split(struct devlink * devlink,struct devlink_port * port,unsigned int count,struct netlink_ext_ack * extack)64 nfp_devlink_port_split(struct devlink *devlink, struct devlink_port *port,
65 		       unsigned int count, struct netlink_ext_ack *extack)
66 {
67 	struct nfp_pf *pf = devlink_priv(devlink);
68 	struct nfp_eth_table_port eth_port;
69 	unsigned int lanes;
70 	int ret;
71 
72 	rtnl_lock();
73 	ret = nfp_devlink_fill_eth_port_from_id(pf, port, &eth_port);
74 	rtnl_unlock();
75 	if (ret)
76 		return ret;
77 
78 	if (eth_port.port_lanes % count)
79 		return -EINVAL;
80 
81 	/* Special case the 100G CXP -> 2x40G split */
82 	lanes = eth_port.port_lanes / count;
83 	if (eth_port.lanes == 10 && count == 2)
84 		lanes = 8 / count;
85 
86 	return nfp_devlink_set_lanes(pf, eth_port.index, lanes);
87 }
88 
89 static int
nfp_devlink_port_unsplit(struct devlink * devlink,struct devlink_port * port,struct netlink_ext_ack * extack)90 nfp_devlink_port_unsplit(struct devlink *devlink, struct devlink_port *port,
91 			 struct netlink_ext_ack *extack)
92 {
93 	struct nfp_pf *pf = devlink_priv(devlink);
94 	struct nfp_eth_table_port eth_port;
95 	unsigned int lanes;
96 	int ret;
97 
98 	rtnl_lock();
99 	ret = nfp_devlink_fill_eth_port_from_id(pf, port, &eth_port);
100 	rtnl_unlock();
101 	if (ret)
102 		return ret;
103 
104 	if (!eth_port.is_split)
105 		return -EINVAL;
106 
107 	/* Special case the 100G CXP -> 2x40G unsplit */
108 	lanes = eth_port.port_lanes;
109 	if (eth_port.port_lanes == 8)
110 		lanes = 10;
111 
112 	return nfp_devlink_set_lanes(pf, eth_port.index, lanes);
113 }
114 
115 static int
nfp_devlink_sb_pool_get(struct devlink * devlink,unsigned int sb_index,u16 pool_index,struct devlink_sb_pool_info * pool_info)116 nfp_devlink_sb_pool_get(struct devlink *devlink, unsigned int sb_index,
117 			u16 pool_index, struct devlink_sb_pool_info *pool_info)
118 {
119 	struct nfp_pf *pf = devlink_priv(devlink);
120 
121 	return nfp_shared_buf_pool_get(pf, sb_index, pool_index, pool_info);
122 }
123 
124 static int
nfp_devlink_sb_pool_set(struct devlink * devlink,unsigned int sb_index,u16 pool_index,u32 size,enum devlink_sb_threshold_type threshold_type,struct netlink_ext_ack * extack)125 nfp_devlink_sb_pool_set(struct devlink *devlink, unsigned int sb_index,
126 			u16 pool_index,
127 			u32 size, enum devlink_sb_threshold_type threshold_type,
128 			struct netlink_ext_ack *extack)
129 {
130 	struct nfp_pf *pf = devlink_priv(devlink);
131 
132 	return nfp_shared_buf_pool_set(pf, sb_index, pool_index,
133 				       size, threshold_type);
134 }
135 
nfp_devlink_eswitch_mode_get(struct devlink * devlink,u16 * mode)136 static int nfp_devlink_eswitch_mode_get(struct devlink *devlink, u16 *mode)
137 {
138 	struct nfp_pf *pf = devlink_priv(devlink);
139 
140 	return nfp_app_eswitch_mode_get(pf->app, mode);
141 }
142 
nfp_devlink_eswitch_mode_set(struct devlink * devlink,u16 mode,struct netlink_ext_ack * extack)143 static int nfp_devlink_eswitch_mode_set(struct devlink *devlink, u16 mode,
144 					struct netlink_ext_ack *extack)
145 {
146 	struct nfp_pf *pf = devlink_priv(devlink);
147 
148 	return nfp_app_eswitch_mode_set(pf->app, mode);
149 }
150 
151 static const struct nfp_devlink_versions_simple {
152 	const char *key;
153 	const char *hwinfo;
154 } nfp_devlink_versions_hwinfo[] = {
155 	{ DEVLINK_INFO_VERSION_GENERIC_BOARD_ID,	"assembly.partno", },
156 	{ DEVLINK_INFO_VERSION_GENERIC_BOARD_REV,	"assembly.revision", },
157 	{ DEVLINK_INFO_VERSION_GENERIC_BOARD_MANUFACTURE, "assembly.vendor", },
158 	{ "board.model", /* code name */		"assembly.model", },
159 };
160 
161 static int
nfp_devlink_versions_get_hwinfo(struct nfp_pf * pf,struct devlink_info_req * req)162 nfp_devlink_versions_get_hwinfo(struct nfp_pf *pf, struct devlink_info_req *req)
163 {
164 	unsigned int i;
165 	int err;
166 
167 	for (i = 0; i < ARRAY_SIZE(nfp_devlink_versions_hwinfo); i++) {
168 		const struct nfp_devlink_versions_simple *info;
169 		const char *val;
170 
171 		info = &nfp_devlink_versions_hwinfo[i];
172 
173 		val = nfp_hwinfo_lookup(pf->hwinfo, info->hwinfo);
174 		if (!val)
175 			continue;
176 
177 		err = devlink_info_version_fixed_put(req, info->key, val);
178 		if (err)
179 			return err;
180 	}
181 
182 	return 0;
183 }
184 
185 static const struct nfp_devlink_versions {
186 	enum nfp_nsp_versions id;
187 	const char *key;
188 } nfp_devlink_versions_nsp[] = {
189 	{ NFP_VERSIONS_BUNDLE,	DEVLINK_INFO_VERSION_GENERIC_FW_BUNDLE_ID, },
190 	{ NFP_VERSIONS_BSP,	DEVLINK_INFO_VERSION_GENERIC_FW_MGMT, },
191 	{ NFP_VERSIONS_CPLD,	"fw.cpld", },
192 	{ NFP_VERSIONS_APP,	DEVLINK_INFO_VERSION_GENERIC_FW_APP, },
193 	{ NFP_VERSIONS_UNDI,	DEVLINK_INFO_VERSION_GENERIC_FW_UNDI, },
194 	{ NFP_VERSIONS_NCSI,	DEVLINK_INFO_VERSION_GENERIC_FW_NCSI, },
195 	{ NFP_VERSIONS_CFGR,	"chip.init", },
196 };
197 
198 static int
nfp_devlink_versions_get_nsp(struct devlink_info_req * req,bool flash,const u8 * buf,unsigned int size)199 nfp_devlink_versions_get_nsp(struct devlink_info_req *req, bool flash,
200 			     const u8 *buf, unsigned int size)
201 {
202 	unsigned int i;
203 	int err;
204 
205 	for (i = 0; i < ARRAY_SIZE(nfp_devlink_versions_nsp); i++) {
206 		const struct nfp_devlink_versions *info;
207 		const char *version;
208 
209 		info = &nfp_devlink_versions_nsp[i];
210 
211 		version = nfp_nsp_versions_get(info->id, flash, buf, size);
212 		if (IS_ERR(version)) {
213 			if (PTR_ERR(version) == -ENOENT)
214 				continue;
215 			else
216 				return PTR_ERR(version);
217 		}
218 
219 		if (flash)
220 			err = devlink_info_version_stored_put(req, info->key,
221 							      version);
222 		else
223 			err = devlink_info_version_running_put(req, info->key,
224 							       version);
225 		if (err)
226 			return err;
227 	}
228 
229 	return 0;
230 }
231 
232 static int
nfp_devlink_info_get(struct devlink * devlink,struct devlink_info_req * req,struct netlink_ext_ack * extack)233 nfp_devlink_info_get(struct devlink *devlink, struct devlink_info_req *req,
234 		     struct netlink_ext_ack *extack)
235 {
236 	struct nfp_pf *pf = devlink_priv(devlink);
237 	const char *sn, *vendor, *part;
238 	struct nfp_nsp *nsp;
239 	char *buf = NULL;
240 	int err;
241 
242 	err = devlink_info_driver_name_put(req, "nfp");
243 	if (err)
244 		return err;
245 
246 	vendor = nfp_hwinfo_lookup(pf->hwinfo, "assembly.vendor");
247 	part = nfp_hwinfo_lookup(pf->hwinfo, "assembly.partno");
248 	sn = nfp_hwinfo_lookup(pf->hwinfo, "assembly.serial");
249 	if (vendor && part && sn) {
250 		char *buf;
251 
252 		buf = kmalloc(strlen(vendor) + strlen(part) + strlen(sn) + 1,
253 			      GFP_KERNEL);
254 		if (!buf)
255 			return -ENOMEM;
256 
257 		buf[0] = '\0';
258 		strcat(buf, vendor);
259 		strcat(buf, part);
260 		strcat(buf, sn);
261 
262 		err = devlink_info_serial_number_put(req, buf);
263 		kfree(buf);
264 		if (err)
265 			return err;
266 	}
267 
268 	nsp = nfp_nsp_open(pf->cpp);
269 	if (IS_ERR(nsp)) {
270 		NL_SET_ERR_MSG_MOD(extack, "can't access NSP");
271 		return PTR_ERR(nsp);
272 	}
273 
274 	if (nfp_nsp_has_versions(nsp)) {
275 		buf = kzalloc(NFP_NSP_VERSION_BUFSZ, GFP_KERNEL);
276 		if (!buf) {
277 			err = -ENOMEM;
278 			goto err_close_nsp;
279 		}
280 
281 		err = nfp_nsp_versions(nsp, buf, NFP_NSP_VERSION_BUFSZ);
282 		if (err)
283 			goto err_free_buf;
284 
285 		err = nfp_devlink_versions_get_nsp(req, false,
286 						   buf, NFP_NSP_VERSION_BUFSZ);
287 		if (err)
288 			goto err_free_buf;
289 
290 		err = nfp_devlink_versions_get_nsp(req, true,
291 						   buf, NFP_NSP_VERSION_BUFSZ);
292 		if (err)
293 			goto err_free_buf;
294 
295 		kfree(buf);
296 	}
297 
298 	nfp_nsp_close(nsp);
299 
300 	return nfp_devlink_versions_get_hwinfo(pf, req);
301 
302 err_free_buf:
303 	kfree(buf);
304 err_close_nsp:
305 	nfp_nsp_close(nsp);
306 	return err;
307 }
308 
309 static int
nfp_devlink_flash_update(struct devlink * devlink,struct devlink_flash_update_params * params,struct netlink_ext_ack * extack)310 nfp_devlink_flash_update(struct devlink *devlink,
311 			 struct devlink_flash_update_params *params,
312 			 struct netlink_ext_ack *extack)
313 {
314 	return nfp_flash_update_common(devlink_priv(devlink), params->fw, extack);
315 }
316 
317 const struct devlink_ops nfp_devlink_ops = {
318 	.port_split		= nfp_devlink_port_split,
319 	.port_unsplit		= nfp_devlink_port_unsplit,
320 	.sb_pool_get		= nfp_devlink_sb_pool_get,
321 	.sb_pool_set		= nfp_devlink_sb_pool_set,
322 	.eswitch_mode_get	= nfp_devlink_eswitch_mode_get,
323 	.eswitch_mode_set	= nfp_devlink_eswitch_mode_set,
324 	.info_get		= nfp_devlink_info_get,
325 	.flash_update		= nfp_devlink_flash_update,
326 };
327 
nfp_devlink_port_register(struct nfp_app * app,struct nfp_port * port)328 int nfp_devlink_port_register(struct nfp_app *app, struct nfp_port *port)
329 {
330 	struct devlink_port_attrs attrs = {};
331 	struct nfp_eth_table_port eth_port;
332 	struct devlink *devlink;
333 	const u8 *serial;
334 	int serial_len;
335 	int ret;
336 
337 	rtnl_lock();
338 	ret = nfp_devlink_fill_eth_port(port, &eth_port);
339 	rtnl_unlock();
340 	if (ret)
341 		return ret;
342 
343 	attrs.split = eth_port.is_split;
344 	attrs.splittable = !attrs.split;
345 	attrs.lanes = eth_port.port_lanes;
346 	attrs.flavour = DEVLINK_PORT_FLAVOUR_PHYSICAL;
347 	attrs.phys.port_number = eth_port.label_port;
348 	attrs.phys.split_subport_number = eth_port.label_subport;
349 	serial_len = nfp_cpp_serial(port->app->cpp, &serial);
350 	memcpy(attrs.switch_id.id, serial, serial_len);
351 	attrs.switch_id.id_len = serial_len;
352 	devlink_port_attrs_set(&port->dl_port, &attrs);
353 
354 	devlink = priv_to_devlink(app->pf);
355 
356 	return devl_port_register(devlink, &port->dl_port, port->eth_id);
357 }
358 
nfp_devlink_port_unregister(struct nfp_port * port)359 void nfp_devlink_port_unregister(struct nfp_port *port)
360 {
361 	devl_port_unregister(&port->dl_port);
362 }
363 
nfp_devlink_port_type_eth_set(struct nfp_port * port)364 void nfp_devlink_port_type_eth_set(struct nfp_port *port)
365 {
366 	devlink_port_type_eth_set(&port->dl_port, port->netdev);
367 }
368 
nfp_devlink_port_type_clear(struct nfp_port * port)369 void nfp_devlink_port_type_clear(struct nfp_port *port)
370 {
371 	devlink_port_type_clear(&port->dl_port);
372 }
373 
nfp_devlink_get_devlink_port(struct net_device * netdev)374 struct devlink_port *nfp_devlink_get_devlink_port(struct net_device *netdev)
375 {
376 	struct nfp_port *port;
377 
378 	port = nfp_port_from_netdev(netdev);
379 	if (!port)
380 		return NULL;
381 
382 	return &port->dl_port;
383 }
384