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
46
47
48
49
50
51
52
53
54
55
56#include <linux/module.h>
57#include <linux/moduleparam.h>
58#include <linux/types.h>
59#include <linux/errno.h>
60#include <linux/kernel.h>
61#include <linux/miscdevice.h>
62
63#include <linux/watchdog.h>
64#include <linux/fs.h>
65#include <linux/ioport.h>
66#include <linux/platform_device.h>
67#include <linux/init.h>
68#include <linux/uaccess.h>
69#include <linux/io.h>
70
71
72#define DRV_NAME "acquirewdt"
73#define PFX DRV_NAME ": "
74#define WATCHDOG_NAME "Acquire WDT"
75
76#define WATCHDOG_HEARTBEAT 0
77
78
79
80static struct platform_device *acq_platform_device;
81static unsigned long acq_is_open;
82static char expect_close;
83
84
85
86static int wdt_stop = 0x43;
87module_param(wdt_stop, int, 0);
88MODULE_PARM_DESC(wdt_stop, "Acquire WDT 'stop' io port (default 0x43)");
89
90
91static int wdt_start = 0x443;
92module_param(wdt_start, int, 0);
93MODULE_PARM_DESC(wdt_start, "Acquire WDT 'start' io port (default 0x443)");
94
95static int nowayout = WATCHDOG_NOWAYOUT;
96module_param(nowayout, int, 0);
97MODULE_PARM_DESC(nowayout,
98 "Watchdog cannot be stopped once started (default="
99 __MODULE_STRING(WATCHDOG_NOWAYOUT) ")");
100
101
102
103
104
105static void acq_keepalive(void)
106{
107
108 inb_p(wdt_start);
109}
110
111static void acq_stop(void)
112{
113
114 inb_p(wdt_stop);
115}
116
117
118
119
120
121static ssize_t acq_write(struct file *file, const char __user *buf,
122 size_t count, loff_t *ppos)
123{
124
125 if (count) {
126 if (!nowayout) {
127 size_t i;
128
129
130 expect_close = 0;
131
132
133 for (i = 0; i != count; i++) {
134 char c;
135 if (get_user(c, buf + i))
136 return -EFAULT;
137 if (c == 'V')
138 expect_close = 42;
139 }
140 }
141
142
143 acq_keepalive();
144 }
145 return count;
146}
147
148static long acq_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
149{
150 int options, retval = -EINVAL;
151 void __user *argp = (void __user *)arg;
152 int __user *p = argp;
153 static const struct watchdog_info ident = {
154 .options = WDIOF_KEEPALIVEPING | WDIOF_MAGICCLOSE,
155 .firmware_version = 1,
156 .identity = WATCHDOG_NAME,
157 };
158
159 switch (cmd) {
160 case WDIOC_GETSUPPORT:
161 return copy_to_user(argp, &ident, sizeof(ident)) ? -EFAULT : 0;
162
163 case WDIOC_GETSTATUS:
164 case WDIOC_GETBOOTSTATUS:
165 return put_user(0, p);
166
167 case WDIOC_SETOPTIONS:
168 {
169 if (get_user(options, p))
170 return -EFAULT;
171 if (options & WDIOS_DISABLECARD) {
172 acq_stop();
173 retval = 0;
174 }
175 if (options & WDIOS_ENABLECARD) {
176 acq_keepalive();
177 retval = 0;
178 }
179 return retval;
180 }
181 case WDIOC_KEEPALIVE:
182 acq_keepalive();
183 return 0;
184
185 case WDIOC_GETTIMEOUT:
186 return put_user(WATCHDOG_HEARTBEAT, p);
187
188 default:
189 return -ENOTTY;
190 }
191}
192
193static int acq_open(struct inode *inode, struct file *file)
194{
195 if (test_and_set_bit(0, &acq_is_open))
196 return -EBUSY;
197
198 if (nowayout)
199 __module_get(THIS_MODULE);
200
201
202 acq_keepalive();
203 return nonseekable_open(inode, file);
204}
205
206static int acq_close(struct inode *inode, struct file *file)
207{
208 if (expect_close == 42) {
209 acq_stop();
210 } else {
211 printk(KERN_CRIT PFX
212 "Unexpected close, not stopping watchdog!\n");
213 acq_keepalive();
214 }
215 clear_bit(0, &acq_is_open);
216 expect_close = 0;
217 return 0;
218}
219
220
221
222
223
224static const struct file_operations acq_fops = {
225 .owner = THIS_MODULE,
226 .llseek = no_llseek,
227 .write = acq_write,
228 .unlocked_ioctl = acq_ioctl,
229 .open = acq_open,
230 .release = acq_close,
231};
232
233static struct miscdevice acq_miscdev = {
234 .minor = WATCHDOG_MINOR,
235 .name = "watchdog",
236 .fops = &acq_fops,
237};
238
239
240
241
242
243static int __devinit acq_probe(struct platform_device *dev)
244{
245 int ret;
246
247 if (wdt_stop != wdt_start) {
248 if (!request_region(wdt_stop, 1, WATCHDOG_NAME)) {
249 printk(KERN_ERR PFX
250 "I/O address 0x%04x already in use\n", wdt_stop);
251 ret = -EIO;
252 goto out;
253 }
254 }
255
256 if (!request_region(wdt_start, 1, WATCHDOG_NAME)) {
257 printk(KERN_ERR PFX "I/O address 0x%04x already in use\n",
258 wdt_start);
259 ret = -EIO;
260 goto unreg_stop;
261 }
262 ret = misc_register(&acq_miscdev);
263 if (ret != 0) {
264 printk(KERN_ERR PFX
265 "cannot register miscdev on minor=%d (err=%d)\n",
266 WATCHDOG_MINOR, ret);
267 goto unreg_regions;
268 }
269 printk(KERN_INFO PFX "initialized. (nowayout=%d)\n", nowayout);
270
271 return 0;
272unreg_regions:
273 release_region(wdt_start, 1);
274unreg_stop:
275 if (wdt_stop != wdt_start)
276 release_region(wdt_stop, 1);
277out:
278 return ret;
279}
280
281static int __devexit acq_remove(struct platform_device *dev)
282{
283 misc_deregister(&acq_miscdev);
284 release_region(wdt_start, 1);
285 if (wdt_stop != wdt_start)
286 release_region(wdt_stop, 1);
287
288 return 0;
289}
290
291static void acq_shutdown(struct platform_device *dev)
292{
293
294 acq_stop();
295}
296
297static struct platform_driver acquirewdt_driver = {
298 .probe = acq_probe,
299 .remove = __devexit_p(acq_remove),
300 .shutdown = acq_shutdown,
301 .driver = {
302 .owner = THIS_MODULE,
303 .name = DRV_NAME,
304 },
305};
306
307static int __init acq_init(void)
308{
309 int err;
310
311 printk(KERN_INFO
312 "WDT driver for Acquire single board computer initialising.\n");
313
314 err = platform_driver_register(&acquirewdt_driver);
315 if (err)
316 return err;
317
318 acq_platform_device = platform_device_register_simple(DRV_NAME,
319 -1, NULL, 0);
320 if (IS_ERR(acq_platform_device)) {
321 err = PTR_ERR(acq_platform_device);
322 goto unreg_platform_driver;
323 }
324 return 0;
325
326unreg_platform_driver:
327 platform_driver_unregister(&acquirewdt_driver);
328 return err;
329}
330
331static void __exit acq_exit(void)
332{
333 platform_device_unregister(acq_platform_device);
334 platform_driver_unregister(&acquirewdt_driver);
335 printk(KERN_INFO PFX "Watchdog Module Unloaded.\n");
336}
337
338module_init(acq_init);
339module_exit(acq_exit);
340
341MODULE_AUTHOR("David Woodhouse");
342MODULE_DESCRIPTION("Acquire Inc. Single Board Computer Watchdog Timer driver");
343MODULE_LICENSE("GPL");
344MODULE_ALIAS_MISCDEV(WATCHDOG_MINOR);
345