[mirror_ubuntu-jammy-kernel.git] / drivers / net / ethernet / broadcom / bnxt / bnxt_devlink.c

/* Broadcom NetXtreme-C/E network driver.
 *
 * Copyright (c) 2017 Broadcom Limited
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation.
 */

#include <linux/pci.h>
#include <linux/netdevice.h>
#include <net/devlink.h>
#include "bnxt_hsi.h"
#include "bnxt.h"
#include "bnxt_vfr.h"
#include "bnxt_devlink.h"
#include "bnxt_ethtool.h"

static int
bnxt_dl_flash_update(struct devlink *dl, const char *filename,
		     const char *region, struct netlink_ext_ack *extack)
{
	struct bnxt *bp = bnxt_get_bp_from_dl(dl);

	if (region)
		return -EOPNOTSUPP;

	if (!BNXT_PF(bp)) {
		NL_SET_ERR_MSG_MOD(extack,
				   "flash update not supported from a VF");
		return -EPERM;
	}

	return bnxt_flash_package_from_file(bp->dev, filename, 0);
}

static int bnxt_fw_reporter_diagnose(struct devlink_health_reporter *reporter,
				     struct devlink_fmsg *fmsg,
				     struct netlink_ext_ack *extack)
{
	struct bnxt *bp = devlink_health_reporter_priv(reporter);
	struct bnxt_fw_health *health = bp->fw_health;
	u32 val, health_status;
	int rc;

	if (!health || test_bit(BNXT_STATE_IN_FW_RESET, &bp->state))
		return 0;

	val = bnxt_fw_health_readl(bp, BNXT_FW_HEALTH_REG);
	health_status = val & 0xffff;

	if (health_status < BNXT_FW_STATUS_HEALTHY) {
		rc = devlink_fmsg_string_pair_put(fmsg, "Description",
						  "Not yet completed initialization");
		if (rc)
			return rc;
	} else if (health_status > BNXT_FW_STATUS_HEALTHY) {
		rc = devlink_fmsg_string_pair_put(fmsg, "Description",
						  "Encountered fatal error and cannot recover");
		if (rc)
			return rc;
	}

	if (val >> 16) {
		rc = devlink_fmsg_u32_pair_put(fmsg, "Error code", val >> 16);
		if (rc)
			return rc;
	}

	val = bnxt_fw_health_readl(bp, BNXT_FW_RESET_CNT_REG);
	rc = devlink_fmsg_u32_pair_put(fmsg, "Reset count", val);
	if (rc)
		return rc;

	return 0;
}

static const struct devlink_health_reporter_ops bnxt_dl_fw_reporter_ops = {
	.name = "fw",
	.diagnose = bnxt_fw_reporter_diagnose,
};

static int bnxt_fw_reset_recover(struct devlink_health_reporter *reporter,
				 void *priv_ctx,
				 struct netlink_ext_ack *extack)
{
	struct bnxt *bp = devlink_health_reporter_priv(reporter);

	if (!priv_ctx)
		return -EOPNOTSUPP;

	bnxt_fw_reset(bp);
	return 0;
}

static const
struct devlink_health_reporter_ops bnxt_dl_fw_reset_reporter_ops = {
	.name = "fw_reset",
	.recover = bnxt_fw_reset_recover,
};

static int bnxt_fw_fatal_recover(struct devlink_health_reporter *reporter,
				 void *priv_ctx,
				 struct netlink_ext_ack *extack)
{
	struct bnxt *bp = devlink_health_reporter_priv(reporter);
	struct bnxt_fw_reporter_ctx *fw_reporter_ctx = priv_ctx;
	unsigned long event;

	if (!priv_ctx)
		return -EOPNOTSUPP;

	bp->fw_health->fatal = true;
	event = fw_reporter_ctx->sp_event;
	if (event == BNXT_FW_RESET_NOTIFY_SP_EVENT)
		bnxt_fw_reset(bp);
	else if (event == BNXT_FW_EXCEPTION_SP_EVENT)
		bnxt_fw_exception(bp);

	return 0;
}

static const
struct devlink_health_reporter_ops bnxt_dl_fw_fatal_reporter_ops = {
	.name = "fw_fatal",
	.recover = bnxt_fw_fatal_recover,
};

static void bnxt_dl_fw_reporters_create(struct bnxt *bp)
{
	struct bnxt_fw_health *health = bp->fw_health;

	if (!health)
		return;

	health->fw_reporter =
		devlink_health_reporter_create(bp->dl, &bnxt_dl_fw_reporter_ops,
					       0, false, bp);
	if (IS_ERR(health->fw_reporter)) {
		netdev_warn(bp->dev, "Failed to create FW health reporter, rc = %ld\n",
			    PTR_ERR(health->fw_reporter));
		health->fw_reporter = NULL;
	}

	health->fw_reset_reporter =
		devlink_health_reporter_create(bp->dl,
					       &bnxt_dl_fw_reset_reporter_ops,
					       0, true, bp);
	if (IS_ERR(health->fw_reset_reporter)) {
		netdev_warn(bp->dev, "Failed to create FW fatal health reporter, rc = %ld\n",
			    PTR_ERR(health->fw_reset_reporter));
		health->fw_reset_reporter = NULL;
	}

	health->fw_fatal_reporter =
		devlink_health_reporter_create(bp->dl,
					       &bnxt_dl_fw_fatal_reporter_ops,
					       0, true, bp);
	if (IS_ERR(health->fw_fatal_reporter)) {
		netdev_warn(bp->dev, "Failed to create FW fatal health reporter, rc = %ld\n",
			    PTR_ERR(health->fw_fatal_reporter));
		health->fw_fatal_reporter = NULL;
	}
}

