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#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
30
31#include <linux/module.h>
32#include <linux/types.h>
33#include <linux/errno.h>
34#include <linux/kernel.h>
35#include <linux/watchdog.h>
36#include <linux/init.h>
37#include <linux/idr.h>
38#include <linux/err.h>
39#include <linux/of.h>
40
41#include "watchdog_core.h"
42
43static DEFINE_IDA(watchdog_ida);
44static struct class *watchdog_class;
45
46static void watchdog_check_min_max_timeout(struct watchdog_device *wdd)
47{
48
49
50
51
52 if (wdd->min_timeout > wdd->max_timeout) {
53 pr_info("Invalid min and max timeout values, resetting to 0!\n");
54 wdd->min_timeout = 0;
55 wdd->max_timeout = 0;
56 }
57}
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72int watchdog_init_timeout(struct watchdog_device *wdd,
73 unsigned int timeout_parm, struct device *dev)
74{
75 unsigned int t = 0;
76 int ret = 0;
77
78 watchdog_check_min_max_timeout(wdd);
79
80
81 if (!watchdog_timeout_invalid(wdd, timeout_parm) && timeout_parm) {
82 wdd->timeout = timeout_parm;
83 return ret;
84 }
85 if (timeout_parm)
86 ret = -EINVAL;
87
88
89 if (dev == NULL || dev->of_node == NULL)
90 return ret;
91 of_property_read_u32(dev->of_node, "timeout-sec", &t);
92 if (!watchdog_timeout_invalid(wdd, t) && t)
93 wdd->timeout = t;
94 else
95 ret = -EINVAL;
96
97 return ret;
98}
99EXPORT_SYMBOL_GPL(watchdog_init_timeout);
100
101
102
103
104
105
106
107
108
109
110
111int watchdog_register_device(struct watchdog_device *wdd)
112{
113 int ret, id, devno;
114
115 if (wdd == NULL || wdd->info == NULL || wdd->ops == NULL)
116 return -EINVAL;
117
118
119 if (wdd->ops->start == NULL || wdd->ops->stop == NULL)
120 return -EINVAL;
121
122 watchdog_check_min_max_timeout(wdd);
123
124
125
126
127
128
129
130 mutex_init(&wdd->lock);
131 id = ida_simple_get(&watchdog_ida, 0, MAX_DOGS, GFP_KERNEL);
132 if (id < 0)
133 return id;
134 wdd->id = id;
135
136 ret = watchdog_dev_register(wdd);
137 if (ret) {
138 ida_simple_remove(&watchdog_ida, id);
139 if (!(id == 0 && ret == -EBUSY))
140 return ret;
141
142
143 id = ida_simple_get(&watchdog_ida, 1, MAX_DOGS, GFP_KERNEL);
144 if (id < 0)
145 return id;
146 wdd->id = id;
147
148 ret = watchdog_dev_register(wdd);
149 if (ret) {
150 ida_simple_remove(&watchdog_ida, id);
151 return ret;
152 }
153 }
154
155 devno = wdd->cdev.dev;
156 wdd->dev = device_create(watchdog_class, wdd->parent, devno,
157 NULL, "watchdog%d", wdd->id);
158 if (IS_ERR(wdd->dev)) {
159 watchdog_dev_unregister(wdd);
160 ida_simple_remove(&watchdog_ida, id);
161 ret = PTR_ERR(wdd->dev);
162 return ret;
163 }
164
165 return 0;
166}
167EXPORT_SYMBOL_GPL(watchdog_register_device);
168
169
170
171
172
173
174
175
176void watchdog_unregister_device(struct watchdog_device *wdd)
177{
178 int ret;
179 int devno;
180
181 if (wdd == NULL)
182 return;
183
184 devno = wdd->cdev.dev;
185 ret = watchdog_dev_unregister(wdd);
186 if (ret)
187 pr_err("error unregistering /dev/watchdog (err=%d)\n", ret);
188 device_destroy(watchdog_class, devno);
189 ida_simple_remove(&watchdog_ida, wdd->id);
190 wdd->dev = NULL;
191}
192EXPORT_SYMBOL_GPL(watchdog_unregister_device);
193
194static int __init watchdog_init(void)
195{
196 int err;
197
198 watchdog_class = class_create(THIS_MODULE, "watchdog");
199 if (IS_ERR(watchdog_class)) {
200 pr_err("couldn't create class\n");
201 return PTR_ERR(watchdog_class);
202 }
203
204 err = watchdog_dev_init();
205 if (err < 0) {
206 class_destroy(watchdog_class);
207 return err;
208 }
209
210 return 0;
211}
212
213static void __exit watchdog_exit(void)
214{
215 watchdog_dev_exit();
216 class_destroy(watchdog_class);
217 ida_destroy(&watchdog_ida);
218}
219
220subsys_initcall(watchdog_init);
221module_exit(watchdog_exit);
222
223MODULE_AUTHOR("Alan Cox <alan@lxorguk.ukuu.org.uk>");
224MODULE_AUTHOR("Wim Van Sebroeck <wim@iguana.be>");
225MODULE_DESCRIPTION("WatchDog Timer Driver Core");
226MODULE_LICENSE("GPL");
227