linux/drivers/isdn/hardware/avm/avm_cs.c
<<
>>
Prefs
   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
  38MODULE_DESCRIPTION("CAPI4Linux: PCMCIA client driver for AVM B1/M1/M2");
  39MODULE_AUTHOR("Carsten Paeth");
  40MODULE_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
  53static int avmcs_config(struct pcmcia_device *link);
  54static 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
  62static 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   
  85typedef 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
 101static 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
 143static 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
 157static int avmcs_configcheck(struct pcmcia_device *p_dev,
 158                             cistpl_cftable_entry_t *cf,
 159                             cistpl_cftable_entry_t *dflt,
 160                             unsigned int vcc,
 161                             void *priv_data)
 162{
 163        if (cf->io.nwin <= 0)
 164                return -ENODEV;
 165
 166        p_dev->io.BasePort1 = cf->io.win[0].base;
 167        p_dev->io.NumPorts1 = cf->io.win[0].len;
 168        p_dev->io.NumPorts2 = 0;
 169        printk(KERN_INFO "avm_cs: testing i/o %#x-%#x\n",
 170               p_dev->io.BasePort1,
 171               p_dev->io.BasePort1+p_dev->io.NumPorts1-1);
 172        return pcmcia_request_io(p_dev, &p_dev->io);
 173}
 174
 175static int avmcs_config(struct pcmcia_device *link)
 176{
 177    local_info_t *dev;
 178    int i;
 179    char devname[128];
 180    int cardtype;
 181    int (*addcard)(unsigned int port, unsigned irq);
 182
 183    dev = link->priv;
 184
 185    devname[0] = 0;
 186    if (link->prod_id[1])
 187            strlcpy(devname, link->prod_id[1], sizeof(devname));
 188
 189    /*
 190     * find IO port
 191     */
 192    if (pcmcia_loop_config(link, avmcs_configcheck, NULL))
 193            return -ENODEV;
 194
 195    do {
 196        /*
 197         * allocate an interrupt line
 198         */
 199        i = pcmcia_request_irq(link, &link->irq);
 200        if (i != 0) {
 201            cs_error(link, RequestIRQ, i);
 202            /* undo */
 203            pcmcia_disable_device(link);
 204            break;
 205        }
 206
 207        /*
 208         * configure the PCMCIA socket
 209          */
 210        i = pcmcia_request_configuration(link, &link->conf);
 211        if (i != 0) {
 212            cs_error(link, RequestConfiguration, i);
 213            pcmcia_disable_device(link);
 214            break;
 215        }
 216
 217    } while (0);
 218
 219    /* At this point, the dev_node_t structure(s) should be
 220       initialized and arranged in a linked list at link->dev. */
 221
 222    if (devname[0]) {
 223        char *s = strrchr(devname, ' ');
 224        if (!s)
 225           s = devname;
 226        else s++;
 227        strcpy(dev->node.dev_name, s);
 228        if (strcmp("M1", s) == 0) {
 229           cardtype = AVM_CARDTYPE_M1;
 230        } else if (strcmp("M2", s) == 0) {
 231           cardtype = AVM_CARDTYPE_M2;
 232        } else {
 233           cardtype = AVM_CARDTYPE_B1;
 234        }
 235    } else {
 236        strcpy(dev->node.dev_name, "b1");
 237        cardtype = AVM_CARDTYPE_B1;
 238    }
 239
 240    dev->node.major = 64;
 241    dev->node.minor = 0;
 242    link->dev_node = &dev->node;
 243
 244    /* If any step failed, release any partially configured state */
 245    if (i != 0) {
 246        avmcs_release(link);
 247        return -ENODEV;
 248    }
 249
 250
 251    switch (cardtype) {
 252        case AVM_CARDTYPE_M1: addcard = b1pcmcia_addcard_m1; break;
 253        case AVM_CARDTYPE_M2: addcard = b1pcmcia_addcard_m2; break;
 254        default:
 255        case AVM_CARDTYPE_B1: addcard = b1pcmcia_addcard_b1; break;
 256    }
 257    if ((i = (*addcard)(link->io.BasePort1, link->irq.AssignedIRQ)) < 0) {
 258        printk(KERN_ERR "avm_cs: failed to add AVM-%s-Controller at i/o %#x, irq %d\n",
 259                dev->node.dev_name, link->io.BasePort1, link->irq.AssignedIRQ);
 260        avmcs_release(link);
 261        return -ENODEV;
 262    }
 263    dev->node.minor = i;
 264    return 0;
 265
 266} /* avmcs_config */
 267
 268/*======================================================================
 269
 270    After a card is removed, avmcs_release() will unregister the net
 271    device, and release the PCMCIA configuration.  If the device is
 272    still open, this will be postponed until it is closed.
 273    
 274======================================================================*/
 275
 276static void avmcs_release(struct pcmcia_device *link)
 277{
 278        b1pcmcia_delcard(link->io.BasePort1, link->irq.AssignedIRQ);
 279        pcmcia_disable_device(link);
 280} /* avmcs_release */
 281
 282
 283static struct pcmcia_device_id avmcs_ids[] = {
 284        PCMCIA_DEVICE_PROD_ID12("AVM", "ISDN-Controller B1", 0x95d42008, 0x845dc335),
 285        PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M1", 0x95d42008, 0x81e10430),
 286        PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M2", 0x95d42008, 0x18e8558a),
 287        PCMCIA_DEVICE_NULL
 288};
 289MODULE_DEVICE_TABLE(pcmcia, avmcs_ids);
 290
 291static struct pcmcia_driver avmcs_driver = {
 292        .owner  = THIS_MODULE,
 293        .drv    = {
 294                .name   = "avm_cs",
 295        },
 296        .probe = avmcs_probe,
 297        .remove = avmcs_detach,
 298        .id_table = avmcs_ids,
 299};
 300
 301static int __init avmcs_init(void)
 302{
 303        return pcmcia_register_driver(&avmcs_driver);
 304}
 305
 306static void __exit avmcs_exit(void)
 307{
 308        pcmcia_unregister_driver(&avmcs_driver);
 309}
 310
 311module_init(avmcs_init);
 312module_exit(avmcs_exit);
 313