static void bnxt_dl_fw_reporters_destroy(struct bnxt *bp)
{
	struct bnxt_fw_health *health = bp->fw_health;

	if (!health)
		return;

	if (health->fw_reporter)
		devlink_health_reporter_destroy(health->fw_reporter);

	if (health->fw_reset_reporter)
		devlink_health_reporter_destroy(health->fw_reset_reporter);

	if (health->fw_fatal_reporter)
		devlink_health_reporter_destroy(health->fw_fatal_reporter);
}

void bnxt_devlink_health_report(struct bnxt *bp, unsigned long event)
{
	struct bnxt_fw_health *fw_health = bp->fw_health;
	struct bnxt_fw_reporter_ctx fw_reporter_ctx;

	if (!fw_health)
		return;

	fw_reporter_ctx.sp_event = event;
	switch (event) {
	case BNXT_FW_RESET_NOTIFY_SP_EVENT:
		if (test_bit(BNXT_STATE_FW_FATAL_COND, &bp->state)) {
			if (!fw_health->fw_fatal_reporter)
				return;

			devlink_health_report(fw_health->fw_fatal_reporter,
					      "FW fatal async event received",
					      &fw_reporter_ctx);
			return;
		}
		if (!fw_health->fw_reset_reporter)
			return;

		devlink_health_report(fw_health->fw_reset_reporter,
				      "FW non-fatal reset event received",
				      &fw_reporter_ctx);
		return;

	case BNXT_FW_EXCEPTION_SP_EVENT:
		if (!fw_health->fw_fatal_reporter)
			return;

		devlink_health_report(fw_health->fw_fatal_reporter,
				      "FW fatal error reported",
				      &fw_reporter_ctx);
		return;
	}
}

void bnxt_dl_health_status_update(struct bnxt *bp, bool healthy)
{
	struct bnxt_fw_health *health = bp->fw_health;
	u8 state;

	if (healthy)
		state = DEVLINK_HEALTH_REPORTER_STATE_HEALTHY;
	else
		state = DEVLINK_HEALTH_REPORTER_STATE_ERROR;

	if (health->fatal)
		devlink_health_reporter_state_update(health->fw_fatal_reporter,
						     state);
	else
		devlink_health_reporter_state_update(health->fw_reset_reporter,
						     state);

	health->fatal = false;
}

static const struct devlink_ops bnxt_dl_ops = {
#ifdef CONFIG_BNXT_SRIOV
	.eswitch_mode_set = bnxt_dl_eswitch_mode_set,
	.eswitch_mode_get = bnxt_dl_eswitch_mode_get,
#endif /* CONFIG_BNXT_SRIOV */
	.flash_update	  = bnxt_dl_flash_update,
};

enum bnxt_dl_param_id {
	BNXT_DEVLINK_PARAM_ID_BASE = DEVLINK_PARAM_GENERIC_ID_MAX,
	BNXT_DEVLINK_PARAM_ID_GRE_VER_CHECK,
};

static const struct bnxt_dl_nvm_param nvm_params[] = {
	{DEVLINK_PARAM_GENERIC_ID_ENABLE_SRIOV, NVM_OFF_ENABLE_SRIOV,
	 BNXT_NVM_SHARED_CFG, 1, 1},
	{DEVLINK_PARAM_GENERIC_ID_IGNORE_ARI, NVM_OFF_IGNORE_ARI,
	 BNXT_NVM_SHARED_CFG, 1, 1},
	{DEVLINK_PARAM_GENERIC_ID_MSIX_VEC_PER_PF_MAX,
	 NVM_OFF_MSIX_VEC_PER_PF_MAX, BNXT_NVM_SHARED_CFG, 10, 4},
	{DEVLINK_PARAM_GENERIC_ID_MSIX_VEC_PER_PF_MIN,
	 NVM_OFF_MSIX_VEC_PER_PF_MIN, BNXT_NVM_SHARED_CFG, 7, 4},
	{BNXT_DEVLINK_PARAM_ID_GRE_VER_CHECK, NVM_OFF_DIS_GRE_VER_CHECK,
	 BNXT_NVM_SHARED_CFG, 1, 1},
};

union bnxt_nvm_data {
	u8	val8;
	__le32	val32;
};

static void bnxt_copy_to_nvm_data(union bnxt_nvm_data *dst,
				  union devlink_param_value *src,
				  int nvm_num_bits, int dl_num_bytes)
{
	u32 val32 = 0;

	if (nvm_num_bits == 1) {
		dst->val8 = src->vbool;
		return;
	}
	if (dl_num_bytes == 4)
		val32 = src->vu32;
	else if (dl_num_bytes == 2)
		val32 = (u32)src->vu16;
	else if (dl_num_bytes == 1)
		val32 = (u32)src->vu8;
	dst->val32 = cpu_to_le32(val32);
}

static void bnxt_copy_from_nvm_data(union devlink_param_value *dst,
				    union bnxt_nvm_data *src,
				    int nvm_num_bits, int dl_num_bytes)
{
	u32 val32;

	if (nvm_num_bits == 1) {
		dst->vbool = src->val8;
		return;
	}
	val32 = le32_to_cpu(src->val32);
	if (dl_num_bytes == 4)
		dst->vu32 = val32;
	else if (dl_num_bytes == 2)
		dst->vu16 = (u16)val32;
	else if (dl_num_bytes == 1)
		dst->vu8 = (u8)val32;
}

