divamnt.c

Go to the documentation of this file.

/* $Id: divamnt.c,v 1.32.6.10 2005/02/11 19:40:25 armin Exp $
 *
 * Driver for Eicon DIVA Server ISDN cards.
 * Maint module
 *
 * Copyright 2000-2003 by Armin Schindler ([email protected])
 * Copyright 2000-2003 Cytronics & Melware ([email protected])
 *
 * This software may be used and distributed according to the terms
 * of the GNU General Public License, incorporated herein by reference.
 */

#include <linux/module.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/poll.h>
#include <linux/mutex.h>
#include <asm/uaccess.h>

#include "platform.h"
#include "di_defs.h"
#include "divasync.h"
#include "debug_if.h"

static DEFINE_MUTEX(maint_mutex);
static char *main_revision = "$Revision: 1.32.6.10 $";

static int major;

MODULE_DESCRIPTION("Maint driver for Eicon DIVA Server cards");
MODULE_AUTHOR("Cytronics & Melware, Eicon Networks");
MODULE_SUPPORTED_DEVICE("DIVA card driver");
MODULE_LICENSE("GPL");

static int buffer_length = 128;
module_param(buffer_length, int, 0);
static unsigned long diva_dbg_mem = 0;
module_param(diva_dbg_mem, ulong, 0);

static char *DRIVERNAME =
    "Eicon DIVA - MAINT module (http://www.melware.net)";
static char *DRIVERLNAME = "diva_mnt";
static char *DEVNAME = "DivasMAINT";
char *DRIVERRELEASE_MNT = "2.0";

static wait_queue_head_t msgwaitq;
static unsigned long opened;
static struct timeval start_time;

extern int mntfunc_init(int *, void **, unsigned long);
extern void mntfunc_finit(void);
extern int maint_read_write(void __user *buf, int count);

/*
 *  helper functions
 */
static char *getrev(const char *revision)
{
    char *rev;
    char *p;

    if ((p = strchr(revision, ':'))) {
        rev = p + 2;
        p = strchr(rev, '$');
        *--p = 0;
    } else
        rev = "1.0";

    return rev;
}

/*
 * kernel/user space copy functions
 */
int diva_os_copy_to_user(void *os_handle, void __user *dst, const void *src,
             int length)
{
    return (copy_to_user(dst, src, length));
}
int diva_os_copy_from_user(void *os_handle, void *dst, const void __user *src,
               int length)
{
    return (copy_from_user(dst, src, length));
}

/*
 * get time
 */
void diva_os_get_time(dword *sec, dword *usec)
{
    struct timeval tv;

    do_gettimeofday(&tv);

    if (tv.tv_sec > start_time.tv_sec) {
        if (start_time.tv_usec > tv.tv_usec) {
            tv.tv_sec--;
            tv.tv_usec += 1000000;
        }
        *sec = (dword) (tv.tv_sec - start_time.tv_sec);
        *usec = (dword) (tv.tv_usec - start_time.tv_usec);
    } else if (tv.tv_sec == start_time.tv_sec) {
        *sec = 0;
        if (start_time.tv_usec < tv.tv_usec) {
            *usec = (dword) (tv.tv_usec - start_time.tv_usec);
        } else {
            *usec = 0;
        }
    } else {
        *sec = (dword) tv.tv_sec;
        *usec = (dword) tv.tv_usec;
    }
}

/*
 * device node operations
 */
static unsigned int maint_poll(struct file *file, poll_table *wait)
{
    unsigned int mask = 0;

    poll_wait(file, &msgwaitq, wait);
    mask = POLLOUT | POLLWRNORM;
    if (file->private_data || diva_dbg_q_length()) {
        mask |= POLLIN | POLLRDNORM;
    }
    return (mask);
}

static int maint_open(struct inode *ino, struct file *filep)
{
    int ret;

    mutex_lock(&maint_mutex);
    /* only one open is allowed, so we test
       it atomically */
    if (test_and_set_bit(0, &opened))
        ret = -EBUSY;
    else {
        filep->private_data = NULL;
        ret = nonseekable_open(ino, filep);
    }
    mutex_unlock(&maint_mutex);
    return ret;
}

static int maint_close(struct inode *ino, struct file *filep)
{
    if (filep->private_data) {
        diva_os_free(0, filep->private_data);
        filep->private_data = NULL;
    }

    /* clear 'used' flag */
    clear_bit(0, &opened);

    return (0);
}

static ssize_t divas_maint_write(struct file *file, const char __user *buf,
                 size_t count, loff_t *ppos)
{
    return (maint_read_write((char __user *) buf, (int) count));
}

static ssize_t divas_maint_read(struct file *file, char __user *buf,
                size_t count, loff_t *ppos)
{
    return (maint_read_write(buf, (int) count));
}

static const struct file_operations divas_maint_fops = {
    .owner   = THIS_MODULE,
    .llseek  = no_llseek,
    .read    = divas_maint_read,
    .write   = divas_maint_write,
    .poll    = maint_poll,
    .open    = maint_open,
    .release = maint_close
};

static void divas_maint_unregister_chrdev(void)
{
    unregister_chrdev(major, DEVNAME);
}

static int __init divas_maint_register_chrdev(void)
{
    if ((major = register_chrdev(0, DEVNAME, &divas_maint_fops)) < 0)
    {
        printk(KERN_ERR "%s: failed to create /dev entry.\n",
               DRIVERLNAME);
        return (0);
    }

    return (1);
}

/*
 * wake up reader
 */
void diva_maint_wakeup_read(void)
{
    wake_up_interruptible(&msgwaitq);
}

/*
 *  Driver Load
 */
static int __init maint_init(void)
{
    char tmprev[50];
    int ret = 0;
    void *buffer = NULL;

    do_gettimeofday(&start_time);
    init_waitqueue_head(&msgwaitq);

    printk(KERN_INFO "%s\n", DRIVERNAME);
    printk(KERN_INFO "%s: Rel:%s  Rev:", DRIVERLNAME, DRIVERRELEASE_MNT);
    strcpy(tmprev, main_revision);
    printk("%s  Build: %s \n", getrev(tmprev), DIVA_BUILD);

    if (!divas_maint_register_chrdev()) {
        ret = -EIO;
        goto out;
    }

    if (!(mntfunc_init(&buffer_length, &buffer, diva_dbg_mem))) {
        printk(KERN_ERR "%s: failed to connect to DIDD.\n",
               DRIVERLNAME);
        divas_maint_unregister_chrdev();
        ret = -EIO;
        goto out;
    }

    printk(KERN_INFO "%s: trace buffer = %p - %d kBytes, %s (Major: %d)\n",
           DRIVERLNAME, buffer, (buffer_length / 1024),
           (diva_dbg_mem == 0) ? "internal" : "external", major);

out:
    return (ret);
}

/*
**  Driver Unload
*/
static void __exit maint_exit(void)
{
    divas_maint_unregister_chrdev();
    mntfunc_finit();

    printk(KERN_INFO "%s: module unloaded.\n", DRIVERLNAME);
}

module_init(maint_init);
module_exit(maint_exit);