ds.c 34.4 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12
/*
 * ds.c -- 16-bit PCMCIA core support
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 *
 * The initial developer of the original code is David A. Hinds
 * <dahinds@users.sourceforge.net>.  Portions created by David A. Hinds
 * are Copyright (C) 1999 David A. Hinds.  All Rights Reserved.
 *
 * (C) 1999		David A. Hinds
13
 * (C) 2003 - 2010	Dominik Brodowski
L
Linus Torvalds 已提交
14 15
 */

16
#include <linux/kernel.h>
L
Linus Torvalds 已提交
17 18 19 20 21 22
#include <linux/module.h>
#include <linux/init.h>
#include <linux/errno.h>
#include <linux/list.h>
#include <linux/delay.h>
#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>
L
Linus Torvalds 已提交
28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45

#include <pcmcia/cistpl.h>
#include <pcmcia/ds.h>
#include <pcmcia/ss.h>

#include "cs_internal.h"

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

/* Module parameters */

MODULE_AUTHOR("David Hinds <dahinds@users.sourceforge.net>");
MODULE_DESCRIPTION("PCMCIA Driver Services");
MODULE_LICENSE("GPL");


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

46 47 48 49 50 51
static void pcmcia_check_driver(struct pcmcia_driver *p_drv)
{
	struct pcmcia_device_id *did = p_drv->id_table;
	unsigned int i;
	u32 hash;

52
	if (!p_drv->probe || !p_drv->remove)
P
Pavel Roskin 已提交
53 54
		printk(KERN_DEBUG "pcmcia: %s lacks a requisite callback "
		       "function\n", p_drv->drv.name);
55

56
	while (did && did->match_flags) {
D
Dominik Brodowski 已提交
57
		for (i = 0; i < 4; i++) {
58 59 60 61 62 63 64 65 66 67 68
			if (!did->prod_id[i])
				continue;

			hash = crc32(0, did->prod_id[i], strlen(did->prod_id[i]));
			if (hash == did->prod_id_hash[i])
				continue;

			printk(KERN_DEBUG "pcmcia: %s: invalid hash for "
			       "product string \"%s\": is 0x%x, should "
			       "be 0x%x\n", p_drv->drv.name, did->prod_id[i],
			       did->prod_id_hash[i], hash);
69 70 71
			printk(KERN_DEBUG "pcmcia: see "
				"Documentation/pcmcia/devicetable.txt for "
				"details\n");
72 73 74 75 76 77 78
		}
		did++;
	}

	return;
}

79

L
Linus Torvalds 已提交
80 81 82
/*======================================================================*/


B
Bernhard Walle 已提交
83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104
struct pcmcia_dynid {
	struct list_head 		node;
	struct pcmcia_device_id 	id;
};

/**
 * pcmcia_store_new_id - add a new PCMCIA device ID to this driver and re-probe devices
 * @driver: target device driver
 * @buf: buffer for scanning device ID data
 * @count: input size
 *
 * Adds a new dynamic PCMCIA device ID to this driver,
 * and causes the driver to probe for all devices again.
 */
static ssize_t
pcmcia_store_new_id(struct device_driver *driver, const char *buf, size_t count)
{
	struct pcmcia_dynid *dynid;
	struct pcmcia_driver *pdrv = to_pcmcia_drv(driver);
	__u16 match_flags, manf_id, card_id;
	__u8 func_id, function, device_no;
	__u32 prod_id_hash[4] = {0, 0, 0, 0};
D
Dominik Brodowski 已提交
105
	int fields = 0;
B
Bernhard Walle 已提交
106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125
	int retval = 0;

	fields = sscanf(buf, "%hx %hx %hx %hhx %hhx %hhx %x %x %x %x",
			&match_flags, &manf_id, &card_id, &func_id, &function, &device_no,
			&prod_id_hash[0], &prod_id_hash[1], &prod_id_hash[2], &prod_id_hash[3]);
	if (fields < 6)
		return -EINVAL;

	dynid = kzalloc(sizeof(struct pcmcia_dynid), GFP_KERNEL);
	if (!dynid)
		return -ENOMEM;

	dynid->id.match_flags = match_flags;
	dynid->id.manf_id = manf_id;
	dynid->id.card_id = card_id;
	dynid->id.func_id = func_id;
	dynid->id.function = function;
	dynid->id.device_no = device_no;
	memcpy(dynid->id.prod_id_hash, prod_id_hash, sizeof(__u32) * 4);

126
	mutex_lock(&pdrv->dynids.lock);
127
	list_add_tail(&dynid->node, &pdrv->dynids.list);
128
	mutex_unlock(&pdrv->dynids.lock);
B
Bernhard Walle 已提交
129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145

	if (get_driver(&pdrv->drv)) {
		retval = driver_attach(&pdrv->drv);
		put_driver(&pdrv->drv);
	}

	if (retval)
		return retval;
	return count;
}
static DRIVER_ATTR(new_id, S_IWUSR, NULL, pcmcia_store_new_id);

static void
pcmcia_free_dynids(struct pcmcia_driver *drv)
{
	struct pcmcia_dynid *dynid, *n;

146
	mutex_lock(&drv->dynids.lock);
B
Bernhard Walle 已提交
147 148 149 150
	list_for_each_entry_safe(dynid, n, &drv->dynids.list, node) {
		list_del(&dynid->node);
		kfree(dynid);
	}
151
	mutex_unlock(&drv->dynids.lock);
B
Bernhard Walle 已提交
152 153 154 155 156 157 158
}

static int
pcmcia_create_newid_file(struct pcmcia_driver *drv)
{
	int error = 0;
	if (drv->probe != NULL)
159
		error = driver_create_file(&drv->drv, &driver_attr_new_id);
B
Bernhard Walle 已提交
160 161 162 163
	return error;
}


L
Linus Torvalds 已提交
164 165
/**
 * pcmcia_register_driver - register a PCMCIA driver with the bus core
R
Randy Dunlap 已提交
166
 * @driver: the &driver being registered
L
Linus Torvalds 已提交
167 168 169 170 171
 *
 * Registers a PCMCIA driver with the PCMCIA bus core.
 */
int pcmcia_register_driver(struct pcmcia_driver *driver)
{
B
Bernhard Walle 已提交
172 173
	int error;

L
Linus Torvalds 已提交
174 175 176
	if (!driver)
		return -EINVAL;

177 178
	pcmcia_check_driver(driver);

L
Linus Torvalds 已提交
179 180 181
	/* initialize common fields */
	driver->drv.bus = &pcmcia_bus_type;
	driver->drv.owner = driver->owner;
182
	mutex_init(&driver->dynids.lock);
B
Bernhard Walle 已提交
183
	INIT_LIST_HEAD(&driver->dynids.list);
L
Linus Torvalds 已提交
184

185
	pr_debug("registering driver %s\n", driver->drv.name);
186

B
Bernhard Walle 已提交
187 188 189 190 191 192 193 194 195
	error = driver_register(&driver->drv);
	if (error < 0)
		return error;

	error = pcmcia_create_newid_file(driver);
	if (error)
		driver_unregister(&driver->drv);

	return error;
L
Linus Torvalds 已提交
196 197 198 199 200
}
EXPORT_SYMBOL(pcmcia_register_driver);

