aboutsummaryrefslogtreecommitdiff
path: root/src/drivers/device/cdev.cpp
diff options
context:
space:
mode:
authorAndrew Tridgell <tridge@samba.org>2013-12-07 22:43:54 +1100
committerLorenz Meier <lm@inf.ethz.ch>2013-12-10 11:31:04 +0100
commitb2b9665e4460ce25718509b7abb75c4b702c4c5f (patch)
tree259b860871b0c8dd98c1b39660d948443855d9f0 /src/drivers/device/cdev.cpp
parent895dc3a2bbf172c7a2095d3a815cdd13d1388816 (diff)
downloadpx4-firmware-b2b9665e4460ce25718509b7abb75c4b702c4c5f.tar.gz
px4-firmware-b2b9665e4460ce25718509b7abb75c4b702c4c5f.tar.bz2
px4-firmware-b2b9665e4460ce25718509b7abb75c4b702c4c5f.zip
device: added register_class_devname() API
this allows drivers to register generic device names for a device class, with automatic class instance handling
Diffstat (limited to 'src/drivers/device/cdev.cpp')
-rw-r--r--src/drivers/device/cdev.cpp36
1 files changed, 36 insertions, 0 deletions
diff --git a/src/drivers/device/cdev.cpp b/src/drivers/device/cdev.cpp
index 47ebcd40a..7954ce5ab 100644
--- a/src/drivers/device/cdev.cpp
+++ b/src/drivers/device/cdev.cpp
@@ -109,6 +109,42 @@ CDev::~CDev()
}
int
+CDev::register_class_devname(const char *class_devname)
+{
+ if (class_devname == nullptr) {
+ return -EINVAL;
+ }
+ int class_instance = 0;
+ int ret = -ENOSPC;
+ while (class_instance < 4) {
+ if (class_instance == 0) {
+ ret = register_driver(class_devname, &fops, 0666, (void *)this);
+ if (ret == OK) break;
+ } else {
+ char name[32];
+ snprintf(name, sizeof(name), "%s%u", class_devname, class_instance);
+ ret = register_driver(name, &fops, 0666, (void *)this);
+ if (ret == OK) break;
+ }
+ class_instance++;
+ }
+ if (class_instance == 4)
+ return ret;
+ return class_instance;
+}
+
+int
+CDev::unregister_class_devname(const char *class_devname, unsigned class_instance)
+{
+ if (class_instance > 0) {
+ char name[32];
+ snprintf(name, sizeof(name), "%s%u", class_devname, class_instance);
+ return unregister_driver(name);
+ }
+ return unregister_driver(class_devname);
+}
+
+int
CDev::init()
{
// base class init first