avma1_cs.c 4.0 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5
/*
 * PCMCIA client driver for AVM A1 / Fritz!PCMCIA
 *
 * Author       Carsten Paeth
 * Copyright    1998-2001 by Carsten Paeth <calle@calle.in-berlin.de>
6
 *
L
Linus Torvalds 已提交
7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40
 * 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);

/*====================================================================*/

41
static int avma1cs_config(struct pcmcia_device *link);
42
static void avma1cs_release(struct pcmcia_device *link);
43
static void avma1cs_detach(struct pcmcia_device *p_dev);
L
Linus Torvalds 已提交
44

45
static int avma1cs_probe(struct pcmcia_device *p_dev)
L
Linus Torvalds 已提交
46
{
47
	dev_dbg(&p_dev->dev, "avma1cs_attach()\n");
L
Linus Torvalds 已提交
48

49 50 51 52
	/* 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;
53

54
	return avma1cs_config(p_dev);
L
Linus Torvalds 已提交
55 56
} /* avma1cs_attach */

57
static void avma1cs_detach(struct pcmcia_device *link)
L
Linus Torvalds 已提交
58
{
59
	dev_dbg(&link->dev, "avma1cs_detach(0x%p)\n", link);
60 61
	avma1cs_release(link);
	kfree(link->priv);
L
Linus Torvalds 已提交
62 63
} /* avma1cs_detach */

64
static int avma1cs_configcheck(struct pcmcia_device *p_dev, void *priv_data)
L
Linus Torvalds 已提交
65
{
66 67 68
	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;
69
	p_dev->io_lines = 5;
70

71
	return pcmcia_request_io(p_dev);
L
Linus Torvalds 已提交
72 73 74
}


75
static int avma1cs_config(struct pcmcia_device *link)
L
Linus Torvalds 已提交
76
{
77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112
	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 */
D
Dominik Brodowski 已提交
113
	if (i != 0) {
114 115
		avma1cs_release(link);
		return -ENODEV;
L
Linus Torvalds 已提交
116 117
	}

118 119 120 121 122 123 124 125 126 127 128 129 130 131
	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;
L
Linus Torvalds 已提交
132

133
	return 0;
L
Linus Torvalds 已提交
134 135
} /* avma1cs_config */

136
static void avma1cs_release(struct pcmcia_device *link)
L
Linus Torvalds 已提交
137
{
138
	unsigned long minor = (unsigned long) link->priv;
L
Linus Torvalds 已提交
139

140
	dev_dbg(&link->dev, "avma1cs_release(0x%p)\n", link);
L
Linus Torvalds 已提交
141

142
	/* now unregister function with hisax */
143
	HiSax_closecard(minor);
L
Linus Torvalds 已提交
144

145
	pcmcia_disable_device(link);
L
Linus Torvalds 已提交
146 147
} /* avma1cs_release */

148
static const struct pcmcia_device_id avma1cs_ids[] = {
149 150 151 152 153 154
	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);

L
Linus Torvalds 已提交
155 156
static struct pcmcia_driver avma1cs_driver = {
	.owner		= THIS_MODULE,
157
	.name		= "avma1_cs",
158
	.probe		= avma1cs_probe,
159
	.remove		= avma1cs_detach,
160
	.id_table	= avma1cs_ids,
L
Linus Torvalds 已提交
161
};
162

L
Linus Torvalds 已提交
163 164
static int __init init_avma1_cs(void)
{
165
	return pcmcia_register_driver(&avma1cs_driver);
L
Linus Torvalds 已提交
166 167 168 169 170 171 172 173 174
}

static void __exit exit_avma1_cs(void)
{
	pcmcia_unregister_driver(&avma1cs_driver);
}

module_init(init_avma1_cs);
module_exit(exit_avma1_cs);