1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18#include <linux/module.h>
19#include <linux/moduleparam.h>
20#include <linux/types.h>
21#include <linux/kernel.h>
22#include <linux/fs.h>
23#include <linux/miscdevice.h>
24#include <linux/init.h>
25#include <linux/ioport.h>
26#include <linux/watchdog.h>
27#include <linux/notifier.h>
28#include <linux/reboot.h>
29#include <linux/uaccess.h>
30#include <linux/io.h>
31
32#include <asm/system.h>
33
34#define WATCHDOG_VERSION "1.00"
35#define WATCHDOG_NAME "W83977F WDT"
36#define PFX WATCHDOG_NAME ": "
37#define DRIVER_VERSION WATCHDOG_NAME " driver, v" WATCHDOG_VERSION "\n"
38
39#define IO_INDEX_PORT 0x3F0
40#define IO_DATA_PORT (IO_INDEX_PORT+1)
41
42#define UNLOCK_DATA 0x87
43#define LOCK_DATA 0xAA
44#define DEVICE_REGISTER 0x07
45
46#define DEFAULT_TIMEOUT 45
47
48static int timeout = DEFAULT_TIMEOUT;
49static int timeoutW;
50static unsigned long timer_alive;
51static int testmode;
52static char expect_close;
53static DEFINE_SPINLOCK(spinlock);
54
55module_param(timeout, int, 0);
56MODULE_PARM_DESC(timeout,
57 "Watchdog timeout in seconds (15..7635), default="
58 __MODULE_STRING(DEFAULT_TIMEOUT) ")");
59module_param(testmode, int, 0);
60MODULE_PARM_DESC(testmode, "Watchdog testmode (1 = no reboot), default=0");
61
62static int nowayout = WATCHDOG_NOWAYOUT;
63module_param(nowayout, int, 0);
64MODULE_PARM_DESC(nowayout,
65 "Watchdog cannot be stopped once started (default="
66 __MODULE_STRING(WATCHDOG_NOWAYOUT) ")");
67
68
69
70
71
72static int wdt_start(void)
73{
74 unsigned long flags;
75
76 spin_lock_irqsave(&spinlock, flags);
77
78
79 outb_p(UNLOCK_DATA, IO_INDEX_PORT);
80 outb_p(UNLOCK_DATA, IO_INDEX_PORT);
81
82
83
84
85
86
87
88 outb_p(DEVICE_REGISTER, IO_INDEX_PORT);
89 outb_p(0x08, IO_DATA_PORT);
90 outb_p(0xF2, IO_INDEX_PORT);
91 outb_p(timeoutW, IO_DATA_PORT);
92 outb_p(0xF3, IO_INDEX_PORT);
93 outb_p(0x08, IO_DATA_PORT);
94 outb_p(0xF4, IO_INDEX_PORT);
95 outb_p(0x00, IO_DATA_PORT);
96
97
98 outb_p(0x30, IO_INDEX_PORT);
99 outb_p(0x01, IO_DATA_PORT);
100
101
102
103
104
105
106
107
108 outb_p(DEVICE_REGISTER, IO_INDEX_PORT);
109 outb_p(0x07, IO_DATA_PORT);
110 if (!testmode) {
111 unsigned pin_map;
112
113 outb_p(0xE6, IO_INDEX_PORT);
114 outb_p(0x0A, IO_DATA_PORT);
115 outb_p(0x2C, IO_INDEX_PORT);
116 pin_map = inb_p(IO_DATA_PORT);
117 pin_map |= 0x10;
118 pin_map &= ~(0x20);
119 outb_p(0x2C, IO_INDEX_PORT);
120 outb_p(pin_map, IO_DATA_PORT);
121 }
122 outb_p(0xE3, IO_INDEX_PORT);
123 outb_p(0x08, IO_DATA_PORT);
124
125
126 outb_p(0x30, IO_INDEX_PORT);
127 outb_p(0x01, IO_DATA_PORT);
128
129
130 outb_p(LOCK_DATA, IO_INDEX_PORT);
131
132 spin_unlock_irqrestore(&spinlock, flags);
133
134 printk(KERN_INFO PFX "activated.\n");
135
136 return 0;
137}
138
139
140
141
142
143static int wdt_stop(void)
144{
145 unsigned long flags;
146
147 spin_lock_irqsave(&spinlock, flags);
148
149
150 outb_p(UNLOCK_DATA, IO_INDEX_PORT);
151 outb_p(UNLOCK_DATA, IO_INDEX_PORT);
152
153
154
155
156
157
158
159 outb_p(DEVICE_REGISTER, IO_INDEX_PORT);
160 outb_p(0x08, IO_DATA_PORT);
161 outb_p(0xF2, IO_INDEX_PORT);
162 outb_p(0xFF, IO_DATA_PORT);
163 outb_p(0xF3, IO_INDEX_PORT);
164 outb_p(0x00, IO_DATA_PORT);
165 outb_p(0xF4, IO_INDEX_PORT);
166 outb_p(0x00, IO_DATA_PORT);
167 outb_p(0xF2, IO_INDEX_PORT);
168 outb_p(0x00, IO_DATA_PORT);
169
170
171
172
173
174 outb_p(DEVICE_REGISTER, IO_INDEX_PORT);
175 outb_p(0x07, IO_DATA_PORT);
176 if (!testmode) {
177 outb_p(0xE6, IO_INDEX_PORT);
178 outb_p(0x01, IO_DATA_PORT);
179 }
180 outb_p(0xE3, IO_INDEX_PORT);
181 outb_p(0x01, IO_DATA_PORT);
182
183
184 outb_p(LOCK_DATA, IO_INDEX_PORT);
185
186 spin_unlock_irqrestore(&spinlock, flags);
187
188 printk(KERN_INFO PFX "shutdown.\n");
189
190 return 0;
191}
192
193
194
195
196
197
198static int wdt_keepalive(void)
199{
200 unsigned long flags;
201
202 spin_lock_irqsave(&spinlock, flags);
203
204
205 outb_p(UNLOCK_DATA, IO_INDEX_PORT);
206 outb_p(UNLOCK_DATA, IO_INDEX_PORT);
207
208
209 outb_p(DEVICE_REGISTER, IO_INDEX_PORT);
210 outb_p(0x08, IO_DATA_PORT);
211 outb_p(0xF2, IO_INDEX_PORT);
212 outb_p(timeoutW, IO_DATA_PORT);
213
214
215 outb_p(LOCK_DATA, IO_INDEX_PORT);
216
217 spin_unlock_irqrestore(&spinlock, flags);
218
219 return 0;
220}
221
222
223
224
225
226static int wdt_set_timeout(int t)
227{
228 int tmrval;
229
230
231
232
233
234
235
236
237 if (t < 15)
238 return -EINVAL;
239
240 tmrval = ((t + 15) + 29) / 30;
241
242 if (tmrval > 255)
243 return -EINVAL;
244
245
246
247
248
249 timeoutW = tmrval;
250 timeout = (timeoutW * 30) - 15;
251 return 0;
252}
253
254
255
256
257
258static int wdt_get_status(int *status)
259{
260 int new_status;
261 unsigned long flags;
262
263 spin_lock_irqsave(&spinlock, flags);
264
265
266 outb_p(UNLOCK_DATA, IO_INDEX_PORT);
267 outb_p(UNLOCK_DATA, IO_INDEX_PORT);
268
269
270 outb_p(DEVICE_REGISTER, IO_INDEX_PORT);
271 outb_p(0x08, IO_DATA_PORT);
272 outb_p(0xF4, IO_INDEX_PORT);
273 new_status = inb_p(IO_DATA_PORT);
274
275
276 outb_p(LOCK_DATA, IO_INDEX_PORT);
277
278 spin_unlock_irqrestore(&spinlock, flags);
279
280 *status = 0;
281 if (new_status & 1)
282 *status |= WDIOF_CARDRESET;
283
284 return 0;
285}
286
287
288
289
290
291
292static int wdt_open(struct inode *inode, struct file *file)
293{
294
295 if (test_and_set_bit(0, &timer_alive))
296 return -EBUSY;
297
298 if (nowayout)
299 __module_get(THIS_MODULE);
300
301 wdt_start();
302 return nonseekable_open(inode, file);
303}
304
305static int wdt_release(struct inode *inode, struct file *file)
306{
307
308
309
310
311 if (expect_close == 42) {
312 wdt_stop();
313 clear_bit(0, &timer_alive);
314 } else {
315 wdt_keepalive();
316 printk(KERN_CRIT PFX
317 "unexpected close, not stopping watchdog!\n");
318 }
319 expect_close = 0;
320 return 0;
321}
322
323
324
325
326
327
328
329
330
331
332
333
334static ssize_t wdt_write(struct file *file, const char __user *buf,
335 size_t count, loff_t *ppos)
336{
337
338 if (count) {
339 if (!nowayout) {
340 size_t ofs;
341
342
343
344 expect_close = 0;
345
346
347
348 for (ofs = 0; ofs != count; ofs++) {
349 char c;
350 if (get_user(c, buf + ofs))
351 return -EFAULT;
352 if (c == 'V')
353 expect_close = 42;
354 }
355 }
356
357
358 wdt_keepalive();
359 }
360 return count;
361}
362
363
364
365
366
367
368
369
370
371
372
373
374static const struct watchdog_info ident = {
375 .options = WDIOF_SETTIMEOUT | WDIOF_MAGICCLOSE | WDIOF_KEEPALIVEPING,
376 .firmware_version = 1,
377 .identity = WATCHDOG_NAME,
378};
379
380static long wdt_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
381{
382 int status;
383 int new_options, retval = -EINVAL;
384 int new_timeout;
385 union {
386 struct watchdog_info __user *ident;
387 int __user *i;
388 } uarg;
389
390 uarg.i = (int __user *)arg;
391
392 switch (cmd) {
393 case WDIOC_GETSUPPORT:
394 return copy_to_user(uarg.ident, &ident,
395 sizeof(ident)) ? -EFAULT : 0;
396
397 case WDIOC_GETSTATUS:
398 wdt_get_status(&status);
399 return put_user(status, uarg.i);
400
401 case WDIOC_GETBOOTSTATUS:
402 return put_user(0, uarg.i);
403
404 case WDIOC_SETOPTIONS:
405 if (get_user(new_options, uarg.i))
406 return -EFAULT;
407
408 if (new_options & WDIOS_DISABLECARD) {
409 wdt_stop();
410 retval = 0;
411 }
412
413 if (new_options & WDIOS_ENABLECARD) {
414 wdt_start();
415 retval = 0;
416 }
417
418 return retval;
419
420 case WDIOC_KEEPALIVE:
421 wdt_keepalive();
422 return 0;
423
424 case WDIOC_SETTIMEOUT:
425 if (get_user(new_timeout, uarg.i))
426 return -EFAULT;
427
428 if (wdt_set_timeout(new_timeout))
429 return -EINVAL;
430
431 wdt_keepalive();
432
433
434 case WDIOC_GETTIMEOUT:
435 return put_user(timeout, uarg.i);
436
437 default:
438 return -ENOTTY;
439
440 }
441}
442
443static int wdt_notify_sys(struct notifier_block *this, unsigned long code,
444 void *unused)
445{
446 if (code == SYS_DOWN || code == SYS_HALT)
447 wdt_stop();
448 return NOTIFY_DONE;
449}
450
451static const struct file_operations wdt_fops = {
452 .owner = THIS_MODULE,
453 .llseek = no_llseek,
454 .write = wdt_write,
455 .unlocked_ioctl = wdt_ioctl,
456 .open = wdt_open,
457 .release = wdt_release,
458};
459
460static struct miscdevice wdt_miscdev = {
461 .minor = WATCHDOG_MINOR,
462 .name = "watchdog",
463 .fops = &wdt_fops,
464};
465
466static struct notifier_block wdt_notifier = {
467 .notifier_call = wdt_notify_sys,
468};
469
470static int __init w83977f_wdt_init(void)
471{
472 int rc;
473
474 printk(KERN_INFO PFX DRIVER_VERSION);
475
476
477
478
479
480 if (wdt_set_timeout(timeout)) {
481 wdt_set_timeout(DEFAULT_TIMEOUT);
482 printk(KERN_INFO PFX
483 "timeout value must be 15 <= timeout <= 7635, using %d\n",
484 DEFAULT_TIMEOUT);
485 }
486
487 if (!request_region(IO_INDEX_PORT, 2, WATCHDOG_NAME)) {
488 printk(KERN_ERR PFX "I/O address 0x%04x already in use\n",
489 IO_INDEX_PORT);
490 rc = -EIO;
491 goto err_out;
492 }
493
494 rc = register_reboot_notifier(&wdt_notifier);
495 if (rc) {
496 printk(KERN_ERR PFX
497 "cannot register reboot notifier (err=%d)\n", rc);
498 goto err_out_region;
499 }
500
501 rc = misc_register(&wdt_miscdev);
502 if (rc) {
503 printk(KERN_ERR PFX
504 "cannot register miscdev on minor=%d (err=%d)\n",
505 wdt_miscdev.minor, rc);
506 goto err_out_reboot;
507 }
508
509 printk(KERN_INFO PFX
510 "initialized. timeout=%d sec (nowayout=%d testmode=%d)\n",
511 timeout, nowayout, testmode);
512
513 return 0;
514
515err_out_reboot:
516 unregister_reboot_notifier(&wdt_notifier);
517err_out_region:
518 release_region(IO_INDEX_PORT, 2);
519err_out:
520 return rc;
521}
522
523static void __exit w83977f_wdt_exit(void)
524{
525 wdt_stop();
526 misc_deregister(&wdt_miscdev);
527 unregister_reboot_notifier(&wdt_notifier);
528 release_region(IO_INDEX_PORT, 2);
529}
530
531module_init(w83977f_wdt_init);
532module_exit(w83977f_wdt_exit);
533
534MODULE_AUTHOR("Jose Goncalves <jose.goncalves@inov.pt>");
535MODULE_DESCRIPTION("Driver for watchdog timer in W83977F I/O chip");
536MODULE_LICENSE("GPL");
537MODULE_ALIAS_MISCDEV(WATCHDOG_MINOR);
538