Linux-6.18.2/drivers/net/ethernet/broadcom/bnge/bnge_devlink.c

// SPDX-License-Identifier: GPL-2.0
// Copyright (c) 2025 Broadcom.

#include <linux/unaligned.h>
#include <linux/pci.h>
#include <linux/types.h>
#include <net/devlink.h>

#include "bnge.h"
#include "bnge_devlink.h"
#include "bnge_hwrm_lib.h"

static int bnge_dl_info_put(struct bnge_dev *bd, struct devlink_info_req *req,
			    enum bnge_dl_version_type type, const char *key,
			    char *buf)
{
	if (!strlen(buf))
		return 0;

	if (!strcmp(key, DEVLINK_INFO_VERSION_GENERIC_FW_NCSI) ||
	    !strcmp(key, DEVLINK_INFO_VERSION_GENERIC_FW_ROCE))
		return 0;

	switch (type) {
	case BNGE_VERSION_FIXED:
		return devlink_info_version_fixed_put(req, key, buf);
	case BNGE_VERSION_RUNNING:
		return devlink_info_version_running_put(req, key, buf);
	case BNGE_VERSION_STORED:
		return devlink_info_version_stored_put(req, key, buf);
	}

	return 0;
}

static void bnge_vpd_read_info(struct bnge_dev *bd)
{
	struct pci_dev *pdev = bd->pdev;
	unsigned int vpd_size, kw_len;
	int pos, size;
	u8 *vpd_data;

	vpd_data = pci_vpd_alloc(pdev, &vpd_size);
	if (IS_ERR(vpd_data)) {
		pci_warn(pdev, "Unable to read VPD\n");
		return;
	}

	pos = pci_vpd_find_ro_info_keyword(vpd_data, vpd_size,
					   PCI_VPD_RO_KEYWORD_PARTNO, &kw_len);
	if (pos < 0)
		goto read_sn;

	size = min_t(int, kw_len, BNGE_VPD_FLD_LEN - 1);
	memcpy(bd->board_partno, &vpd_data[pos], size);

read_sn:
	pos = pci_vpd_find_ro_info_keyword(vpd_data, vpd_size,
					   PCI_VPD_RO_KEYWORD_SERIALNO,
					   &kw_len);
	if (pos < 0)
		goto exit;

	size = min_t(int, kw_len, BNGE_VPD_FLD_LEN - 1);
	memcpy(bd->board_serialno, &vpd_data[pos], size);

exit:
	kfree(vpd_data);
}

#define HWRM_FW_VER_STR_LEN	16

static int bnge_devlink_info_get(struct devlink *devlink,
				 struct devlink_info_req *req,
				 struct netlink_ext_ack *extack)
{
	struct hwrm_nvm_get_dev_info_output nvm_dev_info;
	struct bnge_dev *bd = devlink_priv(devlink);
	struct hwrm_ver_get_output *ver_resp;
	char mgmt_ver[FW_VER_STR_LEN];
	char roce_ver[FW_VER_STR_LEN];
	char ncsi_ver[FW_VER_STR_LEN];
	char buf[32];

	int rc;

	if (bd->dsn) {
		char buf[32];
		u8 dsn[8];
		int rc;

		put_unaligned_le64(bd->dsn, dsn);
		sprintf(buf, "%02X-%02X-%02X-%02X-%02X-%02X-%02X-%02X",
			dsn[7], dsn[6], dsn[5], dsn[4],
			dsn[3], dsn[2], dsn[1], dsn[0]);
		rc = devlink_info_serial_number_put(req, buf);
		if (rc) {
			NL_SET_ERR_MSG_MOD(extack, "Failed to set dsn");
			return rc;
		}
	}

	if (strlen(bd->board_serialno)) {
		rc = devlink_info_board_serial_number_put(req,
							  bd->board_serialno);
		if (rc) {
			NL_SET_ERR_MSG_MOD(extack,
					   "Failed to set board serial number");
			return rc;
		}
	}

	rc = bnge_dl_info_put(bd, req, BNGE_VERSION_FIXED,
			      DEVLINK_INFO_VERSION_GENERIC_BOARD_ID,
			      bd->board_partno);
	if (rc) {
		NL_SET_ERR_MSG_MOD(extack, "Failed to set board part number");
		return rc;
	}

