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, ð_port);
74 rtnl_unlock();
75 if (ret)
76 return ret;
77
78 if (eth_port.port_lanes % count) {
79 NL_SET_ERR_MSG_MOD(extack, "invalid count");
80 return -EINVAL;
81 }
82
83 /* Special case the 100G CXP -> 2x40G split */
84 lanes = eth_port.port_lanes / count;
85 if (eth_port.lanes == 10 && count == 2)
86 lanes = 8 / count;
87
88 return nfp_devlink_set_lanes(pf, eth_port.index, lanes);
89 }
90
91 static int
nfp_devlink_port_unsplit(struct devlink * devlink,struct devlink_port * port,struct netlink_ext_ack * extack)92 nfp_devlink_port_unsplit(struct devlink *devlink, struct devlink_port *port,
93 struct netlink_ext_ack *extack)
94 {
95 struct nfp_pf *pf = devlink_priv(devlink);
96 struct nfp_eth_table_port eth_port;
97 unsigned int lanes;
98 int ret;
99
100 rtnl_lock();
101 ret = nfp_devlink_fill_eth_port_from_id(pf, port, ð_port);
102 rtnl_unlock();
103 if (ret)
104 return ret;
105
106 if (!eth_port.is_split) {
107 NL_SET_ERR_MSG_MOD(extack, "port is not split");
108 return -EINVAL;
109 }
110
111 /* Special case the 100G CXP -> 2x40G unsplit */
112 lanes = eth_port.port_lanes;
113 if (eth_port.port_lanes == 8)
114 lanes = 10;
115
116 return nfp_devlink_set_lanes(pf, eth_port.index, lanes);
117 }
118
119 static int
nfp_devlink_sb_pool_get(struct devlink * devlink,unsigned int sb_index,u16 pool_index,struct devlink_sb_pool_info * pool_info)120 nfp_devlink_sb_pool_get(struct devlink *devlink, unsigned int sb_index,
121 u16 pool_index, struct devlink_sb_pool_info *pool_info)
122 {
123 struct nfp_pf *pf = devlink_priv(devlink);
124
125 return nfp_shared_buf_pool_get(pf, sb_index, pool_index, pool_info);
126 }
127
128 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)129 nfp_devlink_sb_pool_set(struct devlink *devlink, unsigned int sb_index,
130 u16 pool_index,
131 u32 size, enum devlink_sb_threshold_type threshold_type,
132 struct netlink_ext_ack *extack)
133 {
134 struct nfp_pf *pf = devlink_priv(devlink);
135
136 return nfp_shared_buf_pool_set(pf, sb_index, pool_index,
137 size, threshold_type);
138 }
139
nfp_devlink_eswitch_mode_get(struct devlink * devlink,u16 * mode)140 static int nfp_devlink_eswitch_mode_get(struct devlink *devlink, u16 *mode)
141 {
142 struct nfp_pf *pf = devlink_priv(devlink);
143
144 return nfp_app_eswitch_mode_get(pf->app, mode);
145 }
146
nfp_devlink_eswitch_mode_set(struct devlink * devlink,u16 mode,struct netlink_ext_ack * extack)147 static int nfp_devlink_eswitch_mode_set(struct devlink *devlink, u16 mode,
148 struct netlink_ext_ack *extack)
149 {
150 struct nfp_pf *pf = devlink_priv(devlink);
151
152 return nfp_app_eswitch_mode_set(pf->app, mode);
153 }
154
155 static const struct nfp_devlink_versions_simple {
156 const char *key;
157 const char *hwinfo;
158 } nfp_devlink_versions_hwinfo[] = {
159 { DEVLINK_INFO_VERSION_GENERIC_BOARD_ID, "assembly.partno", },
160 { DEVLINK_INFO_VERSION_GENERIC_BOARD_REV, "assembly.revision", },
161 { DEVLINK_INFO_VERSION_GENERIC_BOARD_MANUFACTURE, "assembly.vendor", },
162 { "board.model", /* code name */ "assembly.model", },
163 { DEVLINK_INFO_VERSION_GENERIC_BOARD_PART_NUMBER, "pn", },
164 };
165
166 static int
nfp_devlink_versions_get_hwinfo(struct nfp_pf * pf,struct devlink_info_req * req)167 nfp_devlink_versions_get_hwinfo(struct nfp_pf *pf, struct devlink_info_req *req)
168 {
169 unsigned int i;
170 int err;
171
172 for (i = 0; i < ARRAY_SIZE(nfp_devlink_versions_hwinfo); i++) {
173 const struct nfp_devlink_versions_simple *info;
174 const char *val;
175
176 info = &nfp_devlink_versions_hwinfo[i];
177
178 val = nfp_hwinfo_lookup(pf->hwinfo, info->hwinfo);
179 if (!val)
180 continue;
181
182 err = devlink_info_version_fixed_put(req, info->key, val);
183 if (err)
184 return err;
185 }
186
187 return 0;
188 }
189
190 static const struct nfp_devlink_versions {
191 enum nfp_nsp_versions id;
192 const char *key;
193 } nfp_devlink_versions_nsp[] = {
194 { NFP_VERSIONS_BUNDLE, DEVLINK_INFO_VERSION_GENERIC_FW_BUNDLE_ID, },
195 { NFP_VERSIONS_BSP, DEVLINK_INFO_VERSION_GENERIC_FW_MGMT, },
196 { NFP_VERSIONS_CPLD, "fw.cpld", },
197 { NFP_VERSIONS_APP, DEVLINK_INFO_VERSION_GENERIC_FW_APP, },
198 { NFP_VERSIONS_UNDI, DEVLINK_INFO_VERSION_GENERIC_FW_UNDI, },
199 { NFP_VERSIONS_NCSI, DEVLINK_INFO_VERSION_GENERIC_FW_NCSI, },
200 { NFP_VERSIONS_CFGR, "chip.init", },
201 };
202
203 static int
nfp_devlink_versions_get_nsp(struct devlink_info_req * req,bool flash,const u8 * buf,unsigned int size)204 nfp_devlink_versions_get_nsp(struct devlink_info_req *req, bool flash,
205 const u8 *buf, unsigned int size)
206 {
207 unsigned int i;
208 int err;
209
210 for (i = 0; i < ARRAY_SIZE(nfp_devlink_versions_nsp); i++) {
211 const struct nfp_devlink_versions *info;
212 const char *version;
213
214 info = &nfp_devlink_versions_nsp[i];
215
216 version = nfp_nsp_versions_get(info->id, flash, buf, size);
217 if (IS_ERR(version)) {
218 if (PTR_ERR(version) == -ENOENT)
219 continue;
220 else
221 return PTR_ERR(version);
222 }
223
224 if (flash)
225 err = devlink_info_version_stored_put(req, info->key,
226 version);
227 else
228 err = devlink_info_version_running_put(req, info->key,
229 version);
230 if (err)
231 return err;
232 }
233
234 return 0;
235 }
236
237 static int
nfp_devlink_info_get(struct devlink * devlink,struct devlink_info_req * req,struct netlink_ext_ack * extack)238 nfp_devlink_info_get(struct devlink *devlink, struct devlink_info_req *req,
239 struct netlink_ext_ack *extack)
240 {
241 struct nfp_pf *pf = devlink_priv(devlink);
242 const char *sn, *vendor, *part;
243 struct nfp_nsp *nsp;
244 char *buf = NULL;
245 int err;
246
247 vendor = nfp_hwinfo_lookup(pf->hwinfo, "assembly.vendor");
248 part = nfp_hwinfo_lookup(pf->hwinfo, "assembly.partno");
249 sn = nfp_hwinfo_lookup(pf->hwinfo, "assembly.serial");
250 if (vendor && part && sn) {
251 char *buf;
252
253 buf = kmalloc(strlen(vendor) + strlen(part) + strlen(sn) + 1,
254 GFP_KERNEL);
255 if (!buf)
256 return -ENOMEM;
257
258 buf[0] = '\0';
259 strcat(buf, vendor);
260 strcat(buf, part);
261 strcat(buf, sn);
262
263 err = devlink_info_serial_number_put(req, buf);
264 kfree(buf);
265 if (err)
266 return err;
267 }
268
269 nsp = nfp_nsp_open(pf->cpp);
270 if (IS_ERR(nsp)) {
271 NL_SET_ERR_MSG_MOD(extack, "can't access NSP");
272 return PTR_ERR(nsp);
273 }
274
275 if (nfp_nsp_has_versions(nsp)) {
276 buf = kzalloc(NFP_NSP_VERSION_BUFSZ, GFP_KERNEL);
277 if (!buf) {
278 err = -ENOMEM;
279 goto err_close_nsp;
280 }
281
282 err = nfp_nsp_versions(nsp, buf, NFP_NSP_VERSION_BUFSZ);
283 if (err)
284 goto err_free_buf;
285
286 err = nfp_devlink_versions_get_nsp(req, false,
287 buf, NFP_NSP_VERSION_BUFSZ);
288 if (err)
289 goto err_free_buf;
290
291 err = nfp_devlink_versions_get_nsp(req, true,
292 buf, NFP_NSP_VERSION_BUFSZ);
293 if (err)
294 goto err_free_buf;
295
296 kfree(buf);
297 }
298
299 nfp_nsp_close(nsp);
300
301 return nfp_devlink_versions_get_hwinfo(pf, req);
302
303 err_free_buf:
304 kfree(buf);
305 err_close_nsp:
306 nfp_nsp_close(nsp);
307 return err;
308 }
309
310 static int
nfp_devlink_flash_update(struct devlink * devlink,struct devlink_flash_update_params * params,struct netlink_ext_ack * extack)311 nfp_devlink_flash_update(struct devlink *devlink,
312 struct devlink_flash_update_params *params,
313 struct netlink_ext_ack *extack)
314 {
315 return nfp_flash_update_common(devlink_priv(devlink), params->fw, extack);
316 }
317
318 const struct devlink_ops nfp_devlink_ops = {
319 .sb_pool_get = nfp_devlink_sb_pool_get,
320 .sb_pool_set = nfp_devlink_sb_pool_set,
321 .eswitch_mode_get = nfp_devlink_eswitch_mode_get,
322 .eswitch_mode_set = nfp_devlink_eswitch_mode_set,
323 .info_get = nfp_devlink_info_get,
324 .flash_update = nfp_devlink_flash_update,
325 };
326
327 static const struct devlink_port_ops nfp_devlink_port_ops = {
328 .port_split = nfp_devlink_port_split,
329 .port_unsplit = nfp_devlink_port_unsplit,
330 };
331
nfp_devlink_port_register(struct nfp_app * app,struct nfp_port * port)332 int nfp_devlink_port_register(struct nfp_app *app, struct nfp_port *port)
333 {
334 struct devlink_port_attrs attrs = {};
335 struct nfp_eth_table_port eth_port;
336 struct devlink *devlink;
337 const u8 *serial;
338 int serial_len;
339 int ret;
340
341 SET_NETDEV_DEVLINK_PORT(port->netdev, &port->dl_port);
342
343 rtnl_lock();
344 ret = nfp_devlink_fill_eth_port(port, ð_port);
345 rtnl_unlock();
346 if (ret)
347 return ret;
348
349 attrs.split = eth_port.is_split;
350 attrs.splittable = eth_port.port_lanes > 1 && !attrs.split;
351 attrs.lanes = eth_port.port_lanes;
352 attrs.flavour = DEVLINK_PORT_FLAVOUR_PHYSICAL;
353 attrs.phys.port_number = eth_port.label_port;
354 attrs.phys.split_subport_number = eth_port.label_subport;
355 serial_len = nfp_cpp_serial(port->app->cpp, &serial);
356 memcpy(attrs.switch_id.id, serial, serial_len);
357 attrs.switch_id.id_len = serial_len;
358 devlink_port_attrs_set(&port->dl_port, &attrs);
359
360 devlink = priv_to_devlink(app->pf);
361
362 return devl_port_register_with_ops(devlink, &port->dl_port,
363 port->eth_id, &nfp_devlink_port_ops);
364 }
365
nfp_devlink_port_unregister(struct nfp_port * port)366 void nfp_devlink_port_unregister(struct nfp_port *port)
367 {
368 devl_port_unregister(&port->dl_port);
369 }
370