static int bnxt_hwrm_nvm_req(struct bnxt *bp, u32 param_id, void *msg,
			     int msg_len, union devlink_param_value *val)
{
	struct hwrm_nvm_get_variable_input *req = msg;
	struct bnxt_dl_nvm_param nvm_param;
	union bnxt_nvm_data *data;
	dma_addr_t data_dma_addr;
	int idx = 0, rc, i;

	/* Get/Set NVM CFG parameter is supported only on PFs */
	if (BNXT_VF(bp))
		return -EPERM;

	for (i = 0; i < ARRAY_SIZE(nvm_params); i++) {
		if (nvm_params[i].id == param_id) {
			nvm_param = nvm_params[i];
			break;
		}
	}

	if (i == ARRAY_SIZE(nvm_params))
		return -EOPNOTSUPP;

	if (nvm_param.dir_type == BNXT_NVM_PORT_CFG)
		idx = bp->pf.port_id;
	else if (nvm_param.dir_type == BNXT_NVM_FUNC_CFG)
		idx = bp->pf.fw_fid - BNXT_FIRST_PF_FID;

	data = dma_alloc_coherent(&bp->pdev->dev, sizeof(*data),
				  &data_dma_addr, GFP_KERNEL);
	if (!data)
		return -ENOMEM;

	req->dest_data_addr = cpu_to_le64(data_dma_addr);
	req->data_len = cpu_to_le16(nvm_param.nvm_num_bits);
	req->option_num = cpu_to_le16(nvm_param.offset);
	req->index_0 = cpu_to_le16(idx);
	if (idx)
		req->dimensions = cpu_to_le16(1);

	if (req->req_type == cpu_to_le16(HWRM_NVM_SET_VARIABLE)) {
		bnxt_copy_to_nvm_data(data, val, nvm_param.nvm_num_bits,
				      nvm_param.dl_num_bytes);
		rc = hwrm_send_message(bp, msg, msg_len, HWRM_CMD_TIMEOUT);
	} else {
		rc = hwrm_send_message_silent(bp, msg, msg_len,
					      HWRM_CMD_TIMEOUT);
		if (!rc) {
			bnxt_copy_from_nvm_data(val, data,
						nvm_param.nvm_num_bits,
						nvm_param.dl_num_bytes);
		} else {
			struct hwrm_err_output *resp = bp->hwrm_cmd_resp_addr;

			if (resp->cmd_err ==
				NVM_GET_VARIABLE_CMD_ERR_CODE_VAR_NOT_EXIST)
				rc = -EOPNOTSUPP;
		}
	}
	dma_free_coherent(&bp->pdev->dev, sizeof(*data), data, data_dma_addr);
	if (rc == -EACCES)
		netdev_err(bp->dev, "PF does not have admin privileges to modify NVM config\n");
	return rc;
}

static int bnxt_dl_nvm_param_get(struct devlink *dl, u32 id,
				 struct devlink_param_gset_ctx *ctx)
{
	struct hwrm_nvm_get_variable_input req = {0};
	struct bnxt *bp = bnxt_get_bp_from_dl(dl);
	int rc;

	bnxt_hwrm_cmd_hdr_init(bp, &req, HWRM_NVM_GET_VARIABLE, -1, -1);
	rc = bnxt_hwrm_nvm_req(bp, id, &req, sizeof(req), &ctx->val);
	if (!rc)
		if (id == BNXT_DEVLINK_PARAM_ID_GRE_VER_CHECK)
			ctx->val.vbool = !ctx->val.vbool;

	return rc;
}

static int bnxt_dl_nvm_param_set(struct devlink *dl, u32 id,
				 struct devlink_param_gset_ctx *ctx)
{
	struct hwrm_nvm_set_variable_input req = {0};
	struct bnxt *bp = bnxt_get_bp_from_dl(dl);

	bnxt_hwrm_cmd_hdr_init(bp, &req, HWRM_NVM_SET_VARIABLE, -1, -1);

	if (id == BNXT_DEVLINK_PARAM_ID_GRE_VER_CHECK)
		ctx->val.vbool = !ctx->val.vbool;

	return bnxt_hwrm_nvm_req(bp, id, &req, sizeof(req), &ctx->val);
}

static int bnxt_dl_msix_validate(struct devlink *dl, u32 id,
				 union devlink_param_value val,
				 struct netlink_ext_ack *extack)
{
	int max_val = -1;

	if (id == DEVLINK_PARAM_GENERIC_ID_MSIX_VEC_PER_PF_MAX)
		max_val = BNXT_MSIX_VEC_MAX;

	if (id == DEVLINK_PARAM_GENERIC_ID_MSIX_VEC_PER_PF_MIN)
		max_val = BNXT_MSIX_VEC_MIN_MAX;

	if (val.vu32 > max_val) {
		NL_SET_ERR_MSG_MOD(extack, "MSIX value is exceeding the range");
		return -EINVAL;
	}

	return 0;
}

static const struct devlink_param bnxt_dl_params[] = {
	DEVLINK_PARAM_GENERIC(ENABLE_SRIOV,
			      BIT(DEVLINK_PARAM_CMODE_PERMANENT),
			      bnxt_dl_nvm_param_get, bnxt_dl_nvm_param_set,
			      NULL),
	DEVLINK_PARAM_GENERIC(IGNORE_ARI,
			      BIT(DEVLINK_PARAM_CMODE_PERMANENT),
			      bnxt_dl_nvm_param_get, bnxt_dl_nvm_param_set,
			      NULL),
	DEVLINK_PARAM_GENERIC(MSIX_VEC_PER_PF_MAX,
			      BIT(DEVLINK_PARAM_CMODE_PERMANENT),
			      bnxt_dl_nvm_param_get, bnxt_dl_nvm_param_set,
			      bnxt_dl_msix_validate),
	DEVLINK_PARAM_GENERIC(MSIX_VEC_PER_PF_MIN,
			      BIT(DEVLINK_PARAM_CMODE_PERMANENT),
			      bnxt_dl_nvm_param_get, bnxt_dl_nvm_param_set,
			      bnxt_dl_msix_validate),
	DEVLINK_PARAM_DRIVER(BNXT_DEVLINK_PARAM_ID_GRE_VER_CHECK,
			     "gre_ver_check", DEVLINK_PARAM_TYPE_BOOL,
			     BIT(DEVLINK_PARAM_CMODE_PERMANENT),
			     bnxt_dl_nvm_param_get, bnxt_dl_nvm_param_set,
			     NULL),
};

