Commit 54127f9b authored by Wim Van Sebroeck's avatar Wim Van Sebroeck

[WATCHDOG] v2.6.5-rc2 wdt.c-patch

Version 0.10 of wdt.c - Changes that were made are:
* Extract the start code in a seperate function (wdt_start)
* Extract the stop code in a seperate function (wdt_stop)
* Convert wdt_ping so that it return an int value (0=succes).
* Extract the get_temperature code in a seperate function (wdt_get_temperature)
* Make /dev/watchdog and /dev/temperature to different misc devices with their own fops.
* Reorganize init and exit functions
* Make heartbeat (the emulated heartbeat) a module parameter
* Rewrite status flag code so that we could add a new tachometer module parameter
* Small clean-up's
parent 67bfb5a7
/* /*
* Industrial Computer Source WDT500/501 driver for Linux 2.1.x * Industrial Computer Source WDT500/501 driver
* *
* (c) Copyright 1996-1997 Alan Cox <alan@redhat.com>, All Rights Reserved. * (c) Copyright 1996-1997 Alan Cox <alan@redhat.com>, All Rights Reserved.
* http://www.redhat.com * http://www.redhat.com
...@@ -15,7 +15,7 @@ ...@@ -15,7 +15,7 @@
* *
* (c) Copyright 1995 Alan Cox <alan@lxorguk.ukuu.org.uk> * (c) Copyright 1995 Alan Cox <alan@lxorguk.ukuu.org.uk>
* *
* Release 0.09. * Release 0.10.
* *
* Fixes * Fixes
* Dave Gregorich : Modularisation and minor bugs * Dave Gregorich : Modularisation and minor bugs
...@@ -53,17 +53,15 @@ static unsigned long wdt_is_open; ...@@ -53,17 +53,15 @@ static unsigned long wdt_is_open;
static char expect_close; static char expect_close;
/* /*
* You must set these - there is no sane way to probe for this board. * Module parameters
* You can use wdt=x,y to set these now.
*/ */
static int io=0x240; #define WD_TIMO 60 /* Default heartbeat = 60 seconds */
static int irq=11;
/* Default margin */ static int heartbeat = WD_TIMO;
#define WD_TIMO (100*60) /* 1 minute */ static int wd_heartbeat;
module_param(heartbeat, int, 0);
static int wd_margin = WD_TIMO; MODULE_PARM_DESC(heartbeat, "Watchdog heartbeat in seconds. (0<heartbeat<65536, default=" __MODULE_STRING(WD_TIMO) ")");
#ifdef CONFIG_WATCHDOG_NOWAYOUT #ifdef CONFIG_WATCHDOG_NOWAYOUT
static int nowayout = 1; static int nowayout = 1;
...@@ -74,11 +72,23 @@ static int nowayout = 0; ...@@ -74,11 +72,23 @@ static int nowayout = 0;
module_param(nowayout, int, 0); module_param(nowayout, int, 0);
MODULE_PARM_DESC(nowayout, "Watchdog cannot be stopped once started (default=CONFIG_WATCHDOG_NOWAYOUT)"); MODULE_PARM_DESC(nowayout, "Watchdog cannot be stopped once started (default=CONFIG_WATCHDOG_NOWAYOUT)");
/* You must set these - there is no sane way to probe for this board. */
static int io=0x240;
static int irq=11;
module_param(io, int, 0); module_param(io, int, 0);
MODULE_PARM_DESC(io, "WDT io port (default=0x240)"); MODULE_PARM_DESC(io, "WDT io port (default=0x240)");
module_param(irq, int, 0); module_param(irq, int, 0);
MODULE_PARM_DESC(irq, "WDT irq (default=11)"); MODULE_PARM_DESC(irq, "WDT irq (default=11)");
#ifdef CONFIG_WDT_501
/* Support for the Fan Tachometer on the WDT501-P */
static int tachometer;
module_param(tachometer, int, 0);
MODULE_PARM_DESC(tachometer, "WDT501-P Fan Tachometer support (0=disable, default=0)");
#endif /* CONFIG_WDT_501 */
/* /*
* Programming support * Programming support
*/ */
...@@ -97,13 +107,77 @@ static void wdt_ctr_load(int ctr, int val) ...@@ -97,13 +107,77 @@ static void wdt_ctr_load(int ctr, int val)
outb_p(val>>8, WDT_COUNT0+ctr); outb_p(val>>8, WDT_COUNT0+ctr);
} }
/* /**
* Kernel methods. * wdt_start:
*
* Start the watchdog driver.
*/
static int wdt_start(void)
{
inb_p(WDT_DC); /* Disable watchdog */
wdt_ctr_mode(0,3); /* Program CTR0 for Mode 3: Square Wave Generator */
wdt_ctr_mode(1,2); /* Program CTR1 for Mode 2: Rate Generator */
wdt_ctr_mode(2,0); /* Program CTR2 for Mode 0: Pulse on Terminal Count */
wdt_ctr_load(0, 8948); /* Count at 100Hz */
wdt_ctr_load(1,wd_heartbeat); /* Heartbeat */
wdt_ctr_load(2,65535); /* Length of reset pulse */
outb_p(0, WDT_DC); /* Enable watchdog */
return 0;
}
/**
* wdt_stop:
*
* Stop the watchdog driver.
*/
static int wdt_stop (void)
{
/* Turn the card off */
inb_p(WDT_DC); /* Disable watchdog */
wdt_ctr_load(2,0); /* 0 length reset pulses now */
return 0;
}
/**
* wdt_ping:
*
* Reload counter one with the watchdog heartbeat. We don't bother reloading
* the cascade counter.
*/ */
static int wdt_ping(void)
{
/* Write a watchdog value */
inb_p(WDT_DC); /* Disable watchdog */
wdt_ctr_mode(1,2); /* Re-Program CTR1 for Mode 2: Rate Generator */
wdt_ctr_load(1,wd_heartbeat); /* Heartbeat */
outb_p(0, WDT_DC); /* Enable watchdog */
return 0;
}
/** /**
* wdt_status: * wdt_set_heartbeat:
* @t: the new heartbeat value that needs to be set.
*
* Set a new heartbeat value for the watchdog device. If the heartbeat value is
* incorrect we keep the old value and return -EINVAL. If successfull we
* return 0.
*/
static int wdt_set_heartbeat(int t)
{
if ((t < 1) || (t > 65535))
return -EINVAL;
heartbeat = t;
wd_heartbeat = t * 100;
return 0;
}
/**
* wdt_get_status:
* @status: the new status.
* *
* Extract the status information from a WDT watchdog device. There are * Extract the status information from a WDT watchdog device. There are
* several board variants so we have to know which bits are valid. Some * several board variants so we have to know which bits are valid. Some
...@@ -112,31 +186,46 @@ static void wdt_ctr_load(int ctr, int val) ...@@ -112,31 +186,46 @@ static void wdt_ctr_load(int ctr, int val)
* we then map the bits onto the status ioctl flags. * we then map the bits onto the status ioctl flags.
*/ */
static int wdt_status(void) static int wdt_get_status(int *status)
{ {
/* unsigned char new_status=inb_p(WDT_SR);
* Status register to bit flags
*/
int flag=0; *status=0;
unsigned char status=inb_p(WDT_SR); if (new_status & WDC_SR_ISOI0)
status|=FEATUREMAP1; *status |= WDIOF_EXTERN1;
status&=~FEATUREMAP2; if (new_status & WDC_SR_ISII1)
*status |= WDIOF_EXTERN2;
if(!(status&WDC_SR_TGOOD)) #ifdef CONFIG_WDT_501
flag|=WDIOF_OVERHEAT; if (!(new_status & WDC_SR_TGOOD))
if(!(status&WDC_SR_PSUOVER)) *status |= WDIOF_OVERHEAT;
flag|=WDIOF_POWEROVER; if (!(new_status & WDC_SR_PSUOVER))
if(!(status&WDC_SR_PSUUNDR)) *status |= WDIOF_POWEROVER;
flag|=WDIOF_POWERUNDER; if (!(new_status & WDC_SR_PSUUNDR))
if(!(status&WDC_SR_FANGOOD)) *status |= WDIOF_POWERUNDER;
flag|=WDIOF_FANFAULT; if (tachometer) {
if(status&WDC_SR_ISOI0) if (!(new_status & WDC_SR_FANGOOD))
flag|=WDIOF_EXTERN1; *status |= WDIOF_FANFAULT;
if(status&WDC_SR_ISII1) }
flag|=WDIOF_EXTERN2; #endif /* CONFIG_WDT_501 */
return flag; return 0;
}
#ifdef CONFIG_WDT_501
/**
* wdt_get_temperature:
*
* Reports the temperature in degrees Fahrenheit. The API is in
* farenheit. It was designed by an imperial measurement luddite.
*/
static int wdt_get_temperature(int *temperature)
{
unsigned short c=inb_p(WDT_RT);
*temperature = (c * 11 / 15) + 7;
return 0;
} }
#endif /* CONFIG_WDT_501 */
/** /**
* wdt_interrupt: * wdt_interrupt:
...@@ -155,23 +244,23 @@ static irqreturn_t wdt_interrupt(int irq, void *dev_id, struct pt_regs *regs) ...@@ -155,23 +244,23 @@ static irqreturn_t wdt_interrupt(int irq, void *dev_id, struct pt_regs *regs)
* Read the status register see what is up and * Read the status register see what is up and
* then printk it. * then printk it.
*/ */
unsigned char status=inb_p(WDT_SR); unsigned char status=inb_p(WDT_SR);
status|=FEATUREMAP1;
status&=~FEATUREMAP2;
printk(KERN_CRIT "WDT status %d\n", status); printk(KERN_CRIT "WDT status %d\n", status);
if(!(status&WDC_SR_TGOOD)) #ifdef CONFIG_WDT_501
if (!(status & WDC_SR_TGOOD))
printk(KERN_CRIT "Overheat alarm.(%d)\n",inb_p(WDT_RT)); printk(KERN_CRIT "Overheat alarm.(%d)\n",inb_p(WDT_RT));
if(!(status&WDC_SR_PSUOVER)) if (!(status & WDC_SR_PSUOVER))
printk(KERN_CRIT "PSU over voltage.\n"); printk(KERN_CRIT "PSU over voltage.\n");
if(!(status&WDC_SR_PSUUNDR)) if (!(status & WDC_SR_PSUUNDR))
printk(KERN_CRIT "PSU under voltage.\n"); printk(KERN_CRIT "PSU under voltage.\n");
if(!(status&WDC_SR_FANGOOD)) if (tachometer) {
printk(KERN_CRIT "Possible fan fault.\n"); if (!(status & WDC_SR_FANGOOD))
if(!(status&WDC_SR_WCCR)) printk(KERN_CRIT "Possible fan fault.\n");
}
#endif /* CONFIG_WDT_501 */
if (!(status & WDC_SR_WCCR))
#ifdef SOFTWARE_REBOOT #ifdef SOFTWARE_REBOOT
#ifdef ONLY_TESTING #ifdef ONLY_TESTING
printk(KERN_CRIT "Would Reboot.\n"); printk(KERN_CRIT "Would Reboot.\n");
...@@ -186,22 +275,6 @@ static irqreturn_t wdt_interrupt(int irq, void *dev_id, struct pt_regs *regs) ...@@ -186,22 +275,6 @@ static irqreturn_t wdt_interrupt(int irq, void *dev_id, struct pt_regs *regs)
} }
/**
* wdt_ping:
*
* Reload counter one with the watchdog timeout. We don't bother reloading
* the cascade counter.
*/
static void wdt_ping(void)
{
/* Write a watchdog value */
inb_p(WDT_DC);
wdt_ctr_mode(1,2);
wdt_ctr_load(1,wd_margin); /* Timeout */
outb_p(0, WDT_DC);
}
/** /**
* wdt_write: * wdt_write:
* @file: file handle to the watchdog * @file: file handle to the watchdog
...@@ -239,40 +312,6 @@ static ssize_t wdt_write(struct file *file, const char *buf, size_t count, loff_ ...@@ -239,40 +312,6 @@ static ssize_t wdt_write(struct file *file, const char *buf, size_t count, loff_
return count; return count;
} }
/**
* wdt_read:
* @file: file handle to the watchdog board
* @buf: buffer to write 1 byte into
* @count: length of buffer
* @ptr: offset (no seek allowed)
*
* Read reports the temperature in degrees Fahrenheit. The API is in
* farenheit. It was designed by an imperial measurement luddite.
*/
static ssize_t wdt_read(struct file *file, char *buf, size_t count, loff_t *ptr)
{
unsigned short c=inb_p(WDT_RT);
unsigned char cp;
/* Can't seek (pread) on this device */
if (ptr != &file->f_pos)
return -ESPIPE;
switch(iminor(file->f_dentry->d_inode))
{
case TEMP_MINOR:
c*=11;
c/=15;
cp=c+7;
if(copy_to_user(buf,&cp,1))
return -EFAULT;
return 1;
default:
return -EINVAL;
}
}
/** /**
* wdt_ioctl: * wdt_ioctl:
* @inode: inode of the device * @inode: inode of the device
...@@ -288,18 +327,25 @@ static ssize_t wdt_read(struct file *file, char *buf, size_t count, loff_t *ptr) ...@@ -288,18 +327,25 @@ static ssize_t wdt_read(struct file *file, char *buf, size_t count, loff_t *ptr)
static int wdt_ioctl(struct inode *inode, struct file *file, unsigned int cmd, static int wdt_ioctl(struct inode *inode, struct file *file, unsigned int cmd,
unsigned long arg) unsigned long arg)
{ {
int new_margin; int new_heartbeat;
int status;
static struct watchdog_info ident=
{ static struct watchdog_info ident = {
.options = WDIOF_OVERHEAT|WDIOF_POWERUNDER|WDIOF_POWEROVER .options = WDIOF_SETTIMEOUT|
|WDIOF_EXTERN1|WDIOF_EXTERN2|WDIOF_FANFAULT WDIOF_MAGICCLOSE|
|WDIOF_SETTIMEOUT|WDIOF_MAGICCLOSE, WDIOF_KEEPALIVEPING,
.firmware_version = 1, .firmware_version = 1,
.identity = "WDT500/501", .identity = "WDT500/501",
}; };
ident.options&=WDT_OPTION_MASK; /* Mask down to the card we have */ /* Add options according to the card we have */
ident.options |= (WDIOF_EXTERN1|WDIOF_EXTERN2);
#ifdef CONFIG_WDT_501
ident.options |= (WDIOF_OVERHEAT|WDIOF_POWERUNDER|WDIOF_POWEROVER);
if (tachometer)
ident.options |= WDIOF_FANFAULT;
#endif /* CONFIG_WDT_501 */
switch(cmd) switch(cmd)
{ {
default: default:
...@@ -308,23 +354,24 @@ static int wdt_ioctl(struct inode *inode, struct file *file, unsigned int cmd, ...@@ -308,23 +354,24 @@ static int wdt_ioctl(struct inode *inode, struct file *file, unsigned int cmd,
return copy_to_user((struct watchdog_info *)arg, &ident, sizeof(ident))?-EFAULT:0; return copy_to_user((struct watchdog_info *)arg, &ident, sizeof(ident))?-EFAULT:0;
case WDIOC_GETSTATUS: case WDIOC_GETSTATUS:
return put_user(wdt_status(),(int *)arg); wdt_get_status(&status);
return put_user(status,(int *)arg);
case WDIOC_GETBOOTSTATUS: case WDIOC_GETBOOTSTATUS:
return put_user(0, (int *)arg); return put_user(0, (int *)arg);
case WDIOC_KEEPALIVE: case WDIOC_KEEPALIVE:
wdt_ping(); wdt_ping();
return 0; return 0;
case WDIOC_SETTIMEOUT: case WDIOC_SETTIMEOUT:
if (get_user(new_margin, (int *)arg)) if (get_user(new_heartbeat, (int *)arg))
return -EFAULT; return -EFAULT;
/* Arbitrary, can't find the card's limits */
if ((new_margin < 0) || (new_margin > 60)) if (wdt_set_heartbeat(new_heartbeat))
return -EINVAL; return -EINVAL;
wd_margin = new_margin * 100;
wdt_ping(); wdt_ping();
/* Fall */ /* Fall */
case WDIOC_GETTIMEOUT: case WDIOC_GETTIMEOUT:
return put_user(wd_margin / 100, (int *)arg); return put_user(heartbeat, (int *)arg);
} }
} }
...@@ -333,43 +380,26 @@ static int wdt_ioctl(struct inode *inode, struct file *file, unsigned int cmd, ...@@ -333,43 +380,26 @@ static int wdt_ioctl(struct inode *inode, struct file *file, unsigned int cmd,
* @inode: inode of device * @inode: inode of device
* @file: file handle to device * @file: file handle to device
* *
* One of our two misc devices has been opened. The watchdog device is * The watchdog device has been opened. The watchdog device is single
* single open and on opening we load the counters. Counter zero is a * open and on opening we load the counters. Counter zero is a 100Hz
* 100Hz cascade, into counter 1 which downcounts to reboot. When the * cascade, into counter 1 which downcounts to reboot. When the counter
* counter triggers counter 2 downcounts the length of the reset pulse * triggers counter 2 downcounts the length of the reset pulse which
* which set set to be as long as possible. * set set to be as long as possible.
*/ */
static int wdt_open(struct inode *inode, struct file *file) static int wdt_open(struct inode *inode, struct file *file)
{ {
switch(iminor(inode)) if(test_and_set_bit(0, &wdt_is_open))
{ return -EBUSY;
case WATCHDOG_MINOR: /*
if(test_and_set_bit(0, &wdt_is_open)) * Activate
return -EBUSY; */
/* wdt_start();
* Activate return 0;
*/
wdt_is_open=1;
inb_p(WDT_DC); /* Disable */
wdt_ctr_mode(0,3);
wdt_ctr_mode(1,2);
wdt_ctr_mode(2,0);
wdt_ctr_load(0, 8948); /* count at 100Hz */
wdt_ctr_load(1,wd_margin); /* Timeout 120 seconds */
wdt_ctr_load(2,65535);
outb_p(0, WDT_DC); /* Enable */
return 0;
case TEMP_MINOR:
return 0;
default:
return -ENODEV;
}
} }
/** /**
* wdt_close: * wdt_release:
* @inode: inode to board * @inode: inode to board
* @file: file handle to board * @file: file handle to board
* *
...@@ -382,19 +412,72 @@ static int wdt_open(struct inode *inode, struct file *file) ...@@ -382,19 +412,72 @@ static int wdt_open(struct inode *inode, struct file *file)
static int wdt_release(struct inode *inode, struct file *file) static int wdt_release(struct inode *inode, struct file *file)
{ {
if(iminor(inode)==WATCHDOG_MINOR) if (expect_close == 42) {
{ wdt_stop();
if (expect_close == 42) {
inb_p(WDT_DC); /* Disable counters */
wdt_ctr_load(2,0); /* 0 length reset pulses now */
} else {
printk(KERN_CRIT "wdt: WDT device closed unexpectedly. WDT will not stop!\n");
}
clear_bit(0, &wdt_is_open); clear_bit(0, &wdt_is_open);
expect_close = 0; } else {
printk(KERN_CRIT "wdt: WDT device closed unexpectedly. WDT will not stop!\n");
wdt_ping();
} }
expect_close = 0;
return 0;
}
#ifdef CONFIG_WDT_501
/**
* wdt_temp_read:
* @file: file handle to the watchdog board
* @buf: buffer to write 1 byte into
* @count: length of buffer
* @ptr: offset (no seek allowed)
*
* Temp_read reports the temperature in degrees Fahrenheit. The API is in
* farenheit. It was designed by an imperial measurement luddite.
*/
static ssize_t wdt_temp_read(struct file *file, char *buf, size_t count, loff_t *ptr)
{
int temperature;
/* Can't seek (pread) on this device */
if (ptr != &file->f_pos)
return -ESPIPE;
if (wdt_get_temperature(&temperature))
return -EFAULT;
if (copy_to_user (buf, &temperature, 1))
return -EFAULT;
return 1;
}
/**
* wdt_temp_open:
* @inode: inode of device
* @file: file handle to device
*
* The temperature device has been opened.
*/
static int wdt_temp_open(struct inode *inode, struct file *file)
{
return 0;
}
/**
* wdt_temp_release:
* @inode: inode to board
* @file: file handle to board
*
* The temperature device has been closed.
*/
static int wdt_temp_release(struct inode *inode, struct file *file)
{
return 0; return 0;
} }
#endif /* CONFIG_WDT_501 */
/** /**
* notify_sys: * notify_sys:
...@@ -411,11 +494,9 @@ static int wdt_release(struct inode *inode, struct file *file) ...@@ -411,11 +494,9 @@ static int wdt_release(struct inode *inode, struct file *file)
static int wdt_notify_sys(struct notifier_block *this, unsigned long code, static int wdt_notify_sys(struct notifier_block *this, unsigned long code,
void *unused) void *unused)
{ {
if(code==SYS_DOWN || code==SYS_HALT) if(code==SYS_DOWN || code==SYS_HALT) {
{
/* Turn the card off */ /* Turn the card off */
inb_p(WDT_DC); wdt_stop();
wdt_ctr_load(2,0);
} }
return NOTIFY_DONE; return NOTIFY_DONE;
} }
...@@ -428,36 +509,40 @@ static int wdt_notify_sys(struct notifier_block *this, unsigned long code, ...@@ -428,36 +509,40 @@ static int wdt_notify_sys(struct notifier_block *this, unsigned long code,
static struct file_operations wdt_fops = { static struct file_operations wdt_fops = {
.owner = THIS_MODULE, .owner = THIS_MODULE,
.llseek = no_llseek, .llseek = no_llseek,
.read = wdt_read,
.write = wdt_write, .write = wdt_write,
.ioctl = wdt_ioctl, .ioctl = wdt_ioctl,
.open = wdt_open, .open = wdt_open,
.release = wdt_release, .release = wdt_release,
}; };
static struct miscdevice wdt_miscdev= static struct miscdevice wdt_miscdev = {
{
.minor = WATCHDOG_MINOR, .minor = WATCHDOG_MINOR,
.name = "watchdog", .name = "watchdog",
.fops = &wdt_fops, .fops = &wdt_fops,
}; };
#ifdef CONFIG_WDT_501 #ifdef CONFIG_WDT_501
static struct miscdevice temp_miscdev= static struct file_operations wdt_temp_fops = {
{ .owner = THIS_MODULE,
.llseek = no_llseek,
.read = wdt_temp_read,
.open = wdt_temp_open,
.release = wdt_temp_release,
};
static struct miscdevice temp_miscdev = {
.minor = TEMP_MINOR, .minor = TEMP_MINOR,
.name = "temperature", .name = "temperature",
.fops = &wdt_fops, .fops = &wdt_temp_fops,
}; };
#endif #endif /* CONFIG_WDT_501 */
/* /*
* The WDT card needs to learn about soft shutdowns in order to * The WDT card needs to learn about soft shutdowns in order to
* turn the timebomb registers off. * turn the timebomb registers off.
*/ */
static struct notifier_block wdt_notifier= static struct notifier_block wdt_notifier = {
{
.notifier_call = wdt_notify_sys, .notifier_call = wdt_notify_sys,
}; };
...@@ -476,10 +561,10 @@ static void __exit wdt_exit(void) ...@@ -476,10 +561,10 @@ static void __exit wdt_exit(void)
misc_deregister(&wdt_miscdev); misc_deregister(&wdt_miscdev);
#ifdef CONFIG_WDT_501 #ifdef CONFIG_WDT_501
misc_deregister(&temp_miscdev); misc_deregister(&temp_miscdev);
#endif #endif /* CONFIG_WDT_501 */
unregister_reboot_notifier(&wdt_notifier); unregister_reboot_notifier(&wdt_notifier);
release_region(io,8);
free_irq(irq, NULL); free_irq(irq, NULL);
release_region(io,8);
} }
/** /**
...@@ -494,51 +579,67 @@ static int __init wdt_init(void) ...@@ -494,51 +579,67 @@ static int __init wdt_init(void)
{ {
int ret; int ret;
ret = misc_register(&wdt_miscdev); /* Check that the heartbeat value is within it's range ; if not reset to the default */
if (ret) { if (wdt_set_heartbeat(heartbeat)) {
printk(KERN_ERR "wdt: can't misc_register on minor=%d\n", WATCHDOG_MINOR); wdt_set_heartbeat(WD_TIMO);
printk(KERN_INFO "wdt: heartbeat value must be 0<heartbeat<65536, using %d\n",
WD_TIMO);
}
if (!request_region(io, 8, "wdt501p")) {
printk(KERN_ERR "wdt: I/O address 0x%04x already in use\n", io);
ret = -EBUSY;
goto out; goto out;
} }
ret = request_irq(irq, wdt_interrupt, SA_INTERRUPT, "wdt501p", NULL); ret = request_irq(irq, wdt_interrupt, SA_INTERRUPT, "wdt501p", NULL);
if(ret) { if(ret) {
printk(KERN_ERR "wdt: IRQ %d is not free.\n", irq); printk(KERN_ERR "wdt: IRQ %d is not free.\n", irq);
goto outmisc; goto outreg;
}
if (!request_region(io, 8, "wdt501p")) {
printk(KERN_ERR "wdt: IO %X is not free.\n", io);
ret = -EBUSY;
goto outirq;
} }
ret = register_reboot_notifier(&wdt_notifier); ret = register_reboot_notifier(&wdt_notifier);
if(ret) { if(ret) {
printk(KERN_ERR "wdt: can't register reboot notifier (err=%d)\n", ret); printk(KERN_ERR "wdt: cannot register reboot notifier (err=%d)\n", ret);
goto outreg; goto outirq;
} }
#ifdef CONFIG_WDT_501 #ifdef CONFIG_WDT_501
ret = misc_register(&temp_miscdev); ret = misc_register(&temp_miscdev);
if (ret) { if (ret) {
printk(KERN_ERR "wdt: can't misc_register (temp) on minor=%d\n", TEMP_MINOR); printk(KERN_ERR "wdt: cannot register miscdev on minor=%d (err=%d)\n",
TEMP_MINOR, ret);
goto outrbt; goto outrbt;
} }
#endif #endif /* CONFIG_WDT_501 */
ret = misc_register(&wdt_miscdev);
if (ret) {
printk(KERN_ERR "wdt: cannot register miscdev on minor=%d (err=%d)\n",
WATCHDOG_MINOR, ret);
goto outmisc;
}
ret = 0; ret = 0;
printk(KERN_INFO "WDT500/501-P driver 0.07 at %X (Interrupt %d)\n", io, irq); printk(KERN_INFO "WDT500/501-P driver 0.10 at 0x%04x (Interrupt %d). heartbeat=%d sec (nowayout=%d)\n",
io, irq, heartbeat, nowayout);
#ifdef CONFIG_WDT_501
printk(KERN_INFO "wdt: Fan Tachometer is %s\n", (tachometer ? "Enabled" : "Disabled"));
#endif /* CONFIG_WDT_501 */
out: out:
return ret; return ret;
outmisc:
#ifdef CONFIG_WDT_501 #ifdef CONFIG_WDT_501
misc_deregister(&temp_miscdev);
#endif /* CONFIG_WDT_501 */
outrbt: outrbt:
unregister_reboot_notifier(&wdt_notifier); unregister_reboot_notifier(&wdt_notifier);
#endif
outreg:
release_region(io,8);
outirq: outirq:
free_irq(irq, NULL); free_irq(irq, NULL);
outmisc: outreg:
misc_deregister(&wdt_miscdev); release_region(io,8);
goto out; goto out;
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment