1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
46
47#include <linux/module.h>
48#include <linux/moduleparam.h>
49#include <linux/types.h>
50#include <linux/timer.h>
51#include <linux/jiffies.h>
52#include <linux/miscdevice.h>
53#include <linux/watchdog.h>
54#include <linux/fs.h>
55#include <linux/ioport.h>
56#include <linux/notifier.h>
57#include <linux/reboot.h>
58#include <linux/init.h>
59#include <linux/io.h>
60#include <linux/uaccess.h>
61
62
63#define OUR_NAME "sbc60xxwdt"
64#define PFX OUR_NAME ": "
65
66
67
68
69
70static int wdt_stop = 0x45;
71module_param(wdt_stop, int, 0);
72MODULE_PARM_DESC(wdt_stop, "SBC60xx WDT 'stop' io port (default 0x45)");
73
74static int wdt_start = 0x443;
75module_param(wdt_start, int, 0);
76MODULE_PARM_DESC(wdt_start, "SBC60xx WDT 'start' io port (default 0x443)");
77
78
79
80
81
82
83
84#define WDT_INTERVAL (HZ/4+1)
85
86
87
88
89
90
91
92
93
94
95#define WATCHDOG_TIMEOUT 30
96static int timeout = WATCHDOG_TIMEOUT;
97
98module_param(timeout, int, 0);
99MODULE_PARM_DESC(timeout,
100 "Watchdog timeout in seconds. (1<=timeout<=3600, default="
101 __MODULE_STRING(WATCHDOG_TIMEOUT) ")");
102
103static bool nowayout = WATCHDOG_NOWAYOUT;
104module_param(nowayout, bool, 0);
105MODULE_PARM_DESC(nowayout,
106 "Watchdog cannot be stopped once started (default="
107 __MODULE_STRING(WATCHDOG_NOWAYOUT) ")");
108
109static void wdt_timer_ping(struct timer_list *);
110static DEFINE_TIMER(timer, wdt_timer_ping);
111static unsigned long next_heartbeat;
112static unsigned long wdt_is_open;
113static char wdt_expect_close;
114
115
116
117
118
119static void wdt_timer_ping(struct timer_list *unused)
120{
121
122
123
124 if (time_before(jiffies, next_heartbeat)) {
125
126 inb_p(wdt_start);
127
128 mod_timer(&timer, jiffies + WDT_INTERVAL);
129 } else
130 pr_warn("Heartbeat lost! Will not ping the watchdog\n");
131}
132
133
134
135
136
137static void wdt_startup(void)
138{
139 next_heartbeat = jiffies + (timeout * HZ);
140
141
142 mod_timer(&timer, jiffies + WDT_INTERVAL);
143 pr_info("Watchdog timer is now enabled\n");
144}
145
146static void wdt_turnoff(void)
147{
148
149 del_timer(&timer);
150 inb_p(wdt_stop);
151 pr_info("Watchdog timer is now disabled...\n");
152}
153
154static void wdt_keepalive(void)
155{
156
157 next_heartbeat = jiffies + (timeout * HZ);
158}
159
160
161
162
163
164static ssize_t fop_write(struct file *file, const char __user *buf,
165 size_t count, loff_t *ppos)
166{
167
168 if (count) {
169 if (!nowayout) {
170 size_t ofs;
171
172
173
174 wdt_expect_close = 0;
175
176
177
178 for (ofs = 0; ofs != count; ofs++) {
179 char c;
180 if (get_user(c, buf + ofs))
181 return -EFAULT;
182 if (c == 'V')
183 wdt_expect_close = 42;
184 }
185 }
186
187
188
189 wdt_keepalive();
190 }
191 return count;
192}
193
194static int fop_open(struct inode *inode, struct file *file)
195{
196
197 if (test_and_set_bit(0, &wdt_is_open))
198 return -EBUSY;
199
200 if (nowayout)
201 __module_get(THIS_MODULE);
202
203
204 wdt_startup();
205 return stream_open(inode, file);
206}
207
208static int fop_close(struct inode *inode, struct file *file)
209{
210 if (wdt_expect_close == 42)
211 wdt_turnoff();
212 else {
213 del_timer(&timer);
214 pr_crit("device file closed unexpectedly. Will not stop the WDT!\n");
215 }
216 clear_bit(0, &wdt_is_open);
217 wdt_expect_close = 0;
218 return 0;
219}
220
221static long fop_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
222{
223 void __user *argp = (void __user *)arg;
224 int __user *p = argp;
225 static const struct watchdog_info ident = {
226 .options = WDIOF_KEEPALIVEPING | WDIOF_SETTIMEOUT |
227 WDIOF_MAGICCLOSE,
228 .firmware_version = 1,
229 .identity = "SBC60xx",
230 };
231
232 switch (cmd) {
233 case WDIOC_GETSUPPORT:
234 return copy_to_user(argp, &ident, sizeof(ident)) ? -EFAULT : 0;
235 case WDIOC_GETSTATUS:
236 case WDIOC_GETBOOTSTATUS:
237 return put_user(0, p);
238 case WDIOC_SETOPTIONS:
239 {
240 int new_options, retval = -EINVAL;
241 if (get_user(new_options, p))
242 return -EFAULT;
243 if (new_options & WDIOS_DISABLECARD) {
244 wdt_turnoff();
245 retval = 0;
246 }
247 if (new_options & WDIOS_ENABLECARD) {
248 wdt_startup();
249 retval = 0;
250 }
251 return retval;
252 }
253 case WDIOC_KEEPALIVE:
254 wdt_keepalive();
255 return 0;
256 case WDIOC_SETTIMEOUT:
257 {
258 int new_timeout;
259 if (get_user(new_timeout, p))
260 return -EFAULT;
261
262 if (new_timeout < 1 || new_timeout > 3600)
263 return -EINVAL;
264
265 timeout = new_timeout;
266 wdt_keepalive();
267 }
268
269 case WDIOC_GETTIMEOUT:
270 return put_user(timeout, p);
271 default:
272 return -ENOTTY;
273 }
274}
275
276static const struct file_operations wdt_fops = {
277 .owner = THIS_MODULE,
278 .llseek = no_llseek,
279 .write = fop_write,
280 .open = fop_open,
281 .release = fop_close,
282 .unlocked_ioctl = fop_ioctl,
283};
284
285static struct miscdevice wdt_miscdev = {
286 .minor = WATCHDOG_MINOR,
287 .name = "watchdog",
288 .fops = &wdt_fops,
289};
290
291
292
293
294
295static int wdt_notify_sys(struct notifier_block *this, unsigned long code,
296 void *unused)
297{
298 if (code == SYS_DOWN || code == SYS_HALT)
299 wdt_turnoff();
300 return NOTIFY_DONE;
301}
302
303
304
305
306
307
308static struct notifier_block wdt_notifier = {
309 .notifier_call = wdt_notify_sys,
310};
311
312static void __exit sbc60xxwdt_unload(void)
313{
314 wdt_turnoff();
315
316
317 misc_deregister(&wdt_miscdev);
318
319 unregister_reboot_notifier(&wdt_notifier);
320 if ((wdt_stop != 0x45) && (wdt_stop != wdt_start))
321 release_region(wdt_stop, 1);
322 release_region(wdt_start, 1);
323}
324
325static int __init sbc60xxwdt_init(void)
326{
327 int rc = -EBUSY;
328
329 if (timeout < 1 || timeout > 3600) {
330 timeout = WATCHDOG_TIMEOUT;
331 pr_info("timeout value must be 1 <= x <= 3600, using %d\n",
332 timeout);
333 }
334
335 if (!request_region(wdt_start, 1, "SBC 60XX WDT")) {
336 pr_err("I/O address 0x%04x already in use\n", wdt_start);
337 rc = -EIO;
338 goto err_out;
339 }
340
341
342 if (wdt_stop != 0x45 && wdt_stop != wdt_start) {
343 if (!request_region(wdt_stop, 1, "SBC 60XX WDT")) {
344 pr_err("I/O address 0x%04x already in use\n", wdt_stop);
345 rc = -EIO;
346 goto err_out_region1;
347 }
348 }
349
350 rc = register_reboot_notifier(&wdt_notifier);
351 if (rc) {
352 pr_err("cannot register reboot notifier (err=%d)\n", rc);
353 goto err_out_region2;
354 }
355
356 rc = misc_register(&wdt_miscdev);
357 if (rc) {
358 pr_err("cannot register miscdev on minor=%d (err=%d)\n",
359 wdt_miscdev.minor, rc);
360 goto err_out_reboot;
361 }
362 pr_info("WDT driver for 60XX single board computer initialised. timeout=%d sec (nowayout=%d)\n",
363 timeout, nowayout);
364
365 return 0;
366
367err_out_reboot:
368 unregister_reboot_notifier(&wdt_notifier);
369err_out_region2:
370 if (wdt_stop != 0x45 && wdt_stop != wdt_start)
371 release_region(wdt_stop, 1);
372err_out_region1:
373 release_region(wdt_start, 1);
374err_out:
375 return rc;
376}
377
378module_init(sbc60xxwdt_init);
379module_exit(sbc60xxwdt_unload);
380
381MODULE_AUTHOR("Jakob Oestergaard <jakob@unthought.net>");
382MODULE_DESCRIPTION("60xx Single Board Computer Watchdog Timer driver");
383MODULE_LICENSE("GPL");
384