qlge: Add xgmac reg blocks to firwmare dump.

Signed-off-by: Ron Mercer <ron.mercer@qlogic.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

1 files changed, 87 insertions, 0 deletions

diff --git a/drivers/net/qlge/qlge_dbg.c b/drivers/net/qlge/qlge_dbg.c
index 87e50d9c3350..ec4349a254cc 100644
--- a/drivers/net/qlge/qlge_dbg.c
+++ b/drivers/net/qlge/qlge_dbg.c
@@ -331,6 +331,76 @@ static int ql_get_serdes_regs(struct ql_adapter *qdev,
         return 0;
 }
 
+static int ql_read_other_func_xgmac_reg(struct ql_adapter *qdev, u32 reg,
+                                                        u32 *data)
+{
+        int status = 0;
+
+        /* wait for reg to come ready */
+        status = ql_wait_other_func_reg_rdy(qdev, XGMAC_ADDR / 4,
+                                                XGMAC_ADDR_RDY, XGMAC_ADDR_XME);
+        if (status)
+                goto exit;
+
+        /* set up for reg read */
+        ql_write_other_func_reg(qdev, XGMAC_ADDR / 4, reg | XGMAC_ADDR_R);
+
+        /* wait for reg to come ready */
+        status = ql_wait_other_func_reg_rdy(qdev, XGMAC_ADDR / 4,
+                                                XGMAC_ADDR_RDY, XGMAC_ADDR_XME);
+        if (status)
+                goto exit;
+
+        /* get the data */
+        *data = ql_read_other_func_reg(qdev, XGMAC_DATA / 4);
+exit:
+        return status;
+}
+
+/* Read the 400 xgmac control/statistics registers
+ * skipping unused locations.
+ */
+static int ql_get_xgmac_regs(struct ql_adapter *qdev, u32 * buf,
+                                        unsigned int other_function)
+{
+        int status = 0;
+        int i;
+
+        for (i = PAUSE_SRC_LO; i < XGMAC_REGISTER_END; i += 4, buf++) {
+                /* We're reading 400 xgmac registers, but we filter out
+                 * serveral locations that are non-responsive to reads.
+                 */
+                if ((i == 0x00000114) ||
+                        (i == 0x00000118) ||
+                        (i == 0x0000013c) ||
+                        (i == 0x00000140) ||
+                        (i > 0x00000150 && i < 0x000001fc) ||
+                        (i > 0x00000278 && i < 0x000002a0) ||
+                        (i > 0x000002c0 && i < 0x000002cf) ||
+                        (i > 0x000002dc && i < 0x000002f0) ||
+                        (i > 0x000003c8 && i < 0x00000400) ||
+                        (i > 0x00000400 && i < 0x00000410) ||
+                        (i > 0x00000410 && i < 0x00000420) ||
+                        (i > 0x00000420 && i < 0x00000430) ||
+                        (i > 0x00000430 && i < 0x00000440) ||
+                        (i > 0x00000440 && i < 0x00000450) ||
+                        (i > 0x00000450 && i < 0x00000500) ||
+                        (i > 0x0000054c && i < 0x00000568) ||
+                        (i > 0x000005c8 && i < 0x00000600)) {
+                        if (other_function)
+                                status =
+                                ql_read_other_func_xgmac_reg(qdev, i, buf);
+                        else
+                                status = ql_read_xgmac_reg(qdev, i, buf);
+
+                        if (status)
+                                *buf = 0xdeadbeef;
+                        break;
+                }
+        }
+        return status;
+}
+
 static int ql_get_ets_regs(struct ql_adapter *qdev, u32 * buf)
 {
         int status = 0;
@@ -706,6 +776,17 @@ int ql_core_dump(struct ql_adapter *qdev, struct ql_mpi_coredump *mpi_coredump)
                         sizeof(struct mpi_coredump_segment_header) +
                         sizeof(mpi_coredump->nic2_regs), "NIC2 Registers");
 
+        /* Get XGMac registers. (Segment 18, Rev C. step 21) */
+        ql_build_coredump_seg_header(&mpi_coredump->xgmac1_seg_hdr,
+                        NIC1_XGMAC_SEG_NUM,
+                        sizeof(struct mpi_coredump_segment_header) +
+                        sizeof(mpi_coredump->xgmac1), "NIC1 XGMac Registers");
+
+        ql_build_coredump_seg_header(&mpi_coredump->xgmac2_seg_hdr,
+                        NIC2_XGMAC_SEG_NUM,
+                        sizeof(struct mpi_coredump_segment_header) +
+                        sizeof(mpi_coredump->xgmac2), "NIC2 XGMac Registers");
+
         if (qdev->func & 1) {
                 /* Odd means our function is NIC 2 */
                 for (i = 0; i < NIC_REGS_DUMP_WORD_COUNT; i++)
@@ -715,6 +796,9 @@ int ql_core_dump(struct ql_adapter *qdev, struct ql_mpi_coredump *mpi_coredump)
                 for (i = 0; i < NIC_REGS_DUMP_WORD_COUNT; i++)
                         mpi_coredump->nic_regs[i] =
                         ql_read_other_func_reg(qdev, (i * sizeof(u32)) / 4);
+
+                ql_get_xgmac_regs(qdev, &mpi_coredump->xgmac2[0], 0);
+                ql_get_xgmac_regs(qdev, &mpi_coredump->xgmac1[0], 1);
         } else {
                 /* Even means our function is NIC 1 */
                 for (i = 0; i < NIC_REGS_DUMP_WORD_COUNT; i++)
@@ -723,6 +807,9 @@ int ql_core_dump(struct ql_adapter *qdev, struct ql_mpi_coredump *mpi_coredump)
                 for (i = 0; i < NIC_REGS_DUMP_WORD_COUNT; i++)
                         mpi_coredump->nic2_regs[i] =
                         ql_read_other_func_reg(qdev, (i * sizeof(u32)) / 4);
+
+                ql_get_xgmac_regs(qdev, &mpi_coredump->xgmac1[0], 0);
+                ql_get_xgmac_regs(qdev, &mpi_coredump->xgmac2[0], 1);
         }
 
         /* Rev C. Step 20a */