drivers/staging/qlge/qlge_devlink.c

// SPDX-License-Identifier: GPL-2.0-or-later
#include "qlge.h"
#include "qlge_devlink.h"

static int qlge_fill_seg_(struct devlink_fmsg *fmsg,
			  struct mpi_coredump_segment_header *seg_header,
			  u32 *reg_data)
{
	int regs_num = (seg_header->seg_size
			- sizeof(struct mpi_coredump_segment_header)) / sizeof(u32);
	int err;
	int i;

	err = devlink_fmsg_pair_nest_start(fmsg, seg_header->description);
	if (err)
		return err;
	err = devlink_fmsg_obj_nest_start(fmsg);
	if (err)
		return err;
	err = devlink_fmsg_u32_pair_put(fmsg, "segment", seg_header->seg_num);
	if (err)
		return err;
	err = devlink_fmsg_arr_pair_nest_start(fmsg, "values");
	if (err)
		return err;
	for (i = 0; i < regs_num; i++) {
		err = devlink_fmsg_u32_put(fmsg, *reg_data);
		if (err)
			return err;
		reg_data++;
	}
	err = devlink_fmsg_obj_nest_end(fmsg);
	if (err)
		return err;
	err = devlink_fmsg_arr_pair_nest_end(fmsg);
	if (err)
		return err;
	err = devlink_fmsg_pair_nest_end(fmsg);
	return err;
}

#define FILL_SEG(seg_hdr, seg_regs)			                    \
	do {                                                                \
		err = qlge_fill_seg_(fmsg, &dump->seg_hdr, dump->seg_regs); \
		if (err) {					            \
			kvfree(dump);                                       \
			return err;				            \
		}                                                           \
	} while (0)

static int qlge_reporter_coredump(struct devlink_health_reporter *reporter,
				  struct devlink_fmsg *fmsg, void *priv_ctx,
				  struct netlink_ext_ack *extack)
{
	int err = 0;

	struct qlge_adapter *qdev = devlink_health_reporter_priv(reporter);
	struct qlge_mpi_coredump *dump;
	wait_queue_head_t wait;

	if (!netif_running(qdev->ndev))
		return 0;

	if (test_bit(QL_FRC_COREDUMP, &qdev->flags)) {
		if (qlge_own_firmware(qdev)) {
			qlge_queue_fw_error(qdev);
			init_waitqueue_head(&wait);
			wait_event_timeout(wait, 0, 5 * HZ);
		} else {
			netif_err(qdev, ifup, qdev->ndev,
				  "Force Coredump failed because this NIC function doesn't own the firmware\n");
			return -EPERM;
		}
	}

	dump = kvmalloc(sizeof(*dump), GFP_KERNEL);
	if (!dump)
		return -ENOMEM;

	err = qlge_core_dump(qdev, dump);
	if (err) {
		kvfree(dump);
		return err;
	}

	qlge_soft_reset_mpi_risc(qdev);

	FILL_SEG(core_regs_seg_hdr, mpi_core_regs);
	FILL_SEG(test_logic_regs_seg_hdr, test_logic_regs);
	FILL_SEG(rmii_regs_seg_hdr, rmii_regs);
	FILL_SEG(fcmac1_regs_seg_hdr, fcmac1_regs);
	FILL_SEG(fcmac2_regs_seg_hdr, fcmac2_regs);
	FILL_SEG(fc1_mbx_regs_seg_hdr, fc1_mbx_regs);
	FILL_SEG(ide_regs_seg_hdr, ide_regs);
	FILL_SEG(nic1_mbx_regs_seg_hdr, nic1_mbx_regs);
	FILL_SEG(smbus_regs_seg_hdr, smbus_regs);
	FILL_SEG(fc2_mbx_regs_seg_hdr, fc2_mbx_regs);
	FILL_SEG(nic2_mbx_regs_seg_hdr, nic2_mbx_regs);
	FILL_SEG(i2c_regs_seg_hdr, i2c_regs);
	FILL_SEG(memc_regs_seg_hdr, memc_regs);
	FILL_SEG(pbus_regs_seg_hdr, pbus_regs);
	FILL_SEG(mde_regs_seg_hdr, mde_regs);
	FILL_SEG(nic_regs_seg_hdr, nic_regs);
	FILL_SEG(nic2_regs_seg_hdr, nic2_regs);
	FILL_SEG(xgmac1_seg_hdr, xgmac1);
	FILL_SEG(xgmac2_seg_hdr, xgmac2);
	FILL_SEG(code_ram_seg_hdr, code_ram);
	FILL_SEG(memc_ram_seg_hdr, memc_ram);
	FILL_SEG(xaui_an_hdr, serdes_xaui_an);
	FILL_SEG(xaui_hss_pcs_hdr, serdes_xaui_hss_pcs);
	FILL_SEG(xfi_an_hdr, serdes_xfi_an);
	FILL_SEG(xfi_train_hdr, serdes_xfi_train);
	FILL_SEG(xfi_hss_pcs_hdr, serdes_xfi_hss_pcs);
	FILL_SEG(xfi_hss_tx_hdr, serdes_xfi_hss_tx);
	FILL_SEG(xfi_hss_rx_hdr, serdes_xfi_hss_rx);
	FILL_SEG(xfi_hss_pll_hdr, serdes_xfi_hss_pll);

	err = qlge_fill_seg_(fmsg, &dump->misc_nic_seg_hdr,
			     (u32 *)&dump->misc_nic_info);
	if (err) {
		kvfree(dump);
		return err;
	}

	FILL_SEG(intr_states_seg_hdr, intr_states);
	FILL_SEG(cam_entries_seg_hdr, cam_entries);
	FILL_SEG(nic_routing_words_seg_hdr, nic_routing_words);
	FILL_SEG(ets_seg_hdr, ets);
	FILL_SEG(probe_dump_seg_hdr, probe_dump);
	FILL_SEG(routing_reg_seg_hdr, routing_regs);
	FILL_SEG(mac_prot_reg_seg_hdr, mac_prot_regs);
	FILL_SEG(xaui2_an_hdr, serdes2_xaui_an);
	FILL_SEG(xaui2_hss_pcs_hdr, serdes2_xaui_hss_pcs);
	FILL_SEG(xfi2_an_hdr, serdes2_xfi_an);
	FILL_SEG(xfi2_train_hdr, serdes2_xfi_train);
	FILL_SEG(xfi2_hss_pcs_hdr, serdes2_xfi_hss_pcs);
	FILL_SEG(xfi2_hss_tx_hdr, serdes2_xfi_hss_tx);
	FILL_SEG(xfi2_hss_rx_hdr, serdes2_xfi_hss_rx);
	FILL_SEG(xfi2_hss_pll_hdr, serdes2_xfi_hss_pll);
	FILL_SEG(sem_regs_seg_hdr, sem_regs);

	kvfree(dump);
	return err;
}

static const struct devlink_health_reporter_ops qlge_reporter_ops = {
	.name = "coredump",
	.dump = qlge_reporter_coredump,
};

long qlge_health_create_reporters(struct qlge_adapter *priv)
{
	struct devlink *devlink;
	long err = 0;

	devlink = priv_to_devlink(priv);
	priv->reporter =
		devlink_health_reporter_create(devlink, &qlge_reporter_ops,
					       0, priv);
	if (IS_ERR(priv->reporter)) {
		err = PTR_ERR(priv->reporter);
		netdev_warn(priv->ndev,
			    "Failed to create reporter, err = %ld\n",
			    err);
	}
	return err;
}