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/sched.h>
  16 #include <linux/ptrace.h>
  17 #include <linux/slab.h>
  18 #include <linux/string.h>
  19 #include <linux/tty.h>
  20 #include <linux/serial.h>
  21 #include <linux/major.h>
  22 #include <asm/io.h>
  23 #include <asm/system.h>
  24
  25 #include <pcmcia/cs_types.h>
  26 #include <pcmcia/cs.h>
  27 #include <pcmcia/cistpl.h>
  28 #include <pcmcia/ciscode.h>
  29 #include <pcmcia/ds.h>
  30 #include <pcmcia/cisreg.h>
  31
  32 #include <linux/skbuff.h>
  33 #include <linux/capi.h>
  34 #include <linux/b1lli.h>
  35 #include <linux/b1pcmcia.h>
  36
  37 /*====================================================================*/
  38
  39 MODULE_DESCRIPTION("CAPI4Linux: PCMCIA client driver for AVM B1/M1/M2");
  40 MODULE_AUTHOR("Carsten Paeth");
  41 MODULE_LICENSE("GPL");
  42
  43 /*====================================================================*/
  44
  45 /*
  46    The event() function is this driver's Card Services event handler.
  47    It will be called by Card Services when an appropriate card status
  48    event is received.  The config() and release() entry points are
  49    used to configure or release a socket, in response to card insertion
  50    and ejection events.  They are invoked from the skeleton event
  51    handler.
  52 */
  53
  54 static int avmcs_config(struct pcmcia_device *link);
  55 static void avmcs_release(struct pcmcia_device *link);
  56
  57 /*
  58    The attach() and detach() entry points are used to create and destroy
  59    "instances" of the driver, where each instance represents everything
  60    needed to manage one actual PCMCIA card.
  61 */
  62
  63 static void avmcs_detach(struct pcmcia_device *p_dev);
  64
  65 /*
  66    A linked list of "instances" of the skeleton device.  Each actual
  67    PCMCIA card corresponds to one device instance, and is described
  68    by one struct pcmcia_device structure (defined in ds.h).
  69
  70    You may not want to use a linked list for this -- for example, the
  71    memory card driver uses an array of struct pcmcia_device pointers, where minor
  72    device numbers are used to derive the corresponding array index.
  73 */
  74
  75 /*
  76    A driver needs to provide a dev_node_t structure for each device
  77    on a card.  In some cases, there is only one device per card (for
  78    example, ethernet cards, modems).  In other cases, there may be
  79    many actual or logical devices (SCSI adapters, memory cards with
  80    multiple partitions).  The dev_node_t structures need to be kept
  81    in a linked list starting at the 'dev' field of a struct pcmcia_device
  82    structure.  We allocate them in the card's private data structure,
  83    because they generally can't be allocated dynamically.
  84 */
  85
  86 typedef struct local_info_t {
  87     dev_node_t  node;
  88 } local_info_t;
  89
  90 /*======================================================================
  91
  92     avmcs_attach() creates an "instance" of the driver, allocating
  93     local data structures for one device.  The device is registered
  94     with Card Services.
  95
  96     The dev_link structure is initialized, but we don't actually
  97     configure the card at this point -- we wait until we receive a
  98     card insertion event.
  99
 100 ======================================================================*/
 101
 102 static int avmcs_probe(struct pcmcia_device *p_dev)
 103 {
 104     local_info_t *local;
 105
 106     /* The io structure describes IO port mapping */
 107     p_dev->io.NumPorts1 = 16;
 108     p_dev->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
 109     p_dev->io.NumPorts2 = 0;
 110
 111     /* Interrupt setup */
 112     p_dev->irq.Attributes = IRQ_TYPE_EXCLUSIVE;
 113     p_dev->irq.Attributes = IRQ_TYPE_DYNAMIC_SHARING|IRQ_FIRST_SHARED;
 114
 115     p_dev->irq.IRQInfo1 = IRQ_LEVEL_ID;
 116
 117     /* General socket configuration */
 118     p_dev->conf.Attributes = CONF_ENABLE_IRQ;
 119     p_dev->conf.IntType = INT_MEMORY_AND_IO;
 120     p_dev->conf.ConfigIndex = 1;
 121     p_dev->conf.Present = PRESENT_OPTION;
 122
 123     /* Allocate space for private device-specific data */
 124     local = kmalloc(sizeof(local_info_t), GFP_KERNEL);
 125     if (!local)
 126         goto err;
 127     memset(local, 0, sizeof(local_info_t));
 128     p_dev->priv = local;
 129
 130     return avmcs_config(p_dev);
 131
 132  err:
 133     return -ENOMEM;
 134 } /* avmcs_attach */
 135
 136 /*======================================================================
 137
 138     This deletes a driver "instance".  The device is de-registered
 139     with Card Services.  If it has been released, all local data
 140     structures are freed.  Otherwise, the structures will be freed
 141     when the device is released.
 142
 143 ======================================================================*/
 144
 145 static void avmcs_detach(struct pcmcia_device *link)
 146 {
 147         avmcs_release(link);
 148         kfree(link->priv);
 149 } /* avmcs_detach */
 150
 151 /*======================================================================
 152
 153     avmcs_config() is scheduled to run after a CARD_INSERTION event
 154     is received, to configure the PCMCIA socket, and to make the
 155     ethernet device available to the system.
 156
 157 ======================================================================*/
 158
 159 static int get_tuple(struct pcmcia_device *handle, tuple_t *tuple,
 160                      cisparse_t *parse)
 161 {
 162     int i = pcmcia_get_tuple_data(handle, tuple);
 163     if (i != CS_SUCCESS) return i;
 164     return pcmcia_parse_tuple(handle, tuple, parse);
 165 }
 166
 167 static int first_tuple(struct pcmcia_device *handle, tuple_t *tuple,
 168                      cisparse_t *parse)
 169 {
 170     int i = pcmcia_get_first_tuple(handle, tuple);
 171     if (i != CS_SUCCESS) return i;
 172     return get_tuple(handle, tuple, parse);
 173 }
 174
 175 static int next_tuple(struct pcmcia_device *handle, tuple_t *tuple,
 176                      cisparse_t *parse)
 177 {
 178     int i = pcmcia_get_next_tuple(handle, tuple);
 179     if (i != CS_SUCCESS) return i;
 180     return get_tuple(handle, tuple, parse);
 181 }
 182
 183 static int avmcs_config(struct pcmcia_device *link)
 184 {
 185     tuple_t tuple;
 186     cisparse_t parse;
 187     cistpl_cftable_entry_t *cf = &parse.cftable_entry;
 188     local_info_t *dev;
 189     int i;
 190     u_char buf[64];
 191     char devname[128];
 192     int cardtype;
 193     int (*addcard)(unsigned int port, unsigned irq);
 194
 195     dev = link->priv;
 196
 197     do {
 198         devname[0] = 0;
 199         if (link->prod_id[1])
 200                 strlcpy(devname, link->prod_id[1], sizeof(devname));
 201
 202         /*
 203          * find IO port
 204          */
 205         tuple.TupleData = (cisdata_t *)buf;
 206         tuple.TupleOffset = 0; tuple.TupleDataMax = 255;
 207         tuple.Attributes = 0;
 208         tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
 209         i = first_tuple(link, &tuple, &parse);
 210         while (i == CS_SUCCESS) {
 211             if (cf->io.nwin > 0) {
 212                 link->conf.ConfigIndex = cf->index;
 213                 link->io.BasePort1 = cf->io.win[0].base;
 214                 link->io.NumPorts1 = cf->io.win[0].len;
 215                 link->io.NumPorts2 = 0;
 216                 printk(KERN_INFO "avm_cs: testing i/o %#x-%#x\n",
 217                         link->io.BasePort1,
 218                         link->io.BasePort1+link->io.NumPorts1-1);
 219                 i = pcmcia_request_io(link, &link->io);
 220                 if (i == CS_SUCCESS) goto found_port;
 221             }
 222             i = next_tuple(link, &tuple, &parse);
 223         }
 224
 225 found_port:
 226         if (i != CS_SUCCESS) {
 227             cs_error(link, RequestIO, i);
 228             break;
 229         }
 230
 231         /*
 232          * allocate an interrupt line
 233          */
 234         i = pcmcia_request_irq(link, &link->irq);
 235         if (i != CS_SUCCESS) {
 236             cs_error(link, RequestIRQ, i);
 237             /* undo */
 238             pcmcia_disable_device(link);
 239             break;
 240         }
 241
 242         /*
 243          * configure the PCMCIA socket
 244           */
 245         i = pcmcia_request_configuration(link, &link->conf);
 246         if (i != CS_SUCCESS) {
 247             cs_error(link, RequestConfiguration, i);
 248             pcmcia_disable_device(link);
 249             break;
 250         }
 251
 252     } while (0);
 253
 254     /* At this point, the dev_node_t structure(s) should be
 255        initialized and arranged in a linked list at link->dev. */
 256
 257     if (devname[0]) {
 258         char *s = strrchr(devname, ' ');
 259         if (!s)
 260            s = devname;
 261         else s++;
 262         strcpy(dev->node.dev_name, s);
 263         if (strcmp("M1", s) == 0) {
 264            cardtype = AVM_CARDTYPE_M1;
 265         } else if (strcmp("M2", s) == 0) {
 266            cardtype = AVM_CARDTYPE_M2;
 267         } else {
 268            cardtype = AVM_CARDTYPE_B1;
 269         }
 270     } else {
 271         strcpy(dev->node.dev_name, "b1");
 272         cardtype = AVM_CARDTYPE_B1;
 273     }
 274
 275     dev->node.major = 64;
 276     dev->node.minor = 0;
 277     link->dev_node = &dev->node;
 278
 279     /* If any step failed, release any partially configured state */
 280     if (i != 0) {
 281         avmcs_release(link);
 282         return -ENODEV;
 283     }
 284
 285
 286     switch (cardtype) {
 287         case AVM_CARDTYPE_M1: addcard = b1pcmcia_addcard_m1; break;
 288         case AVM_CARDTYPE_M2: addcard = b1pcmcia_addcard_m2; break;
 289         default:
 290         case AVM_CARDTYPE_B1: addcard = b1pcmcia_addcard_b1; break;
 291     }
 292     if ((i = (*addcard)(link->io.BasePort1, link->irq.AssignedIRQ)) < 0) {
 293         printk(KERN_ERR "avm_cs: failed to add AVM-%s-Controller at i/o %#x, irq %d\n",
 294                 dev->node.dev_name, link->io.BasePort1, link->irq.AssignedIRQ);
 295         avmcs_release(link);
 296         return -ENODEV;
 297     }
 298     dev->node.minor = i;
 299     return 0;
 300
 301 } /* avmcs_config */
 302
 303 /*======================================================================
 304
 305     After a card is removed, avmcs_release() will unregister the net
 306     device, and release the PCMCIA configuration.  If the device is
 307     still open, this will be postponed until it is closed.
 308
 309 ======================================================================*/
 310
 311 static void avmcs_release(struct pcmcia_device *link)
 312 {
 313         b1pcmcia_delcard(link->io.BasePort1, link->irq.AssignedIRQ);
 314         pcmcia_disable_device(link);
 315 } /* avmcs_release */
 316
 317
 318 static struct pcmcia_device_id avmcs_ids[] = {
 319         PCMCIA_DEVICE_PROD_ID12("AVM", "ISDN-Controller B1", 0x95d42008, 0x845dc335),
 320         PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M1", 0x95d42008, 0x81e10430),
 321         PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M2", 0x95d42008, 0x18e8558a),
 322         PCMCIA_DEVICE_NULL
 323 };
 324 MODULE_DEVICE_TABLE(pcmcia, avmcs_ids);
 325
 326 static struct pcmcia_driver avmcs_driver = {
 327         .owner  = THIS_MODULE,
 328         .drv    = {
 329                 .name   = "avm_cs",
 330         },
 331         .probe = avmcs_probe,
 332         .remove = avmcs_detach,
 333         .id_table = avmcs_ids,
 334 };
 335
 336 static int __init avmcs_init(void)
 337 {
 338         return pcmcia_register_driver(&avmcs_driver);
 339 }
 340
 341 static void __exit avmcs_exit(void)
 342 {
 343         pcmcia_unregister_driver(&avmcs_driver);
 344 }
 345
 346 module_init(avmcs_init);
 347 module_exit(avmcs_exit);