qed: implement devlink dump

Gather and push out full device dump to devlink.
Device dump is the same as with `ethtool -d`, but now its generated
exactly at the moment bad thing happens.

Signed-off-by: Igor Russkikh <irusskikh@marvell.com>
Signed-off-by: Alexander Lobakin <alobakin@marvell.com>
Signed-off-by: Michal Kalderon <michal.kalderon@marvell.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

diff --git a/drivers/net/ethernet/qlogic/qed/qed_devlink.c b/drivers/net/ethernet/qlogic/qed/qed_devlink.c
index bc4e40f135fffe35efc6b10ebe9bbe1edbca2fbf..cf7f4da68e69fe266280837e2d4c263ba63c8c29 100644 (file)
--- a/drivers/net/ethernet/qlogic/qed/qed_devlink.c
+++ b/drivers/net/ethernet/qlogic/qed/qed_devlink.c
@@ -6,6 +6,7 @@
 
 #include <linux/kernel.h>
 #include <linux/qed/qed_if.h>
+#include <linux/vmalloc.h>
 #include "qed.h"
 #include "qed_devlink.h"
 
@@ -32,6 +33,47 @@ int qed_report_fatal_error(struct devlink *devlink, enum qed_hw_err_type err_typ
        return 0;
 }
 
+static int
+qed_fw_fatal_reporter_dump(struct devlink_health_reporter *reporter,
+                          struct devlink_fmsg *fmsg, void *priv_ctx,
+                          struct netlink_ext_ack *extack)
+{
+       struct qed_devlink *qdl = devlink_health_reporter_priv(reporter);
+       struct qed_fw_fatal_ctx *fw_fatal_ctx = priv_ctx;
+       struct qed_dev *cdev = qdl->cdev;
+       u32 dbg_data_buf_size;
+       u8 *p_dbg_data_buf;
+       int err;
+
+       /* Having context means that was a dump request after fatal,
+        * so we enable extra debugging while gathering the dump,
+        * just in case
+        */
+       cdev->print_dbg_data = fw_fatal_ctx ? true : false;
+
+       dbg_data_buf_size = qed_dbg_all_data_size(cdev);
+       p_dbg_data_buf = vzalloc(dbg_data_buf_size);
+       if (!p_dbg_data_buf) {
+               DP_NOTICE(cdev,
+                         "Failed to allocate memory for a debug data buffer\n");
+               return -ENOMEM;
+       }
+
+       err = qed_dbg_all_data(cdev, p_dbg_data_buf);
+       if (err) {
+               DP_NOTICE(cdev, "Failed to obtain debug data\n");
+               vfree(p_dbg_data_buf);
+               return err;
+       }
+
+       err = devlink_fmsg_binary_pair_put(fmsg, "dump_data",
+                                          p_dbg_data_buf, dbg_data_buf_size);
+
+       vfree(p_dbg_data_buf);
+
+       return err;
+}
+
 static int
 qed_fw_fatal_reporter_recover(struct devlink_health_reporter *reporter,
                              void *priv_ctx,
@@ -48,6 +90,7 @@ qed_fw_fatal_reporter_recover(struct devlink_health_reporter *reporter,
 static const struct devlink_health_reporter_ops qed_fw_fatal_reporter_ops = {
                .name = "fw_fatal",
                .recover = qed_fw_fatal_reporter_recover,
+               .dump = qed_fw_fatal_reporter_dump,
 };
 
 #define QED_REPORTER_FW_GRACEFUL_PERIOD 1200000