/**
 * pcmcia_unregister_driver - unregister a PCMCIA driver with the bus core
R
Randy Dunlap 已提交
201
 * @driver: the &driver being unregistered
L
Linus Torvalds 已提交
202 203 204
 */
void pcmcia_unregister_driver(struct pcmcia_driver *driver)
{
205
	pr_debug("unregistering driver %s\n", driver->drv.name);
L
Linus Torvalds 已提交
206
	driver_unregister(&driver->drv);
B
Bernhard Walle 已提交
207
	pcmcia_free_dynids(driver);
L
Linus Torvalds 已提交
208 209 210 211 212 213
}
EXPORT_SYMBOL(pcmcia_unregister_driver);


/* pcmcia_device handling */

214
static struct pcmcia_device *pcmcia_get_dev(struct pcmcia_device *p_dev)
L
Linus Torvalds 已提交
215 216 217 218 219 220 221 222
{
	struct device *tmp_dev;
	tmp_dev = get_device(&p_dev->dev);
	if (!tmp_dev)
		return NULL;
	return to_pcmcia_dev(tmp_dev);
}

223
static void pcmcia_put_dev(struct pcmcia_device *p_dev)
L
Linus Torvalds 已提交
224 225 226 227 228
{
	if (p_dev)
		put_device(&p_dev->dev);
}

229 230 231
static void pcmcia_release_function(struct kref *ref)
{
	struct config_t *c = container_of(ref, struct config_t, ref);
232
	pr_debug("releasing config_t\n");
233 234 235
	kfree(c);
}

L
Linus Torvalds 已提交
236 237 238
static void pcmcia_release_dev(struct device *dev)
{
	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
239
	int i;
240
	dev_dbg(dev, "releasing device\n");
241
	pcmcia_put_socket(p_dev->socket);
242 243
	for (i = 0; i < 4; i++)
		kfree(p_dev->prod_id[i]);
244
	kfree(p_dev->devname);
245
	kref_put(&p_dev->function_config->ref, pcmcia_release_function);
L
Linus Torvalds 已提交
246 247 248 249
	kfree(p_dev);
}


