NFC: nfcsim: Add support for sysfs control entry

The idea is to have a way to control and/or modify the behavior of the
nfcsim virtual devices.

This patch creates a folder tree in the debug filesystem. The debugfs is
usually mounted into /sys/kernel/debug and the nfcsim entries are
located in DEBUGFS/nfcsim/nfcX/ where X is either 0 or 1 depending on
the device you want to address.

These folders are empty for now and control entries will be added by
upcoming commits.

Signed-off-by: Thierry Escande <thierry.escande@collabora.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>

diff --git a/drivers/nfc/nfcsim.c b/drivers/nfc/nfcsim.c
index 40b4846509f419be81a5fe01a8785729d08f9f67..97067a5f248cdc11d7d6af978eb2c2046fa820e6 100644 (file)
--- a/drivers/nfc/nfcsim.c
+++ b/drivers/nfc/nfcsim.c
@@ -16,6 +16,8 @@
 #include <linux/device.h>
 #include <linux/kernel.h>
 #include <linux/module.h>
+#include <linux/ctype.h>
+#include <linux/debugfs.h>
 #include <linux/nfc.h>
 #include <net/nfc/nfc.h>
 #include <net/nfc/digital.h>
@@ -329,6 +331,49 @@ static struct nfc_digital_ops nfcsim_digital_ops = {
        .switch_rf = nfcsim_switch_rf,
 };
 
+static struct dentry *nfcsim_debugfs_root;
+
+static void nfcsim_debugfs_init(void)
+{
+       nfcsim_debugfs_root = debugfs_create_dir("nfcsim", NULL);
+
+       if (!nfcsim_debugfs_root)
+               pr_err("Could not create debugfs entry\n");
+
+}
+
+static void nfcsim_debugfs_remove(void)
+{
+       debugfs_remove_recursive(nfcsim_debugfs_root);
+}
+
+static void nfcsim_debugfs_init_dev(struct nfcsim *dev)
+{
+       struct dentry *dev_dir;
+       char devname[5]; /* nfcX\0 */
+       u32 idx;
+       int n;
+
+       if (!nfcsim_debugfs_root) {
+               NFCSIM_ERR(dev, "nfcsim debugfs not initialized\n");
+               return;
+       }
+
+       idx = dev->nfc_digital_dev->nfc_dev->idx;
+       n = snprintf(devname, sizeof(devname), "nfc%d", idx);
+       if (n >= sizeof(devname)) {
+               NFCSIM_ERR(dev, "Could not compute dev name for dev %d\n", idx);
+               return;
+       }
+
+       dev_dir = debugfs_create_dir(devname, nfcsim_debugfs_root);
+       if (!dev_dir) {
+               NFCSIM_ERR(dev, "Could not create debugfs entries for nfc%d\n",
+                          idx);
+               return;
+       }
+}
+
 static struct nfcsim *nfcsim_device_new(struct nfcsim_link *link_in,
                                        struct nfcsim_link *link_out)
 {
@@ -366,6 +411,8 @@ static struct nfcsim *nfcsim_device_new(struct nfcsim_link *link_in,
                return ERR_PTR(rc);
        }
 
+       nfcsim_debugfs_init_dev(dev);
+
        return dev;
 }
 
@@ -400,6 +447,8 @@ static int __init nfcsim_init(void)
                goto exit_err;
        }
 
+       nfcsim_debugfs_init();
+
        dev0 = nfcsim_device_new(link0, link1);
        if (IS_ERR(dev0)) {
                rc = PTR_ERR(dev0);
@@ -439,6 +488,8 @@ static void __exit nfcsim_exit(void)
 
        nfcsim_link_free(link0);
        nfcsim_link_free(link1);
+
+       nfcsim_debugfs_remove();
 }
 
 module_init(nfcsim_init);