static const struct devlink_param bnxt_dl_port_params[] = {
};

int bnxt_dl_register(struct bnxt *bp)
{
	struct devlink *dl;
	int rc;

	if (bp->hwrm_spec_code < 0x10600) {
		netdev_warn(bp->dev, "Firmware does not support NVM params");
		return -ENOTSUPP;
	}

	dl = devlink_alloc(&bnxt_dl_ops, sizeof(struct bnxt_dl));
	if (!dl) {
		netdev_warn(bp->dev, "devlink_alloc failed");
		return -ENOMEM;
	}

	bnxt_link_bp_to_dl(bp, dl);

	/* Add switchdev eswitch mode setting, if SRIOV supported */
	if (pci_find_ext_capability(bp->pdev, PCI_EXT_CAP_ID_SRIOV) &&
	    bp->hwrm_spec_code > 0x10803)
		bp->eswitch_mode = DEVLINK_ESWITCH_MODE_LEGACY;

	rc = devlink_register(dl, &bp->pdev->dev);
	if (rc) {
		netdev_warn(bp->dev, "devlink_register failed. rc=%d", rc);
		goto err_dl_free;
	}

	rc = devlink_params_register(dl, bnxt_dl_params,
				     ARRAY_SIZE(bnxt_dl_params));
	if (rc) {
		netdev_warn(bp->dev, "devlink_params_register failed. rc=%d",
			    rc);
		goto err_dl_unreg;
	}

	devlink_port_attrs_set(&bp->dl_port, DEVLINK_PORT_FLAVOUR_PHYSICAL,
			       bp->pf.port_id, false, 0,
			       bp->switch_id, sizeof(bp->switch_id));
	rc = devlink_port_register(dl, &bp->dl_port, bp->pf.port_id);
	if (rc) {
		netdev_err(bp->dev, "devlink_port_register failed");
		goto err_dl_param_unreg;
	}
	devlink_port_type_eth_set(&bp->dl_port, bp->dev);

	rc = devlink_port_params_register(&bp->dl_port, bnxt_dl_port_params,
					  ARRAY_SIZE(bnxt_dl_port_params));
	if (rc) {
		netdev_err(bp->dev, "devlink_port_params_register failed");
		goto err_dl_port_unreg;
	}

	devlink_params_publish(dl);

	bnxt_dl_fw_reporters_create(bp);

	return 0;

err_dl_port_unreg:
	devlink_port_unregister(&bp->dl_port);
err_dl_param_unreg:
	devlink_params_unregister(dl, bnxt_dl_params,
				  ARRAY_SIZE(bnxt_dl_params));
err_dl_unreg:
	devlink_unregister(dl);
err_dl_free:
	bnxt_link_bp_to_dl(bp, NULL);
	devlink_free(dl);
	return rc;
}

void bnxt_dl_unregister(struct bnxt *bp)
{
	struct devlink *dl = bp->dl;

	if (!dl)
		return;

	bnxt_dl_fw_reporters_destroy(bp);
	devlink_port_params_unregister(&bp->dl_port, bnxt_dl_port_params,
				       ARRAY_SIZE(bnxt_dl_port_params));
	devlink_port_unregister(&bp->dl_port);
	devlink_params_unregister(dl, bnxt_dl_params,
				  ARRAY_SIZE(bnxt_dl_params));
	devlink_unregister(dl);
	devlink_free(dl);
}
Commit	Line	Data
3c467bf3 SL	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>
477edb78	12	#include <net/devlink.h>
3c467bf3 SL	13	#include "bnxt_hsi.h"
	14	#include "bnxt.h"
	15	#include "bnxt_vfr.h"
	16	#include "bnxt_devlink.h"
d168f328 VV	17	#include "bnxt_ethtool.h"
	18
	19	static int
	20	bnxt_dl_flash_update(struct devlink dl, const char filename,
	21	const char region, struct netlink_ext_ack extack)
	22	{
	23	struct bnxt *bp = bnxt_get_bp_from_dl(dl);
	24
	25	if (region)
	26	return -EOPNOTSUPP;
	27
	28	if (!BNXT_PF(bp)) {
	29	NL_SET_ERR_MSG_MOD(extack,
	30	"flash update not supported from a VF");
	31	return -EPERM;
	32	}
	33
	34	return bnxt_flash_package_from_file(bp->dev, filename, 0);
	35	}
3c467bf3	36
6763c779	37	static int bnxt_fw_reporter_diagnose(struct devlink_health_reporter *reporter,
e7a98105 JP	38	struct devlink_fmsg *fmsg,
e7a98105 JP	39	struct netlink_ext_ack *extack)
6763c779 VV	40	{
	41	struct bnxt *bp = devlink_health_reporter_priv(reporter);
	42	struct bnxt_fw_health *health = bp->fw_health;
	43	u32 val, health_status;
	44	int rc;
	45
	46	if (!health \|\| test_bit(BNXT_STATE_IN_FW_RESET, &bp->state))
	47	return 0;
	48
	49	val = bnxt_fw_health_readl(bp, BNXT_FW_HEALTH_REG);
	50	health_status = val & 0xffff;
	51
f255ed1c VV	52	if (health_status < BNXT_FW_STATUS_HEALTHY) {
	53	rc = devlink_fmsg_string_pair_put(fmsg, "Description",
	54	"Not yet completed initialization");
6763c779 VV	55	if (rc)
	56	return rc;
	57	} else if (health_status > BNXT_FW_STATUS_HEALTHY) {
f255ed1c VV	58	rc = devlink_fmsg_string_pair_put(fmsg, "Description",
f255ed1c VV	59	"Encountered fatal error and cannot recover");
6763c779 VV	60	if (rc)
	61	return rc;
	62	}
	63
	64	if (val >> 16) {
f255ed1c	65	rc = devlink_fmsg_u32_pair_put(fmsg, "Error code", val >> 16);
6763c779 VV	66	if (rc)
	67	return rc;
	68	}
	69
	70	val = bnxt_fw_health_readl(bp, BNXT_FW_RESET_CNT_REG);
	71	rc = devlink_fmsg_u32_pair_put(fmsg, "Reset count", val);
	72	if (rc)
	73	return rc;
	74
	75	return 0;
	76	}
	77
	78	static const struct devlink_health_reporter_ops bnxt_dl_fw_reporter_ops = {
	79	.name = "fw",
	80	.diagnose = bnxt_fw_reporter_diagnose,
	81	};
	82
