Commit | Line | Data |
---|---|---|
3a5f9000 DT |
1 | /* |
2 | * Watchdog driver for SBC-FITPC2 board | |
3 | * | |
4 | * Author: Denis Turischev <denis@compulab.co.il> | |
5 | * | |
6 | * Adapted from the IXP2000 watchdog driver by Deepak Saxena. | |
7 | * | |
8 | * This file is licensed under the terms of the GNU General Public | |
9 | * License version 2. This program is licensed "as is" without any | |
10 | * warranty of any kind, whether express or implied. | |
11 | */ | |
12 | ||
13 | #define pr_fmt(fmt) KBUILD_MODNAME " WATCHDOG: " fmt | |
14 | ||
15 | #include <linux/module.h> | |
16 | #include <linux/types.h> | |
17 | #include <linux/miscdevice.h> | |
18 | #include <linux/watchdog.h> | |
19 | #include <linux/ioport.h> | |
20 | #include <linux/delay.h> | |
21 | #include <linux/fs.h> | |
22 | #include <linux/init.h> | |
23 | #include <linux/moduleparam.h> | |
24 | #include <linux/dmi.h> | |
25 | #include <linux/io.h> | |
26 | #include <linux/uaccess.h> | |
27 | ||
28 | #include <asm/system.h> | |
29 | ||
86a1e189 | 30 | static bool nowayout = WATCHDOG_NOWAYOUT; |
3a5f9000 DT |
31 | static unsigned int margin = 60; /* (secs) Default is 1 minute */ |
32 | static unsigned long wdt_status; | |
322af98c | 33 | static DEFINE_MUTEX(wdt_lock); |
3a5f9000 DT |
34 | |
35 | #define WDT_IN_USE 0 | |
36 | #define WDT_OK_TO_CLOSE 1 | |
37 | ||
38 | #define COMMAND_PORT 0x4c | |
39 | #define DATA_PORT 0x48 | |
40 | ||
41 | #define IFACE_ON_COMMAND 1 | |
42 | #define REBOOT_COMMAND 2 | |
43 | ||
5f3b2756 | 44 | #define WATCHDOG_NAME "SBC-FITPC2 Watchdog" |
3a5f9000 DT |
45 | |
46 | static void wdt_send_data(unsigned char command, unsigned char data) | |
47 | { | |
3a5f9000 | 48 | outb(data, DATA_PORT); |
ef39a1bf | 49 | msleep(200); |
fcf1dd7e DT |
50 | outb(command, COMMAND_PORT); |
51 | msleep(100); | |
3a5f9000 DT |
52 | } |
53 | ||
54 | static void wdt_enable(void) | |
55 | { | |
322af98c | 56 | mutex_lock(&wdt_lock); |
3a5f9000 DT |
57 | wdt_send_data(IFACE_ON_COMMAND, 1); |
58 | wdt_send_data(REBOOT_COMMAND, margin); | |
322af98c | 59 | mutex_unlock(&wdt_lock); |
3a5f9000 DT |
60 | } |
61 | ||
62 | static void wdt_disable(void) | |
63 | { | |
322af98c | 64 | mutex_lock(&wdt_lock); |
3a5f9000 DT |
65 | wdt_send_data(IFACE_ON_COMMAND, 0); |
66 | wdt_send_data(REBOOT_COMMAND, 0); | |
322af98c | 67 | mutex_unlock(&wdt_lock); |
3a5f9000 DT |
68 | } |
69 | ||
70 | static int fitpc2_wdt_open(struct inode *inode, struct file *file) | |
71 | { | |
72 | if (test_and_set_bit(WDT_IN_USE, &wdt_status)) | |
73 | return -EBUSY; | |
74 | ||
75 | clear_bit(WDT_OK_TO_CLOSE, &wdt_status); | |
76 | ||
77 | wdt_enable(); | |
78 | ||
79 | return nonseekable_open(inode, file); | |
80 | } | |
81 | ||
82 | static ssize_t fitpc2_wdt_write(struct file *file, const char *data, | |
83 | size_t len, loff_t *ppos) | |
84 | { | |
85 | size_t i; | |
86 | ||
87 | if (!len) | |
88 | return 0; | |
89 | ||
90 | if (nowayout) { | |
91 | len = 0; | |
92 | goto out; | |
93 | } | |
94 | ||
95 | clear_bit(WDT_OK_TO_CLOSE, &wdt_status); | |
96 | ||
97 | for (i = 0; i != len; i++) { | |
98 | char c; | |
99 | ||
100 | if (get_user(c, data + i)) | |
101 | return -EFAULT; | |
102 | ||
103 | if (c == 'V') | |
104 | set_bit(WDT_OK_TO_CLOSE, &wdt_status); | |
105 | } | |
106 | ||
107 | out: | |
108 | wdt_enable(); | |
109 | ||
110 | return len; | |
111 | } | |
112 | ||
113 | ||
42747d71 | 114 | static const struct watchdog_info ident = { |
3a5f9000 DT |
115 | .options = WDIOF_MAGICCLOSE | WDIOF_SETTIMEOUT | |
116 | WDIOF_KEEPALIVEPING, | |
117 | .identity = WATCHDOG_NAME, | |
118 | }; | |
119 | ||
120 | ||
121 | static long fitpc2_wdt_ioctl(struct file *file, unsigned int cmd, | |
122 | unsigned long arg) | |
123 | { | |
124 | int ret = -ENOTTY; | |
125 | int time; | |
126 | ||
127 | switch (cmd) { | |
128 | case WDIOC_GETSUPPORT: | |
129 | ret = copy_to_user((struct watchdog_info *)arg, &ident, | |
130 | sizeof(ident)) ? -EFAULT : 0; | |
131 | break; | |
132 | ||
133 | case WDIOC_GETSTATUS: | |
134 | ret = put_user(0, (int *)arg); | |
135 | break; | |
136 | ||
137 | case WDIOC_GETBOOTSTATUS: | |
138 | ret = put_user(0, (int *)arg); | |
139 | break; | |
140 | ||
141 | case WDIOC_KEEPALIVE: | |
142 | wdt_enable(); | |
143 | ret = 0; | |
144 | break; | |
145 | ||
146 | case WDIOC_SETTIMEOUT: | |
147 | ret = get_user(time, (int *)arg); | |
148 | if (ret) | |
149 | break; | |
150 | ||
151 | if (time < 31 || time > 255) { | |
152 | ret = -EINVAL; | |
153 | break; | |
154 | } | |
155 | ||
156 | margin = time; | |
157 | wdt_enable(); | |
158 | /* Fall through */ | |
159 | ||
160 | case WDIOC_GETTIMEOUT: | |
161 | ret = put_user(margin, (int *)arg); | |
162 | break; | |
163 | } | |
164 | ||
165 | return ret; | |
166 | } | |
167 | ||
168 | static int fitpc2_wdt_release(struct inode *inode, struct file *file) | |
169 | { | |
170 | if (test_bit(WDT_OK_TO_CLOSE, &wdt_status)) { | |
171 | wdt_disable(); | |
172 | pr_info("Device disabled\n"); | |
173 | } else { | |
27c766aa | 174 | pr_warn("Device closed unexpectedly - timer will not stop\n"); |
3a5f9000 DT |
175 | wdt_enable(); |
176 | } | |
177 | ||
178 | clear_bit(WDT_IN_USE, &wdt_status); | |
179 | clear_bit(WDT_OK_TO_CLOSE, &wdt_status); | |
180 | ||
181 | return 0; | |
182 | } | |
183 | ||
184 | ||
185 | static const struct file_operations fitpc2_wdt_fops = { | |
186 | .owner = THIS_MODULE, | |
187 | .llseek = no_llseek, | |
188 | .write = fitpc2_wdt_write, | |
189 | .unlocked_ioctl = fitpc2_wdt_ioctl, | |
190 | .open = fitpc2_wdt_open, | |
191 | .release = fitpc2_wdt_release, | |
192 | }; | |
193 | ||
194 | static struct miscdevice fitpc2_wdt_miscdev = { | |
195 | .minor = WATCHDOG_MINOR, | |
196 | .name = "watchdog", | |
197 | .fops = &fitpc2_wdt_fops, | |
198 | }; | |
199 | ||
200 | static int __init fitpc2_wdt_init(void) | |
201 | { | |
202 | int err; | |
d4065775 | 203 | const char *brd_name; |
3a5f9000 | 204 | |
d4065775 JS |
205 | brd_name = dmi_get_system_info(DMI_BOARD_NAME); |
206 | ||
207 | if (!brd_name || !strstr(brd_name, "SBC-FITPC2")) | |
3a5f9000 | 208 | return -ENODEV; |
ef39a1bf | 209 | |
d4065775 | 210 | pr_info("%s found\n", brd_name); |
3a5f9000 DT |
211 | |
212 | if (!request_region(COMMAND_PORT, 1, WATCHDOG_NAME)) { | |
213 | pr_err("I/O address 0x%04x already in use\n", COMMAND_PORT); | |
214 | return -EIO; | |
215 | } | |
216 | ||
217 | if (!request_region(DATA_PORT, 1, WATCHDOG_NAME)) { | |
218 | pr_err("I/O address 0x%04x already in use\n", DATA_PORT); | |
219 | err = -EIO; | |
220 | goto err_data_port; | |
221 | } | |
222 | ||
223 | if (margin < 31 || margin > 255) { | |
27c766aa JP |
224 | pr_err("margin must be in range 31 - 255 seconds, you tried to set %d\n", |
225 | margin); | |
3a5f9000 DT |
226 | err = -EINVAL; |
227 | goto err_margin; | |
228 | } | |
229 | ||
230 | err = misc_register(&fitpc2_wdt_miscdev); | |
1efd374d | 231 | if (err) { |
3a5f9000 | 232 | pr_err("cannot register miscdev on minor=%d (err=%d)\n", |
27c766aa | 233 | WATCHDOG_MINOR, err); |
3a5f9000 DT |
234 | goto err_margin; |
235 | } | |
236 | ||
237 | return 0; | |
238 | ||
239 | err_margin: | |
240 | release_region(DATA_PORT, 1); | |
241 | err_data_port: | |
242 | release_region(COMMAND_PORT, 1); | |
243 | ||
244 | return err; | |
245 | } | |
246 | ||
247 | static void __exit fitpc2_wdt_exit(void) | |
248 | { | |
249 | misc_deregister(&fitpc2_wdt_miscdev); | |
250 | release_region(DATA_PORT, 1); | |
251 | release_region(COMMAND_PORT, 1); | |
252 | } | |
253 | ||
254 | module_init(fitpc2_wdt_init); | |
255 | module_exit(fitpc2_wdt_exit); | |
256 | ||
257 | MODULE_AUTHOR("Denis Turischev <denis@compulab.co.il>"); | |
258 | MODULE_DESCRIPTION("SBC-FITPC2 Watchdog"); | |
259 | ||
260 | module_param(margin, int, 0); | |
261 | MODULE_PARM_DESC(margin, "Watchdog margin in seconds (default 60s)"); | |
262 | ||
86a1e189 | 263 | module_param(nowayout, bool, 0); |
3a5f9000 DT |
264 | MODULE_PARM_DESC(nowayout, "Watchdog cannot be stopped once started"); |
265 | ||
266 | MODULE_LICENSE("GPL"); | |
267 | MODULE_ALIAS_MISCDEV(WATCHDOG_MINOR); | |
268 |