pci-driver.c 23.5 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3
/*
 * drivers/pci/pci-driver.c
 *
4 5 6 7 8
 * (C) Copyright 2002-2004, 2007 Greg Kroah-Hartman <greg@kroah.com>
 * (C) Copyright 2007 Novell Inc.
 *
 * Released under the GPL v2 only.
 *
L
Linus Torvalds 已提交
9 10 11 12 13 14
 */

#include <linux/pci.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/device.h>
15
#include <linux/mempolicy.h>
T
Tim Schmielau 已提交
16 17
#include <linux/string.h>
#include <linux/slab.h>
18
#include <linux/sched.h>
19
#include <linux/cpu.h>
L
Linus Torvalds 已提交
20 21 22 23 24 25
#include "pci.h"

/*
 * Dynamic device IDs are disabled for !CONFIG_HOTPLUG
 */

26 27 28 29
struct pci_dynid {
	struct list_head node;
	struct pci_device_id id;
};
L
Linus Torvalds 已提交
30

31 32
#ifdef CONFIG_HOTPLUG

L
Linus Torvalds 已提交
33
/**
R
Randy Dunlap 已提交
34 35 36 37
 * store_new_id - add a new PCI device ID to this driver and re-probe devices
 * @driver: target device driver
 * @buf: buffer for scanning device ID data
 * @count: input size
L
Linus Torvalds 已提交
38 39 40 41
 *
 * Adds a new dynamic pci device ID to this driver,
 * and causes the driver to probe for all devices again.
 */
42
static ssize_t
L
Linus Torvalds 已提交
43 44
store_new_id(struct device_driver *driver, const char *buf, size_t count)
{
45
	struct pci_dynid *dynid;
L
Linus Torvalds 已提交
46
	struct pci_driver *pdrv = to_pci_driver(driver);
47
	const struct pci_device_id *ids = pdrv->id_table;
48
	__u32 vendor, device, subvendor=PCI_ANY_ID,
L
Linus Torvalds 已提交
49 50 51
		subdevice=PCI_ANY_ID, class=0, class_mask=0;
	unsigned long driver_data=0;
	int fields=0;
52
	int retval=0;
L
Linus Torvalds 已提交
53

54
	fields = sscanf(buf, "%x %x %x %x %x %x %lx",
L
Linus Torvalds 已提交
55 56
			&vendor, &device, &subvendor, &subdevice,
			&class, &class_mask, &driver_data);
57
	if (fields < 2)
L
Linus Torvalds 已提交
58 59
		return -EINVAL;

60 61
	/* Only accept driver_data values that match an existing id_table
	   entry */
62 63 64 65 66 67 68 69
	if (ids) {
		retval = -EINVAL;
		while (ids->vendor || ids->subvendor || ids->class_mask) {
			if (driver_data == ids->driver_data) {
				retval = 0;
				break;
			}
			ids++;
70
		}
71 72
		if (retval)	/* No match */
			return retval;
73 74
	}

75
	dynid = kzalloc(sizeof(*dynid), GFP_KERNEL);
L
Linus Torvalds 已提交
76 77 78 79 80 81 82 83 84
	if (!dynid)
		return -ENOMEM;

	dynid->id.vendor = vendor;
	dynid->id.device = device;
	dynid->id.subvendor = subvendor;
	dynid->id.subdevice = subdevice;
	dynid->id.class = class;
	dynid->id.class_mask = class_mask;
M
Milton Miller 已提交
85
	dynid->id.driver_data = driver_data;
L
Linus Torvalds 已提交
86 87

	spin_lock(&pdrv->dynids.lock);
88
	list_add_tail(&dynid->node, &pdrv->dynids.list);
L
Linus Torvalds 已提交
89 90
	spin_unlock(&pdrv->dynids.lock);

91
	if (get_driver(&pdrv->driver)) {
92
		retval = driver_attach(&pdrv->driver);
93
		put_driver(&pdrv->driver);
L
Linus Torvalds 已提交
94 95
	}

96 97
	if (retval)
		return retval;
L
Linus Torvalds 已提交
98 99 100 101 102 103 104
	return count;
}
static DRIVER_ATTR(new_id, S_IWUSR, NULL, store_new_id);

static void
pci_free_dynids(struct pci_driver *drv)
{
105
	struct pci_dynid *dynid, *n;
L
Linus Torvalds 已提交
106 107

	spin_lock(&drv->dynids.lock);
108
	list_for_each_entry_safe(dynid, n, &drv->dynids.list, node) {
L
Linus Torvalds 已提交
109 110 111 112 113 114 115 116 117 118 119
		list_del(&dynid->node);
		kfree(dynid);
	}
	spin_unlock(&drv->dynids.lock);
}