657a33c8	83	static int bnxt_fw_reset_recover(struct devlink_health_reporter *reporter,
e7a98105 JP	84	void *priv_ctx,
e7a98105 JP	85	struct netlink_ext_ack *extack)
657a33c8 VV	86	{
	87	struct bnxt *bp = devlink_health_reporter_priv(reporter);
	88
	89	if (!priv_ctx)
	90	return -EOPNOTSUPP;
	91
	92	bnxt_fw_reset(bp);
	93	return 0;
	94	}
	95
	96	static const
	97	struct devlink_health_reporter_ops bnxt_dl_fw_reset_reporter_ops = {
	98	.name = "fw_reset",
	99	.recover = bnxt_fw_reset_recover,
	100	};
	101
acfb50e4	102	static int bnxt_fw_fatal_recover(struct devlink_health_reporter *reporter,
e7a98105 JP	103	void *priv_ctx,
e7a98105 JP	104	struct netlink_ext_ack *extack)
acfb50e4 VV	105	{
	106	struct bnxt *bp = devlink_health_reporter_priv(reporter);
	107	struct bnxt_fw_reporter_ctx *fw_reporter_ctx = priv_ctx;
	108	unsigned long event;
	109
	110	if (!priv_ctx)
	111	return -EOPNOTSUPP;
	112
e4e38237	113	bp->fw_health->fatal = true;
acfb50e4 VV	114	event = fw_reporter_ctx->sp_event;
	115	if (event == BNXT_FW_RESET_NOTIFY_SP_EVENT)
	116	bnxt_fw_reset(bp);
	117	else if (event == BNXT_FW_EXCEPTION_SP_EVENT)
	118	bnxt_fw_exception(bp);
	119
	120	return 0;
	121	}
	122
	123	static const
	124	struct devlink_health_reporter_ops bnxt_dl_fw_fatal_reporter_ops = {
	125	.name = "fw_fatal",
	126	.recover = bnxt_fw_fatal_recover,
	127	};
	128
6763c779 VV	129	static void bnxt_dl_fw_reporters_create(struct bnxt *bp)
	130	{
	131	struct bnxt_fw_health *health = bp->fw_health;
	132
	133	if (!health)
	134	return;
	135
	136	health->fw_reporter =
	137	devlink_health_reporter_create(bp->dl, &bnxt_dl_fw_reporter_ops,
	138	0, false, bp);
	139	if (IS_ERR(health->fw_reporter)) {
	140	netdev_warn(bp->dev, "Failed to create FW health reporter, rc = %ld\n",
	141	PTR_ERR(health->fw_reporter));
	142	health->fw_reporter = NULL;
	143	}
657a33c8 VV	144
	145	health->fw_reset_reporter =
	146	devlink_health_reporter_create(bp->dl,
	147	&bnxt_dl_fw_reset_reporter_ops,
	148	0, true, 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	}
acfb50e4 VV	154
	155	health->fw_fatal_reporter =
	156	devlink_health_reporter_create(bp->dl,
	157	&bnxt_dl_fw_fatal_reporter_ops,
	158	0, true, bp);
	159	if (IS_ERR(health->fw_fatal_reporter)) {
	160	netdev_warn(bp->dev, "Failed to create FW fatal health reporter, rc = %ld\n",
	161	PTR_ERR(health->fw_fatal_reporter));
	162	health->fw_fatal_reporter = NULL;
	163	}
6763c779 VV	164	}
	165
	166	static void bnxt_dl_fw_reporters_destroy(struct bnxt *bp)
	167	{
	168	struct bnxt_fw_health *health = bp->fw_health;
	169
	170	if (!health)
	171	return;
	172
	173	if (health->fw_reporter)
	174	devlink_health_reporter_destroy(health->fw_reporter);
657a33c8 VV	175
	176	if (health->fw_reset_reporter)
	177	devlink_health_reporter_destroy(health->fw_reset_reporter);
acfb50e4 VV	178
	179	if (health->fw_fatal_reporter)
	180	devlink_health_reporter_destroy(health->fw_fatal_reporter);
657a33c8 VV	181	}
	182
	183	void bnxt_devlink_health_report(struct bnxt *bp, unsigned long event)
	184	{
	185	struct bnxt_fw_health *fw_health = bp->fw_health;
	186	struct bnxt_fw_reporter_ctx fw_reporter_ctx;
	187
	188	if (!fw_health)
	189	return;
	190
	191	fw_reporter_ctx.sp_event = event;
	192	switch (event) {
	193	case BNXT_FW_RESET_NOTIFY_SP_EVENT:
acfb50e4 VV	194	if (test_bit(BNXT_STATE_FW_FATAL_COND, &bp->state)) {
	195	if (!fw_health->fw_fatal_reporter)
	196	return;
	197
	198	devlink_health_report(fw_health->fw_fatal_reporter,
	199	"FW fatal async event received",
	200	&fw_reporter_ctx);
	201	return;
	202	}
657a33c8 VV	203	if (!fw_health->fw_reset_reporter)
	204	return;
	205
	206	devlink_health_report(fw_health->fw_reset_reporter,
	207	"FW non-fatal reset event received",
	208	&fw_reporter_ctx);
	209	return;
acfb50e4 VV	210
	211	case BNXT_FW_EXCEPTION_SP_EVENT:
	212	if (!fw_health->fw_fatal_reporter)
	213	return;
	214
	215	devlink_health_report(fw_health->fw_fatal_reporter,
	216	"FW fatal error reported",
	217	&fw_reporter_ctx);
	218	return;
657a33c8	219	}
6763c779 VV	220	}
6763c779 VV	221
e4e38237 VV	222	void bnxt_dl_health_status_update(struct bnxt *bp, bool healthy)
	223	{
	224	struct bnxt_fw_health *health = bp->fw_health;
	225	u8 state;
	226
	227	if (healthy)
	228	state = DEVLINK_HEALTH_REPORTER_STATE_HEALTHY;
	229	else
	230	state = DEVLINK_HEALTH_REPORTER_STATE_ERROR;
	231
	232	if (health->fatal)
	233	devlink_health_reporter_state_update(health->fw_fatal_reporter,
	234	state);
	235	else
	236	devlink_health_reporter_state_update(health->fw_reset_reporter,
	237	state);
	238
	239	health->fatal = false;
	240	}
	241
