Commit 1053c278 authored by Coiby Xu's avatar Coiby Xu Committed by Greg Kroah-Hartman
Browse files

staging: qlge: coredump via devlink health reporter 



    $ devlink health dump show DEVICE reporter coredump -p -j
    {
        "Core Registers": {
            "segment": 1,
            "values": [ 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0 ]
        },
        "Test Logic Regs": {
            "segment": 2,
            "values": [ 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0 ]
        },
        "RMII Registers": {
            "segment": 3,
            "values": [ 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0 ]
        },
        ...
        "Sem Registers": {
            "segment": 50,
            "values": [ 0,0,0,0 ]
        }
    }

Signed-off-by: default avatarCoiby Xu <coiby.xu@gmail.com>
Link: https://lore.kernel.org/r/20210123104613.38359-5-coiby.xu@gmail.com


Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
parent b9ccc256

drivers/staging/qlge/qlge_devlink.c

+126 −6
Original line number Diff line number Diff line
@@ -2,16 +2,136 @@ 
#include "qlge.h"

#include "qlge_devlink.h"



static int

qlge_reporter_coredump(struct devlink_health_reporter *reporter,

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;



	if (!netif_running(qdev->ndev))

		return 0;



	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 = "dummy",

	.name = "coredump",

	.dump = qlge_reporter_coredump,

};