static int
pci_create_newid_file(struct pci_driver *drv)
{
	int error = 0;
	if (drv->probe != NULL)
120
		error = driver_create_file(&drv->driver, &driver_attr_new_id);
L
Linus Torvalds 已提交
121 122 123
	return error;
}

124 125 126 127
static void pci_remove_newid_file(struct pci_driver *drv)
{
	driver_remove_file(&drv->driver, &driver_attr_new_id);
}
L
Linus Torvalds 已提交
128 129 130 131 132 133
#else /* !CONFIG_HOTPLUG */
static inline void pci_free_dynids(struct pci_driver *drv) {}
static inline int pci_create_newid_file(struct pci_driver *drv)
{
	return 0;
}
134
static inline void pci_remove_newid_file(struct pci_driver *drv) {}
L
Linus Torvalds 已提交
135 136 137
#endif

/**
138
 * pci_match_id - See if a pci device matches a given pci_id table
L
Linus Torvalds 已提交
139
 * @ids: array of PCI device id structures to search in
140 141
 * @dev: the PCI device structure to match against.
 *
L
Linus Torvalds 已提交
142
 * Used by a driver to check whether a PCI device present in the
143
 * system is in its list of supported devices.  Returns the matching
L
Linus Torvalds 已提交
144
 * pci_device_id structure or %NULL if there is no match.
145
 *
R
Randy Dunlap 已提交
146
 * Deprecated, don't use this as it will not catch any dynamic ids
147
 * that a driver might want to check for.
L
Linus Torvalds 已提交
148
 */
149 150
const struct pci_device_id *pci_match_id(const struct pci_device_id *ids,
					 struct pci_dev *dev)
L
Linus Torvalds 已提交
151
{
152 153 154 155 156 157
	if (ids) {
		while (ids->vendor || ids->subvendor || ids->class_mask) {
			if (pci_match_one_device(ids, dev))
				return ids;
			ids++;
		}
L
Linus Torvalds 已提交
158 159 160 161 162
	}
	return NULL;
}

/**
R
Randy Dunlap 已提交
163
 * pci_match_device - Tell if a PCI device structure has a matching PCI device id structure
164
 * @drv: the PCI driver to match against
165
 * @dev: the PCI device structure to match against
166 167 168 169
 *
 * Used by a driver to check whether a PCI device present in the
 * system is in its list of supported devices.  Returns the matching
 * pci_device_id structure or %NULL if there is no match.
L
Linus Torvalds 已提交
170
 */
A
Adrian Bunk 已提交
171 172
static const struct pci_device_id *pci_match_device(struct pci_driver *drv,
						    struct pci_dev *dev)
173 174
{
	struct pci_dynid *dynid;
L
Linus Torvalds 已提交
175

176
	/* Look at the dynamic ids first, before the static ones */
177 178 179 180 181 182
	spin_lock(&drv->dynids.lock);
	list_for_each_entry(dynid, &drv->dynids.list, node) {
		if (pci_match_one_device(&dynid->id, dev)) {
			spin_unlock(&drv->dynids.lock);
			return &dynid->id;
		}
L
Linus Torvalds 已提交
183
	}
184
	spin_unlock(&drv->dynids.lock);
185 186

	return pci_match_id(drv->id_table, dev);
L
Linus Torvalds 已提交
187 188
}

189 190 191 192 193 194 195 196 197 198 199 200 201
struct drv_dev_and_id {
	struct pci_driver *drv;
	struct pci_dev *dev;
	const struct pci_device_id *id;
};

static long local_pci_probe(void *_ddi)
{
	struct drv_dev_and_id *ddi = _ddi;

	return ddi->drv->probe(ddi->dev, ddi->id);
}

202 203 204
static int pci_call_probe(struct pci_driver *drv, struct pci_dev *dev,
			  const struct pci_device_id *id)
{
205 206 207 208 209 210 211 212
	int error, node;
	struct drv_dev_and_id ddi = { drv, dev, id };

	/* Execute driver initialization on node where the device's
	   bus is attached to.  This way the driver likely allocates
	   its local memory on the right node without any need to
	   change it. */
	node = dev_to_node(&dev->dev);
213
	if (node >= 0) {
214
		int cpu;
215
		node_to_cpumask_ptr(nodecpumask, node);
216 217 218 219 220 221 222 223 224 225

		get_online_cpus();
		cpu = cpumask_any_and(nodecpumask, cpu_online_mask);
		if (cpu < nr_cpu_ids)
			error = work_on_cpu(cpu, local_pci_probe, &ddi);
		else
			error = local_pci_probe(&ddi);
		put_online_cpus();
	} else
		error = local_pci_probe(&ddi);
226 227 228
	return error;
}

