pcmcia: pcmcia_config_loop() ConfigIndex unification
[linux-2.6.git] / drivers / isdn / hardware / avm / avm_cs.c
1 /* $Id: avm_cs.c,v 1.4.6.3 2001/09/23 22:24:33 kai Exp $
2  *
3  * A PCMCIA client driver for AVM B1/M1/M2
4  *
5  * Copyright 1999 by Carsten Paeth <calle@calle.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 #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
38 MODULE_DESCRIPTION("CAPI4Linux: PCMCIA client driver for AVM B1/M1/M2");
39 MODULE_AUTHOR("Carsten Paeth");
40 MODULE_LICENSE("GPL");
41
42 /*====================================================================*/
43
44 /*
45    The event() function is this driver's Card Services event handler.
46    It will be called by Card Services when an appropriate card status
47    event is received.  The config() and release() entry points are
48    used to configure or release a socket, in response to card insertion
49    and ejection events.  They are invoked from the skeleton event
50    handler.
51 */
52
53 static int avmcs_config(struct pcmcia_device *link);
54 static void avmcs_release(struct pcmcia_device *link);
55
56 /*
57    The attach() and detach() entry points are used to create and destroy
58    "instances" of the driver, where each instance represents everything
59    needed to manage one actual PCMCIA card.
60 */
61
62 static void avmcs_detach(struct pcmcia_device *p_dev);
63
64 /*
65    A linked list of "instances" of the skeleton device.  Each actual
66    PCMCIA card corresponds to one device instance, and is described
67    by one struct pcmcia_device structure (defined in ds.h).
68
69    You may not want to use a linked list for this -- for example, the
70    memory card driver uses an array of struct pcmcia_device pointers, where minor
71    device numbers are used to derive the corresponding array index.
72 */
73
74 /*
75    A driver needs to provide a dev_node_t structure for each device
76    on a card.  In some cases, there is only one device per card (for
77    example, ethernet cards, modems).  In other cases, there may be
78    many actual or logical devices (SCSI adapters, memory cards with
79    multiple partitions).  The dev_node_t structures need to be kept
80    in a linked list starting at the 'dev' field of a struct pcmcia_device
81    structure.  We allocate them in the card's private data structure,
82    because they generally can't be allocated dynamically.
83 */
84    
85 typedef struct local_info_t {
86     dev_node_t  node;
87 } local_info_t;
88
89 /*======================================================================
90
91     avmcs_attach() creates an "instance" of the driver, allocating
92     local data structures for one device.  The device is registered
93     with Card Services.
94
95     The dev_link structure is initialized, but we don't actually
96     configure the card at this point -- we wait until we receive a
97     card insertion event.
98     
99 ======================================================================*/
100
101 static int avmcs_probe(struct pcmcia_device *p_dev)
102 {
103     local_info_t *local;
104
105     /* The io structure describes IO port mapping */
106     p_dev->io.NumPorts1 = 16;
107     p_dev->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
108     p_dev->io.NumPorts2 = 0;
109
110     /* Interrupt setup */
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     /* General socket configuration */
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     /* Allocate space for private device-specific data */
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 } /* avmcs_attach */
133
134 /*======================================================================
135
136     This deletes a driver "instance".  The device is de-registered
137     with Card Services.  If it has been released, all local data
138     structures are freed.  Otherwise, the structures will be freed
139     when the device is released.
140
141 ======================================================================*/
142
143 static void avmcs_detach(struct pcmcia_device *link)
144 {
145         avmcs_release(link);
146         kfree(link->priv);
147 } /* avmcs_detach */
148
149 /*======================================================================
150
151     avmcs_config() is scheduled to run after a CARD_INSERTION event
152     is received, to configure the PCMCIA socket, and to make the
153     ethernet device available to the system.
154     
155 ======================================================================*/
156
157 static int avmcs_configcheck(struct pcmcia_device *p_dev,
158                              cistpl_cftable_entry_t *cf,
159                              void *priv_data)
160 {
161         if (cf->io.nwin <= 0)
162                 return -ENODEV;
163
164         p_dev->io.BasePort1 = cf->io.win[0].base;
165         p_dev->io.NumPorts1 = cf->io.win[0].len;
166         p_dev->io.NumPorts2 = 0;
167         printk(KERN_INFO "avm_cs: testing i/o %#x-%#x\n",
168                p_dev->io.BasePort1,
169                p_dev->io.BasePort1+p_dev->io.NumPorts1-1);
170         return pcmcia_request_io(p_dev, &p_dev->io);
171 }
172
173 static int avmcs_config(struct pcmcia_device *link)
174 {
175     local_info_t *dev;
176     int i;
177     char devname[128];
178     int cardtype;
179     int (*addcard)(unsigned int port, unsigned irq);
180
181     dev = link->priv;
182
183     devname[0] = 0;
184     if (link->prod_id[1])
185             strlcpy(devname, link->prod_id[1], sizeof(devname));
186
187     /*
188      * find IO port
189      */
190     if (pcmcia_loop_config(link, avmcs_configcheck, NULL))
191             return -ENODEV;
192
193     do {
194         /*
195          * allocate an interrupt line
196          */
197         i = pcmcia_request_irq(link, &link->irq);
198         if (i != CS_SUCCESS) {
199             cs_error(link, RequestIRQ, i);
200             /* undo */
201             pcmcia_disable_device(link);
202             break;
203         }
204
205         /*
206          * configure the PCMCIA socket
207           */
208         i = pcmcia_request_configuration(link, &link->conf);
209         if (i != CS_SUCCESS) {
210             cs_error(link, RequestConfiguration, i);
211             pcmcia_disable_device(link);
212             break;
213         }
214
215     } while (0);
216
217     /* At this point, the dev_node_t structure(s) should be
218        initialized and arranged in a linked list at link->dev. */
219
220     if (devname[0]) {
221         char *s = strrchr(devname, ' ');
222         if (!s)
223            s = devname;
224         else s++;
225         strcpy(dev->node.dev_name, s);
226         if (strcmp("M1", s) == 0) {
227            cardtype = AVM_CARDTYPE_M1;
228         } else if (strcmp("M2", s) == 0) {
229            cardtype = AVM_CARDTYPE_M2;
230         } else {
231            cardtype = AVM_CARDTYPE_B1;
232         }
233     } else {
234         strcpy(dev->node.dev_name, "b1");
235         cardtype = AVM_CARDTYPE_B1;
236     }
237
238     dev->node.major = 64;
239     dev->node.minor = 0;
240     link->dev_node = &dev->node;
241
242     /* If any step failed, release any partially configured state */
243     if (i != 0) {
244         avmcs_release(link);
245         return -ENODEV;
246     }
247
248
249     switch (cardtype) {
250         case AVM_CARDTYPE_M1: addcard = b1pcmcia_addcard_m1; break;
251         case AVM_CARDTYPE_M2: addcard = b1pcmcia_addcard_m2; break;
252         default:
253         case AVM_CARDTYPE_B1: addcard = b1pcmcia_addcard_b1; break;
254     }
255     if ((i = (*addcard)(link->io.BasePort1, link->irq.AssignedIRQ)) < 0) {
256         printk(KERN_ERR "avm_cs: failed to add AVM-%s-Controller at i/o %#x, irq %d\n",
257                 dev->node.dev_name, link->io.BasePort1, link->irq.AssignedIRQ);
258         avmcs_release(link);
259         return -ENODEV;
260     }
261     dev->node.minor = i;
262     return 0;
263
264 } /* avmcs_config */
265
266 /*======================================================================
267
268     After a card is removed, avmcs_release() will unregister the net
269     device, and release the PCMCIA configuration.  If the device is
270     still open, this will be postponed until it is closed.
271     
272 ======================================================================*/
273
274 static void avmcs_release(struct pcmcia_device *link)
275 {
276         b1pcmcia_delcard(link->io.BasePort1, link->irq.AssignedIRQ);
277         pcmcia_disable_device(link);
278 } /* avmcs_release */
279
280
281 static struct pcmcia_device_id avmcs_ids[] = {
282         PCMCIA_DEVICE_PROD_ID12("AVM", "ISDN-Controller B1", 0x95d42008, 0x845dc335),
283         PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M1", 0x95d42008, 0x81e10430),
284         PCMCIA_DEVICE_PROD_ID12("AVM", "Mobile ISDN-Controller M2", 0x95d42008, 0x18e8558a),
285         PCMCIA_DEVICE_NULL
286 };
287 MODULE_DEVICE_TABLE(pcmcia, avmcs_ids);
288
289 static struct pcmcia_driver avmcs_driver = {
290         .owner  = THIS_MODULE,
291         .drv    = {
292                 .name   = "avm_cs",
293         },
294         .probe = avmcs_probe,
295         .remove = avmcs_detach,
296         .id_table = avmcs_ids,
297 };
298
299 static int __init avmcs_init(void)
300 {
301         return pcmcia_register_driver(&avmcs_driver);
302 }
303
304 static void __exit avmcs_exit(void)
305 {
306         pcmcia_unregister_driver(&avmcs_driver);
307 }
308
309 module_init(avmcs_init);
310 module_exit(avmcs_exit);