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