L
Linus Torvalds 已提交
229 230
/**
 * __pci_device_probe()
R
Randy Dunlap 已提交
231 232
 * @drv: driver to call to check if it wants the PCI device
 * @pci_dev: PCI device being probed
L
Linus Torvalds 已提交
233
 * 
R
Randy Dunlap 已提交
234
 * returns 0 on success, else error.
L
Linus Torvalds 已提交
235 236 237 238
 * side-effect: pci_dev->driver is set to drv when drv claims pci_dev.
 */
static int
__pci_device_probe(struct pci_driver *drv, struct pci_dev *pci_dev)
239 240
{
	const struct pci_device_id *id;
L
Linus Torvalds 已提交
241 242 243
	int error = 0;

	if (!pci_dev->driver && drv->probe) {
244 245 246 247
		error = -ENODEV;

		id = pci_match_device(drv, pci_dev);
		if (id)
248
			error = pci_call_probe(drv, pci_dev, id);
249 250 251 252
		if (error >= 0) {
			pci_dev->driver = drv;
			error = 0;
		}
L
Linus Torvalds 已提交
253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283
	}
	return error;
}

static int pci_device_probe(struct device * dev)
{
	int error = 0;
	struct pci_driver *drv;
	struct pci_dev *pci_dev;

	drv = to_pci_driver(dev->driver);
	pci_dev = to_pci_dev(dev);
	pci_dev_get(pci_dev);
	error = __pci_device_probe(drv, pci_dev);
	if (error)
		pci_dev_put(pci_dev);

	return error;
}

static int pci_device_remove(struct device * dev)
{
	struct pci_dev * pci_dev = to_pci_dev(dev);
	struct pci_driver * drv = pci_dev->driver;

	if (drv) {
		if (drv->remove)
			drv->remove(pci_dev);
		pci_dev->driver = NULL;
	}

284 285 286 287 288 289 290
	/*
	 * If the device is still on, set the power state as "unknown",
	 * since it might change by the next time we load the driver.
	 */
	if (pci_dev->current_state == PCI_D0)
		pci_dev->current_state = PCI_UNKNOWN;

L
Linus Torvalds 已提交
291 292 293 294 295 296 297 298 299 300 301 302 303
	/*
	 * We would love to complain here if pci_dev->is_enabled is set, that
	 * the driver should have called pci_disable_device(), but the
	 * unfortunate fact is there are too many odd BIOS and bridge setups
	 * that don't like drivers doing that all of the time.  
	 * Oh well, we can dream of sane hardware when we sleep, no matter how
	 * horrible the crap we have to deal with is when we are awake...
	 */

	pci_dev_put(pci_dev);
	return 0;
}

304 305 306 307 308 309 310 311 312 313 314 315 316
static void pci_device_shutdown(struct device *dev)
{
	struct pci_dev *pci_dev = to_pci_dev(dev);
	struct pci_driver *drv = pci_dev->driver;

	if (drv && drv->shutdown)
		drv->shutdown(pci_dev);
	pci_msi_shutdown(pci_dev);
	pci_msix_shutdown(pci_dev);
}

#ifdef CONFIG_PM_SLEEP

317 318 319
/*
 * Default "suspend" method for devices that have no driver provided suspend,
 * or not even a driver at all (second part).
320
 */
321
static void pci_pm_set_unknown_state(struct pci_dev *pci_dev)
322 323 324 325 326 327 328 329 330
{
	/*
	 * mark its power state as "unknown", since we don't know if
	 * e.g. the BIOS will change its device state when we suspend.
	 */
	if (pci_dev->current_state == PCI_D0)
		pci_dev->current_state = PCI_UNKNOWN;
}

331 332 333 334
/*
 * Default "resume" method for devices that have no driver provided resume,
 * or not even a driver at all (second part).
 */
335
static int pci_pm_reenable_device(struct pci_dev *pci_dev)
336 337 338
{
	int retval;

339 340 341 342 343 344 345 346 347 348 349 350 351
	/* if the device was enabled before suspend, reenable */
	retval = pci_reenable_device(pci_dev);
	/*
	 * if the device was busmaster before the suspend, make it busmaster
	 * again
	 */
	if (pci_dev->is_busmaster)
		pci_set_master(pci_dev);

	return retval;
}