	/* More information from HWRM ver get command */
	sprintf(buf, "%X", bd->chip_num);
	rc = bnge_dl_info_put(bd, req, BNGE_VERSION_FIXED,
			      DEVLINK_INFO_VERSION_GENERIC_ASIC_ID, buf);
	if (rc) {
		NL_SET_ERR_MSG_MOD(extack, "Failed to set asic id");
		return rc;
	}

	ver_resp = &bd->ver_resp;
	sprintf(buf, "%c%d", 'A' + ver_resp->chip_rev, ver_resp->chip_metal);
	rc = bnge_dl_info_put(bd, req, BNGE_VERSION_FIXED,
			      DEVLINK_INFO_VERSION_GENERIC_ASIC_REV, buf);
	if (rc) {
		NL_SET_ERR_MSG_MOD(extack, "Failed to set asic info");
		return rc;
	}

	rc = bnge_dl_info_put(bd, req, BNGE_VERSION_RUNNING,
			      DEVLINK_INFO_VERSION_GENERIC_FW_PSID,
			      bd->nvm_cfg_ver);
	if (rc) {
		NL_SET_ERR_MSG_MOD(extack, "Failed to set firmware version");
		return rc;
	}

	buf[0] = 0;
	strncat(buf, ver_resp->active_pkg_name, HWRM_FW_VER_STR_LEN);
	rc = bnge_dl_info_put(bd, req, BNGE_VERSION_RUNNING,
			      DEVLINK_INFO_VERSION_GENERIC_FW, buf);
	if (rc) {
		NL_SET_ERR_MSG_MOD(extack,
				   "Failed to set firmware generic version");
		return rc;
	}

	if (ver_resp->flags & VER_GET_RESP_FLAGS_EXT_VER_AVAIL) {
		snprintf(mgmt_ver, FW_VER_STR_LEN, "%d.%d.%d.%d",
			 ver_resp->hwrm_fw_major, ver_resp->hwrm_fw_minor,
			 ver_resp->hwrm_fw_build, ver_resp->hwrm_fw_patch);

		snprintf(ncsi_ver, FW_VER_STR_LEN, "%d.%d.%d.%d",
			 ver_resp->mgmt_fw_major, ver_resp->mgmt_fw_minor,
			 ver_resp->mgmt_fw_build, ver_resp->mgmt_fw_patch);

		snprintf(roce_ver, FW_VER_STR_LEN, "%d.%d.%d.%d",
			 ver_resp->roce_fw_major, ver_resp->roce_fw_minor,
			 ver_resp->roce_fw_build, ver_resp->roce_fw_patch);
	} else {
		snprintf(mgmt_ver, FW_VER_STR_LEN, "%d.%d.%d.%d",
			 ver_resp->hwrm_fw_maj_8b, ver_resp->hwrm_fw_min_8b,
			 ver_resp->hwrm_fw_bld_8b, ver_resp->hwrm_fw_rsvd_8b);

		snprintf(ncsi_ver, FW_VER_STR_LEN, "%d.%d.%d.%d",
			 ver_resp->mgmt_fw_maj_8b, ver_resp->mgmt_fw_min_8b,
			 ver_resp->mgmt_fw_bld_8b, ver_resp->mgmt_fw_rsvd_8b);

		snprintf(roce_ver, FW_VER_STR_LEN, "%d.%d.%d.%d",
			 ver_resp->roce_fw_maj_8b, ver_resp->roce_fw_min_8b,
			 ver_resp->roce_fw_bld_8b, ver_resp->roce_fw_rsvd_8b);
	}
	rc = bnge_dl_info_put(bd, req, BNGE_VERSION_RUNNING,
			      DEVLINK_INFO_VERSION_GENERIC_FW_MGMT, mgmt_ver);
	if (rc) {
		NL_SET_ERR_MSG_MOD(extack,
				   "Failed to set firmware mgmt version");
		return rc;
	}

	rc = bnge_dl_info_put(bd, req, BNGE_VERSION_RUNNING,
			      DEVLINK_INFO_VERSION_GENERIC_FW_MGMT_API,
			      bd->hwrm_ver_supp);
	if (rc) {
		NL_SET_ERR_MSG_MOD(extack,
				   "Failed to set firmware mgmt api version");
		return rc;
	}

	rc = bnge_dl_info_put(bd, req, BNGE_VERSION_RUNNING,
			      DEVLINK_INFO_VERSION_GENERIC_FW_NCSI, ncsi_ver);
	if (rc) {
		NL_SET_ERR_MSG_MOD(extack,
				   "Failed to set ncsi firmware version");
		return rc;
	}