D
Dominik Brodowski 已提交
250
static int pcmcia_device_probe(struct device *dev)
L
Linus Torvalds 已提交
251 252 253
{
	struct pcmcia_device *p_dev;
	struct pcmcia_driver *p_drv;
254
	struct pcmcia_socket *s;
255
	cistpl_config_t cis_config;
L
Linus Torvalds 已提交
256 257 258 259 260 261 262 263
	int ret = 0;

	dev = get_device(dev);
	if (!dev)
		return -ENODEV;

	p_dev = to_pcmcia_dev(dev);
	p_drv = to_pcmcia_drv(dev->driver);
264
	s = p_dev->socket;
L
Linus Torvalds 已提交
265

266
	dev_dbg(dev, "trying to bind to %s\n", p_drv->drv.name);
267

268 269
	if ((!p_drv->probe) || (!p_dev->function_config) ||
	    (!try_module_get(p_drv->owner))) {
L
Linus Torvalds 已提交
270 271 272 273
		ret = -EINVAL;
		goto put_dev;
	}

274 275 276 277
	/* set up some more device information */
	ret = pccard_read_tuple(p_dev->socket, p_dev->func, CISTPL_CONFIG,
				&cis_config);
	if (!ret) {
278 279
		p_dev->config_base = cis_config.base;
		p_dev->config_regs = cis_config.rmask[0];
280 281
		dev_dbg(dev, "base %x, regs %x", p_dev->config_base,
			p_dev->config_regs);
282
	} else {
283 284
		dev_printk(KERN_INFO, dev,
			   "pcmcia: could not parse base and rmask0 of CIS\n");
285 286
		p_dev->config_base = 0;
		p_dev->config_regs = 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 297 298 299
	dev_dbg(dev, "%s bound: Vpp %d.%d, idx %x, IRQ %d", p_drv->drv.name,
		p_dev->vpp/10, p_dev->vpp%10, p_dev->config_index, p_dev->irq);
	dev_dbg(dev, "resources: ioport %pR %pR iomem %pR %pR %pR",
		p_dev->resource[0], p_dev->resource[1], p_dev->resource[2],
		p_dev->resource[3], p_dev->resource[4]);
300

D
Dominik Brodowski 已提交
301
	mutex_lock(&s->ops_mutex);
302
	if ((s->pcmcia_pfc) &&
303
	    (p_dev->socket->device_count == 1) && (p_dev->device_no == 0))
304
		pcmcia_parse_uevents(s, PCMCIA_UEVENT_REQUERY);
D
Dominik Brodowski 已提交
305
	mutex_unlock(&s->ops_mutex);
306

307
put_module:
L
Linus Torvalds 已提交
308 309
	if (ret)
		module_put(p_drv->owner);
310
put_dev:
311
	if (ret)
L
Linus Torvalds 已提交
312
		put_device(dev);
D
Dominik Brodowski 已提交
313
	return ret;
L
Linus Torvalds 已提交
314 315 316
}


317 318 319 320 321 322 323 324
/*
 * Removes a PCMCIA card from the device tree and socket list.
 */
static void pcmcia_card_remove(struct pcmcia_socket *s, struct pcmcia_device *leftover)
{
	struct pcmcia_device	*p_dev;
	struct pcmcia_device	*tmp;

325
	dev_dbg(leftover ? &leftover->dev : &s->dev,
326 327
		   "pcmcia_card_remove(%d) %s\n", s->sock,
		   leftover ? leftover->devname : "");
328

D
Dominik Brodowski 已提交
329
	mutex_lock(&s->ops_mutex);
330 331 332 333
	if (!leftover)
		s->device_count = 0;
	else
		s->device_count = 1;
D
Dominik Brodowski 已提交
334
	mutex_unlock(&s->ops_mutex);
335 336 337 338 339 340

	/* unregister all pcmcia_devices registered with this socket, except leftover */
	list_for_each_entry_safe(p_dev, tmp, &s->devices_list, socket_device_list) {
		if (p_dev == leftover)
			continue;

D
Dominik Brodowski 已提交
341
		mutex_lock(&s->ops_mutex);
342
		list_del(&p_dev->socket_device_list);
D
Dominik Brodowski 已提交
343
		mutex_unlock(&s->ops_mutex);
344

345
		dev_dbg(&p_dev->dev, "unregistering device\n");
346 347 348 349 350 351
		device_unregister(&p_dev->dev);
	}

	return;
}

D
Dominik Brodowski 已提交
352
static int pcmcia_device_remove(struct device *dev)
L
Linus Torvalds 已提交
353 354 355
{
	struct pcmcia_device *p_dev;
	struct pcmcia_driver *p_drv;
356
	int i;
L
Linus Torvalds 已提交
357 358 359

	p_dev = to_pcmcia_dev(dev);
	p_drv = to_pcmcia_drv(dev->driver);
360

361
	dev_dbg(dev, "removing device\n");
362

363 364 365 366
	/* If we're removing the primary module driving a
	 * pseudo multi-function card, we need to unbind
	 * all devices
	 */
367
	if ((p_dev->socket->pcmcia_pfc) &&
368
	    (p_dev->socket->device_count > 0) &&
369 370 371 372
	    (p_dev->device_no == 0))
		pcmcia_card_remove(p_dev->socket, p_dev);

	/* detach the "instance" */
373 374
	if (!p_drv)
		return 0;
L
Linus Torvalds 已提交
375

376
	if (p_drv->remove)
D
Dominik Brodowski 已提交
377
		p_drv->remove(p_dev);
378

379
	/* check for proper unloading */
380
	if (p_dev->_irq || p_dev->_io || p_dev->_locked)
381 382 383
		dev_printk(KERN_INFO, dev,
			"pcmcia: driver %s did not release config properly\n",
			p_drv->drv.name);
384

385
	for (i = 0; i < MAX_WIN; i++)
386
		if (p_dev->_win & CLIENT_WIN_REQ(i))
387 388 389
			dev_printk(KERN_INFO, dev,
			  "pcmcia: driver %s did not release window properly\n",
			   p_drv->drv.name);
390

391 392 393
	/* references from pcmcia_probe_device */
	pcmcia_put_dev(p_dev);
	module_put(p_drv->owner);
L
Linus Torvalds 已提交
394 395 396 397 398 399 400 401 402 403 404 405

	return 0;
}


/*
 * pcmcia_device_query -- determine information about a pcmcia device
 */
static int pcmcia_device_query(struct pcmcia_device *p_dev)
{
	cistpl_manfid_t manf_id;
	cistpl_funcid_t func_id;
406
	cistpl_vers_1_t	*vers1;
L
Linus Torvalds 已提交
407 408
	unsigned int i;

409 410 411 412
	vers1 = kmalloc(sizeof(*vers1), GFP_KERNEL);
	if (!vers1)
		return -ENOMEM;

413
	if (!pccard_read_tuple(p_dev->socket, BIND_FN_ALL,
L
Linus Torvalds 已提交
414
			       CISTPL_MANFID, &manf_id)) {
415
		mutex_lock(&p_dev->socket->ops_mutex);
L
Linus Torvalds 已提交
416 417 418 419
		p_dev->manf_id = manf_id.manf;
		p_dev->card_id = manf_id.card;
		p_dev->has_manf_id = 1;
		p_dev->has_card_id = 1;
420
		mutex_unlock(&p_dev->socket->ops_mutex);
L
Linus Torvalds 已提交
421 422 423 424
	}

	if (!pccard_read_tuple(p_dev->socket, p_dev->func,
			       CISTPL_FUNCID, &func_id)) {
425
		mutex_lock(&p_dev->socket->ops_mutex);
L
Linus Torvalds 已提交
426 427
		p_dev->func_id = func_id.func;
		p_dev->has_func_id = 1;
428
		mutex_unlock(&p_dev->socket->ops_mutex);
L
Linus Torvalds 已提交
429 430 431 432
	} else {
		/* rule of thumb: cards with no FUNCID, but with
		 * common memory device geometry information, are
		 * probably memory cards (from pcmcia-cs) */
433 434 435 436 437 438 439
		cistpl_device_geo_t *devgeo;

		devgeo = kmalloc(sizeof(*devgeo), GFP_KERNEL);
		if (!devgeo) {
			kfree(vers1);
			return -ENOMEM;
		}
L
Linus Torvalds 已提交
440
		if (!pccard_read_tuple(p_dev->socket, p_dev->func,
441
				      CISTPL_DEVICE_GEO, devgeo)) {
442
			dev_dbg(&p_dev->dev,
443 444
				   "mem device geometry probably means "
				   "FUNCID_MEMORY\n");
445
			mutex_lock(&p_dev->socket->ops_mutex);
L
Linus Torvalds 已提交
446 447
			p_dev->func_id = CISTPL_FUNCID_MEMORY;
			p_dev->has_func_id = 1;
448
			mutex_unlock(&p_dev->socket->ops_mutex);
L
Linus Torvalds 已提交
449
		}
450
		kfree(devgeo);
L
Linus Torvalds 已提交
451 452
	}

453
	if (!pccard_read_tuple(p_dev->socket, BIND_FN_ALL, CISTPL_VERS_1,
454
			       vers1)) {
455
		mutex_lock(&p_dev->socket->ops_mutex);
456
		for (i = 0; i < min_t(unsigned int, 4, vers1->ns); i++) {
L
Linus Torvalds 已提交
457 458
			char *tmp;
			unsigned int length;
459
			char *new;
L
Linus Torvalds 已提交
460

461
			tmp = vers1->str + vers1->ofs[i];
L
Linus Torvalds 已提交
462 463

			length = strlen(tmp) + 1;
464
			if ((length < 2) || (length > 255))
L
Linus Torvalds 已提交
465 466
				continue;

467 468
			new = kmalloc(sizeof(char) * length, GFP_KERNEL);
			if (!new)
L
Linus Torvalds 已提交
469 470
				continue;

471 472 473 474 475
			new = strncpy(new, tmp, length);

			tmp = p_dev->prod_id[i];
			p_dev->prod_id[i] = new;
			kfree(tmp);
L
Linus Torvalds 已提交
476
		}
477
		mutex_unlock(&p_dev->socket->ops_mutex);
L
Linus Torvalds 已提交
478 479
	}

480
	kfree(vers1);
L
Linus Torvalds 已提交
481 482 483 484
	return 0;
}


485 486
static struct pcmcia_device *pcmcia_device_add(struct pcmcia_socket *s,
					       unsigned int function)
L
Linus Torvalds 已提交
487
{
488
	struct pcmcia_device *p_dev, *tmp_dev;
489
	int i;
L
Linus Torvalds 已提交
490

491
	s = pcmcia_get_socket(s);
L
Linus Torvalds 已提交
492 493 494
	if (!s)
		return NULL;

495
	pr_debug("adding device to %d, function %d\n", s->sock, function);
496

497
	p_dev = kzalloc(sizeof(struct pcmcia_device), GFP_KERNEL);
L
Linus Torvalds 已提交
498 499 500
	if (!p_dev)
		goto err_put;

D
Dominik Brodowski 已提交
501
	mutex_lock(&s->ops_mutex);
L
Linus Torvalds 已提交
502
	p_dev->device_no = (s->device_count++);
D
Dominik Brodowski 已提交
503
	mutex_unlock(&s->ops_mutex);
504

505 506 507 508 509 510
	/* max of 2 PFC devices */
	if ((p_dev->device_no >= 2) && (function == 0))
		goto err_free;

	/* max of 4 devices overall */
	if (p_dev->device_no >= 4)
511 512 513
		goto err_free;

	p_dev->socket = s;
L
Linus Torvalds 已提交
514 515 516
	p_dev->func   = function;

	p_dev->dev.bus = &pcmcia_bus_type;
517
	p_dev->dev.parent = s->dev.parent;
L
Linus Torvalds 已提交
518
	p_dev->dev.release = pcmcia_release_dev;
519 520 521
	/* by default don't allow DMA */
	p_dev->dma_mask = DMA_MASK_NONE;
	p_dev->dev.dma_mask = &p_dev->dma_mask;
522 523 524 525
	dev_set_name(&p_dev->dev, "%d.%d", p_dev->socket->sock, p_dev->device_no);
	if (!dev_name(&p_dev->dev))
		goto err_free;
	p_dev->devname = kasprintf(GFP_KERNEL, "pcmcia%s", dev_name(&p_dev->dev));
526 527
	if (!p_dev->devname)
		goto err_free;
528
	dev_dbg(&p_dev->dev, "devname is %s\n", p_dev->devname);
L
Linus Torvalds 已提交
529

D
Dominik Brodowski 已提交
530
	mutex_lock(&s->ops_mutex);
531 532 533

	/*
	 * p_dev->function_config must be the same for all card functions.
534 535
	 * Note that this is serialized by ops_mutex, so that only one
	 * such struct will be created.
536
	 */
D
Dominik Brodowski 已提交
537 538
	list_for_each_entry(tmp_dev, &s->devices_list, socket_device_list)
		if (p_dev->func == tmp_dev->func) {
539
			p_dev->function_config = tmp_dev->function_config;
540
			p_dev->irq = tmp_dev->irq;
541 542 543 544
			kref_get(&p_dev->function_config->ref);
		}

	/* Add to the list in pcmcia_bus_socket */
545
	list_add(&p_dev->socket_device_list, &s->devices_list);
546

547 548 549
	if (pcmcia_setup_irq(p_dev))
		dev_warn(&p_dev->dev,
			"IRQ setup failed -- device might not work\n");
L
Linus Torvalds 已提交
550

551
	if (!p_dev->function_config) {
552
		config_t *c;
553
		dev_dbg(&p_dev->dev, "creating config_t\n");
554 555
		c = kzalloc(sizeof(struct config_t), GFP_KERNEL);
		if (!c) {
556
			mutex_unlock(&s->ops_mutex);
557
			goto err_unreg;
558
		}
559 560 561
		p_dev->function_config = c;
		kref_init(&c->ref);
		for (i = 0; i < MAX_IO_WIN; i++) {
562
			c->io[i].name = p_dev->devname;
563 564
			c->io[i].flags = IORESOURCE_IO;
		}
565
		for (i = 0; i< MAX_WIN; i++) {
566
			c->mem[i].name = p_dev->devname;
567 568
			c->mem[i].flags = IORESOURCE_MEM;
		}
569
	}
570 571
	for (i = 0; i < MAX_IO_WIN; i++)
		p_dev->resource[i] = &p_dev->function_config->io[i];
572 573
	for (; i < (MAX_IO_WIN + MAX_WIN); i++)
		p_dev->resource[i] = &p_dev->function_config->mem[i-MAX_IO_WIN];
574

575
	mutex_unlock(&s->ops_mutex);
576

577
	dev_printk(KERN_NOTICE, &p_dev->dev,
578
		   "pcmcia: registering new device %s (IRQ: %d)\n",
579
		   p_dev->devname, p_dev->irq);
580

581 582
	pcmcia_device_query(p_dev);

583 584
	if (device_register(&p_dev->dev))
		goto err_unreg;
L
Linus Torvalds 已提交
585 586 587

	return p_dev;

588
 err_unreg:
D
Dominik Brodowski 已提交
589
	mutex_lock(&s->ops_mutex);
590
	list_del(&p_dev->socket_device_list);
D
Dominik Brodowski 已提交
591
	mutex_unlock(&s->ops_mutex);
592

L
Linus Torvalds 已提交
593
 err_free:
D
Dominik Brodowski 已提交
594
	mutex_lock(&s->ops_mutex);
595
	s->device_count--;
D
Dominik Brodowski 已提交
596
	mutex_unlock(&s->ops_mutex);
597

598 599
	for (i = 0; i < 4; i++)
		kfree(p_dev->prod_id[i]);
600
	kfree(p_dev->devname);
L
Linus Torvalds 已提交
601 602
	kfree(p_dev);
 err_put:
603
	pcmcia_put_socket(s);
L
Linus Torvalds 已提交
604 605 606 607 608 609 610 611

	return NULL;
}


static int pcmcia_card_add(struct pcmcia_socket *s)
{
	cistpl_longlink_mfc_t mfc;
612
	unsigned int no_funcs, i, no_chains;
613
	int ret = -EAGAIN;
L
Linus Torvalds 已提交
614

615
	mutex_lock(&s->ops_mutex);
616
	if (!(s->resource_setup_done)) {
617
		dev_dbg(&s->dev,
618
			   "no resources available, delaying card_add\n");
619
		mutex_unlock(&s->ops_mutex);
L
Linus Torvalds 已提交
620
		return -EAGAIN; /* try again, but later... */
621
	}
L
Linus Torvalds 已提交
622

623
	if (pcmcia_validate_mem(s)) {
624
		dev_dbg(&s->dev, "validating mem resources failed, "
625
		       "delaying card_add\n");
626
		mutex_unlock(&s->ops_mutex);
627
		return -EAGAIN; /* try again, but later... */
628
	}
629
	mutex_unlock(&s->ops_mutex);
630

631
	ret = pccard_validate_cis(s, &no_chains);
632
	if (ret || !no_chains) {
633
		dev_dbg(&s->dev, "invalid CIS or invalid resources\n");
L
Linus Torvalds 已提交
634 635 636 637 638 639 640
		return -ENODEV;
	}

	if (!pccard_read_tuple(s, BIND_FN_ALL, CISTPL_LONGLINK_MFC, &mfc))
		no_funcs = mfc.nfn;
	else
		no_funcs = 1;
641
	s->functions = no_funcs;
L
Linus Torvalds 已提交
642

D
Dominik Brodowski 已提交
643
	for (i = 0; i < no_funcs; i++)
644
		pcmcia_device_add(s, i);
L
Linus Torvalds 已提交
645

D
Dominik Brodowski 已提交
646
	return ret;
L
Linus Torvalds 已提交
647 648 649
}


650
static int pcmcia_requery_callback(struct device *dev, void * _data)
651
{
652
	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
653
	if (!p_dev->dev.driver) {
654
		dev_dbg(dev, "update device information\n");
655
		pcmcia_device_query(p_dev);
656
	}
657 658 659 660

	return 0;
}

661

662
static void pcmcia_requery(struct pcmcia_socket *s)
663
{
664
	int has_pfc;
665

666 667 668
	if (s->functions == 0) {
		pcmcia_card_add(s);
		return;
669 670 671 672 673
	}

	/* some device information might have changed because of a CIS
	 * update or because we can finally read it correctly... so
	 * determine it again, overwriting old values if necessary. */
674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689
	bus_for_each_dev(&pcmcia_bus_type, NULL, NULL, pcmcia_requery_callback);

	/* if the CIS changed, we need to check whether the number of
	 * functions changed. */
	if (s->fake_cis) {
		int old_funcs, new_funcs;
		cistpl_longlink_mfc_t mfc;

		/* does this cis override add or remove functions? */
		old_funcs = s->functions;

		if (!pccard_read_tuple(s, BIND_FN_ALL, CISTPL_LONGLINK_MFC,
					&mfc))
			new_funcs = mfc.nfn;
		else
			new_funcs = 1;
690 691
		if (old_funcs != new_funcs) {
			/* we need to re-start */
692
			pcmcia_card_remove(s, NULL);
693
			s->functions = 0;
694 695 696
			pcmcia_card_add(s);
		}
	}
697

698 699 700 701
	/* If the PCMCIA device consists of two pseudo devices,
	 * call pcmcia_device_add() -- which will fail if both
	 * devices are already registered. */
	mutex_lock(&s->ops_mutex);
702
	has_pfc = s->pcmcia_pfc;
703 704 705 706
	mutex_unlock(&s->ops_mutex);
	if (has_pfc)
		pcmcia_device_add(s, 0);

707 708
	/* we re-scan all devices, not just the ones connected to this
	 * socket. This does not matter, though. */
709 710
	if (bus_rescan_devices(&pcmcia_bus_type))
		dev_warn(&s->dev, "rescanning the bus failed\n");
711
}
712

713

714 715 716 717
#ifdef CONFIG_PCMCIA_LOAD_CIS

/**
 * pcmcia_load_firmware - load CIS from userspace if device-provided is broken
R
Randy Dunlap 已提交
718 719
 * @dev: the pcmcia device which needs a CIS override
 * @filename: requested filename in /lib/firmware/
720 721 722 723 724 725 726 727 728 729
 *
 * This uses the in-kernel firmware loading mechanism to use a "fake CIS" if
 * the one provided by the card is broken. The firmware files reside in
 * /lib/firmware/ in userspace.
 */
static int pcmcia_load_firmware(struct pcmcia_device *dev, char * filename)
{
	struct pcmcia_socket *s = dev->socket;
	const struct firmware *fw;
	int ret = -ENOMEM;
730 731
	cistpl_longlink_mfc_t mfc;
	int old_funcs, new_funcs = 1;
732 733 734 735

	if (!filename)
		return -EINVAL;

736
	dev_dbg(&dev->dev, "trying to load CIS file %s\n", filename);
737

738
	if (request_firmware(&fw, filename, &dev->dev) == 0) {
739 740
		if (fw->size >= CISTPL_MAX_CIS_SIZE) {
			ret = -EINVAL;
741 742
			dev_printk(KERN_ERR, &dev->dev,
				   "pcmcia: CIS override is too big\n");
743
			goto release;
744
		}
745

746
		if (!pcmcia_replace_cis(s, fw->data, fw->size))
747
			ret = 0;
748
		else {
749 750
			dev_printk(KERN_ERR, &dev->dev,
				   "pcmcia: CIS override failed\n");
751 752 753
			goto release;
		}

754 755 756 757 758 759 760 761
		/* we need to re-start if the number of functions changed */
		old_funcs = s->functions;
		if (!pccard_read_tuple(s, BIND_FN_ALL, CISTPL_LONGLINK_MFC,
					&mfc))
			new_funcs = mfc.nfn;

		if (old_funcs != new_funcs)
			ret = -EBUSY;
762 763 764 765

		/* update information */
		pcmcia_device_query(dev);

766 767
		/* requery (as number of functions might have changed) */
		pcmcia_parse_uevents(s, PCMCIA_UEVENT_REQUERY);
768 769 770 771
	}
 release:
	release_firmware(fw);

D
Dominik Brodowski 已提交
772
	return ret;
773 774 775 776 777 778 779 780 781 782 783 784
}

#else /* !CONFIG_PCMCIA_LOAD_CIS */

static inline int pcmcia_load_firmware(struct pcmcia_device *dev, char * filename)
{
	return -ENODEV;
}

#endif


785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831
static inline int pcmcia_devmatch(struct pcmcia_device *dev,
				  struct pcmcia_device_id *did)
{
	if (did->match_flags & PCMCIA_DEV_ID_MATCH_MANF_ID) {
		if ((!dev->has_manf_id) || (dev->manf_id != did->manf_id))
			return 0;
	}

	if (did->match_flags & PCMCIA_DEV_ID_MATCH_CARD_ID) {
		if ((!dev->has_card_id) || (dev->card_id != did->card_id))
			return 0;
	}

	if (did->match_flags & PCMCIA_DEV_ID_MATCH_FUNCTION) {
		if (dev->func != did->function)
			return 0;
	}

	if (did->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID1) {
		if (!dev->prod_id[0])
			return 0;
		if (strcmp(did->prod_id[0], dev->prod_id[0]))
			return 0;
	}

	if (did->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID2) {
		if (!dev->prod_id[1])
			return 0;
		if (strcmp(did->prod_id[1], dev->prod_id[1]))
			return 0;
	}

	if (did->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID3) {
		if (!dev->prod_id[2])
			return 0;
		if (strcmp(did->prod_id[2], dev->prod_id[2]))
			return 0;
	}

	if (did->match_flags & PCMCIA_DEV_ID_MATCH_PROD_ID4) {
		if (!dev->prod_id[3])
			return 0;
		if (strcmp(did->prod_id[3], dev->prod_id[3]))
			return 0;
	}

	if (did->match_flags & PCMCIA_DEV_ID_MATCH_DEVICE_NO) {
832
		dev_dbg(&dev->dev, "this is a pseudo-multi-function device\n");
833
		mutex_lock(&dev->socket->ops_mutex);
834
		dev->socket->pcmcia_pfc = 1;
835
		mutex_unlock(&dev->socket->ops_mutex);
836 837
		if (dev->device_no != did->device_no)
			return 0;
838 839 840
	}

	if (did->match_flags & PCMCIA_DEV_ID_MATCH_FUNC_ID) {
841 842
		int ret;

843 844 845 846 847
		if ((!dev->has_func_id) || (dev->func_id != did->func_id))
			return 0;

		/* if this is a pseudo-multi-function device,
		 * we need explicit matches */
848
		if (dev->socket->pcmcia_pfc)
849 850 851 852 853 854 855 856
			return 0;
		if (dev->device_no)
			return 0;

		/* also, FUNC_ID matching needs to be activated by userspace
		 * after it has re-checked that there is no possible module
		 * with a prod_id/manf_id/card_id match.
		 */
857 858 859 860 861 862 863
		mutex_lock(&dev->socket->ops_mutex);
		ret = dev->allow_func_id_match;
		mutex_unlock(&dev->socket->ops_mutex);

		if (!ret) {
			dev_dbg(&dev->dev,
				"skipping FUNC_ID match until userspace ACK\n");
864
			return 0;
865
		}
866 867
	}

868
	if (did->match_flags & PCMCIA_DEV_ID_MATCH_FAKE_CIS) {
869
		dev_dbg(&dev->dev, "device needs a fake CIS\n");
870
		if (!dev->socket->fake_cis)
871 872
			if (pcmcia_load_firmware(dev, did->cisfile))
				return 0;
873 874
	}

875 876
	if (did->match_flags & PCMCIA_DEV_ID_MATCH_ANONYMOUS) {
		int i;
D
Dominik Brodowski 已提交
877
		for (i = 0; i < 4; i++)
878 879 880 881 882 883
			if (dev->prod_id[i])
				return 0;
		if (dev->has_manf_id || dev->has_card_id || dev->has_func_id)
			return 0;
	}

884 885 886 887
	return 1;
}


D
Dominik Brodowski 已提交
888 889 890 891
static int pcmcia_bus_match(struct device *dev, struct device_driver *drv)
{
	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
	struct pcmcia_driver *p_drv = to_pcmcia_drv(drv);
892
	struct pcmcia_device_id *did = p_drv->id_table;
B
Bernhard Walle 已提交
893 894 895
	struct pcmcia_dynid *dynid;

	/* match dynamic devices first */
896
	mutex_lock(&p_drv->dynids.lock);
B
Bernhard Walle 已提交
897
	list_for_each_entry(dynid, &p_drv->dynids.list, node) {
898
		dev_dbg(dev, "trying to match to %s\n", drv->name);
B
Bernhard Walle 已提交
899
		if (pcmcia_devmatch(p_dev, &dynid->id)) {
900
			dev_dbg(dev, "matched to %s\n", drv->name);
901
			mutex_unlock(&p_drv->dynids.lock);
B
Bernhard Walle 已提交
902 903 904
			return 1;
		}
	}
905
	mutex_unlock(&p_drv->dynids.lock);
L
Linus Torvalds 已提交
906

907
	while (did && did->match_flags) {
908
		dev_dbg(dev, "trying to match to %s\n", drv->name);
909
		if (pcmcia_devmatch(p_dev, did)) {
910
			dev_dbg(dev, "matched to %s\n", drv->name);
911
			return 1;
912
		}
913 914 915
		did++;
	}

L
Linus Torvalds 已提交
916 917 918
	return 0;
}

919 920
#ifdef CONFIG_HOTPLUG

921
static int pcmcia_bus_uevent(struct device *dev, struct kobj_uevent_env *env)
922 923
{
	struct pcmcia_device *p_dev;
924
	int i;
925 926 927 928 929 930 931 932
	u32 hash[4] = { 0, 0, 0, 0};

	if (!dev)
		return -ENODEV;

	p_dev = to_pcmcia_dev(dev);

	/* calculate hashes */
D
Dominik Brodowski 已提交
933
	for (i = 0; i < 4; i++) {
934 935 936 937 938
		if (!p_dev->prod_id[i])
			continue;
		hash[i] = crc32(0, p_dev->prod_id[i], strlen(p_dev->prod_id[i]));
	}

939
	if (add_uevent_var(env, "SOCKET_NO=%u", p_dev->socket->sock))
940 941
		return -ENOMEM;

942
	if (add_uevent_var(env, "DEVICE_NO=%02X", p_dev->device_no))
943 944
		return -ENOMEM;

945
	if (add_uevent_var(env, "MODALIAS=pcmcia:m%04Xc%04Xf%02Xfn%02Xpfn%02X"
946 947 948 949 950 951 952 953 954 955
			   "pa%08Xpb%08Xpc%08Xpd%08X",
			   p_dev->has_manf_id ? p_dev->manf_id : 0,
			   p_dev->has_card_id ? p_dev->card_id : 0,
			   p_dev->has_func_id ? p_dev->func_id : 0,
			   p_dev->func,
			   p_dev->device_no,
			   hash[0],
			   hash[1],
			   hash[2],
			   hash[3]))
956 957 958 959 960 961 962
		return -ENOMEM;

	return 0;
}

#else

963
static int pcmcia_bus_uevent(struct device *dev, struct kobj_uevent_env *env)
964 965 966 967 968 969
{
	return -ENODEV;
}

#endif

970 971 972 973 974 975 976 977 978
/************************ runtime PM support ***************************/

static int pcmcia_dev_suspend(struct device *dev, pm_message_t state);
static int pcmcia_dev_resume(struct device *dev);

static int runtime_suspend(struct device *dev)
{
	int rc;

979
	device_lock(dev);
980
	rc = pcmcia_dev_suspend(dev, PMSG_SUSPEND);
981
	device_unlock(dev);
982 983 984
	return rc;
}

985
static int runtime_resume(struct device *dev)
986 987 988
{
	int rc;

989
	device_lock(dev);
990
	rc = pcmcia_dev_resume(dev);
991
	device_unlock(dev);
992
	return rc;
993 994
}

L
Linus Torvalds 已提交
995 996 997
/************************ per-device sysfs output ***************************/

#define pcmcia_device_attr(field, test, format)				\
998
static ssize_t field##_show (struct device *dev, struct device_attribute *attr, char *buf)		\
L
Linus Torvalds 已提交
999 1000
{									\
	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);		\
D
Dominik Brodowski 已提交
1001
	return p_dev->test ? sprintf(buf, format, p_dev->field) : -ENODEV; \
L
Linus Torvalds 已提交
1002 1003 1004
}

