mirror of https://github.com/hak5/openwrt.git
190 lines
5.7 KiB
Diff
190 lines
5.7 KiB
Diff
--- a/drivers/cbus/retu-wdt.c
|
|
+++ b/drivers/cbus/retu-wdt.c
|
|
@@ -7,6 +7,8 @@
|
|
*
|
|
* Written by Amit Kucheria <amit.kucheria@nokia.com>
|
|
*
|
|
+ * Cleanups by Michael Buesch <mb@bu3sch.de> (C) 2011
|
|
+ *
|
|
* This file is subject to the terms and conditions of the GNU General
|
|
* Public License. See the file "COPYING" in the main directory of this
|
|
* archive for more details.
|
|
@@ -48,37 +50,31 @@
|
|
#define RETU_WDT_DEFAULT_TIMER 32
|
|
#define RETU_WDT_MAX_TIMER 63
|
|
|
|
-static DEFINE_MUTEX(retu_wdt_mutex);
|
|
-
|
|
-/* Current period of watchdog */
|
|
-static unsigned int period_val = RETU_WDT_DEFAULT_TIMER;
|
|
-
|
|
struct retu_wdt_dev {
|
|
struct device *dev;
|
|
+ unsigned int period_val; /* Current period of watchdog */
|
|
unsigned long users;
|
|
- struct miscdevice retu_wdt_miscdev;
|
|
+ struct miscdevice miscdev;
|
|
struct delayed_work ping_work;
|
|
+ struct mutex mutex;
|
|
};
|
|
|
|
-static struct retu_wdt_dev *retu_wdt;
|
|
|
|
-static int _retu_modify_counter(unsigned int new)
|
|
+static inline void _retu_modify_counter(struct retu_wdt_dev *wdev,
|
|
+ unsigned int new)
|
|
{
|
|
- if (retu_wdt)
|
|
- retu_write_reg(retu_wdt->dev, RETU_REG_WATCHDOG, (u16)new);
|
|
-
|
|
- return 0;
|
|
+ retu_write_reg(wdev->dev, RETU_REG_WATCHDOG, (u16)new);
|
|
}
|
|
|
|
-static int retu_modify_counter(unsigned int new)
|
|
+static int retu_modify_counter(struct retu_wdt_dev *wdev, unsigned int new)
|
|
{
|
|
if (new < RETU_WDT_MIN_TIMER || new > RETU_WDT_MAX_TIMER)
|
|
return -EINVAL;
|
|
|
|
- mutex_lock(&retu_wdt_mutex);
|
|
- period_val = new;
|
|
- _retu_modify_counter(period_val);
|
|
- mutex_unlock(&retu_wdt_mutex);
|
|
+ mutex_lock(&wdev->mutex);
|
|
+ wdev->period_val = new;
|
|
+ _retu_modify_counter(wdev, wdev->period_val);
|
|
+ mutex_unlock(&wdev->mutex);
|
|
|
|
return 0;
|
|
}
|
|
@@ -90,14 +86,14 @@ static int retu_modify_counter(unsigned
|
|
*/
|
|
static void retu_wdt_ping_enable(struct retu_wdt_dev *wdev)
|
|
{
|
|
- _retu_modify_counter(RETU_WDT_MAX_TIMER);
|
|
+ _retu_modify_counter(wdev, RETU_WDT_MAX_TIMER);
|
|
schedule_delayed_work(&wdev->ping_work,
|
|
round_jiffies_relative(RETU_WDT_DEFAULT_TIMER * HZ));
|
|
}
|
|
|
|
static void retu_wdt_ping_disable(struct retu_wdt_dev *wdev)
|
|
{
|
|
- _retu_modify_counter(RETU_WDT_MAX_TIMER);
|
|
+ _retu_modify_counter(wdev, RETU_WDT_MAX_TIMER);
|
|
cancel_delayed_work_sync(&wdev->ping_work);
|
|
}
|
|
|
|
@@ -110,18 +106,21 @@ static void retu_wdt_ping_work(struct wo
|
|
|
|
static int retu_wdt_open(struct inode *inode, struct file *file)
|
|
{
|
|
- if (test_and_set_bit(0, &retu_wdt->users))
|
|
+ struct miscdevice *mdev = file->private_data;
|
|
+ struct retu_wdt_dev *wdev = container_of(mdev, struct retu_wdt_dev, miscdev);
|
|
+
|
|
+ if (test_and_set_bit(0, &wdev->users))
|
|
return -EBUSY;
|
|
|
|
- file->private_data = (void *)retu_wdt;
|
|
- retu_wdt_ping_disable(retu_wdt);
|
|
+ retu_wdt_ping_disable(wdev);
|
|
|
|
return nonseekable_open(inode, file);
|
|
}
|
|
|
|
static int retu_wdt_release(struct inode *inode, struct file *file)
|
|
{
|
|
- struct retu_wdt_dev *wdev = file->private_data;
|
|
+ struct miscdevice *mdev = file->private_data;
|
|
+ struct retu_wdt_dev *wdev = container_of(mdev, struct retu_wdt_dev, miscdev);
|
|
|
|
#ifndef CONFIG_WATCHDOG_NOWAYOUT
|
|
retu_wdt_ping_enable(wdev);
|
|
@@ -134,8 +133,11 @@ static int retu_wdt_release(struct inode
|
|
static ssize_t retu_wdt_write(struct file *file, const char __user *data,
|
|
size_t len, loff_t *ppos)
|
|
{
|
|
+ struct miscdevice *mdev = file->private_data;
|
|
+ struct retu_wdt_dev *wdev = container_of(mdev, struct retu_wdt_dev, miscdev);
|
|
+
|
|
if (len)
|
|
- retu_modify_counter(RETU_WDT_MAX_TIMER);
|
|
+ retu_modify_counter(wdev, RETU_WDT_MAX_TIMER);
|
|
|
|
return len;
|
|
}
|
|
@@ -143,6 +145,8 @@ static ssize_t retu_wdt_write(struct fil
|
|
static long retu_wdt_ioctl(struct file *file, unsigned int cmd,
|
|
unsigned long arg)
|
|
{
|
|
+ struct miscdevice *mdev = file->private_data;
|
|
+ struct retu_wdt_dev *wdev = container_of(mdev, struct retu_wdt_dev, miscdev);
|
|
int new_margin;
|
|
|
|
static struct watchdog_info ident = {
|
|
@@ -167,15 +171,15 @@ static long retu_wdt_ioctl(struct file *
|
|
return put_user(omap_prcm_get_reset_sources(),
|
|
(int __user *)arg);
|
|
case WDIOC_KEEPALIVE:
|
|
- retu_modify_counter(RETU_WDT_MAX_TIMER);
|
|
+ retu_modify_counter(wdev, RETU_WDT_MAX_TIMER);
|
|
break;
|
|
case WDIOC_SETTIMEOUT:
|
|
if (get_user(new_margin, (int __user *)arg))
|
|
return -EFAULT;
|
|
- retu_modify_counter(new_margin);
|
|
+ retu_modify_counter(wdev, new_margin);
|
|
/* Fall through */
|
|
case WDIOC_GETTIMEOUT:
|
|
- return put_user(period_val, (int __user *)arg);
|
|
+ return put_user(wdev->period_val, (int __user *)arg);
|
|
}
|
|
|
|
return 0;
|
|
@@ -199,15 +203,17 @@ static int __init retu_wdt_probe(struct
|
|
return -ENOMEM;
|
|
|
|
wdev->dev = &pdev->dev;
|
|
+ wdev->period_val = RETU_WDT_DEFAULT_TIMER;
|
|
+ mutex_init(&wdev->mutex);
|
|
|
|
platform_set_drvdata(pdev, wdev);
|
|
- retu_wdt = wdev;
|
|
- wdev->retu_wdt_miscdev.parent = &pdev->dev;
|
|
- wdev->retu_wdt_miscdev.minor = WATCHDOG_MINOR;
|
|
- wdev->retu_wdt_miscdev.name = "watchdog";
|
|
- wdev->retu_wdt_miscdev.fops = &retu_wdt_fops;
|
|
|
|
- ret = misc_register(&(wdev->retu_wdt_miscdev));
|
|
+ wdev->miscdev.parent = &pdev->dev;
|
|
+ wdev->miscdev.minor = WATCHDOG_MINOR;
|
|
+ wdev->miscdev.name = "watchdog";
|
|
+ wdev->miscdev.fops = &retu_wdt_fops;
|
|
+
|
|
+ ret = misc_register(&wdev->miscdev);
|
|
if (ret)
|
|
goto err_free_wdev;
|
|
|
|
@@ -216,9 +222,9 @@ static int __init retu_wdt_probe(struct
|
|
/* Kick the watchdog for kernel booting to finish.
|
|
* If nowayout is not set, we start the ping work. */
|
|
#ifdef CONFIG_WATCHDOG_NOWAYOUT
|
|
- retu_modify_counter(RETU_WDT_MAX_TIMER);
|
|
+ retu_modify_counter(wdev, RETU_WDT_MAX_TIMER);
|
|
#else
|
|
- retu_wdt_ping_enable(retu_wdt);
|
|
+ retu_wdt_ping_enable(wdev);
|
|
#endif
|
|
|
|
return 0;
|
|
@@ -234,7 +240,7 @@ static int __devexit retu_wdt_remove(str
|
|
struct retu_wdt_dev *wdev;
|
|
|
|
wdev = platform_get_drvdata(pdev);
|
|
- misc_deregister(&wdev->retu_wdt_miscdev);
|
|
+ misc_deregister(&wdev->miscdev);
|
|
cancel_delayed_work_sync(&wdev->ping_work);
|
|
kfree(wdev);
|
|
|