3c467bf3 SL	242	static const struct devlink_ops bnxt_dl_ops = {
	243	#ifdef CONFIG_BNXT_SRIOV
	244	.eswitch_mode_set = bnxt_dl_eswitch_mode_set,
	245	.eswitch_mode_get = bnxt_dl_eswitch_mode_get,
	246	#endif /* CONFIG_BNXT_SRIOV */
d168f328	247	.flash_update = bnxt_dl_flash_update,
3c467bf3 SL	248	};
3c467bf3 SL	249
2dc0865e VV	250	enum bnxt_dl_param_id {
	251	BNXT_DEVLINK_PARAM_ID_BASE = DEVLINK_PARAM_GENERIC_ID_MAX,
	252	BNXT_DEVLINK_PARAM_ID_GRE_VER_CHECK,
	253	};
	254
6354b95e VV	255	static const struct bnxt_dl_nvm_param nvm_params[] = {
6354b95e VV	256	{DEVLINK_PARAM_GENERIC_ID_ENABLE_SRIOV, NVM_OFF_ENABLE_SRIOV,
c329230c	257	BNXT_NVM_SHARED_CFG, 1, 1},
7d859234	258	{DEVLINK_PARAM_GENERIC_ID_IGNORE_ARI, NVM_OFF_IGNORE_ARI,
c329230c	259	BNXT_NVM_SHARED_CFG, 1, 1},
f399e849	260	{DEVLINK_PARAM_GENERIC_ID_MSIX_VEC_PER_PF_MAX,
c329230c	261	NVM_OFF_MSIX_VEC_PER_PF_MAX, BNXT_NVM_SHARED_CFG, 10, 4},
f399e849	262	{DEVLINK_PARAM_GENERIC_ID_MSIX_VEC_PER_PF_MIN,
c329230c	263	NVM_OFF_MSIX_VEC_PER_PF_MIN, BNXT_NVM_SHARED_CFG, 7, 4},
2dc0865e	264	{BNXT_DEVLINK_PARAM_ID_GRE_VER_CHECK, NVM_OFF_DIS_GRE_VER_CHECK,
c329230c	265	BNXT_NVM_SHARED_CFG, 1, 1},
6354b95e VV	266	};
6354b95e VV	267
83a46a82 MC	268	union bnxt_nvm_data {
	269	u8 val8;
	270	__le32 val32;
	271	};
	272
	273	static void bnxt_copy_to_nvm_data(union bnxt_nvm_data *dst,
	274	union devlink_param_value *src,
	275	int nvm_num_bits, int dl_num_bytes)
	276	{
	277	u32 val32 = 0;
	278
	279	if (nvm_num_bits == 1) {
	280	dst->val8 = src->vbool;
	281	return;
	282	}
	283	if (dl_num_bytes == 4)
	284	val32 = src->vu32;
	285	else if (dl_num_bytes == 2)
	286	val32 = (u32)src->vu16;
	287	else if (dl_num_bytes == 1)
	288	val32 = (u32)src->vu8;
	289	dst->val32 = cpu_to_le32(val32);
	290	}
	291
	292	static void bnxt_copy_from_nvm_data(union devlink_param_value *dst,
	293	union bnxt_nvm_data *src,
	294	int nvm_num_bits, int dl_num_bytes)
	295	{
	296	u32 val32;
	297
	298	if (nvm_num_bits == 1) {
	299	dst->vbool = src->val8;
	300	return;
	301	}
	302	val32 = le32_to_cpu(src->val32);
	303	if (dl_num_bytes == 4)
	304	dst->vu32 = val32;
	305	else if (dl_num_bytes == 2)
	306	dst->vu16 = (u16)val32;
	307	else if (dl_num_bytes == 1)
	308	dst->vu8 = (u8)val32;
	309	}
	310
