drivers/isdn/hardware/avm/avm_cs.c

   1 /* $Id: avm_cs.c,v 1.4.6.3 2001/09/23 22:24:33 kai Exp $
   2  *
   3  * A PCMCIA client driver for AVM B1/M1/M2
   4  *
   5  * Copyright 1999 by Carsten Paeth <calle@calle.de>
   6  *
   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/init.h>
  15 #include <linux/ptrace.h>
  16 #include <linux/string.h>
  17 #include <linux/tty.h>
  18 #include <linux/serial.h>
  19 #include <linux/major.h>
  20 #include <asm/io.h>
  21 #include <asm/system.h>
  22
  23 #include <pcmcia/cistpl.h>
  24 #include <pcmcia/ciscode.h>
  25 #include <pcmcia/ds.h>
  26 #include <pcmcia/cisreg.h>
  27
  28 #include <linux/skbuff.h>
  29 #include <linux/capi.h>
  30 #include <linux/b1lli.h>
  31 #include <linux/b1pcmcia.h>
  32
  33 /*====================================================================*/
  34
  35 MODULE_DESCRIPTION("CAPI4Linux: PCMCIA client driver for AVM B1/M1/M2");
  36 MODULE_AUTHOR("Carsten Paeth");
  37 MODULE_LICENSE("GPL");
  38
  39 /*====================================================================*/
  40
  41 /*
  42    The event() function is this driver's Card Services event handler.
  43    It will be called by Card Services when an appropriate card status
  44    event is received.  The config() and release() entry points are
  45    used to configure or release a socket, in response to card insertion
  46    and ejection events.  They are invoked from the skeleton event
  47    handler.
  48 */
  49
  50 static int avmcs_config(struct pcmcia_device *link);
  51 static void avmcs_release(struct pcmcia_device *link);
  52
  53 /*
  54    The attach() and detach() entry points are used to create and destroy
  55    "instances" of the driver, where each instance represents everything
  56    needed to manage one actual PCMCIA card.
  57 */
  58
  59 static void avmcs_detach(struct pcmcia_device *p_dev);
  60
  61 /*======================================================================
  62
  63     avmcs_attach() creates an "instance" of the driver, allocating
  64     local data structures for one device.  The device is registered
  65     with Card Services.
  66
  67     The dev_link structure is initialized, but we don't actually
  68     configure the card at this point -- we wait until we receive a
  69     card insertion event.
  70
  71 ======================================================================*/
  72
  73 static int avmcs_probe(struct pcmcia_device *p_dev)
  74 {
  75     /* General socket configuration */
  76     p_dev->config_flags |= CONF_ENABLE_IRQ | CONF_AUTO_SET_IO;
  77     p_dev->config_index = 1;
  78     p_dev->config_regs = PRESENT_OPTION;
  79
  80     return avmcs_config(p_dev);
  81 } /* avmcs_attach */
  82
  83 /*======================================================================
  84
  85     This deletes a driver "instance".  The device is de-registered
  86     with Card Services.  If it has been released, all local data
  87     structures are freed.  Otherwise, the structures will be freed
  88     when the device is released.
  89
  90 ======================================================================*/
  91
  92 static void avmcs_detach(struct pcmcia_device *link)
  93 {
  94         avmcs_release(link);
  95 } /* avmcs_detach */
  96
  97 /*======================================================================
  98
  99     avmcs_config() is scheduled to run after a CARD_INSERTION event
 100     is received, to configure the PCMCIA socket, and to make the
 101     ethernet device available to the system.
 102
 103 ======================================================================*/
 104
 105 static int avmcs_configcheck(struct pcmcia_device *p_dev, void *priv_data)
 106 {
 107         p_dev->resource[0]->end = 16;
 108         p_dev->resource[0]->flags &= ~IO_DATA_PATH_WIDTH;
 109         p_dev->resource[0]->flags |= IO_DATA_PATH_WIDTH_8;
 110
 111         return pcmcia_request_io(p_dev);
 112 }
 113
 114 static int avmcs_config(struct pcmcia_device *link)
 115 {
 116     int i = -1;
 117     char devname[128];
 118     int cardtype;
 119     int (*addcard)(unsigned int port, unsigned irq);
 120
 121     devname[0] = 0;
 122     if (link->prod_id[1])
 123             strlcpy(devname, link->prod_id[1], sizeof(devname));
 124
 125     /*
 126      * find IO port
 127      */
 128     if (pcmcia_loop_config(link, avmcs_configcheck, NULL))
 129             return -ENODEV;
 130
 131     do {
 132         if (!link->irq) {
 133             /* undo */
 134             pcmcia_disable_device(link);
 135             break;
 136         }
 137
 138         /*
 139          * configure the PCMCIA socket
 140           */
 141         i = pcmcia_enable_device(link);
 142         if (i != 0) {
 143             pcmcia_disable_device(link);
 144             break;
 145         }
 146
 147     } while (0);
 148
 149     if (devname[0]) {
 150         char *s = strrchr(devname, ' ');
 151         if (!s)
 152            s = devname;
 153         else s++;
 154         if (strcmp("M1", s) == 0) {
 155            cardtype = AVM_CARDTYPE_M1;
 156         } else if (strcmp("M2", s) == 0) {
 157            cardtype = AVM_CARDTYPE_M2;
 158         } else {
 159            cardtype = AVM_CARDTYPE_B1;
 160         }
 161     } else
 162         cardtype = AVM_CARDTYPE_B1;
 163
 164     /* If any step failed, release any partially configured state */
 165     if (i != 0) {
 166         avmcs_release(link);
 167         return -ENODEV;
 168     }
 169
 170
 171     switch (cardtype) {
 172         case AVM_CARDTYPE_M1: addcard = b1pcmcia_addcard_m1; break;
 173         case AVM_CARDTYPE_M2: addcard = b1pcmcia_addcard_m2; break;
 174         default:
 175         case AVM_CARDTYPE_B1: addcard = b1pcmcia_addcard_b1; break;
 176     }
 177     if ((i = (*addcard)(link->resource[0]->start, link->irq)) < 0) {
 178             dev_err(&link->dev,
 179                     "avm_cs: failed to add AVM-Controller at i/o %#x, irq %d\n",
 180                     (unsigned int) link->resource[0]->start, link->irq);
 181             avmcs_release(link);
 182             return -ENODEV;
 183     }
 184     return 0;
 185
 186 } /* avmcs_config */
 187
 188 /*======================================================================
 189
 190     After a card is removed, avmcs_release() will unregister the net
 191     device, and release the PCMCIA configuration.  If the device is
 192     still open, this will be postponed until it is closed.
 193
 194 ======================================================================*/
 195
 196 static void avmcs_release(struct pcmcia_device *link)
 197 {
 198         b1pcmcia_delcard(link->resource[0]->start, link->irq);
 199         pcmcia_disable_device(link);
 200 } /* avmcs_release */
 201
 202
 203 static struct pcmcia_device_id avmcs_ids[] = {
 204         PCMCIA_DEVICE_PROD_ID12("AVM", "ISDN-Controller B1", 0x95d42008, 0x845dc335),
 205         PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M1", 0x95d42008, 0x81e10430),
 206         PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M2", 0x95d42008, 0x18e8558a),
 207         PCMCIA_DEVICE_NULL
 208 };
 209 MODULE_DEVICE_TABLE(pcmcia, avmcs_ids);
 210
 211 static struct pcmcia_driver avmcs_driver = {
 212         .owner  = THIS_MODULE,
 213         .name           = "avm_cs",
 214         .probe = avmcs_probe,
 215         .remove = avmcs_detach,
 216         .id_table = avmcs_ids,
 217 };
 218
 219 static int __init avmcs_init(void)
 220 {
 221         return pcmcia_register_driver(&avmcs_driver);
 222 }
 223
 224 static void __exit avmcs_exit(void)
 225 {
 226         pcmcia_unregister_driver(&avmcs_driver);
 227 }
 228
 229 module_init(avmcs_init);
 230 module_exit(avmcs_exit);