xref: /linux/drivers/pcmcia/ds.c (revision 5d4a2e29fba5b2bef95b96a46b338ec4d76fa4fd)
1 /*
2  * ds.c -- 16-bit PCMCIA core support
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License version 2 as
6  * published by the Free Software Foundation.
7  *
8  * The initial developer of the original code is David A. Hinds
9  * <dahinds@users.sourceforge.net>.  Portions created by David A. Hinds
10  * are Copyright (C) 1999 David A. Hinds.  All Rights Reserved.
11  *
12  * (C) 1999		David A. Hinds
13  * (C) 2003 - 2006	Dominik Brodowski
14  */
15 
16 #include <linux/kernel.h>
17 #include <linux/module.h>
18 #include <linux/init.h>
19 #include <linux/errno.h>
20 #include <linux/list.h>
21 #include <linux/delay.h>
22 #include <linux/workqueue.h>
23 #include <linux/crc32.h>
24 #include <linux/firmware.h>
25 #include <linux/kref.h>
26 #include <linux/dma-mapping.h>
27 #include <linux/slab.h>
28 
29 #include <pcmcia/cs_types.h>
30 #include <pcmcia/cs.h>
31 #include <pcmcia/cistpl.h>
32 #include <pcmcia/ds.h>
33 #include <pcmcia/ss.h>
34 
35 #include "cs_internal.h"
36 
37 /*====================================================================*/
38 
39 /* Module parameters */
40 
41 MODULE_AUTHOR("David Hinds <dahinds@users.sourceforge.net>");
42 MODULE_DESCRIPTION("PCMCIA Driver Services");
43 MODULE_LICENSE("GPL");
44 
45 
46 /*====================================================================*/
47 
48 static void pcmcia_check_driver(struct pcmcia_driver *p_drv)
49 {
50 	struct pcmcia_device_id *did = p_drv->id_table;
51 	unsigned int i;
52 	u32 hash;
53 
54 	if (!p_drv->probe || !p_drv->remove)
55 		printk(KERN_DEBUG "pcmcia: %s lacks a requisite callback "
56 		       "function\n", p_drv->drv.name);
57 
58 	while (did && did->match_flags) {
59 		for (i = 0; i < 4; i++) {
60 			if (!did->prod_id[i])
61 				continue;
62 
63 			hash = crc32(0, did->prod_id[i], strlen(did->prod_id[i]));
64 			if (hash == did->prod_id_hash[i])
65 				continue;
66 
67 			printk(KERN_DEBUG "pcmcia: %s: invalid hash for "
68 			       "product string \"%s\": is 0x%x, should "
69 			       "be 0x%x\n", p_drv->drv.name, did->prod_id[i],
70 			       did->prod_id_hash[i], hash);
71 			printk(KERN_DEBUG "pcmcia: see "
72 				"Documentation/pcmcia/devicetable.txt for "
73 				"details\n");
74 		}
75 		did++;
76 	}
77 
78 	return;
79 }
80 
81 
82 /*======================================================================*/
83 
84 
85 struct pcmcia_dynid {
86 	struct list_head 		node;
87 	struct pcmcia_device_id 	id;
88 };
89 
90 /**
91  * pcmcia_store_new_id - add a new PCMCIA device ID to this driver and re-probe devices
92  * @driver: target device driver
93  * @buf: buffer for scanning device ID data
94  * @count: input size
95  *
96  * Adds a new dynamic PCMCIA device ID to this driver,
97  * and causes the driver to probe for all devices again.
98  */
99 static ssize_t
100 pcmcia_store_new_id(struct device_driver *driver, const char *buf, size_t count)
101 {
102 	struct pcmcia_dynid *dynid;
103 	struct pcmcia_driver *pdrv = to_pcmcia_drv(driver);
104 	__u16 match_flags, manf_id, card_id;
105 	__u8 func_id, function, device_no;
106 	__u32 prod_id_hash[4] = {0, 0, 0, 0};
107 	int fields = 0;
108 	int retval = 0;
109 
110 	fields = sscanf(buf, "%hx %hx %hx %hhx %hhx %hhx %x %x %x %x",
111 			&match_flags, &manf_id, &card_id, &func_id, &function, &device_no,
112 			&prod_id_hash[0], &prod_id_hash[1], &prod_id_hash[2], &prod_id_hash[3]);
113 	if (fields < 6)
114 		return -EINVAL;
115 
116 	dynid = kzalloc(sizeof(struct pcmcia_dynid), GFP_KERNEL);
117 	if (!dynid)
118 		return -ENOMEM;
119 
120 	dynid->id.match_flags = match_flags;
121 	dynid->id.manf_id = manf_id;
122 	dynid->id.card_id = card_id;
123 	dynid->id.func_id = func_id;
124 	dynid->id.function = function;
125 	dynid->id.device_no = device_no;
126 	memcpy(dynid->id.prod_id_hash, prod_id_hash, sizeof(__u32) * 4);
127 
128 	mutex_lock(&pdrv->dynids.lock);
129 	list_add_tail(&dynid->node, &pdrv->dynids.list);
130 	mutex_unlock(&pdrv->dynids.lock);
131 
132 	if (get_driver(&pdrv->drv)) {
133 		retval = driver_attach(&pdrv->drv);
134 		put_driver(&pdrv->drv);
135 	}
136 
137 	if (retval)
138 		return retval;
139 	return count;
140 }
141 static DRIVER_ATTR(new_id, S_IWUSR, NULL, pcmcia_store_new_id);
142 
143 static void
144 pcmcia_free_dynids(struct pcmcia_driver *drv)
145 {
146 	struct pcmcia_dynid *dynid, *n;
147 
148 	mutex_lock(&drv->dynids.lock);
149 	list_for_each_entry_safe(dynid, n, &drv->dynids.list, node) {
150 		list_del(&dynid->node);
151 		kfree(dynid);
152 	}
153 	mutex_unlock(&drv->dynids.lock);
154 }
155 
156 static int
157 pcmcia_create_newid_file(struct pcmcia_driver *drv)
158 {
159 	int error = 0;
160 	if (drv->probe != NULL)
161 		error = driver_create_file(&drv->drv, &driver_attr_new_id);
162 	return error;
163 }
164 
165 
166 /**
167  * pcmcia_register_driver - register a PCMCIA driver with the bus core
168  * @driver: the &driver being registered
169  *
170  * Registers a PCMCIA driver with the PCMCIA bus core.
171  */
172 int pcmcia_register_driver(struct pcmcia_driver *driver)
173 {
174 	int error;
175 
176 	if (!driver)
177 		return -EINVAL;
178 
179 	pcmcia_check_driver(driver);
180 
181 	/* initialize common fields */
182 	driver->drv.bus = &pcmcia_bus_type;
183 	driver->drv.owner = driver->owner;
184 	mutex_init(&driver->dynids.lock);
185 	INIT_LIST_HEAD(&driver->dynids.list);
186 
187 	pr_debug("registering driver %s\n", driver->drv.name);
188 
189 	error = driver_register(&driver->drv);
190 	if (error < 0)
191 		return error;
192 
193 	error = pcmcia_create_newid_file(driver);
194 	if (error)
195 		driver_unregister(&driver->drv);
196 
197 	return error;
198 }
199 EXPORT_SYMBOL(pcmcia_register_driver);
200 
201 /**
202  * pcmcia_unregister_driver - unregister a PCMCIA driver with the bus core
203  * @driver: the &driver being unregistered
204  */
205 void pcmcia_unregister_driver(struct pcmcia_driver *driver)
206 {
207 	pr_debug("unregistering driver %s\n", driver->drv.name);
208 	driver_unregister(&driver->drv);
209 	pcmcia_free_dynids(driver);
210 }
211 EXPORT_SYMBOL(pcmcia_unregister_driver);
212 
213 
214 /* pcmcia_device handling */
215 
216 struct pcmcia_device *pcmcia_get_dev(struct pcmcia_device *p_dev)
217 {
218 	struct device *tmp_dev;
219 	tmp_dev = get_device(&p_dev->dev);
220 	if (!tmp_dev)
221 		return NULL;
222 	return to_pcmcia_dev(tmp_dev);
223 }
224 
225 void pcmcia_put_dev(struct pcmcia_device *p_dev)
226 {
227 	if (p_dev)
228 		put_device(&p_dev->dev);
229 }
230 
231 static void pcmcia_release_function(struct kref *ref)
232 {
233 	struct config_t *c = container_of(ref, struct config_t, ref);
234 	pr_debug("releasing config_t\n");
235 	kfree(c);
236 }
237 
238 static void pcmcia_release_dev(struct device *dev)
239 {
240 	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
241 	int i;
242 	dev_dbg(dev, "releasing device\n");
243 	pcmcia_put_socket(p_dev->socket);
244 	for (i = 0; i < 4; i++)
245 		kfree(p_dev->prod_id[i]);
246 	kfree(p_dev->devname);
247 	kref_put(&p_dev->function_config->ref, pcmcia_release_function);
248 	kfree(p_dev);
249 }
250 
251 
252 static int pcmcia_device_probe(struct device *dev)
253 {
254 	struct pcmcia_device *p_dev;
255 	struct pcmcia_driver *p_drv;
256 	struct pcmcia_socket *s;
257 	cistpl_config_t cis_config;
258 	int ret = 0;
259 
260 	dev = get_device(dev);
261 	if (!dev)
262 		return -ENODEV;
263 
264 	p_dev = to_pcmcia_dev(dev);
265 	p_drv = to_pcmcia_drv(dev->driver);
266 	s = p_dev->socket;
267 
268 	dev_dbg(dev, "trying to bind to %s\n", p_drv->drv.name);
269 
270 	if ((!p_drv->probe) || (!p_dev->function_config) ||
271 	    (!try_module_get(p_drv->owner))) {
272 		ret = -EINVAL;
273 		goto put_dev;
274 	}
275 
276 	/* set up some more device information */
277 	ret = pccard_read_tuple(p_dev->socket, p_dev->func, CISTPL_CONFIG,
278 				&cis_config);
279 	if (!ret) {
280 		p_dev->conf.ConfigBase = cis_config.base;
281 		p_dev->conf.Present = cis_config.rmask[0];
282 	} else {
283 		dev_printk(KERN_INFO, dev,
284 			   "pcmcia: could not parse base and rmask0 of CIS\n");
285 		p_dev->conf.ConfigBase = 0;
286 		p_dev->conf.Present = 0;
287 	}
288 
289 	ret = p_drv->probe(p_dev);
290 	if (ret) {
291 		dev_dbg(dev, "binding to %s failed with %d\n",
292 			   p_drv->drv.name, ret);
293 		goto put_module;
294 	}
295 
296 	mutex_lock(&s->ops_mutex);
297 	if ((s->pcmcia_state.has_pfc) &&
298 	    (p_dev->socket->device_count == 1) && (p_dev->device_no == 0))
299 		pcmcia_parse_uevents(s, PCMCIA_UEVENT_REQUERY);
300 	mutex_unlock(&s->ops_mutex);
301 
302 put_module:
303 	if (ret)
304 		module_put(p_drv->owner);
305 put_dev:
306 	if (ret)
307 		put_device(dev);
308 	return ret;
309 }
310 
311 
312 /*
313  * Removes a PCMCIA card from the device tree and socket list.
314  */
315 static void pcmcia_card_remove(struct pcmcia_socket *s, struct pcmcia_device *leftover)
316 {
317 	struct pcmcia_device	*p_dev;
318 	struct pcmcia_device	*tmp;
319 
320 	dev_dbg(leftover ? &leftover->dev : &s->dev,
321 		   "pcmcia_card_remove(%d) %s\n", s->sock,
322 		   leftover ? leftover->devname : "");
323 
324 	mutex_lock(&s->ops_mutex);
325 	if (!leftover)
326 		s->device_count = 0;
327 	else
328 		s->device_count = 1;
329 	mutex_unlock(&s->ops_mutex);
330 
331 	/* unregister all pcmcia_devices registered with this socket, except leftover */
332 	list_for_each_entry_safe(p_dev, tmp, &s->devices_list, socket_device_list) {
333 		if (p_dev == leftover)
334 			continue;
335 
336 		mutex_lock(&s->ops_mutex);
337 		list_del(&p_dev->socket_device_list);
338 		mutex_unlock(&s->ops_mutex);
339 
340 		dev_dbg(&p_dev->dev, "unregistering device\n");
341 		device_unregister(&p_dev->dev);
342 	}
343 
344 	return;
345 }
346 
347 static int pcmcia_device_remove(struct device *dev)
348 {
349 	struct pcmcia_device *p_dev;
350 	struct pcmcia_driver *p_drv;
351 	int i;
352 
353 	p_dev = to_pcmcia_dev(dev);
354 	p_drv = to_pcmcia_drv(dev->driver);
355 
356 	dev_dbg(dev, "removing device\n");
357 
358 	/* If we're removing the primary module driving a
359 	 * pseudo multi-function card, we need to unbind
360 	 * all devices
361 	 */
362 	if ((p_dev->socket->pcmcia_state.has_pfc) &&
363 	    (p_dev->socket->device_count > 0) &&
364 	    (p_dev->device_no == 0))
365 		pcmcia_card_remove(p_dev->socket, p_dev);
366 
367 	/* detach the "instance" */
368 	if (!p_drv)
369 		return 0;
370 
371 	if (p_drv->remove)
372 		p_drv->remove(p_dev);
373 
374 	/* check for proper unloading */
375 	if (p_dev->_irq || p_dev->_io || p_dev->_locked)
376 		dev_printk(KERN_INFO, dev,
377 			"pcmcia: driver %s did not release config properly\n",
378 			p_drv->drv.name);
379 
380 	for (i = 0; i < MAX_WIN; i++)
381 		if (p_dev->_win & CLIENT_WIN_REQ(i))
382 			dev_printk(KERN_INFO, dev,
383 			  "pcmcia: driver %s did not release window properly\n",
384 			   p_drv->drv.name);
385 
386 	/* references from pcmcia_probe_device */
387 	pcmcia_put_dev(p_dev);
388 	module_put(p_drv->owner);
389 
390 	return 0;
391 }
392 
393 
394 /*
395  * pcmcia_device_query -- determine information about a pcmcia device
396  */
397 static int pcmcia_device_query(struct pcmcia_device *p_dev)
398 {
399 	cistpl_manfid_t manf_id;
400 	cistpl_funcid_t func_id;
401 	cistpl_vers_1_t	*vers1;
402 	unsigned int i;
403 
404 	vers1 = kmalloc(sizeof(*vers1), GFP_KERNEL);
405 	if (!vers1)
406 		return -ENOMEM;
407 
408 	if (!pccard_read_tuple(p_dev->socket, BIND_FN_ALL,
409 			       CISTPL_MANFID, &manf_id)) {
410 		mutex_lock(&p_dev->socket->ops_mutex);
411 		p_dev->manf_id = manf_id.manf;
412 		p_dev->card_id = manf_id.card;
413 		p_dev->has_manf_id = 1;
414 		p_dev->has_card_id = 1;
415 		mutex_unlock(&p_dev->socket->ops_mutex);
416 	}
417 
418 	if (!pccard_read_tuple(p_dev->socket, p_dev->func,
419 			       CISTPL_FUNCID, &func_id)) {
420 		mutex_lock(&p_dev->socket->ops_mutex);
421 		p_dev->func_id = func_id.func;
422 		p_dev->has_func_id = 1;
423 		mutex_unlock(&p_dev->socket->ops_mutex);
424 	} else {
425 		/* rule of thumb: cards with no FUNCID, but with
426 		 * common memory device geometry information, are
427 		 * probably memory cards (from pcmcia-cs) */
428 		cistpl_device_geo_t *devgeo;
429 
430 		devgeo = kmalloc(sizeof(*devgeo), GFP_KERNEL);
431 		if (!devgeo) {
432 			kfree(vers1);
433 			return -ENOMEM;
434 		}
435 		if (!pccard_read_tuple(p_dev->socket, p_dev->func,
436 				      CISTPL_DEVICE_GEO, devgeo)) {
437 			dev_dbg(&p_dev->dev,
438 				   "mem device geometry probably means "
439 				   "FUNCID_MEMORY\n");
440 			mutex_lock(&p_dev->socket->ops_mutex);
441 			p_dev->func_id = CISTPL_FUNCID_MEMORY;
442 			p_dev->has_func_id = 1;
443 			mutex_unlock(&p_dev->socket->ops_mutex);
444 		}
445 		kfree(devgeo);
446 	}
447 
448 	if (!pccard_read_tuple(p_dev->socket, BIND_FN_ALL, CISTPL_VERS_1,
449 			       vers1)) {
450 		mutex_lock(&p_dev->socket->ops_mutex);
451 		for (i = 0; i < min_t(unsigned int, 4, vers1->ns); i++) {
452 			char *tmp;
453 			unsigned int length;
454 			char *new;
455 
456 			tmp = vers1->str + vers1->ofs[i];
457 
458 			length = strlen(tmp) + 1;
459 			if ((length < 2) || (length > 255))
460 				continue;
461 
462 			new = kmalloc(sizeof(char) * length, GFP_KERNEL);
463 			if (!new)
464 				continue;
465 
466 			new = strncpy(new, tmp, length);
467 
468 			tmp = p_dev->prod_id[i];
469 			p_dev->prod_id[i] = new;
470 			kfree(tmp);
471 		}
472 		mutex_unlock(&p_dev->socket->ops_mutex);
473 	}
474 
475 	kfree(vers1);
476 	return 0;
477 }
478 
479 
480 struct pcmcia_device *pcmcia_device_add(struct pcmcia_socket *s, unsigned int function)
481 {
482 	struct pcmcia_device *p_dev, *tmp_dev;
483 	int i;
484 
485 	s = pcmcia_get_socket(s);
486 	if (!s)
487 		return NULL;
488 
489 	pr_debug("adding device to %d, function %d\n", s->sock, function);
490 
491 	p_dev = kzalloc(sizeof(struct pcmcia_device), GFP_KERNEL);
492 	if (!p_dev)
493 		goto err_put;
494 
495 	mutex_lock(&s->ops_mutex);
496 	p_dev->device_no = (s->device_count++);
497 	mutex_unlock(&s->ops_mutex);
498 
499 	/* max of 2 PFC devices */
500 	if ((p_dev->device_no >= 2) && (function == 0))
501 		goto err_free;
502 
503 	/* max of 4 devices overall */
504 	if (p_dev->device_no >= 4)
505 		goto err_free;
506 
507 	p_dev->socket = s;
508 	p_dev->func   = function;
509 
510 	p_dev->dev.bus = &pcmcia_bus_type;
511 	p_dev->dev.parent = s->dev.parent;
512 	p_dev->dev.release = pcmcia_release_dev;
513 	/* by default don't allow DMA */
514 	p_dev->dma_mask = DMA_MASK_NONE;
515 	p_dev->dev.dma_mask = &p_dev->dma_mask;
516 	dev_set_name(&p_dev->dev, "%d.%d", p_dev->socket->sock, p_dev->device_no);
517 	if (!dev_name(&p_dev->dev))
518 		goto err_free;
519 	p_dev->devname = kasprintf(GFP_KERNEL, "pcmcia%s", dev_name(&p_dev->dev));
520 	if (!p_dev->devname)
521 		goto err_free;
522 	dev_dbg(&p_dev->dev, "devname is %s\n", p_dev->devname);
523 
524 	mutex_lock(&s->ops_mutex);
525 
526 	/*
527 	 * p_dev->function_config must be the same for all card functions.
528 	 * Note that this is serialized by ops_mutex, so that only one
529 	 * such struct will be created.
530 	 */
531 	list_for_each_entry(tmp_dev, &s->devices_list, socket_device_list)
532 		if (p_dev->func == tmp_dev->func) {
533 			p_dev->function_config = tmp_dev->function_config;
534 			p_dev->io = tmp_dev->io;
535 			p_dev->irq = tmp_dev->irq;
536 			kref_get(&p_dev->function_config->ref);
537 		}
538 
539 	/* Add to the list in pcmcia_bus_socket */
540 	list_add(&p_dev->socket_device_list, &s->devices_list);
541 
542 	if (pcmcia_setup_irq(p_dev))
543 		dev_warn(&p_dev->dev,
544 			"IRQ setup failed -- device might not work\n");
545 
546 	if (!p_dev->function_config) {
547 		dev_dbg(&p_dev->dev, "creating config_t\n");
548 		p_dev->function_config = kzalloc(sizeof(struct config_t),
549 						 GFP_KERNEL);
550 		if (!p_dev->function_config) {
551 			mutex_unlock(&s->ops_mutex);
552 			goto err_unreg;
553 		}
554 		kref_init(&p_dev->function_config->ref);
555 	}
556 	mutex_unlock(&s->ops_mutex);
557 
558 	dev_printk(KERN_NOTICE, &p_dev->dev,
559 		   "pcmcia: registering new device %s (IRQ: %d)\n",
560 		   p_dev->devname, p_dev->irq);
561 
562 	pcmcia_device_query(p_dev);
563 
564 	if (device_register(&p_dev->dev))
565 		goto err_unreg;
566 
567 	return p_dev;
568 
569  err_unreg:
570 	mutex_lock(&s->ops_mutex);
571 	list_del(&p_dev->socket_device_list);
572 	mutex_unlock(&s->ops_mutex);
573 
574  err_free:
575 	mutex_lock(&s->ops_mutex);
576 	s->device_count--;
577 	mutex_unlock(&s->ops_mutex);
578 
579 	for (i = 0; i < 4; i++)
580 		kfree(p_dev->prod_id[i]);
581 	kfree(p_dev->devname);
582 	kfree(p_dev);
583  err_put:
584 	pcmcia_put_socket(s);
585 
586 	return NULL;
587 }
588 
589 
590 static int pcmcia_card_add(struct pcmcia_socket *s)
591 {
592 	cistpl_longlink_mfc_t mfc;
593 	unsigned int no_funcs, i, no_chains;
594 	int ret = -EAGAIN;
595 
596 	mutex_lock(&s->ops_mutex);
597 	if (!(s->resource_setup_done)) {
598 		dev_dbg(&s->dev,
599 			   "no resources available, delaying card_add\n");
600 		mutex_unlock(&s->ops_mutex);
601 		return -EAGAIN; /* try again, but later... */
602 	}
603 
604 	if (pcmcia_validate_mem(s)) {
605 		dev_dbg(&s->dev, "validating mem resources failed, "
606 		       "delaying card_add\n");
607 		mutex_unlock(&s->ops_mutex);
608 		return -EAGAIN; /* try again, but later... */
609 	}
610 	mutex_unlock(&s->ops_mutex);
611 
612 	ret = pccard_validate_cis(s, &no_chains);
613 	if (ret || !no_chains) {
614 		dev_dbg(&s->dev, "invalid CIS or invalid resources\n");
615 		return -ENODEV;
616 	}
617 
618 	if (!pccard_read_tuple(s, BIND_FN_ALL, CISTPL_LONGLINK_MFC, &mfc))
619 		no_funcs = mfc.nfn;
620 	else
621 		no_funcs = 1;
622 	s->functions = no_funcs;
623 
624 	for (i = 0; i < no_funcs; i++)
625 		pcmcia_device_add(s, i);
626 
627 	return ret;
628 }
629 
630 
631 static int pcmcia_requery_callback(struct device *dev, void * _data)
632 {
633 	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
634 	if (!p_dev->dev.driver) {
635 		dev_dbg(dev, "update device information\n");
636 		pcmcia_device_query(p_dev);
637 	}
638 
639 	return 0;
640 }
641 
642 
643 static void pcmcia_requery(struct pcmcia_socket *s)
644 {
645 	int has_pfc;
646 
647 	if (s->functions == 0) {
648 		pcmcia_card_add(s);
649 		return;
650 	}
651 
652 	/* some device information might have changed because of a CIS
653 	 * update or because we can finally read it correctly... so
654 	 * determine it again, overwriting old values if necessary. */
655 	bus_for_each_dev(&pcmcia_bus_type, NULL, NULL, pcmcia_requery_callback);
656 
657 	/* if the CIS changed, we need to check whether the number of
658 	 * functions changed. */
659 	if (s->fake_cis) {
660 		int old_funcs, new_funcs;
661 		cistpl_longlink_mfc_t mfc;
662 
663 		/* does this cis override add or remove functions? */
664 		old_funcs = s->functions;
665 
666 		if (!pccard_read_tuple(s, BIND_FN_ALL, CISTPL_LONGLINK_MFC,
667 					&mfc))
668 			new_funcs = mfc.nfn;
669 		else
670 			new_funcs = 1;
671 		if (old_funcs != new_funcs) {
672 			/* we need to re-start */
673 			pcmcia_card_remove(s, NULL);
674 			s->functions = 0;
675 			pcmcia_card_add(s);
676 		}
677 	}
678 
679 	/* If the PCMCIA device consists of two pseudo devices,
680 	 * call pcmcia_device_add() -- which will fail if both
681 	 * devices are already registered. */
682 	mutex_lock(&s->ops_mutex);
683 	has_pfc = s->pcmcia_state.has_pfc;
684 	mutex_unlock(&s->ops_mutex);
685 	if (has_pfc)
686 		pcmcia_device_add(s, 0);
687 
688 	/* we re-scan all devices, not just the ones connected to this
689 	 * socket. This does not matter, though. */
690 	if (bus_rescan_devices(&pcmcia_bus_type))
691 		dev_warn(&s->dev, "rescanning the bus failed\n");
692 }
693 
694 
695 #ifdef CONFIG_PCMCIA_LOAD_CIS
696 
697 /**
698  * pcmcia_load_firmware - load CIS from userspace if device-provided is broken
699  * @dev: the pcmcia device which needs a CIS override
700  * @filename: requested filename in /lib/firmware/
701  *
702  * This uses the in-kernel firmware loading mechanism to use a "fake CIS" if
703  * the one provided by the card is broken. The firmware files reside in
704  * /lib/firmware/ in userspace.
705  */
706 static int pcmcia_load_firmware(struct pcmcia_device *dev, char * filename)
707 {
708 	struct pcmcia_socket *s = dev->socket;
709 	const struct firmware *fw;
710 	int ret = -ENOMEM;
711 	cistpl_longlink_mfc_t mfc;
712 	int old_funcs, new_funcs = 1;
713 
714 	if (!filename)
715 		return -EINVAL;
716 
717 	dev_dbg(&dev->dev, "trying to load CIS file %s\n", filename);
718 
719 	if (request_firmware(&fw, filename, &dev->dev) == 0) {
720 		if (fw->size >= CISTPL_MAX_CIS_SIZE) {
721 			ret = -EINVAL;
722 			dev_printk(KERN_ERR, &dev->dev,
723 				   "pcmcia: CIS override is too big\n");
724 			goto release;
725 		}
726 
727 		if (!pcmcia_replace_cis(s, fw->data, fw->size))
728 			ret = 0;
729 		else {
730 			dev_printk(KERN_ERR, &dev->dev,
731 				   "pcmcia: CIS override failed\n");
732 			goto release;
733 		}
734 
735 		/* we need to re-start if the number of functions changed */
736 		old_funcs = s->functions;
737 		if (!pccard_read_tuple(s, BIND_FN_ALL, CISTPL_LONGLINK_MFC,
738 					&mfc))
739 			new_funcs = mfc.nfn;
740 
741 		if (old_funcs != new_funcs)
742 			ret = -EBUSY;
743 
744 		/* update information */
745 		pcmcia_device_query(dev);
746 
747 		/* requery (as number of functions might have changed) */
748 		pcmcia_parse_uevents(s, PCMCIA_UEVENT_REQUERY);
749 	}
750  release:
751 	release_firmware(fw);
752 
753 	return ret;
754 }
755 
756 #else /* !CONFIG_PCMCIA_LOAD_CIS */
757 
758 static inline int pcmcia_load_firmware(struct pcmcia_device *dev, char * filename)
759 {
760 	return -ENODEV;
761 }
762 
763 #endif
764 
765 
766 static inline int pcmcia_devmatch(struct pcmcia_device *dev,
767 				  struct pcmcia_device_id *did)
768 {
769 	if (did->match_flags & PCMCIA_DEV_ID_MATCH_MANF_ID) {
770 		if ((!dev->has_manf_id) || (dev->manf_id != did->manf_id))
771 			return 0;
772 	}
773 
774 	if (did->match_flags & PCMCIA_DEV_ID_MATCH_CARD_ID) {
775 		if ((!dev->has_card_id) || (dev->card_id != did->card_id))
776 			return 0;
777 	}
778 
779 	if (did->match_flags & PCMCIA_DEV_ID_MATCH_FUNCTION) {
780 		if (dev->func != did->function)
781 			return 0;
782 	}
783 
784 	if (did->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID1) {
785 		if (!dev->prod_id[0])
786 			return 0;
787 		if (strcmp(did->prod_id[0], dev->prod_id[0]))
788 			return 0;
789 	}
790 
791 	if (did->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID2) {
792 		if (!dev->prod_id[1])
793 			return 0;
794 		if (strcmp(did->prod_id[1], dev->prod_id[1]))
795 			return 0;
796 	}
797 
798 	if (did->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID3) {
799 		if (!dev->prod_id[2])
800 			return 0;
801 		if (strcmp(did->prod_id[2], dev->prod_id[2]))
802 			return 0;
803 	}
804 
805 	if (did->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID4) {
806 		if (!dev->prod_id[3])
807 			return 0;
808 		if (strcmp(did->prod_id[3], dev->prod_id[3]))
809 			return 0;
810 	}
811 
812 	if (did->match_flags & PCMCIA_DEV_ID_MATCH_DEVICE_NO) {
813 		dev_dbg(&dev->dev, "this is a pseudo-multi-function device\n");
814 		mutex_lock(&dev->socket->ops_mutex);
815 		dev->socket->pcmcia_state.has_pfc = 1;
816 		mutex_unlock(&dev->socket->ops_mutex);
817 		if (dev->device_no != did->device_no)
818 			return 0;
819 	}
820 
821 	if (did->match_flags & PCMCIA_DEV_ID_MATCH_FUNC_ID) {
822 		int ret;
823 
824 		if ((!dev->has_func_id) || (dev->func_id != did->func_id))
825 			return 0;
826 
827 		/* if this is a pseudo-multi-function device,
828 		 * we need explicit matches */
829 		if (dev->socket->pcmcia_state.has_pfc)
830 			return 0;
831 		if (dev->device_no)
832 			return 0;
833 
834 		/* also, FUNC_ID matching needs to be activated by userspace
835 		 * after it has re-checked that there is no possible module
836 		 * with a prod_id/manf_id/card_id match.
837 		 */
838 		mutex_lock(&dev->socket->ops_mutex);
839 		ret = dev->allow_func_id_match;
840 		mutex_unlock(&dev->socket->ops_mutex);
841 
842 		if (!ret) {
843 			dev_dbg(&dev->dev,
844 				"skipping FUNC_ID match until userspace ACK\n");
845 			return 0;
846 		}
847 	}
848 
849 	if (did->match_flags & PCMCIA_DEV_ID_MATCH_FAKE_CIS) {
850 		dev_dbg(&dev->dev, "device needs a fake CIS\n");
851 		if (!dev->socket->fake_cis)
852 			if (pcmcia_load_firmware(dev, did->cisfile))
853 				return 0;
854 	}
855 
856 	if (did->match_flags & PCMCIA_DEV_ID_MATCH_ANONYMOUS) {
857 		int i;
858 		for (i = 0; i < 4; i++)
859 			if (dev->prod_id[i])
860 				return 0;
861 		if (dev->has_manf_id || dev->has_card_id || dev->has_func_id)
862 			return 0;
863 	}
864 
865 	return 1;
866 }
867 
868 
869 static int pcmcia_bus_match(struct device *dev, struct device_driver *drv)
870 {
871 	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
872 	struct pcmcia_driver *p_drv = to_pcmcia_drv(drv);
873 	struct pcmcia_device_id *did = p_drv->id_table;
874 	struct pcmcia_dynid *dynid;
875 
876 	/* match dynamic devices first */
877 	mutex_lock(&p_drv->dynids.lock);
878 	list_for_each_entry(dynid, &p_drv->dynids.list, node) {
879 		dev_dbg(dev, "trying to match to %s\n", drv->name);
880 		if (pcmcia_devmatch(p_dev, &dynid->id)) {
881 			dev_dbg(dev, "matched to %s\n", drv->name);
882 			mutex_unlock(&p_drv->dynids.lock);
883 			return 1;
884 		}
885 	}
886 	mutex_unlock(&p_drv->dynids.lock);
887 
888 #ifdef CONFIG_PCMCIA_IOCTL
889 	/* matching by cardmgr */
890 	if (p_dev->cardmgr == p_drv) {
891 		dev_dbg(dev, "cardmgr matched to %s\n", drv->name);
892 		return 1;
893 	}
894 #endif
895 
896 	while (did && did->match_flags) {
897 		dev_dbg(dev, "trying to match to %s\n", drv->name);
898 		if (pcmcia_devmatch(p_dev, did)) {
899 			dev_dbg(dev, "matched to %s\n", drv->name);
900 			return 1;
901 		}
902 		did++;
903 	}
904 
905 	return 0;
906 }
907 
908 #ifdef CONFIG_HOTPLUG
909 
910 static int pcmcia_bus_uevent(struct device *dev, struct kobj_uevent_env *env)
911 {
912 	struct pcmcia_device *p_dev;
913 	int i;
914 	u32 hash[4] = { 0, 0, 0, 0};
915 
916 	if (!dev)
917 		return -ENODEV;
918 
919 	p_dev = to_pcmcia_dev(dev);
920 
921 	/* calculate hashes */
922 	for (i = 0; i < 4; i++) {
923 		if (!p_dev->prod_id[i])
924 			continue;
925 		hash[i] = crc32(0, p_dev->prod_id[i], strlen(p_dev->prod_id[i]));
926 	}
927 
928 	if (add_uevent_var(env, "SOCKET_NO=%u", p_dev->socket->sock))
929 		return -ENOMEM;
930 
931 	if (add_uevent_var(env, "DEVICE_NO=%02X", p_dev->device_no))
932 		return -ENOMEM;
933 
934 	if (add_uevent_var(env, "MODALIAS=pcmcia:m%04Xc%04Xf%02Xfn%02Xpfn%02X"
935 			   "pa%08Xpb%08Xpc%08Xpd%08X",
936 			   p_dev->has_manf_id ? p_dev->manf_id : 0,
937 			   p_dev->has_card_id ? p_dev->card_id : 0,
938 			   p_dev->has_func_id ? p_dev->func_id : 0,
939 			   p_dev->func,
940 			   p_dev->device_no,
941 			   hash[0],
942 			   hash[1],
943 			   hash[2],
944 			   hash[3]))
945 		return -ENOMEM;
946 
947 	return 0;
948 }
949 
950 #else
951 
952 static int pcmcia_bus_uevent(struct device *dev, struct kobj_uevent_env *env)
953 {
954 	return -ENODEV;
955 }
956 
957 #endif
958 
959 /************************ runtime PM support ***************************/
960 
961 static int pcmcia_dev_suspend(struct device *dev, pm_message_t state);
962 static int pcmcia_dev_resume(struct device *dev);
963 
964 static int runtime_suspend(struct device *dev)
965 {
966 	int rc;
967 
968 	device_lock(dev);
969 	rc = pcmcia_dev_suspend(dev, PMSG_SUSPEND);
970 	device_unlock(dev);
971 	return rc;
972 }
973 
974 static int runtime_resume(struct device *dev)
975 {
976 	int rc;
977 
978 	device_lock(dev);
979 	rc = pcmcia_dev_resume(dev);
980 	device_unlock(dev);
981 	return rc;
982 }
983 
984 /************************ per-device sysfs output ***************************/
985 
986 #define pcmcia_device_attr(field, test, format)				\
987 static ssize_t field##_show (struct device *dev, struct device_attribute *attr, char *buf)		\
988 {									\
989 	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);		\
990 	return p_dev->test ? sprintf(buf, format, p_dev->field) : -ENODEV; \
991 }
992 
993 #define pcmcia_device_stringattr(name, field)					\
994 static ssize_t name##_show (struct device *dev, struct device_attribute *attr, char *buf)		\
995 {									\
996 	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);		\
997 	return p_dev->field ? sprintf(buf, "%s\n", p_dev->field) : -ENODEV; \
998 }
999 
1000 pcmcia_device_attr(func, socket, "0x%02x\n");
1001 pcmcia_device_attr(func_id, has_func_id, "0x%02x\n");
1002 pcmcia_device_attr(manf_id, has_manf_id, "0x%04x\n");
1003 pcmcia_device_attr(card_id, has_card_id, "0x%04x\n");
1004 pcmcia_device_stringattr(prod_id1, prod_id[0]);
1005 pcmcia_device_stringattr(prod_id2, prod_id[1]);
1006 pcmcia_device_stringattr(prod_id3, prod_id[2]);
1007 pcmcia_device_stringattr(prod_id4, prod_id[3]);
1008 
1009 
1010 static ssize_t pcmcia_show_pm_state(struct device *dev, struct device_attribute *attr, char *buf)
1011 {
1012 	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
1013 
1014 	if (p_dev->suspended)
1015 		return sprintf(buf, "off\n");
1016 	else
1017 		return sprintf(buf, "on\n");
1018 }
1019 
1020 static ssize_t pcmcia_store_pm_state(struct device *dev, struct device_attribute *attr,
1021 				     const char *buf, size_t count)
1022 {
1023 	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
1024 	int ret = 0;
1025 
1026 	if (!count)
1027 		return -EINVAL;
1028 
1029 	if ((!p_dev->suspended) && !strncmp(buf, "off", 3))
1030 		ret = runtime_suspend(dev);
1031 	else if (p_dev->suspended && !strncmp(buf, "on", 2))
1032 		ret = runtime_resume(dev);
1033 
1034 	return ret ? ret : count;
1035 }
1036 
1037 
1038 static ssize_t modalias_show(struct device *dev, struct device_attribute *attr, char *buf)
1039 {
1040 	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
1041 	int i;
1042 	u32 hash[4] = { 0, 0, 0, 0};
1043 
1044 	/* calculate hashes */
1045 	for (i = 0; i < 4; i++) {
1046 		if (!p_dev->prod_id[i])
1047 			continue;
1048 		hash[i] = crc32(0, p_dev->prod_id[i],
1049 				strlen(p_dev->prod_id[i]));
1050 	}
1051 	return sprintf(buf, "pcmcia:m%04Xc%04Xf%02Xfn%02Xpfn%02X"
1052 				"pa%08Xpb%08Xpc%08Xpd%08X\n",
1053 				p_dev->has_manf_id ? p_dev->manf_id : 0,
1054 				p_dev->has_card_id ? p_dev->card_id : 0,
1055 				p_dev->has_func_id ? p_dev->func_id : 0,
1056 				p_dev->func, p_dev->device_no,
1057 				hash[0], hash[1], hash[2], hash[3]);
1058 }
1059 
1060 static ssize_t pcmcia_store_allow_func_id_match(struct device *dev,
1061 		struct device_attribute *attr, const char *buf, size_t count)
1062 {
1063 	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
1064 
1065 	if (!count)
1066 		return -EINVAL;
1067 
1068 	mutex_lock(&p_dev->socket->ops_mutex);
1069 	p_dev->allow_func_id_match = 1;
1070 	mutex_unlock(&p_dev->socket->ops_mutex);
1071 	pcmcia_parse_uevents(p_dev->socket, PCMCIA_UEVENT_REQUERY);
1072 
1073 	return count;
1074 }
1075 
1076 static struct device_attribute pcmcia_dev_attrs[] = {
1077 	__ATTR(function, 0444, func_show, NULL),
1078 	__ATTR(pm_state, 0644, pcmcia_show_pm_state, pcmcia_store_pm_state),
1079 	__ATTR_RO(func_id),
1080 	__ATTR_RO(manf_id),
1081 	__ATTR_RO(card_id),
1082 	__ATTR_RO(prod_id1),
1083 	__ATTR_RO(prod_id2),
1084 	__ATTR_RO(prod_id3),
1085 	__ATTR_RO(prod_id4),
1086 	__ATTR_RO(modalias),
1087 	__ATTR(allow_func_id_match, 0200, NULL, pcmcia_store_allow_func_id_match),
1088 	__ATTR_NULL,
1089 };
1090 
1091 /* PM support, also needed for reset */
1092 
1093 static int pcmcia_dev_suspend(struct device *dev, pm_message_t state)
1094 {
1095 	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
1096 	struct pcmcia_driver *p_drv = NULL;
1097 	int ret = 0;
1098 
1099 	mutex_lock(&p_dev->socket->ops_mutex);
1100 	if (p_dev->suspended) {
1101 		mutex_unlock(&p_dev->socket->ops_mutex);
1102 		return 0;
1103 	}
1104 	p_dev->suspended = 1;
1105 	mutex_unlock(&p_dev->socket->ops_mutex);
1106 
1107 	dev_dbg(dev, "suspending\n");
1108 
1109 	if (dev->driver)
1110 		p_drv = to_pcmcia_drv(dev->driver);
1111 
1112 	if (!p_drv)
1113 		goto out;
1114 
1115 	if (p_drv->suspend) {
1116 		ret = p_drv->suspend(p_dev);
1117 		if (ret) {
1118 			dev_printk(KERN_ERR, dev,
1119 				   "pcmcia: device %s (driver %s) did "
1120 				   "not want to go to sleep (%d)\n",
1121 				   p_dev->devname, p_drv->drv.name, ret);
1122 			mutex_lock(&p_dev->socket->ops_mutex);
1123 			p_dev->suspended = 0;
1124 			mutex_unlock(&p_dev->socket->ops_mutex);
1125 			goto out;
1126 		}
1127 	}
1128 
1129 	if (p_dev->device_no == p_dev->func) {
1130 		dev_dbg(dev, "releasing configuration\n");
1131 		pcmcia_release_configuration(p_dev);
1132 	}
1133 
1134  out:
1135 	return ret;
1136 }
1137 
1138 
1139 static int pcmcia_dev_resume(struct device *dev)
1140 {
1141 	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
1142 	struct pcmcia_driver *p_drv = NULL;
1143 	int ret = 0;
1144 
1145 	mutex_lock(&p_dev->socket->ops_mutex);
1146 	if (!p_dev->suspended) {
1147 		mutex_unlock(&p_dev->socket->ops_mutex);
1148 		return 0;
1149 	}
1150 	p_dev->suspended = 0;
1151 	mutex_unlock(&p_dev->socket->ops_mutex);
1152 
1153 	dev_dbg(dev, "resuming\n");
1154 
1155 	if (dev->driver)
1156 		p_drv = to_pcmcia_drv(dev->driver);
1157 
1158 	if (!p_drv)
1159 		goto out;
1160 
1161 	if (p_dev->device_no == p_dev->func) {
1162 		dev_dbg(dev, "requesting configuration\n");
1163 		ret = pcmcia_request_configuration(p_dev, &p_dev->conf);
1164 		if (ret)
1165 			goto out;
1166 	}
1167 
1168 	if (p_drv->resume)
1169 		ret = p_drv->resume(p_dev);
1170 
1171  out:
1172 	return ret;
1173 }
1174 
1175 
1176 static int pcmcia_bus_suspend_callback(struct device *dev, void * _data)
1177 {
1178 	struct pcmcia_socket *skt = _data;
1179 	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
1180 
1181 	if (p_dev->socket != skt || p_dev->suspended)
1182 		return 0;
1183 
1184 	return runtime_suspend(dev);
1185 }
1186 
1187 static int pcmcia_bus_resume_callback(struct device *dev, void * _data)
1188 {
1189 	struct pcmcia_socket *skt = _data;
1190 	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
1191 
1192 	if (p_dev->socket != skt || !p_dev->suspended)
1193 		return 0;
1194 
1195 	runtime_resume(dev);
1196 
1197 	return 0;
1198 }
1199 
1200 static int pcmcia_bus_resume(struct pcmcia_socket *skt)
1201 {
1202 	dev_dbg(&skt->dev, "resuming socket %d\n", skt->sock);
1203 	bus_for_each_dev(&pcmcia_bus_type, NULL, skt, pcmcia_bus_resume_callback);
1204 	return 0;
1205 }
1206 
1207 static int pcmcia_bus_suspend(struct pcmcia_socket *skt)
1208 {
1209 	dev_dbg(&skt->dev, "suspending socket %d\n", skt->sock);
1210 	if (bus_for_each_dev(&pcmcia_bus_type, NULL, skt,
1211 			     pcmcia_bus_suspend_callback)) {
1212 		pcmcia_bus_resume(skt);
1213 		return -EIO;
1214 	}
1215 	return 0;
1216 }
1217 
1218 
1219 /*======================================================================
1220 
1221     The card status event handler.
1222 
1223 ======================================================================*/
1224 
1225 /* Normally, the event is passed to individual drivers after
1226  * informing userspace. Only for CS_EVENT_CARD_REMOVAL this
1227  * is inversed to maintain historic compatibility.
1228  */
1229 
1230 static int ds_event(struct pcmcia_socket *skt, event_t event, int priority)
1231 {
1232 	struct pcmcia_socket *s = pcmcia_get_socket(skt);
1233 
1234 	if (!s) {
1235 		dev_printk(KERN_ERR, &skt->dev,
1236 			   "PCMCIA obtaining reference to socket "	\
1237 			   "failed, event 0x%x lost!\n", event);
1238 		return -ENODEV;
1239 	}
1240 
1241 	dev_dbg(&skt->dev, "ds_event(0x%06x, %d, 0x%p)\n",
1242 		   event, priority, skt);
1243 
1244 	switch (event) {
1245 	case CS_EVENT_CARD_REMOVAL:
1246 		atomic_set(&skt->present, 0);
1247 		pcmcia_card_remove(skt, NULL);
1248 		handle_event(skt, event);
1249 		mutex_lock(&s->ops_mutex);
1250 		destroy_cis_cache(s);
1251 		pcmcia_cleanup_irq(s);
1252 		mutex_unlock(&s->ops_mutex);
1253 		break;
1254 
1255 	case CS_EVENT_CARD_INSERTION:
1256 		atomic_set(&skt->present, 1);
1257 		mutex_lock(&s->ops_mutex);
1258 		s->pcmcia_state.has_pfc = 0;
1259 		destroy_cis_cache(s); /* to be on the safe side... */
1260 		mutex_unlock(&s->ops_mutex);
1261 		pcmcia_card_add(skt);
1262 		handle_event(skt, event);
1263 		break;
1264 
1265 	case CS_EVENT_EJECTION_REQUEST:
1266 		break;
1267 
1268 	case CS_EVENT_PM_RESUME:
1269 		if (verify_cis_cache(skt) != 0) {
1270 			dev_dbg(&skt->dev, "cis mismatch - different card\n");
1271 			/* first, remove the card */
1272 			ds_event(skt, CS_EVENT_CARD_REMOVAL, CS_EVENT_PRI_HIGH);
1273 			mutex_lock(&s->ops_mutex);
1274 			destroy_cis_cache(skt);
1275 			kfree(skt->fake_cis);
1276 			skt->fake_cis = NULL;
1277 			s->functions = 0;
1278 			mutex_unlock(&s->ops_mutex);
1279 			/* now, add the new card */
1280 			ds_event(skt, CS_EVENT_CARD_INSERTION,
1281 				 CS_EVENT_PRI_LOW);
1282 		}
1283 		handle_event(skt, event);
1284 		break;
1285 
1286 	case CS_EVENT_PM_SUSPEND:
1287 	case CS_EVENT_RESET_PHYSICAL:
1288 	case CS_EVENT_CARD_RESET:
1289 	default:
1290 		handle_event(skt, event);
1291 		break;
1292     }
1293 
1294     pcmcia_put_socket(s);
1295 
1296     return 0;
1297 } /* ds_event */
1298 
1299 /*
1300  * NOTE: This is racy. There's no guarantee the card will still be
1301  * physically present, even if the call to this function returns
1302  * non-NULL. Furthermore, the device driver most likely is unbound
1303  * almost immediately, so the timeframe where pcmcia_dev_present
1304  * returns NULL is probably really really small.
1305  */
1306 struct pcmcia_device *pcmcia_dev_present(struct pcmcia_device *_p_dev)
1307 {
1308 	struct pcmcia_device *p_dev;
1309 	struct pcmcia_device *ret = NULL;
1310 
1311 	p_dev = pcmcia_get_dev(_p_dev);
1312 	if (!p_dev)
1313 		return NULL;
1314 
1315 	if (atomic_read(&p_dev->socket->present) != 0)
1316 		ret = p_dev;
1317 
1318 	pcmcia_put_dev(p_dev);
1319 	return ret;
1320 }
1321 EXPORT_SYMBOL(pcmcia_dev_present);
1322 
1323 
1324 static struct pcmcia_callback pcmcia_bus_callback = {
1325 	.owner = THIS_MODULE,
1326 	.event = ds_event,
1327 	.requery = pcmcia_requery,
1328 	.validate = pccard_validate_cis,
1329 	.suspend = pcmcia_bus_suspend,
1330 	.resume = pcmcia_bus_resume,
1331 };
1332 
1333 static int __devinit pcmcia_bus_add_socket(struct device *dev,
1334 					   struct class_interface *class_intf)
1335 {
1336 	struct pcmcia_socket *socket = dev_get_drvdata(dev);
1337 	int ret;
1338 
1339 	socket = pcmcia_get_socket(socket);
1340 	if (!socket) {
1341 		dev_printk(KERN_ERR, dev,
1342 			   "PCMCIA obtaining reference to socket failed\n");
1343 		return -ENODEV;
1344 	}
1345 
1346 	ret = sysfs_create_bin_file(&dev->kobj, &pccard_cis_attr);
1347 	if (ret) {
1348 		dev_printk(KERN_ERR, dev, "PCMCIA registration failed\n");
1349 		pcmcia_put_socket(socket);
1350 		return ret;
1351 	}
1352 
1353 #ifdef CONFIG_PCMCIA_IOCTL
1354 	init_waitqueue_head(&socket->queue);
1355 #endif
1356 	INIT_LIST_HEAD(&socket->devices_list);
1357 	memset(&socket->pcmcia_state, 0, sizeof(u8));
1358 	socket->device_count = 0;
1359 
1360 	ret = pccard_register_pcmcia(socket, &pcmcia_bus_callback);
1361 	if (ret) {
1362 		dev_printk(KERN_ERR, dev, "PCMCIA registration failed\n");
1363 		pcmcia_put_socket(socket);
1364 		return ret;
1365 	}
1366 
1367 	atomic_set(&socket->present, 0);
1368 
1369 	return 0;
1370 }
1371 
1372 static void pcmcia_bus_remove_socket(struct device *dev,
1373 				     struct class_interface *class_intf)
1374 {
1375 	struct pcmcia_socket *socket = dev_get_drvdata(dev);
1376 
1377 	if (!socket)
1378 		return;
1379 
1380 	pccard_register_pcmcia(socket, NULL);
1381 
1382 	/* unregister any unbound devices */
1383 	mutex_lock(&socket->skt_mutex);
1384 	pcmcia_card_remove(socket, NULL);
1385 	release_cis_mem(socket);
1386 	mutex_unlock(&socket->skt_mutex);
1387 
1388 	sysfs_remove_bin_file(&dev->kobj, &pccard_cis_attr);
1389 
1390 	pcmcia_put_socket(socket);
1391 
1392 	return;
1393 }
1394 
1395 
1396 /* the pcmcia_bus_interface is used to handle pcmcia socket devices */
1397 static struct class_interface pcmcia_bus_interface __refdata = {
1398 	.class = &pcmcia_socket_class,
1399 	.add_dev = &pcmcia_bus_add_socket,
1400 	.remove_dev = &pcmcia_bus_remove_socket,
1401 };
1402 
1403 
1404 struct bus_type pcmcia_bus_type = {
1405 	.name = "pcmcia",
1406 	.uevent = pcmcia_bus_uevent,
1407 	.match = pcmcia_bus_match,
1408 	.dev_attrs = pcmcia_dev_attrs,
1409 	.probe = pcmcia_device_probe,
1410 	.remove = pcmcia_device_remove,
1411 	.suspend = pcmcia_dev_suspend,
1412 	.resume = pcmcia_dev_resume,
1413 };
1414 
1415 
1416 static int __init init_pcmcia_bus(void)
1417 {
1418 	int ret;
1419 
1420 	ret = bus_register(&pcmcia_bus_type);
1421 	if (ret < 0) {
1422 		printk(KERN_WARNING "pcmcia: bus_register error: %d\n", ret);
1423 		return ret;
1424 	}
1425 	ret = class_interface_register(&pcmcia_bus_interface);
1426 	if (ret < 0) {
1427 		printk(KERN_WARNING
1428 			"pcmcia: class_interface_register error: %d\n", ret);
1429 		bus_unregister(&pcmcia_bus_type);
1430 		return ret;
1431 	}
1432 
1433 	pcmcia_setup_ioctl();
1434 
1435 	return 0;
1436 }
1437 fs_initcall(init_pcmcia_bus); /* one level after subsys_initcall so that
1438 			       * pcmcia_socket_class is already registered */
1439 
1440 
1441 static void __exit exit_pcmcia_bus(void)
1442 {
1443 	pcmcia_cleanup_ioctl();
1444 
1445 	class_interface_unregister(&pcmcia_bus_interface);
1446 
1447 	bus_unregister(&pcmcia_bus_type);
1448 }
1449 module_exit(exit_pcmcia_bus);
1450 
1451 
1452 MODULE_ALIAS("ds");
1453