6354b95e VV	311	static int bnxt_hwrm_nvm_req(struct bnxt bp, u32 param_id, void msg,
	312	int msg_len, union devlink_param_value *val)
	313	{
6fc92c33	314	struct hwrm_nvm_get_variable_input *req = msg;
6354b95e	315	struct bnxt_dl_nvm_param nvm_param;
83a46a82	316	union bnxt_nvm_data *data;
6354b95e	317	dma_addr_t data_dma_addr;
c329230c	318	int idx = 0, rc, i;
6354b95e VV	319
	320	/* Get/Set NVM CFG parameter is supported only on PFs */
	321	if (BNXT_VF(bp))
	322	return -EPERM;
	323
	324	for (i = 0; i < ARRAY_SIZE(nvm_params); i++) {
	325	if (nvm_params[i].id == param_id) {
	326	nvm_param = nvm_params[i];
	327	break;
	328	}
	329	}
	330
65fac4fe	331	if (i == ARRAY_SIZE(nvm_params))
	332	return -EOPNOTSUPP;
	333
6354b95e VV	334	if (nvm_param.dir_type == BNXT_NVM_PORT_CFG)
	335	idx = bp->pf.port_id;
	336	else if (nvm_param.dir_type == BNXT_NVM_FUNC_CFG)
	337	idx = bp->pf.fw_fid - BNXT_FIRST_PF_FID;
	338
83a46a82 MC	339	data = dma_alloc_coherent(&bp->pdev->dev, sizeof(*data),
	340	&data_dma_addr, GFP_KERNEL);
	341	if (!data)
6354b95e VV	342	return -ENOMEM;
6354b95e VV	343
6fc92c33	344	req->dest_data_addr = cpu_to_le64(data_dma_addr);
c329230c	345	req->data_len = cpu_to_le16(nvm_param.nvm_num_bits);
6354b95e VV	346	req->option_num = cpu_to_le16(nvm_param.offset);
	347	req->index_0 = cpu_to_le16(idx);
	348	if (idx)
	349	req->dimensions = cpu_to_le16(1);
	350
b703ba75	351	if (req->req_type == cpu_to_le16(HWRM_NVM_SET_VARIABLE)) {
83a46a82 MC	352	bnxt_copy_to_nvm_data(data, val, nvm_param.nvm_num_bits,
83a46a82 MC	353	nvm_param.dl_num_bytes);
b703ba75 VV	354	rc = hwrm_send_message(bp, msg, msg_len, HWRM_CMD_TIMEOUT);
	355	} else {
	356	rc = hwrm_send_message_silent(bp, msg, msg_len,
	357	HWRM_CMD_TIMEOUT);
05069dd4	358	if (!rc) {
83a46a82 MC	359	bnxt_copy_from_nvm_data(val, data,
	360	nvm_param.nvm_num_bits,
	361	nvm_param.dl_num_bytes);
05069dd4 VV	362	} else {
	363	struct hwrm_err_output *resp = bp->hwrm_cmd_resp_addr;
	364
	365	if (resp->cmd_err ==
	366	NVM_GET_VARIABLE_CMD_ERR_CODE_VAR_NOT_EXIST)
	367	rc = -EOPNOTSUPP;
	368	}
b703ba75	369	}
83a46a82	370	dma_free_coherent(&bp->pdev->dev, sizeof(*data), data, data_dma_addr);
d4f1420d	371	if (rc == -EACCES)
3a1d52a5	372	netdev_err(bp->dev, "PF does not have admin privileges to modify NVM config\n");
d4f1420d	373	return rc;
6354b95e VV	374	}
	375
	376	static int bnxt_dl_nvm_param_get(struct devlink *dl, u32 id,
	377	struct devlink_param_gset_ctx *ctx)
	378	{
	379	struct hwrm_nvm_get_variable_input req = {0};
	380	struct bnxt *bp = bnxt_get_bp_from_dl(dl);
2dc0865e	381	int rc;
6354b95e VV	382
6354b95e VV	383	bnxt_hwrm_cmd_hdr_init(bp, &req, HWRM_NVM_GET_VARIABLE, -1, -1);
2dc0865e VV	384	rc = bnxt_hwrm_nvm_req(bp, id, &req, sizeof(req), &ctx->val);
	385	if (!rc)
	386	if (id == BNXT_DEVLINK_PARAM_ID_GRE_VER_CHECK)
	387	ctx->val.vbool = !ctx->val.vbool;
	388
	389	return rc;
6354b95e VV	390	}
	391
	392	static int bnxt_dl_nvm_param_set(struct devlink *dl, u32 id,
	393	struct devlink_param_gset_ctx *ctx)
	394	{
	395	struct hwrm_nvm_set_variable_input req = {0};
	396	struct bnxt *bp = bnxt_get_bp_from_dl(dl);
	397
	398	bnxt_hwrm_cmd_hdr_init(bp, &req, HWRM_NVM_SET_VARIABLE, -1, -1);
2dc0865e VV	399
	400	if (id == BNXT_DEVLINK_PARAM_ID_GRE_VER_CHECK)
	401	ctx->val.vbool = !ctx->val.vbool;
	402
6354b95e VV	403	return bnxt_hwrm_nvm_req(bp, id, &req, sizeof(req), &ctx->val);
	404	}
	405
f399e849 VV	406	static int bnxt_dl_msix_validate(struct devlink *dl, u32 id,
	407	union devlink_param_value val,
	408	struct netlink_ext_ack *extack)
	409	{
5fc7c12f	410	int max_val = -1;
f399e849 VV	411
	412	if (id == DEVLINK_PARAM_GENERIC_ID_MSIX_VEC_PER_PF_MAX)
	413	max_val = BNXT_MSIX_VEC_MAX;
	414
	415	if (id == DEVLINK_PARAM_GENERIC_ID_MSIX_VEC_PER_PF_MIN)
	416	max_val = BNXT_MSIX_VEC_MIN_MAX;
	417
5fc7c12f	418	if (val.vu32 > max_val) {
f399e849 VV	419	NL_SET_ERR_MSG_MOD(extack, "MSIX value is exceeding the range");
	420	return -EINVAL;
	421	}
	422
	423	return 0;
	424	}
	425
