drivers/isdn/hisax/avma1_cs.c

   1 /*
   2  * PCMCIA client driver for AVM A1 / Fritz!PCMCIA
   3  *
   4  * Author       Carsten Paeth
   5  * Copyright    1998-2001 by Carsten Paeth <calle@calle.in-berlin.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
  14
  15 #include <linux/kernel.h>
  16 #include <linux/init.h>
  17 #include <linux/ptrace.h>
  18 #include <linux/slab.h>
  19 #include <linux/string.h>
  20 #include <asm/io.h>
  21 #include <asm/system.h>
  22
  23 #include <pcmcia/cistpl.h>
  24 #include <pcmcia/ds.h>
  25 #include "hisax_cfg.h"
  26
  27 MODULE_DESCRIPTION("ISDN4Linux: PCMCIA client driver for AVM A1/Fritz!PCMCIA cards");
  28 MODULE_AUTHOR("Carsten Paeth");
  29 MODULE_LICENSE("GPL");
  30
  31
  32 /*====================================================================*/
  33
  34 /* Parameters that can be set with 'insmod' */
  35
  36 static int isdnprot = 2;
  37
  38 module_param(isdnprot, int, 0);
  39
  40 /*====================================================================*/
  41
  42 static int avma1cs_config(struct pcmcia_device *link) __devinit ;
  43 static void avma1cs_release(struct pcmcia_device *link);
  44 static void avma1cs_detach(struct pcmcia_device *p_dev) __devexit ;
  45
  46 static int __devinit avma1cs_probe(struct pcmcia_device *p_dev)
  47 {
  48     dev_dbg(&p_dev->dev, "avma1cs_attach()\n");
  49
  50     /* General socket configuration */
  51     p_dev->config_flags |= CONF_ENABLE_IRQ | CONF_AUTO_SET_IO;
  52     p_dev->config_index = 1;
  53     p_dev->config_regs = PRESENT_OPTION;
  54
  55     return avma1cs_config(p_dev);
  56 } /* avma1cs_attach */
  57
  58 static void __devexit avma1cs_detach(struct pcmcia_device *link)
  59 {
  60         dev_dbg(&link->dev, "avma1cs_detach(0x%p)\n", link);
  61         avma1cs_release(link);
  62         kfree(link->priv);
  63 } /* avma1cs_detach */
  64
  65 static int avma1cs_configcheck(struct pcmcia_device *p_dev, void *priv_data)
  66 {
  67         p_dev->resource[0]->end = 16;
  68         p_dev->resource[0]->flags &= ~IO_DATA_PATH_WIDTH;
  69         p_dev->resource[0]->flags |= IO_DATA_PATH_WIDTH_8;
  70         p_dev->io_lines = 5;
  71
  72         return pcmcia_request_io(p_dev);
  73 }
  74
  75
  76 static int __devinit avma1cs_config(struct pcmcia_device *link)
  77 {
  78     int i = -1;
  79     char devname[128];
  80     IsdnCard_t  icard;
  81     int busy = 0;
  82
  83     dev_dbg(&link->dev, "avma1cs_config(0x%p)\n", link);
  84
  85     devname[0] = 0;
  86     if (link->prod_id[1])
  87             strlcpy(devname, link->prod_id[1], sizeof(devname));
  88
  89     if (pcmcia_loop_config(link, avma1cs_configcheck, NULL))
  90             return -ENODEV;
  91
  92     do {
  93         /*
  94          * allocate an interrupt line
  95          */
  96         if (!link->irq) {
  97             /* undo */
  98             pcmcia_disable_device(link);
  99             break;
 100         }
 101
 102         /*
 103          * configure the PCMCIA socket
 104          */
 105         i = pcmcia_enable_device(link);
 106         if (i != 0) {
 107             pcmcia_disable_device(link);
 108             break;
 109         }
 110
 111     } while (0);
 112
 113     /* If any step failed, release any partially configured state */
 114     if (i != 0) {
 115         avma1cs_release(link);
 116         return -ENODEV;
 117     }
 118
 119     icard.para[0] = link->irq;
 120     icard.para[1] = link->resource[0]->start;
 121     icard.protocol = isdnprot;
 122     icard.typ = ISDN_CTYPE_A1_PCMCIA;
 123
 124     i = hisax_init_pcmcia(link, &busy, &icard);
 125     if (i < 0) {
 126         printk(KERN_ERR "avma1_cs: failed to initialize AVM A1 "
 127                         "PCMCIA %d at i/o %#x\n", i,
 128                         (unsigned int) link->resource[0]->start);
 129         avma1cs_release(link);
 130         return -ENODEV;
 131     }
 132     link->priv = (void *) (unsigned long) i;
 133
 134     return 0;
 135 } /* avma1cs_config */
 136
 137 static void avma1cs_release(struct pcmcia_device *link)
 138 {
 139         unsigned long minor = (unsigned long) link->priv;
 140
 141         dev_dbg(&link->dev, "avma1cs_release(0x%p)\n", link);
 142
 143         /* now unregister function with hisax */
 144         HiSax_closecard(minor);
 145
 146         pcmcia_disable_device(link);
 147 } /* avma1cs_release */
 148
 149 static const struct pcmcia_device_id avma1cs_ids[] = {
 150         PCMCIA_DEVICE_PROD_ID12("AVM", "ISDN A", 0x95d42008, 0xadc9d4bb),
 151         PCMCIA_DEVICE_PROD_ID12("ISDN", "CARD", 0x8d9761c8, 0x01c5aa7b),
 152         PCMCIA_DEVICE_NULL
 153 };
 154 MODULE_DEVICE_TABLE(pcmcia, avma1cs_ids);
 155
 156 static struct pcmcia_driver avma1cs_driver = {
 157         .owner          = THIS_MODULE,
 158         .name           = "avma1_cs",
 159         .probe          = avma1cs_probe,
 160         .remove         = __devexit_p(avma1cs_detach),
 161         .id_table       = avma1cs_ids,
 162 };
 163
 164 static int __init init_avma1_cs(void)
 165 {
 166         return pcmcia_register_driver(&avma1cs_driver);
 167 }
 168
 169 static void __exit exit_avma1_cs(void)
 170 {
 171         pcmcia_unregister_driver(&avma1cs_driver);
 172 }
 173
 174 module_init(init_avma1_cs);
 175 module_exit(exit_avma1_cs);