Commit 8e7ff451 authored by Wim Van Sebroeck's avatar Wim Van Sebroeck

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

Version 0.10 of wdt_pci.c - Changes that were made are:
* Extract the start code in a seperate function (wdtpci_start)
* Extract the stop code in a seperate function (wdtpci_stop)
* Convert wdtpci_ping so that it return an int value (0=succes).
* Extract the get_temperature code in a seperate function (wdtpci_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
   + make clear distinction between PCI-WDT500 and PCI-WDT501.
* Small clean-up's
parent 54127f9b
/* /*
* Industrial Computer Source WDT500/501 driver for Linux 2.1.x * Industrial Computer Source PCI-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
...@@ -46,6 +46,7 @@ ...@@ -46,6 +46,7 @@
#include <linux/notifier.h> #include <linux/notifier.h>
#include <linux/reboot.h> #include <linux/reboot.h>
#include <linux/init.h> #include <linux/init.h>
#include <linux/fs.h>
#include <linux/pci.h> #include <linux/pci.h>
#include <asm/io.h> #include <asm/io.h>
...@@ -70,6 +71,9 @@ ...@@ -70,6 +71,9 @@
#define PCI_DEVICE_ID_WDG_CSM 0x22c0 #define PCI_DEVICE_ID_WDG_CSM 0x22c0
#endif #endif
/* We can only use 1 card due to the /dev/watchdog restriction */
static int dev_count;
static struct semaphore open_sem; static struct semaphore open_sem;
static spinlock_t wdtpci_lock; static spinlock_t wdtpci_lock;
static char expect_close; static char expect_close;
...@@ -78,10 +82,12 @@ static int io; ...@@ -78,10 +82,12 @@ static int io;
static int irq; static int irq;
/* Default timeout */ /* Default timeout */
#define WD_TIMO (100*60) /* 1 minute */ #define WD_TIMO 60 /* Default heartbeat = 60 seconds */
#define WD_TIMO_MAX (WD_TIMO*60) /* 1 hour(?) */
static int wd_margin = WD_TIMO; static int heartbeat = WD_TIMO;
static int wd_heartbeat;
module_param(heartbeat, int, 0);
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;
...@@ -92,6 +98,14 @@ static int nowayout = 0; ...@@ -92,6 +98,14 @@ 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)");
#ifdef CONFIG_WDT_501_PCI
/* Support for the Fan Tachometer on the PCI-WDT501 */
static int tachometer;
module_param(tachometer, int, 0);
MODULE_PARM_DESC(tachometer, "PCI-WDT501 Fan Tachometer support (0=disable, default=0)");
#endif /* CONFIG_WDT_501_PCI */
/* /*
* Programming support * Programming support
*/ */
...@@ -110,13 +124,105 @@ static void wdtpci_ctr_load(int ctr, int val) ...@@ -110,13 +124,105 @@ static void wdtpci_ctr_load(int ctr, int val)
outb_p(val>>8, WDT_COUNT0+ctr); outb_p(val>>8, WDT_COUNT0+ctr);
} }
/* /**
* Kernel methods. * wdtpci_start:
*
* Start the watchdog driver.
*/
static int wdtpci_start(void)
{
unsigned long flags;
spin_lock_irqsave(&wdtpci_lock, flags);
/*
* "pet" the watchdog, as Access says.
* This resets the clock outputs.
*/ */
inb_p(WDT_DC); /* Disable watchdog */
wdtpci_ctr_mode(2,0); /* Program CTR2 for Mode 0: Pulse on Terminal Count */
outb_p(0, WDT_DC); /* Enable watchdog */
inb_p(WDT_DC); /* Disable watchdog */
outb_p(0, WDT_CLOCK); /* 2.0833MHz clock */
inb_p(WDT_BUZZER); /* disable */
inb_p(WDT_OPTONOTRST); /* disable */
inb_p(WDT_OPTORST); /* disable */
inb_p(WDT_PROGOUT); /* disable */
wdtpci_ctr_mode(0,3); /* Program CTR0 for Mode 3: Square Wave Generator */
wdtpci_ctr_mode(1,2); /* Program CTR1 for Mode 2: Rate Generator */
wdtpci_ctr_mode(2,1); /* Program CTR2 for Mode 1: Retriggerable One-Shot */
wdtpci_ctr_load(0,20833); /* count at 100Hz */
wdtpci_ctr_load(1,wd_heartbeat);/* Heartbeat */
/* DO NOT LOAD CTR2 on PCI card! -- JPN */
outb_p(0, WDT_DC); /* Enable watchdog */
spin_unlock_irqrestore(&wdtpci_lock, flags);
return 0;
}
/**
* wdtpci_stop:
*
* Stop the watchdog driver.
*/
static int wdtpci_stop (void)
{
unsigned long flags;
/* Turn the card off */
spin_lock_irqsave(&wdtpci_lock, flags);
inb_p(WDT_DC); /* Disable watchdog */
wdtpci_ctr_load(2,0); /* 0 length reset pulses now */
spin_unlock_irqrestore(&wdtpci_lock, flags);
return 0;
}
/**
* wdtpci_ping:
*
* Reload counter one with the watchdog heartbeat. We don't bother reloading
* the cascade counter.
*/
static int wdtpci_ping(void)
{
unsigned long flags;
/* Write a watchdog value */
spin_lock_irqsave(&wdtpci_lock, flags);
inb_p(WDT_DC); /* Disable watchdog */
wdtpci_ctr_mode(1,2); /* Re-Program CTR1 for Mode 2: Rate Generator */
wdtpci_ctr_load(1,wd_heartbeat);/* Heartbeat */
outb_p(0, WDT_DC); /* Enable watchdog */
spin_unlock_irqrestore(&wdtpci_lock, flags);
return 0;
}
/**
* wdtpci_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 wdtpci_set_heartbeat(int t)
{
/* Arbitrary, can't find the card's limits */
if ((t < 1) || (t > 65535))
return -EINVAL;
heartbeat = t;
wd_heartbeat = t * 100;
return 0;
}
/** /**
* wdtpci_status: * wdtpci_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
...@@ -125,31 +231,46 @@ static void wdtpci_ctr_load(int ctr, int val) ...@@ -125,31 +231,46 @@ static void wdtpci_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 wdtpci_status(void) static int wdtpci_get_status(int *status)
{ {
/* unsigned char new_status=inb_p(WDT_SR);
* Status register to bit flags
*status=0;
if (new_status & WDC_SR_ISOI0)
*status |= WDIOF_EXTERN1;
if (new_status & WDC_SR_ISII1)
*status |= WDIOF_EXTERN2;
#ifdef CONFIG_WDT_501_PCI
if (!(new_status & WDC_SR_TGOOD))
*status |= WDIOF_OVERHEAT;
if (!(new_status & WDC_SR_PSUOVER))
*status |= WDIOF_POWEROVER;
if (!(new_status & WDC_SR_PSUUNDR))
*status |= WDIOF_POWERUNDER;
if (tachometer) {
if (!(new_status & WDC_SR_FANGOOD))
*status |= WDIOF_FANFAULT;
}
#endif /* CONFIG_WDT_501_PCI */
return 0;
}
#ifdef CONFIG_WDT_501_PCI
/**
* wdtpci_get_temperature:
*
* Reports the temperature in degrees Fahrenheit. The API is in
* farenheit. It was designed by an imperial measurement luddite.
*/ */
int flag=0; static int wdtpci_get_temperature(int *temperature)
unsigned char status=inb_p(WDT_SR); {
status|=FEATUREMAP1; unsigned short c=inb_p(WDT_RT);
status&=~FEATUREMAP2;
*temperature = (c * 11 / 15) + 7;
if(!(status&WDC_SR_TGOOD)) return 0;
flag|=WDIOF_OVERHEAT;
if(!(status&WDC_SR_PSUOVER))
flag|=WDIOF_POWEROVER;
if(!(status&WDC_SR_PSUUNDR))
flag|=WDIOF_POWERUNDER;
if(!(status&WDC_SR_FANGOOD))
flag|=WDIOF_FANFAULT;
if(status&WDC_SR_ISOI0)
flag|=WDIOF_EXTERN1;
if(status&WDC_SR_ISII1)
flag|=WDIOF_EXTERN2;
return flag;
} }
#endif /* CONFIG_WDT_501_PCI */
/** /**
* wdtpci_interrupt: * wdtpci_interrupt:
...@@ -168,57 +289,37 @@ static irqreturn_t wdtpci_interrupt(int irq, void *dev_id, struct pt_regs *regs) ...@@ -168,57 +289,37 @@ static irqreturn_t wdtpci_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; printk(KERN_CRIT PFX "status %d\n", status);
status&=~FEATUREMAP2;
printk(KERN_CRIT "WDT status %d\n", status); #ifdef CONFIG_WDT_501_PCI
if (!(status & WDC_SR_TGOOD))
if(!(status&WDC_SR_TGOOD)) printk(KERN_CRIT PFX "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 PFX "PSU over voltage.\n");
printk(KERN_CRIT "PSU over voltage.\n"); if (!(status & WDC_SR_PSUUNDR))
if(!(status&WDC_SR_PSUUNDR)) printk(KERN_CRIT PFX "PSU under voltage.\n");
printk(KERN_CRIT "PSU under voltage.\n"); if (tachometer) {
if(!(status&WDC_SR_FANGOOD)) if (!(status & WDC_SR_FANGOOD))
printk(KERN_CRIT "Possible fan fault.\n"); printk(KERN_CRIT PFX "Possible fan fault.\n");
if(!(status&WDC_SR_WCCR)) }
#endif /* CONFIG_WDT_501_PCI */
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 PFX "Would Reboot.\n");
#else #else
printk(KERN_CRIT "Initiating system reboot.\n"); printk(KERN_CRIT PFX "Initiating system reboot.\n");
machine_restart(NULL); machine_restart(NULL);
#endif #endif
#else #else
printk(KERN_CRIT "Reset in 5ms.\n"); printk(KERN_CRIT PFX "Reset in 5ms.\n");
#endif #endif
return IRQ_HANDLED; return IRQ_HANDLED;
} }
/**
* wdtpci_ping:
*
* Reload counter one with the watchdog timeout. We don't bother reloading
* the cascade counter.
*/
static void wdtpci_ping(void)
{
unsigned long flags;
/* Write a watchdog value */
spin_lock_irqsave(&wdtpci_lock, flags);
inb_p(WDT_DC);
wdtpci_ctr_mode(1,2);
wdtpci_ctr_load(1,wd_margin); /* Timeout */
outb_p(0, WDT_DC);
spin_unlock_irqrestore(&wdtpci_lock, flags);
}
/** /**
* wdtpci_write: * wdtpci_write:
* @file: file handle to the watchdog * @file: file handle to the watchdog
...@@ -256,40 +357,6 @@ static ssize_t wdtpci_write(struct file *file, const char *buf, size_t count, lo ...@@ -256,40 +357,6 @@ static ssize_t wdtpci_write(struct file *file, const char *buf, size_t count, lo
return count; return count;
} }
/**
* wdtpci_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
* fahrenheit. It was designed by an imperial measurement luddite.
*/
static ssize_t wdtpci_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;
}
}
/** /**
* wdtpci_ioctl: * wdtpci_ioctl:
* @inode: inode of the device * @inode: inode of the device
...@@ -305,17 +372,25 @@ static ssize_t wdtpci_read(struct file *file, char *buf, size_t count, loff_t *p ...@@ -305,17 +372,25 @@ static ssize_t wdtpci_read(struct file *file, char *buf, size_t count, loff_t *p
static int wdtpci_ioctl(struct inode *inode, struct file *file, unsigned int cmd, static int wdtpci_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 | .options = WDIOF_SETTIMEOUT|
WDIOF_POWEROVER | WDIOF_EXTERN1 | WDIOF_MAGICCLOSE|
WDIOF_EXTERN2 | WDIOF_FANFAULT | WDIOF_KEEPALIVEPING,
WDIOF_SETTIMEOUT|WDIOF_MAGICCLOSE,
.firmware_version = 1, .firmware_version = 1,
.identity = "WDT500/501PCI", .identity = "PCI-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_PCI
ident.options |= (WDIOF_OVERHEAT|WDIOF_POWERUNDER|WDIOF_POWEROVER);
if (tachometer)
ident.options |= WDIOF_FANFAULT;
#endif /* CONFIG_WDT_501_PCI */
switch(cmd) switch(cmd)
{ {
default: default:
...@@ -324,24 +399,24 @@ static int wdtpci_ioctl(struct inode *inode, struct file *file, unsigned int cmd ...@@ -324,24 +399,24 @@ static int wdtpci_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(wdtpci_status(),(int *)arg); wdtpci_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:
wdtpci_ping(); wdtpci_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 */
new_margin *= 100; if (wdtpci_set_heartbeat(new_heartbeat))
if ((new_margin < 0) || (new_margin > WD_TIMO_MAX))
return -EINVAL; return -EINVAL;
wd_margin = new_margin;
wdtpci_ping(); wdtpci_ping();
/* Fall */ /* Fall */
case WDIOC_GETTIMEOUT: case WDIOC_GETTIMEOUT:
return put_user(wd_margin / 100, (int *)arg); return put_user(heartbeat, (int *)arg);
} }
} }
...@@ -350,20 +425,15 @@ static int wdtpci_ioctl(struct inode *inode, struct file *file, unsigned int cmd ...@@ -350,20 +425,15 @@ static int wdtpci_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 wdtpci_open(struct inode *inode, struct file *file) static int wdtpci_open(struct inode *inode, struct file *file)
{ {
unsigned long flags;
switch(iminor(inode))
{
case WATCHDOG_MINOR:
if (down_trylock(&open_sem)) if (down_trylock(&open_sem))
return -EBUSY; return -EBUSY;
...@@ -373,43 +443,12 @@ static int wdtpci_open(struct inode *inode, struct file *file) ...@@ -373,43 +443,12 @@ static int wdtpci_open(struct inode *inode, struct file *file)
/* /*
* Activate * Activate
*/ */
spin_lock_irqsave(&wdtpci_lock, flags); wdtpci_start();
inb_p(WDT_DC); /* Disable */
/*
* "pet" the watchdog, as Access says.
* This resets the clock outputs.
*/
wdtpci_ctr_mode(2,0);
outb_p(0, WDT_DC);
inb_p(WDT_DC);
outb_p(0, WDT_CLOCK); /* 2.0833MHz clock */
inb_p(WDT_BUZZER); /* disable */
inb_p(WDT_OPTONOTRST); /* disable */
inb_p(WDT_OPTORST); /* disable */
inb_p(WDT_PROGOUT); /* disable */
wdtpci_ctr_mode(0,3);
wdtpci_ctr_mode(1,2);
wdtpci_ctr_mode(2,1);
wdtpci_ctr_load(0,20833); /* count at 100Hz */
wdtpci_ctr_load(1,wd_margin);/* Timeout 60 seconds */
/* DO NOT LOAD CTR2 on PCI card! -- JPN */
outb_p(0, WDT_DC); /* Enable */
spin_unlock_irqrestore(&wdtpci_lock, flags);
return 0; return 0;
case TEMP_MINOR:
return 0;
default:
return -ENODEV;
}
} }
/** /**
* wdtpci_close: * wdtpci_release:
* @inode: inode to board * @inode: inode to board
* @file: file handle to board * @file: file handle to board
* *
...@@ -422,24 +461,73 @@ static int wdtpci_open(struct inode *inode, struct file *file) ...@@ -422,24 +461,73 @@ static int wdtpci_open(struct inode *inode, struct file *file)
static int wdtpci_release(struct inode *inode, struct file *file) static int wdtpci_release(struct inode *inode, struct file *file)
{ {
if (iminor(inode)==WATCHDOG_MINOR) {
unsigned long flags;
if (expect_close == 42) { if (expect_close == 42) {
spin_lock_irqsave(&wdtpci_lock, flags); wdtpci_stop();
inb_p(WDT_DC); /* Disable counters */
wdtpci_ctr_load(2,0); /* 0 length reset pulses now */
spin_unlock_irqrestore(&wdtpci_lock, flags);
} else { } else {
printk(KERN_CRIT PFX "Unexpected close, not stopping timer!"); printk(KERN_CRIT PFX "Unexpected close, not stopping timer!");
wdtpci_ping(); wdtpci_ping();
} }
expect_close = 0; expect_close = 0;
up(&open_sem); up(&open_sem);
}
return 0; return 0;
} }
#ifdef CONFIG_WDT_501_PCI
/**
* wdtpci_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)
*
* Read reports the temperature in degrees Fahrenheit. The API is in
* fahrenheit. It was designed by an imperial measurement luddite.
*/
static ssize_t wdtpci_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 (wdtpci_get_temperature(&temperature))
return -EFAULT;
if (copy_to_user (buf, &temperature, 1))
return -EFAULT;
return 1;
}
/**
* wdtpci_temp_open:
* @inode: inode of device
* @file: file handle to device
*
* The temperature device has been opened.
*/
static int wdtpci_temp_open(struct inode *inode, struct file *file)
{
return 0;
}
/**
* wdtpci_temp_release:
* @inode: inode to board
* @file: file handle to board
*
* The temperature device has been closed.
*/
static int wdtpci_temp_release(struct inode *inode, struct file *file)
{
return 0;
}
#endif /* CONFIG_WDT_501_PCI */
/** /**
* notify_sys: * notify_sys:
* @this: our notifier block * @this: our notifier block
...@@ -455,14 +543,9 @@ static int wdtpci_release(struct inode *inode, struct file *file) ...@@ -455,14 +543,9 @@ static int wdtpci_release(struct inode *inode, struct file *file)
static int wdtpci_notify_sys(struct notifier_block *this, unsigned long code, static int wdtpci_notify_sys(struct notifier_block *this, unsigned long code,
void *unused) void *unused)
{ {
unsigned long flags;
if (code==SYS_DOWN || code==SYS_HALT) { if (code==SYS_DOWN || code==SYS_HALT) {
/* Turn the card off */ /* Turn the card off */
spin_lock_irqsave(&wdtpci_lock, flags); wdtpci_stop();
inb_p(WDT_DC);
wdtpci_ctr_load(2,0);
spin_unlock_irqrestore(&wdtpci_lock, flags);
} }
return NOTIFY_DONE; return NOTIFY_DONE;
} }
...@@ -475,7 +558,6 @@ static int wdtpci_notify_sys(struct notifier_block *this, unsigned long code, ...@@ -475,7 +558,6 @@ static int wdtpci_notify_sys(struct notifier_block *this, unsigned long code,
static struct file_operations wdtpci_fops = { static struct file_operations wdtpci_fops = {
.owner = THIS_MODULE, .owner = THIS_MODULE,
.llseek = no_llseek, .llseek = no_llseek,
.read = wdtpci_read,
.write = wdtpci_write, .write = wdtpci_write,
.ioctl = wdtpci_ioctl, .ioctl = wdtpci_ioctl,
.open = wdtpci_open, .open = wdtpci_open,
...@@ -489,12 +571,20 @@ static struct miscdevice wdtpci_miscdev = { ...@@ -489,12 +571,20 @@ static struct miscdevice wdtpci_miscdev = {
}; };
#ifdef CONFIG_WDT_501_PCI #ifdef CONFIG_WDT_501_PCI
static struct file_operations wdtpci_temp_fops = {
.owner = THIS_MODULE,
.llseek = no_llseek,
.read = wdtpci_temp_read,
.open = wdtpci_temp_open,
.release = wdtpci_temp_release,
};
static struct miscdevice temp_miscdev = { static struct miscdevice temp_miscdev = {
.minor = TEMP_MINOR, .minor = TEMP_MINOR,
.name = "temperature", .name = "temperature",
.fops = &wdtpci_fops, .fops = &wdtpci_temp_fops,
}; };
#endif #endif /* CONFIG_WDT_501_PCI */
/* /*
* The WDT card needs to learn about soft shutdowns in order to * The WDT card needs to learn about soft shutdowns in order to
...@@ -509,71 +599,96 @@ static struct notifier_block wdtpci_notifier = { ...@@ -509,71 +599,96 @@ static struct notifier_block wdtpci_notifier = {
static int __devinit wdtpci_init_one (struct pci_dev *dev, static int __devinit wdtpci_init_one (struct pci_dev *dev,
const struct pci_device_id *ent) const struct pci_device_id *ent)
{ {
static int dev_count = 0;
int ret = -EIO; int ret = -EIO;
dev_count++; dev_count++;
if (dev_count > 1) { if (dev_count > 1) {
printk (KERN_ERR PFX printk (KERN_ERR PFX "this driver only supports 1 device\n");
"this driver only supports 1 device\n");
return -ENODEV; return -ENODEV;
} }
if (pci_enable_device (dev)) if (pci_enable_device (dev)) {
goto out; printk (KERN_ERR PFX "Not possible to enable PCI Device\n");
return -ENODEV;
}
if (pci_resource_start (dev, 2) == 0x0000) {
printk (KERN_ERR PFX "No I/O-Address for card detected\n");
ret = -ENODEV;
goto out_pci;
}
sema_init(&open_sem, 1); sema_init(&open_sem, 1);
spin_lock_init(&wdtpci_lock); spin_lock_init(&wdtpci_lock);
irq = dev->irq; irq = dev->irq;
io = pci_resource_start (dev, 2); io = pci_resource_start (dev, 2);
printk ("WDT501-P(PCI-WDG-CSM) driver 0.07 at %X "
"(Interrupt %d)\n", io, irq);
if (request_region (io, 16, "wdt-pci") == NULL) { if (request_region (io, 16, "wdt_pci") == NULL) {
printk (KERN_ERR PFX "I/O %d is not free.\n", io); printk (KERN_ERR PFX "I/O address 0x%04x already in use\n", io);
goto out; goto out_pci;
} }
if (request_irq (irq, wdtpci_interrupt, SA_INTERRUPT | SA_SHIRQ, if (request_irq (irq, wdtpci_interrupt, SA_INTERRUPT | SA_SHIRQ,
"wdt-pci", &wdtpci_miscdev)) { "wdt_pci", &wdtpci_miscdev)) {
printk (KERN_ERR PFX "IRQ %d is not free.\n", irq); printk (KERN_ERR PFX "IRQ %d is not free\n", irq);
goto out_reg; goto out_reg;
} }
ret = misc_register (&wdtpci_miscdev); printk ("PCI-WDT500/501 (PCI-WDG-CSM) driver 0.10 at 0x%04x (Interrupt %d)\n",
if (ret) { io, irq);
printk (KERN_ERR PFX "can't misc_register on minor=%d\n", WATCHDOG_MINOR);
goto out_irq; /* Check that the heartbeat value is within it's range ; if not reset to the default */
if (wdtpci_set_heartbeat(heartbeat)) {
wdtpci_set_heartbeat(WD_TIMO);
printk(KERN_INFO PFX "heartbeat value must be 0<heartbeat<65536, using %d\n",
WD_TIMO);
} }
ret = register_reboot_notifier (&wdtpci_notifier); ret = register_reboot_notifier (&wdtpci_notifier);
if (ret) { if (ret) {
printk (KERN_ERR PFX "can't misc_register on minor=%d\n", WATCHDOG_MINOR); printk (KERN_ERR PFX "cannot register reboot notifier (err=%d)\n", ret);
goto out_misc; goto out_irq;
} }
#ifdef CONFIG_WDT_501_PCI #ifdef CONFIG_WDT_501_PCI
ret = misc_register (&temp_miscdev); ret = misc_register (&temp_miscdev);
if (ret) { if (ret) {
printk (KERN_ERR PFX "can't misc_register (temp) on minor=%d\n", TEMP_MINOR); printk (KERN_ERR PFX "cannot register miscdev on minor=%d (err=%d)\n",
TEMP_MINOR, ret);
goto out_rbt; goto out_rbt;
} }
#endif #endif /* CONFIG_WDT_501_PCI */
ret = misc_register (&wdtpci_miscdev);
if (ret) {
printk (KERN_ERR PFX "cannot register miscdev on minor=%d (err=%d)\n",
WATCHDOG_MINOR, ret);
goto out_misc;
}
printk(KERN_INFO PFX "initialized. heartbeat=%d sec (nowayout=%d)\n",
heartbeat, nowayout);
#ifdef CONFIG_WDT_501_PCI
printk(KERN_INFO "wdt: Fan Tachometer is %s\n", (tachometer ? "Enabled" : "Disabled"));
#endif /* CONFIG_WDT_501_PCI */
ret = 0; ret = 0;
out: out:
return ret; return ret;
out_misc:
#ifdef CONFIG_WDT_501_PCI #ifdef CONFIG_WDT_501_PCI
misc_deregister(&temp_miscdev);
#endif /* CONFIG_WDT_501_PCI */
out_rbt: out_rbt:
unregister_reboot_notifier(&wdtpci_notifier); unregister_reboot_notifier(&wdtpci_notifier);
#endif
out_misc:
misc_deregister(&wdtpci_miscdev);
out_irq: out_irq:
free_irq(irq, &wdtpci_miscdev); free_irq(irq, &wdtpci_miscdev);
out_reg: out_reg:
release_region (io, 16); release_region (io, 16);
out_pci:
pci_disable_device(dev);
goto out; goto out;
} }
...@@ -582,13 +697,15 @@ static void __devexit wdtpci_remove_one (struct pci_dev *pdev) ...@@ -582,13 +697,15 @@ static void __devexit wdtpci_remove_one (struct pci_dev *pdev)
{ {
/* here we assume only one device will ever have /* here we assume only one device will ever have
* been picked up and registered by probe function */ * been picked up and registered by probe function */
unregister_reboot_notifier(&wdtpci_notifier); misc_deregister(&wdtpci_miscdev);
#ifdef CONFIG_WDT_501_PCI #ifdef CONFIG_WDT_501_PCI
misc_deregister(&temp_miscdev); misc_deregister(&temp_miscdev);
#endif #endif /* CONFIG_WDT_501_PCI */
misc_deregister(&wdtpci_miscdev); unregister_reboot_notifier(&wdtpci_notifier);
free_irq(irq, &wdtpci_miscdev); free_irq(irq, &wdtpci_miscdev);
release_region(io, 16); release_region(io, 16);
pci_disable_device(pdev);
dev_count--;
} }
...@@ -605,7 +722,7 @@ MODULE_DEVICE_TABLE(pci, wdtpci_pci_tbl); ...@@ -605,7 +722,7 @@ MODULE_DEVICE_TABLE(pci, wdtpci_pci_tbl);
static struct pci_driver wdtpci_driver = { static struct pci_driver wdtpci_driver = {
.name = "wdt-pci", .name = "wdt_pci",
.id_table = wdtpci_pci_tbl, .id_table = wdtpci_pci_tbl,
.probe = wdtpci_init_one, .probe = wdtpci_init_one,
.remove = __devexit_p(wdtpci_remove_one), .remove = __devexit_p(wdtpci_remove_one),
...@@ -619,7 +736,7 @@ static struct pci_driver wdtpci_driver = { ...@@ -619,7 +736,7 @@ static struct pci_driver wdtpci_driver = {
* If your watchdog is set to continue ticking on close and you unload * If your watchdog is set to continue ticking on close and you unload
* it, well it keeps ticking. We won't get the interrupt but the board * it, well it keeps ticking. We won't get the interrupt but the board
* will not touch PC memory so all is fine. You just have to load a new * will not touch PC memory so all is fine. You just have to load a new
* module in 60 seconds or reboot. * module in xx seconds or reboot.
*/ */
static void __exit wdtpci_cleanup(void) static void __exit wdtpci_cleanup(void)
...@@ -638,12 +755,7 @@ static void __exit wdtpci_cleanup(void) ...@@ -638,12 +755,7 @@ static void __exit wdtpci_cleanup(void)
static int __init wdtpci_init(void) static int __init wdtpci_init(void)
{ {
int rc = pci_register_driver (&wdtpci_driver); return pci_register_driver (&wdtpci_driver);
if (rc < 1)
return -ENODEV;
return 0;
} }
...@@ -651,7 +763,7 @@ module_init(wdtpci_init); ...@@ -651,7 +763,7 @@ module_init(wdtpci_init);
module_exit(wdtpci_cleanup); module_exit(wdtpci_cleanup);
MODULE_AUTHOR("JP Nollmann, Alan Cox"); MODULE_AUTHOR("JP Nollmann, Alan Cox");
MODULE_DESCRIPTION("Driver for the ICS PCI watchdog cards"); MODULE_DESCRIPTION("Driver for the ICS PCI-WDT500/501 watchdog cards");
MODULE_LICENSE("GPL"); MODULE_LICENSE("GPL");
MODULE_ALIAS_MISCDEV(WATCHDOG_MINOR); MODULE_ALIAS_MISCDEV(WATCHDOG_MINOR);
MODULE_ALIAS_MISCDEV(TEMP_MINOR); MODULE_ALIAS_MISCDEV(TEMP_MINOR);
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