include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit...
[linux-3.10.git] / drivers / isdn / mISDN / timerdev.c
1 /*
2  *
3  * general timer device for using in ISDN stacks
4  *
5  * Author       Karsten Keil <kkeil@novell.com>
6  *
7  * Copyright 2008  by Karsten Keil <kkeil@novell.com>
8  *
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License version 2 as
11  * published by the Free Software Foundation.
12  *
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  * GNU General Public License for more details.
17  *
18  */
19
20 #include <linux/poll.h>
21 #include <linux/vmalloc.h>
22 #include <linux/slab.h>
23 #include <linux/timer.h>
24 #include <linux/miscdevice.h>
25 #include <linux/module.h>
26 #include <linux/mISDNif.h>
27 #include "core.h"
28
29 static u_int    *debug;
30
31
32 struct mISDNtimerdev {
33         int                     next_id;
34         struct list_head        pending;
35         struct list_head        expired;
36         wait_queue_head_t       wait;
37         u_int                   work;
38         spinlock_t              lock; /* protect lists */
39 };
40
41 struct mISDNtimer {
42         struct list_head        list;
43         struct  mISDNtimerdev   *dev;
44         struct timer_list       tl;
45         int                     id;
46 };
47
48 static int
49 mISDN_open(struct inode *ino, struct file *filep)
50 {
51         struct mISDNtimerdev    *dev;
52
53         if (*debug & DEBUG_TIMER)
54                 printk(KERN_DEBUG "%s(%p,%p)\n", __func__, ino, filep);
55         dev = kmalloc(sizeof(struct mISDNtimerdev) , GFP_KERNEL);
56         if (!dev)
57                 return -ENOMEM;
58         dev->next_id = 1;
59         INIT_LIST_HEAD(&dev->pending);
60         INIT_LIST_HEAD(&dev->expired);
61         spin_lock_init(&dev->lock);
62         dev->work = 0;
63         init_waitqueue_head(&dev->wait);
64         filep->private_data = dev;
65         __module_get(THIS_MODULE);
66         return nonseekable_open(ino, filep);
67 }
68
69 static int
70 mISDN_close(struct inode *ino, struct file *filep)
71 {
72         struct mISDNtimerdev    *dev = filep->private_data;
73         struct mISDNtimer       *timer, *next;
74
75         if (*debug & DEBUG_TIMER)
76                 printk(KERN_DEBUG "%s(%p,%p)\n", __func__, ino, filep);
77         list_for_each_entry_safe(timer, next, &dev->pending, list) {
78                 del_timer(&timer->tl);
79                 kfree(timer);
80         }
81         list_for_each_entry_safe(timer, next, &dev->expired, list) {
82                 kfree(timer);
83         }
84         kfree(dev);
85         module_put(THIS_MODULE);
86         return 0;
87 }
88
89 static ssize_t
90 mISDN_read(struct file *filep, char __user *buf, size_t count, loff_t *off)
91 {
92         struct mISDNtimerdev    *dev = filep->private_data;
93         struct mISDNtimer       *timer;
94         u_long  flags;
95         int     ret = 0;
96
97         if (*debug & DEBUG_TIMER)
98                 printk(KERN_DEBUG "%s(%p, %p, %d, %p)\n", __func__,
99                         filep, buf, (int)count, off);
100         if (*off != filep->f_pos)
101                 return -ESPIPE;
102
103         if (list_empty(&dev->expired) && (dev->work == 0)) {
104                 if (filep->f_flags & O_NONBLOCK)
105                         return -EAGAIN;
106                 wait_event_interruptible(dev->wait, (dev->work ||
107                     !list_empty(&dev->expired)));
108                 if (signal_pending(current))
109                         return -ERESTARTSYS;
110         }
111         if (count < sizeof(int))
112                 return -ENOSPC;
113         if (dev->work)
114                 dev->work = 0;
115         if (!list_empty(&dev->expired)) {
116                 spin_lock_irqsave(&dev->lock, flags);
117                 timer = (struct mISDNtimer *)dev->expired.next;
118                 list_del(&timer->list);
119                 spin_unlock_irqrestore(&dev->lock, flags);
120                 if (put_user(timer->id, (int __user *)buf))
121                         ret = -EFAULT;
122                 else
123                         ret = sizeof(int);
124                 kfree(timer);
125         }
126         return ret;
127 }
128
129 static unsigned int
130 mISDN_poll(struct file *filep, poll_table *wait)
131 {
132         struct mISDNtimerdev    *dev = filep->private_data;
133         unsigned int            mask = POLLERR;
134
135         if (*debug & DEBUG_TIMER)
136                 printk(KERN_DEBUG "%s(%p, %p)\n", __func__, filep, wait);
137         if (dev) {
138                 poll_wait(filep, &dev->wait, wait);
139                 mask = 0;
140                 if (dev->work || !list_empty(&dev->expired))
141                         mask |= (POLLIN | POLLRDNORM);
142                 if (*debug & DEBUG_TIMER)
143                         printk(KERN_DEBUG "%s work(%d) empty(%d)\n", __func__,
144                                 dev->work, list_empty(&dev->expired));
145         }
146         return mask;
147 }
148
149 static void
150 dev_expire_timer(unsigned long data)
151 {
152         struct mISDNtimer *timer = (void *)data;
153         u_long                  flags;
154
155         spin_lock_irqsave(&timer->dev->lock, flags);
156         list_move_tail(&timer->list, &timer->dev->expired);
157         spin_unlock_irqrestore(&timer->dev->lock, flags);
158         wake_up_interruptible(&timer->dev->wait);
159 }
160
161 static int
162 misdn_add_timer(struct mISDNtimerdev *dev, int timeout)
163 {
164         int                     id;
165         u_long                  flags;
166         struct mISDNtimer       *timer;
167
168         if (!timeout) {
169                 dev->work = 1;
170                 wake_up_interruptible(&dev->wait);
171                 id = 0;
172         } else {
173                 timer = kzalloc(sizeof(struct mISDNtimer), GFP_KERNEL);
174                 if (!timer)
175                         return -ENOMEM;
176                 spin_lock_irqsave(&dev->lock, flags);
177                 timer->id = dev->next_id++;
178                 if (dev->next_id < 0)
179                         dev->next_id = 1;
180                 list_add_tail(&timer->list, &dev->pending);
181                 spin_unlock_irqrestore(&dev->lock, flags);
182                 timer->dev = dev;
183                 timer->tl.data = (long)timer;
184                 timer->tl.function = dev_expire_timer;
185                 init_timer(&timer->tl);
186                 timer->tl.expires = jiffies + ((HZ * (u_long)timeout) / 1000);
187                 add_timer(&timer->tl);
188                 id = timer->id;
189         }
190         return id;
191 }
192
193 static int
194 misdn_del_timer(struct mISDNtimerdev *dev, int id)
195 {
196         u_long                  flags;
197         struct mISDNtimer       *timer;
198         int                     ret = 0;
199
200         spin_lock_irqsave(&dev->lock, flags);
201         list_for_each_entry(timer, &dev->pending, list) {
202                 if (timer->id == id) {
203                         list_del_init(&timer->list);
204                         /* RED-PEN AK: race -- timer can be still running on
205                          * other CPU. Needs reference count I think
206                          */
207                         del_timer(&timer->tl);
208                         ret = timer->id;
209                         kfree(timer);
210                         goto unlock;
211                 }
212         }
213 unlock:
214         spin_unlock_irqrestore(&dev->lock, flags);
215         return ret;
216 }
217
218 static int
219 mISDN_ioctl(struct inode *inode, struct file *filep, unsigned int cmd,
220     unsigned long arg)
221 {
222         struct mISDNtimerdev    *dev = filep->private_data;
223         int                     id, tout, ret = 0;
224
225
226         if (*debug & DEBUG_TIMER)
227                 printk(KERN_DEBUG "%s(%p, %x, %lx)\n", __func__,
228                     filep, cmd, arg);
229         switch (cmd) {
230         case IMADDTIMER:
231                 if (get_user(tout, (int __user *)arg)) {
232                         ret = -EFAULT;
233                         break;
234                 }
235                 id = misdn_add_timer(dev, tout);
236                 if (*debug & DEBUG_TIMER)
237                         printk(KERN_DEBUG "%s add %d id %d\n", __func__,
238                             tout, id);
239                 if (id < 0) {
240                         ret = id;
241                         break;
242                 }
243                 if (put_user(id, (int __user *)arg))
244                         ret = -EFAULT;
245                 break;
246         case IMDELTIMER:
247                 if (get_user(id, (int __user *)arg)) {
248                         ret = -EFAULT;
249                         break;
250                 }
251                 if (*debug & DEBUG_TIMER)
252                         printk(KERN_DEBUG "%s del id %d\n", __func__, id);
253                 id = misdn_del_timer(dev, id);
254                 if (put_user(id, (int __user *)arg))
255                         ret = -EFAULT;
256                 break;
257         default:
258                 ret = -EINVAL;
259         }
260         return ret;
261 }
262
263 static const struct file_operations mISDN_fops = {
264         .read           = mISDN_read,
265         .poll           = mISDN_poll,
266         .ioctl          = mISDN_ioctl,
267         .open           = mISDN_open,
268         .release        = mISDN_close,
269 };
270
271 static struct miscdevice mISDNtimer = {
272         .minor  = MISC_DYNAMIC_MINOR,
273         .name   = "mISDNtimer",
274         .fops   = &mISDN_fops,
275 };
276
277 int
278 mISDN_inittimer(u_int *deb)
279 {
280         int     err;
281
282         debug = deb;
283         err = misc_register(&mISDNtimer);
284         if (err)
285                 printk(KERN_WARNING "mISDN: Could not register timer device\n");
286         return err;
287 }
288
289 void mISDN_timer_cleanup(void)
290 {
291         misc_deregister(&mISDNtimer);
292 }