1 /* Broadcom NetXtreme-C/E network driver.
2  *
3  * Copyright (c) 2017 Broadcom Limited
4  *
5  * This program is free software; you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License as published by
7  * the Free Software Foundation.
8  */
9 
10 #include <linux/pci.h>
11 #include <linux/netdevice.h>
12 #include <net/devlink.h>
13 #include "bnxt_hsi.h"
14 #include "bnxt.h"
15 #include "bnxt_vfr.h"
16 #include "bnxt_devlink.h"
17 #include "bnxt_ethtool.h"
18 
19 static int
20 bnxt_dl_flash_update(struct devlink *dl,
21 		     struct devlink_flash_update_params *params,
22 		     struct netlink_ext_ack *extack)
23 {
24 	struct bnxt *bp = bnxt_get_bp_from_dl(dl);
25 	int rc;
26 
27 	if (!BNXT_PF(bp)) {
28 		NL_SET_ERR_MSG_MOD(extack,
29 				   "flash update not supported from a VF");
30 		return -EPERM;
31 	}
32 
33 	devlink_flash_update_begin_notify(dl);
34 	devlink_flash_update_status_notify(dl, "Preparing to flash", NULL, 0, 0);
35 	rc = bnxt_flash_package_from_file(bp->dev, params->file_name, 0);
36 	if (!rc)
37 		devlink_flash_update_status_notify(dl, "Flashing done", NULL, 0, 0);
38 	else
39 		devlink_flash_update_status_notify(dl, "Flashing failed", NULL, 0, 0);
40 	devlink_flash_update_end_notify(dl);
41 	return rc;
42 }
43 
44 static int bnxt_fw_reporter_diagnose(struct devlink_health_reporter *reporter,
45 				     struct devlink_fmsg *fmsg,
46 				     struct netlink_ext_ack *extack)
47 {
48 	struct bnxt *bp = devlink_health_reporter_priv(reporter);
49 	u32 val, health_status;
50 	int rc;
51 
52 	if (test_bit(BNXT_STATE_IN_FW_RESET, &bp->state))
53 		return 0;
54 
55 	val = bnxt_fw_health_readl(bp, BNXT_FW_HEALTH_REG);
56 	health_status = val & 0xffff;
57 
58 	if (health_status < BNXT_FW_STATUS_HEALTHY) {
59 		rc = devlink_fmsg_string_pair_put(fmsg, "Description",
60 						  "Not yet completed initialization");
61 		if (rc)
62 			return rc;
63 	} else if (health_status > BNXT_FW_STATUS_HEALTHY) {
64 		rc = devlink_fmsg_string_pair_put(fmsg, "Description",
65 						  "Encountered fatal error and cannot recover");
66 		if (rc)
67 			return rc;
68 	}
69 
70 	if (val >> 16) {
71 		rc = devlink_fmsg_u32_pair_put(fmsg, "Error code", val >> 16);
72 		if (rc)
73 			return rc;
74 	}
75 
76 	val = bnxt_fw_health_readl(bp, BNXT_FW_RESET_CNT_REG);
77 	rc = devlink_fmsg_u32_pair_put(fmsg, "Reset count", val);
78 	if (rc)
79 		return rc;
80 
81 	return 0;
82 }
83 
84 static const struct devlink_health_reporter_ops bnxt_dl_fw_reporter_ops = {
85 	.name = "fw",
86 	.diagnose = bnxt_fw_reporter_diagnose,
87 };
88 
89 static int bnxt_fw_reset_recover(struct devlink_health_reporter *reporter,
90 				 void *priv_ctx,
91 				 struct netlink_ext_ack *extack)
92 {
93 	struct bnxt *bp = devlink_health_reporter_priv(reporter);
94 
95 	if (!priv_ctx)
96 		return -EOPNOTSUPP;
97 
98 	bnxt_fw_reset(bp);
99 	return -EINPROGRESS;
100 }
101 
102 static const
103 struct devlink_health_reporter_ops bnxt_dl_fw_reset_reporter_ops = {
104 	.name = "fw_reset",
105 	.recover = bnxt_fw_reset_recover,
106 };
107 
108 static int bnxt_fw_fatal_recover(struct devlink_health_reporter *reporter,
109 				 void *priv_ctx,
110 				 struct netlink_ext_ack *extack)
111 {
112 	struct bnxt *bp = devlink_health_reporter_priv(reporter);
113 	struct bnxt_fw_reporter_ctx *fw_reporter_ctx = priv_ctx;
114 	unsigned long event;
115 
116 	if (!priv_ctx)
117 		return -EOPNOTSUPP;
118 
119 	bp->fw_health->fatal = true;
120 	event = fw_reporter_ctx->sp_event;
121 	if (event == BNXT_FW_RESET_NOTIFY_SP_EVENT)
122 		bnxt_fw_reset(bp);
123 	else if (event == BNXT_FW_EXCEPTION_SP_EVENT)
124 		bnxt_fw_exception(bp);
125 
126 	return -EINPROGRESS;
127 }
128 
129 static const
130 struct devlink_health_reporter_ops bnxt_dl_fw_fatal_reporter_ops = {
131 	.name = "fw_fatal",
132 	.recover = bnxt_fw_fatal_recover,
133 };
134 
135 void bnxt_dl_fw_reporters_create(struct bnxt *bp)
136 {
137 	struct bnxt_fw_health *health = bp->fw_health;
138 
139 	if (!bp->dl || !health)
140 		return;
141 
142 	if (!(bp->fw_cap & BNXT_FW_CAP_HOT_RESET) || health->fw_reset_reporter)
143 		goto err_recovery;
144 
145 	health->fw_reset_reporter =
146 		devlink_health_reporter_create(bp->dl,
147 					       &bnxt_dl_fw_reset_reporter_ops,
148 					       0, bp);
149 	if (IS_ERR(health->fw_reset_reporter)) {
150 		netdev_warn(bp->dev, "Failed to create FW fatal health reporter, rc = %ld\n",
151 			    PTR_ERR(health->fw_reset_reporter));
152 		health->fw_reset_reporter = NULL;
153 		bp->fw_cap &= ~BNXT_FW_CAP_HOT_RESET;
154 	}
155 
156 err_recovery:
157 	if (!(bp->fw_cap & BNXT_FW_CAP_ERROR_RECOVERY))
158 		return;
159 
160 	if (!health->fw_reporter) {
161 		health->fw_reporter =
162 			devlink_health_reporter_create(bp->dl,
163 						       &bnxt_dl_fw_reporter_ops,
164 						       0, bp);
165 		if (IS_ERR(health->fw_reporter)) {
166 			netdev_warn(bp->dev, "Failed to create FW health reporter, rc = %ld\n",
167 				    PTR_ERR(health->fw_reporter));
168 			health->fw_reporter = NULL;
169 			bp->fw_cap &= ~BNXT_FW_CAP_ERROR_RECOVERY;
170 			return;
171 		}
172 	}
173 
174 	if (health->fw_fatal_reporter)
175 		return;
176 
177 	health->fw_fatal_reporter =
178 		devlink_health_reporter_create(bp->dl,
179 					       &bnxt_dl_fw_fatal_reporter_ops,
180 					       0, bp);
181 	if (IS_ERR(health->fw_fatal_reporter)) {
182 		netdev_warn(bp->dev, "Failed to create FW fatal health reporter, rc = %ld\n",
183 			    PTR_ERR(health->fw_fatal_reporter));
184 		health->fw_fatal_reporter = NULL;
185 		bp->fw_cap &= ~BNXT_FW_CAP_ERROR_RECOVERY;
186 	}
187 }
188 
189 void bnxt_dl_fw_reporters_destroy(struct bnxt *bp, bool all)
190 {
191 	struct bnxt_fw_health *health = bp->fw_health;
192 
193 	if (!bp->dl || !health)
194 		return;
195 
196 	if ((all || !(bp->fw_cap & BNXT_FW_CAP_HOT_RESET)) &&
197 	    health->fw_reset_reporter) {
198 		devlink_health_reporter_destroy(health->fw_reset_reporter);
199 		health->fw_reset_reporter = NULL;
200 	}
201 
202 	if ((bp->fw_cap & BNXT_FW_CAP_ERROR_RECOVERY) && !all)
203 		return;
204 
205 	if (health->fw_reporter) {
206 		devlink_health_reporter_destroy(health->fw_reporter);
207 		health->fw_reporter = NULL;
208 	}
209 
210 	if (health->fw_fatal_reporter) {
211 		devlink_health_reporter_destroy(health->fw_fatal_reporter);
212 		health->fw_fatal_reporter = NULL;
213 	}
214 }
215 
216 void bnxt_devlink_health_report(struct bnxt *bp, unsigned long event)
217 {
218 	struct bnxt_fw_health *fw_health = bp->fw_health;
219 	struct bnxt_fw_reporter_ctx fw_reporter_ctx;
220 
221 	fw_reporter_ctx.sp_event = event;
222 	switch (event) {
223 	case BNXT_FW_RESET_NOTIFY_SP_EVENT:
224 		if (test_bit(BNXT_STATE_FW_FATAL_COND, &bp->state)) {
225 			if (!fw_health->fw_fatal_reporter)
226 				return;
227 
228 			devlink_health_report(fw_health->fw_fatal_reporter,
229 					      "FW fatal async event received",
230 					      &fw_reporter_ctx);
231 			return;
232 		}
233 		if (!fw_health->fw_reset_reporter)
234 			return;
235 
236 		devlink_health_report(fw_health->fw_reset_reporter,
237 				      "FW non-fatal reset event received",
238 				      &fw_reporter_ctx);
239 		return;
240 
241 	case BNXT_FW_EXCEPTION_SP_EVENT:
242 		if (!fw_health->fw_fatal_reporter)
243 			return;
244 
245 		devlink_health_report(fw_health->fw_fatal_reporter,
246 				      "FW fatal error reported",
247 				      &fw_reporter_ctx);
248 		return;
249 	}
250 }
251 
252 void bnxt_dl_health_status_update(struct bnxt *bp, bool healthy)
253 {
254 	struct bnxt_fw_health *health = bp->fw_health;
255 	u8 state;
256 
257 	if (healthy)
258 		state = DEVLINK_HEALTH_REPORTER_STATE_HEALTHY;
259 	else
260 		state = DEVLINK_HEALTH_REPORTER_STATE_ERROR;
261 
262 	if (health->fatal)
263 		devlink_health_reporter_state_update(health->fw_fatal_reporter,
264 						     state);
265 	else
266 		devlink_health_reporter_state_update(health->fw_reset_reporter,
267 						     state);
268 
269 	health->fatal = false;
270 }
271 
272 void bnxt_dl_health_recovery_done(struct bnxt *bp)
273 {
274 	struct bnxt_fw_health *hlth = bp->fw_health;
275 
276 	if (hlth->fatal)
277 		devlink_health_reporter_recovery_done(hlth->fw_fatal_reporter);
278 	else
279 		devlink_health_reporter_recovery_done(hlth->fw_reset_reporter);
280 }
281 
282 static int bnxt_dl_info_get(struct devlink *dl, struct devlink_info_req *req,
283 			    struct netlink_ext_ack *extack);
284 
285 static const struct devlink_ops bnxt_dl_ops = {
286 #ifdef CONFIG_BNXT_SRIOV
287 	.eswitch_mode_set = bnxt_dl_eswitch_mode_set,
288 	.eswitch_mode_get = bnxt_dl_eswitch_mode_get,
289 #endif /* CONFIG_BNXT_SRIOV */
290 	.info_get	  = bnxt_dl_info_get,
291 	.flash_update	  = bnxt_dl_flash_update,
292 };
293 
294 static const struct devlink_ops bnxt_vf_dl_ops;
295 
296 enum bnxt_dl_param_id {
297 	BNXT_DEVLINK_PARAM_ID_BASE = DEVLINK_PARAM_GENERIC_ID_MAX,
298 	BNXT_DEVLINK_PARAM_ID_GRE_VER_CHECK,
299 };
300 
301 static const struct bnxt_dl_nvm_param nvm_params[] = {
302 	{DEVLINK_PARAM_GENERIC_ID_ENABLE_SRIOV, NVM_OFF_ENABLE_SRIOV,
303 	 BNXT_NVM_SHARED_CFG, 1, 1},
304 	{DEVLINK_PARAM_GENERIC_ID_IGNORE_ARI, NVM_OFF_IGNORE_ARI,
305 	 BNXT_NVM_SHARED_CFG, 1, 1},
306 	{DEVLINK_PARAM_GENERIC_ID_MSIX_VEC_PER_PF_MAX,
307 	 NVM_OFF_MSIX_VEC_PER_PF_MAX, BNXT_NVM_SHARED_CFG, 10, 4},
308 	{DEVLINK_PARAM_GENERIC_ID_MSIX_VEC_PER_PF_MIN,
309 	 NVM_OFF_MSIX_VEC_PER_PF_MIN, BNXT_NVM_SHARED_CFG, 7, 4},
310 	{BNXT_DEVLINK_PARAM_ID_GRE_VER_CHECK, NVM_OFF_DIS_GRE_VER_CHECK,
311 	 BNXT_NVM_SHARED_CFG, 1, 1},
312 };
313 
314 union bnxt_nvm_data {
315 	u8	val8;
316 	__le32	val32;
317 };
318 
319 static void bnxt_copy_to_nvm_data(union bnxt_nvm_data *dst,
320 				  union devlink_param_value *src,
321 				  int nvm_num_bits, int dl_num_bytes)
322 {
323 	u32 val32 = 0;
324 
325 	if (nvm_num_bits == 1) {
326 		dst->val8 = src->vbool;
327 		return;
328 	}
329 	if (dl_num_bytes == 4)
330 		val32 = src->vu32;
331 	else if (dl_num_bytes == 2)
332 		val32 = (u32)src->vu16;
333 	else if (dl_num_bytes == 1)
334 		val32 = (u32)src->vu8;
335 	dst->val32 = cpu_to_le32(val32);
336 }
337 
338 static void bnxt_copy_from_nvm_data(union devlink_param_value *dst,
339 				    union bnxt_nvm_data *src,
340 				    int nvm_num_bits, int dl_num_bytes)
341 {
342 	u32 val32;
343 
344 	if (nvm_num_bits == 1) {
345 		dst->vbool = src->val8;
346 		return;
347 	}
348 	val32 = le32_to_cpu(src->val32);
349 	if (dl_num_bytes == 4)
350 		dst->vu32 = val32;
351 	else if (dl_num_bytes == 2)
352 		dst->vu16 = (u16)val32;
353 	else if (dl_num_bytes == 1)
354 		dst->vu8 = (u8)val32;
355 }
356 
357 static int bnxt_hwrm_get_nvm_cfg_ver(struct bnxt *bp,
358 				     union devlink_param_value *nvm_cfg_ver)
359 {
360 	struct hwrm_nvm_get_variable_input req = {0};
361 	union bnxt_nvm_data *data;
362 	dma_addr_t data_dma_addr;
363 	int rc;
364 
365 	bnxt_hwrm_cmd_hdr_init(bp, &req, HWRM_NVM_GET_VARIABLE, -1, -1);
366 	data = dma_alloc_coherent(&bp->pdev->dev, sizeof(*data),
367 				  &data_dma_addr, GFP_KERNEL);
368 	if (!data)
369 		return -ENOMEM;
370 
371 	req.dest_data_addr = cpu_to_le64(data_dma_addr);
372 	req.data_len = cpu_to_le16(BNXT_NVM_CFG_VER_BITS);
373 	req.option_num = cpu_to_le16(NVM_OFF_NVM_CFG_VER);
374 
375 	rc = hwrm_send_message_silent(bp, &req, sizeof(req), HWRM_CMD_TIMEOUT);
376 	if (!rc)
377 		bnxt_copy_from_nvm_data(nvm_cfg_ver, data,
378 					BNXT_NVM_CFG_VER_BITS,
379 					BNXT_NVM_CFG_VER_BYTES);
380 
381 	dma_free_coherent(&bp->pdev->dev, sizeof(*data), data, data_dma_addr);
382 	return rc;
383 }
384 
385 static int bnxt_dl_info_get(struct devlink *dl, struct devlink_info_req *req,
386 			    struct netlink_ext_ack *extack)
387 {
388 	struct bnxt *bp = bnxt_get_bp_from_dl(dl);
389 	union devlink_param_value nvm_cfg_ver;
390 	struct hwrm_ver_get_output *ver_resp;
391 	char mgmt_ver[FW_VER_STR_LEN];
392 	char roce_ver[FW_VER_STR_LEN];
393 	char fw_ver[FW_VER_STR_LEN];
394 	char buf[32];
395 	int rc;
396 
397 	rc = devlink_info_driver_name_put(req, DRV_MODULE_NAME);
398 	if (rc)
399 		return rc;
400 
401 	if (strlen(bp->board_partno)) {
402 		rc = devlink_info_version_fixed_put(req,
403 			DEVLINK_INFO_VERSION_GENERIC_BOARD_ID,
404 			bp->board_partno);
405 		if (rc)
406 			return rc;
407 	}
408 
409 	if (strlen(bp->board_serialno)) {
410 		rc = devlink_info_board_serial_number_put(req, bp->board_serialno);
411 		if (rc)
412 			return rc;
413 	}
414 
415 	sprintf(buf, "%X", bp->chip_num);
416 	rc = devlink_info_version_fixed_put(req,
417 			DEVLINK_INFO_VERSION_GENERIC_ASIC_ID, buf);
418 	if (rc)
419 		return rc;
420 
421 	ver_resp = &bp->ver_resp;
422 	sprintf(buf, "%X", ver_resp->chip_rev);
423 	rc = devlink_info_version_fixed_put(req,
424 			DEVLINK_INFO_VERSION_GENERIC_ASIC_REV, buf);
425 	if (rc)
426 		return rc;
427 
428 	if (BNXT_PF(bp)) {
429 		sprintf(buf, "%02X-%02X-%02X-%02X-%02X-%02X-%02X-%02X",
430 			bp->dsn[7], bp->dsn[6], bp->dsn[5], bp->dsn[4],
431 			bp->dsn[3], bp->dsn[2], bp->dsn[1], bp->dsn[0]);
432 		rc = devlink_info_serial_number_put(req, buf);
433 		if (rc)
434 			return rc;
435 	}
436 
437 	if (strlen(ver_resp->active_pkg_name)) {
438 		rc =
439 		    devlink_info_version_running_put(req,
440 					DEVLINK_INFO_VERSION_GENERIC_FW,
441 					ver_resp->active_pkg_name);
442 		if (rc)
443 			return rc;
444 	}
445 
446 	if (BNXT_PF(bp) && !bnxt_hwrm_get_nvm_cfg_ver(bp, &nvm_cfg_ver)) {
447 		u32 ver = nvm_cfg_ver.vu32;
448 
449 		sprintf(buf, "%X.%X.%X", (ver >> 16) & 0xF, (ver >> 8) & 0xF,
450 			ver & 0xF);
451 		rc = devlink_info_version_running_put(req,
452 				DEVLINK_INFO_VERSION_GENERIC_FW_PSID, buf);
453 		if (rc)
454 			return rc;
455 	}
456 
457 	if (ver_resp->flags & VER_GET_RESP_FLAGS_EXT_VER_AVAIL) {
458 		snprintf(fw_ver, FW_VER_STR_LEN, "%d.%d.%d.%d",
459 			 ver_resp->hwrm_fw_major, ver_resp->hwrm_fw_minor,
460 			 ver_resp->hwrm_fw_build, ver_resp->hwrm_fw_patch);
461 
462 		snprintf(mgmt_ver, FW_VER_STR_LEN, "%d.%d.%d.%d",
463 			 ver_resp->mgmt_fw_major, ver_resp->mgmt_fw_minor,
464 			 ver_resp->mgmt_fw_build, ver_resp->mgmt_fw_patch);
465 
466 		snprintf(roce_ver, FW_VER_STR_LEN, "%d.%d.%d.%d",
467 			 ver_resp->roce_fw_major, ver_resp->roce_fw_minor,
468 			 ver_resp->roce_fw_build, ver_resp->roce_fw_patch);
469 	} else {
470 		snprintf(fw_ver, FW_VER_STR_LEN, "%d.%d.%d.%d",
471 			 ver_resp->hwrm_fw_maj_8b, ver_resp->hwrm_fw_min_8b,
472 			 ver_resp->hwrm_fw_bld_8b, ver_resp->hwrm_fw_rsvd_8b);
473 
474 		snprintf(mgmt_ver, FW_VER_STR_LEN, "%d.%d.%d.%d",
475 			 ver_resp->mgmt_fw_maj_8b, ver_resp->mgmt_fw_min_8b,
476 			 ver_resp->mgmt_fw_bld_8b, ver_resp->mgmt_fw_rsvd_8b);
477 
478 		snprintf(roce_ver, FW_VER_STR_LEN, "%d.%d.%d.%d",
479 			 ver_resp->roce_fw_maj_8b, ver_resp->roce_fw_min_8b,
480 			 ver_resp->roce_fw_bld_8b, ver_resp->roce_fw_rsvd_8b);
481 	}
482 	rc = devlink_info_version_running_put(req,
483 			DEVLINK_INFO_VERSION_GENERIC_FW_MGMT, fw_ver);
484 	if (rc)
485 		return rc;
486 
487 	rc = devlink_info_version_running_put(req,
488 				DEVLINK_INFO_VERSION_GENERIC_FW_MGMT_API,
489 				bp->hwrm_ver_supp);
490 	if (rc)
491 		return rc;
492 
493 	if (!(bp->flags & BNXT_FLAG_CHIP_P5)) {
494 		rc = devlink_info_version_running_put(req,
495 			DEVLINK_INFO_VERSION_GENERIC_FW_NCSI, mgmt_ver);
496 		if (rc)
497 			return rc;
498 
499 		rc = devlink_info_version_running_put(req,
500 			DEVLINK_INFO_VERSION_GENERIC_FW_ROCE, roce_ver);
501 		if (rc)
502 			return rc;
503 	}
504 	return 0;
505 }
506 
507 static int bnxt_hwrm_nvm_req(struct bnxt *bp, u32 param_id, void *msg,
508 			     int msg_len, union devlink_param_value *val)
509 {
510 	struct hwrm_nvm_get_variable_input *req = msg;
511 	struct bnxt_dl_nvm_param nvm_param;
512 	union bnxt_nvm_data *data;
513 	dma_addr_t data_dma_addr;
514 	int idx = 0, rc, i;
515 
516 	/* Get/Set NVM CFG parameter is supported only on PFs */
517 	if (BNXT_VF(bp))
518 		return -EPERM;
519 
520 	for (i = 0; i < ARRAY_SIZE(nvm_params); i++) {
521 		if (nvm_params[i].id == param_id) {
522 			nvm_param = nvm_params[i];
523 			break;
524 		}
525 	}
526 
527 	if (i == ARRAY_SIZE(nvm_params))
528 		return -EOPNOTSUPP;
529 
530 	if (nvm_param.dir_type == BNXT_NVM_PORT_CFG)
531 		idx = bp->pf.port_id;
532 	else if (nvm_param.dir_type == BNXT_NVM_FUNC_CFG)
533 		idx = bp->pf.fw_fid - BNXT_FIRST_PF_FID;
534 
535 	data = dma_alloc_coherent(&bp->pdev->dev, sizeof(*data),
536 				  &data_dma_addr, GFP_KERNEL);
537 	if (!data)
538 		return -ENOMEM;
539 
540 	req->dest_data_addr = cpu_to_le64(data_dma_addr);
541 	req->data_len = cpu_to_le16(nvm_param.nvm_num_bits);
542 	req->option_num = cpu_to_le16(nvm_param.offset);
543 	req->index_0 = cpu_to_le16(idx);
544 	if (idx)
545 		req->dimensions = cpu_to_le16(1);
546 
547 	if (req->req_type == cpu_to_le16(HWRM_NVM_SET_VARIABLE)) {
548 		bnxt_copy_to_nvm_data(data, val, nvm_param.nvm_num_bits,
549 				      nvm_param.dl_num_bytes);
550 		rc = hwrm_send_message(bp, msg, msg_len, HWRM_CMD_TIMEOUT);
551 	} else {
552 		rc = hwrm_send_message_silent(bp, msg, msg_len,
553 					      HWRM_CMD_TIMEOUT);
554 		if (!rc) {
555 			bnxt_copy_from_nvm_data(val, data,
556 						nvm_param.nvm_num_bits,
557 						nvm_param.dl_num_bytes);
558 		} else {
559 			struct hwrm_err_output *resp = bp->hwrm_cmd_resp_addr;
560 
561 			if (resp->cmd_err ==
562 				NVM_GET_VARIABLE_CMD_ERR_CODE_VAR_NOT_EXIST)
563 				rc = -EOPNOTSUPP;
564 		}
565 	}
566 	dma_free_coherent(&bp->pdev->dev, sizeof(*data), data, data_dma_addr);
567 	if (rc == -EACCES)
568 		netdev_err(bp->dev, "PF does not have admin privileges to modify NVM config\n");
569 	return rc;
570 }
571 
572 static int bnxt_dl_nvm_param_get(struct devlink *dl, u32 id,
573 				 struct devlink_param_gset_ctx *ctx)
574 {
575 	struct hwrm_nvm_get_variable_input req = {0};
576 	struct bnxt *bp = bnxt_get_bp_from_dl(dl);
577 	int rc;
578 
579 	bnxt_hwrm_cmd_hdr_init(bp, &req, HWRM_NVM_GET_VARIABLE, -1, -1);
580 	rc = bnxt_hwrm_nvm_req(bp, id, &req, sizeof(req), &ctx->val);
581 	if (!rc)
582 		if (id == BNXT_DEVLINK_PARAM_ID_GRE_VER_CHECK)
583 			ctx->val.vbool = !ctx->val.vbool;
584 
585 	return rc;
586 }
587 
588 static int bnxt_dl_nvm_param_set(struct devlink *dl, u32 id,
589 				 struct devlink_param_gset_ctx *ctx)
590 {
591 	struct hwrm_nvm_set_variable_input req = {0};
592 	struct bnxt *bp = bnxt_get_bp_from_dl(dl);
593 
594 	bnxt_hwrm_cmd_hdr_init(bp, &req, HWRM_NVM_SET_VARIABLE, -1, -1);
595 
596 	if (id == BNXT_DEVLINK_PARAM_ID_GRE_VER_CHECK)
597 		ctx->val.vbool = !ctx->val.vbool;
598 
599 	return bnxt_hwrm_nvm_req(bp, id, &req, sizeof(req), &ctx->val);
600 }
601 
602 static int bnxt_dl_msix_validate(struct devlink *dl, u32 id,
603 				 union devlink_param_value val,
604 				 struct netlink_ext_ack *extack)
605 {
606 	int max_val = -1;
607 
608 	if (id == DEVLINK_PARAM_GENERIC_ID_MSIX_VEC_PER_PF_MAX)
609 		max_val = BNXT_MSIX_VEC_MAX;
610 
611 	if (id == DEVLINK_PARAM_GENERIC_ID_MSIX_VEC_PER_PF_MIN)
612 		max_val = BNXT_MSIX_VEC_MIN_MAX;
613 
614 	if (val.vu32 > max_val) {
615 		NL_SET_ERR_MSG_MOD(extack, "MSIX value is exceeding the range");
616 		return -EINVAL;
617 	}
618 
619 	return 0;
620 }
621 
622 static const struct devlink_param bnxt_dl_params[] = {
623 	DEVLINK_PARAM_GENERIC(ENABLE_SRIOV,
624 			      BIT(DEVLINK_PARAM_CMODE_PERMANENT),
625 			      bnxt_dl_nvm_param_get, bnxt_dl_nvm_param_set,
626 			      NULL),
627 	DEVLINK_PARAM_GENERIC(IGNORE_ARI,
628 			      BIT(DEVLINK_PARAM_CMODE_PERMANENT),
629 			      bnxt_dl_nvm_param_get, bnxt_dl_nvm_param_set,
630 			      NULL),
631 	DEVLINK_PARAM_GENERIC(MSIX_VEC_PER_PF_MAX,
632 			      BIT(DEVLINK_PARAM_CMODE_PERMANENT),
633 			      bnxt_dl_nvm_param_get, bnxt_dl_nvm_param_set,
634 			      bnxt_dl_msix_validate),
635 	DEVLINK_PARAM_GENERIC(MSIX_VEC_PER_PF_MIN,
636 			      BIT(DEVLINK_PARAM_CMODE_PERMANENT),
637 			      bnxt_dl_nvm_param_get, bnxt_dl_nvm_param_set,
638 			      bnxt_dl_msix_validate),
639 	DEVLINK_PARAM_DRIVER(BNXT_DEVLINK_PARAM_ID_GRE_VER_CHECK,
640 			     "gre_ver_check", DEVLINK_PARAM_TYPE_BOOL,
641 			     BIT(DEVLINK_PARAM_CMODE_PERMANENT),
642 			     bnxt_dl_nvm_param_get, bnxt_dl_nvm_param_set,
643 			     NULL),
644 };
645 
646 static const struct devlink_param bnxt_dl_port_params[] = {
647 };
648 
649 static int bnxt_dl_params_register(struct bnxt *bp)
650 {
651 	int rc;
652 
653 	if (bp->hwrm_spec_code < 0x10600)
654 		return 0;
655 
656 	rc = devlink_params_register(bp->dl, bnxt_dl_params,
657 				     ARRAY_SIZE(bnxt_dl_params));
658 	if (rc) {
659 		netdev_warn(bp->dev, "devlink_params_register failed. rc=%d\n",
660 			    rc);
661 		return rc;
662 	}
663 	rc = devlink_port_params_register(&bp->dl_port, bnxt_dl_port_params,
664 					  ARRAY_SIZE(bnxt_dl_port_params));
665 	if (rc) {
666 		netdev_err(bp->dev, "devlink_port_params_register failed\n");
667 		devlink_params_unregister(bp->dl, bnxt_dl_params,
668 					  ARRAY_SIZE(bnxt_dl_params));
669 		return rc;
670 	}
671 	devlink_params_publish(bp->dl);
672 
673 	return 0;
674 }
675 
676 static void bnxt_dl_params_unregister(struct bnxt *bp)
677 {
678 	if (bp->hwrm_spec_code < 0x10600)
679 		return;
680 
681 	devlink_params_unregister(bp->dl, bnxt_dl_params,
682 				  ARRAY_SIZE(bnxt_dl_params));
683 	devlink_port_params_unregister(&bp->dl_port, bnxt_dl_port_params,
684 				       ARRAY_SIZE(bnxt_dl_port_params));
685 }
686 
687 int bnxt_dl_register(struct bnxt *bp)
688 {
689 	struct devlink_port_attrs attrs = {};
690 	struct devlink *dl;
691 	int rc;
692 
693 	if (BNXT_PF(bp))
694 		dl = devlink_alloc(&bnxt_dl_ops, sizeof(struct bnxt_dl));
695 	else
696 		dl = devlink_alloc(&bnxt_vf_dl_ops, sizeof(struct bnxt_dl));
697 	if (!dl) {
698 		netdev_warn(bp->dev, "devlink_alloc failed\n");
699 		return -ENOMEM;
700 	}
701 
702 	bnxt_link_bp_to_dl(bp, dl);
703 
704 	/* Add switchdev eswitch mode setting, if SRIOV supported */
705 	if (pci_find_ext_capability(bp->pdev, PCI_EXT_CAP_ID_SRIOV) &&
706 	    bp->hwrm_spec_code > 0x10803)
707 		bp->eswitch_mode = DEVLINK_ESWITCH_MODE_LEGACY;
708 
709 	rc = devlink_register(dl, &bp->pdev->dev);
710 	if (rc) {
711 		netdev_warn(bp->dev, "devlink_register failed. rc=%d\n", rc);
712 		goto err_dl_free;
713 	}
714 
715 	if (!BNXT_PF(bp))
716 		return 0;
717 
718 	attrs.flavour = DEVLINK_PORT_FLAVOUR_PHYSICAL;
719 	attrs.phys.port_number = bp->pf.port_id;
720 	memcpy(attrs.switch_id.id, bp->dsn, sizeof(bp->dsn));
721 	attrs.switch_id.id_len = sizeof(bp->dsn);
722 	devlink_port_attrs_set(&bp->dl_port, &attrs);
723 	rc = devlink_port_register(dl, &bp->dl_port, bp->pf.port_id);
724 	if (rc) {
725 		netdev_err(bp->dev, "devlink_port_register failed\n");
726 		goto err_dl_unreg;
727 	}
728 
729 	rc = bnxt_dl_params_register(bp);
730 	if (rc)
731 		goto err_dl_port_unreg;
732 
733 	return 0;
734 
735 err_dl_port_unreg:
736 	devlink_port_unregister(&bp->dl_port);
737 err_dl_unreg:
738 	devlink_unregister(dl);
739 err_dl_free:
740 	bnxt_link_bp_to_dl(bp, NULL);
741 	devlink_free(dl);
742 	return rc;
743 }
744 
745 void bnxt_dl_unregister(struct bnxt *bp)
746 {
747 	struct devlink *dl = bp->dl;
748 
749 	if (!dl)
750 		return;
751 
752 	if (BNXT_PF(bp)) {
753 		bnxt_dl_params_unregister(bp);
754 		devlink_port_unregister(&bp->dl_port);
755 	}
756 	devlink_unregister(dl);
757 	devlink_free(dl);
758 }
759