LXR linux/drivers/isdn/hardware/avm/avm

   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
  22#include <pcmcia/cistpl.h>
  23#include <pcmcia/ciscode.h>
  24#include <pcmcia/ds.h>
  25#include <pcmcia/cisreg.h>
  26
  27#include <linux/skbuff.h>
  28#include <linux/capi.h>
  29#include <linux/b1lli.h>
  30#include <linux/b1pcmcia.h>
  31
  32/*====================================================================*/
  33
  34MODULE_DESCRIPTION("CAPI4Linux: PCMCIA client driver for AVM B1/M1/M2");
  35MODULE_AUTHOR("Carsten Paeth");
  36MODULE_LICENSE("GPL");
  37
  38/*====================================================================*/
  39
  40static int avmcs_config(struct pcmcia_device *link);
  41static void avmcs_release(struct pcmcia_device *link);
  42static void avmcs_detach(struct pcmcia_device *p_dev);
  43
  44static int avmcs_probe(struct pcmcia_device *p_dev)
  45{
  46        /* General socket configuration */
  47        p_dev->config_flags |= CONF_ENABLE_IRQ | CONF_AUTO_SET_IO;
  48        p_dev->config_index = 1;
  49        p_dev->config_regs = PRESENT_OPTION;
  50
  51        return avmcs_config(p_dev);
  52} /* avmcs_attach */
  53
  54
  55static void avmcs_detach(struct pcmcia_device *link)
  56{
  57        avmcs_release(link);
  58} /* avmcs_detach */
  59
  60static int avmcs_configcheck(struct pcmcia_device *p_dev, void *priv_data)
  61{
  62        p_dev->resource[0]->end = 16;
  63        p_dev->resource[0]->flags &= ~IO_DATA_PATH_WIDTH;
  64        p_dev->resource[0]->flags |= IO_DATA_PATH_WIDTH_8;
  65
  66        return pcmcia_request_io(p_dev);
  67}
  68
  69static int avmcs_config(struct pcmcia_device *link)
  70{
  71        int i = -1;
  72        char devname[128];
  73        int cardtype;
  74        int (*addcard)(unsigned int port, unsigned irq);
  75
  76        devname[0] = 0;
  77        if (link->prod_id[1])
  78                strlcpy(devname, link->prod_id[1], sizeof(devname));
  79
  80        /*
  81         * find IO port
  82         */
  83        if (pcmcia_loop_config(link, avmcs_configcheck, NULL))
  84                return -ENODEV;
  85
  86        do {
  87                if (!link->irq) {
  88                        /* undo */
  89                        pcmcia_disable_device(link);
  90                        break;
  91                }
  92
  93                /*
  94                 * configure the PCMCIA socket
  95                 */
  96                i = pcmcia_enable_device(link);
  97                if (i != 0) {
  98                        pcmcia_disable_device(link);
  99                        break;
 100                }
 101
 102        } while (0);
 103
 104        if (devname[0]) {
 105                char *s = strrchr(devname, ' ');
 106                if (!s)
 107                        s = devname;
 108                else s++;
 109                if (strcmp("M1", s) == 0) {
 110                        cardtype = AVM_CARDTYPE_M1;
 111                } else if (strcmp("M2", s) == 0) {
 112                        cardtype = AVM_CARDTYPE_M2;
 113                } else {
 114                        cardtype = AVM_CARDTYPE_B1;
 115                }
 116        } else
 117                cardtype = AVM_CARDTYPE_B1;
 118
 119        /* If any step failed, release any partially configured state */
 120        if (i != 0) {
 121                avmcs_release(link);
 122                return -ENODEV;
 123        }
 124
 125
 126        switch (cardtype) {
 127        case AVM_CARDTYPE_M1: addcard = b1pcmcia_addcard_m1; break;
 128        case AVM_CARDTYPE_M2: addcard = b1pcmcia_addcard_m2; break;
 129        default:
 130        case AVM_CARDTYPE_B1: addcard = b1pcmcia_addcard_b1; break;
 131        }
 132        if ((i = (*addcard)(link->resource[0]->start, link->irq)) < 0) {
 133                dev_err(&link->dev,
 134                        "avm_cs: failed to add AVM-Controller at i/o %#x, irq %d\n",
 135                        (unsigned int) link->resource[0]->start, link->irq);
 136                avmcs_release(link);
 137                return -ENODEV;
 138        }
 139        return 0;
 140
 141} /* avmcs_config */
 142
 143
 144static void avmcs_release(struct pcmcia_device *link)
 145{
 146        b1pcmcia_delcard(link->resource[0]->start, link->irq);
 147        pcmcia_disable_device(link);
 148} /* avmcs_release */
 149
 150
 151static const struct pcmcia_device_id avmcs_ids[] = {
 152        PCMCIA_DEVICE_PROD_ID12("AVM", "ISDN-Controller B1", 0x95d42008, 0x845dc335),
 153        PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M1", 0x95d42008, 0x81e10430),
 154        PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M2", 0x95d42008, 0x18e8558a),
 155        PCMCIA_DEVICE_NULL
 156};
 157MODULE_DEVICE_TABLE(pcmcia, avmcs_ids);
 158
 159static struct pcmcia_driver avmcs_driver = {
 160        .owner  = THIS_MODULE,
 161        .name           = "avm_cs",
 162        .probe = avmcs_probe,
 163        .remove = avmcs_detach,
 164        .id_table = avmcs_ids,
 165};
 166module_pcmcia_driver(avmcs_driver);
 167