static int pci_legacy_suspend(struct device *dev, pm_message_t state)
L
Linus Torvalds 已提交
352 353 354
{
	struct pci_dev * pci_dev = to_pci_dev(dev);
	struct pci_driver * drv = pci_dev->driver;
355
	int error = 0;
L
Linus Torvalds 已提交
356

357
	if (drv && drv->suspend) {
358 359
		pci_power_t prev = pci_dev->current_state;

360 361
		pci_dev->state_saved = false;

362 363 364 365
		error = drv->suspend(pci_dev, state);
		suspend_report_result(drv->suspend, error);
		if (error)
			return error;
366 367 368 369

		if (pci_dev->state_saved)
			goto Fixup;

370 371 372 373 374
		if (pci_dev->current_state != PCI_D0
		    && pci_dev->current_state != PCI_UNKNOWN) {
			WARN_ONCE(pci_dev->current_state != prev,
				"PCI PM: Device state not saved by %pF\n",
				drv->suspend);
375
			goto Fixup;
376
		}
377
	}
378

379 380 381 382 383 384 385
	pci_save_state(pci_dev);
	/*
	 * This is for compatibility with existing code with legacy PM support.
	 */
	pci_pm_set_unknown_state(pci_dev);

 Fixup:
386 387
	pci_fixup_device(pci_fixup_suspend, pci_dev);

388
	return error;
L
Linus Torvalds 已提交
389 390
}

391
static int pci_legacy_suspend_late(struct device *dev, pm_message_t state)
L
Linus Torvalds 已提交
392 393 394
{
	struct pci_dev * pci_dev = to_pci_dev(dev);
	struct pci_driver * drv = pci_dev->driver;
395
	int error = 0;
L
Linus Torvalds 已提交
396 397

	if (drv && drv->suspend_late) {
398 399
		error = drv->suspend_late(pci_dev, state);
		suspend_report_result(drv->suspend_late, error);
L
Linus Torvalds 已提交
400
	}
401
	return error;
L
Linus Torvalds 已提交
402
}
L
Linus Torvalds 已提交
403

404 405 406 407 408
static int pci_legacy_resume_early(struct device *dev)
{
	struct pci_dev * pci_dev = to_pci_dev(dev);
	struct pci_driver * drv = pci_dev->driver;

409 410
	return drv && drv->resume_early ?
			drv->resume_early(pci_dev) : 0;
411 412
}

413
static int pci_legacy_resume(struct device *dev)
L
Linus Torvalds 已提交
414 415 416 417
{
	struct pci_dev * pci_dev = to_pci_dev(dev);
	struct pci_driver * drv = pci_dev->driver;

418 419
	pci_fixup_device(pci_fixup_resume, pci_dev);

420 421
	return drv && drv->resume ?
			drv->resume(pci_dev) : pci_pm_reenable_device(pci_dev);
L
Linus Torvalds 已提交
422 423
}

424 425
/* Auxiliary functions used by the new power management framework */

426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442
/**
 * pci_restore_standard_config - restore standard config registers of PCI device
 * @pci_dev: PCI device to handle
 */
static int pci_restore_standard_config(struct pci_dev *pci_dev)
{
	pci_update_current_state(pci_dev, PCI_UNKNOWN);

	if (pci_dev->current_state != PCI_D0) {
		int error = pci_set_power_state(pci_dev, PCI_D0);
		if (error)
			return error;
	}

	return pci_dev->state_saved ? pci_restore_state(pci_dev) : 0;
}

443 444
static void pci_pm_default_resume_noirq(struct pci_dev *pci_dev)
{
445
	pci_restore_standard_config(pci_dev);
446
	pci_dev->state_saved = false;
447
	pci_fixup_device(pci_fixup_resume_early, pci_dev);
448 449
}

450
static void pci_pm_default_resume(struct pci_dev *pci_dev)
451
{
452 453
	pci_fixup_device(pci_fixup_resume, pci_dev);

454 455
	if (!pci_is_bridge(pci_dev))
		pci_enable_wake(pci_dev, PCI_D0, false);
456 457
}

458
static void pci_pm_default_suspend(struct pci_dev *pci_dev)
459
{
460
	/* Disable non-bridge devices without PM support */
461 462
	if (!pci_is_bridge(pci_dev))
		pci_disable_enabled_device(pci_dev);
463 464 465
	pci_save_state(pci_dev);
}

