1
2
3
4
5
6
7
8
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/slab.h>
17#include <linux/string.h>
18#include <linux/tty.h>
19#include <linux/serial.h>
20#include <linux/major.h>
21#include <asm/io.h>
22#include <asm/system.h>
23
24#include <pcmcia/cs_types.h>
25#include <pcmcia/cs.h>
26#include <pcmcia/cistpl.h>
27#include <pcmcia/ciscode.h>
28#include <pcmcia/ds.h>
29#include <pcmcia/cisreg.h>
30
31#include <linux/skbuff.h>
32#include <linux/capi.h>
33#include <linux/b1lli.h>
34#include <linux/b1pcmcia.h>
35
36
37
38MODULE_DESCRIPTION("CAPI4Linux: PCMCIA client driver for AVM B1/M1/M2");
39MODULE_AUTHOR("Carsten Paeth");
40MODULE_LICENSE("GPL");
41
42
43
44
45
46
47
48
49
50
51
52
53static int avmcs_config(struct pcmcia_device *link);
54static void avmcs_release(struct pcmcia_device *link);
55
56
57
58
59
60
61
62static void avmcs_detach(struct pcmcia_device *p_dev);
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85typedef struct local_info_t {
86 dev_node_t node;
87} local_info_t;
88
89
90
91
92
93
94
95
96
97
98
99
100
101static int avmcs_probe(struct pcmcia_device *p_dev)
102{
103 local_info_t *local;
104
105
106 p_dev->io.NumPorts1 = 16;
107 p_dev->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
108 p_dev->io.NumPorts2 = 0;
109
110
111 p_dev->irq.Attributes = IRQ_TYPE_EXCLUSIVE;
112 p_dev->irq.Attributes = IRQ_TYPE_DYNAMIC_SHARING|IRQ_FIRST_SHARED;
113
114 p_dev->irq.IRQInfo1 = IRQ_LEVEL_ID;
115
116
117 p_dev->conf.Attributes = CONF_ENABLE_IRQ;
118 p_dev->conf.IntType = INT_MEMORY_AND_IO;
119 p_dev->conf.ConfigIndex = 1;
120 p_dev->conf.Present = PRESENT_OPTION;
121
122
123 local = kzalloc(sizeof(local_info_t), GFP_KERNEL);
124 if (!local)
125 goto err;
126 p_dev->priv = local;
127
128 return avmcs_config(p_dev);
129
130 err:
131 return -ENOMEM;
132}
133
134
135
136
137
138
139
140
141
142
143static void avmcs_detach(struct pcmcia_device *link)
144{
145 avmcs_release(link);
146 kfree(link->priv);
147}
148
149
150
151
152
153
154
155
156
157static int avmcs_configcheck(struct pcmcia_device *p_dev,
158 cistpl_cftable_entry_t *cf,
159 cistpl_cftable_entry_t *dflt,
160 unsigned int vcc,
161 void *priv_data)
162{
163 if (cf->io.nwin <= 0)
164 return -ENODEV;
165
166 p_dev->io.BasePort1 = cf->io.win[0].base;
167 p_dev->io.NumPorts1 = cf->io.win[0].len;
168 p_dev->io.NumPorts2 = 0;
169 printk(KERN_INFO "avm_cs: testing i/o %#x-%#x\n",
170 p_dev->io.BasePort1,
171 p_dev->io.BasePort1+p_dev->io.NumPorts1-1);
172 return pcmcia_request_io(p_dev, &p_dev->io);
173}
174
175static int avmcs_config(struct pcmcia_device *link)
176{
177 local_info_t *dev;
178 int i;
179 char devname[128];
180 int cardtype;
181 int (*addcard)(unsigned int port, unsigned irq);
182
183 dev = link->priv;
184
185 devname[0] = 0;
186 if (link->prod_id[1])
187 strlcpy(devname, link->prod_id[1], sizeof(devname));
188
189
190
191
192 if (pcmcia_loop_config(link, avmcs_configcheck, NULL))
193 return -ENODEV;
194
195 do {
196
197
198
199 i = pcmcia_request_irq(link, &link->irq);
200 if (i != 0) {
201 cs_error(link, RequestIRQ, i);
202
203 pcmcia_disable_device(link);
204 break;
205 }
206
207
208
209
210 i = pcmcia_request_configuration(link, &link->conf);
211 if (i != 0) {
212 cs_error(link, RequestConfiguration, i);
213 pcmcia_disable_device(link);
214 break;
215 }
216
217 } while (0);
218
219
220
221
222 if (devname[0]) {
223 char *s = strrchr(devname, ' ');
224 if (!s)
225 s = devname;
226 else s++;
227 strcpy(dev->node.dev_name, s);
228 if (strcmp("M1", s) == 0) {
229 cardtype = AVM_CARDTYPE_M1;
230 } else if (strcmp("M2", s) == 0) {
231 cardtype = AVM_CARDTYPE_M2;
232 } else {
233 cardtype = AVM_CARDTYPE_B1;
234 }
235 } else {
236 strcpy(dev->node.dev_name, "b1");
237 cardtype = AVM_CARDTYPE_B1;
238 }
239
240 dev->node.major = 64;
241 dev->node.minor = 0;
242 link->dev_node = &dev->node;
243
244
245 if (i != 0) {
246 avmcs_release(link);
247 return -ENODEV;
248 }
249
250
251 switch (cardtype) {
252 case AVM_CARDTYPE_M1: addcard = b1pcmcia_addcard_m1; break;
253 case AVM_CARDTYPE_M2: addcard = b1pcmcia_addcard_m2; break;
254 default:
255 case AVM_CARDTYPE_B1: addcard = b1pcmcia_addcard_b1; break;
256 }
257 if ((i = (*addcard)(link->io.BasePort1, link->irq.AssignedIRQ)) < 0) {
258 printk(KERN_ERR "avm_cs: failed to add AVM-%s-Controller at i/o %#x, irq %d\n",
259 dev->node.dev_name, link->io.BasePort1, link->irq.AssignedIRQ);
260 avmcs_release(link);
261 return -ENODEV;
262 }
263 dev->node.minor = i;
264 return 0;
265
266}
267
268
269
270
271
272
273
274
275
276static void avmcs_release(struct pcmcia_device *link)
277{
278 b1pcmcia_delcard(link->io.BasePort1, link->irq.AssignedIRQ);
279 pcmcia_disable_device(link);
280}
281
282
283static struct pcmcia_device_id avmcs_ids[] = {
284 PCMCIA_DEVICE_PROD_ID12("AVM", "ISDN-Controller B1", 0x95d42008, 0x845dc335),
285 PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M1", 0x95d42008, 0x81e10430),
286 PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M2", 0x95d42008, 0x18e8558a),
287 PCMCIA_DEVICE_NULL
288};
289MODULE_DEVICE_TABLE(pcmcia, avmcs_ids);
290
291static struct pcmcia_driver avmcs_driver = {
292 .owner = THIS_MODULE,
293 .drv = {
294 .name = "avm_cs",
295 },
296 .probe = avmcs_probe,
297 .remove = avmcs_detach,
298 .id_table = avmcs_ids,
299};
300
301static int __init avmcs_init(void)
302{
303 return pcmcia_register_driver(&avmcs_driver);
304}
305
306static void __exit avmcs_exit(void)
307{
308 pcmcia_unregister_driver(&avmcs_driver);
309}
310
311module_init(avmcs_init);
312module_exit(avmcs_exit);
313