| /* $Id: b1.c,v 1.1.2.2 2004/01/16 21:09:27 keil Exp $ | 
 |  *  | 
 |  * Common module for AVM B1 cards. | 
 |  *  | 
 |  * Copyright 1999 by Carsten Paeth <calle@calle.de> | 
 |  * | 
 |  * 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/kernel.h> | 
 | #include <linux/pci.h> | 
 | #include <linux/skbuff.h> | 
 | #include <linux/delay.h> | 
 | #include <linux/mm.h> | 
 | #include <linux/interrupt.h> | 
 | #include <linux/ioport.h> | 
 | #include <linux/capi.h> | 
 | #include <linux/kernelcapi.h> | 
 | #include <asm/io.h> | 
 | #include <linux/init.h> | 
 | #include <asm/uaccess.h> | 
 | #include <linux/netdevice.h> | 
 | #include <linux/isdn/capilli.h> | 
 | #include "avmcard.h" | 
 | #include <linux/isdn/capicmd.h> | 
 | #include <linux/isdn/capiutil.h> | 
 |  | 
 | static char *revision = "$Revision: 1.1.2.2 $"; | 
 |  | 
 | /* ------------------------------------------------------------- */ | 
 |  | 
 | MODULE_DESCRIPTION("CAPI4Linux: Common support for active AVM cards"); | 
 | MODULE_AUTHOR("Carsten Paeth"); | 
 | MODULE_LICENSE("GPL"); | 
 |  | 
 | /* ------------------------------------------------------------- */ | 
 |  | 
 | int b1_irq_table[16] = | 
 | {0, | 
 |  0, | 
 |  0, | 
 |  192,				/* irq 3 */ | 
 |  32,				/* irq 4 */ | 
 |  160,				/* irq 5 */ | 
 |  96,				/* irq 6 */ | 
 |  224,				/* irq 7 */ | 
 |  0, | 
 |  64,				/* irq 9 */ | 
 |  80,				/* irq 10 */ | 
 |  208,				/* irq 11 */ | 
 |  48,				/* irq 12 */ | 
 |  0, | 
 |  0, | 
 |  112,				/* irq 15 */ | 
 | }; | 
 |  | 
 | /* ------------------------------------------------------------- */	 | 
 |  | 
 | avmcard *b1_alloc_card(int nr_controllers) | 
 | { | 
 | 	avmcard *card; | 
 | 	avmctrl_info *cinfo; | 
 | 	int i; | 
 |  | 
 | 	card = kmalloc(sizeof(*card), GFP_KERNEL); | 
 | 	if (!card) | 
 | 		return NULL; | 
 |  | 
 | 	memset(card, 0, sizeof(*card)); | 
 |  | 
 |         cinfo = kmalloc(sizeof(*cinfo) * nr_controllers, GFP_KERNEL); | 
 | 	if (!cinfo) { | 
 | 		kfree(card); | 
 | 		return NULL; | 
 | 	} | 
 | 	memset(cinfo, 0, sizeof(*cinfo) * nr_controllers); | 
 |  | 
 | 	card->ctrlinfo = cinfo; | 
 | 	for (i = 0; i < nr_controllers; i++) { | 
 | 		INIT_LIST_HEAD(&cinfo[i].ncci_head); | 
 | 		cinfo[i].card = card; | 
 | 	} | 
 | 	spin_lock_init(&card->lock); | 
 | 	card->nr_controllers = nr_controllers; | 
 |  | 
 | 	return card; | 
 | } | 
 |  | 
 | /* ------------------------------------------------------------- */ | 
 |  | 
 | void b1_free_card(avmcard *card) | 
 | { | 
 | 	kfree(card->ctrlinfo); | 
 | 	kfree(card); | 
 | } | 
 |  | 
 | /* ------------------------------------------------------------- */ | 
 |  | 
 | int b1_detect(unsigned int base, enum avmcardtype cardtype) | 
 | { | 
 | 	int onoff, i; | 
 |  | 
 | 	/* | 
 | 	 * Statusregister 0000 00xx  | 
 | 	 */ | 
 | 	if ((inb(base + B1_INSTAT) & 0xfc) | 
 | 	    || (inb(base + B1_OUTSTAT) & 0xfc)) | 
 | 		return 1; | 
 | 	/* | 
 | 	 * Statusregister 0000 001x  | 
 | 	 */ | 
 | 	b1outp(base, B1_INSTAT, 0x2);	/* enable irq */ | 
 | 	/* b1outp(base, B1_OUTSTAT, 0x2); */ | 
 | 	if ((inb(base + B1_INSTAT) & 0xfe) != 0x2 | 
 | 	    /* || (inb(base + B1_OUTSTAT) & 0xfe) != 0x2 */) | 
 | 		return 2; | 
 | 	/* | 
 | 	 * Statusregister 0000 000x  | 
 | 	 */ | 
 | 	b1outp(base, B1_INSTAT, 0x0);	/* disable irq */ | 
 | 	b1outp(base, B1_OUTSTAT, 0x0); | 
 | 	if ((inb(base + B1_INSTAT) & 0xfe) | 
 | 	    || (inb(base + B1_OUTSTAT) & 0xfe)) | 
 | 		return 3; | 
 |          | 
 | 	for (onoff = !0, i= 0; i < 10 ; i++) { | 
 | 		b1_set_test_bit(base, cardtype, onoff); | 
 | 		if (b1_get_test_bit(base, cardtype) != onoff) | 
 | 		   return 4; | 
 | 		onoff = !onoff; | 
 | 	} | 
 |  | 
 | 	if (cardtype == avm_m1) | 
 | 	   return 0; | 
 |  | 
 |         if ((b1_rd_reg(base, B1_STAT1(cardtype)) & 0x0f) != 0x01) | 
 | 	   return 5; | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | void b1_getrevision(avmcard *card) | 
 | { | 
 |     card->class = inb(card->port + B1_ANALYSE); | 
 |     card->revision = inb(card->port + B1_REVISION); | 
 | } | 
 |  | 
 | #define FWBUF_SIZE	256 | 
 | int b1_load_t4file(avmcard *card, capiloaddatapart * t4file) | 
 | { | 
 | 	unsigned char buf[FWBUF_SIZE]; | 
 | 	unsigned char *dp; | 
 | 	int i, left; | 
 | 	unsigned int base = card->port; | 
 |  | 
 | 	dp = t4file->data; | 
 | 	left = t4file->len; | 
 | 	while (left > FWBUF_SIZE) { | 
 | 		if (t4file->user) { | 
 | 			if (copy_from_user(buf, dp, FWBUF_SIZE)) | 
 | 				return -EFAULT; | 
 | 		} else { | 
 | 			memcpy(buf, dp, FWBUF_SIZE); | 
 | 		} | 
 | 		for (i = 0; i < FWBUF_SIZE; i++) | 
 | 			if (b1_save_put_byte(base, buf[i]) < 0) { | 
 | 				printk(KERN_ERR "%s: corrupted firmware file ?\n", | 
 | 						card->name); | 
 | 				return -EIO; | 
 | 			} | 
 | 		left -= FWBUF_SIZE; | 
 | 		dp += FWBUF_SIZE; | 
 | 	} | 
 | 	if (left) { | 
 | 		if (t4file->user) { | 
 | 			if (copy_from_user(buf, dp, left)) | 
 | 				return -EFAULT; | 
 | 		} else { | 
 | 			memcpy(buf, dp, left); | 
 | 		} | 
 | 		for (i = 0; i < left; i++) | 
 | 			if (b1_save_put_byte(base, buf[i]) < 0) { | 
 | 				printk(KERN_ERR "%s: corrupted firmware file ?\n", | 
 | 						card->name); | 
 | 				return -EIO; | 
 | 			} | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 | int b1_load_config(avmcard *card, capiloaddatapart * config) | 
 | { | 
 | 	unsigned char buf[FWBUF_SIZE]; | 
 | 	unsigned char *dp; | 
 | 	unsigned int base = card->port; | 
 | 	int i, j, left; | 
 |  | 
 | 	dp = config->data; | 
 | 	left = config->len; | 
 | 	if (left) { | 
 | 		b1_put_byte(base, SEND_CONFIG); | 
 |         	b1_put_word(base, 1); | 
 | 		b1_put_byte(base, SEND_CONFIG); | 
 |         	b1_put_word(base, left); | 
 | 	} | 
 | 	while (left > FWBUF_SIZE) { | 
 | 		if (config->user) { | 
 | 			if (copy_from_user(buf, dp, FWBUF_SIZE)) | 
 | 				return -EFAULT; | 
 | 		} else { | 
 | 			memcpy(buf, dp, FWBUF_SIZE); | 
 | 		} | 
 | 		for (i = 0; i < FWBUF_SIZE; ) { | 
 | 			b1_put_byte(base, SEND_CONFIG); | 
 | 			for (j=0; j < 4; j++) { | 
 | 				b1_put_byte(base, buf[i++]); | 
 | 			} | 
 | 		} | 
 | 		left -= FWBUF_SIZE; | 
 | 		dp += FWBUF_SIZE; | 
 | 	} | 
 | 	if (left) { | 
 | 		if (config->user) { | 
 | 			if (copy_from_user(buf, dp, left)) | 
 | 				return -EFAULT; | 
 | 		} else { | 
 | 			memcpy(buf, dp, left); | 
 | 		} | 
 | 		for (i = 0; i < left; ) { | 
 | 			b1_put_byte(base, SEND_CONFIG); | 
 | 			for (j=0; j < 4; j++) { | 
 | 				if (i < left) | 
 | 					b1_put_byte(base, buf[i++]); | 
 | 				else | 
 | 					b1_put_byte(base, 0); | 
 | 			} | 
 | 		} | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 | int b1_loaded(avmcard *card) | 
 | { | 
 | 	unsigned int base = card->port; | 
 | 	unsigned long stop; | 
 | 	unsigned char ans; | 
 | 	unsigned long tout = 2; | 
 |  | 
 | 	for (stop = jiffies + tout * HZ; time_before(jiffies, stop);) { | 
 | 		if (b1_tx_empty(base)) | 
 | 			break; | 
 | 	} | 
 | 	if (!b1_tx_empty(base)) { | 
 | 		printk(KERN_ERR "%s: b1_loaded: tx err, corrupted t4 file ?\n", | 
 | 				card->name); | 
 | 		return 0; | 
 | 	} | 
 | 	b1_put_byte(base, SEND_POLL); | 
 | 	for (stop = jiffies + tout * HZ; time_before(jiffies, stop);) { | 
 | 		if (b1_rx_full(base)) { | 
 | 			if ((ans = b1_get_byte(base)) == RECEIVE_POLL) { | 
 | 				return 1; | 
 | 			} | 
 | 			printk(KERN_ERR "%s: b1_loaded: got 0x%x, firmware not running\n", | 
 | 					card->name, ans); | 
 | 			return 0; | 
 | 		} | 
 | 	} | 
 | 	printk(KERN_ERR "%s: b1_loaded: firmware not running\n", card->name); | 
 | 	return 0; | 
 | } | 
 |  | 
 | /* ------------------------------------------------------------- */ | 
 |  | 
 | int b1_load_firmware(struct capi_ctr *ctrl, capiloaddata *data) | 
 | { | 
 | 	avmctrl_info *cinfo = (avmctrl_info *)(ctrl->driverdata); | 
 | 	avmcard *card = cinfo->card; | 
 | 	unsigned int port = card->port; | 
 | 	unsigned long flags; | 
 | 	int retval; | 
 |  | 
 | 	b1_reset(port); | 
 |  | 
 | 	if ((retval = b1_load_t4file(card, &data->firmware))) { | 
 | 		b1_reset(port); | 
 | 		printk(KERN_ERR "%s: failed to load t4file!!\n", | 
 | 					card->name); | 
 | 		return retval; | 
 | 	} | 
 |  | 
 | 	b1_disable_irq(port); | 
 |  | 
 | 	if (data->configuration.len > 0 && data->configuration.data) { | 
 | 		if ((retval = b1_load_config(card, &data->configuration))) { | 
 | 			b1_reset(port); | 
 | 			printk(KERN_ERR "%s: failed to load config!!\n", | 
 | 					card->name); | 
 | 			return retval; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	if (!b1_loaded(card)) { | 
 | 		printk(KERN_ERR "%s: failed to load t4file.\n", card->name); | 
 | 		return -EIO; | 
 | 	} | 
 |  | 
 | 	spin_lock_irqsave(&card->lock, flags); | 
 | 	b1_setinterrupt(port, card->irq, card->cardtype); | 
 | 	b1_put_byte(port, SEND_INIT); | 
 | 	b1_put_word(port, CAPI_MAXAPPL); | 
 | 	b1_put_word(port, AVM_NCCI_PER_CHANNEL*2); | 
 | 	b1_put_word(port, ctrl->cnr - 1); | 
 | 	spin_unlock_irqrestore(&card->lock, flags); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | void b1_reset_ctr(struct capi_ctr *ctrl) | 
 | { | 
 | 	avmctrl_info *cinfo = (avmctrl_info *)(ctrl->driverdata); | 
 | 	avmcard *card = cinfo->card; | 
 | 	unsigned int port = card->port; | 
 |  | 
 | 	b1_reset(port); | 
 | 	b1_reset(port); | 
 |  | 
 | 	memset(cinfo->version, 0, sizeof(cinfo->version)); | 
 | 	capilib_release(&cinfo->ncci_head); | 
 | 	capi_ctr_reseted(ctrl); | 
 | } | 
 |  | 
 | void b1_register_appl(struct capi_ctr *ctrl, | 
 | 				u16 appl, | 
 | 				capi_register_params *rp) | 
 | { | 
 | 	avmctrl_info *cinfo = (avmctrl_info *)(ctrl->driverdata); | 
 | 	avmcard *card = cinfo->card; | 
 | 	unsigned int port = card->port; | 
 | 	unsigned long flags; | 
 | 	int nconn, want = rp->level3cnt; | 
 |  | 
 | 	if (want > 0) nconn = want; | 
 | 	else nconn = ctrl->profile.nbchannel * -want; | 
 | 	if (nconn == 0) nconn = ctrl->profile.nbchannel; | 
 |  | 
 | 	spin_lock_irqsave(&card->lock, flags); | 
 | 	b1_put_byte(port, SEND_REGISTER); | 
 | 	b1_put_word(port, appl); | 
 | 	b1_put_word(port, 1024 * (nconn+1)); | 
 | 	b1_put_word(port, nconn); | 
 | 	b1_put_word(port, rp->datablkcnt); | 
 | 	b1_put_word(port, rp->datablklen); | 
 | 	spin_unlock_irqrestore(&card->lock, flags); | 
 | } | 
 |  | 
 | void b1_release_appl(struct capi_ctr *ctrl, u16 appl) | 
 | { | 
 | 	avmctrl_info *cinfo = (avmctrl_info *)(ctrl->driverdata); | 
 | 	avmcard *card = cinfo->card; | 
 | 	unsigned int port = card->port; | 
 | 	unsigned long flags; | 
 |  | 
 | 	capilib_release_appl(&cinfo->ncci_head, appl); | 
 |  | 
 | 	spin_lock_irqsave(&card->lock, flags); | 
 | 	b1_put_byte(port, SEND_RELEASE); | 
 | 	b1_put_word(port, appl); | 
 | 	spin_unlock_irqrestore(&card->lock, flags); | 
 | } | 
 |  | 
 | u16 b1_send_message(struct capi_ctr *ctrl, struct sk_buff *skb) | 
 | { | 
 | 	avmctrl_info *cinfo = (avmctrl_info *)(ctrl->driverdata); | 
 | 	avmcard *card = cinfo->card; | 
 | 	unsigned int port = card->port; | 
 | 	unsigned long flags; | 
 | 	u16 len = CAPIMSG_LEN(skb->data); | 
 | 	u8 cmd = CAPIMSG_COMMAND(skb->data); | 
 | 	u8 subcmd = CAPIMSG_SUBCOMMAND(skb->data); | 
 | 	u16 dlen, retval; | 
 |  | 
 | 	if (CAPICMD(cmd, subcmd) == CAPI_DATA_B3_REQ) { | 
 | 		retval = capilib_data_b3_req(&cinfo->ncci_head, | 
 | 					     CAPIMSG_APPID(skb->data), | 
 | 					     CAPIMSG_NCCI(skb->data), | 
 | 					     CAPIMSG_MSGID(skb->data)); | 
 | 		if (retval != CAPI_NOERROR)  | 
 | 			return retval; | 
 |  | 
 | 		dlen = CAPIMSG_DATALEN(skb->data); | 
 |  | 
 | 	 	spin_lock_irqsave(&card->lock, flags); | 
 | 		b1_put_byte(port, SEND_DATA_B3_REQ); | 
 | 		b1_put_slice(port, skb->data, len); | 
 | 		b1_put_slice(port, skb->data + len, dlen); | 
 | 		spin_unlock_irqrestore(&card->lock, flags); | 
 | 	} else { | 
 | 	 	spin_lock_irqsave(&card->lock, flags); | 
 | 		b1_put_byte(port, SEND_MESSAGE); | 
 | 		b1_put_slice(port, skb->data, len); | 
 | 		spin_unlock_irqrestore(&card->lock, flags); | 
 | 	} | 
 |  | 
 | 	dev_kfree_skb_any(skb); | 
 | 	return CAPI_NOERROR; | 
 | } | 
 |  | 
 | /* ------------------------------------------------------------- */ | 
 |  | 
 | void b1_parse_version(avmctrl_info *cinfo) | 
 | { | 
 | 	struct capi_ctr *ctrl = &cinfo->capi_ctrl; | 
 | 	avmcard *card = cinfo->card; | 
 | 	capi_profile *profp; | 
 | 	u8 *dversion; | 
 | 	u8 flag; | 
 | 	int i, j; | 
 |  | 
 | 	for (j = 0; j < AVM_MAXVERSION; j++) | 
 | 		cinfo->version[j] = "\0\0" + 1; | 
 | 	for (i = 0, j = 0; | 
 | 	     j < AVM_MAXVERSION && i < cinfo->versionlen; | 
 | 	     j++, i += cinfo->versionbuf[i] + 1) | 
 | 		cinfo->version[j] = &cinfo->versionbuf[i + 1]; | 
 |  | 
 | 	strlcpy(ctrl->serial, cinfo->version[VER_SERIAL], sizeof(ctrl->serial)); | 
 | 	memcpy(&ctrl->profile, cinfo->version[VER_PROFILE],sizeof(capi_profile)); | 
 | 	strlcpy(ctrl->manu, "AVM GmbH", sizeof(ctrl->manu)); | 
 | 	dversion = cinfo->version[VER_DRIVER]; | 
 | 	ctrl->version.majorversion = 2; | 
 | 	ctrl->version.minorversion = 0; | 
 | 	ctrl->version.majormanuversion = (((dversion[0] - '0') & 0xf) << 4); | 
 | 	ctrl->version.majormanuversion |= ((dversion[2] - '0') & 0xf); | 
 | 	ctrl->version.minormanuversion = (dversion[3] - '0') << 4; | 
 | 	ctrl->version.minormanuversion |= | 
 | 			(dversion[5] - '0') * 10 + ((dversion[6] - '0') & 0xf); | 
 |  | 
 | 	profp = &ctrl->profile; | 
 |  | 
 | 	flag = ((u8 *)(profp->manu))[1]; | 
 | 	switch (flag) { | 
 | 	case 0: if (cinfo->version[VER_CARDTYPE]) | 
 | 	           strcpy(cinfo->cardname, cinfo->version[VER_CARDTYPE]); | 
 | 	        else strcpy(cinfo->cardname, "B1"); | 
 | 		break; | 
 | 	case 3: strcpy(cinfo->cardname,"PCMCIA B"); break; | 
 | 	case 4: strcpy(cinfo->cardname,"PCMCIA M1"); break; | 
 | 	case 5: strcpy(cinfo->cardname,"PCMCIA M2"); break; | 
 | 	case 6: strcpy(cinfo->cardname,"B1 V3.0"); break; | 
 | 	case 7: strcpy(cinfo->cardname,"B1 PCI"); break; | 
 | 	default: sprintf(cinfo->cardname, "AVM?%u", (unsigned int)flag); break; | 
 |         } | 
 |         printk(KERN_NOTICE "%s: card %d \"%s\" ready.\n", | 
 | 				card->name, ctrl->cnr, cinfo->cardname); | 
 |  | 
 |         flag = ((u8 *)(profp->manu))[3]; | 
 |         if (flag) | 
 | 		printk(KERN_NOTICE "%s: card %d Protocol:%s%s%s%s%s%s%s\n", | 
 | 			card->name, | 
 | 			ctrl->cnr, | 
 | 			(flag & 0x01) ? " DSS1" : "", | 
 | 			(flag & 0x02) ? " CT1" : "", | 
 | 			(flag & 0x04) ? " VN3" : "", | 
 | 			(flag & 0x08) ? " NI1" : "", | 
 | 			(flag & 0x10) ? " AUSTEL" : "", | 
 | 			(flag & 0x20) ? " ESS" : "", | 
 | 			(flag & 0x40) ? " 1TR6" : "" | 
 | 			); | 
 |  | 
 |         flag = ((u8 *)(profp->manu))[5]; | 
 | 	if (flag) | 
 | 		printk(KERN_NOTICE "%s: card %d Linetype:%s%s%s%s\n", | 
 | 			card->name, | 
 | 			ctrl->cnr, | 
 | 			(flag & 0x01) ? " point to point" : "", | 
 | 			(flag & 0x02) ? " point to multipoint" : "", | 
 | 			(flag & 0x08) ? " leased line without D-channel" : "", | 
 | 			(flag & 0x04) ? " leased line with D-channel" : "" | 
 | 			); | 
 | } | 
 |  | 
 | /* ------------------------------------------------------------- */ | 
 |  | 
 | irqreturn_t b1_interrupt(int interrupt, void *devptr, struct pt_regs *regs) | 
 | { | 
 | 	avmcard *card = devptr; | 
 | 	avmctrl_info *cinfo = &card->ctrlinfo[0]; | 
 | 	struct capi_ctr *ctrl = &cinfo->capi_ctrl; | 
 | 	unsigned char b1cmd; | 
 | 	struct sk_buff *skb; | 
 |  | 
 | 	unsigned ApplId; | 
 | 	unsigned MsgLen; | 
 | 	unsigned DataB3Len; | 
 | 	unsigned NCCI; | 
 | 	unsigned WindowSize; | 
 | 	unsigned long flags; | 
 |  | 
 | 	spin_lock_irqsave(&card->lock, flags); | 
 |  | 
 | 	if (!b1_rx_full(card->port)) { | 
 | 		spin_unlock_irqrestore(&card->lock, flags); | 
 | 		return IRQ_NONE; | 
 | 	} | 
 |  | 
 | 	b1cmd = b1_get_byte(card->port); | 
 |  | 
 | 	switch (b1cmd) { | 
 |  | 
 | 	case RECEIVE_DATA_B3_IND: | 
 |  | 
 | 		ApplId = (unsigned) b1_get_word(card->port); | 
 | 		MsgLen = b1_get_slice(card->port, card->msgbuf); | 
 | 		DataB3Len = b1_get_slice(card->port, card->databuf); | 
 | 		spin_unlock_irqrestore(&card->lock, flags); | 
 |  | 
 | 		if (MsgLen < 30) { /* not CAPI 64Bit */ | 
 | 			memset(card->msgbuf+MsgLen, 0, 30-MsgLen); | 
 | 			MsgLen = 30; | 
 | 			CAPIMSG_SETLEN(card->msgbuf, 30); | 
 | 		} | 
 | 		if (!(skb = alloc_skb(DataB3Len + MsgLen, GFP_ATOMIC))) { | 
 | 			printk(KERN_ERR "%s: incoming packet dropped\n", | 
 | 					card->name); | 
 | 		} else { | 
 | 			memcpy(skb_put(skb, MsgLen), card->msgbuf, MsgLen); | 
 | 			memcpy(skb_put(skb, DataB3Len), card->databuf, DataB3Len); | 
 | 			capi_ctr_handle_message(ctrl, ApplId, skb); | 
 | 		} | 
 | 		break; | 
 |  | 
 | 	case RECEIVE_MESSAGE: | 
 |  | 
 | 		ApplId = (unsigned) b1_get_word(card->port); | 
 | 		MsgLen = b1_get_slice(card->port, card->msgbuf); | 
 | 		spin_unlock_irqrestore(&card->lock, flags); | 
 | 		if (!(skb = alloc_skb(MsgLen, GFP_ATOMIC))) { | 
 | 			printk(KERN_ERR "%s: incoming packet dropped\n", | 
 | 					card->name); | 
 | 		} else { | 
 | 			memcpy(skb_put(skb, MsgLen), card->msgbuf, MsgLen); | 
 | 			if (CAPIMSG_CMD(skb->data) == CAPI_DATA_B3_CONF) | 
 | 				capilib_data_b3_conf(&cinfo->ncci_head, ApplId, | 
 | 						     CAPIMSG_NCCI(skb->data), | 
 | 						     CAPIMSG_MSGID(skb->data)); | 
 |  | 
 | 			capi_ctr_handle_message(ctrl, ApplId, skb); | 
 | 		} | 
 | 		break; | 
 |  | 
 | 	case RECEIVE_NEW_NCCI: | 
 |  | 
 | 		ApplId = b1_get_word(card->port); | 
 | 		NCCI = b1_get_word(card->port); | 
 | 		WindowSize = b1_get_word(card->port); | 
 | 		spin_unlock_irqrestore(&card->lock, flags); | 
 |  | 
 | 		capilib_new_ncci(&cinfo->ncci_head, ApplId, NCCI, WindowSize); | 
 |  | 
 | 		break; | 
 |  | 
 | 	case RECEIVE_FREE_NCCI: | 
 |  | 
 | 		ApplId = b1_get_word(card->port); | 
 | 		NCCI = b1_get_word(card->port); | 
 | 		spin_unlock_irqrestore(&card->lock, flags); | 
 |  | 
 | 		if (NCCI != 0xffffffff) | 
 | 			capilib_free_ncci(&cinfo->ncci_head, ApplId, NCCI); | 
 | 	        | 
 | 		break; | 
 |  | 
 | 	case RECEIVE_START: | 
 | 	   	/* b1_put_byte(card->port, SEND_POLLACK); */ | 
 | 		spin_unlock_irqrestore(&card->lock, flags); | 
 | 		capi_ctr_resume_output(ctrl); | 
 | 		break; | 
 |  | 
 | 	case RECEIVE_STOP: | 
 | 		spin_unlock_irqrestore(&card->lock, flags); | 
 | 		capi_ctr_suspend_output(ctrl); | 
 | 		break; | 
 |  | 
 | 	case RECEIVE_INIT: | 
 |  | 
 | 		cinfo->versionlen = b1_get_slice(card->port, cinfo->versionbuf); | 
 | 		spin_unlock_irqrestore(&card->lock, flags); | 
 | 		b1_parse_version(cinfo); | 
 | 		printk(KERN_INFO "%s: %s-card (%s) now active\n", | 
 | 		       card->name, | 
 | 		       cinfo->version[VER_CARDTYPE], | 
 | 		       cinfo->version[VER_DRIVER]); | 
 | 		capi_ctr_ready(ctrl); | 
 | 		break; | 
 |  | 
 | 	case RECEIVE_TASK_READY: | 
 | 		ApplId = (unsigned) b1_get_word(card->port); | 
 | 		MsgLen = b1_get_slice(card->port, card->msgbuf); | 
 | 		spin_unlock_irqrestore(&card->lock, flags); | 
 | 		card->msgbuf[MsgLen] = 0; | 
 | 		while (    MsgLen > 0 | 
 | 		       && (   card->msgbuf[MsgLen-1] == '\n' | 
 | 			   || card->msgbuf[MsgLen-1] == '\r')) { | 
 | 			card->msgbuf[MsgLen-1] = 0; | 
 | 			MsgLen--; | 
 | 		} | 
 | 		printk(KERN_INFO "%s: task %d \"%s\" ready.\n", | 
 | 				card->name, ApplId, card->msgbuf); | 
 | 		break; | 
 |  | 
 | 	case RECEIVE_DEBUGMSG: | 
 | 		MsgLen = b1_get_slice(card->port, card->msgbuf); | 
 | 		spin_unlock_irqrestore(&card->lock, flags); | 
 | 		card->msgbuf[MsgLen] = 0; | 
 | 		while (    MsgLen > 0 | 
 | 		       && (   card->msgbuf[MsgLen-1] == '\n' | 
 | 			   || card->msgbuf[MsgLen-1] == '\r')) { | 
 | 			card->msgbuf[MsgLen-1] = 0; | 
 | 			MsgLen--; | 
 | 		} | 
 | 		printk(KERN_INFO "%s: DEBUG: %s\n", card->name, card->msgbuf); | 
 | 		break; | 
 |  | 
 | 	case 0xff: | 
 | 		spin_unlock_irqrestore(&card->lock, flags); | 
 | 		printk(KERN_ERR "%s: card removed ?\n", card->name); | 
 | 		return IRQ_NONE; | 
 | 	default: | 
 | 		spin_unlock_irqrestore(&card->lock, flags); | 
 | 		printk(KERN_ERR "%s: b1_interrupt: 0x%x ???\n", | 
 | 				card->name, b1cmd); | 
 | 		return IRQ_HANDLED; | 
 | 	} | 
 | 	return IRQ_HANDLED; | 
 | } | 
 |  | 
 | /* ------------------------------------------------------------- */ | 
 | int b1ctl_read_proc(char *page, char **start, off_t off, | 
 |         		int count, int *eof, struct capi_ctr *ctrl) | 
 | { | 
 | 	avmctrl_info *cinfo = (avmctrl_info *)(ctrl->driverdata); | 
 | 	avmcard *card = cinfo->card; | 
 | 	u8 flag; | 
 | 	int len = 0; | 
 | 	char *s; | 
 |  | 
 | 	len += sprintf(page+len, "%-16s %s\n", "name", card->name); | 
 | 	len += sprintf(page+len, "%-16s 0x%x\n", "io", card->port); | 
 | 	len += sprintf(page+len, "%-16s %d\n", "irq", card->irq); | 
 | 	switch (card->cardtype) { | 
 | 	case avm_b1isa: s = "B1 ISA"; break; | 
 | 	case avm_b1pci: s = "B1 PCI"; break; | 
 | 	case avm_b1pcmcia: s = "B1 PCMCIA"; break; | 
 | 	case avm_m1: s = "M1"; break; | 
 | 	case avm_m2: s = "M2"; break; | 
 | 	case avm_t1isa: s = "T1 ISA (HEMA)"; break; | 
 | 	case avm_t1pci: s = "T1 PCI"; break; | 
 | 	case avm_c4: s = "C4"; break; | 
 | 	case avm_c2: s = "C2"; break; | 
 | 	default: s = "???"; break; | 
 | 	} | 
 | 	len += sprintf(page+len, "%-16s %s\n", "type", s); | 
 | 	if (card->cardtype == avm_t1isa) | 
 | 	   len += sprintf(page+len, "%-16s %d\n", "cardnr", card->cardnr); | 
 | 	if ((s = cinfo->version[VER_DRIVER]) != 0) | 
 | 	   len += sprintf(page+len, "%-16s %s\n", "ver_driver", s); | 
 | 	if ((s = cinfo->version[VER_CARDTYPE]) != 0) | 
 | 	   len += sprintf(page+len, "%-16s %s\n", "ver_cardtype", s); | 
 | 	if ((s = cinfo->version[VER_SERIAL]) != 0) | 
 | 	   len += sprintf(page+len, "%-16s %s\n", "ver_serial", s); | 
 |  | 
 | 	if (card->cardtype != avm_m1) { | 
 |         	flag = ((u8 *)(ctrl->profile.manu))[3]; | 
 |         	if (flag) | 
 | 			len += sprintf(page+len, "%-16s%s%s%s%s%s%s%s\n", | 
 | 			"protocol", | 
 | 			(flag & 0x01) ? " DSS1" : "", | 
 | 			(flag & 0x02) ? " CT1" : "", | 
 | 			(flag & 0x04) ? " VN3" : "", | 
 | 			(flag & 0x08) ? " NI1" : "", | 
 | 			(flag & 0x10) ? " AUSTEL" : "", | 
 | 			(flag & 0x20) ? " ESS" : "", | 
 | 			(flag & 0x40) ? " 1TR6" : "" | 
 | 			); | 
 | 	} | 
 | 	if (card->cardtype != avm_m1) { | 
 |         	flag = ((u8 *)(ctrl->profile.manu))[5]; | 
 | 		if (flag) | 
 | 			len += sprintf(page+len, "%-16s%s%s%s%s\n", | 
 | 			"linetype", | 
 | 			(flag & 0x01) ? " point to point" : "", | 
 | 			(flag & 0x02) ? " point to multipoint" : "", | 
 | 			(flag & 0x08) ? " leased line without D-channel" : "", | 
 | 			(flag & 0x04) ? " leased line with D-channel" : "" | 
 | 			); | 
 | 	} | 
 | 	len += sprintf(page+len, "%-16s %s\n", "cardname", cinfo->cardname); | 
 |  | 
 | 	if (off+count >= len) | 
 | 	   *eof = 1; | 
 | 	if (len < off) | 
 |            return 0; | 
 | 	*start = page + off; | 
 | 	return ((count < len-off) ? count : len-off); | 
 | } | 
 |  | 
 | /* ------------------------------------------------------------- */ | 
 |  | 
 | #ifdef CONFIG_PCI | 
 |  | 
 | avmcard_dmainfo * | 
 | avmcard_dma_alloc(char *name, struct pci_dev *pdev, long rsize, long ssize) | 
 | { | 
 | 	avmcard_dmainfo *p; | 
 | 	void *buf; | 
 |  | 
 | 	p = kmalloc(sizeof(avmcard_dmainfo), GFP_KERNEL); | 
 | 	if (!p) { | 
 | 		printk(KERN_WARNING "%s: no memory.\n", name); | 
 | 		goto err; | 
 | 	} | 
 | 	memset(p, 0, sizeof(avmcard_dmainfo)); | 
 |  | 
 | 	p->recvbuf.size = rsize; | 
 | 	buf = pci_alloc_consistent(pdev, rsize, &p->recvbuf.dmaaddr); | 
 | 	if (!buf) { | 
 | 		printk(KERN_WARNING "%s: allocation of receive dma buffer failed.\n", name); | 
 | 		goto err_kfree; | 
 | 	} | 
 | 	p->recvbuf.dmabuf = buf; | 
 |  | 
 | 	p->sendbuf.size = ssize; | 
 | 	buf = pci_alloc_consistent(pdev, ssize, &p->sendbuf.dmaaddr); | 
 | 	if (!buf) { | 
 | 		printk(KERN_WARNING "%s: allocation of send dma buffer failed.\n", name); | 
 | 		goto err_free_consistent; | 
 | 	} | 
 |  | 
 | 	p->sendbuf.dmabuf = buf; | 
 | 	skb_queue_head_init(&p->send_queue); | 
 |  | 
 | 	return p; | 
 |  | 
 |  err_free_consistent: | 
 | 	pci_free_consistent(p->pcidev, p->recvbuf.size, | 
 | 			    p->recvbuf.dmabuf, p->recvbuf.dmaaddr); | 
 |  err_kfree: | 
 | 	kfree(p); | 
 |  err: | 
 | 	return NULL; | 
 | } | 
 |  | 
 | void avmcard_dma_free(avmcard_dmainfo *p) | 
 | { | 
 | 	pci_free_consistent(p->pcidev, p->recvbuf.size, | 
 | 			    p->recvbuf.dmabuf, p->recvbuf.dmaaddr); | 
 | 	pci_free_consistent(p->pcidev, p->sendbuf.size, | 
 | 			    p->sendbuf.dmabuf, p->sendbuf.dmaaddr); | 
 | 	skb_queue_purge(&p->send_queue); | 
 | 	kfree(p); | 
 | } | 
 |  | 
 | EXPORT_SYMBOL(avmcard_dma_alloc); | 
 | EXPORT_SYMBOL(avmcard_dma_free); | 
 |  | 
 | #endif | 
 |  | 
 | EXPORT_SYMBOL(b1_irq_table); | 
 |  | 
 | EXPORT_SYMBOL(b1_alloc_card); | 
 | EXPORT_SYMBOL(b1_free_card); | 
 | EXPORT_SYMBOL(b1_detect); | 
 | EXPORT_SYMBOL(b1_getrevision); | 
 | EXPORT_SYMBOL(b1_load_t4file); | 
 | EXPORT_SYMBOL(b1_load_config); | 
 | EXPORT_SYMBOL(b1_loaded); | 
 | EXPORT_SYMBOL(b1_load_firmware); | 
 | EXPORT_SYMBOL(b1_reset_ctr); | 
 | EXPORT_SYMBOL(b1_register_appl); | 
 | EXPORT_SYMBOL(b1_release_appl); | 
 | EXPORT_SYMBOL(b1_send_message); | 
 |  | 
 | EXPORT_SYMBOL(b1_parse_version); | 
 | EXPORT_SYMBOL(b1_interrupt); | 
 |  | 
 | EXPORT_SYMBOL(b1ctl_read_proc); | 
 |  | 
 | static int __init b1_init(void) | 
 | { | 
 | 	char *p; | 
 | 	char rev[32]; | 
 |  | 
 | 	if ((p = strchr(revision, ':')) != 0 && p[1]) { | 
 | 		strlcpy(rev, p + 2, 32); | 
 | 		if ((p = strchr(rev, '$')) != 0 && p > rev) | 
 | 		   *(p-1) = 0; | 
 | 	} else | 
 | 		strcpy(rev, "1.0"); | 
 |  | 
 | 	printk(KERN_INFO "b1: revision %s\n", rev); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static void __exit b1_exit(void) | 
 | { | 
 | } | 
 |  | 
 | module_init(b1_init); | 
 | module_exit(b1_exit); |