466 467 468
static bool pci_has_legacy_pm_support(struct pci_dev *pci_dev)
{
	struct pci_driver *drv = pci_dev->driver;
469
	bool ret = drv && (drv->suspend || drv->suspend_late || drv->resume
470
		|| drv->resume_early);
471 472 473 474 475 476 477 478 479

	/*
	 * Legacy PM support is used by default, so warn if the new framework is
	 * supported as well.  Drivers are supposed to support either the
	 * former, or the latter, but not both at the same time.
	 */
	WARN_ON(ret && drv->driver.pm);

	return ret;
480 481
}

482 483
/* New power management framework */

484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507
static int pci_pm_prepare(struct device *dev)
{
	struct device_driver *drv = dev->driver;
	int error = 0;

	if (drv && drv->pm && drv->pm->prepare)
		error = drv->pm->prepare(dev);

	return error;
}

static void pci_pm_complete(struct device *dev)
{
	struct device_driver *drv = dev->driver;

	if (drv && drv->pm && drv->pm->complete)
		drv->pm->complete(dev);
}

#ifdef CONFIG_SUSPEND

static int pci_pm_suspend(struct device *dev)
{
	struct pci_dev *pci_dev = to_pci_dev(dev);
508
	struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
509

510 511
	if (pci_has_legacy_pm_support(pci_dev))
		return pci_legacy_suspend(dev, PMSG_SUSPEND);
512

513 514 515 516 517 518 519 520 521 522 523
	if (!pm) {
		pci_pm_default_suspend(pci_dev);
		goto Fixup;
	}

	pci_dev->state_saved = false;

	if (pm->suspend) {
		pci_power_t prev = pci_dev->current_state;
		int error;

524 525
		error = pm->suspend(dev);
		suspend_report_result(pm->suspend, error);
526 527 528 529 530 531 532 533 534 535 536 537 538
		if (error)
			return error;

		if (pci_dev->state_saved)
			goto Fixup;

		if (pci_dev->current_state != PCI_D0
		    && pci_dev->current_state != PCI_UNKNOWN) {
			WARN_ONCE(pci_dev->current_state != prev,
				"PCI PM: State of device not saved by %pF\n",
				pm->suspend);
			goto Fixup;
		}
539
	}
540

541 542 543 544 545
	if (!pci_dev->state_saved) {
		pci_save_state(pci_dev);
		if (!pci_is_bridge(pci_dev))
			pci_prepare_to_sleep(pci_dev);
	}
546

547 548 549 550
 Fixup:
	pci_fixup_device(pci_fixup_suspend, pci_dev);

	return 0;
551 552 553
}

static int pci_pm_suspend_noirq(struct device *dev)
G
Greg KH 已提交
554
{
555
	struct pci_dev *pci_dev = to_pci_dev(dev);
556
	struct device_driver *drv = dev->driver;
557
	int error = 0;
G
Greg KH 已提交
558

559 560 561
	if (pci_has_legacy_pm_support(pci_dev))
		return pci_legacy_suspend_late(dev, PMSG_SUSPEND);

562 563 564
	if (drv && drv->pm && drv->pm->suspend_noirq) {
		error = drv->pm->suspend_noirq(dev);
		suspend_report_result(drv->pm->suspend_noirq, error);
565 566
	}

567 568 569
	if (!error)
		pci_pm_set_unknown_state(pci_dev);

570
	return error;
G
Greg KH 已提交
571
}
L
Linus Torvalds 已提交
572

573
static int pci_pm_resume_noirq(struct device *dev)
574 575 576
{
	struct pci_dev *pci_dev = to_pci_dev(dev);
	struct device_driver *drv = dev->driver;
577
	int error = 0;
578

579 580
	pci_pm_default_resume_noirq(pci_dev);

581
	if (pci_has_legacy_pm_support(pci_dev))
582
		return pci_legacy_resume_early(dev);
583

584 585
	if (drv && drv->pm && drv->pm->resume_noirq)
		error = drv->pm->resume_noirq(dev);
586 587 588 589

	return error;
}

590
static int pci_pm_resume(struct device *dev)
591
{
592
	struct pci_dev *pci_dev = to_pci_dev(dev);
593
	struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
594 595
	int error = 0;

596 597 598 599 600 601 602
	/*
	 * This is necessary for the suspend error path in which resume is
	 * called without restoring the standard config registers of the device.
	 */
	if (pci_dev->state_saved)
		pci_restore_standard_config(pci_dev);

603
	if (pci_has_legacy_pm_support(pci_dev))
604
		return pci_legacy_resume(dev);
605

606
	pci_pm_default_resume(pci_dev);
607

608 609 610 611 612 613
	if (pm) {
		if (pm->resume)
			error = pm->resume(dev);
	} else {
		pci_pm_reenable_device(pci_dev);
	}
614

615
	return 0;
616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631
}

