OSDN Git Service

netfilter: IDLETIMER: be syzkaller friendly
[sagit-ice-cold/kernel_xiaomi_msm8998.git] / net / netfilter / xt_IDLETIMER.c
1 /*
2  * linux/net/netfilter/xt_IDLETIMER.c
3  *
4  * Netfilter module to trigger a timer when packet matches.
5  * After timer expires a kevent will be sent.
6  *
7  * Copyright (C) 2004, 2010 Nokia Corporation
8  * Written by Timo Teras <ext-timo.teras@nokia.com>
9  *
10  * Converted to x_tables and reworked for upstream inclusion
11  * by Luciano Coelho <luciano.coelho@nokia.com>
12  *
13  * Contact: Luciano Coelho <luciano.coelho@nokia.com>
14  *
15  * This program is free software; you can redistribute it and/or
16  * modify it under the terms of the GNU General Public License
17  * version 2 as published by the Free Software Foundation.
18  *
19  * This program is distributed in the hope that it will be useful, but
20  * WITHOUT ANY WARRANTY; without even the implied warranty of
21  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
22  * General Public License for more details.
23  *
24  * You should have received a copy of the GNU General Public License
25  * along with this program; if not, write to the Free Software
26  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
27  * 02110-1301 USA
28  */
29
30 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
31
32 #include <linux/module.h>
33 #include <linux/timer.h>
34 #include <linux/list.h>
35 #include <linux/mutex.h>
36 #include <linux/netfilter.h>
37 #include <linux/netfilter/x_tables.h>
38 #include <linux/netfilter/xt_IDLETIMER.h>
39 #include <linux/kdev_t.h>
40 #include <linux/kobject.h>
41 #include <linux/workqueue.h>
42 #include <linux/sysfs.h>
43
44 struct idletimer_tg_attr {
45         struct attribute attr;
46         ssize_t (*show)(struct kobject *kobj,
47                         struct attribute *attr, char *buf);
48 };
49
50 struct idletimer_tg {
51         struct list_head entry;
52         struct timer_list timer;
53         struct work_struct work;
54
55         struct kobject *kobj;
56         struct idletimer_tg_attr attr;
57
58         unsigned int refcnt;
59 };
60
61 static LIST_HEAD(idletimer_tg_list);
62 static DEFINE_MUTEX(list_mutex);
63
64 static struct kobject *idletimer_tg_kobj;
65
66 static
67 struct idletimer_tg *__idletimer_tg_find_by_label(const char *label)
68 {
69         struct idletimer_tg *entry;
70
71         BUG_ON(!label);
72
73         list_for_each_entry(entry, &idletimer_tg_list, entry) {
74                 if (!strcmp(label, entry->attr.attr.name))
75                         return entry;
76         }
77
78         return NULL;
79 }
80
81 static ssize_t idletimer_tg_show(struct kobject *kobj, struct attribute *attr,
82                                  char *buf)
83 {
84         struct idletimer_tg *timer;
85         unsigned long expires = 0;
86
87         mutex_lock(&list_mutex);
88
89         timer = __idletimer_tg_find_by_label(attr->name);
90         if (timer)
91                 expires = timer->timer.expires;
92
93         mutex_unlock(&list_mutex);
94
95         if (time_after(expires, jiffies))
96                 return sprintf(buf, "%u\n",
97                                jiffies_to_msecs(expires - jiffies) / 1000);
98
99         return sprintf(buf, "0\n");
100 }
101
102 static void idletimer_tg_work(struct work_struct *work)
103 {
104         struct idletimer_tg *timer = container_of(work, struct idletimer_tg,
105                                                   work);
106
107         sysfs_notify(idletimer_tg_kobj, NULL, timer->attr.attr.name);
108 }
109
110 static void idletimer_tg_expired(unsigned long data)
111 {
112         struct idletimer_tg *timer = (struct idletimer_tg *) data;
113
114         pr_debug("timer %s expired\n", timer->attr.attr.name);
115
116         schedule_work(&timer->work);
117 }
118
119 static int idletimer_tg_create(struct idletimer_tg_info *info)
120 {
121         int ret;
122
123         info->timer = kmalloc(sizeof(*info->timer), GFP_KERNEL);
124         if (!info->timer) {
125                 ret = -ENOMEM;
126                 goto out;
127         }
128
129         sysfs_attr_init(&info->timer->attr.attr);
130         info->timer->attr.attr.name = kstrdup(info->label, GFP_KERNEL);
131         if (!info->timer->attr.attr.name) {
132                 ret = -ENOMEM;
133                 goto out_free_timer;
134         }
135         info->timer->attr.attr.mode = S_IRUGO;
136         info->timer->attr.show = idletimer_tg_show;
137
138         ret = sysfs_create_file(idletimer_tg_kobj, &info->timer->attr.attr);
139         if (ret < 0) {
140                 pr_debug("couldn't add file to sysfs");
141                 goto out_free_attr;
142         }
143
144         list_add(&info->timer->entry, &idletimer_tg_list);
145
146         setup_timer(&info->timer->timer, idletimer_tg_expired,
147                     (unsigned long) info->timer);
148         info->timer->refcnt = 1;
149
150         INIT_WORK(&info->timer->work, idletimer_tg_work);
151
152         mod_timer(&info->timer->timer,
153                   msecs_to_jiffies(info->timeout * 1000) + jiffies);
154
155         return 0;
156
157 out_free_attr:
158         kfree(info->timer->attr.attr.name);
159 out_free_timer:
160         kfree(info->timer);
161 out:
162         return ret;
163 }
164
165 /*
166  * The actual xt_tables plugin.
167  */
168 static unsigned int idletimer_tg_target(struct sk_buff *skb,
169                                          const struct xt_action_param *par)
170 {
171         const struct idletimer_tg_info *info = par->targinfo;
172
173         pr_debug("resetting timer %s, timeout period %u\n",
174                  info->label, info->timeout);
175
176         BUG_ON(!info->timer);
177
178         mod_timer(&info->timer->timer,
179                   msecs_to_jiffies(info->timeout * 1000) + jiffies);
180
181         return XT_CONTINUE;
182 }
183
184 static int idletimer_tg_checkentry(const struct xt_tgchk_param *par)
185 {
186         struct idletimer_tg_info *info = par->targinfo;
187         int ret;
188
189         pr_debug("checkentry targinfo%s\n", info->label);
190
191         if (info->timeout == 0) {
192                 pr_debug("timeout value is zero\n");
193                 return -EINVAL;
194         }
195         if (info->timeout >= INT_MAX / 1000) {
196                 pr_debug("timeout value is too big\n");
197                 return -EINVAL;
198         }
199         if (info->label[0] == '\0' ||
200             strnlen(info->label,
201                     MAX_IDLETIMER_LABEL_SIZE) == MAX_IDLETIMER_LABEL_SIZE) {
202                 pr_debug("label is empty or not nul-terminated\n");
203                 return -EINVAL;
204         }
205
206         mutex_lock(&list_mutex);
207
208         info->timer = __idletimer_tg_find_by_label(info->label);
209         if (info->timer) {
210                 info->timer->refcnt++;
211                 mod_timer(&info->timer->timer,
212                           msecs_to_jiffies(info->timeout * 1000) + jiffies);
213
214                 pr_debug("increased refcnt of timer %s to %u\n",
215                          info->label, info->timer->refcnt);
216         } else {
217                 ret = idletimer_tg_create(info);
218                 if (ret < 0) {
219                         pr_debug("failed to create timer\n");
220                         mutex_unlock(&list_mutex);
221                         return ret;
222                 }
223         }
224
225         mutex_unlock(&list_mutex);
226         return 0;
227 }
228
229 static void idletimer_tg_destroy(const struct xt_tgdtor_param *par)
230 {
231         const struct idletimer_tg_info *info = par->targinfo;
232
233         pr_debug("destroy targinfo %s\n", info->label);
234
235         mutex_lock(&list_mutex);
236
237         if (--info->timer->refcnt == 0) {
238                 pr_debug("deleting timer %s\n", info->label);
239
240                 list_del(&info->timer->entry);
241                 del_timer_sync(&info->timer->timer);
242                 sysfs_remove_file(idletimer_tg_kobj, &info->timer->attr.attr);
243                 kfree(info->timer->attr.attr.name);
244                 kfree(info->timer);
245         } else {
246                 pr_debug("decreased refcnt of timer %s to %u\n",
247                          info->label, info->timer->refcnt);
248         }
249
250         mutex_unlock(&list_mutex);
251 }
252
253 static struct xt_target idletimer_tg __read_mostly = {
254         .name           = "IDLETIMER",
255         .family         = NFPROTO_UNSPEC,
256         .target         = idletimer_tg_target,
257         .targetsize     = sizeof(struct idletimer_tg_info),
258         .checkentry     = idletimer_tg_checkentry,
259         .destroy        = idletimer_tg_destroy,
260         .me             = THIS_MODULE,
261 };
262
263 static struct class *idletimer_tg_class;
264
265 static struct device *idletimer_tg_device;
266
267 static int __init idletimer_tg_init(void)
268 {
269         int err;
270
271         idletimer_tg_class = class_create(THIS_MODULE, "xt_idletimer");
272         err = PTR_ERR(idletimer_tg_class);
273         if (IS_ERR(idletimer_tg_class)) {
274                 pr_debug("couldn't register device class\n");
275                 goto out;
276         }
277
278         idletimer_tg_device = device_create(idletimer_tg_class, NULL,
279                                             MKDEV(0, 0), NULL, "timers");
280         err = PTR_ERR(idletimer_tg_device);
281         if (IS_ERR(idletimer_tg_device)) {
282                 pr_debug("couldn't register system device\n");
283                 goto out_class;
284         }
285
286         idletimer_tg_kobj = &idletimer_tg_device->kobj;
287
288         err =  xt_register_target(&idletimer_tg);
289         if (err < 0) {
290                 pr_debug("couldn't register xt target\n");
291                 goto out_dev;
292         }
293
294         return 0;
295 out_dev:
296         device_destroy(idletimer_tg_class, MKDEV(0, 0));
297 out_class:
298         class_destroy(idletimer_tg_class);
299 out:
300         return err;
301 }
302
303 static void __exit idletimer_tg_exit(void)
304 {
305         xt_unregister_target(&idletimer_tg);
306
307         device_destroy(idletimer_tg_class, MKDEV(0, 0));
308         class_destroy(idletimer_tg_class);
309 }
310
311 module_init(idletimer_tg_init);
312 module_exit(idletimer_tg_exit);
313
314 MODULE_AUTHOR("Timo Teras <ext-timo.teras@nokia.com>");
315 MODULE_AUTHOR("Luciano Coelho <luciano.coelho@nokia.com>");
316 MODULE_DESCRIPTION("Xtables: idle time monitor");
317 MODULE_LICENSE("GPL v2");
318 MODULE_ALIAS("ipt_IDLETIMER");
319 MODULE_ALIAS("ip6t_IDLETIMER");