forked from luck/tmp_suning_uos_patched
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>
This commit is contained in:
parent
d85a301c26
commit
f9ac6273e5
@ -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);
|
||||
|
Loading…
Reference in New Issue
Block a user