#define pcmcia_device_stringattr(name, field)					\
1005
static ssize_t name##_show (struct device *dev, struct device_attribute *attr, char *buf)		\
L
Linus Torvalds 已提交
1006 1007
{									\
	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);		\
D
Dominik Brodowski 已提交
1008
	return p_dev->field ? sprintf(buf, "%s\n", p_dev->field) : -ENODEV; \
L
Linus Torvalds 已提交
1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019
}

pcmcia_device_attr(func, socket, "0x%02x\n");
pcmcia_device_attr(func_id, has_func_id, "0x%02x\n");
pcmcia_device_attr(manf_id, has_manf_id, "0x%04x\n");
pcmcia_device_attr(card_id, has_card_id, "0x%04x\n");
pcmcia_device_stringattr(prod_id1, prod_id[0]);
pcmcia_device_stringattr(prod_id2, prod_id[1]);
pcmcia_device_stringattr(prod_id3, prod_id[2]);
pcmcia_device_stringattr(prod_id4, prod_id[3]);

1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031
static ssize_t pcmcia_show_resources(struct device *dev,
				     struct device_attribute *attr, char *buf)
{
	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
	char *str = buf;
	int i;

	for (i = 0; i < PCMCIA_NUM_RESOURCES; i++)
		str += sprintf(str, "%pr\n", p_dev->resource[i]);

