crypto: caam/qi2 - Add printing dpseci fq stats using debugfs

Add support of printing the dpseci frame queue statistics using debugfs.

Signed-off-by: Vakul Garg <vakul.garg@nxp.com>
Reviewed-by: Horia Geantă <horia.geanta@nxp.com>
Signed-off-by: Herbert Xu <herbert@gondor.apana.org.au>

diff --git a/drivers/crypto/caam/Makefile b/drivers/crypto/caam/Makefile
index 9ab4e81..68d5cc0 100644 (file)
--- a/drivers/crypto/caam/Makefile
+++ b/drivers/crypto/caam/Makefile
@@ -30,3 +30,4 @@ endif
 obj-$(CONFIG_CRYPTO_DEV_FSL_DPAA2_CAAM) += dpaa2_caam.o
 
 dpaa2_caam-y    := caamalg_qi2.o dpseci.o
+dpaa2_caam-$(CONFIG_DEBUG_FS) += dpseci-debugfs.o

diff --git a/drivers/crypto/caam/caamalg_qi2.c b/drivers/crypto/caam/caamalg_qi2.c
index 06bf32c..a78a36d 100644 (file)
--- a/drivers/crypto/caam/caamalg_qi2.c
+++ b/drivers/crypto/caam/caamalg_qi2.c
@@ -15,6 +15,7 @@
 #include "key_gen.h"
 #include "caamalg_desc.h"
 #include "caamhash_desc.h"
+#include "dpseci-debugfs.h"
 #include <linux/fsl/mc.h>
 #include <soc/fsl/dpaa2-io.h>
 #include <soc/fsl/dpaa2-fd.h>
@@ -5098,6 +5099,8 @@ static int dpaa2_caam_probe(struct fsl_mc_device *dpseci_dev)
                goto err_bind;
        }
 
+       dpaa2_dpseci_debugfs_init(priv);
+
        /* register crypto algorithms the device supports */
        for (i = 0; i < ARRAY_SIZE(driver_algs); i++) {
                struct caam_skcipher_alg *t_alg = driver_algs + i;
@@ -5265,6 +5268,8 @@ static int __cold dpaa2_caam_remove(struct fsl_mc_device *ls_dev)
        dev = &ls_dev->dev;
        priv = dev_get_drvdata(dev);
 
+       dpaa2_dpseci_debugfs_exit(priv);
+
        for (i = 0; i < ARRAY_SIZE(driver_aeads); i++) {
                struct caam_aead_alg *t_alg = driver_aeads + i;
 

diff --git a/drivers/crypto/caam/caamalg_qi2.h b/drivers/crypto/caam/caamalg_qi2.h
index 973f629..b450e2a 100644 (file)
--- a/drivers/crypto/caam/caamalg_qi2.h
+++ b/drivers/crypto/caam/caamalg_qi2.h
@@ -10,6 +10,7 @@
 #include <soc/fsl/dpaa2-io.h>
 #include <soc/fsl/dpaa2-fd.h>
 #include <linux/threads.h>
+#include <linux/netdevice.h>
 #include "dpseci.h"
 #include "desc_constr.h"
 
@@ -64,6 +65,7 @@ struct dpaa2_caam_priv {
        struct iommu_domain *domain;
 
        struct dpaa2_caam_priv_per_cpu __percpu *ppriv;
+       struct dentry *dfs_root;
 };
 
 /**

diff --git a/drivers/crypto/caam/dpseci-debugfs.c b/drivers/crypto/caam/dpseci-debugfs.c
new file mode 100644 (file)
index 0000000..c5bfc92
--- /dev/null
+++ b/drivers/crypto/caam/dpseci-debugfs.c
@@ -0,0 +1,79 @@
+// SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause)
+/* Copyright 2019 NXP */
+
+#include <linux/module.h>
+#include <linux/device.h>
+#include <linux/debugfs.h>
+#include "dpseci-debugfs.h"
+
+static int dpseci_dbg_fqs_show(struct seq_file *file, void *offset)
+{
+       struct dpaa2_caam_priv *priv = (struct dpaa2_caam_priv *)file->private;
+       u32 fqid, fcnt, bcnt;
+       int i, err;
+
+       seq_printf(file, "FQ stats for %s:\n", dev_name(priv->dev));
+       seq_printf(file, "%s%16s%16s\n",
+                  "Rx-VFQID",
+                  "Pending frames",
+                  "Pending bytes");
+
+       for (i = 0; i <  priv->num_pairs; i++) {
+               fqid = priv->rx_queue_attr[i].fqid;
+               err = dpaa2_io_query_fq_count(NULL, fqid, &fcnt, &bcnt);
+               if (err)
+                       continue;
+
+               seq_printf(file, "%5d%16u%16u\n", fqid, fcnt, bcnt);
+       }
+
+       seq_printf(file, "%s%16s%16s\n",
+                  "Tx-VFQID",
+                  "Pending frames",
+                  "Pending bytes");
+
+       for (i = 0; i <  priv->num_pairs; i++) {
+               fqid = priv->tx_queue_attr[i].fqid;
+               err = dpaa2_io_query_fq_count(NULL, fqid, &fcnt, &bcnt);
+               if (err)
+                       continue;
+
+               seq_printf(file, "%5d%16u%16u\n", fqid, fcnt, bcnt);
+       }
+
+       return 0;
+}
+
+static int dpseci_dbg_fqs_open(struct inode *inode, struct file *file)
+{
+       int err;
+       struct dpaa2_caam_priv *priv;
+
+       priv = (struct dpaa2_caam_priv *)inode->i_private;
+
+       err = single_open(file, dpseci_dbg_fqs_show, priv);
+       if (err < 0)
+               dev_err(priv->dev, "single_open() failed\n");
+
+       return err;
+}
+
+static const struct file_operations dpseci_dbg_fq_ops = {
+       .open = dpseci_dbg_fqs_open,
+       .read = seq_read,
+       .llseek = seq_lseek,
+       .release = single_release,
+};
+
+void dpaa2_dpseci_debugfs_init(struct dpaa2_caam_priv *priv)
+{
+       priv->dfs_root = debugfs_create_dir(dev_name(priv->dev), NULL);
+
+       debugfs_create_file("fq_stats", 0444, priv->dfs_root, priv,
+                           &dpseci_dbg_fq_ops);
+}
+
+void dpaa2_dpseci_debugfs_exit(struct dpaa2_caam_priv *priv)
+{
+       debugfs_remove_recursive(priv->dfs_root);
+}

diff --git a/drivers/crypto/caam/dpseci-debugfs.h b/drivers/crypto/caam/dpseci-debugfs.h
new file mode 100644 (file)
index 0000000..bc22af7
--- /dev/null
+++ b/drivers/crypto/caam/dpseci-debugfs.h
@@ -0,0 +1,18 @@
+/* SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause) */
+/* Copyright 2019 NXP */
+
+#ifndef DPSECI_DEBUGFS_H
+#define DPSECI_DEBUGFS_H
+
+#include <linux/dcache.h>
+#include "caamalg_qi2.h"
+
+#ifdef CONFIG_DEBUG_FS
+void dpaa2_dpseci_debugfs_init(struct dpaa2_caam_priv *priv);
+void dpaa2_dpseci_debugfs_exit(struct dpaa2_caam_priv *priv);
+#else
+static inline void dpaa2_dpseci_debugfs_init(struct dpaa2_caam_priv *priv) {}
+static inline void dpaa2_dpseci_debugfs_exit(struct dpaa2_caam_priv *priv) {}
+#endif /* CONFIG_DEBUG_FS */
+
+#endif /* DPSECI_DEBUGFS_H */