6354b95e VV	426	static const struct devlink_param bnxt_dl_params[] = {
	427	DEVLINK_PARAM_GENERIC(ENABLE_SRIOV,
	428	BIT(DEVLINK_PARAM_CMODE_PERMANENT),
	429	bnxt_dl_nvm_param_get, bnxt_dl_nvm_param_set,
	430	NULL),
7d859234 VV	431	DEVLINK_PARAM_GENERIC(IGNORE_ARI,
	432	BIT(DEVLINK_PARAM_CMODE_PERMANENT),
	433	bnxt_dl_nvm_param_get, bnxt_dl_nvm_param_set,
	434	NULL),
f399e849 VV	435	DEVLINK_PARAM_GENERIC(MSIX_VEC_PER_PF_MAX,
	436	BIT(DEVLINK_PARAM_CMODE_PERMANENT),
	437	bnxt_dl_nvm_param_get, bnxt_dl_nvm_param_set,
	438	bnxt_dl_msix_validate),
	439	DEVLINK_PARAM_GENERIC(MSIX_VEC_PER_PF_MIN,
	440	BIT(DEVLINK_PARAM_CMODE_PERMANENT),
	441	bnxt_dl_nvm_param_get, bnxt_dl_nvm_param_set,
	442	bnxt_dl_msix_validate),
2dc0865e VV	443	DEVLINK_PARAM_DRIVER(BNXT_DEVLINK_PARAM_ID_GRE_VER_CHECK,
	444	"gre_ver_check", DEVLINK_PARAM_TYPE_BOOL,
	445	BIT(DEVLINK_PARAM_CMODE_PERMANENT),
	446	bnxt_dl_nvm_param_get, bnxt_dl_nvm_param_set,
	447	NULL),
6354b95e VV	448	};
6354b95e VV	449
782a624d	450	static const struct devlink_param bnxt_dl_port_params[] = {
782a624d VV	451	};
782a624d VV	452
3c467bf3 SL	453	int bnxt_dl_register(struct bnxt *bp)
	454	{
	455	struct devlink *dl;
	456	int rc;
	457
6354b95e VV	458	if (bp->hwrm_spec_code < 0x10600) {
6354b95e VV	459	netdev_warn(bp->dev, "Firmware does not support NVM params");
3c467bf3 SL	460	return -ENOTSUPP;
	461	}
	462
	463	dl = devlink_alloc(&bnxt_dl_ops, sizeof(struct bnxt_dl));
	464	if (!dl) {
	465	netdev_warn(bp->dev, "devlink_alloc failed");
	466	return -ENOMEM;
	467	}
	468
	469	bnxt_link_bp_to_dl(bp, dl);
6354b95e VV	470
	471	/* Add switchdev eswitch mode setting, if SRIOV supported */
	472	if (pci_find_ext_capability(bp->pdev, PCI_EXT_CAP_ID_SRIOV) &&
	473	bp->hwrm_spec_code > 0x10803)
	474	bp->eswitch_mode = DEVLINK_ESWITCH_MODE_LEGACY;
	475
3c467bf3 SL	476	rc = devlink_register(dl, &bp->pdev->dev);
3c467bf3 SL	477	if (rc) {
3c467bf3	478	netdev_warn(bp->dev, "devlink_register failed. rc=%d", rc);
6354b95e VV	479	goto err_dl_free;
	480	}
	481
	482	rc = devlink_params_register(dl, bnxt_dl_params,
	483	ARRAY_SIZE(bnxt_dl_params));
	484	if (rc) {
	485	netdev_warn(bp->dev, "devlink_params_register failed. rc=%d",
	486	rc);
	487	goto err_dl_unreg;
3c467bf3 SL	488	}
3c467bf3 SL	489
a0e18132	490	devlink_port_attrs_set(&bp->dl_port, DEVLINK_PORT_FLAVOUR_PHYSICAL,
6605a226 JP	491	bp->pf.port_id, false, 0,
6605a226 JP	492	bp->switch_id, sizeof(bp->switch_id));
782a624d VV	493	rc = devlink_port_register(dl, &bp->dl_port, bp->pf.port_id);
	494	if (rc) {
	495	netdev_err(bp->dev, "devlink_port_register failed");
	496	goto err_dl_param_unreg;
	497	}
d0d54e8c	498	devlink_port_type_eth_set(&bp->dl_port, bp->dev);
782a624d VV	499
	500	rc = devlink_port_params_register(&bp->dl_port, bnxt_dl_port_params,
	501	ARRAY_SIZE(bnxt_dl_port_params));
	502	if (rc) {
	503	netdev_err(bp->dev, "devlink_port_params_register failed");
	504	goto err_dl_port_unreg;
	505	}
7c62cfb8 JP	506
	507	devlink_params_publish(dl);
	508
6763c779 VV	509	bnxt_dl_fw_reporters_create(bp);
6763c779 VV	510
3c467bf3	511	return 0;
6354b95e	512
782a624d VV	513	err_dl_port_unreg:
	514	devlink_port_unregister(&bp->dl_port);
	515	err_dl_param_unreg:
	516	devlink_params_unregister(dl, bnxt_dl_params,
	517	ARRAY_SIZE(bnxt_dl_params));
6354b95e VV	518	err_dl_unreg:
	519	devlink_unregister(dl);
	520	err_dl_free:
	521	bnxt_link_bp_to_dl(bp, NULL);
	522	devlink_free(dl);
	523	return rc;
3c467bf3 SL	524	}
	525
	526	void bnxt_dl_unregister(struct bnxt *bp)
	527	{
	528	struct devlink *dl = bp->dl;
	529
	530	if (!dl)
	531	return;
	532
6763c779	533	bnxt_dl_fw_reporters_destroy(bp);
782a624d VV	534	devlink_port_params_unregister(&bp->dl_port, bnxt_dl_port_params,
	535	ARRAY_SIZE(bnxt_dl_port_params));
	536	devlink_port_unregister(&bp->dl_port);
6354b95e VV	537	devlink_params_unregister(dl, bnxt_dl_params,
6354b95e VV	538	ARRAY_SIZE(bnxt_dl_params));
3c467bf3 SL	539	devlink_unregister(dl);
	540	devlink_free(dl);
	541	}