#else /* !CONFIG_SUSPEND */

#define pci_pm_suspend		NULL
#define pci_pm_suspend_noirq	NULL
#define pci_pm_resume		NULL
#define pci_pm_resume_noirq	NULL

#endif /* !CONFIG_SUSPEND */

#ifdef CONFIG_HIBERNATION

static int pci_pm_freeze(struct device *dev)
{
	struct pci_dev *pci_dev = to_pci_dev(dev);
632
	struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
633

634 635
	if (pci_has_legacy_pm_support(pci_dev))
		return pci_legacy_suspend(dev, PMSG_FREEZE);
636

637 638 639
	if (!pm) {
		pci_pm_default_suspend(pci_dev);
		return 0;
640 641
	}

642
	pci_dev->state_saved = false;
643

644 645 646 647 648 649 650 651 652 653 654 655 656
	if (pm->freeze) {
		int error;

		error = pm->freeze(dev);
		suspend_report_result(pm->freeze, error);
		if (error)
			return error;
	}

	if (!pci_dev->state_saved)
		pci_save_state(pci_dev);

	return 0;
657 658 659 660
}

static int pci_pm_freeze_noirq(struct device *dev)
{
661
	struct pci_dev *pci_dev = to_pci_dev(dev);
662
	struct device_driver *drv = dev->driver;
663 664
	int error = 0;

665 666 667
	if (pci_has_legacy_pm_support(pci_dev))
		return pci_legacy_suspend_late(dev, PMSG_FREEZE);

668 669 670
	if (drv && drv->pm && drv->pm->freeze_noirq) {
		error = drv->pm->freeze_noirq(dev);
		suspend_report_result(drv->pm->freeze_noirq, error);
671 672
	}

673 674 675
	if (!error)
		pci_pm_set_unknown_state(pci_dev);

676 677 678
	return error;
}

679
static int pci_pm_thaw_noirq(struct device *dev)
680
{
681
	struct pci_dev *pci_dev = to_pci_dev(dev);
682 683 684
	struct device_driver *drv = dev->driver;
	int error = 0;

685
	if (pci_has_legacy_pm_support(pci_dev))
686
		return pci_legacy_resume_early(dev);
687

688
	pci_update_current_state(pci_dev, PCI_D0);
689

690 691
	if (drv && drv->pm && drv->pm->thaw_noirq)
		error = drv->pm->thaw_noirq(dev);
692 693 694 695

	return error;
}

696
static int pci_pm_thaw(struct device *dev)
697
{
698
	struct pci_dev *pci_dev = to_pci_dev(dev);
699
	struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
700 701
	int error = 0;

702
	if (pci_has_legacy_pm_support(pci_dev))
703
		return pci_legacy_resume(dev);
704

705 706 707 708 709 710
	if (pm) {
		if (pm->thaw)
			error = pm->thaw(dev);
	} else {
		pci_pm_reenable_device(pci_dev);
	}
711 712 713 714 715 716

	return error;
}

static int pci_pm_poweroff(struct device *dev)
{
717
	struct pci_dev *pci_dev = to_pci_dev(dev);
718
	struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
719 720
	int error = 0;

721 722
	if (pci_has_legacy_pm_support(pci_dev))
		return pci_legacy_suspend(dev, PMSG_HIBERNATE);
723

724 725 726 727 728 729 730 731
	if (!pm) {
		pci_pm_default_suspend(pci_dev);
		goto Fixup;
	}

	pci_dev->state_saved = false;

	if (pm->poweroff) {
732 733
		error = pm->poweroff(dev);
		suspend_report_result(pm->poweroff, error);
734 735
	}

736 737 738 739 740
	if (!pci_dev->state_saved && !pci_is_bridge(pci_dev))
		pci_prepare_to_sleep(pci_dev);

 Fixup:
	pci_fixup_device(pci_fixup_suspend, pci_dev);
741

742 743 744 745 746
	return error;
}

static int pci_pm_poweroff_noirq(struct device *dev)
{
747
	struct device_driver *drv = dev->driver;
748 749
	int error = 0;

750 751 752
	if (pci_has_legacy_pm_support(to_pci_dev(dev)))
		return pci_legacy_suspend_late(dev, PMSG_HIBERNATE);

753 754 755
	if (drv && drv->pm && drv->pm->poweroff_noirq) {
		error = drv->pm->poweroff_noirq(dev);
		suspend_report_result(drv->pm->poweroff_noirq, error);
756 757 758 759 760
	}

	return error;
}