	return str - buf;
}
1032 1033 1034 1035 1036

static ssize_t pcmcia_show_pm_state(struct device *dev, struct device_attribute *attr, char *buf)
{
	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);

1037
	if (p_dev->suspended)
1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048
		return sprintf(buf, "off\n");
	else
		return sprintf(buf, "on\n");
}

static ssize_t pcmcia_store_pm_state(struct device *dev, struct device_attribute *attr,
				     const char *buf, size_t count)
{
	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
	int ret = 0;

D
Dominik Brodowski 已提交
1049 1050
	if (!count)
		return -EINVAL;
1051

1052
	if ((!p_dev->suspended) && !strncmp(buf, "off", 3))
1053
		ret = runtime_suspend(dev);
1054
	else if (p_dev->suspended && !strncmp(buf, "on", 2))
1055
		ret = runtime_resume(dev);
1056 1057 1058 1059 1060

	return ret ? ret : count;
}


1061
static ssize_t modalias_show(struct device *dev, struct device_attribute *attr, char *buf)
1062 1063 1064 1065 1066 1067
{
	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
	int i;
	u32 hash[4] = { 0, 0, 0, 0};

	/* calculate hashes */
D
Dominik Brodowski 已提交
1068
	for (i = 0; i < 4; i++) {
1069 1070
		if (!p_dev->prod_id[i])
			continue;
D
Dominik Brodowski 已提交
1071 1072
		hash[i] = crc32(0, p_dev->prod_id[i],
				strlen(p_dev->prod_id[i]));
1073 1074 1075 1076 1077 1078 1079 1080 1081
	}
	return sprintf(buf, "pcmcia:m%04Xc%04Xf%02Xfn%02Xpfn%02X"
				"pa%08Xpb%08Xpc%08Xpd%08X\n",
				p_dev->has_manf_id ? p_dev->manf_id : 0,
				p_dev->has_card_id ? p_dev->card_id : 0,
				p_dev->has_func_id ? p_dev->func_id : 0,
				p_dev->func, p_dev->device_no,
				hash[0], hash[1], hash[2], hash[3]);
}
1082

