| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* $Id: b1pcmcia.c,v 1.1.2.2 2004/01/16 21:09:27 keil Exp $ | 
| Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 2 |  * | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3 |  * Module for AVM B1/M1/M2 PCMCIA-card. | 
| Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 4 |  * | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5 |  * Copyright 1999 by Carsten Paeth <calle@calle.de> | 
| Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 6 |  * | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 7 |  * This software may be used and distributed according to the terms | 
 | 8 |  * of the GNU General Public License, incorporated herein by reference. | 
 | 9 |  * | 
 | 10 |  */ | 
 | 11 |  | 
 | 12 | #include <linux/module.h> | 
 | 13 | #include <linux/kernel.h> | 
 | 14 | #include <linux/skbuff.h> | 
 | 15 | #include <linux/delay.h> | 
 | 16 | #include <linux/mm.h> | 
 | 17 | #include <linux/interrupt.h> | 
 | 18 | #include <linux/ioport.h> | 
 | 19 | #include <linux/init.h> | 
 | 20 | #include <asm/io.h> | 
 | 21 | #include <linux/capi.h> | 
 | 22 | #include <linux/b1pcmcia.h> | 
 | 23 | #include <linux/isdn/capicmd.h> | 
 | 24 | #include <linux/isdn/capiutil.h> | 
 | 25 | #include <linux/isdn/capilli.h> | 
 | 26 | #include "avmcard.h" | 
 | 27 |  | 
 | 28 | /* ------------------------------------------------------------- */ | 
 | 29 |  | 
 | 30 | static char *revision = "$Revision: 1.1.2.2 $"; | 
 | 31 |  | 
 | 32 | /* ------------------------------------------------------------- */ | 
 | 33 |  | 
 | 34 | MODULE_DESCRIPTION("CAPI4Linux: Driver for AVM PCMCIA cards"); | 
 | 35 | MODULE_AUTHOR("Carsten Paeth"); | 
 | 36 | MODULE_LICENSE("GPL"); | 
 | 37 |  | 
 | 38 | /* ------------------------------------------------------------- */ | 
 | 39 |  | 
 | 40 | static void b1pcmcia_remove_ctr(struct capi_ctr *ctrl) | 
 | 41 | { | 
 | 42 | 	avmctrl_info *cinfo = (avmctrl_info *)(ctrl->driverdata); | 
 | 43 | 	avmcard *card = cinfo->card; | 
 | 44 | 	unsigned int port = card->port; | 
 | 45 |  | 
 | 46 | 	b1_reset(port); | 
 | 47 | 	b1_reset(port); | 
 | 48 |  | 
 | 49 | 	detach_capi_ctr(ctrl); | 
 | 50 | 	free_irq(card->irq, card); | 
 | 51 | 	b1_free_card(card); | 
 | 52 | } | 
 | 53 |  | 
 | 54 | /* ------------------------------------------------------------- */ | 
 | 55 |  | 
 | 56 | static LIST_HEAD(cards); | 
 | 57 |  | 
 | 58 | static char *b1pcmcia_procinfo(struct capi_ctr *ctrl); | 
 | 59 |  | 
 | 60 | static int b1pcmcia_add_card(unsigned int port, unsigned irq, | 
 | 61 | 			     enum avmcardtype cardtype) | 
 | 62 | { | 
 | 63 | 	avmctrl_info *cinfo; | 
 | 64 | 	avmcard *card; | 
 | 65 | 	char *cardname; | 
 | 66 | 	int retval; | 
 | 67 |  | 
 | 68 | 	card = b1_alloc_card(1); | 
 | 69 | 	if (!card) { | 
 | 70 | 		printk(KERN_WARNING "b1pcmcia: no memory.\n"); | 
 | 71 | 		retval = -ENOMEM; | 
 | 72 | 		goto err; | 
 | 73 | 	} | 
 | 74 | 	cinfo = card->ctrlinfo; | 
 | 75 |  | 
 | 76 | 	switch (cardtype) { | 
| Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 77 | 	case avm_m1: sprintf(card->name, "m1-%x", port); break; | 
 | 78 | 	case avm_m2: sprintf(card->name, "m2-%x", port); break; | 
 | 79 | 	default: sprintf(card->name, "b1pcmcia-%x", port); break; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 80 | 	} | 
 | 81 | 	card->port = port; | 
 | 82 | 	card->irq = irq; | 
 | 83 | 	card->cardtype = cardtype; | 
 | 84 |  | 
| Thomas Gleixner | 9ba02be | 2006-07-01 19:29:36 -0700 | [diff] [blame] | 85 | 	retval = request_irq(card->irq, b1_interrupt, IRQF_SHARED, card->name, card); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 86 | 	if (retval) { | 
 | 87 | 		printk(KERN_ERR "b1pcmcia: unable to get IRQ %d.\n", | 
 | 88 | 		       card->irq); | 
 | 89 | 		retval = -EBUSY; | 
 | 90 | 		goto err_free; | 
 | 91 | 	} | 
 | 92 | 	b1_reset(card->port); | 
 | 93 | 	if ((retval = b1_detect(card->port, card->cardtype)) != 0) { | 
 | 94 | 		printk(KERN_NOTICE "b1pcmcia: NO card at 0x%x (%d)\n", | 
 | 95 | 		       card->port, retval); | 
 | 96 | 		retval = -ENODEV; | 
 | 97 | 		goto err_free_irq; | 
 | 98 | 	} | 
 | 99 | 	b1_reset(card->port); | 
 | 100 | 	b1_getrevision(card); | 
 | 101 |  | 
 | 102 | 	cinfo->capi_ctrl.owner         = THIS_MODULE; | 
 | 103 | 	cinfo->capi_ctrl.driver_name   = "b1pcmcia"; | 
 | 104 | 	cinfo->capi_ctrl.driverdata    = cinfo; | 
 | 105 | 	cinfo->capi_ctrl.register_appl = b1_register_appl; | 
 | 106 | 	cinfo->capi_ctrl.release_appl  = b1_release_appl; | 
 | 107 | 	cinfo->capi_ctrl.send_message  = b1_send_message; | 
 | 108 | 	cinfo->capi_ctrl.load_firmware = b1_load_firmware; | 
 | 109 | 	cinfo->capi_ctrl.reset_ctr     = b1_reset_ctr; | 
 | 110 | 	cinfo->capi_ctrl.procinfo      = b1pcmcia_procinfo; | 
| Alexey Dobriyan | 9a58a80 | 2010-01-14 03:10:54 -0800 | [diff] [blame] | 111 | 	cinfo->capi_ctrl.proc_fops = &b1ctl_proc_fops; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 112 | 	strcpy(cinfo->capi_ctrl.name, card->name); | 
 | 113 |  | 
 | 114 | 	retval = attach_capi_ctr(&cinfo->capi_ctrl); | 
 | 115 | 	if (retval) { | 
 | 116 | 		printk(KERN_ERR "b1pcmcia: attach controller failed.\n"); | 
 | 117 | 		goto err_free_irq; | 
 | 118 | 	} | 
 | 119 | 	switch (cardtype) { | 
| Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 120 | 	case avm_m1: cardname = "M1"; break; | 
 | 121 | 	case avm_m2: cardname = "M2"; break; | 
 | 122 | 	default: cardname = "B1 PCMCIA"; break; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 123 | 	} | 
 | 124 |  | 
 | 125 | 	printk(KERN_INFO "b1pcmcia: AVM %s at i/o %#x, irq %d, revision %d\n", | 
 | 126 | 	       cardname, card->port, card->irq, card->revision); | 
 | 127 |  | 
 | 128 | 	list_add(&card->list, &cards); | 
 | 129 | 	return cinfo->capi_ctrl.cnr; | 
 | 130 |  | 
| Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 131 | err_free_irq: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 132 | 	free_irq(card->irq, card); | 
| Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 133 | err_free: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 134 | 	b1_free_card(card); | 
| Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 135 | err: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 136 | 	return retval; | 
 | 137 | } | 
 | 138 |  | 
 | 139 | /* ------------------------------------------------------------- */ | 
 | 140 |  | 
 | 141 | static char *b1pcmcia_procinfo(struct capi_ctr *ctrl) | 
 | 142 | { | 
 | 143 | 	avmctrl_info *cinfo = (avmctrl_info *)(ctrl->driverdata); | 
 | 144 |  | 
 | 145 | 	if (!cinfo) | 
 | 146 | 		return ""; | 
 | 147 | 	sprintf(cinfo->infobuf, "%s %s 0x%x %d r%d", | 
 | 148 | 		cinfo->cardname[0] ? cinfo->cardname : "-", | 
 | 149 | 		cinfo->version[VER_DRIVER] ? cinfo->version[VER_DRIVER] : "-", | 
 | 150 | 		cinfo->card ? cinfo->card->port : 0x0, | 
 | 151 | 		cinfo->card ? cinfo->card->irq : 0, | 
 | 152 | 		cinfo->card ? cinfo->card->revision : 0 | 
 | 153 | 		); | 
 | 154 | 	return cinfo->infobuf; | 
 | 155 | } | 
 | 156 |  | 
 | 157 | /* ------------------------------------------------------------- */ | 
 | 158 |  | 
 | 159 | int b1pcmcia_addcard_b1(unsigned int port, unsigned irq) | 
 | 160 | { | 
 | 161 | 	return b1pcmcia_add_card(port, irq, avm_b1pcmcia); | 
 | 162 | } | 
 | 163 |  | 
 | 164 | int b1pcmcia_addcard_m1(unsigned int port, unsigned irq) | 
 | 165 | { | 
 | 166 | 	return b1pcmcia_add_card(port, irq, avm_m1); | 
 | 167 | } | 
 | 168 |  | 
 | 169 | int b1pcmcia_addcard_m2(unsigned int port, unsigned irq) | 
 | 170 | { | 
 | 171 | 	return b1pcmcia_add_card(port, irq, avm_m2); | 
 | 172 | } | 
 | 173 |  | 
 | 174 | int b1pcmcia_delcard(unsigned int port, unsigned irq) | 
 | 175 | { | 
 | 176 | 	struct list_head *l; | 
 | 177 | 	avmcard *card; | 
| Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 178 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 179 | 	list_for_each(l, &cards) { | 
 | 180 | 		card = list_entry(l, avmcard, list); | 
 | 181 | 		if (card->port == port && card->irq == irq) { | 
 | 182 | 			b1pcmcia_remove_ctr(&card->ctrlinfo[0].capi_ctrl); | 
 | 183 | 			return 0; | 
 | 184 | 		} | 
 | 185 | 	} | 
 | 186 | 	return -ESRCH; | 
 | 187 | } | 
 | 188 |  | 
 | 189 | EXPORT_SYMBOL(b1pcmcia_addcard_b1); | 
 | 190 | EXPORT_SYMBOL(b1pcmcia_addcard_m1); | 
 | 191 | EXPORT_SYMBOL(b1pcmcia_addcard_m2); | 
 | 192 | EXPORT_SYMBOL(b1pcmcia_delcard); | 
 | 193 |  | 
 | 194 | static struct capi_driver capi_driver_b1pcmcia = { | 
 | 195 | 	.name		= "b1pcmcia", | 
 | 196 | 	.revision	= "1.0", | 
 | 197 | }; | 
 | 198 |  | 
 | 199 | static int __init b1pcmcia_init(void) | 
 | 200 | { | 
 | 201 | 	char *p; | 
 | 202 | 	char rev[32]; | 
 | 203 |  | 
| Harvey Harrison | 8e44b29 | 2008-04-28 02:14:38 -0700 | [diff] [blame] | 204 | 	if ((p = strchr(revision, ':')) != NULL && p[1]) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 205 | 		strlcpy(rev, p + 2, 32); | 
| Harvey Harrison | 8e44b29 | 2008-04-28 02:14:38 -0700 | [diff] [blame] | 206 | 		if ((p = strchr(rev, '$')) != NULL && p > rev) | 
| Joe Perches | 475be4d | 2012-02-19 19:52:38 -0800 | [diff] [blame] | 207 | 			*(p - 1) = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 208 | 	} else | 
 | 209 | 		strcpy(rev, "1.0"); | 
 | 210 |  | 
 | 211 | 	strlcpy(capi_driver_b1pcmcia.revision, rev, 32); | 
 | 212 | 	register_capi_driver(&capi_driver_b1pcmcia); | 
 | 213 | 	printk(KERN_INFO "b1pci: revision %s\n", rev); | 
 | 214 |  | 
 | 215 | 	return 0; | 
 | 216 | } | 
 | 217 |  | 
 | 218 | static void __exit b1pcmcia_exit(void) | 
 | 219 | { | 
 | 220 | 	unregister_capi_driver(&capi_driver_b1pcmcia); | 
 | 221 | } | 
 | 222 |  | 
 | 223 | module_init(b1pcmcia_init); | 
 | 224 | module_exit(b1pcmcia_exit); |