761
static int pci_pm_restore_noirq(struct device *dev)
762 763 764
{
	struct pci_dev *pci_dev = to_pci_dev(dev);
	struct device_driver *drv = dev->driver;
765
	int error = 0;
766

767 768
	pci_pm_default_resume_noirq(pci_dev);

769
	if (pci_has_legacy_pm_support(pci_dev))
770
		return pci_legacy_resume_early(dev);
771

772 773
	if (drv && drv->pm && drv->pm->restore_noirq)
		error = drv->pm->restore_noirq(dev);
774 775 776 777

	return error;
}

778
static int pci_pm_restore(struct device *dev)
779 780
{
	struct pci_dev *pci_dev = to_pci_dev(dev);
781
	struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
782 783
	int error = 0;

784 785 786 787 788 789 790
	/*
	 * This is necessary for the hibernation error path in which restore is
	 * called without restoring the standard config registers of the device.
	 */
	if (pci_dev->state_saved)
		pci_restore_standard_config(pci_dev);

791
	if (pci_has_legacy_pm_support(pci_dev))
792
		return pci_legacy_resume(dev);
793

794
	pci_pm_default_resume(pci_dev);
795

796 797 798 799 800 801
	if (pm) {
		if (pm->restore)
			error = pm->restore(dev);
	} else {
		pci_pm_reenable_device(pci_dev);
	}
802 803

	return error;
G
Greg KH 已提交
804
}
L
Linus Torvalds 已提交
805

806 807 808 809 810 811 812 813 814 815 816 817 818
#else /* !CONFIG_HIBERNATION */

#define pci_pm_freeze		NULL
#define pci_pm_freeze_noirq	NULL
#define pci_pm_thaw		NULL
#define pci_pm_thaw_noirq	NULL
#define pci_pm_poweroff		NULL
#define pci_pm_poweroff_noirq	NULL
#define pci_pm_restore		NULL
#define pci_pm_restore_noirq	NULL

#endif /* !CONFIG_HIBERNATION */

819 820 821 822 823 824 825 826 827
struct dev_pm_ops pci_dev_pm_ops = {
	.prepare = pci_pm_prepare,
	.complete = pci_pm_complete,
	.suspend = pci_pm_suspend,
	.resume = pci_pm_resume,
	.freeze = pci_pm_freeze,
	.thaw = pci_pm_thaw,
	.poweroff = pci_pm_poweroff,
	.restore = pci_pm_restore,
828 829 830 831 832 833 834 835
	.suspend_noirq = pci_pm_suspend_noirq,
	.resume_noirq = pci_pm_resume_noirq,
	.freeze_noirq = pci_pm_freeze_noirq,
	.thaw_noirq = pci_pm_thaw_noirq,
	.poweroff_noirq = pci_pm_poweroff_noirq,
	.restore_noirq = pci_pm_restore_noirq,
};

836
#define PCI_PM_OPS_PTR	(&pci_dev_pm_ops)
837 838 839 840 841 842 843

#else /* !CONFIG_PM_SLEEP */

#define PCI_PM_OPS_PTR	NULL

#endif /* !CONFIG_PM_SLEEP */

L
Linus Torvalds 已提交
844
/**
845
 * __pci_register_driver - register a new pci driver
L
Linus Torvalds 已提交
846
 * @drv: the driver structure to register
847
 * @owner: owner module of drv
848
 * @mod_name: module name string
L
Linus Torvalds 已提交
849 850 851
 * 
 * Adds the driver structure to the list of registered drivers.
 * Returns a negative value on error, otherwise 0. 
852
 * If no error occurred, the driver remains registered even if 
L
Linus Torvalds 已提交
853 854
 * no device was claimed during registration.
 */
855 856
int __pci_register_driver(struct pci_driver *drv, struct module *owner,
			  const char *mod_name)
L
Linus Torvalds 已提交
857 858 859 860 861 862
{
	int error;

	/* initialize common driver fields */
	drv->driver.name = drv->name;
	drv->driver.bus = &pci_bus_type;
863
	drv->driver.owner = owner;
864
	drv->driver.mod_name = mod_name;
A
Alan Cox 已提交
865

866 867
	spin_lock_init(&drv->dynids.lock);
	INIT_LIST_HEAD(&drv->dynids.list);
L
Linus Torvalds 已提交
868 869 870

	/* register with core */
	error = driver_register(&drv->driver);
871 872
	if (error)
		return error;
L
Linus Torvalds 已提交
873

874 875 876
	error = pci_create_newid_file(drv);
	if (error)
		driver_unregister(&drv->driver);
L
Linus Torvalds 已提交
877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893

	return error;
}

