staging/qlge/qlge_devlink.c

0001 // SPDX-License-Identifier: GPL-2.0-or-later
0002 #include "qlge.h"
0003 #include "qlge_devlink.h"
0004
0005 static int qlge_fill_seg_(struct devlink_fmsg *fmsg,
0006               struct mpi_coredump_segment_header *seg_header,
0007               u32 *reg_data)
0008 {
0009     int regs_num = (seg_header->seg_size
0010             - sizeof(struct mpi_coredump_segment_header)) / sizeof(u32);
0011     int err;
0012     int i;
0013
0014     err = devlink_fmsg_pair_nest_start(fmsg, seg_header->description);
0015     if (err)
0016         return err;
0017     err = devlink_fmsg_obj_nest_start(fmsg);
0018     if (err)
0019         return err;
0020     err = devlink_fmsg_u32_pair_put(fmsg, "segment", seg_header->seg_num);
0021     if (err)
0022         return err;
0023     err = devlink_fmsg_arr_pair_nest_start(fmsg, "values");
0024     if (err)
0025         return err;
0026     for (i = 0; i < regs_num; i++) {
0027         err = devlink_fmsg_u32_put(fmsg, *reg_data);
0028         if (err)
0029             return err;
0030         reg_data++;
0031     }
0032     err = devlink_fmsg_obj_nest_end(fmsg);
0033     if (err)
0034         return err;
0035     err = devlink_fmsg_arr_pair_nest_end(fmsg);
0036     if (err)
0037         return err;
0038     err = devlink_fmsg_pair_nest_end(fmsg);
0039     return err;
0040 }
0041
0042 #define FILL_SEG(seg_hdr, seg_regs)                             \
0043     do {                                                                \
0044         err = qlge_fill_seg_(fmsg, &dump->seg_hdr, dump->seg_regs); \
0045         if (err) {                              \
0046             kvfree(dump);                                       \
0047             return err;                         \
0048         }                                                           \
0049     } while (0)
0050
0051 static int qlge_reporter_coredump(struct devlink_health_reporter *reporter,
0052                   struct devlink_fmsg *fmsg, void *priv_ctx,
0053                   struct netlink_ext_ack *extack)
0054 {
0055     int err = 0;
0056
0057     struct qlge_adapter *qdev = devlink_health_reporter_priv(reporter);
0058     struct qlge_mpi_coredump *dump;
0059     wait_queue_head_t wait;
0060
0061     if (!netif_running(qdev->ndev))
0062         return 0;
0063
0064     if (test_bit(QL_FRC_COREDUMP, &qdev->flags)) {
0065         if (qlge_own_firmware(qdev)) {
0066             qlge_queue_fw_error(qdev);
0067             init_waitqueue_head(&wait);
0068             wait_event_timeout(wait, 0, 5 * HZ);
0069         } else {
0070             netif_err(qdev, ifup, qdev->ndev,
0071                   "Force Coredump failed because this NIC function doesn't own the firmware\n");
0072             return -EPERM;
0073         }
0074     }
0075
0076     dump = kvmalloc(sizeof(*dump), GFP_KERNEL);
0077     if (!dump)
0078         return -ENOMEM;
0079
0080     err = qlge_core_dump(qdev, dump);
0081     if (err) {
0082         kvfree(dump);
0083         return err;
0084     }
0085
0086     qlge_soft_reset_mpi_risc(qdev);
0087
0088     FILL_SEG(core_regs_seg_hdr, mpi_core_regs);
0089     FILL_SEG(test_logic_regs_seg_hdr, test_logic_regs);
0090     FILL_SEG(rmii_regs_seg_hdr, rmii_regs);
0091     FILL_SEG(fcmac1_regs_seg_hdr, fcmac1_regs);
0092     FILL_SEG(fcmac2_regs_seg_hdr, fcmac2_regs);
0093     FILL_SEG(fc1_mbx_regs_seg_hdr, fc1_mbx_regs);
0094     FILL_SEG(ide_regs_seg_hdr, ide_regs);
0095     FILL_SEG(nic1_mbx_regs_seg_hdr, nic1_mbx_regs);
0096     FILL_SEG(smbus_regs_seg_hdr, smbus_regs);
0097     FILL_SEG(fc2_mbx_regs_seg_hdr, fc2_mbx_regs);
0098     FILL_SEG(nic2_mbx_regs_seg_hdr, nic2_mbx_regs);
0099     FILL_SEG(i2c_regs_seg_hdr, i2c_regs);
0100     FILL_SEG(memc_regs_seg_hdr, memc_regs);
0101     FILL_SEG(pbus_regs_seg_hdr, pbus_regs);
0102     FILL_SEG(mde_regs_seg_hdr, mde_regs);
0103     FILL_SEG(nic_regs_seg_hdr, nic_regs);
0104     FILL_SEG(nic2_regs_seg_hdr, nic2_regs);
0105     FILL_SEG(xgmac1_seg_hdr, xgmac1);
0106     FILL_SEG(xgmac2_seg_hdr, xgmac2);
0107     FILL_SEG(code_ram_seg_hdr, code_ram);
0108     FILL_SEG(memc_ram_seg_hdr, memc_ram);
0109     FILL_SEG(xaui_an_hdr, serdes_xaui_an);
0110     FILL_SEG(xaui_hss_pcs_hdr, serdes_xaui_hss_pcs);
0111     FILL_SEG(xfi_an_hdr, serdes_xfi_an);
0112     FILL_SEG(xfi_train_hdr, serdes_xfi_train);
0113     FILL_SEG(xfi_hss_pcs_hdr, serdes_xfi_hss_pcs);
0114     FILL_SEG(xfi_hss_tx_hdr, serdes_xfi_hss_tx);
0115     FILL_SEG(xfi_hss_rx_hdr, serdes_xfi_hss_rx);
0116     FILL_SEG(xfi_hss_pll_hdr, serdes_xfi_hss_pll);
0117
0118     err = qlge_fill_seg_(fmsg, &dump->misc_nic_seg_hdr,
0119                  (u32 *)&dump->misc_nic_info);
0120     if (err) {
0121         kvfree(dump);
0122         return err;
0123     }
0124
0125     FILL_SEG(intr_states_seg_hdr, intr_states);
0126     FILL_SEG(cam_entries_seg_hdr, cam_entries);
0127     FILL_SEG(nic_routing_words_seg_hdr, nic_routing_words);
0128     FILL_SEG(ets_seg_hdr, ets);
0129     FILL_SEG(probe_dump_seg_hdr, probe_dump);
0130     FILL_SEG(routing_reg_seg_hdr, routing_regs);
0131     FILL_SEG(mac_prot_reg_seg_hdr, mac_prot_regs);
0132     FILL_SEG(xaui2_an_hdr, serdes2_xaui_an);
0133     FILL_SEG(xaui2_hss_pcs_hdr, serdes2_xaui_hss_pcs);
0134     FILL_SEG(xfi2_an_hdr, serdes2_xfi_an);
0135     FILL_SEG(xfi2_train_hdr, serdes2_xfi_train);
0136     FILL_SEG(xfi2_hss_pcs_hdr, serdes2_xfi_hss_pcs);
0137     FILL_SEG(xfi2_hss_tx_hdr, serdes2_xfi_hss_tx);
0138     FILL_SEG(xfi2_hss_rx_hdr, serdes2_xfi_hss_rx);
0139     FILL_SEG(xfi2_hss_pll_hdr, serdes2_xfi_hss_pll);
0140     FILL_SEG(sem_regs_seg_hdr, sem_regs);
0141
0142     kvfree(dump);
0143     return err;
0144 }
0145
0146 static const struct devlink_health_reporter_ops qlge_reporter_ops = {
0147     .name = "coredump",
0148     .dump = qlge_reporter_coredump,
0149 };
0150
0151 long qlge_health_create_reporters(struct qlge_adapter *priv)
0152 {
0153     struct devlink *devlink;
0154     long err = 0;
0155
0156     devlink = priv_to_devlink(priv);
0157     priv->reporter =
0158         devlink_health_reporter_create(devlink, &qlge_reporter_ops,
0159                            0, priv);
0160     if (IS_ERR(priv->reporter)) {
0161         err = PTR_ERR(priv->reporter);
0162         netdev_warn(priv->ndev,
0163                 "Failed to create reporter, err = %ld\n",
0164                 err);
0165     }
0166     return err;
0167 }