1083 1084
static ssize_t pcmcia_store_allow_func_id_match(struct device *dev,
		struct device_attribute *attr, const char *buf, size_t count)
1085 1086
{
	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
1087 1088 1089

	if (!count)
		return -EINVAL;
1090

1091
	mutex_lock(&p_dev->socket->ops_mutex);
1092
	p_dev->allow_func_id_match = 1;
1093
	mutex_unlock(&p_dev->socket->ops_mutex);
1094
	pcmcia_parse_uevents(p_dev->socket, PCMCIA_UEVENT_REQUERY);
1095 1096 1097 1098

	return count;
}

L
Linus Torvalds 已提交
1099 1100
static struct device_attribute pcmcia_dev_attrs[] = {
	__ATTR(function, 0444, func_show, NULL),
1101
	__ATTR(pm_state, 0644, pcmcia_show_pm_state, pcmcia_store_pm_state),
1102
	__ATTR(resources, 0444, pcmcia_show_resources, NULL),
L
Linus Torvalds 已提交
1103 1104 1105 1106 1107 1108 1109
	__ATTR_RO(func_id),
	__ATTR_RO(manf_id),
	__ATTR_RO(card_id),
	__ATTR_RO(prod_id1),
	__ATTR_RO(prod_id2),
	__ATTR_RO(prod_id3),
	__ATTR_RO(prod_id4),
1110
	__ATTR_RO(modalias),
1111
	__ATTR(allow_func_id_match, 0200, NULL, pcmcia_store_allow_func_id_match),
L
Linus Torvalds 已提交
1112 1113 1114
	__ATTR_NULL,
};

