diff options
Diffstat (limited to 'drivers/isdn/hisax/avma1_cs.c')
| -rw-r--r-- | drivers/isdn/hisax/avma1_cs.c | 174 |
1 files changed, 174 insertions, 0 deletions
diff --git a/drivers/isdn/hisax/avma1_cs.c b/drivers/isdn/hisax/avma1_cs.c new file mode 100644 index 00000000..c644557a --- /dev/null +++ b/drivers/isdn/hisax/avma1_cs.c @@ -0,0 +1,174 @@ +/* + * PCMCIA client driver for AVM A1 / Fritz!PCMCIA + * + * Author Carsten Paeth + * Copyright 1998-2001 by Carsten Paeth <calle@calle.in-berlin.de> + * + * This software may be used and distributed according to the terms + * of the GNU General Public License, incorporated herein by reference. + * + */ + +#include <linux/module.h> + + +#include <linux/kernel.h> +#include <linux/init.h> +#include <linux/ptrace.h> +#include <linux/slab.h> +#include <linux/string.h> +#include <asm/io.h> + +#include <pcmcia/cistpl.h> +#include <pcmcia/ds.h> +#include "hisax_cfg.h" + +MODULE_DESCRIPTION("ISDN4Linux: PCMCIA client driver for AVM A1/Fritz!PCMCIA cards"); +MODULE_AUTHOR("Carsten Paeth"); +MODULE_LICENSE("GPL"); + + +/*====================================================================*/ + +/* Parameters that can be set with 'insmod' */ + +static int isdnprot = 2; + +module_param(isdnprot, int, 0); + +/*====================================================================*/ + +static int avma1cs_config(struct pcmcia_device *link) __devinit; +static void avma1cs_release(struct pcmcia_device *link); +static void avma1cs_detach(struct pcmcia_device *p_dev) __devexit; + +static int __devinit avma1cs_probe(struct pcmcia_device *p_dev) +{ + dev_dbg(&p_dev->dev, "avma1cs_attach()\n"); + + /* General socket configuration */ + p_dev->config_flags |= CONF_ENABLE_IRQ | CONF_AUTO_SET_IO; + p_dev->config_index = 1; + p_dev->config_regs = PRESENT_OPTION; + + return avma1cs_config(p_dev); +} /* avma1cs_attach */ + +static void __devexit avma1cs_detach(struct pcmcia_device *link) +{ + dev_dbg(&link->dev, "avma1cs_detach(0x%p)\n", link); + avma1cs_release(link); + kfree(link->priv); +} /* avma1cs_detach */ + +static int avma1cs_configcheck(struct pcmcia_device *p_dev, void *priv_data) +{ + p_dev->resource[0]->end = 16; + p_dev->resource[0]->flags &= ~IO_DATA_PATH_WIDTH; + p_dev->resource[0]->flags |= IO_DATA_PATH_WIDTH_8; + p_dev->io_lines = 5; + + return pcmcia_request_io(p_dev); +} + + +static int __devinit avma1cs_config(struct pcmcia_device *link) +{ + int i = -1; + char devname[128]; + IsdnCard_t icard; + int busy = 0; + + dev_dbg(&link->dev, "avma1cs_config(0x%p)\n", link); + + devname[0] = 0; + if (link->prod_id[1]) + strlcpy(devname, link->prod_id[1], sizeof(devname)); + + if (pcmcia_loop_config(link, avma1cs_configcheck, NULL)) + return -ENODEV; + + do { + /* + * allocate an interrupt line + */ + if (!link->irq) { + /* undo */ + pcmcia_disable_device(link); + break; + } + + /* + * configure the PCMCIA socket + */ + i = pcmcia_enable_device(link); + if (i != 0) { + pcmcia_disable_device(link); + break; + } + + } while (0); + + /* If any step failed, release any partially configured state */ + if (i != 0) { + avma1cs_release(link); + return -ENODEV; + } + + icard.para[0] = link->irq; + icard.para[1] = link->resource[0]->start; + icard.protocol = isdnprot; + icard.typ = ISDN_CTYPE_A1_PCMCIA; + + i = hisax_init_pcmcia(link, &busy, &icard); + if (i < 0) { + printk(KERN_ERR "avma1_cs: failed to initialize AVM A1 " + "PCMCIA %d at i/o %#x\n", i, + (unsigned int) link->resource[0]->start); + avma1cs_release(link); + return -ENODEV; + } + link->priv = (void *) (unsigned long) i; + + return 0; +} /* avma1cs_config */ + +static void avma1cs_release(struct pcmcia_device *link) +{ + unsigned long minor = (unsigned long) link->priv; + + dev_dbg(&link->dev, "avma1cs_release(0x%p)\n", link); + + /* now unregister function with hisax */ + HiSax_closecard(minor); + + pcmcia_disable_device(link); +} /* avma1cs_release */ + +static const struct pcmcia_device_id avma1cs_ids[] = { + PCMCIA_DEVICE_PROD_ID12("AVM", "ISDN A", 0x95d42008, 0xadc9d4bb), + PCMCIA_DEVICE_PROD_ID12("ISDN", "CARD", 0x8d9761c8, 0x01c5aa7b), + PCMCIA_DEVICE_NULL +}; +MODULE_DEVICE_TABLE(pcmcia, avma1cs_ids); + +static struct pcmcia_driver avma1cs_driver = { + .owner = THIS_MODULE, + .name = "avma1_cs", + .probe = avma1cs_probe, + .remove = __devexit_p(avma1cs_detach), + .id_table = avma1cs_ids, +}; + +static int __init init_avma1_cs(void) +{ + return pcmcia_register_driver(&avma1cs_driver); +} + +static void __exit exit_avma1_cs(void) +{ + pcmcia_unregister_driver(&avma1cs_driver); +} + +module_init(init_avma1_cs); +module_exit(exit_avma1_cs); |