xref: /OK3568_Linux_fs/kernel/drivers/watchdog/sc1200wdt.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  *	National Semiconductor PC87307/PC97307 (ala SC1200) WDT driver
4*4882a593Smuzhiyun  *	(c) Copyright 2002 Zwane Mwaikambo <zwane@commfireservices.com>,
5*4882a593Smuzhiyun  *			All Rights Reserved.
6*4882a593Smuzhiyun  *	Based on wdt.c and wdt977.c by Alan Cox and Woody Suwalski respectively.
7*4882a593Smuzhiyun  *
8*4882a593Smuzhiyun  *	The author(s) of this software shall not be held liable for damages
9*4882a593Smuzhiyun  *	of any nature resulting due to the use of this software. This
10*4882a593Smuzhiyun  *	software is provided AS-IS with no warranties.
11*4882a593Smuzhiyun  *
12*4882a593Smuzhiyun  *	Changelog:
13*4882a593Smuzhiyun  *	20020220 Zwane Mwaikambo	Code based on datasheet, no hardware.
14*4882a593Smuzhiyun  *	20020221 Zwane Mwaikambo	Cleanups as suggested by Jeff Garzik
15*4882a593Smuzhiyun  *					and Alan Cox.
16*4882a593Smuzhiyun  *	20020222 Zwane Mwaikambo	Added probing.
17*4882a593Smuzhiyun  *	20020225 Zwane Mwaikambo	Added ISAPNP support.
18*4882a593Smuzhiyun  *	20020412 Rob Radez		Broke out start/stop functions
19*4882a593Smuzhiyun  *		 <rob@osinvestor.com>	Return proper status instead of
20*4882a593Smuzhiyun  *					temperature warning
21*4882a593Smuzhiyun  *					Add WDIOC_GETBOOTSTATUS and
22*4882a593Smuzhiyun  *					WDIOC_SETOPTIONS ioctls
23*4882a593Smuzhiyun  *					Fix CONFIG_WATCHDOG_NOWAYOUT
24*4882a593Smuzhiyun  *	20020530 Joel Becker		Add Matt Domsch's nowayout module
25*4882a593Smuzhiyun  *					option
26*4882a593Smuzhiyun  *	20030116 Adam Belay		Updated to the latest pnp code
27*4882a593Smuzhiyun  */
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
30*4882a593Smuzhiyun 
31*4882a593Smuzhiyun #include <linux/module.h>
32*4882a593Smuzhiyun #include <linux/moduleparam.h>
33*4882a593Smuzhiyun #include <linux/miscdevice.h>
34*4882a593Smuzhiyun #include <linux/watchdog.h>
35*4882a593Smuzhiyun #include <linux/ioport.h>
36*4882a593Smuzhiyun #include <linux/spinlock.h>
37*4882a593Smuzhiyun #include <linux/notifier.h>
38*4882a593Smuzhiyun #include <linux/reboot.h>
39*4882a593Smuzhiyun #include <linux/init.h>
40*4882a593Smuzhiyun #include <linux/pnp.h>
41*4882a593Smuzhiyun #include <linux/fs.h>
42*4882a593Smuzhiyun #include <linux/semaphore.h>
43*4882a593Smuzhiyun #include <linux/io.h>
44*4882a593Smuzhiyun #include <linux/uaccess.h>
45*4882a593Smuzhiyun 
46*4882a593Smuzhiyun #define SC1200_MODULE_VER	"build 20020303"
47*4882a593Smuzhiyun #define SC1200_MODULE_NAME	"sc1200wdt"
48*4882a593Smuzhiyun 
49*4882a593Smuzhiyun #define	MAX_TIMEOUT	255	/* 255 minutes */
50*4882a593Smuzhiyun #define PMIR		(io)	/* Power Management Index Register */
51*4882a593Smuzhiyun #define PMDR		(io+1)	/* Power Management Data Register */
52*4882a593Smuzhiyun 
53*4882a593Smuzhiyun /* Data Register indexes */
54*4882a593Smuzhiyun #define FER1		0x00	/* Function enable register 1 */
55*4882a593Smuzhiyun #define FER2		0x01	/* Function enable register 2 */
56*4882a593Smuzhiyun #define PMC1		0x02	/* Power Management Ctrl 1 */
57*4882a593Smuzhiyun #define PMC2		0x03	/* Power Management Ctrl 2 */
58*4882a593Smuzhiyun #define PMC3		0x04	/* Power Management Ctrl 3 */
59*4882a593Smuzhiyun #define WDTO		0x05	/* Watchdog timeout register */
60*4882a593Smuzhiyun #define	WDCF		0x06	/* Watchdog config register */
61*4882a593Smuzhiyun #define WDST		0x07	/* Watchdog status register */
62*4882a593Smuzhiyun 
63*4882a593Smuzhiyun /* WDCF bitfields - which devices assert WDO */
64*4882a593Smuzhiyun #define KBC_IRQ		0x01	/* Keyboard Controller */
65*4882a593Smuzhiyun #define MSE_IRQ		0x02	/* Mouse */
66*4882a593Smuzhiyun #define UART1_IRQ	0x03	/* Serial0 */
67*4882a593Smuzhiyun #define UART2_IRQ	0x04	/* Serial1 */
68*4882a593Smuzhiyun /* 5 -7 are reserved */
69*4882a593Smuzhiyun 
70*4882a593Smuzhiyun static int timeout = 1;
71*4882a593Smuzhiyun static int io = -1;
72*4882a593Smuzhiyun static int io_len = 2;		/* for non plug and play */
73*4882a593Smuzhiyun static unsigned long open_flag;
74*4882a593Smuzhiyun static char expect_close;
75*4882a593Smuzhiyun static DEFINE_SPINLOCK(sc1200wdt_lock);	/* io port access serialisation */
76*4882a593Smuzhiyun 
77*4882a593Smuzhiyun #if defined CONFIG_PNP
78*4882a593Smuzhiyun static int isapnp = 1;
79*4882a593Smuzhiyun static struct pnp_dev *wdt_dev;
80*4882a593Smuzhiyun 
81*4882a593Smuzhiyun module_param(isapnp, int, 0);
82*4882a593Smuzhiyun MODULE_PARM_DESC(isapnp,
83*4882a593Smuzhiyun 	"When set to 0 driver ISA PnP support will be disabled");
84*4882a593Smuzhiyun #endif
85*4882a593Smuzhiyun 
86*4882a593Smuzhiyun module_param_hw(io, int, ioport, 0);
87*4882a593Smuzhiyun MODULE_PARM_DESC(io, "io port");
88*4882a593Smuzhiyun module_param(timeout, int, 0);
89*4882a593Smuzhiyun MODULE_PARM_DESC(timeout, "range is 0-255 minutes, default is 1");
90*4882a593Smuzhiyun 
91*4882a593Smuzhiyun static bool nowayout = WATCHDOG_NOWAYOUT;
92*4882a593Smuzhiyun module_param(nowayout, bool, 0);
93*4882a593Smuzhiyun MODULE_PARM_DESC(nowayout,
94*4882a593Smuzhiyun 	"Watchdog cannot be stopped once started (default="
95*4882a593Smuzhiyun 				__MODULE_STRING(WATCHDOG_NOWAYOUT) ")");
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun 
98*4882a593Smuzhiyun 
99*4882a593Smuzhiyun /* Read from Data Register */
__sc1200wdt_read_data(unsigned char index,unsigned char * data)100*4882a593Smuzhiyun static inline void __sc1200wdt_read_data(unsigned char index,
101*4882a593Smuzhiyun 						unsigned char *data)
102*4882a593Smuzhiyun {
103*4882a593Smuzhiyun 	outb_p(index, PMIR);
104*4882a593Smuzhiyun 	*data = inb(PMDR);
105*4882a593Smuzhiyun }
106*4882a593Smuzhiyun 
sc1200wdt_read_data(unsigned char index,unsigned char * data)107*4882a593Smuzhiyun static void sc1200wdt_read_data(unsigned char index, unsigned char *data)
108*4882a593Smuzhiyun {
109*4882a593Smuzhiyun 	spin_lock(&sc1200wdt_lock);
110*4882a593Smuzhiyun 	__sc1200wdt_read_data(index, data);
111*4882a593Smuzhiyun 	spin_unlock(&sc1200wdt_lock);
112*4882a593Smuzhiyun }
113*4882a593Smuzhiyun 
114*4882a593Smuzhiyun /* Write to Data Register */
__sc1200wdt_write_data(unsigned char index,unsigned char data)115*4882a593Smuzhiyun static inline void __sc1200wdt_write_data(unsigned char index,
116*4882a593Smuzhiyun 						unsigned char data)
117*4882a593Smuzhiyun {
118*4882a593Smuzhiyun 	outb_p(index, PMIR);
119*4882a593Smuzhiyun 	outb(data, PMDR);
120*4882a593Smuzhiyun }
121*4882a593Smuzhiyun 
sc1200wdt_write_data(unsigned char index,unsigned char data)122*4882a593Smuzhiyun static inline void sc1200wdt_write_data(unsigned char index,
123*4882a593Smuzhiyun 						unsigned char data)
124*4882a593Smuzhiyun {
125*4882a593Smuzhiyun 	spin_lock(&sc1200wdt_lock);
126*4882a593Smuzhiyun 	__sc1200wdt_write_data(index, data);
127*4882a593Smuzhiyun 	spin_unlock(&sc1200wdt_lock);
128*4882a593Smuzhiyun }
129*4882a593Smuzhiyun 
130*4882a593Smuzhiyun 
sc1200wdt_start(void)131*4882a593Smuzhiyun static void sc1200wdt_start(void)
132*4882a593Smuzhiyun {
133*4882a593Smuzhiyun 	unsigned char reg;
134*4882a593Smuzhiyun 	spin_lock(&sc1200wdt_lock);
135*4882a593Smuzhiyun 
136*4882a593Smuzhiyun 	__sc1200wdt_read_data(WDCF, &reg);
137*4882a593Smuzhiyun 	/* assert WDO when any of the following interrupts are triggered too */
138*4882a593Smuzhiyun 	reg |= (KBC_IRQ | MSE_IRQ | UART1_IRQ | UART2_IRQ);
139*4882a593Smuzhiyun 	__sc1200wdt_write_data(WDCF, reg);
140*4882a593Smuzhiyun 	/* set the timeout and get the ball rolling */
141*4882a593Smuzhiyun 	__sc1200wdt_write_data(WDTO, timeout);
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun 	spin_unlock(&sc1200wdt_lock);
144*4882a593Smuzhiyun }
145*4882a593Smuzhiyun 
sc1200wdt_stop(void)146*4882a593Smuzhiyun static void sc1200wdt_stop(void)
147*4882a593Smuzhiyun {
148*4882a593Smuzhiyun 	sc1200wdt_write_data(WDTO, 0);
149*4882a593Smuzhiyun }
150*4882a593Smuzhiyun 
151*4882a593Smuzhiyun /* This returns the status of the WDO signal, inactive high. */
sc1200wdt_status(void)152*4882a593Smuzhiyun static inline int sc1200wdt_status(void)
153*4882a593Smuzhiyun {
154*4882a593Smuzhiyun 	unsigned char ret;
155*4882a593Smuzhiyun 
156*4882a593Smuzhiyun 	sc1200wdt_read_data(WDST, &ret);
157*4882a593Smuzhiyun 	/* If the bit is inactive, the watchdog is enabled, so return
158*4882a593Smuzhiyun 	 * KEEPALIVEPING which is a bit of a kludge because there's nothing
159*4882a593Smuzhiyun 	 * else for enabled/disabled status
160*4882a593Smuzhiyun 	 */
161*4882a593Smuzhiyun 	return (ret & 0x01) ? 0 : WDIOF_KEEPALIVEPING;
162*4882a593Smuzhiyun }
163*4882a593Smuzhiyun 
sc1200wdt_open(struct inode * inode,struct file * file)164*4882a593Smuzhiyun static int sc1200wdt_open(struct inode *inode, struct file *file)
165*4882a593Smuzhiyun {
166*4882a593Smuzhiyun 	/* allow one at a time */
167*4882a593Smuzhiyun 	if (test_and_set_bit(0, &open_flag))
168*4882a593Smuzhiyun 		return -EBUSY;
169*4882a593Smuzhiyun 
170*4882a593Smuzhiyun 	if (timeout > MAX_TIMEOUT)
171*4882a593Smuzhiyun 		timeout = MAX_TIMEOUT;
172*4882a593Smuzhiyun 
173*4882a593Smuzhiyun 	sc1200wdt_start();
174*4882a593Smuzhiyun 	pr_info("Watchdog enabled, timeout = %d min(s)", timeout);
175*4882a593Smuzhiyun 
176*4882a593Smuzhiyun 	return stream_open(inode, file);
177*4882a593Smuzhiyun }
178*4882a593Smuzhiyun 
179*4882a593Smuzhiyun 
sc1200wdt_ioctl(struct file * file,unsigned int cmd,unsigned long arg)180*4882a593Smuzhiyun static long sc1200wdt_ioctl(struct file *file, unsigned int cmd,
181*4882a593Smuzhiyun 						unsigned long arg)
182*4882a593Smuzhiyun {
183*4882a593Smuzhiyun 	int new_timeout;
184*4882a593Smuzhiyun 	void __user *argp = (void __user *)arg;
185*4882a593Smuzhiyun 	int __user *p = argp;
186*4882a593Smuzhiyun 	static const struct watchdog_info ident = {
187*4882a593Smuzhiyun 		.options = WDIOF_KEEPALIVEPING | WDIOF_SETTIMEOUT |
188*4882a593Smuzhiyun 							WDIOF_MAGICCLOSE,
189*4882a593Smuzhiyun 		.firmware_version = 0,
190*4882a593Smuzhiyun 		.identity = "PC87307/PC97307",
191*4882a593Smuzhiyun 	};
192*4882a593Smuzhiyun 
193*4882a593Smuzhiyun 	switch (cmd) {
194*4882a593Smuzhiyun 	case WDIOC_GETSUPPORT:
195*4882a593Smuzhiyun 		if (copy_to_user(argp, &ident, sizeof(ident)))
196*4882a593Smuzhiyun 			return -EFAULT;
197*4882a593Smuzhiyun 		return 0;
198*4882a593Smuzhiyun 
199*4882a593Smuzhiyun 	case WDIOC_GETSTATUS:
200*4882a593Smuzhiyun 		return put_user(sc1200wdt_status(), p);
201*4882a593Smuzhiyun 
202*4882a593Smuzhiyun 	case WDIOC_GETBOOTSTATUS:
203*4882a593Smuzhiyun 		return put_user(0, p);
204*4882a593Smuzhiyun 
205*4882a593Smuzhiyun 	case WDIOC_SETOPTIONS:
206*4882a593Smuzhiyun 	{
207*4882a593Smuzhiyun 		int options, retval = -EINVAL;
208*4882a593Smuzhiyun 
209*4882a593Smuzhiyun 		if (get_user(options, p))
210*4882a593Smuzhiyun 			return -EFAULT;
211*4882a593Smuzhiyun 
212*4882a593Smuzhiyun 		if (options & WDIOS_DISABLECARD) {
213*4882a593Smuzhiyun 			sc1200wdt_stop();
214*4882a593Smuzhiyun 			retval = 0;
215*4882a593Smuzhiyun 		}
216*4882a593Smuzhiyun 
217*4882a593Smuzhiyun 		if (options & WDIOS_ENABLECARD) {
218*4882a593Smuzhiyun 			sc1200wdt_start();
219*4882a593Smuzhiyun 			retval = 0;
220*4882a593Smuzhiyun 		}
221*4882a593Smuzhiyun 
222*4882a593Smuzhiyun 		return retval;
223*4882a593Smuzhiyun 	}
224*4882a593Smuzhiyun 	case WDIOC_KEEPALIVE:
225*4882a593Smuzhiyun 		sc1200wdt_write_data(WDTO, timeout);
226*4882a593Smuzhiyun 		return 0;
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun 	case WDIOC_SETTIMEOUT:
229*4882a593Smuzhiyun 		if (get_user(new_timeout, p))
230*4882a593Smuzhiyun 			return -EFAULT;
231*4882a593Smuzhiyun 		/* the API states this is given in secs */
232*4882a593Smuzhiyun 		new_timeout /= 60;
233*4882a593Smuzhiyun 		if (new_timeout < 0 || new_timeout > MAX_TIMEOUT)
234*4882a593Smuzhiyun 			return -EINVAL;
235*4882a593Smuzhiyun 		timeout = new_timeout;
236*4882a593Smuzhiyun 		sc1200wdt_write_data(WDTO, timeout);
237*4882a593Smuzhiyun 		fallthrough;	/* and return the new timeout */
238*4882a593Smuzhiyun 
239*4882a593Smuzhiyun 	case WDIOC_GETTIMEOUT:
240*4882a593Smuzhiyun 		return put_user(timeout * 60, p);
241*4882a593Smuzhiyun 
242*4882a593Smuzhiyun 	default:
243*4882a593Smuzhiyun 		return -ENOTTY;
244*4882a593Smuzhiyun 	}
245*4882a593Smuzhiyun }
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun 
sc1200wdt_release(struct inode * inode,struct file * file)248*4882a593Smuzhiyun static int sc1200wdt_release(struct inode *inode, struct file *file)
249*4882a593Smuzhiyun {
250*4882a593Smuzhiyun 	if (expect_close == 42) {
251*4882a593Smuzhiyun 		sc1200wdt_stop();
252*4882a593Smuzhiyun 		pr_info("Watchdog disabled\n");
253*4882a593Smuzhiyun 	} else {
254*4882a593Smuzhiyun 		sc1200wdt_write_data(WDTO, timeout);
255*4882a593Smuzhiyun 		pr_crit("Unexpected close!, timeout = %d min(s)\n", timeout);
256*4882a593Smuzhiyun 	}
257*4882a593Smuzhiyun 	clear_bit(0, &open_flag);
258*4882a593Smuzhiyun 	expect_close = 0;
259*4882a593Smuzhiyun 
260*4882a593Smuzhiyun 	return 0;
261*4882a593Smuzhiyun }
262*4882a593Smuzhiyun 
263*4882a593Smuzhiyun 
sc1200wdt_write(struct file * file,const char __user * data,size_t len,loff_t * ppos)264*4882a593Smuzhiyun static ssize_t sc1200wdt_write(struct file *file, const char __user *data,
265*4882a593Smuzhiyun 						size_t len, loff_t *ppos)
266*4882a593Smuzhiyun {
267*4882a593Smuzhiyun 	if (len) {
268*4882a593Smuzhiyun 		if (!nowayout) {
269*4882a593Smuzhiyun 			size_t i;
270*4882a593Smuzhiyun 
271*4882a593Smuzhiyun 			expect_close = 0;
272*4882a593Smuzhiyun 
273*4882a593Smuzhiyun 			for (i = 0; i != len; i++) {
274*4882a593Smuzhiyun 				char c;
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun 				if (get_user(c, data + i))
277*4882a593Smuzhiyun 					return -EFAULT;
278*4882a593Smuzhiyun 				if (c == 'V')
279*4882a593Smuzhiyun 					expect_close = 42;
280*4882a593Smuzhiyun 			}
281*4882a593Smuzhiyun 		}
282*4882a593Smuzhiyun 
283*4882a593Smuzhiyun 		sc1200wdt_write_data(WDTO, timeout);
284*4882a593Smuzhiyun 		return len;
285*4882a593Smuzhiyun 	}
286*4882a593Smuzhiyun 
287*4882a593Smuzhiyun 	return 0;
288*4882a593Smuzhiyun }
289*4882a593Smuzhiyun 
290*4882a593Smuzhiyun 
sc1200wdt_notify_sys(struct notifier_block * this,unsigned long code,void * unused)291*4882a593Smuzhiyun static int sc1200wdt_notify_sys(struct notifier_block *this,
292*4882a593Smuzhiyun 					unsigned long code, void *unused)
293*4882a593Smuzhiyun {
294*4882a593Smuzhiyun 	if (code == SYS_DOWN || code == SYS_HALT)
295*4882a593Smuzhiyun 		sc1200wdt_stop();
296*4882a593Smuzhiyun 
297*4882a593Smuzhiyun 	return NOTIFY_DONE;
298*4882a593Smuzhiyun }
299*4882a593Smuzhiyun 
300*4882a593Smuzhiyun 
301*4882a593Smuzhiyun static struct notifier_block sc1200wdt_notifier = {
302*4882a593Smuzhiyun 	.notifier_call =	sc1200wdt_notify_sys,
303*4882a593Smuzhiyun };
304*4882a593Smuzhiyun 
305*4882a593Smuzhiyun static const struct file_operations sc1200wdt_fops = {
306*4882a593Smuzhiyun 	.owner		= THIS_MODULE,
307*4882a593Smuzhiyun 	.llseek		= no_llseek,
308*4882a593Smuzhiyun 	.write		= sc1200wdt_write,
309*4882a593Smuzhiyun 	.unlocked_ioctl = sc1200wdt_ioctl,
310*4882a593Smuzhiyun 	.compat_ioctl	= compat_ptr_ioctl,
311*4882a593Smuzhiyun 	.open		= sc1200wdt_open,
312*4882a593Smuzhiyun 	.release	= sc1200wdt_release,
313*4882a593Smuzhiyun };
314*4882a593Smuzhiyun 
315*4882a593Smuzhiyun static struct miscdevice sc1200wdt_miscdev = {
316*4882a593Smuzhiyun 	.minor		= WATCHDOG_MINOR,
317*4882a593Smuzhiyun 	.name		= "watchdog",
318*4882a593Smuzhiyun 	.fops		= &sc1200wdt_fops,
319*4882a593Smuzhiyun };
320*4882a593Smuzhiyun 
321*4882a593Smuzhiyun 
sc1200wdt_probe(void)322*4882a593Smuzhiyun static int __init sc1200wdt_probe(void)
323*4882a593Smuzhiyun {
324*4882a593Smuzhiyun 	/* The probe works by reading the PMC3 register's default value of 0x0e
325*4882a593Smuzhiyun 	 * there is one caveat, if the device disables the parallel port or any
326*4882a593Smuzhiyun 	 * of the UARTs we won't be able to detect it.
327*4882a593Smuzhiyun 	 * NB. This could be done with accuracy by reading the SID registers,
328*4882a593Smuzhiyun 	 * but we don't have access to those io regions.
329*4882a593Smuzhiyun 	 */
330*4882a593Smuzhiyun 
331*4882a593Smuzhiyun 	unsigned char reg;
332*4882a593Smuzhiyun 
333*4882a593Smuzhiyun 	sc1200wdt_read_data(PMC3, &reg);
334*4882a593Smuzhiyun 	reg &= 0x0f;		/* we don't want the UART busy bits */
335*4882a593Smuzhiyun 	return (reg == 0x0e) ? 0 : -ENODEV;
336*4882a593Smuzhiyun }
337*4882a593Smuzhiyun 
338*4882a593Smuzhiyun 
339*4882a593Smuzhiyun #if defined CONFIG_PNP
340*4882a593Smuzhiyun 
341*4882a593Smuzhiyun static const struct pnp_device_id scl200wdt_pnp_devices[] = {
342*4882a593Smuzhiyun 	/* National Semiconductor PC87307/PC97307 watchdog component */
343*4882a593Smuzhiyun 	{.id = "NSC0800", .driver_data = 0},
344*4882a593Smuzhiyun 	{.id = ""},
345*4882a593Smuzhiyun };
346*4882a593Smuzhiyun 
scl200wdt_pnp_probe(struct pnp_dev * dev,const struct pnp_device_id * dev_id)347*4882a593Smuzhiyun static int scl200wdt_pnp_probe(struct pnp_dev *dev,
348*4882a593Smuzhiyun 					const struct pnp_device_id *dev_id)
349*4882a593Smuzhiyun {
350*4882a593Smuzhiyun 	/* this driver only supports one card at a time */
351*4882a593Smuzhiyun 	if (wdt_dev || !isapnp)
352*4882a593Smuzhiyun 		return -EBUSY;
353*4882a593Smuzhiyun 
354*4882a593Smuzhiyun 	wdt_dev = dev;
355*4882a593Smuzhiyun 	io = pnp_port_start(wdt_dev, 0);
356*4882a593Smuzhiyun 	io_len = pnp_port_len(wdt_dev, 0);
357*4882a593Smuzhiyun 
358*4882a593Smuzhiyun 	if (!request_region(io, io_len, SC1200_MODULE_NAME)) {
359*4882a593Smuzhiyun 		pr_err("Unable to register IO port %#x\n", io);
360*4882a593Smuzhiyun 		return -EBUSY;
361*4882a593Smuzhiyun 	}
362*4882a593Smuzhiyun 
363*4882a593Smuzhiyun 	pr_info("PnP device found at io port %#x/%d\n", io, io_len);
364*4882a593Smuzhiyun 	return 0;
365*4882a593Smuzhiyun }
366*4882a593Smuzhiyun 
scl200wdt_pnp_remove(struct pnp_dev * dev)367*4882a593Smuzhiyun static void scl200wdt_pnp_remove(struct pnp_dev *dev)
368*4882a593Smuzhiyun {
369*4882a593Smuzhiyun 	if (wdt_dev) {
370*4882a593Smuzhiyun 		release_region(io, io_len);
371*4882a593Smuzhiyun 		wdt_dev = NULL;
372*4882a593Smuzhiyun 	}
373*4882a593Smuzhiyun }
374*4882a593Smuzhiyun 
375*4882a593Smuzhiyun static struct pnp_driver scl200wdt_pnp_driver = {
376*4882a593Smuzhiyun 	.name		= "scl200wdt",
377*4882a593Smuzhiyun 	.id_table	= scl200wdt_pnp_devices,
378*4882a593Smuzhiyun 	.probe		= scl200wdt_pnp_probe,
379*4882a593Smuzhiyun 	.remove		= scl200wdt_pnp_remove,
380*4882a593Smuzhiyun };
381*4882a593Smuzhiyun 
382*4882a593Smuzhiyun #endif /* CONFIG_PNP */
383*4882a593Smuzhiyun 
384*4882a593Smuzhiyun 
sc1200wdt_init(void)385*4882a593Smuzhiyun static int __init sc1200wdt_init(void)
386*4882a593Smuzhiyun {
387*4882a593Smuzhiyun 	int ret;
388*4882a593Smuzhiyun 
389*4882a593Smuzhiyun 	pr_info("%s\n", SC1200_MODULE_VER);
390*4882a593Smuzhiyun 
391*4882a593Smuzhiyun #if defined CONFIG_PNP
392*4882a593Smuzhiyun 	if (isapnp) {
393*4882a593Smuzhiyun 		ret = pnp_register_driver(&scl200wdt_pnp_driver);
394*4882a593Smuzhiyun 		if (ret)
395*4882a593Smuzhiyun 			goto out_clean;
396*4882a593Smuzhiyun 	}
397*4882a593Smuzhiyun #endif
398*4882a593Smuzhiyun 
399*4882a593Smuzhiyun 	if (io == -1) {
400*4882a593Smuzhiyun 		pr_err("io parameter must be specified\n");
401*4882a593Smuzhiyun 		ret = -EINVAL;
402*4882a593Smuzhiyun 		goto out_pnp;
403*4882a593Smuzhiyun 	}
404*4882a593Smuzhiyun 
405*4882a593Smuzhiyun #if defined CONFIG_PNP
406*4882a593Smuzhiyun 	/* now that the user has specified an IO port and we haven't detected
407*4882a593Smuzhiyun 	 * any devices, disable pnp support */
408*4882a593Smuzhiyun 	if (isapnp)
409*4882a593Smuzhiyun 		pnp_unregister_driver(&scl200wdt_pnp_driver);
410*4882a593Smuzhiyun 	isapnp = 0;
411*4882a593Smuzhiyun #endif
412*4882a593Smuzhiyun 
413*4882a593Smuzhiyun 	if (!request_region(io, io_len, SC1200_MODULE_NAME)) {
414*4882a593Smuzhiyun 		pr_err("Unable to register IO port %#x\n", io);
415*4882a593Smuzhiyun 		ret = -EBUSY;
416*4882a593Smuzhiyun 		goto out_pnp;
417*4882a593Smuzhiyun 	}
418*4882a593Smuzhiyun 
419*4882a593Smuzhiyun 	ret = sc1200wdt_probe();
420*4882a593Smuzhiyun 	if (ret)
421*4882a593Smuzhiyun 		goto out_io;
422*4882a593Smuzhiyun 
423*4882a593Smuzhiyun 	ret = register_reboot_notifier(&sc1200wdt_notifier);
424*4882a593Smuzhiyun 	if (ret) {
425*4882a593Smuzhiyun 		pr_err("Unable to register reboot notifier err = %d\n", ret);
426*4882a593Smuzhiyun 		goto out_io;
427*4882a593Smuzhiyun 	}
428*4882a593Smuzhiyun 
429*4882a593Smuzhiyun 	ret = misc_register(&sc1200wdt_miscdev);
430*4882a593Smuzhiyun 	if (ret) {
431*4882a593Smuzhiyun 		pr_err("Unable to register miscdev on minor %d\n",
432*4882a593Smuzhiyun 		       WATCHDOG_MINOR);
433*4882a593Smuzhiyun 		goto out_rbt;
434*4882a593Smuzhiyun 	}
435*4882a593Smuzhiyun 
436*4882a593Smuzhiyun 	/* ret = 0 */
437*4882a593Smuzhiyun 
438*4882a593Smuzhiyun out_clean:
439*4882a593Smuzhiyun 	return ret;
440*4882a593Smuzhiyun 
441*4882a593Smuzhiyun out_rbt:
442*4882a593Smuzhiyun 	unregister_reboot_notifier(&sc1200wdt_notifier);
443*4882a593Smuzhiyun 
444*4882a593Smuzhiyun out_io:
445*4882a593Smuzhiyun 	release_region(io, io_len);
446*4882a593Smuzhiyun 
447*4882a593Smuzhiyun out_pnp:
448*4882a593Smuzhiyun #if defined CONFIG_PNP
449*4882a593Smuzhiyun 	if (isapnp)
450*4882a593Smuzhiyun 		pnp_unregister_driver(&scl200wdt_pnp_driver);
451*4882a593Smuzhiyun #endif
452*4882a593Smuzhiyun 	goto out_clean;
453*4882a593Smuzhiyun }
454*4882a593Smuzhiyun 
455*4882a593Smuzhiyun 
sc1200wdt_exit(void)456*4882a593Smuzhiyun static void __exit sc1200wdt_exit(void)
457*4882a593Smuzhiyun {
458*4882a593Smuzhiyun 	misc_deregister(&sc1200wdt_miscdev);
459*4882a593Smuzhiyun 	unregister_reboot_notifier(&sc1200wdt_notifier);
460*4882a593Smuzhiyun 
461*4882a593Smuzhiyun #if defined CONFIG_PNP
462*4882a593Smuzhiyun 	if (isapnp)
463*4882a593Smuzhiyun 		pnp_unregister_driver(&scl200wdt_pnp_driver);
464*4882a593Smuzhiyun 	else
465*4882a593Smuzhiyun #endif
466*4882a593Smuzhiyun 	release_region(io, io_len);
467*4882a593Smuzhiyun }
468*4882a593Smuzhiyun 
469*4882a593Smuzhiyun module_init(sc1200wdt_init);
470*4882a593Smuzhiyun module_exit(sc1200wdt_exit);
471*4882a593Smuzhiyun 
472*4882a593Smuzhiyun MODULE_AUTHOR("Zwane Mwaikambo <zwane@commfireservices.com>");
473*4882a593Smuzhiyun MODULE_DESCRIPTION(
474*4882a593Smuzhiyun 	"Driver for National Semiconductor PC87307/PC97307 watchdog component");
475*4882a593Smuzhiyun MODULE_LICENSE("GPL");
476