1115 1116
/* PM support, also needed for reset */

D
Dominik Brodowski 已提交
1117
static int pcmcia_dev_suspend(struct device *dev, pm_message_t state)
1118 1119 1120
{
	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
	struct pcmcia_driver *p_drv = NULL;
1121
	int ret = 0;
1122

1123 1124 1125
	mutex_lock(&p_dev->socket->ops_mutex);
	if (p_dev->suspended) {
		mutex_unlock(&p_dev->socket->ops_mutex);
1126
		return 0;
1127 1128 1129
	}
	p_dev->suspended = 1;
	mutex_unlock(&p_dev->socket->ops_mutex);
1130

1131
	dev_dbg(dev, "suspending\n");
1132

1133 1134 1135
	if (dev->driver)
		p_drv = to_pcmcia_drv(dev->driver);

1136 1137 1138 1139
	if (!p_drv)
		goto out;

	if (p_drv->suspend) {
1140
		ret = p_drv->suspend(p_dev);
1141
		if (ret) {
1142 1143 1144 1145
			dev_printk(KERN_ERR, dev,
				   "pcmcia: device %s (driver %s) did "
				   "not want to go to sleep (%d)\n",
				   p_dev->devname, p_drv->drv.name, ret);
1146 1147 1148
			mutex_lock(&p_dev->socket->ops_mutex);
			p_dev->suspended = 0;
			mutex_unlock(&p_dev->socket->ops_mutex);
1149
			goto out;
1150
		}
1151
	}
1152

1153
	if (p_dev->device_no == p_dev->func) {
1154
		dev_dbg(dev, "releasing configuration\n");
1155
		pcmcia_release_configuration(p_dev);
1156
	}
1157

1158 1159
 out:
	return ret;
1160 1161 1162
}


D
Dominik Brodowski 已提交
1163
static int pcmcia_dev_resume(struct device *dev)
1164 1165
{
	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);
D
Dominik Brodowski 已提交
1166
	struct pcmcia_driver *p_drv = NULL;
1167
	int ret = 0;
1168

1169 1170 1171
	mutex_lock(&p_dev->socket->ops_mutex);
	if (!p_dev->suspended) {
		mutex_unlock(&p_dev->socket->ops_mutex);
1172
		return 0;
1173 1174 1175
	}
	p_dev->suspended = 0;
	mutex_unlock(&p_dev->socket->ops_mutex);
1176

1177
	dev_dbg(dev, "resuming\n");
1178

1179 1180 1181
	if (dev->driver)
		p_drv = to_pcmcia_drv(dev->driver);

1182 1183 1184 1185
	if (!p_drv)
		goto out;

	if (p_dev->device_no == p_dev->func) {
1186
		dev_dbg(dev, "requesting configuration\n");
1187
		ret = pcmcia_enable_device(p_dev);
1188 1189
		if (ret)
			goto out;
1190
	}
1191

1192 1193 1194
	if (p_drv->resume)
		ret = p_drv->resume(p_dev);

1195 1196
 out:
	return ret;
1197 1198 1199 1200 1201 1202 1203 1204
}


static int pcmcia_bus_suspend_callback(struct device *dev, void * _data)
{
	struct pcmcia_socket *skt = _data;
	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);

1205
	if (p_dev->socket != skt || p_dev->suspended)
1206 1207
		return 0;

1208
	return runtime_suspend(dev);
1209 1210 1211 1212 1213 1214 1215
}

static int pcmcia_bus_resume_callback(struct device *dev, void * _data)
{
	struct pcmcia_socket *skt = _data;
	struct pcmcia_device *p_dev = to_pcmcia_dev(dev);

1216
	if (p_dev->socket != skt || !p_dev->suspended)
1217 1218
		return 0;

1219
	runtime_resume(dev);
1220 1221 1222 1223 1224 1225

	return 0;
}

static int pcmcia_bus_resume(struct pcmcia_socket *skt)
{
1226
	dev_dbg(&skt->dev, "resuming socket %d\n", skt->sock);
1227 1228 1229 1230 1231 1232
	bus_for_each_dev(&pcmcia_bus_type, NULL, skt, pcmcia_bus_resume_callback);
	return 0;
}

static int pcmcia_bus_suspend(struct pcmcia_socket *skt)
{
1233
	dev_dbg(&skt->dev, "suspending socket %d\n", skt->sock);
1234 1235 1236 1237 1238 1239 1240 1241
	if (bus_for_each_dev(&pcmcia_bus_type, NULL, skt,
			     pcmcia_bus_suspend_callback)) {
		pcmcia_bus_resume(skt);
		return -EIO;
	}
	return 0;
}

1242 1243 1244 1245
static int pcmcia_bus_remove(struct pcmcia_socket *skt)
{
	atomic_set(&skt->present, 0);
	pcmcia_card_remove(skt, NULL);
L
Linus Torvalds 已提交
1246

1247 1248 1249 1250
	mutex_lock(&skt->ops_mutex);
	destroy_cis_cache(skt);
	pcmcia_cleanup_irq(skt);
	mutex_unlock(&skt->ops_mutex);
L
Linus Torvalds 已提交
1251

1252 1253
	return 0;
}
D
Dominik Brodowski 已提交
1254

1255 1256 1257
static int pcmcia_bus_add(struct pcmcia_socket *skt)
{
	atomic_set(&skt->present, 1);
L
Linus Torvalds 已提交
1258

1259
	mutex_lock(&skt->ops_mutex);
1260
	skt->pcmcia_pfc = 0;
1261 1262
	destroy_cis_cache(skt); /* to be on the safe side... */
	mutex_unlock(&skt->ops_mutex);
L
Linus Torvalds 已提交
1263

1264
	pcmcia_card_add(skt);
L
Linus Torvalds 已提交
1265

1266 1267
	return 0;
}
1268

