|
@@ -35,10 +35,12 @@
|
|
|
#include <linux/watchdog.h> /* For watchdog specific items */
|
|
|
#include <linux/init.h> /* For __init/__exit/... */
|
|
|
#include <linux/idr.h> /* For ida_* macros */
|
|
|
+#include <linux/err.h> /* For IS_ERR macros */
|
|
|
|
|
|
#include "watchdog_core.h" /* For watchdog_dev_register/... */
|
|
|
|
|
|
static DEFINE_IDA(watchdog_ida);
|
|
|
+static struct class *watchdog_class;
|
|
|
|
|
|
/**
|
|
|
* watchdog_register_device() - register a watchdog device
|
|
@@ -52,7 +54,7 @@ static DEFINE_IDA(watchdog_ida);
|
|
|
*/
|
|
|
int watchdog_register_device(struct watchdog_device *wdd)
|
|
|
{
|
|
|
- int ret, id;
|
|
|
+ int ret, id, devno;
|
|
|
|
|
|
if (wdd == NULL || wdd->info == NULL || wdd->ops == NULL)
|
|
|
return -EINVAL;
|
|
@@ -101,6 +103,16 @@ int watchdog_register_device(struct watchdog_device *wdd)
|
|
|
}
|
|
|
}
|
|
|
|
|
|
+ devno = wdd->cdev.dev;
|
|
|
+ wdd->dev = device_create(watchdog_class, wdd->parent, devno,
|
|
|
+ NULL, "watchdog%d", wdd->id);
|
|
|
+ if (IS_ERR(wdd->dev)) {
|
|
|
+ watchdog_dev_unregister(wdd);
|
|
|
+ ida_simple_remove(&watchdog_ida, id);
|
|
|
+ ret = PTR_ERR(wdd->dev);
|
|
|
+ return ret;
|
|
|
+ }
|
|
|
+
|
|
|
return 0;
|
|
|
}
|
|
|
EXPORT_SYMBOL_GPL(watchdog_register_device);
|
|
@@ -115,6 +127,7 @@ EXPORT_SYMBOL_GPL(watchdog_register_device);
|
|
|
void watchdog_unregister_device(struct watchdog_device *wdd)
|
|
|
{
|
|
|
int ret;
|
|
|
+ int devno = wdd->cdev.dev;
|
|
|
|
|
|
if (wdd == NULL)
|
|
|
return;
|
|
@@ -122,18 +135,35 @@ void watchdog_unregister_device(struct watchdog_device *wdd)
|
|
|
ret = watchdog_dev_unregister(wdd);
|
|
|
if (ret)
|
|
|
pr_err("error unregistering /dev/watchdog (err=%d)\n", ret);
|
|
|
+ device_destroy(watchdog_class, devno);
|
|
|
ida_simple_remove(&watchdog_ida, wdd->id);
|
|
|
+ wdd->dev = NULL;
|
|
|
}
|
|
|
EXPORT_SYMBOL_GPL(watchdog_unregister_device);
|
|
|
|
|
|
static int __init watchdog_init(void)
|
|
|
{
|
|
|
- return watchdog_dev_init();
|
|
|
+ int err;
|
|
|
+
|
|
|
+ watchdog_class = class_create(THIS_MODULE, "watchdog");
|
|
|
+ if (IS_ERR(watchdog_class)) {
|
|
|
+ pr_err("couldn't create class\n");
|
|
|
+ return PTR_ERR(watchdog_class);
|
|
|
+ }
|
|
|
+
|
|
|
+ err = watchdog_dev_init();
|
|
|
+ if (err < 0) {
|
|
|
+ class_destroy(watchdog_class);
|
|
|
+ return err;
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
}
|
|
|
|
|
|
static void __exit watchdog_exit(void)
|
|
|
{
|
|
|
watchdog_dev_exit();
|
|
|
+ class_destroy(watchdog_class);
|
|
|
ida_destroy(&watchdog_ida);
|
|
|
}
|
|
|
|