1 files changed, 991 insertions, 0 deletions

diff --git a/drivers/isdn/capi/kcapi.c b/drivers/isdn/capi/kcapi.c
new file mode 100644
index 000000000000..feec40cf5900
--- /dev/null
+++ b/drivers/isdn/capi/kcapi.c
@@ -0,0 +1,991 @@
+/* $Id: kcapi.c,v 1.1.2.8 2004/03/26 19:57:20 armin Exp $
+ * 
+ * Kernel CAPI 2.0 Module
+ * 
+ * Copyright 1999 by Carsten Paeth <calle@calle.de>
+ * Copyright 2002 by Kai Germaschewski <kai@germaschewski.name>
+ * 
+ * This software may be used and distributed according to the terms
+ * of the GNU General Public License, incorporated herein by reference.
+ *
+ */
+
+#define CONFIG_AVMB1_COMPAT
+
+#include "kcapi.h"
+#include <linux/module.h>
+#include <linux/mm.h>
+#include <linux/interrupt.h>
+#include <linux/ioport.h>
+#include <linux/proc_fs.h>
+#include <linux/seq_file.h>
+#include <linux/skbuff.h>
+#include <linux/workqueue.h>
+#include <linux/capi.h>
+#include <linux/kernelcapi.h>
+#include <linux/init.h>
+#include <linux/moduleparam.h>
+#include <linux/delay.h>
+#include <asm/uaccess.h>
+#include <linux/isdn/capicmd.h>
+#include <linux/isdn/capiutil.h>
+#ifdef CONFIG_AVMB1_COMPAT
+#include <linux/b1lli.h>
+#endif
+
+static char *revision = "$Revision: 1.1.2.8 $";
+
+/* ------------------------------------------------------------- */
+
+static int showcapimsgs = 0;
+
+MODULE_DESCRIPTION("CAPI4Linux: kernel CAPI layer");
+MODULE_AUTHOR("Carsten Paeth");
+MODULE_LICENSE("GPL");
+module_param(showcapimsgs, uint, 0);
+
+/* ------------------------------------------------------------- */
+
+struct capi_notifier {
+        struct work_struct work;
+        unsigned int cmd;
+        u32 controller;
+        u16 applid;
+        u32 ncci;
+};
+
+/* ------------------------------------------------------------- */
+
+static struct capi_version driver_version = {2, 0, 1, 1<<4};
+static char driver_serial[CAPI_SERIAL_LEN] = "0004711";
+static char capi_manufakturer[64] = "AVM Berlin";
+
+#define NCCI2CTRL(ncci)    (((ncci) >> 24) & 0x7f)
+
+LIST_HEAD(capi_drivers);
+DEFINE_RWLOCK(capi_drivers_list_lock);
+
+static DEFINE_RWLOCK(application_lock);
+static DECLARE_MUTEX(controller_sem);
+
+struct capi20_appl *capi_applications[CAPI_MAXAPPL];
+struct capi_ctr *capi_cards[CAPI_MAXCONTR];
+
+static int ncards;
+
+/* -------- controller ref counting -------------------------------------- */
+
+static inline struct capi_ctr *
+capi_ctr_get(struct capi_ctr *card)
+{
+        if (!try_module_get(card->owner))
+                return NULL;
+        return card;
+}
+
+static inline void
+capi_ctr_put(struct capi_ctr *card)
+{
+        module_put(card->owner);
+}
+
+/* ------------------------------------------------------------- */
+
+static inline struct capi_ctr *get_capi_ctr_by_nr(u16 contr)
+{
+        if (contr - 1 >= CAPI_MAXCONTR)
+                return NULL;
+
+        return capi_cards[contr - 1];
+}
+
+static inline struct capi20_appl *get_capi_appl_by_nr(u16 applid)
+{
+        if (applid - 1 >= CAPI_MAXAPPL)
+                return NULL;
+
+        return capi_applications[applid - 1];
+}
+
+/* -------- util functions ------------------------------------ */
+
+static inline int capi_cmd_valid(u8 cmd)
+{
+        switch (cmd) {
+        case CAPI_ALERT:
+        case CAPI_CONNECT:
+        case CAPI_CONNECT_ACTIVE:
+        case CAPI_CONNECT_B3_ACTIVE:
+        case CAPI_CONNECT_B3:
+        case CAPI_CONNECT_B3_T90_ACTIVE:
+        case CAPI_DATA_B3:
+        case CAPI_DISCONNECT_B3:
+        case CAPI_DISCONNECT:
+        case CAPI_FACILITY:
+        case CAPI_INFO:
+        case CAPI_LISTEN:
+        case CAPI_MANUFACTURER:
+        case CAPI_RESET_B3:
+        case CAPI_SELECT_B_PROTOCOL:
+                return 1;
+        }
+        return 0;
+}
+
+static inline int capi_subcmd_valid(u8 subcmd)
+{
+        switch (subcmd) {
+        case CAPI_REQ:
+        case CAPI_CONF:
+        case CAPI_IND:
+        case CAPI_RESP:
+                return 1;
+        }
+        return 0;
+}
+
+/* ------------------------------------------------------------ */
+
+static void register_appl(struct capi_ctr *card, u16 applid, capi_register_params *rparam)
+{
+        card = capi_ctr_get(card);
+
+        if (card)
+                card->register_appl(card, applid, rparam);
+        else
+                printk(KERN_WARNING "%s: cannot get card resources\n", __FUNCTION__);
+}
+
+
+static void release_appl(struct capi_ctr *card, u16 applid)
+{
+        DBG("applid %#x", applid);
+        
+        card->release_appl(card, applid);
+        capi_ctr_put(card);
+}
+
+/* -------- KCI_CONTRUP --------------------------------------- */
+
+static void notify_up(u32 contr)
+{
+        struct capi_ctr *card = get_capi_ctr_by_nr(contr);
+        struct capi20_appl *ap;
+        u16 applid;
+
+        if (showcapimsgs & 1) {
+                printk(KERN_DEBUG "kcapi: notify up contr %d\n", contr);
+        }
+        if (!card) {
+                printk(KERN_WARNING "%s: invalid contr %d\n", __FUNCTION__, contr);
+                return;
+        }
+        for (applid = 1; applid <= CAPI_MAXAPPL; applid++) {
+                ap = get_capi_appl_by_nr(applid);
+                if (!ap || ap->release_in_progress) continue;
+                register_appl(card, applid, &ap->rparam);
+                if (ap->callback && !ap->release_in_progress)
+                        ap->callback(KCI_CONTRUP, contr, &card->profile);
+        }
+}
+
+/* -------- KCI_CONTRDOWN ------------------------------------- */
+
+static void notify_down(u32 contr)
+{
+        struct capi20_appl *ap;
+        u16 applid;
+
+        if (showcapimsgs & 1) {
+                printk(KERN_DEBUG "kcapi: notify down contr %d\n", contr);
+        }
+
+        for (applid = 1; applid <= CAPI_MAXAPPL; applid++) {
+                ap = get_capi_appl_by_nr(applid);
+                if (ap && ap->callback && !ap->release_in_progress)
+                        ap->callback(KCI_CONTRDOWN, contr, NULL);
+        }
+}
+
+static void notify_handler(void *data)
+{
+        struct capi_notifier *np = data;
+
+        switch (np->cmd) {
+        case KCI_CONTRUP:
+                notify_up(np->controller);
+                break;
+        case KCI_CONTRDOWN:
+                notify_down(np->controller);
+                break;
+        }
+
+        kfree(np);
+}
+
+/*
+ * The notifier will result in adding/deleteing of devices. Devices can
+ * only removed in user process, not in bh.
+ */
+static int notify_push(unsigned int cmd, u32 controller, u16 applid, u32 ncci)
+{
+        struct capi_notifier *np = kmalloc(sizeof(*np), GFP_ATOMIC);
+
+        if (!np)
+                return -ENOMEM;
+
+        INIT_WORK(&np->work, notify_handler, np);
+        np->cmd = cmd;
+        np->controller = controller;
+        np->applid = applid;
+        np->ncci = ncci;
+
+        schedule_work(&np->work);
+        return 0;
+}
+
+        
+/* -------- Receiver ------------------------------------------ */
+
+static void recv_handler(void *_ap)
+{
+        struct sk_buff *skb;
+        struct capi20_appl *ap = (struct capi20_appl *) _ap;
+
+        if ((!ap) || (ap->release_in_progress))
+                return;
+
+        down(&ap->recv_sem);
+        while ((skb = skb_dequeue(&ap->recv_queue))) {
+                if (CAPIMSG_CMD(skb->data) == CAPI_DATA_B3_IND)
+                        ap->nrecvdatapkt++;
+                else
+                        ap->nrecvctlpkt++;
+
+                ap->recv_message(ap, skb);
+        }
+        up(&ap->recv_sem);
+}
+
+void capi_ctr_handle_message(struct capi_ctr * card, u16 appl, struct sk_buff *skb)
+{
+        struct capi20_appl *ap;
+        int showctl = 0;
+        u8 cmd, subcmd;
+        unsigned long flags;
+
+        if (card->cardstate != CARD_RUNNING) {
+                printk(KERN_INFO "kcapi: controller %d not active, got: %s",
+                       card->cnr, capi_message2str(skb->data));
+                goto error;
+        }
+
+        cmd = CAPIMSG_COMMAND(skb->data);
+        subcmd = CAPIMSG_SUBCOMMAND(skb->data);
+        if (cmd == CAPI_DATA_B3 && subcmd == CAPI_IND) {
+                card->nrecvdatapkt++;
+                if (card->traceflag > 2) showctl |= 2;
+        } else {
+                card->nrecvctlpkt++;
+                if (card->traceflag) showctl |= 2;
+        }
+        showctl |= (card->traceflag & 1);
+        if (showctl & 2) {
+                if (showctl & 1) {
+                        printk(KERN_DEBUG "kcapi: got [0x%lx] id#%d %s len=%u\n",
+                               (unsigned long) card->cnr,
+                               CAPIMSG_APPID(skb->data),
+                               capi_cmd2str(cmd, subcmd),
+                               CAPIMSG_LEN(skb->data));
+                } else {
+                        printk(KERN_DEBUG "kcapi: got [0x%lx] %s\n",
+                                        (unsigned long) card->cnr,
+                                        capi_message2str(skb->data));
+                }
+
+        }
+
+        read_lock_irqsave(&application_lock, flags);
+        ap = get_capi_appl_by_nr(CAPIMSG_APPID(skb->data));
+        if ((!ap) || (ap->release_in_progress)) {
+                read_unlock_irqrestore(&application_lock, flags);
+                printk(KERN_ERR "kcapi: handle_message: applid %d state released (%s)\n",
+                        CAPIMSG_APPID(skb->data), capi_message2str(skb->data));
+                goto error;
+        }
+        skb_queue_tail(&ap->recv_queue, skb);
+        schedule_work(&ap->recv_work);
+        read_unlock_irqrestore(&application_lock, flags);
+
+        return;
+
+error:
+        kfree_skb(skb);
+}
+
+EXPORT_SYMBOL(capi_ctr_handle_message);
+
+void capi_ctr_ready(struct capi_ctr * card)
+{
+        card->cardstate = CARD_RUNNING;
+
+        printk(KERN_NOTICE "kcapi: card %d \"%s\" ready.\n",
+               card->cnr, card->name);
+
+        notify_push(KCI_CONTRUP, card->cnr, 0, 0);
+}
+
+EXPORT_SYMBOL(capi_ctr_ready);
+
+void capi_ctr_reseted(struct capi_ctr * card)
+{
+        u16 appl;
+
+        DBG("");
+
+        if (card->cardstate == CARD_DETECTED)
+                return;
+
+        card->cardstate = CARD_DETECTED;
+
+        memset(card->manu, 0, sizeof(card->manu));
+        memset(&card->version, 0, sizeof(card->version));
+        memset(&card->profile, 0, sizeof(card->profile));
+        memset(card->serial, 0, sizeof(card->serial));
+
+        for (appl = 1; appl <= CAPI_MAXAPPL; appl++) {
+                struct capi20_appl *ap = get_capi_appl_by_nr(appl);
+                if (!ap || ap->release_in_progress)
+                        continue;
+
+                capi_ctr_put(card);
+        }
+
+        printk(KERN_NOTICE "kcapi: card %d down.\n", card->cnr);
+
+        notify_push(KCI_CONTRDOWN, card->cnr, 0, 0);
+}
+
+EXPORT_SYMBOL(capi_ctr_reseted);
+
+void capi_ctr_suspend_output(struct capi_ctr *card)
+{
+        if (!card->blocked) {
+                printk(KERN_DEBUG "kcapi: card %d suspend\n", card->cnr);
+                card->blocked = 1;
+        }
+}
+
+EXPORT_SYMBOL(capi_ctr_suspend_output);
+
+void capi_ctr_resume_output(struct capi_ctr *card)
+{
+        if (card->blocked) {
+                printk(KERN_DEBUG "kcapi: card %d resume\n", card->cnr);
+                card->blocked = 0;
+        }
+}
+
+EXPORT_SYMBOL(capi_ctr_resume_output);
+
+/* ------------------------------------------------------------- */
+
+int
+attach_capi_ctr(struct capi_ctr *card)
+{
+        int i;
+
+        down(&controller_sem);
+
+        for (i = 0; i < CAPI_MAXCONTR; i++) {
+                if (capi_cards[i] == NULL)
+                        break;
+        }
+        if (i == CAPI_MAXCONTR) {
+                up(&controller_sem);
+                printk(KERN_ERR "kcapi: out of controller slots\n");
+                return -EBUSY;
+        }
+        capi_cards[i] = card;
+
+        up(&controller_sem);
+
+        card->nrecvctlpkt = 0;
+        card->nrecvdatapkt = 0;
+        card->nsentctlpkt = 0;
+        card->nsentdatapkt = 0;
+        card->cnr = i + 1;
+        card->cardstate = CARD_DETECTED;
+        card->blocked = 0;
+        card->traceflag = showcapimsgs;
+
+        sprintf(card->procfn, "capi/controllers/%d", card->cnr);
+        card->procent = create_proc_entry(card->procfn, 0, NULL);
+        if (card->procent) {
+           card->procent->read_proc = 
+                (int (*)(char *,char **,off_t,int,int *,void *))
+                        card->ctr_read_proc;
+           card->procent->data = card;
+        }
+
+        ncards++;
+        printk(KERN_NOTICE "kcapi: Controller %d: %s attached\n",
+                        card->cnr, card->name);
+        return 0;
+}
+
+EXPORT_SYMBOL(attach_capi_ctr);
+
+int detach_capi_ctr(struct capi_ctr *card)
+{
+        if (card->cardstate != CARD_DETECTED)
+                capi_ctr_reseted(card);
+
+        ncards--;
+
+        if (card->procent) {
+           remove_proc_entry(card->procfn, NULL);
+           card->procent = NULL;
+        }
+        capi_cards[card->cnr - 1] = NULL;
+        printk(KERN_NOTICE "kcapi: Controller %d: %s unregistered\n",
+                        card->cnr, card->name);
+
+        return 0;
+}
+
+EXPORT_SYMBOL(detach_capi_ctr);
+
+void register_capi_driver(struct capi_driver *driver)
+{
+        unsigned long flags;
+
+        write_lock_irqsave(&capi_drivers_list_lock, flags);
+        list_add_tail(&driver->list, &capi_drivers);
+        write_unlock_irqrestore(&capi_drivers_list_lock, flags);
+}
+
+EXPORT_SYMBOL(register_capi_driver);
+
+void unregister_capi_driver(struct capi_driver *driver)
+{
+        unsigned long flags;
+
+        write_lock_irqsave(&capi_drivers_list_lock, flags);
+        list_del(&driver->list);
+        write_unlock_irqrestore(&capi_drivers_list_lock, flags);
+}
+
+EXPORT_SYMBOL(unregister_capi_driver);
+
+/* ------------------------------------------------------------- */
+/* -------- CAPI2.0 Interface ---------------------------------- */
+/* ------------------------------------------------------------- */
+
+u16 capi20_isinstalled(void)
+{
+        int i;
+        for (i = 0; i < CAPI_MAXCONTR; i++) {
+                if (capi_cards[i] && capi_cards[i]->cardstate == CARD_RUNNING)
+                        return CAPI_NOERROR;
+        }
+        return CAPI_REGNOTINSTALLED;
+}
+
+EXPORT_SYMBOL(capi20_isinstalled);
+
+u16 capi20_register(struct capi20_appl *ap)
+{
+        int i;
+        u16 applid;
+        unsigned long flags;
+
+        DBG("");
+
+        if (ap->rparam.datablklen < 128)
+                return CAPI_LOGBLKSIZETOSMALL;
+
+        write_lock_irqsave(&application_lock, flags);
+
+        for (applid = 1; applid <= CAPI_MAXAPPL; applid++) {
+                if (capi_applications[applid - 1] == NULL)
+                        break;
+        }
+        if (applid > CAPI_MAXAPPL) {
+                write_unlock_irqrestore(&application_lock, flags);
+                return CAPI_TOOMANYAPPLS;
+        }
+
+        ap->applid = applid;
+        capi_applications[applid - 1] = ap;
+
+        ap->nrecvctlpkt = 0;
+        ap->nrecvdatapkt = 0;
+        ap->nsentctlpkt = 0;
+        ap->nsentdatapkt = 0;
+        ap->callback = NULL;
+        init_MUTEX(&ap->recv_sem);
+        skb_queue_head_init(&ap->recv_queue);
+        INIT_WORK(&ap->recv_work, recv_handler, (void *)ap);
+        ap->release_in_progress = 0;
+
+        write_unlock_irqrestore(&application_lock, flags);
+        
+        down(&controller_sem);
+        for (i = 0; i < CAPI_MAXCONTR; i++) {
+                if (!capi_cards[i] || capi_cards[i]->cardstate != CARD_RUNNING)
+                        continue;
+                register_appl(capi_cards[i], applid, &ap->rparam);
+        }
+        up(&controller_sem);
+
+        if (showcapimsgs & 1) {
+                printk(KERN_DEBUG "kcapi: appl %d up\n", applid);
+        }
+
+        return CAPI_NOERROR;
+}
+
+EXPORT_SYMBOL(capi20_register);
+
+u16 capi20_release(struct capi20_appl *ap)
+{
+        int i;
+        unsigned long flags;
+
+        DBG("applid %#x", ap->applid);
+
+        write_lock_irqsave(&application_lock, flags);
+        ap->release_in_progress = 1;
+        capi_applications[ap->applid - 1] = NULL;
+        write_unlock_irqrestore(&application_lock, flags);
+
+        down(&controller_sem);
+        for (i = 0; i < CAPI_MAXCONTR; i++) {
+                if (!capi_cards[i] || capi_cards[i]->cardstate != CARD_RUNNING)
+                        continue;
+                release_appl(capi_cards[i], ap->applid);
+        }
+        up(&controller_sem);
+
+        flush_scheduled_work();
+        skb_queue_purge(&ap->recv_queue);
+
+        if (showcapimsgs & 1) {
+                printk(KERN_DEBUG "kcapi: appl %d down\n", ap->applid);
+        }
+
+        return CAPI_NOERROR;
+}
+
+EXPORT_SYMBOL(capi20_release);
+
+u16 capi20_put_message(struct capi20_appl *ap, struct sk_buff *skb)
+{
+        struct capi_ctr *card;
+        int showctl = 0;
+        u8 cmd, subcmd;
+
+        DBG("applid %#x", ap->applid);
+ 
+        if (ncards == 0)
+                return CAPI_REGNOTINSTALLED;
+        if ((ap->applid == 0) || ap->release_in_progress)
+                return CAPI_ILLAPPNR;
+        if (skb->len < 12
+            || !capi_cmd_valid(CAPIMSG_COMMAND(skb->data))
+            || !capi_subcmd_valid(CAPIMSG_SUBCOMMAND(skb->data)))
+                return CAPI_ILLCMDORSUBCMDORMSGTOSMALL;
+        card = get_capi_ctr_by_nr(CAPIMSG_CONTROLLER(skb->data));
+        if (!card || card->cardstate != CARD_RUNNING) {
+                card = get_capi_ctr_by_nr(1); // XXX why?
+                if (!card || card->cardstate != CARD_RUNNING) 
+                        return CAPI_REGNOTINSTALLED;
+        }
+        if (card->blocked)
+                return CAPI_SENDQUEUEFULL;
+
+        cmd = CAPIMSG_COMMAND(skb->data);
+        subcmd = CAPIMSG_SUBCOMMAND(skb->data);
+
+        if (cmd == CAPI_DATA_B3 && subcmd== CAPI_REQ) {
+                card->nsentdatapkt++;
+                ap->nsentdatapkt++;
+                if (card->traceflag > 2) showctl |= 2;
+        } else {
+                card->nsentctlpkt++;
+                ap->nsentctlpkt++;
+                if (card->traceflag) showctl |= 2;
+        }
+        showctl |= (card->traceflag & 1);
+        if (showctl & 2) {
+                if (showctl & 1) {
+                        printk(KERN_DEBUG "kcapi: put [%#x] id#%d %s len=%u\n",
+                               CAPIMSG_CONTROLLER(skb->data),
+                               CAPIMSG_APPID(skb->data),
+                               capi_cmd2str(cmd, subcmd),
+                               CAPIMSG_LEN(skb->data));
+                } else {
+                        printk(KERN_DEBUG "kcapi: put [%#x] %s\n",
+                               CAPIMSG_CONTROLLER(skb->data),
+                               capi_message2str(skb->data));
+                }
+
+        }
+        return card->send_message(card, skb);
+}
+
+EXPORT_SYMBOL(capi20_put_message);
+
+u16 capi20_get_manufacturer(u32 contr, u8 *buf)
+{
+        struct capi_ctr *card;
+
+        if (contr == 0) {
+                strlcpy(buf, capi_manufakturer, CAPI_MANUFACTURER_LEN);
+                return CAPI_NOERROR;
+        }
+        card = get_capi_ctr_by_nr(contr);
+        if (!card || card->cardstate != CARD_RUNNING) 
+                return CAPI_REGNOTINSTALLED;
+        strlcpy(buf, card->manu, CAPI_MANUFACTURER_LEN);
+        return CAPI_NOERROR;
+}
+
+EXPORT_SYMBOL(capi20_get_manufacturer);
+
+u16 capi20_get_version(u32 contr, struct capi_version *verp)
+{
+        struct capi_ctr *card;
+
+        if (contr == 0) {
+                *verp = driver_version;
+                return CAPI_NOERROR;
+        }
+        card = get_capi_ctr_by_nr(contr);
+        if (!card || card->cardstate != CARD_RUNNING) 
+                return CAPI_REGNOTINSTALLED;
+
+        memcpy((void *) verp, &card->version, sizeof(capi_version));
+        return CAPI_NOERROR;
+}
+
+EXPORT_SYMBOL(capi20_get_version);
+
+u16 capi20_get_serial(u32 contr, u8 *serial)
+{
+        struct capi_ctr *card;
+
+        if (contr == 0) {
+                strlcpy(serial, driver_serial, CAPI_SERIAL_LEN);
+                return CAPI_NOERROR;
+        }
+        card = get_capi_ctr_by_nr(contr);
+        if (!card || card->cardstate != CARD_RUNNING) 
+                return CAPI_REGNOTINSTALLED;
+
+        strlcpy((void *) serial, card->serial, CAPI_SERIAL_LEN);
+        return CAPI_NOERROR;
+}
+
+EXPORT_SYMBOL(capi20_get_serial);
+
+u16 capi20_get_profile(u32 contr, struct capi_profile *profp)
+{
+        struct capi_ctr *card;
+
+        if (contr == 0) {
+                profp->ncontroller = ncards;
+                return CAPI_NOERROR;
+        }
+        card = get_capi_ctr_by_nr(contr);
+        if (!card || card->cardstate != CARD_RUNNING) 
+                return CAPI_REGNOTINSTALLED;
+
+        memcpy((void *) profp, &card->profile,
+                        sizeof(struct capi_profile));
+        return CAPI_NOERROR;
+}
+
+EXPORT_SYMBOL(capi20_get_profile);
+
+#ifdef CONFIG_AVMB1_COMPAT
+static int old_capi_manufacturer(unsigned int cmd, void __user *data)
+{
+        avmb1_loadandconfigdef ldef;
+        avmb1_extcarddef cdef;
+        avmb1_resetdef rdef;
+        capicardparams cparams;
+        struct capi_ctr *card;
+        struct capi_driver *driver = NULL;
+        capiloaddata ldata;
+        struct list_head *l;
+        unsigned long flags;
+        int retval;
+
+        switch (cmd) {
+        case AVMB1_ADDCARD:
+        case AVMB1_ADDCARD_WITH_TYPE:
+                if (cmd == AVMB1_ADDCARD) {
+                   if ((retval = copy_from_user(&cdef, data,
+                                            sizeof(avmb1_carddef))))
+                           return retval;
+                   cdef.cardtype = AVM_CARDTYPE_B1;
+                } else {
+                   if ((retval = copy_from_user(&cdef, data,
+                                            sizeof(avmb1_extcarddef))))
+                           return retval;
+                }
+                cparams.port = cdef.port;
+                cparams.irq = cdef.irq;
+                cparams.cardnr = cdef.cardnr;
+
+                read_lock_irqsave(&capi_drivers_list_lock, flags);
+                switch (cdef.cardtype) {
+                        case AVM_CARDTYPE_B1:
+                                list_for_each(l, &capi_drivers) {
+                                        driver = list_entry(l, struct capi_driver, list);
+                                        if (strcmp(driver->name, "b1isa") == 0)
+                                                break;
+                                }
+                                break;
+                        case AVM_CARDTYPE_T1:
+                                list_for_each(l, &capi_drivers) {
+                                        driver = list_entry(l, struct capi_driver, list);
+                                        if (strcmp(driver->name, "t1isa") == 0)
+                                                break;
+                                }
+                                break;
+                        default:
+                                driver = NULL;
+                                break;
+                }
+                if (!driver) {
+                        read_unlock_irqrestore(&capi_drivers_list_lock, flags);
+                        printk(KERN_ERR "kcapi: driver not loaded.\n");
+                        return -EIO;
+                }
+                if (!driver->add_card) {
+                        read_unlock_irqrestore(&capi_drivers_list_lock, flags);
+                        printk(KERN_ERR "kcapi: driver has no add card function.\n");
+                        return -EIO;
+                }
+
+                retval = driver->add_card(driver, &cparams);
+                read_unlock_irqrestore(&capi_drivers_list_lock, flags);
+                return retval;
+
+        case AVMB1_LOAD:
+        case AVMB1_LOAD_AND_CONFIG:
+
+                if (cmd == AVMB1_LOAD) {
+                        if (copy_from_user(&ldef, data,
+                                           sizeof(avmb1_loaddef)))
+                                return -EFAULT;
+                        ldef.t4config.len = 0;
+                        ldef.t4config.data = NULL;
+                } else {
+                        if (copy_from_user(&ldef, data,
+                                           sizeof(avmb1_loadandconfigdef)))
+                                return -EFAULT;
+                }
+                card = get_capi_ctr_by_nr(ldef.contr);
+                card = capi_ctr_get(card);
+                if (!card)
+                        return -ESRCH;
+                if (card->load_firmware == 0) {
+                        printk(KERN_DEBUG "kcapi: load: no load function\n");
+                        return -ESRCH;
+                }
+
+                if (ldef.t4file.len <= 0) {
+                        printk(KERN_DEBUG "kcapi: load: invalid parameter: length of t4file is %d ?\n", ldef.t4file.len);
+                        return -EINVAL;
+                }
+                if (ldef.t4file.data == 0) {
+                        printk(KERN_DEBUG "kcapi: load: invalid parameter: dataptr is 0\n");
+                        return -EINVAL;
+                }
+
+                ldata.firmware.user = 1;
+                ldata.firmware.data = ldef.t4file.data;
+                ldata.firmware.len = ldef.t4file.len;
+                ldata.configuration.user = 1;
+                ldata.configuration.data = ldef.t4config.data;
+                ldata.configuration.len = ldef.t4config.len;
+
+                if (card->cardstate != CARD_DETECTED) {
+                        printk(KERN_INFO "kcapi: load: contr=%d not in detect state\n", ldef.contr);
+                        return -EBUSY;
+                }
+                card->cardstate = CARD_LOADING;
+
+                retval = card->load_firmware(card, &ldata);
+
+                if (retval) {
+                        card->cardstate = CARD_DETECTED;
+                        capi_ctr_put(card);
+                        return retval;
+                }
+
+                while (card->cardstate != CARD_RUNNING) {
+
+                        msleep_interruptible(100);      /* 0.1 sec */
+
+                        if (signal_pending(current)) {
+                                capi_ctr_put(card);
+                                return -EINTR;
+                        }
+                }
+                capi_ctr_put(card);
+                return 0;
+
+        case AVMB1_RESETCARD:
+                if (copy_from_user(&rdef, data, sizeof(avmb1_resetdef)))
+                        return -EFAULT;
+                card = get_capi_ctr_by_nr(rdef.contr);
+                if (!card)
+                        return -ESRCH;
+
+                if (card->cardstate == CARD_DETECTED)
+                        return 0;
+
+                card->reset_ctr(card);
+
+                while (card->cardstate > CARD_DETECTED) {
+
+                        msleep_interruptible(100);      /* 0.1 sec */
+
+                        if (signal_pending(current))
+                                return -EINTR;
+                }
+                return 0;
+
+        }
+        return -EINVAL;
+}
+#endif
+
+int capi20_manufacturer(unsigned int cmd, void __user *data)
+{
+        struct capi_ctr *card;
+
+        switch (cmd) {
+#ifdef CONFIG_AVMB1_COMPAT
+        case AVMB1_LOAD:
+        case AVMB1_LOAD_AND_CONFIG:
+        case AVMB1_RESETCARD:
+        case AVMB1_GET_CARDINFO:
+        case AVMB1_REMOVECARD:
+                return old_capi_manufacturer(cmd, data);
+#endif
+        case KCAPI_CMD_TRACE:
+        {
+                kcapi_flagdef fdef;
+
+                if (copy_from_user(&fdef, data, sizeof(kcapi_flagdef)))
+                        return -EFAULT;
+
+                card = get_capi_ctr_by_nr(fdef.contr);
+                if (!card)
+                        return -ESRCH;
+
+                card->traceflag = fdef.flag;
+                printk(KERN_INFO "kcapi: contr %d set trace=%d\n",
+                        card->cnr, card->traceflag);
+                return 0;
+        }
+        case KCAPI_CMD_ADDCARD:
+        {
+                struct list_head *l;
+                struct capi_driver *driver = NULL;
+                capicardparams cparams;
+                kcapi_carddef cdef;
+                int retval;
+
+                if ((retval = copy_from_user(&cdef, data, sizeof(cdef))))
+                        return retval;
+
+                cparams.port = cdef.port;
+                cparams.irq = cdef.irq;
+                cparams.membase = cdef.membase;
+                cparams.cardnr = cdef.cardnr;
+                cparams.cardtype = 0;
+                cdef.driver[sizeof(cdef.driver)-1] = 0;
+
+                list_for_each(l, &capi_drivers) {
+                        driver = list_entry(l, struct capi_driver, list);
+                        if (strcmp(driver->name, cdef.driver) == 0)
+                                break;
+                }
+                if (driver == 0) {
+                        printk(KERN_ERR "kcapi: driver \"%s\" not loaded.\n",
+                                        cdef.driver);
+                        return -ESRCH;
+                }
+
+                if (!driver->add_card) {
+                        printk(KERN_ERR "kcapi: driver \"%s\" has no add card function.\n", cdef.driver);
+                        return -EIO;
+                }
+
+                return driver->add_card(driver, &cparams);
+        }
+
+        default:
+                printk(KERN_ERR "kcapi: manufacturer command %d unknown.\n",
+                                        cmd);
+                break;
+
+        }
+        return -EINVAL;
+}
+
+EXPORT_SYMBOL(capi20_manufacturer);
+
+/* temporary hack */
+void capi20_set_callback(struct capi20_appl *ap,
+                         void (*callback) (unsigned int cmd, __u32 contr, void *data))
+{
+        ap->callback = callback;
+}
+
+EXPORT_SYMBOL(capi20_set_callback);
+
+/* ------------------------------------------------------------- */
+/* -------- Init & Cleanup ------------------------------------- */
+/* ------------------------------------------------------------- */
+
+/*
+ * init / exit functions
+ */
+
+static int __init kcapi_init(void)
+{
+        char *p;
+        char rev[32];
+
+        kcapi_proc_init();
+
+        if ((p = strchr(revision, ':')) != 0 && p[1]) {
+                strlcpy(rev, p + 2, sizeof(rev));
+                if ((p = strchr(rev, '$')) != 0 && p > rev)
+                   *(p-1) = 0;
+        } else
+                strcpy(rev, "1.0");
+
+        printk(KERN_NOTICE "CAPI Subsystem Rev %s\n", rev);
+
+        return 0;
+}
+
+static void __exit kcapi_exit(void)
+{
+        kcapi_proc_exit();
+
+        /* make sure all notifiers are finished */
+        flush_scheduled_work();
+}
+
+module_init(kcapi_init);
+module_exit(kcapi_exit);