PageRenderTime 40ms CodeModel.GetById 15ms app.highlight 19ms RepoModel.GetById 2ms app.codeStats 0ms

/drivers/isdn/hisax/avma1_cs.c

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