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