mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-09-12 21:57:43 +00:00
d8827ae8e2
devlink_health_reporter_create may fail. In that case, do the cleanup work. Reported-by: Dan Carpenter <dan.carpenter@oracle.com> Signed-off-by: Coiby Xu <coxu@redhat.com> Link: https://lore.kernel.org/r/20210324010002.109846-1-coxu@redhat.com Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
167 lines
4.8 KiB
C
167 lines
4.8 KiB
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;
|
|
}
|