1269 1270 1271 1272 1273 1274
static int pcmcia_bus_early_resume(struct pcmcia_socket *skt)
{
	if (!verify_cis_cache(skt)) {
		pcmcia_put_socket(skt);
		return 0;
	}
L
Linus Torvalds 已提交
1275

1276
	dev_dbg(&skt->dev, "cis mismatch - different card\n");
1277

1278 1279
	/* first, remove the card */
	pcmcia_bus_remove(skt);
1280

1281 1282 1283 1284 1285 1286
	mutex_lock(&skt->ops_mutex);
	destroy_cis_cache(skt);
	kfree(skt->fake_cis);
	skt->fake_cis = NULL;
	skt->functions = 0;
	mutex_unlock(&skt->ops_mutex);
L
Linus Torvalds 已提交
1287

1288 1289 1290 1291
	/* now, add the new card */
	pcmcia_bus_add(skt);
	return 0;
}
1292

L
Linus Torvalds 已提交
1293

1294 1295 1296 1297 1298 1299 1300
/*
 * NOTE: This is racy. There's no guarantee the card will still be
 * physically present, even if the call to this function returns
 * non-NULL. Furthermore, the device driver most likely is unbound
 * almost immediately, so the timeframe where pcmcia_dev_present
 * returns NULL is probably really really small.
 */
D
Dominik Brodowski 已提交
1301
struct pcmcia_device *pcmcia_dev_present(struct pcmcia_device *_p_dev)
1302 1303 1304 1305 1306 1307 1308 1309
{
	struct pcmcia_device *p_dev;
	struct pcmcia_device *ret = NULL;

	p_dev = pcmcia_get_dev(_p_dev);
	if (!p_dev)
		return NULL;

1310 1311
	if (atomic_read(&p_dev->socket->present) != 0)
		ret = p_dev;
1312 1313 1314 1315 1316 1317 1318

	pcmcia_put_dev(p_dev);
	return ret;
}
EXPORT_SYMBOL(pcmcia_dev_present);


1319 1320
static struct pcmcia_callback pcmcia_bus_callback = {
	.owner = THIS_MODULE,
1321 1322
	.add = pcmcia_bus_add,
	.remove = pcmcia_bus_remove,
1323
	.requery = pcmcia_requery,
1324
	.validate = pccard_validate_cis,
1325
	.suspend = pcmcia_bus_suspend,
1326
	.early_resume = pcmcia_bus_early_resume,
1327
	.resume = pcmcia_bus_resume,
1328 1329
};

1330
static int __devinit pcmcia_bus_add_socket(struct device *dev,
1331
					   struct class_interface *class_intf)
L
Linus Torvalds 已提交
1332
{
1333
	struct pcmcia_socket *socket = dev_get_drvdata(dev);
L
Linus Torvalds 已提交
1334 1335
	int ret;

1336 1337
	socket = pcmcia_get_socket(socket);
	if (!socket) {
1338 1339
		dev_printk(KERN_ERR, dev,
			   "PCMCIA obtaining reference to socket failed\n");
L
Linus Torvalds 已提交
1340 1341 1342
		return -ENODEV;
	}

1343 1344 1345 1346 1347 1348 1349
	ret = sysfs_create_bin_file(&dev->kobj, &pccard_cis_attr);
	if (ret) {
		dev_printk(KERN_ERR, dev, "PCMCIA registration failed\n");
		pcmcia_put_socket(socket);
		return ret;
	}

1350
	INIT_LIST_HEAD(&socket->devices_list);
1351
	socket->pcmcia_pfc = 0;
1352
	socket->device_count = 0;
1353
	atomic_set(&socket->present, 0);
L
Linus Torvalds 已提交
1354

1355
	ret = pccard_register_pcmcia(socket, &pcmcia_bus_callback);
L
Linus Torvalds 已提交
1356
	if (ret) {
1357
		dev_printk(KERN_ERR, dev, "PCMCIA registration failed\n");
1358
		pcmcia_put_socket(socket);
D
Dominik Brodowski 已提交
1359
		return ret;
L
Linus Torvalds 已提交
1360 1361 1362 1363 1364
	}

	return 0;
}

1365
static void pcmcia_bus_remove_socket(struct device *dev,
1366
				     struct class_interface *class_intf)
L
Linus Torvalds 已提交
1367
{
1368
	struct pcmcia_socket *socket = dev_get_drvdata(dev);
L
Linus Torvalds 已提交
1369

1370
	if (!socket)
L
Linus Torvalds 已提交
1371 1372 1373 1374
		return;

	pccard_register_pcmcia(socket, NULL);

1375
	/* unregister any unbound devices */
1376
	mutex_lock(&socket->skt_mutex);
1377
	pcmcia_card_remove(socket, NULL);
1378
	release_cis_mem(socket);
1379
	mutex_unlock(&socket->skt_mutex);
1380

1381 1382
	sysfs_remove_bin_file(&dev->kobj, &pccard_cis_attr);

1383
	pcmcia_put_socket(socket);
L
Linus Torvalds 已提交
1384 1385 1386 1387 1388 1389

	return;
}


/* the pcmcia_bus_interface is used to handle pcmcia socket devices */
1390
static struct class_interface pcmcia_bus_interface __refdata = {
L
Linus Torvalds 已提交
1391
	.class = &pcmcia_socket_class,
1392 1393
	.add_dev = &pcmcia_bus_add_socket,
	.remove_dev = &pcmcia_bus_remove_socket,
L
Linus Torvalds 已提交
1394 1395 1396
};


1397
struct bus_type pcmcia_bus_type = {
L
Linus Torvalds 已提交
1398
	.name = "pcmcia",
1399
	.uevent = pcmcia_bus_uevent,
L
Linus Torvalds 已提交
1400 1401
	.match = pcmcia_bus_match,
	.dev_attrs = pcmcia_dev_attrs,
1402 1403
	.probe = pcmcia_device_probe,
	.remove = pcmcia_device_remove,
1404 1405
	.suspend = pcmcia_dev_suspend,
	.resume = pcmcia_dev_resume,
L
Linus Torvalds 已提交
1406 1407 1408 1409 1410
};


static int __init init_pcmcia_bus(void)
{
1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424
	int ret;

	ret = bus_register(&pcmcia_bus_type);
	if (ret < 0) {
		printk(KERN_WARNING "pcmcia: bus_register error: %d\n", ret);
		return ret;
	}
	ret = class_interface_register(&pcmcia_bus_interface);
	if (ret < 0) {
		printk(KERN_WARNING
			"pcmcia: class_interface_register error: %d\n", ret);
		bus_unregister(&pcmcia_bus_type);
		return ret;
	}
L
Linus Torvalds 已提交
1425 1426 1427

	return 0;
}
D
Dominik Brodowski 已提交
1428
fs_initcall(init_pcmcia_bus); /* one level after subsys_initcall so that
L
Linus Torvalds 已提交
1429 1430 1431 1432 1433
			       * pcmcia_socket_class is already registered */


static void __exit exit_pcmcia_bus(void)
{
1434
	class_interface_unregister(&pcmcia_bus_interface);
L
Linus Torvalds 已提交
1435 1436 1437 1438 1439 1440 1441

	bus_unregister(&pcmcia_bus_type);
}
module_exit(exit_pcmcia_bus);


MODULE_ALIAS("ds");