提交 19ce0a99 编写于 作者: L Linus Torvalds

Merge git://www.linux-watchdog.org/linux-watchdog

Pull second set of watchdog updates from Wim Van Sebroeck:
 "This changeset contains following changes:
   * Add support for multiple watchdog devices.  We use dynamically
     allocated device id's for this.
   * Add locking into the generic watchdog infrastructure.
   * Add support for dynamically allocated watchdog_device structs so
     that we can deal with devices that get unbound.
   * convert following drivers to the generic watchdog framework:
     sch5627, sch5636 and sp805_wdt.
   * Add DA9052/53 PMIC watchdog support
   * Fix printk format warnings for iTCO_wdt.c"

* git://www.linux-watchdog.org/linux-watchdog:
  watchdog: iTCO_wdt.c: fix printk format warnings
  watchdog: sp805_wdt: Add clk_{un}prepare support
  watchdog: sp805_wdt: convert to watchdog core
  hwmon/sch56xx: Depend on watchdog for watchdog core functions
  watchdog: sch56xx-common: set correct bits in register()
  Watchdog: DA9052/53 PMIC watchdog support
  watchdog: sch56xx-common: Add proper ref-counting of watchdog data
  watchdog: sch56xx: Remove unnecessary checks for register changes
  watchdog: sch56xx: Use watchdog core
  watchdog: Add support for dynamically allocated watchdog_device structs
  watchdog: Add Locking support
  watchdog: watchdog_dev: Rewrite wrapper code
  watchdog: use dev_ functions
  watchdog: create all the proper device files
  watchdog: Add a flag to indicate the watchdog doesn't reboot things
  watchdog: Add multiple device support
  watchdog: watchdog_core.h: make functions extern
  watchdog: correct the name of the watchdog_core inlude file
  watchdog: Add watchdog_active() routine
  watchdog: watchdog_dev: include private header to pickup global symbol prototypes
