SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/isdn/hardware/eicon/divamnt.c

   1 /* $Id: divamnt.c,v 1.32.6.10 2005/02/11 19:40:25 armin Exp $
   2  *
   3  * Driver for Eicon DIVA Server ISDN cards.
   4  * Maint module
   5  *
   6  * Copyright 2000-2003 by Armin Schindler (mac@melware.de)
   7  * Copyright 2000-2003 Cytronics & Melware (info@melware.de)
   8  *
   9  * This software may be used and distributed according to the terms
  10  * of the GNU General Public License, incorporated herein by reference.
  11  */
  12
  13 #include <linux/config.h>
  14 #include <linux/module.h>
  15 #include <linux/init.h>
  16 #include <linux/kernel.h>
  17 #include <linux/sched.h>
  18 #include <linux/smp_lock.h>
  19 #include <linux/poll.h>
  20 #include <linux/devfs_fs_kernel.h>
  21 #include <asm/uaccess.h>
  22
  23 #include "platform.h"
  24 #include "di_defs.h"
  25 #include "divasync.h"
  26 #include "debug_if.h"
  27
  28 static char *main_revision = "$Revision: 1.32.6.10 $";
  29
  30 static int major;
  31
  32 MODULE_DESCRIPTION("Maint driver for Eicon DIVA Server cards");
  33 MODULE_AUTHOR("Cytronics & Melware, Eicon Networks");
  34 MODULE_SUPPORTED_DEVICE("DIVA card driver");
  35 MODULE_LICENSE("GPL");
  36
  37 static int buffer_length = 128;
  38 module_param(buffer_length, int, 0);
  39 static unsigned long diva_dbg_mem = 0;
  40 module_param(diva_dbg_mem, ulong, 0);
  41
  42 static char *DRIVERNAME =
  43     "Eicon DIVA - MAINT module (http://www.melware.net)";
  44 static char *DRIVERLNAME = "diva_mnt";
  45 static char *DEVNAME = "DivasMAINT";
  46 char *DRIVERRELEASE_MNT = "2.0";
  47
  48 static wait_queue_head_t msgwaitq;
  49 static unsigned long opened;
  50 static struct timeval start_time;
  51
  52 extern int mntfunc_init(int *, void **, unsigned long);
  53 extern void mntfunc_finit(void);
  54 extern int maint_read_write(void __user *buf, int count);
  55
  56 /*
  57  *  helper functions
  58  */
  59 static char *getrev(const char *revision)
  60 {
  61         char *rev;
  62         char *p;
  63
  64         if ((p = strchr(revision, ':'))) {
  65                 rev = p + 2;
  66                 p = strchr(rev, '$');
  67                 *--p = 0;
  68         } else
  69                 rev = "1.0";
  70
  71         return rev;
  72 }
  73
  74 /*
  75  * kernel/user space copy functions
  76  */
  77 int diva_os_copy_to_user(void *os_handle, void __user *dst, const void *src,
  78                          int length)
  79 {
  80         return (copy_to_user(dst, src, length));
  81 }
  82 int diva_os_copy_from_user(void *os_handle, void *dst, const void __user *src,
  83                            int length)
  84 {
  85         return (copy_from_user(dst, src, length));
  86 }
  87
  88 /*
  89  * get time
  90  */
  91 void diva_os_get_time(dword * sec, dword * usec)
  92 {
  93         struct timeval tv;
  94
  95         do_gettimeofday(&tv);
  96
  97         if (tv.tv_sec > start_time.tv_sec) {
  98                 if (start_time.tv_usec > tv.tv_usec) {
  99                         tv.tv_sec--;
 100                         tv.tv_usec += 1000000;
 101                 }
 102                 *sec = (dword) (tv.tv_sec - start_time.tv_sec);
 103                 *usec = (dword) (tv.tv_usec - start_time.tv_usec);
 104         } else if (tv.tv_sec == start_time.tv_sec) {
 105                 *sec = 0;
 106                 if (start_time.tv_usec < tv.tv_usec) {
 107                         *usec = (dword) (tv.tv_usec - start_time.tv_usec);
 108                 } else {
 109                         *usec = 0;
 110                 }
 111         } else {
 112                 *sec = (dword) tv.tv_sec;
 113                 *usec = (dword) tv.tv_usec;
 114         }
 115 }
 116
 117 /*
 118  * device node operations
 119  */
 120 static unsigned int maint_poll(struct file *file, poll_table * wait)
 121 {
 122         unsigned int mask = 0;
 123
 124         poll_wait(file, &msgwaitq, wait);
 125         mask = POLLOUT | POLLWRNORM;
 126         if (file->private_data || diva_dbg_q_length()) {
 127                 mask |= POLLIN | POLLRDNORM;
 128         }
 129         return (mask);
 130 }
 131
 132 static int maint_open(struct inode *ino, struct file *filep)
 133 {
 134         /* only one open is allowed, so we test
 135            it atomically */
 136         if (test_and_set_bit(0, &opened))
 137                 return (-EBUSY);
 138
 139         filep->private_data = NULL;
 140
 141         return nonseekable_open(ino, filep);
 142 }
 143
 144 static int maint_close(struct inode *ino, struct file *filep)
 145 {
 146         if (filep->private_data) {
 147                 diva_os_free(0, filep->private_data);
 148                 filep->private_data = NULL;
 149         }
 150
 151         /* clear 'used' flag */
 152         clear_bit(0, &opened);
 153
 154         return (0);
 155 }
 156
 157 static ssize_t divas_maint_write(struct file *file, const char __user *buf,
 158                                  size_t count, loff_t * ppos)
 159 {
 160         return (maint_read_write((char __user *) buf, (int) count));
 161 }
 162
 163 static ssize_t divas_maint_read(struct file *file, char __user *buf,
 164                                 size_t count, loff_t * ppos)
 165 {
 166         return (maint_read_write(buf, (int) count));
 167 }
 168
 169 static struct file_operations divas_maint_fops = {
 170         .owner   = THIS_MODULE,
 171         .llseek  = no_llseek,
 172         .read    = divas_maint_read,
 173         .write   = divas_maint_write,
 174         .poll    = maint_poll,
 175         .open    = maint_open,
 176         .release = maint_close
 177 };
 178
 179 static void divas_maint_unregister_chrdev(void)
 180 {
 181         unregister_chrdev(major, DEVNAME);
 182 }
 183
 184 static int DIVA_INIT_FUNCTION divas_maint_register_chrdev(void)
 185 {
 186         if ((major = register_chrdev(0, DEVNAME, &divas_maint_fops)) < 0)
 187         {
 188                 printk(KERN_ERR "%s: failed to create /dev entry.\n",
 189                        DRIVERLNAME);
 190                 return (0);
 191         }
 192
 193         return (1);
 194 }
 195
 196 /*
 197  * wake up reader
 198  */
 199 void diva_maint_wakeup_read(void)
 200 {
 201         wake_up_interruptible(&msgwaitq);
 202 }
 203
 204 /*
 205  *  Driver Load
 206  */
 207 static int DIVA_INIT_FUNCTION maint_init(void)
 208 {
 209         char tmprev[50];
 210         int ret = 0;
 211         void *buffer = NULL;
 212
 213         do_gettimeofday(&start_time);
 214         init_waitqueue_head(&msgwaitq);
 215
 216         printk(KERN_INFO "%s\n", DRIVERNAME);
 217         printk(KERN_INFO "%s: Rel:%s  Rev:", DRIVERLNAME, DRIVERRELEASE_MNT);
 218         strcpy(tmprev, main_revision);
 219         printk("%s  Build: %s \n", getrev(tmprev), DIVA_BUILD);
 220
 221         if (!divas_maint_register_chrdev()) {
 222                 ret = -EIO;
 223                 goto out;
 224         }
 225
 226         if (!(mntfunc_init(&buffer_length, &buffer, diva_dbg_mem))) {
 227                 printk(KERN_ERR "%s: failed to connect to DIDD.\n",
 228                        DRIVERLNAME);
 229                 divas_maint_unregister_chrdev();
 230                 ret = -EIO;
 231                 goto out;
 232         }
 233
 234         printk(KERN_INFO "%s: trace buffer = %p - %d kBytes, %s (Major: %d)\n",
 235                DRIVERLNAME, buffer, (buffer_length / 1024),
 236                (diva_dbg_mem == 0) ? "internal" : "external", major);
 237
 238       out:
 239         return (ret);
 240 }
 241
 242 /*
 243 **  Driver Unload
 244 */
 245 static void DIVA_EXIT_FUNCTION maint_exit(void)
 246 {
 247         divas_maint_unregister_chrdev();
 248         mntfunc_finit();
 249
 250         printk(KERN_INFO "%s: module unloaded.\n", DRIVERLNAME);
 251 }
 252
 253 module_init(maint_init);
 254 module_exit(maint_exit);
 255