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); |