/**
 * pci_unregister_driver - unregister a pci driver
 * @drv: the driver structure to unregister
 * 
 * Deletes the driver structure from the list of registered PCI drivers,
 * gives it a chance to clean up by calling its remove() function for
 * each device it was responsible for, and marks those devices as
 * driverless.
 */

void
pci_unregister_driver(struct pci_driver *drv)
{
894
	pci_remove_newid_file(drv);
L
Linus Torvalds 已提交
895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926
	driver_unregister(&drv->driver);
	pci_free_dynids(drv);
}

static struct pci_driver pci_compat_driver = {
	.name = "compat"
};

/**
 * pci_dev_driver - get the pci_driver of a device
 * @dev: the device to query
 *
 * Returns the appropriate pci_driver structure or %NULL if there is no 
 * registered driver for the device.
 */
struct pci_driver *
pci_dev_driver(const struct pci_dev *dev)
{
	if (dev->driver)
		return dev->driver;
	else {
		int i;
		for(i=0; i<=PCI_ROM_RESOURCE; i++)
			if (dev->resource[i].flags & IORESOURCE_BUSY)
				return &pci_compat_driver;
	}
	return NULL;
}

/**
 * pci_bus_match - Tell if a PCI device structure has a matching PCI device id structure
 * @dev: the PCI device structure to match against
R
Randy Dunlap 已提交
927
 * @drv: the device driver to search for matching PCI device id structures
L
Linus Torvalds 已提交
928 929
 * 
 * Used by a driver to check whether a PCI device present in the
R
Randy Dunlap 已提交
930
 * system is in its list of supported devices. Returns the matching
L
Linus Torvalds 已提交
931 932
 * pci_device_id structure or %NULL if there is no match.
 */
933
static int pci_bus_match(struct device *dev, struct device_driver *drv)
L
Linus Torvalds 已提交
934
{
935 936
	struct pci_dev *pci_dev = to_pci_dev(dev);
	struct pci_driver *pci_drv = to_pci_driver(drv);
L
Linus Torvalds 已提交
937 938
	const struct pci_device_id *found_id;

939
	found_id = pci_match_device(pci_drv, pci_dev);
L
Linus Torvalds 已提交
940 941 942
	if (found_id)
		return 1;

943
	return 0;
L
Linus Torvalds 已提交
944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978
}

/**
 * pci_dev_get - increments the reference count of the pci device structure
 * @dev: the device being referenced
 *
 * Each live reference to a device should be refcounted.
 *
 * Drivers for PCI devices should normally record such references in
 * their probe() methods, when they bind to a device, and release
 * them by calling pci_dev_put(), in their disconnect() methods.
 *
 * A pointer to the device with the incremented reference counter is returned.
 */
struct pci_dev *pci_dev_get(struct pci_dev *dev)
{
	if (dev)
		get_device(&dev->dev);
	return dev;
}

/**
 * pci_dev_put - release a use of the pci device structure
 * @dev: device that's been disconnected
 *
 * Must be called when a user of a device is finished with it.  When the last
 * user of the device calls this function, the memory of the device is freed.
 */
void pci_dev_put(struct pci_dev *dev)
{
	if (dev)
		put_device(&dev->dev);
}

#ifndef CONFIG_HOTPLUG
979
int pci_uevent(struct device *dev, struct kobj_uevent_env *env)
L
Linus Torvalds 已提交
980 981 982 983 984 985 986 987
{
	return -ENODEV;
}
#endif

struct bus_type pci_bus_type = {
	.name		= "pci",
	.match		= pci_bus_match,
988
	.uevent		= pci_uevent,
989 990
	.probe		= pci_device_probe,
	.remove		= pci_device_remove,
L
Linus Torvalds 已提交
991
	.shutdown	= pci_device_shutdown,
L
Linus Torvalds 已提交
992
	.dev_attrs	= pci_dev_attrs,
993
	.pm		= PCI_PM_OPS_PTR,
L
Linus Torvalds 已提交
994 995 996 997 998 999 1000 1001 1002
};

static int __init pci_driver_init(void)
{
	return bus_register(&pci_bus_type);
}

postcore_initcall(pci_driver_init);

1003
EXPORT_SYMBOL(pci_match_id);
1004
EXPORT_SYMBOL(__pci_register_driver);
L
Linus Torvalds 已提交
1005 1006 1007 1008 1009
EXPORT_SYMBOL(pci_unregister_driver);
EXPORT_SYMBOL(pci_dev_driver);
EXPORT_SYMBOL(pci_bus_type);
EXPORT_SYMBOL(pci_dev_get);
EXPORT_SYMBOL(pci_dev_put);