	rc = bnge_dl_info_put(bd, req, BNGE_VERSION_RUNNING,
			      DEVLINK_INFO_VERSION_GENERIC_FW_ROCE, roce_ver);
	if (rc) {
		NL_SET_ERR_MSG_MOD(extack, "Failed to set roce firmware version");
		return rc;
	}

	rc = bnge_hwrm_nvm_dev_info(bd, &nvm_dev_info);
	if (!(nvm_dev_info.flags & NVM_GET_DEV_INFO_RESP_FLAGS_FW_VER_VALID))
		return 0;

	buf[0] = 0;
	strncat(buf, nvm_dev_info.pkg_name, HWRM_FW_VER_STR_LEN);
	rc = bnge_dl_info_put(bd, req, BNGE_VERSION_STORED,
			      DEVLINK_INFO_VERSION_GENERIC_FW, buf);
	if (rc) {
		NL_SET_ERR_MSG_MOD(extack,
				   "Failed to set roce firmware version");
		return rc;
	}

	snprintf(mgmt_ver, FW_VER_STR_LEN, "%d.%d.%d.%d",
		 nvm_dev_info.hwrm_fw_major, nvm_dev_info.hwrm_fw_minor,
		 nvm_dev_info.hwrm_fw_build, nvm_dev_info.hwrm_fw_patch);
	rc = bnge_dl_info_put(bd, req, BNGE_VERSION_STORED,
			      DEVLINK_INFO_VERSION_GENERIC_FW_MGMT, mgmt_ver);
	if (rc) {
		NL_SET_ERR_MSG_MOD(extack,
				   "Failed to set stored firmware version");
		return rc;
	}

	snprintf(ncsi_ver, FW_VER_STR_LEN, "%d.%d.%d.%d",
		 nvm_dev_info.mgmt_fw_major, nvm_dev_info.mgmt_fw_minor,
		 nvm_dev_info.mgmt_fw_build, nvm_dev_info.mgmt_fw_patch);
	rc = bnge_dl_info_put(bd, req, BNGE_VERSION_STORED,
			      DEVLINK_INFO_VERSION_GENERIC_FW_NCSI, ncsi_ver);
	if (rc) {
		NL_SET_ERR_MSG_MOD(extack,
				   "Failed to set stored ncsi firmware version");
		return rc;
	}

	snprintf(roce_ver, FW_VER_STR_LEN, "%d.%d.%d.%d",
		 nvm_dev_info.roce_fw_major, nvm_dev_info.roce_fw_minor,
		 nvm_dev_info.roce_fw_build, nvm_dev_info.roce_fw_patch);
	rc = bnge_dl_info_put(bd, req, BNGE_VERSION_STORED,
			      DEVLINK_INFO_VERSION_GENERIC_FW_ROCE, roce_ver);
	if (rc)
		NL_SET_ERR_MSG_MOD(extack,
				   "Failed to set stored roce firmware version");

	return rc;
}

static const struct devlink_ops bnge_devlink_ops = {
	.info_get = bnge_devlink_info_get,
};

void bnge_devlink_free(struct bnge_dev *bd)
{
	struct devlink *devlink = priv_to_devlink(bd);

	devlink_free(devlink);
}

struct bnge_dev *bnge_devlink_alloc(struct pci_dev *pdev)
{
	struct devlink *devlink;
	struct bnge_dev *bd;

	devlink = devlink_alloc(&bnge_devlink_ops, sizeof(*bd), &pdev->dev);
	if (!devlink)
		return NULL;

	bd = devlink_priv(devlink);
	pci_set_drvdata(pdev, bd);
	bd->dev = &pdev->dev;
	bd->pdev = pdev;

	bd->dsn = pci_get_dsn(pdev);
	if (!bd->dsn)
		pci_warn(pdev, "Failed to get DSN\n");

	bnge_vpd_read_info(bd);

	return bd;
}

void bnge_devlink_register(struct bnge_dev *bd)
{
	struct devlink *devlink = priv_to_devlink(bd);
	devlink_register(devlink);
}

void bnge_devlink_unregister(struct bnge_dev *bd)
{
	struct devlink *devlink = priv_to_devlink(bd);
	devlink_unregister(devlink);
}