The Linux WatchDog Timer Driver Core kernel API. The Linux WatchDog Timer Driver Core kernel API.
=============================================== ===============================================
Last reviewed: 16-Mar-2012 Last reviewed: 22-May-2012
Wim Van Sebroeck <wim@iguana.be> Wim Van Sebroeck <wim@iguana.be>
...@@ -39,6 +39,10 @@ watchdog_device structure. ...@@ -39,6 +39,10 @@ watchdog_device structure.
The watchdog device structure looks like this: The watchdog device structure looks like this:
struct watchdog_device { struct watchdog_device {
int id;
struct cdev cdev;
struct device *dev;
struct device *parent;
const struct watchdog_info *info; const struct watchdog_info *info;
const struct watchdog_ops *ops; const struct watchdog_ops *ops;
unsigned int bootstatus; unsigned int bootstatus;
...@@ -46,10 +50,20 @@ struct watchdog_device { ...@@ -46,10 +50,20 @@ struct watchdog_device {
unsigned int min_timeout; unsigned int min_timeout;
unsigned int max_timeout; unsigned int max_timeout;
void *driver_data; void *driver_data;
struct mutex lock;
unsigned long status; unsigned long status;
}; };
It contains following fields: It contains following fields:
* id: set by watchdog_register_device, id 0 is special. It has both a
/dev/watchdog0 cdev (dynamic major, minor 0) as well as the old
/dev/watchdog miscdev. The id is set automatically when calling
watchdog_register_device.
* cdev: cdev for the dynamic /dev/watchdog<id> device nodes. This
field is also populated by watchdog_register_device.
* dev: device under the watchdog class (created by watchdog_register_device).
* parent: set this to the parent device (or NULL) before calling
watchdog_register_device.
* info: a pointer to a watchdog_info structure. This structure gives some * info: a pointer to a watchdog_info structure. This structure gives some
additional information about the watchdog timer itself. (Like it's unique name) additional information about the watchdog timer itself. (Like it's unique name)
* ops: a pointer to the list of watchdog operations that the watchdog supports. * ops: a pointer to the list of watchdog operations that the watchdog supports.
...@@ -61,6 +75,7 @@ It contains following fields: ...@@ -61,6 +75,7 @@ It contains following fields:
* driver_data: a pointer to the drivers private data of a watchdog device. * driver_data: a pointer to the drivers private data of a watchdog device.
This data should only be accessed via the watchdog_set_drvdata and This data should only be accessed via the watchdog_set_drvdata and
watchdog_get_drvdata routines. watchdog_get_drvdata routines.
* lock: Mutex for WatchDog Timer Driver Core internal use only.
* status: this field contains a number of status bits that give extra * status: this field contains a number of status bits that give extra
information about the status of the device (Like: is the watchdog timer information about the status of the device (Like: is the watchdog timer
running/active, is the nowayout bit set, is the device opened via running/active, is the nowayout bit set, is the device opened via
...@@ -78,6 +93,8 @@ struct watchdog_ops { ...@@ -78,6 +93,8 @@ struct watchdog_ops {
unsigned int (*status)(struct watchdog_device *); unsigned int (*status)(struct watchdog_device *);
int (*set_timeout)(struct watchdog_device *, unsigned int); int (*set_timeout)(struct watchdog_device *, unsigned int);
unsigned int (*get_timeleft)(struct watchdog_device *); unsigned int (*get_timeleft)(struct watchdog_device *);
void (*ref)(struct watchdog_device *);
void (*unref)(struct watchdog_device *);
long (*ioctl)(struct watchdog_device *, unsigned int, unsigned long); long (*ioctl)(struct watchdog_device *, unsigned int, unsigned long);
}; };
...@@ -85,6 +102,21 @@ It is important that you first define the module owner of the watchdog timer ...@@ -85,6 +102,21 @@ It is important that you first define the module owner of the watchdog timer
driver's operations. This module owner will be used to lock the module when driver's operations. This module owner will be used to lock the module when
the watchdog is active. (This to avoid a system crash when you unload the the watchdog is active. (This to avoid a system crash when you unload the
module and /dev/watchdog is still open). module and /dev/watchdog is still open).
If the watchdog_device struct is dynamically allocated, just locking the module
is not enough and a driver also needs to define the ref and unref operations to
ensure the structure holding the watchdog_device does not go away.
The simplest (and usually sufficient) implementation of this is to:
1) Add a kref struct to the same structure which is holding the watchdog_device
2) Define a release callback for the kref which frees the struct holding both
3) Call kref_init on this kref *before* calling watchdog_register_device()
4) Define a ref operation calling kref_get on this kref
5) Define a unref operation calling kref_put on this kref
6) When it is time to cleanup:
* Do not kfree() the struct holding both, the last kref_put will do this!
* *After* calling watchdog_unregister_device() call kref_put on the kref
Some operations are mandatory and some are optional. The mandatory operations Some operations are mandatory and some are optional. The mandatory operations
are: are:
* start: this is a pointer to the routine that starts the watchdog timer * start: this is a pointer to the routine that starts the watchdog timer
...@@ -125,6 +157,10 @@ they are supported. These optional routines/operations are: ...@@ -125,6 +157,10 @@ they are supported. These optional routines/operations are:
(Note: the WDIOF_SETTIMEOUT needs to be set in the options field of the (Note: the WDIOF_SETTIMEOUT needs to be set in the options field of the
watchdog's info structure). watchdog's info structure).
* get_timeleft: this routines returns the time that's left before a reset. * get_timeleft: this routines returns the time that's left before a reset.
* ref: the operation that calls kref_get on the kref of a dynamically
allocated watchdog_device struct.
* unref: the operation that calls kref_put on the kref of a dynamically
allocated watchdog_device struct.
* ioctl: if this routine is present then it will be called first before we do * ioctl: if this routine is present then it will be called first before we do
our own internal ioctl call handling. This routine should return -ENOIOCTLCMD our own internal ioctl call handling. This routine should return -ENOIOCTLCMD
if a command is not supported. The parameters that are passed to the ioctl if a command is not supported. The parameters that are passed to the ioctl
...@@ -144,6 +180,11 @@ bit-operations. The status bits that are defined are: ...@@ -144,6 +180,11 @@ bit-operations. The status bits that are defined are:
(This bit should only be used by the WatchDog Timer Driver Core). (This bit should only be used by the WatchDog Timer Driver Core).
* WDOG_NO_WAY_OUT: this bit stores the nowayout setting for the watchdog. * WDOG_NO_WAY_OUT: this bit stores the nowayout setting for the watchdog.
If this bit is set then the watchdog timer will not be able to stop. If this bit is set then the watchdog timer will not be able to stop.
* WDOG_UNREGISTERED: this bit gets set by the WatchDog Timer Driver Core
after calling watchdog_unregister_device, and then checked before calling
any watchdog_ops, so that you can be sure that no operations (other then
unref) will get called after unregister, even if userspace still holds a
reference to /dev/watchdog
To set the WDOG_NO_WAY_OUT status bit (before registering your watchdog To set the WDOG_NO_WAY_OUT status bit (before registering your watchdog
timer device) you can either: timer device) you can either:
......
...@@ -78,6 +78,11 @@ wd0_timeout: Default watchdog0 timeout in 1/10secs ...@@ -78,6 +78,11 @@ wd0_timeout: Default watchdog0 timeout in 1/10secs
wd1_timeout: Default watchdog1 timeout in 1/10secs wd1_timeout: Default watchdog1 timeout in 1/10secs
wd2_timeout: Default watchdog2 timeout in 1/10secs wd2_timeout: Default watchdog2 timeout in 1/10secs
------------------------------------------------- -------------------------------------------------
da9052wdt:
timeout: Watchdog timeout in seconds. 2<= timeout <=131, default=2.048s
nowayout: Watchdog cannot be stopped once started
(default=kernel config parameter)
-------------------------------------------------
davinci_wdt: davinci_wdt:
heartbeat: Watchdog heartbeat period in seconds from 1 to 600, default 60 heartbeat: Watchdog heartbeat period in seconds from 1 to 600, default 60
------------------------------------------------- -------------------------------------------------
......
...@@ -1036,8 +1036,9 @@ config SENSORS_SCH56XX_COMMON ...@@ -1036,8 +1036,9 @@ config SENSORS_SCH56XX_COMMON
config SENSORS_SCH5627 config SENSORS_SCH5627
tristate "SMSC SCH5627" tristate "SMSC SCH5627"
depends on !PPC depends on !PPC && WATCHDOG
select SENSORS_SCH56XX_COMMON select SENSORS_SCH56XX_COMMON
select WATCHDOG_CORE
help help
If you say yes here you get support for the hardware monitoring If you say yes here you get support for the hardware monitoring
features of the SMSC SCH5627 Super-I/O chip including support for features of the SMSC SCH5627 Super-I/O chip including support for
...@@ -1048,8 +1049,9 @@ config SENSORS_SCH5627 ...@@ -1048,8 +1049,9 @@ config SENSORS_SCH5627
config SENSORS_SCH5636 config SENSORS_SCH5636
tristate "SMSC SCH5636" tristate "SMSC SCH5636"
depends on !PPC depends on !PPC && WATCHDOG
select SENSORS_SCH56XX_COMMON select SENSORS_SCH56XX_COMMON
select WATCHDOG_CORE
help help
SMSC SCH5636 Super I/O chips include an embedded microcontroller for SMSC SCH5636 Super I/O chips include an embedded microcontroller for
hardware monitoring solutions, allowing motherboard manufacturers to hardware monitoring solutions, allowing motherboard manufacturers to
......
...@@ -579,7 +579,7 @@ static int __devinit sch5627_probe(struct platform_device *pdev) ...@@ -579,7 +579,7 @@ static int __devinit sch5627_probe(struct platform_device *pdev)
} }
/* Note failing to register the watchdog is not a fatal error */ /* Note failing to register the watchdog is not a fatal error */
data->watchdog = sch56xx_watchdog_register(data->addr, data->watchdog = sch56xx_watchdog_register(&pdev->dev, data->addr,
(build_code << 24) | (build_id << 8) | hwmon_rev, (build_code << 24) | (build_id << 8) | hwmon_rev,
&data->update_lock, 1); &data->update_lock, 1);
......
...@@ -510,7 +510,7 @@ static int __devinit sch5636_probe(struct platform_device *pdev) ...@@ -510,7 +510,7 @@ static int __devinit sch5636_probe(struct platform_device *pdev)
} }
/* Note failing to register the watchdog is not a fatal error */ /* Note failing to register the watchdog is not a fatal error */
data->watchdog = sch56xx_watchdog_register(data->addr, data->watchdog = sch56xx_watchdog_register(&pdev->dev, data->addr,
(revision[0] << 8) | revision[1], (revision[0] << 8) | revision[1],
&data->update_lock, 0); &data->update_lock, 0);
......
...@@ -66,15 +66,10 @@ MODULE_PARM_DESC(nowayout, "Watchdog cannot be stopped once started (default=" ...@@ -66,15 +66,10 @@ MODULE_PARM_DESC(nowayout, "Watchdog cannot be stopped once started (default="
struct sch56xx_watchdog_data { struct sch56xx_watchdog_data {
u16 addr; u16 addr;
u32 revision;
struct mutex *io_lock; struct mutex *io_lock;
struct mutex watchdog_lock;
struct list_head list; /* member of the watchdog_data_list */
struct kref kref; struct kref kref;
struct miscdevice watchdog_miscdev; struct watchdog_info wdinfo;
unsigned long watchdog_is_open; struct watchdog_device wddev;
char watchdog_name[10]; /* must be unique to avoid sysfs conflict */
char watchdog_expect_close;
u8 watchdog_preset; u8 watchdog_preset;
u8 watchdog_control; u8 watchdog_control;
u8 watchdog_output_enable; u8 watchdog_output_enable;
...@@ -82,15 +77,6 @@ struct sch56xx_watchdog_data { ...@@ -82,15 +77,6 @@ struct sch56xx_watchdog_data {
static struct platform_device *sch56xx_pdev; static struct platform_device *sch56xx_pdev;
/*
* Somewhat ugly :( global data pointer list with all sch56xx devices, so that
* we can find our device data as when using misc_register there is no other
* method to get to ones device data from the open fop.
*/
static LIST_HEAD(watchdog_data_list);
/* Note this lock not only protect list access, but also data.kref access */
static DEFINE_MUTEX(watchdog_data_mutex);
/* Super I/O functions */ /* Super I/O functions */
static inline int superio_inb(int base, int reg) static inline int superio_inb(int base, int reg)
{ {
...@@ -272,22 +258,22 @@ EXPORT_SYMBOL(sch56xx_read_virtual_reg12); ...@@ -272,22 +258,22 @@ EXPORT_SYMBOL(sch56xx_read_virtual_reg12);
* Watchdog routines * Watchdog routines
*/ */
/* /* Release our data struct when we're unregistered *and*
* Release our data struct when the platform device has been released *and* all references to our watchdog device are released */
* all references to our watchdog device are released. static void watchdog_release_resources(struct kref *r)
*/
static void sch56xx_watchdog_release_resources(struct kref *r)
{ {
struct sch56xx_watchdog_data *data = struct sch56xx_watchdog_data *data =
container_of(r, struct sch56xx_watchdog_data, kref); container_of(r, struct sch56xx_watchdog_data, kref);
kfree(data); kfree(data);
} }
static int watchdog_set_timeout(struct sch56xx_watchdog_data *data, static int watchdog_set_timeout(struct watchdog_device *wddev,
int timeout) unsigned int timeout)
{ {
int ret, resolution; struct sch56xx_watchdog_data *data = watchdog_get_drvdata(wddev);
unsigned int resolution;
u8 control; u8 control;
int ret;
/* 1 second or 60 second resolution? */ /* 1 second or 60 second resolution? */
if (timeout <= 255) if (timeout <= 255)
...@@ -298,12 +284,6 @@ static int watchdog_set_timeout(struct sch56xx_watchdog_data *data, ...@@ -298,12 +284,6 @@ static int watchdog_set_timeout(struct sch56xx_watchdog_data *data,
if (timeout < resolution || timeout > (resolution * 255)) if (timeout < resolution || timeout > (resolution * 255))
return -EINVAL; return -EINVAL;
mutex_lock(&data->watchdog_lock);
if (!data->addr) {
ret = -ENODEV;
goto leave;
}
if (resolution == 1) if (resolution == 1)
control = data->watchdog_control | SCH56XX_WDOG_TIME_BASE_SEC; control = data->watchdog_control | SCH56XX_WDOG_TIME_BASE_SEC;
else else
...@@ -316,7 +296,7 @@ static int watchdog_set_timeout(struct sch56xx_watchdog_data *data, ...@@ -316,7 +296,7 @@ static int watchdog_set_timeout(struct sch56xx_watchdog_data *data,
control); control);
mutex_unlock(data->io_lock); mutex_unlock(data->io_lock);
if (ret) if (ret)
goto leave; return ret;
data->watchdog_control = control; data->watchdog_control = control;
} }
...@@ -326,38 +306,17 @@ static int watchdog_set_timeout(struct sch56xx_watchdog_data *data, ...@@ -326,38 +306,17 @@ static int watchdog_set_timeout(struct sch56xx_watchdog_data *data,
* the watchdog countdown. * the watchdog countdown.
*/ */
data->watchdog_preset = DIV_ROUND_UP(timeout, resolution); data->watchdog_preset = DIV_ROUND_UP(timeout, resolution);
wddev->timeout = data->watchdog_preset * resolution;
ret = data->watchdog_preset * resolution; return 0;
leave:
mutex_unlock(&data->watchdog_lock);
return ret;
}
static int watchdog_get_timeout(struct sch56xx_watchdog_data *data)
{
int timeout;
mutex_lock(&data->watchdog_lock);
if (data->watchdog_control & SCH56XX_WDOG_TIME_BASE_SEC)
timeout = data->watchdog_preset;
else
timeout = data->watchdog_preset * 60;
mutex_unlock(&data->watchdog_lock);
return timeout;
} }
static int watchdog_start(struct sch56xx_watchdog_data *data) static int watchdog_start(struct watchdog_device *wddev)
{ {
struct sch56xx_watchdog_data *data = watchdog_get_drvdata(wddev);
int ret; int ret;
u8 val; u8 val;
mutex_lock(&data->watchdog_lock);
if (!data->addr) {
ret = -ENODEV;
goto leave_unlock_watchdog;
}
/* /*
* The sch56xx's watchdog cannot really be started / stopped * The sch56xx's watchdog cannot really be started / stopped
* it is always running, but we can avoid the timer expiring * it is always running, but we can avoid the timer expiring
...@@ -385,18 +344,14 @@ static int watchdog_start(struct sch56xx_watchdog_data *data) ...@@ -385,18 +344,14 @@ static int watchdog_start(struct sch56xx_watchdog_data *data)
if (ret) if (ret)
goto leave; goto leave;
/* 2. Enable output (if not already enabled) */ /* 2. Enable output */
if (!(data->watchdog_output_enable & SCH56XX_WDOG_OUTPUT_ENABLE)) { val = data->watchdog_output_enable | SCH56XX_WDOG_OUTPUT_ENABLE;
val = data->watchdog_output_enable | ret = sch56xx_write_virtual_reg(data->addr,
SCH56XX_WDOG_OUTPUT_ENABLE; SCH56XX_REG_WDOG_OUTPUT_ENABLE, val);
ret = sch56xx_write_virtual_reg(data->addr, if (ret)
SCH56XX_REG_WDOG_OUTPUT_ENABLE, goto leave;
val);
if (ret)
goto leave;
data->watchdog_output_enable = val; data->watchdog_output_enable = val;
}
/* 3. Clear the watchdog event bit if set */ /* 3. Clear the watchdog event bit if set */
val = inb(data->addr + 9); val = inb(data->addr + 9);
...@@ -405,234 +360,70 @@ static int watchdog_start(struct sch56xx_watchdog_data *data) ...@@ -405,234 +360,70 @@ static int watchdog_start(struct sch56xx_watchdog_data *data)
leave: leave:
mutex_unlock(data->io_lock); mutex_unlock(data->io_lock);
leave_unlock_watchdog:
mutex_unlock(&data->watchdog_lock);
return ret; return ret;
} }
static int watchdog_trigger(struct sch56xx_watchdog_data *data) static int watchdog_trigger(struct watchdog_device *wddev)
{ {
struct sch56xx_watchdog_data *data = watchdog_get_drvdata(wddev);
int ret; int ret;
mutex_lock(&data->watchdog_lock);
if (!data->addr) {
ret = -ENODEV;
goto leave;
}
/* Reset the watchdog countdown counter */ /* Reset the watchdog countdown counter */
mutex_lock(data->io_lock); mutex_lock(data->io_lock);
ret = sch56xx_write_virtual_reg(data->addr, SCH56XX_REG_WDOG_PRESET, ret = sch56xx_write_virtual_reg(data->addr, SCH56XX_REG_WDOG_PRESET,
data->watchdog_preset); data->watchdog_preset);
mutex_unlock(data->io_lock); mutex_unlock(data->io_lock);
leave:
mutex_unlock(&data->watchdog_lock);
return ret; return ret;
} }
static int watchdog_stop_unlocked(struct sch56xx_watchdog_data *data) static int watchdog_stop(struct watchdog_device *wddev)
{ {
struct sch56xx_watchdog_data *data = watchdog_get_drvdata(wddev);
int ret = 0; int ret = 0;
u8 val; u8 val;
if (!data->addr) val = data->watchdog_output_enable & ~SCH56XX_WDOG_OUTPUT_ENABLE;
return -ENODEV; mutex_lock(data->io_lock);
ret = sch56xx_write_virtual_reg(data->addr,
if (data->watchdog_output_enable & SCH56XX_WDOG_OUTPUT_ENABLE) { SCH56XX_REG_WDOG_OUTPUT_ENABLE, val);
val = data->watchdog_output_enable & mutex_unlock(data->io_lock);
~SCH56XX_WDOG_OUTPUT_ENABLE; if (ret)
mutex_lock(data->io_lock); return ret;
ret = sch56xx_write_virtual_reg(data->addr,
SCH56XX_REG_WDOG_OUTPUT_ENABLE,
val);
mutex_unlock(data->io_lock);
if (ret)
return ret;
data->watchdog_output_enable = val;
}
return ret;
}
static int watchdog_stop(struct sch56xx_watchdog_data *data)
{
int ret;
mutex_lock(&data->watchdog_lock);
ret = watchdog_stop_unlocked(data);
mutex_unlock(&data->watchdog_lock);
return ret;
}
static int watchdog_release(struct inode *inode, struct file *filp)
{
struct sch56xx_watchdog_data *data = filp->private_data;
if (data->watchdog_expect_close) {
watchdog_stop(data);
data->watchdog_expect_close = 0;
} else {
watchdog_trigger(data);
pr_crit("unexpected close, not stopping watchdog!\n");
}
clear_bit(0, &data->watchdog_is_open);
mutex_lock(&watchdog_data_mutex);
kref_put(&data->kref, sch56xx_watchdog_release_resources);
mutex_unlock(&watchdog_data_mutex);
data->watchdog_output_enable = val;
return 0; return 0;
} }
static int watchdog_open(struct inode *inode, struct file *filp) static void watchdog_ref(struct watchdog_device *wddev)
{ {
struct sch56xx_watchdog_data *pos, *data = NULL; struct sch56xx_watchdog_data *data = watchdog_get_drvdata(wddev);
int ret, watchdog_is_open;
/*
* We get called from drivers/char/misc.c with misc_mtx hold, and we
* call misc_register() from sch56xx_watchdog_probe() with
* watchdog_data_mutex hold, as misc_register() takes the misc_mtx
* lock, this is a possible deadlock, so we use mutex_trylock here.
*/
if (!mutex_trylock(&watchdog_data_mutex))
return -ERESTARTSYS;
list_for_each_entry(pos, &watchdog_data_list, list) {
if (pos->watchdog_miscdev.minor == iminor(inode)) {
data = pos;
break;
}
}
/* Note we can never not have found data, so we don't check for this */
watchdog_is_open = test_and_set_bit(0, &data->watchdog_is_open);
if (!watchdog_is_open)
kref_get(&data->kref);
mutex_unlock(&watchdog_data_mutex);
if (watchdog_is_open)
return -EBUSY;
filp->private_data = data;
/* Start the watchdog */
ret = watchdog_start(data);
if (ret) {
watchdog_release(inode, filp);
return ret;
}
return nonseekable_open(inode, filp); kref_get(&data->kref);
} }
static ssize_t watchdog_write(struct file *filp, const char __user *buf, static void watchdog_unref(struct watchdog_device *wddev)
size_t count, loff_t *offset)
{ {
int ret; struct sch56xx_watchdog_data *data = watchdog_get_drvdata(wddev);
struct sch56xx_watchdog_data *data = filp->private_data;
if (count) {
if (!nowayout) {
size_t i;
/* Clear it in case it was set with a previous write */
data->watchdog_expect_close = 0;
for (i = 0; i != count; i++) {
char c;
if (get_user(c, buf + i))
return -EFAULT;
if (c == 'V')
data->watchdog_expect_close = 1;
}
}
ret = watchdog_trigger(data);
if (ret)
return ret;
}
return count;
}
static long watchdog_ioctl(struct file *filp, unsigned int cmd,
unsigned long arg)
{
struct watchdog_info ident = {
.options = WDIOF_KEEPALIVEPING | WDIOF_SETTIMEOUT,
.identity = "sch56xx watchdog"
};
int i, ret = 0;
struct sch56xx_watchdog_data *data = filp->private_data;
switch (cmd) {
case WDIOC_GETSUPPORT:
ident.firmware_version = data->revision;
if (!nowayout)
ident.options |= WDIOF_MAGICCLOSE;
if (copy_to_user((void __user *)arg, &ident, sizeof(ident)))
ret = -EFAULT;
break;
case WDIOC_GETSTATUS:
case WDIOC_GETBOOTSTATUS:
ret = put_user(0, (int __user *)arg);
break;
case WDIOC_KEEPALIVE:
ret = watchdog_trigger(data);
break;
case WDIOC_GETTIMEOUT: kref_put(&data->kref, watchdog_release_resources);
i = watchdog_get_timeout(data);
ret = put_user(i, (int __user *)arg);
break;
case WDIOC_SETTIMEOUT:
if (get_user(i, (int __user *)arg)) {
ret = -EFAULT;
break;
}
ret = watchdog_set_timeout(data, i);
if (ret >= 0)
ret = put_user(ret, (int __user *)arg);
break;
case WDIOC_SETOPTIONS:
if (get_user(i, (int __user *)arg)) {
ret = -EFAULT;
break;
}
if (i & WDIOS_DISABLECARD)
ret = watchdog_stop(data);
else if (i & WDIOS_ENABLECARD)
ret = watchdog_trigger(data);
else
ret = -EINVAL;
break;
default:
ret = -ENOTTY;
}
return ret;
} }
static const struct file_operations watchdog_fops = { static const struct watchdog_ops watchdog_ops = {
.owner = THIS_MODULE, .owner = THIS_MODULE,
.llseek = no_llseek, .start = watchdog_start,
.open = watchdog_open, .stop = watchdog_stop,
.release = watchdog_release, .ping = watchdog_trigger,
.write = watchdog_write, .set_timeout = watchdog_set_timeout,
.unlocked_ioctl = watchdog_ioctl, .ref = watchdog_ref,
.unref = watchdog_unref,
}; };
struct sch56xx_watchdog_data *sch56xx_watchdog_register( struct sch56xx_watchdog_data *sch56xx_watchdog_register(struct device *parent,
u16 addr, u32 revision, struct mutex *io_lock, int check_enabled) u16 addr, u32 revision, struct mutex *io_lock, int check_enabled)
{ {
struct sch56xx_watchdog_data *data; struct sch56xx_watchdog_data *data;
int i, err, control, output_enable; int err, control, output_enable;
const int watchdog_minors[] = { WATCHDOG_MINOR, 212, 213, 214, 215 };
/* Cache the watchdog registers */ /* Cache the watchdog registers */
mutex_lock(io_lock); mutex_lock(io_lock);
...@@ -656,82 +447,55 @@ struct sch56xx_watchdog_data *sch56xx_watchdog_register( ...@@ -656,82 +447,55 @@ struct sch56xx_watchdog_data *sch56xx_watchdog_register(
return NULL; return NULL;
data->addr = addr; data->addr = addr;
data->revision = revision;
data->io_lock = io_lock; data->io_lock = io_lock;
data->watchdog_control = control;
data->watchdog_output_enable = output_enable;
mutex_init(&data->watchdog_lock);
INIT_LIST_HEAD(&data->list);
kref_init(&data->kref); kref_init(&data->kref);
err = watchdog_set_timeout(data, 60); strlcpy(data->wdinfo.identity, "sch56xx watchdog",
if (err < 0) sizeof(data->wdinfo.identity));
goto error; data->wdinfo.firmware_version = revision;
data->wdinfo.options = WDIOF_KEEPALIVEPING | WDIOF_SETTIMEOUT;
/* if (!nowayout)
* We take the data_mutex lock early so that watchdog_open() cannot data->wdinfo.options |= WDIOF_MAGICCLOSE;
* run when misc_register() has completed, but we've not yet added
* our data to the watchdog_data_list. data->wddev.info = &data->wdinfo;
*/ data->wddev.ops = &watchdog_ops;
mutex_lock(&watchdog_data_mutex); data->wddev.parent = parent;
for (i = 0; i < ARRAY_SIZE(watchdog_minors); i++) { data->wddev.timeout = 60;
/* Register our watchdog part */ data->wddev.min_timeout = 1;
snprintf(data->watchdog_name, sizeof(data->watchdog_name), data->wddev.max_timeout = 255 * 60;
"watchdog%c", (i == 0) ? '\0' : ('0' + i)); if (nowayout)
data->watchdog_miscdev.name = data->watchdog_name; set_bit(WDOG_NO_WAY_OUT, &data->wddev.status);
data->watchdog_miscdev.fops = &watchdog_fops; if (output_enable & SCH56XX_WDOG_OUTPUT_ENABLE)
data->watchdog_miscdev.minor = watchdog_minors[i]; set_bit(WDOG_ACTIVE, &data->wddev.status);
err = misc_register(&data->watchdog_miscdev);
if (err == -EBUSY) /* Since the watchdog uses a downcounter there is no register to read
continue; the BIOS set timeout from (if any was set at all) ->
if (err) Choose a preset which will give us a 1 minute timeout */
break; if (control & SCH56XX_WDOG_TIME_BASE_SEC)
data->watchdog_preset = 60; /* seconds */
else
data->watchdog_preset = 1; /* minute */
list_add(&data->list, &watchdog_data_list); data->watchdog_control = control;
pr_info("Registered /dev/%s chardev major 10, minor: %d\n", data->watchdog_output_enable = output_enable;
data->watchdog_name, watchdog_minors[i]);
break;
}
mutex_unlock(&watchdog_data_mutex);
watchdog_set_drvdata(&data->wddev, data);
err = watchdog_register_device(&data->wddev);
if (err) { if (err) {
pr_err("Registering watchdog chardev: %d\n", err); pr_err("Registering watchdog chardev: %d\n", err);
goto error; kfree(data);
} return NULL;
if (i == ARRAY_SIZE(watchdog_minors)) {
pr_warn("Couldn't register watchdog (no free minor)\n");
goto error;
} }
return data; return data;
error:
kfree(data);
return NULL;
} }
EXPORT_SYMBOL(sch56xx_watchdog_register); EXPORT_SYMBOL(sch56xx_watchdog_register);
void sch56xx_watchdog_unregister(struct sch56xx_watchdog_data *data) void sch56xx_watchdog_unregister(struct sch56xx_watchdog_data *data)
{ {
mutex_lock(&watchdog_data_mutex); watchdog_unregister_device(&data->wddev);
misc_deregister(&data->watchdog_miscdev); kref_put(&data->kref, watchdog_release_resources);
list_del(&data->list); /* Don't touch data after this it may have been free-ed! */
mutex_unlock(&watchdog_data_mutex);
mutex_lock(&data->watchdog_lock);
if (data->watchdog_is_open) {
pr_warn("platform device unregistered with watchdog "
"open! Stopping watchdog.\n");
watchdog_stop_unlocked(data);
}
/* Tell the wdog start/stop/trigger functions our dev is gone */
data->addr = 0;
data->io_lock = NULL;
mutex_unlock(&data->watchdog_lock);
mutex_lock(&watchdog_data_mutex);
kref_put(&data->kref, sch56xx_watchdog_release_resources);
mutex_unlock(&watchdog_data_mutex);
} }
EXPORT_SYMBOL(sch56xx_watchdog_unregister); EXPORT_SYMBOL(sch56xx_watchdog_unregister);
......
...@@ -27,6 +27,6 @@ int sch56xx_read_virtual_reg16(u16 addr, u16 reg); ...@@ -27,6 +27,6 @@ int sch56xx_read_virtual_reg16(u16 addr, u16 reg);
int sch56xx_read_virtual_reg12(u16 addr, u16 msb_reg, u16 lsn_reg, int sch56xx_read_virtual_reg12(u16 addr, u16 msb_reg, u16 lsn_reg,
int high_nibble); int high_nibble);
struct sch56xx_watchdog_data *sch56xx_watchdog_register( struct sch56xx_watchdog_data *sch56xx_watchdog_register(struct device *parent,
u16 addr, u32 revision, struct mutex *io_lock, int check_enabled); u16 addr, u32 revision, struct mutex *io_lock, int check_enabled);
void sch56xx_watchdog_unregister(struct sch56xx_watchdog_data *data); void sch56xx_watchdog_unregister(struct sch56xx_watchdog_data *data);
...@@ -64,6 +64,18 @@ config SOFT_WATCHDOG ...@@ -64,6 +64,18 @@ config SOFT_WATCHDOG
To compile this driver as a module, choose M here: the To compile this driver as a module, choose M here: the
module will be called softdog. module will be called softdog.
config DA9052_WATCHDOG
tristate "Dialog DA9052 Watchdog"
depends on PMIC_DA9052
select WATCHDOG_CORE
help
Support for the watchdog in the DA9052 PMIC. Watchdog trigger
cause system reset.
Say Y here to include support for the DA9052 watchdog.
Alternatively say M to compile the driver as a module,
which will be called da9052_wdt.
config WM831X_WATCHDOG config WM831X_WATCHDOG
tristate "WM831x watchdog" tristate "WM831x watchdog"
depends on MFD_WM831X depends on MFD_WM831X
...@@ -87,6 +99,7 @@ config WM8350_WATCHDOG ...@@ -87,6 +99,7 @@ config WM8350_WATCHDOG
config ARM_SP805_WATCHDOG config ARM_SP805_WATCHDOG
tristate "ARM SP805 Watchdog" tristate "ARM SP805 Watchdog"
depends on ARM_AMBA depends on ARM_AMBA
select WATCHDOG_CORE
help help
ARM Primecell SP805 Watchdog timer. This will reboot your system when ARM Primecell SP805 Watchdog timer. This will reboot your system when
the timeout is reached. the timeout is reached.
......
...@@ -163,6 +163,7 @@ obj-$(CONFIG_WATCHDOG_CP1XXX) += cpwd.o ...@@ -163,6 +163,7 @@ obj-$(CONFIG_WATCHDOG_CP1XXX) += cpwd.o
obj-$(CONFIG_XEN_WDT) += xen_wdt.o obj-$(CONFIG_XEN_WDT) += xen_wdt.o
# Architecture Independent # Architecture Independent
obj-$(CONFIG_DA9052_WATCHDOG) += da9052_wdt.o
obj-$(CONFIG_WM831X_WATCHDOG) += wm831x_wdt.o obj-$(CONFIG_WM831X_WATCHDOG) += wm831x_wdt.o
obj-$(CONFIG_WM8350_WATCHDOG) += wm8350_wdt.o obj-$(CONFIG_WM8350_WATCHDOG) += wm8350_wdt.o
obj-$(CONFIG_MAX63XX_WATCHDOG) += max63xx_wdt.o obj-$(CONFIG_MAX63XX_WATCHDOG) += max63xx_wdt.o
......
/*
* System monitoring driver for DA9052 PMICs.
*
* Copyright(c) 2012 Dialog Semiconductor Ltd.
*
* Author: Anthony Olech <Anthony.Olech@diasemi.com>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
*/
#include <linux/module.h>
#include <linux/delay.h>
#include <linux/uaccess.h>
#include <linux/platform_device.h>
#include <linux/time.h>
#include <linux/watchdog.h>
#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/jiffies.h>
#include <linux/delay.h>
#include <linux/mfd/da9052/reg.h>
#include <linux/mfd/da9052/da9052.h>
#define DA9052_DEF_TIMEOUT 4
#define DA9052_TWDMIN 256
struct da9052_wdt_data {
struct watchdog_device wdt;
struct da9052 *da9052;
struct kref kref;
unsigned long jpast;
};
static const struct {
u8 reg_val;
int time; /* Seconds */
} da9052_wdt_maps[] = {
{ 1, 2 },
{ 2, 4 },
{ 3, 8 },
{ 4, 16 },
{ 5, 32 },
{ 5, 33 }, /* Actual time 32.768s so included both 32s and 33s */
{ 6, 65 },
{ 6, 66 }, /* Actual time 65.536s so include both, 65s and 66s */
{ 7, 131 },
};
static void da9052_wdt_release_resources(struct kref *r)
{
struct da9052_wdt_data *driver_data =
container_of(r, struct da9052_wdt_data, kref);
kfree(driver_data);
}
static int da9052_wdt_set_timeout(struct watchdog_device *wdt_dev,
unsigned int timeout)
{
struct da9052_wdt_data *driver_data = watchdog_get_drvdata(wdt_dev);
struct da9052 *da9052 = driver_data->da9052;
int ret, i;
/*
* Disable the Watchdog timer before setting
* new time out.
*/
ret = da9052_reg_update(da9052, DA9052_CONTROL_D_REG,
DA9052_CONTROLD_TWDSCALE, 0);
if (ret < 0) {
dev_err(da9052->dev, "Failed to disable watchdog bit, %d\n",
ret);
return ret;
}
if (timeout) {
/*
* To change the timeout, da9052 needs to
* be disabled for at least 150 us.
*/
udelay(150);
/* Set the desired timeout */
for (i = 0; i < ARRAY_SIZE(da9052_wdt_maps); i++)
if (da9052_wdt_maps[i].time == timeout)
break;
if (i == ARRAY_SIZE(da9052_wdt_maps))
ret = -EINVAL;
else
ret = da9052_reg_update(da9052, DA9052_CONTROL_D_REG,
DA9052_CONTROLD_TWDSCALE,
da9052_wdt_maps[i].reg_val);
if (ret < 0) {
dev_err(da9052->dev,
"Failed to update timescale bit, %d\n", ret);
return ret;
}
wdt_dev->timeout = timeout;
driver_data->jpast = jiffies;
}
return 0;
}
static void da9052_wdt_ref(struct watchdog_device *wdt_dev)
{
struct da9052_wdt_data *driver_data = watchdog_get_drvdata(wdt_dev);
kref_get(&driver_data->kref);
}
static void da9052_wdt_unref(struct watchdog_device *wdt_dev)
{
struct da9052_wdt_data *driver_data = watchdog_get_drvdata(wdt_dev);
kref_put(&driver_data->kref, da9052_wdt_release_resources);
}
static int da9052_wdt_start(struct watchdog_device *wdt_dev)
{
return da9052_wdt_set_timeout(wdt_dev, wdt_dev->timeout);
}
static int da9052_wdt_stop(struct watchdog_device *wdt_dev)
{
return da9052_wdt_set_timeout(wdt_dev, 0);
}
static int da9052_wdt_ping(struct watchdog_device *wdt_dev)
{
struct da9052_wdt_data *driver_data = watchdog_get_drvdata(wdt_dev);
struct da9052 *da9052 = driver_data->da9052;
unsigned long msec, jnow = jiffies;
int ret;
/*
* We have a minimum time for watchdog window called TWDMIN. A write
* to the watchdog before this elapsed time should cause an error.
*/
msec = (jnow - driver_data->jpast) * 1000/HZ;
if (msec < DA9052_TWDMIN)
mdelay(msec);
/* Reset the watchdog timer */
ret = da9052_reg_update(da9052, DA9052_CONTROL_D_REG,
DA9052_CONTROLD_WATCHDOG, 1 << 7);
if (ret < 0)
goto err_strobe;
/*
* FIXME: Reset the watchdog core, in general PMIC
* is supposed to do this
*/
ret = da9052_reg_update(da9052, DA9052_CONTROL_D_REG,
DA9052_CONTROLD_WATCHDOG, 0 << 7);
err_strobe:
return ret;
}
static struct watchdog_info da9052_wdt_info = {
.options = WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING,
.identity = "DA9052 Watchdog",
};
static const struct watchdog_ops da9052_wdt_ops = {
.owner = THIS_MODULE,
.start = da9052_wdt_start,
.stop = da9052_wdt_stop,
.ping = da9052_wdt_ping,
.set_timeout = da9052_wdt_set_timeout,
.ref = da9052_wdt_ref,
.unref = da9052_wdt_unref,
};
static int __devinit da9052_wdt_probe(struct platform_device *pdev)
{
struct da9052 *da9052 = dev_get_drvdata(pdev->dev.parent);
struct da9052_wdt_data *driver_data;
struct watchdog_device *da9052_wdt;
int ret;
driver_data = devm_kzalloc(&pdev->dev, sizeof(*driver_data),
GFP_KERNEL);
if (!driver_data) {
dev_err(da9052->dev, "Unable to alloacate watchdog device\n");
ret = -ENOMEM;
goto err;
}
driver_data->da9052 = da9052;
da9052_wdt = &driver_data->wdt;
da9052_wdt->timeout = DA9052_DEF_TIMEOUT;
da9052_wdt->info = &da9052_wdt_info;
da9052_wdt->ops = &da9052_wdt_ops;
watchdog_set_drvdata(da9052_wdt, driver_data);
kref_init(&driver_data->kref);
ret = da9052_reg_update(da9052, DA9052_CONTROL_D_REG,
DA9052_CONTROLD_TWDSCALE, 0);
if (ret < 0) {
dev_err(&pdev->dev, "Failed to disable watchdog bits, %d\n",
ret);
goto err;
}
ret = watchdog_register_device(&driver_data->wdt);
if (ret != 0) {
dev_err(da9052->dev, "watchdog_register_device() failed: %d\n",
ret);
goto err;
}
dev_set_drvdata(&pdev->dev, driver_data);
err:
return ret;
}
static int __devexit da9052_wdt_remove(struct platform_device *pdev)
{
struct da9052_wdt_data *driver_data = dev_get_drvdata(&pdev->dev);
watchdog_unregister_device(&driver_data->wdt);
kref_put(&driver_data->kref, da9052_wdt_release_resources);
return 0;
}
static struct platform_driver da9052_wdt_driver = {
.probe = da9052_wdt_probe,
.remove = __devexit_p(da9052_wdt_remove),
.driver = {
.name = "da9052-watchdog",
},
};
module_platform_driver(da9052_wdt_driver);
MODULE_AUTHOR("Anthony Olech <Anthony.Olech@diasemi.com>");
MODULE_DESCRIPTION("DA9052 SM Device Driver");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:da9052-watchdog");
...@@ -575,7 +575,7 @@ static int __devinit iTCO_wdt_probe(struct platform_device *dev) ...@@ -575,7 +575,7 @@ static int __devinit iTCO_wdt_probe(struct platform_device *dev)
if (!request_region(iTCO_wdt_private.smi_res->start, if (!request_region(iTCO_wdt_private.smi_res->start,
resource_size(iTCO_wdt_private.smi_res), dev->name)) { resource_size(iTCO_wdt_private.smi_res), dev->name)) {
pr_err("I/O address 0x%04llx already in use, device disabled\n", pr_err("I/O address 0x%04llx already in use, device disabled\n",
SMI_EN); (u64)SMI_EN);
ret = -EBUSY; ret = -EBUSY;
goto unmap_gcs; goto unmap_gcs;
} }
...@@ -592,13 +592,13 @@ static int __devinit iTCO_wdt_probe(struct platform_device *dev) ...@@ -592,13 +592,13 @@ static int __devinit iTCO_wdt_probe(struct platform_device *dev)
if (!request_region(iTCO_wdt_private.tco_res->start, if (!request_region(iTCO_wdt_private.tco_res->start,
resource_size(iTCO_wdt_private.tco_res), dev->name)) { resource_size(iTCO_wdt_private.tco_res), dev->name)) {
pr_err("I/O address 0x%04llx already in use, device disabled\n", pr_err("I/O address 0x%04llx already in use, device disabled\n",
TCOBASE); (u64)TCOBASE);
ret = -EBUSY; ret = -EBUSY;
goto unreg_smi; goto unreg_smi;
} }
pr_info("Found a %s TCO device (Version=%d, TCOBASE=0x%04llx)\n", pr_info("Found a %s TCO device (Version=%d, TCOBASE=0x%04llx)\n",
ich_info->name, ich_info->iTCO_version, TCOBASE); ich_info->name, ich_info->iTCO_version, (u64)TCOBASE);
/* Clear out the (probably old) status */ /* Clear out the (probably old) status */
outw(0x0008, TCO1_STS); /* Clear the Time Out Status bit */ outw(0x0008, TCO1_STS); /* Clear the Time Out Status bit */
......
...@@ -16,20 +16,17 @@ ...@@ -16,20 +16,17 @@
#include <linux/amba/bus.h> #include <linux/amba/bus.h>
#include <linux/bitops.h> #include <linux/bitops.h>
#include <linux/clk.h> #include <linux/clk.h>
#include <linux/fs.h>
#include <linux/init.h> #include <linux/init.h>
#include <linux/io.h> #include <linux/io.h>
#include <linux/ioport.h> #include <linux/ioport.h>
#include <linux/kernel.h> #include <linux/kernel.h>
#include <linux/math64.h> #include <linux/math64.h>
#include <linux/miscdevice.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/moduleparam.h> #include <linux/moduleparam.h>
#include <linux/pm.h> #include <linux/pm.h>
#include <linux/slab.h> #include <linux/slab.h>
#include <linux/spinlock.h> #include <linux/spinlock.h>
#include <linux/types.h> #include <linux/types.h>
#include <linux/uaccess.h>
#include <linux/watchdog.h> #include <linux/watchdog.h>
/* default timeout in seconds */ /* default timeout in seconds */
...@@ -56,6 +53,7 @@ ...@@ -56,6 +53,7 @@
/** /**
* struct sp805_wdt: sp805 wdt device structure * struct sp805_wdt: sp805 wdt device structure
* @wdd: instance of struct watchdog_device
* @lock: spin lock protecting dev structure and io access * @lock: spin lock protecting dev structure and io access
* @base: base address of wdt * @base: base address of wdt
* @clk: clock structure of wdt * @clk: clock structure of wdt
...@@ -65,24 +63,24 @@ ...@@ -65,24 +63,24 @@
* @timeout: current programmed timeout * @timeout: current programmed timeout
*/ */
struct sp805_wdt { struct sp805_wdt {
struct watchdog_device wdd;
spinlock_t lock; spinlock_t lock;
void __iomem *base; void __iomem *base;
struct clk *clk; struct clk *clk;
struct amba_device *adev; struct amba_device *adev;
unsigned long status;
#define WDT_BUSY 0
#define WDT_CAN_BE_CLOSED 1
unsigned int load_val; unsigned int load_val;
unsigned int timeout; unsigned int timeout;
}; };
/* local variables */
static struct sp805_wdt *wdt;
static bool nowayout = WATCHDOG_NOWAYOUT; static bool nowayout = WATCHDOG_NOWAYOUT;
module_param(nowayout, bool, 0);
MODULE_PARM_DESC(nowayout,
"Set to 1 to keep watchdog running after device release");
/* This routine finds load value that will reset system in required timout */ /* This routine finds load value that will reset system in required timout */
static void wdt_setload(unsigned int timeout) static int wdt_setload(struct watchdog_device *wdd, unsigned int timeout)
{ {
struct sp805_wdt *wdt = watchdog_get_drvdata(wdd);
u64 load, rate; u64 load, rate;
rate = clk_get_rate(wdt->clk); rate = clk_get_rate(wdt->clk);
...@@ -103,11 +101,14 @@ static void wdt_setload(unsigned int timeout) ...@@ -103,11 +101,14 @@ static void wdt_setload(unsigned int timeout)
/* roundup timeout to closest positive integer value */ /* roundup timeout to closest positive integer value */
wdt->timeout = div_u64((load + 1) * 2 + (rate / 2), rate); wdt->timeout = div_u64((load + 1) * 2 + (rate / 2), rate);
spin_unlock(&wdt->lock); spin_unlock(&wdt->lock);
return 0;
} }
/* returns number of seconds left for reset to occur */ /* returns number of seconds left for reset to occur */
static u32 wdt_timeleft(void) static unsigned int wdt_timeleft(struct watchdog_device *wdd)
{ {
struct sp805_wdt *wdt = watchdog_get_drvdata(wdd);
u64 load, rate; u64 load, rate;
rate = clk_get_rate(wdt->clk); rate = clk_get_rate(wdt->clk);
...@@ -123,166 +124,96 @@ static u32 wdt_timeleft(void) ...@@ -123,166 +124,96 @@ static u32 wdt_timeleft(void)
return div_u64(load, rate); return div_u64(load, rate);
} }
/* enables watchdog timers reset */ static int wdt_config(struct watchdog_device *wdd, bool ping)
static void wdt_enable(void)
{ {
spin_lock(&wdt->lock); struct sp805_wdt *wdt = watchdog_get_drvdata(wdd);
int ret;
writel_relaxed(UNLOCK, wdt->base + WDTLOCK); if (!ping) {
writel_relaxed(wdt->load_val, wdt->base + WDTLOAD); ret = clk_prepare(wdt->clk);
writel_relaxed(INT_MASK, wdt->base + WDTINTCLR); if (ret) {
writel_relaxed(INT_ENABLE | RESET_ENABLE, wdt->base + WDTCONTROL); dev_err(&wdt->adev->dev, "clock prepare fail");
writel_relaxed(LOCK, wdt->base + WDTLOCK); return ret;
}
/* Flush posted writes. */ ret = clk_enable(wdt->clk);
readl_relaxed(wdt->base + WDTLOCK); if (ret) {
spin_unlock(&wdt->lock); dev_err(&wdt->adev->dev, "clock enable fail");
} clk_unprepare(wdt->clk);
return ret;
}
}
/* disables watchdog timers reset */
static void wdt_disable(void)
{
spin_lock(&wdt->lock); spin_lock(&wdt->lock);
writel_relaxed(UNLOCK, wdt->base + WDTLOCK); writel_relaxed(UNLOCK, wdt->base + WDTLOCK);
writel_relaxed(0, wdt->base + WDTCONTROL); writel_relaxed(wdt->load_val, wdt->base + WDTLOAD);
if (!ping) {
writel_relaxed(INT_MASK, wdt->base + WDTINTCLR);
writel_relaxed(INT_ENABLE | RESET_ENABLE, wdt->base +
WDTCONTROL);
}
writel_relaxed(LOCK, wdt->base + WDTLOCK); writel_relaxed(LOCK, wdt->base + WDTLOCK);
/* Flush posted writes. */ /* Flush posted writes. */
readl_relaxed(wdt->base + WDTLOCK); readl_relaxed(wdt->base + WDTLOCK);
spin_unlock(&wdt->lock); spin_unlock(&wdt->lock);
return 0;
} }
static ssize_t sp805_wdt_write(struct file *file, const char *data, static int wdt_ping(struct watchdog_device *wdd)
size_t len, loff_t *ppos)
{ {
if (len) { return wdt_config(wdd, true);
if (!nowayout) {
size_t i;
clear_bit(WDT_CAN_BE_CLOSED, &wdt->status);
for (i = 0; i != len; i++) {
char c;
if (get_user(c, data + i))
return -EFAULT;
/* Check for Magic Close character */
if (c == 'V') {
set_bit(WDT_CAN_BE_CLOSED,
&wdt->status);
break;
}
}
}
wdt_enable();
}
return len;
} }
static const struct watchdog_info ident = { /* enables watchdog timers reset */
.options = WDIOF_MAGICCLOSE | WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING, static int wdt_enable(struct watchdog_device *wdd)
.identity = MODULE_NAME,
};
static long sp805_wdt_ioctl(struct file *file, unsigned int cmd,
unsigned long arg)
{ {
int ret = -ENOTTY; return wdt_config(wdd, false);
unsigned int timeout;
switch (cmd) {
case WDIOC_GETSUPPORT:
ret = copy_to_user((struct watchdog_info *)arg, &ident,
sizeof(ident)) ? -EFAULT : 0;
break;
case WDIOC_GETSTATUS:
ret = put_user(0, (int *)arg);
break;
case WDIOC_KEEPALIVE:
wdt_enable();
ret = 0;
break;
case WDIOC_SETTIMEOUT:
ret = get_user(timeout, (unsigned int *)arg);
if (ret)
break;
wdt_setload(timeout);
wdt_enable();
/* Fall through */
case WDIOC_GETTIMEOUT:
ret = put_user(wdt->timeout, (unsigned int *)arg);
break;
case WDIOC_GETTIMELEFT:
ret = put_user(wdt_timeleft(), (unsigned int *)arg);
break;
}
return ret;
} }
static int sp805_wdt_open(struct inode *inode, struct file *file) /* disables watchdog timers reset */
static int wdt_disable(struct watchdog_device *wdd)
{ {
int ret = 0; struct sp805_wdt *wdt = watchdog_get_drvdata(wdd);
if (test_and_set_bit(WDT_BUSY, &wdt->status))
return -EBUSY;
ret = clk_enable(wdt->clk);
if (ret) {
dev_err(&wdt->adev->dev, "clock enable fail");
goto err;
}
wdt_enable();
/* can not be closed, once enabled */ spin_lock(&wdt->lock);
clear_bit(WDT_CAN_BE_CLOSED, &wdt->status);
return nonseekable_open(inode, file);
err: writel_relaxed(UNLOCK, wdt->base + WDTLOCK);
clear_bit(WDT_BUSY, &wdt->status); writel_relaxed(0, wdt->base + WDTCONTROL);
return ret; writel_relaxed(LOCK, wdt->base + WDTLOCK);
}
static int sp805_wdt_release(struct inode *inode, struct file *file) /* Flush posted writes. */
{ readl_relaxed(wdt->base + WDTLOCK);
if (!test_bit(WDT_CAN_BE_CLOSED, &wdt->status)) { spin_unlock(&wdt->lock);
clear_bit(WDT_BUSY, &wdt->status);
dev_warn(&wdt->adev->dev, "Device closed unexpectedly\n");
return 0;
}
wdt_disable();
clk_disable(wdt->clk); clk_disable(wdt->clk);
clear_bit(WDT_BUSY, &wdt->status); clk_unprepare(wdt->clk);
return 0; return 0;
} }
static const struct file_operations sp805_wdt_fops = { static const struct watchdog_info wdt_info = {
.owner = THIS_MODULE, .options = WDIOF_MAGICCLOSE | WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING,
.llseek = no_llseek, .identity = MODULE_NAME,
.write = sp805_wdt_write,
.unlocked_ioctl = sp805_wdt_ioctl,
.open = sp805_wdt_open,
.release = sp805_wdt_release,
}; };
static struct miscdevice sp805_wdt_miscdev = { static const struct watchdog_ops wdt_ops = {
.minor = WATCHDOG_MINOR, .owner = THIS_MODULE,
.name = "watchdog", .start = wdt_enable,
.fops = &sp805_wdt_fops, .stop = wdt_disable,
.ping = wdt_ping,
.set_timeout = wdt_setload,
.get_timeleft = wdt_timeleft,
}; };
static int __devinit static int __devinit
sp805_wdt_probe(struct amba_device *adev, const struct amba_id *id) sp805_wdt_probe(struct amba_device *adev, const struct amba_id *id)
{ {
struct sp805_wdt *wdt;
int ret = 0; int ret = 0;
if (!devm_request_mem_region(&adev->dev, adev->res.start, if (!devm_request_mem_region(&adev->dev, adev->res.start,
...@@ -315,19 +246,26 @@ sp805_wdt_probe(struct amba_device *adev, const struct amba_id *id) ...@@ -315,19 +246,26 @@ sp805_wdt_probe(struct amba_device *adev, const struct amba_id *id)
} }
wdt->adev = adev; wdt->adev = adev;
wdt->wdd.info = &wdt_info;
wdt->wdd.ops = &wdt_ops;
spin_lock_init(&wdt->lock); spin_lock_init(&wdt->lock);
wdt_setload(DEFAULT_TIMEOUT); watchdog_set_nowayout(&wdt->wdd, nowayout);
watchdog_set_drvdata(&wdt->wdd, wdt);
wdt_setload(&wdt->wdd, DEFAULT_TIMEOUT);
ret = misc_register(&sp805_wdt_miscdev); ret = watchdog_register_device(&wdt->wdd);
if (ret < 0) { if (ret) {
dev_warn(&adev->dev, "cannot register misc device\n"); dev_err(&adev->dev, "watchdog_register_device() failed: %d\n",
goto err_misc_register; ret);
goto err_register;
} }
amba_set_drvdata(adev, wdt);
dev_info(&adev->dev, "registration successful\n"); dev_info(&adev->dev, "registration successful\n");
return 0; return 0;
err_misc_register: err_register:
clk_put(wdt->clk); clk_put(wdt->clk);
err: err:
dev_err(&adev->dev, "Probe Failed!!!\n"); dev_err(&adev->dev, "Probe Failed!!!\n");
...@@ -336,7 +274,11 @@ sp805_wdt_probe(struct amba_device *adev, const struct amba_id *id) ...@@ -336,7 +274,11 @@ sp805_wdt_probe(struct amba_device *adev, const struct amba_id *id)
static int __devexit sp805_wdt_remove(struct amba_device *adev) static int __devexit sp805_wdt_remove(struct amba_device *adev)
{ {
misc_deregister(&sp805_wdt_miscdev); struct sp805_wdt *wdt = amba_get_drvdata(adev);
watchdog_unregister_device(&wdt->wdd);
amba_set_drvdata(adev, NULL);
watchdog_set_drvdata(&wdt->wdd, NULL);
clk_put(wdt->clk); clk_put(wdt->clk);
return 0; return 0;
...@@ -345,28 +287,22 @@ static int __devexit sp805_wdt_remove(struct amba_device *adev) ...@@ -345,28 +287,22 @@ static int __devexit sp805_wdt_remove(struct amba_device *adev)
#ifdef CONFIG_PM #ifdef CONFIG_PM
static int sp805_wdt_suspend(struct device *dev) static int sp805_wdt_suspend(struct device *dev)
{ {
if (test_bit(WDT_BUSY, &wdt->status)) { struct sp805_wdt *wdt = dev_get_drvdata(dev);
wdt_disable();
clk_disable(wdt->clk); if (watchdog_active(&wdt->wdd))
} return wdt_disable(&wdt->wdd);
return 0; return 0;
} }
static int sp805_wdt_resume(struct device *dev) static int sp805_wdt_resume(struct device *dev)
{ {
int ret = 0; struct sp805_wdt *wdt = dev_get_drvdata(dev);
if (test_bit(WDT_BUSY, &wdt->status)) { if (watchdog_active(&wdt->wdd))
ret = clk_enable(wdt->clk); return wdt_enable(&wdt->wdd);
if (ret) {
dev_err(dev, "clock enable fail");
return ret;
}
wdt_enable();
}
return ret; return 0;
} }
#endif /* CONFIG_PM */ #endif /* CONFIG_PM */
...@@ -395,11 +331,6 @@ static struct amba_driver sp805_wdt_driver = { ...@@ -395,11 +331,6 @@ static struct amba_driver sp805_wdt_driver = {
module_amba_driver(sp805_wdt_driver); module_amba_driver(sp805_wdt_driver);
module_param(nowayout, bool, 0);
MODULE_PARM_DESC(nowayout,
"Set to 1 to keep watchdog running after device release");
MODULE_AUTHOR("Viresh Kumar <viresh.kumar@st.com>"); MODULE_AUTHOR("Viresh Kumar <viresh.kumar@st.com>");
MODULE_DESCRIPTION("ARM SP805 Watchdog Driver"); MODULE_DESCRIPTION("ARM SP805 Watchdog Driver");
MODULE_LICENSE("GPL"); MODULE_LICENSE("GPL");
MODULE_ALIAS_MISCDEV(WATCHDOG_MINOR);
...@@ -91,7 +91,7 @@ static inline void wdt_reset(void) ...@@ -91,7 +91,7 @@ static inline void wdt_reset(void)
static void wdt_timer_tick(unsigned long data) static void wdt_timer_tick(unsigned long data)
{ {
if (time_before(jiffies, next_heartbeat) || if (time_before(jiffies, next_heartbeat) ||
(!test_bit(WDOG_ACTIVE, &wdt_dev.status))) { (!watchdog_active(&wdt_dev))) {
wdt_reset(); wdt_reset();
mod_timer(&timer, jiffies + WDT_HEARTBEAT); mod_timer(&timer, jiffies + WDT_HEARTBEAT);
} else } else
......
...@@ -34,8 +34,13 @@ ...@@ -34,8 +34,13 @@
#include <linux/kernel.h> /* For printk/panic/... */ #include <linux/kernel.h> /* For printk/panic/... */
#include <linux/watchdog.h> /* For watchdog specific items */ #include <linux/watchdog.h> /* For watchdog specific items */
#include <linux/init.h> /* For __init/__exit/... */ #include <linux/init.h> /* For __init/__exit/... */
#include <linux/idr.h> /* For ida_* macros */
#include <linux/err.h> /* For IS_ERR macros */
#include "watchdog_dev.h" /* For watchdog_dev_register/... */ #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 * watchdog_register_device() - register a watchdog device
...@@ -49,7 +54,7 @@ ...@@ -49,7 +54,7 @@
*/ */
int watchdog_register_device(struct watchdog_device *wdd) int watchdog_register_device(struct watchdog_device *wdd)
{ {
int ret; int ret, id, devno;
if (wdd == NULL || wdd->info == NULL || wdd->ops == NULL) if (wdd == NULL || wdd->info == NULL || wdd->ops == NULL)
return -EINVAL; return -EINVAL;
...@@ -74,10 +79,38 @@ int watchdog_register_device(struct watchdog_device *wdd) ...@@ -74,10 +79,38 @@ int watchdog_register_device(struct watchdog_device *wdd)
* corrupted in a later stage then we expect a kernel panic! * corrupted in a later stage then we expect a kernel panic!
*/ */
/* We only support 1 watchdog device via the /dev/watchdog interface */ mutex_init(&wdd->lock);
id = ida_simple_get(&watchdog_ida, 0, MAX_DOGS, GFP_KERNEL);
if (id < 0)
return id;
wdd->id = id;
ret = watchdog_dev_register(wdd); ret = watchdog_dev_register(wdd);
if (ret) { if (ret) {
pr_err("error registering /dev/watchdog (err=%d)\n", ret); ida_simple_remove(&watchdog_ida, id);
if (!(id == 0 && ret == -EBUSY))
return ret;
/* Retry in case a legacy watchdog module exists */
id = ida_simple_get(&watchdog_ida, 1, MAX_DOGS, GFP_KERNEL);
if (id < 0)
return id;
wdd->id = id;
ret = watchdog_dev_register(wdd);
if (ret) {
ida_simple_remove(&watchdog_ida, id);
return ret;
}
}
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 ret;
} }
...@@ -95,6 +128,7 @@ EXPORT_SYMBOL_GPL(watchdog_register_device); ...@@ -95,6 +128,7 @@ EXPORT_SYMBOL_GPL(watchdog_register_device);
void watchdog_unregister_device(struct watchdog_device *wdd) void watchdog_unregister_device(struct watchdog_device *wdd)
{ {
int ret; int ret;
int devno = wdd->cdev.dev;
if (wdd == NULL) if (wdd == NULL)
return; return;
...@@ -102,9 +136,41 @@ void watchdog_unregister_device(struct watchdog_device *wdd) ...@@ -102,9 +136,41 @@ void watchdog_unregister_device(struct watchdog_device *wdd)
ret = watchdog_dev_unregister(wdd); ret = watchdog_dev_unregister(wdd);
if (ret) if (ret)
pr_err("error unregistering /dev/watchdog (err=%d)\n", 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); EXPORT_SYMBOL_GPL(watchdog_unregister_device);
static int __init watchdog_init(void)
{
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);
}
subsys_initcall(watchdog_init);
module_exit(watchdog_exit);
MODULE_AUTHOR("Alan Cox <alan@lxorguk.ukuu.org.uk>"); MODULE_AUTHOR("Alan Cox <alan@lxorguk.ukuu.org.uk>");
MODULE_AUTHOR("Wim Van Sebroeck <wim@iguana.be>"); MODULE_AUTHOR("Wim Van Sebroeck <wim@iguana.be>");
MODULE_DESCRIPTION("WatchDog Timer Driver Core"); MODULE_DESCRIPTION("WatchDog Timer Driver Core");
......
...@@ -26,8 +26,12 @@ ...@@ -26,8 +26,12 @@
* This material is provided "AS-IS" and at no charge. * This material is provided "AS-IS" and at no charge.
*/ */
#define MAX_DOGS 32 /* Maximum number of watchdog devices */
/* /*
* Functions/procedures to be called by the core * Functions/procedures to be called by the core
*/ */
int watchdog_dev_register(struct watchdog_device *); extern int watchdog_dev_register(struct watchdog_device *);
int watchdog_dev_unregister(struct watchdog_device *); extern int watchdog_dev_unregister(struct watchdog_device *);
extern int __init watchdog_dev_init(void);
extern void __exit watchdog_dev_exit(void);
...@@ -42,10 +42,12 @@ ...@@ -42,10 +42,12 @@
#include <linux/init.h> /* For __init/__exit/... */ #include <linux/init.h> /* For __init/__exit/... */
#include <linux/uaccess.h> /* For copy_to_user/put_user/... */ #include <linux/uaccess.h> /* For copy_to_user/put_user/... */
/* make sure we only register one /dev/watchdog device */ #include "watchdog_core.h"
static unsigned long watchdog_dev_busy;
/* the dev_t structure to store the dynamically allocated watchdog devices */
static dev_t watchdog_devt;
/* the watchdog device behind /dev/watchdog */ /* the watchdog device behind /dev/watchdog */
static struct watchdog_device *wdd; static struct watchdog_device *old_wdd;
/* /*
* watchdog_ping: ping the watchdog. * watchdog_ping: ping the watchdog.
...@@ -59,13 +61,26 @@ static struct watchdog_device *wdd; ...@@ -59,13 +61,26 @@ static struct watchdog_device *wdd;
static int watchdog_ping(struct watchdog_device *wddev) static int watchdog_ping(struct watchdog_device *wddev)
{ {
if (test_bit(WDOG_ACTIVE, &wddev->status)) { int err = 0;
if (wddev->ops->ping)
return wddev->ops->ping(wddev); /* ping the watchdog */ mutex_lock(&wddev->lock);
else
return wddev->ops->start(wddev); /* restart watchdog */ if (test_bit(WDOG_UNREGISTERED, &wddev->status)) {
err = -ENODEV;
goto out_ping;
} }
return 0;
if (!watchdog_active(wddev))
goto out_ping;
if (wddev->ops->ping)
err = wddev->ops->ping(wddev); /* ping the watchdog */
else
err = wddev->ops->start(wddev); /* restart watchdog */
out_ping:
mutex_unlock(&wddev->lock);
return err;
} }
/* /*
...@@ -79,16 +94,25 @@ static int watchdog_ping(struct watchdog_device *wddev) ...@@ -79,16 +94,25 @@ static int watchdog_ping(struct watchdog_device *wddev)
static int watchdog_start(struct watchdog_device *wddev) static int watchdog_start(struct watchdog_device *wddev)
{ {
int err; int err = 0;
if (!test_bit(WDOG_ACTIVE, &wddev->status)) { mutex_lock(&wddev->lock);
err = wddev->ops->start(wddev);
if (err < 0)
return err;
set_bit(WDOG_ACTIVE, &wddev->status); if (test_bit(WDOG_UNREGISTERED, &wddev->status)) {
err = -ENODEV;
goto out_start;
} }
return 0;
if (watchdog_active(wddev))
goto out_start;
err = wddev->ops->start(wddev);
if (err == 0)
set_bit(WDOG_ACTIVE, &wddev->status);
out_start:
mutex_unlock(&wddev->lock);
return err;
} }
/* /*
...@@ -103,22 +127,155 @@ static int watchdog_start(struct watchdog_device *wddev) ...@@ -103,22 +127,155 @@ static int watchdog_start(struct watchdog_device *wddev)
static int watchdog_stop(struct watchdog_device *wddev) static int watchdog_stop(struct watchdog_device *wddev)
{ {
int err = -EBUSY; int err = 0;
if (test_bit(WDOG_NO_WAY_OUT, &wddev->status)) { mutex_lock(&wddev->lock);
pr_info("%s: nowayout prevents watchdog to be stopped!\n",
wddev->info->identity); if (test_bit(WDOG_UNREGISTERED, &wddev->status)) {
return err; err = -ENODEV;
goto out_stop;
} }
if (test_bit(WDOG_ACTIVE, &wddev->status)) { if (!watchdog_active(wddev))
err = wddev->ops->stop(wddev); goto out_stop;
if (err < 0)
return err;
if (test_bit(WDOG_NO_WAY_OUT, &wddev->status)) {
dev_info(wddev->dev, "nowayout prevents watchdog being stopped!\n");
err = -EBUSY;
goto out_stop;
}
err = wddev->ops->stop(wddev);
if (err == 0)
clear_bit(WDOG_ACTIVE, &wddev->status); clear_bit(WDOG_ACTIVE, &wddev->status);
out_stop:
mutex_unlock(&wddev->lock);
return err;
}
/*
* watchdog_get_status: wrapper to get the watchdog status
* @wddev: the watchdog device to get the status from
* @status: the status of the watchdog device
*
* Get the watchdog's status flags.
*/
static int watchdog_get_status(struct watchdog_device *wddev,
unsigned int *status)
{
int err = 0;
*status = 0;
if (!wddev->ops->status)
return -EOPNOTSUPP;
mutex_lock(&wddev->lock);
if (test_bit(WDOG_UNREGISTERED, &wddev->status)) {
err = -ENODEV;
goto out_status;
} }
return 0;
*status = wddev->ops->status(wddev);
out_status:
mutex_unlock(&wddev->lock);
return err;
}
/*
* watchdog_set_timeout: set the watchdog timer timeout
* @wddev: the watchdog device to set the timeout for
* @timeout: timeout to set in seconds
*/
static int watchdog_set_timeout(struct watchdog_device *wddev,
unsigned int timeout)
{
int err;
if ((wddev->ops->set_timeout == NULL) ||
!(wddev->info->options & WDIOF_SETTIMEOUT))
return -EOPNOTSUPP;
if ((wddev->max_timeout != 0) &&
(timeout < wddev->min_timeout || timeout > wddev->max_timeout))
return -EINVAL;
mutex_lock(&wddev->lock);
if (test_bit(WDOG_UNREGISTERED, &wddev->status)) {
err = -ENODEV;
goto out_timeout;
}
err = wddev->ops->set_timeout(wddev, timeout);
out_timeout:
mutex_unlock(&wddev->lock);
return err;
}
/*
* watchdog_get_timeleft: wrapper to get the time left before a reboot
* @wddev: the watchdog device to get the remaining time from
* @timeleft: the time that's left
*
* Get the time before a watchdog will reboot (if not pinged).
*/
static int watchdog_get_timeleft(struct watchdog_device *wddev,
unsigned int *timeleft)
{
int err = 0;
*timeleft = 0;
if (!wddev->ops->get_timeleft)
return -EOPNOTSUPP;
mutex_lock(&wddev->lock);
if (test_bit(WDOG_UNREGISTERED, &wddev->status)) {
err = -ENODEV;
goto out_timeleft;
}
*timeleft = wddev->ops->get_timeleft(wddev);
out_timeleft:
mutex_unlock(&wddev->lock);
return err;
}
/*
* watchdog_ioctl_op: call the watchdog drivers ioctl op if defined
* @wddev: the watchdog device to do the ioctl on
* @cmd: watchdog command
* @arg: argument pointer
*/
static int watchdog_ioctl_op(struct watchdog_device *wddev, unsigned int cmd,
unsigned long arg)
{
int err;
if (!wddev->ops->ioctl)
return -ENOIOCTLCMD;
mutex_lock(&wddev->lock);
if (test_bit(WDOG_UNREGISTERED, &wddev->status)) {
err = -ENODEV;
goto out_ioctl;
}
err = wddev->ops->ioctl(wddev, cmd, arg);
out_ioctl:
mutex_unlock(&wddev->lock);
return err;
} }
/* /*
...@@ -136,6 +293,7 @@ static int watchdog_stop(struct watchdog_device *wddev) ...@@ -136,6 +293,7 @@ static int watchdog_stop(struct watchdog_device *wddev)
static ssize_t watchdog_write(struct file *file, const char __user *data, static ssize_t watchdog_write(struct file *file, const char __user *data,
size_t len, loff_t *ppos) size_t len, loff_t *ppos)
{ {
struct watchdog_device *wdd = file->private_data;
size_t i; size_t i;
char c; char c;
...@@ -175,23 +333,24 @@ static ssize_t watchdog_write(struct file *file, const char __user *data, ...@@ -175,23 +333,24 @@ static ssize_t watchdog_write(struct file *file, const char __user *data,
static long watchdog_ioctl(struct file *file, unsigned int cmd, static long watchdog_ioctl(struct file *file, unsigned int cmd,
unsigned long arg) unsigned long arg)
{ {
struct watchdog_device *wdd = file->private_data;
void __user *argp = (void __user *)arg; void __user *argp = (void __user *)arg;
int __user *p = argp; int __user *p = argp;
unsigned int val; unsigned int val;
int err; int err;
if (wdd->ops->ioctl) { err = watchdog_ioctl_op(wdd, cmd, arg);
err = wdd->ops->ioctl(wdd, cmd, arg); if (err != -ENOIOCTLCMD)
if (err != -ENOIOCTLCMD) return err;
return err;
}
switch (cmd) { switch (cmd) {
case WDIOC_GETSUPPORT: case WDIOC_GETSUPPORT:
return copy_to_user(argp, wdd->info, return copy_to_user(argp, wdd->info,
sizeof(struct watchdog_info)) ? -EFAULT : 0; sizeof(struct watchdog_info)) ? -EFAULT : 0;
case WDIOC_GETSTATUS: case WDIOC_GETSTATUS:
val = wdd->ops->status ? wdd->ops->status(wdd) : 0; err = watchdog_get_status(wdd, &val);
if (err)
return err;
return put_user(val, p); return put_user(val, p);
case WDIOC_GETBOOTSTATUS: case WDIOC_GETBOOTSTATUS:
return put_user(wdd->bootstatus, p); return put_user(wdd->bootstatus, p);
...@@ -215,15 +374,9 @@ static long watchdog_ioctl(struct file *file, unsigned int cmd, ...@@ -215,15 +374,9 @@ static long watchdog_ioctl(struct file *file, unsigned int cmd,
watchdog_ping(wdd); watchdog_ping(wdd);
return 0; return 0;
case WDIOC_SETTIMEOUT: case WDIOC_SETTIMEOUT:
if ((wdd->ops->set_timeout == NULL) ||
!(wdd->info->options & WDIOF_SETTIMEOUT))
return -EOPNOTSUPP;
if (get_user(val, p)) if (get_user(val, p))
return -EFAULT; return -EFAULT;
if ((wdd->max_timeout != 0) && err = watchdog_set_timeout(wdd, val);
(val < wdd->min_timeout || val > wdd->max_timeout))
return -EINVAL;
err = wdd->ops->set_timeout(wdd, val);
if (err < 0) if (err < 0)
return err; return err;
/* If the watchdog is active then we send a keepalive ping /* If the watchdog is active then we send a keepalive ping
...@@ -237,21 +390,21 @@ static long watchdog_ioctl(struct file *file, unsigned int cmd, ...@@ -237,21 +390,21 @@ static long watchdog_ioctl(struct file *file, unsigned int cmd,
return -EOPNOTSUPP; return -EOPNOTSUPP;
return put_user(wdd->timeout, p); return put_user(wdd->timeout, p);
case WDIOC_GETTIMELEFT: case WDIOC_GETTIMELEFT:
if (!wdd->ops->get_timeleft) err = watchdog_get_timeleft(wdd, &val);
return -EOPNOTSUPP; if (err)
return err;
return put_user(wdd->ops->get_timeleft(wdd), p); return put_user(val, p);
default: default:
return -ENOTTY; return -ENOTTY;
} }
} }
/* /*
* watchdog_open: open the /dev/watchdog device. * watchdog_open: open the /dev/watchdog* devices.
* @inode: inode of device * @inode: inode of device
* @file: file handle to device * @file: file handle to device
* *
* When the /dev/watchdog device gets opened, we start the watchdog. * When the /dev/watchdog* device gets opened, we start the watchdog.
* Watch out: the /dev/watchdog device is single open, so we make sure * Watch out: the /dev/watchdog device is single open, so we make sure
* it can only be opened once. * it can only be opened once.
*/ */
...@@ -259,6 +412,13 @@ static long watchdog_ioctl(struct file *file, unsigned int cmd, ...@@ -259,6 +412,13 @@ static long watchdog_ioctl(struct file *file, unsigned int cmd,
static int watchdog_open(struct inode *inode, struct file *file) static int watchdog_open(struct inode *inode, struct file *file)
{ {
int err = -EBUSY; int err = -EBUSY;
struct watchdog_device *wdd;
/* Get the corresponding watchdog device */
if (imajor(inode) == MISC_MAJOR)
wdd = old_wdd;
else
wdd = container_of(inode->i_cdev, struct watchdog_device, cdev);
/* the watchdog is single open! */ /* the watchdog is single open! */
if (test_and_set_bit(WDOG_DEV_OPEN, &wdd->status)) if (test_and_set_bit(WDOG_DEV_OPEN, &wdd->status))
...@@ -275,6 +435,11 @@ static int watchdog_open(struct inode *inode, struct file *file) ...@@ -275,6 +435,11 @@ static int watchdog_open(struct inode *inode, struct file *file)
if (err < 0) if (err < 0)
goto out_mod; goto out_mod;
file->private_data = wdd;
if (wdd->ops->ref)
wdd->ops->ref(wdd);
/* dev/watchdog is a virtual (and thus non-seekable) filesystem */ /* dev/watchdog is a virtual (and thus non-seekable) filesystem */
return nonseekable_open(inode, file); return nonseekable_open(inode, file);
...@@ -286,9 +451,9 @@ static int watchdog_open(struct inode *inode, struct file *file) ...@@ -286,9 +451,9 @@ static int watchdog_open(struct inode *inode, struct file *file)
} }
/* /*
* watchdog_release: release the /dev/watchdog device. * watchdog_release: release the watchdog device.
* @inode: inode of device * @inode: inode of device
* @file: file handle to device * @file: file handle to device
* *
* This is the code for when /dev/watchdog gets closed. We will only * This is the code for when /dev/watchdog gets closed. We will only
* stop the watchdog when we have received the magic char (and nowayout * stop the watchdog when we have received the magic char (and nowayout
...@@ -297,6 +462,7 @@ static int watchdog_open(struct inode *inode, struct file *file) ...@@ -297,6 +462,7 @@ static int watchdog_open(struct inode *inode, struct file *file)
static int watchdog_release(struct inode *inode, struct file *file) static int watchdog_release(struct inode *inode, struct file *file)
{ {
struct watchdog_device *wdd = file->private_data;
int err = -EBUSY; int err = -EBUSY;
/* /*
...@@ -310,7 +476,10 @@ static int watchdog_release(struct inode *inode, struct file *file) ...@@ -310,7 +476,10 @@ static int watchdog_release(struct inode *inode, struct file *file)
/* If the watchdog was not stopped, send a keepalive ping */ /* If the watchdog was not stopped, send a keepalive ping */
if (err < 0) { if (err < 0) {
pr_crit("%s: watchdog did not stop!\n", wdd->info->identity); mutex_lock(&wdd->lock);
if (!test_bit(WDOG_UNREGISTERED, &wdd->status))
dev_crit(wdd->dev, "watchdog did not stop!\n");
mutex_unlock(&wdd->lock);
watchdog_ping(wdd); watchdog_ping(wdd);
} }
...@@ -320,6 +489,10 @@ static int watchdog_release(struct inode *inode, struct file *file) ...@@ -320,6 +489,10 @@ static int watchdog_release(struct inode *inode, struct file *file)
/* make sure that /dev/watchdog can be re-opened */ /* make sure that /dev/watchdog can be re-opened */
clear_bit(WDOG_DEV_OPEN, &wdd->status); clear_bit(WDOG_DEV_OPEN, &wdd->status);
/* Note wdd may be gone after this, do not use after this! */
if (wdd->ops->unref)
wdd->ops->unref(wdd);
return 0; return 0;
} }
...@@ -338,62 +511,92 @@ static struct miscdevice watchdog_miscdev = { ...@@ -338,62 +511,92 @@ static struct miscdevice watchdog_miscdev = {
}; };
/* /*
* watchdog_dev_register: * watchdog_dev_register: register a watchdog device
* @watchdog: watchdog device * @watchdog: watchdog device
* *
* Register a watchdog device as /dev/watchdog. /dev/watchdog * Register a watchdog device including handling the legacy
* is actually a miscdevice and thus we set it up like that. * /dev/watchdog node. /dev/watchdog is actually a miscdevice and
* thus we set it up like that.
*/ */
int watchdog_dev_register(struct watchdog_device *watchdog) int watchdog_dev_register(struct watchdog_device *watchdog)
{ {
int err; int err, devno;
/* Only one device can register for /dev/watchdog */ if (watchdog->id == 0) {
if (test_and_set_bit(0, &watchdog_dev_busy)) { watchdog_miscdev.parent = watchdog->parent;
pr_err("only one watchdog can use /dev/watchdog\n"); err = misc_register(&watchdog_miscdev);
return -EBUSY; if (err != 0) {
pr_err("%s: cannot register miscdev on minor=%d (err=%d).\n",
watchdog->info->identity, WATCHDOG_MINOR, err);
if (err == -EBUSY)
pr_err("%s: a legacy watchdog module is probably present.\n",
watchdog->info->identity);
return err;
}
old_wdd = watchdog;
} }
wdd = watchdog; /* Fill in the data structures */
devno = MKDEV(MAJOR(watchdog_devt), watchdog->id);
err = misc_register(&watchdog_miscdev); cdev_init(&watchdog->cdev, &watchdog_fops);
if (err != 0) { watchdog->cdev.owner = watchdog->ops->owner;
pr_err("%s: cannot register miscdev on minor=%d (err=%d)\n",
watchdog->info->identity, WATCHDOG_MINOR, err); /* Add the device */
goto out; err = cdev_add(&watchdog->cdev, devno, 1);
if (err) {
pr_err("watchdog%d unable to add device %d:%d\n",
watchdog->id, MAJOR(watchdog_devt), watchdog->id);
if (watchdog->id == 0) {
misc_deregister(&watchdog_miscdev);
old_wdd = NULL;
}
} }
return 0;
out:
wdd = NULL;
clear_bit(0, &watchdog_dev_busy);
return err; return err;
} }
/* /*
* watchdog_dev_unregister: * watchdog_dev_unregister: unregister a watchdog device
* @watchdog: watchdog device * @watchdog: watchdog device
* *
* Deregister the /dev/watchdog device. * Unregister the watchdog and if needed the legacy /dev/watchdog device.
*/ */
int watchdog_dev_unregister(struct watchdog_device *watchdog) int watchdog_dev_unregister(struct watchdog_device *watchdog)
{ {
/* Check that a watchdog device was registered in the past */ mutex_lock(&watchdog->lock);
if (!test_bit(0, &watchdog_dev_busy) || !wdd) set_bit(WDOG_UNREGISTERED, &watchdog->status);
return -ENODEV; mutex_unlock(&watchdog->lock);
/* We can only unregister the watchdog device that was registered */ cdev_del(&watchdog->cdev);
if (watchdog != wdd) { if (watchdog->id == 0) {
pr_err("%s: watchdog was not registered as /dev/watchdog\n", misc_deregister(&watchdog_miscdev);
watchdog->info->identity); old_wdd = NULL;
return -ENODEV;
} }
misc_deregister(&watchdog_miscdev);
wdd = NULL;
clear_bit(0, &watchdog_dev_busy);
return 0; return 0;
} }
/*
* watchdog_dev_init: init dev part of watchdog core
*
* Allocate a range of chardev nodes to use for watchdog devices
*/
int __init watchdog_dev_init(void)
{
int err = alloc_chrdev_region(&watchdog_devt, 0, MAX_DOGS, "watchdog");
if (err < 0)
pr_err("watchdog: unable to allocate char dev region\n");
return err;
}
/*
* watchdog_dev_exit: exit dev part of watchdog core
*
* Release the range of chardev nodes used for watchdog devices
*/
void __exit watchdog_dev_exit(void)
{
unregister_chrdev_region(watchdog_devt, MAX_DOGS);
}
...@@ -45,6 +45,8 @@ struct watchdog_info { ...@@ -45,6 +45,8 @@ struct watchdog_info {
#define WDIOF_SETTIMEOUT 0x0080 /* Set timeout (in seconds) */ #define WDIOF_SETTIMEOUT 0x0080 /* Set timeout (in seconds) */
#define WDIOF_MAGICCLOSE 0x0100 /* Supports magic close char */ #define WDIOF_MAGICCLOSE 0x0100 /* Supports magic close char */
#define WDIOF_PRETIMEOUT 0x0200 /* Pretimeout (in seconds), get/set */ #define WDIOF_PRETIMEOUT 0x0200 /* Pretimeout (in seconds), get/set */
#define WDIOF_ALARMONLY 0x0400 /* Watchdog triggers a management or
other external alarm not a reboot */
#define WDIOF_KEEPALIVEPING 0x8000 /* Keep alive ping reply */ #define WDIOF_KEEPALIVEPING 0x8000 /* Keep alive ping reply */
#define WDIOS_DISABLECARD 0x0001 /* Turn off the watchdog timer */ #define WDIOS_DISABLECARD 0x0001 /* Turn off the watchdog timer */
...@@ -54,6 +56,8 @@ struct watchdog_info { ...@@ -54,6 +56,8 @@ struct watchdog_info {
#ifdef __KERNEL__ #ifdef __KERNEL__
#include <linux/bitops.h> #include <linux/bitops.h>
#include <linux/device.h>
#include <linux/cdev.h>
struct watchdog_ops; struct watchdog_ops;
struct watchdog_device; struct watchdog_device;
...@@ -67,6 +71,8 @@ struct watchdog_device; ...@@ -67,6 +71,8 @@ struct watchdog_device;
* @status: The routine that shows the status of the watchdog device. * @status: The routine that shows the status of the watchdog device.
* @set_timeout:The routine for setting the watchdog devices timeout value. * @set_timeout:The routine for setting the watchdog devices timeout value.
* @get_timeleft:The routine that get's the time that's left before a reset. * @get_timeleft:The routine that get's the time that's left before a reset.
* @ref: The ref operation for dyn. allocated watchdog_device structs
* @unref: The unref operation for dyn. allocated watchdog_device structs
* @ioctl: The routines that handles extra ioctl calls. * @ioctl: The routines that handles extra ioctl calls.
* *
* The watchdog_ops structure contains a list of low-level operations * The watchdog_ops structure contains a list of low-level operations
...@@ -84,11 +90,17 @@ struct watchdog_ops { ...@@ -84,11 +90,17 @@ struct watchdog_ops {
unsigned int (*status)(struct watchdog_device *); unsigned int (*status)(struct watchdog_device *);
int (*set_timeout)(struct watchdog_device *, unsigned int); int (*set_timeout)(struct watchdog_device *, unsigned int);
unsigned int (*get_timeleft)(struct watchdog_device *); unsigned int (*get_timeleft)(struct watchdog_device *);
void (*ref)(struct watchdog_device *);
void (*unref)(struct watchdog_device *);
long (*ioctl)(struct watchdog_device *, unsigned int, unsigned long); long (*ioctl)(struct watchdog_device *, unsigned int, unsigned long);
}; };
/** struct watchdog_device - The structure that defines a watchdog device /** struct watchdog_device - The structure that defines a watchdog device
* *
* @id: The watchdog's ID. (Allocated by watchdog_register_device)
* @cdev: The watchdog's Character device.
* @dev: The device for our watchdog
* @parent: The parent bus device
* @info: Pointer to a watchdog_info structure. * @info: Pointer to a watchdog_info structure.
* @ops: Pointer to the list of watchdog operations. * @ops: Pointer to the list of watchdog operations.
* @bootstatus: Status of the watchdog device at boot. * @bootstatus: Status of the watchdog device at boot.
...@@ -96,6 +108,7 @@ struct watchdog_ops { ...@@ -96,6 +108,7 @@ struct watchdog_ops {
* @min_timeout:The watchdog devices minimum timeout value. * @min_timeout:The watchdog devices minimum timeout value.
* @max_timeout:The watchdog devices maximum timeout value. * @max_timeout:The watchdog devices maximum timeout value.
* @driver-data:Pointer to the drivers private data. * @driver-data:Pointer to the drivers private data.
* @lock: Lock for watchdog core internal use only.
* @status: Field that contains the devices internal status bits. * @status: Field that contains the devices internal status bits.
* *
* The watchdog_device structure contains all information about a * The watchdog_device structure contains all information about a
...@@ -103,8 +116,15 @@ struct watchdog_ops { ...@@ -103,8 +116,15 @@ struct watchdog_ops {
* *
* The driver-data field may not be accessed directly. It must be accessed * The driver-data field may not be accessed directly. It must be accessed
* via the watchdog_set_drvdata and watchdog_get_drvdata helpers. * via the watchdog_set_drvdata and watchdog_get_drvdata helpers.
*
* The lock field is for watchdog core internal use only and should not be
* touched.
*/ */
struct watchdog_device { struct watchdog_device {
int id;
struct cdev cdev;
struct device *dev;
struct device *parent;
const struct watchdog_info *info; const struct watchdog_info *info;
const struct watchdog_ops *ops; const struct watchdog_ops *ops;
unsigned int bootstatus; unsigned int bootstatus;
...@@ -112,12 +132,14 @@ struct watchdog_device { ...@@ -112,12 +132,14 @@ struct watchdog_device {
unsigned int min_timeout; unsigned int min_timeout;
unsigned int max_timeout; unsigned int max_timeout;
void *driver_data; void *driver_data;
struct mutex lock;
unsigned long status; unsigned long status;
/* Bit numbers for status flags */ /* Bit numbers for status flags */
#define WDOG_ACTIVE 0 /* Is the watchdog running/active */ #define WDOG_ACTIVE 0 /* Is the watchdog running/active */
#define WDOG_DEV_OPEN 1 /* Opened via /dev/watchdog ? */ #define WDOG_DEV_OPEN 1 /* Opened via /dev/watchdog ? */
#define WDOG_ALLOW_RELEASE 2 /* Did we receive the magic char ? */ #define WDOG_ALLOW_RELEASE 2 /* Did we receive the magic char ? */
#define WDOG_NO_WAY_OUT 3 /* Is 'nowayout' feature set ? */ #define WDOG_NO_WAY_OUT 3 /* Is 'nowayout' feature set ? */
#define WDOG_UNREGISTERED 4 /* Has the device been unregistered */
}; };
#ifdef CONFIG_WATCHDOG_NOWAYOUT #ifdef CONFIG_WATCHDOG_NOWAYOUT
...@@ -128,6 +150,12 @@ struct watchdog_device { ...@@ -128,6 +150,12 @@ struct watchdog_device {
#define WATCHDOG_NOWAYOUT_INIT_STATUS 0 #define WATCHDOG_NOWAYOUT_INIT_STATUS 0
#endif #endif
/* Use the following function to check wether or not the watchdog is active */
static inline bool watchdog_active(struct watchdog_device *wdd)
{
return test_bit(WDOG_ACTIVE, &wdd->status);
}
/* Use the following function to set the nowayout feature */ /* Use the following function to set the nowayout feature */
static inline void watchdog_set_nowayout(struct watchdog_device *wdd, bool nowayout) static inline void watchdog_set_nowayout(struct watchdog_device *wdd, bool nowayout)
{ {
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册