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