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