PCI PM: Restore standard config registers of all devices early
[deliverable/linux.git] / drivers / pci / pci-driver.c
CommitLineData
1da177e4
LT
1/*
2 * drivers/pci/pci-driver.c
3 *
2b937303
GKH
4 * (C) Copyright 2002-2004, 2007 Greg Kroah-Hartman <greg@kroah.com>
5 * (C) Copyright 2007 Novell Inc.
6 *
7 * Released under the GPL v2 only.
8 *
1da177e4
LT
9 */
10
11#include <linux/pci.h>
12#include <linux/module.h>
13#include <linux/init.h>
14#include <linux/device.h>
d42c6997 15#include <linux/mempolicy.h>
4e57b681
TS
16#include <linux/string.h>
17#include <linux/slab.h>
8c65b4a6 18#include <linux/sched.h>
873392ca 19#include <linux/cpu.h>
1da177e4
LT
20#include "pci.h"
21
1da177e4
LT
22/*
23 * Dynamic device IDs are disabled for !CONFIG_HOTPLUG
24 */
25
75865858
GKH
26struct pci_dynid {
27 struct list_head node;
28 struct pci_device_id id;
29};
1da177e4 30
3d3c2ae1
GK
31#ifdef CONFIG_HOTPLUG
32
1da177e4 33/**
8f7020d3
RD
34 * store_new_id - add a new PCI device ID to this driver and re-probe devices
35 * @driver: target device driver
36 * @buf: buffer for scanning device ID data
37 * @count: input size
1da177e4
LT
38 *
39 * Adds a new dynamic pci device ID to this driver,
40 * and causes the driver to probe for all devices again.
41 */
f8eb1005 42static ssize_t
1da177e4
LT
43store_new_id(struct device_driver *driver, const char *buf, size_t count)
44{
75865858 45 struct pci_dynid *dynid;
1da177e4 46 struct pci_driver *pdrv = to_pci_driver(driver);
b41d6cf3 47 const struct pci_device_id *ids = pdrv->id_table;
6ba18636 48 __u32 vendor, device, subvendor=PCI_ANY_ID,
1da177e4
LT
49 subdevice=PCI_ANY_ID, class=0, class_mask=0;
50 unsigned long driver_data=0;
51 int fields=0;
2debb4d2 52 int retval=0;
1da177e4 53
b41d6cf3 54 fields = sscanf(buf, "%x %x %x %x %x %x %lx",
1da177e4
LT
55 &vendor, &device, &subvendor, &subdevice,
56 &class, &class_mask, &driver_data);
6ba18636 57 if (fields < 2)
1da177e4
LT
58 return -EINVAL;
59
b41d6cf3
JD
60 /* Only accept driver_data values that match an existing id_table
61 entry */
2debb4d2
CW
62 if (ids) {
63 retval = -EINVAL;
64 while (ids->vendor || ids->subvendor || ids->class_mask) {
65 if (driver_data == ids->driver_data) {
66 retval = 0;
67 break;
68 }
69 ids++;
b41d6cf3 70 }
2debb4d2
CW
71 if (retval) /* No match */
72 return retval;
b41d6cf3 73 }
b41d6cf3 74
f5afe806 75 dynid = kzalloc(sizeof(*dynid), GFP_KERNEL);
1da177e4
LT
76 if (!dynid)
77 return -ENOMEM;
78
1da177e4
LT
79 dynid->id.vendor = vendor;
80 dynid->id.device = device;
81 dynid->id.subvendor = subvendor;
82 dynid->id.subdevice = subdevice;
83 dynid->id.class = class;
84 dynid->id.class_mask = class_mask;
edbc25ca 85 dynid->id.driver_data = driver_data;
1da177e4
LT
86
87 spin_lock(&pdrv->dynids.lock);
a56bc69a 88 list_add_tail(&dynid->node, &pdrv->dynids.list);
1da177e4
LT
89 spin_unlock(&pdrv->dynids.lock);
90
75865858 91 if (get_driver(&pdrv->driver)) {
b19441af 92 retval = driver_attach(&pdrv->driver);
75865858 93 put_driver(&pdrv->driver);
1da177e4
LT
94 }
95
b19441af
GKH
96 if (retval)
97 return retval;
1da177e4
LT
98 return count;
99}
1da177e4 100static DRIVER_ATTR(new_id, S_IWUSR, NULL, store_new_id);
1da177e4
LT
101
102static void
103pci_free_dynids(struct pci_driver *drv)
104{
75865858 105 struct pci_dynid *dynid, *n;
1da177e4
LT
106
107 spin_lock(&drv->dynids.lock);
75865858 108 list_for_each_entry_safe(dynid, n, &drv->dynids.list, node) {
1da177e4
LT
109 list_del(&dynid->node);
110 kfree(dynid);
111 }
112 spin_unlock(&drv->dynids.lock);
113}
114
115static int
116pci_create_newid_file(struct pci_driver *drv)
117{
118 int error = 0;
119 if (drv->probe != NULL)
03d43b19 120 error = driver_create_file(&drv->driver, &driver_attr_new_id);
1da177e4
LT
121 return error;
122}
123
03d43b19
GKH
124static void pci_remove_newid_file(struct pci_driver *drv)
125{
126 driver_remove_file(&drv->driver, &driver_attr_new_id);
127}
1da177e4 128#else /* !CONFIG_HOTPLUG */
1da177e4
LT
129static inline void pci_free_dynids(struct pci_driver *drv) {}
130static inline int pci_create_newid_file(struct pci_driver *drv)
131{
132 return 0;
133}
03d43b19 134static inline void pci_remove_newid_file(struct pci_driver *drv) {}
1da177e4
LT
135#endif
136
137/**
75865858 138 * pci_match_id - See if a pci device matches a given pci_id table
1da177e4 139 * @ids: array of PCI device id structures to search in
75865858
GKH
140 * @dev: the PCI device structure to match against.
141 *
1da177e4 142 * Used by a driver to check whether a PCI device present in the
75865858 143 * system is in its list of supported devices. Returns the matching
1da177e4 144 * pci_device_id structure or %NULL if there is no match.
75865858 145 *
8b60756a 146 * Deprecated, don't use this as it will not catch any dynamic ids
75865858 147 * that a driver might want to check for.
1da177e4 148 */
75865858
GKH
149const struct pci_device_id *pci_match_id(const struct pci_device_id *ids,
150 struct pci_dev *dev)
1da177e4 151{
75865858
GKH
152 if (ids) {
153 while (ids->vendor || ids->subvendor || ids->class_mask) {
154 if (pci_match_one_device(ids, dev))
155 return ids;
156 ids++;
157 }
1da177e4
LT
158 }
159 return NULL;
160}
161
162/**
ae9608af 163 * pci_match_device - Tell if a PCI device structure has a matching PCI device id structure
75865858 164 * @drv: the PCI driver to match against
39ba487f 165 * @dev: the PCI device structure to match against
75865858
GKH
166 *
167 * Used by a driver to check whether a PCI device present in the
168 * system is in its list of supported devices. Returns the matching
169 * pci_device_id structure or %NULL if there is no match.
1da177e4 170 */
d73460d7
AB
171static const struct pci_device_id *pci_match_device(struct pci_driver *drv,
172 struct pci_dev *dev)
75865858 173{
75865858 174 struct pci_dynid *dynid;
1da177e4 175
7461b60a 176 /* Look at the dynamic ids first, before the static ones */
75865858
GKH
177 spin_lock(&drv->dynids.lock);
178 list_for_each_entry(dynid, &drv->dynids.list, node) {
179 if (pci_match_one_device(&dynid->id, dev)) {
180 spin_unlock(&drv->dynids.lock);
181 return &dynid->id;
182 }
1da177e4 183 }
75865858 184 spin_unlock(&drv->dynids.lock);
7461b60a
RK
185
186 return pci_match_id(drv->id_table, dev);
1da177e4
LT
187}
188
873392ca
RR
189struct drv_dev_and_id {
190 struct pci_driver *drv;
191 struct pci_dev *dev;
192 const struct pci_device_id *id;
193};
194
195static long local_pci_probe(void *_ddi)
196{
197 struct drv_dev_and_id *ddi = _ddi;
198
199 return ddi->drv->probe(ddi->dev, ddi->id);
200}
201
d42c6997
AK
202static int pci_call_probe(struct pci_driver *drv, struct pci_dev *dev,
203 const struct pci_device_id *id)
204{
873392ca
RR
205 int error, node;
206 struct drv_dev_and_id ddi = { drv, dev, id };
207
208 /* Execute driver initialization on node where the device's
209 bus is attached to. This way the driver likely allocates
210 its local memory on the right node without any need to
211 change it. */
212 node = dev_to_node(&dev->dev);
f70316da 213 if (node >= 0) {
873392ca 214 int cpu;
f70316da 215 node_to_cpumask_ptr(nodecpumask, node);
873392ca
RR
216
217 get_online_cpus();
218 cpu = cpumask_any_and(nodecpumask, cpu_online_mask);
219 if (cpu < nr_cpu_ids)
220 error = work_on_cpu(cpu, local_pci_probe, &ddi);
221 else
222 error = local_pci_probe(&ddi);
223 put_online_cpus();
224 } else
225 error = local_pci_probe(&ddi);
d42c6997
AK
226 return error;
227}
228
1da177e4
LT
229/**
230 * __pci_device_probe()
8f7020d3
RD
231 * @drv: driver to call to check if it wants the PCI device
232 * @pci_dev: PCI device being probed
1da177e4 233 *
8f7020d3 234 * returns 0 on success, else error.
1da177e4
LT
235 * side-effect: pci_dev->driver is set to drv when drv claims pci_dev.
236 */
237static int
238__pci_device_probe(struct pci_driver *drv, struct pci_dev *pci_dev)
75865858
GKH
239{
240 const struct pci_device_id *id;
1da177e4
LT
241 int error = 0;
242
243 if (!pci_dev->driver && drv->probe) {
75865858
GKH
244 error = -ENODEV;
245
246 id = pci_match_device(drv, pci_dev);
247 if (id)
d42c6997 248 error = pci_call_probe(drv, pci_dev, id);
75865858
GKH
249 if (error >= 0) {
250 pci_dev->driver = drv;
251 error = 0;
252 }
1da177e4
LT
253 }
254 return error;
255}
256
257static int pci_device_probe(struct device * dev)
258{
259 int error = 0;
260 struct pci_driver *drv;
261 struct pci_dev *pci_dev;
262
263 drv = to_pci_driver(dev->driver);
264 pci_dev = to_pci_dev(dev);
265 pci_dev_get(pci_dev);
266 error = __pci_device_probe(drv, pci_dev);
267 if (error)
268 pci_dev_put(pci_dev);
269
270 return error;
271}
272
273static int pci_device_remove(struct device * dev)
274{
275 struct pci_dev * pci_dev = to_pci_dev(dev);
276 struct pci_driver * drv = pci_dev->driver;
277
278 if (drv) {
279 if (drv->remove)
280 drv->remove(pci_dev);
281 pci_dev->driver = NULL;
282 }
283
2449e06a
SL
284 /*
285 * If the device is still on, set the power state as "unknown",
286 * since it might change by the next time we load the driver.
287 */
288 if (pci_dev->current_state == PCI_D0)
289 pci_dev->current_state = PCI_UNKNOWN;
290
1da177e4
LT
291 /*
292 * We would love to complain here if pci_dev->is_enabled is set, that
293 * the driver should have called pci_disable_device(), but the
294 * unfortunate fact is there are too many odd BIOS and bridge setups
295 * that don't like drivers doing that all of the time.
296 * Oh well, we can dream of sane hardware when we sleep, no matter how
297 * horrible the crap we have to deal with is when we are awake...
298 */
299
300 pci_dev_put(pci_dev);
301 return 0;
302}
303
bbb44d9f
RW
304static void pci_device_shutdown(struct device *dev)
305{
306 struct pci_dev *pci_dev = to_pci_dev(dev);
307 struct pci_driver *drv = pci_dev->driver;
308
309 if (drv && drv->shutdown)
310 drv->shutdown(pci_dev);
311 pci_msi_shutdown(pci_dev);
312 pci_msix_shutdown(pci_dev);
313}
314
315#ifdef CONFIG_PM_SLEEP
316
fa58d305
RW
317/*
318 * Default "suspend" method for devices that have no driver provided suspend,
319 * or not even a driver at all (second part).
bbb44d9f 320 */
bb808945 321static void pci_pm_set_unknown_state(struct pci_dev *pci_dev)
bbb44d9f 322{
bbb44d9f
RW
323 /*
324 * mark its power state as "unknown", since we don't know if
325 * e.g. the BIOS will change its device state when we suspend.
326 */
327 if (pci_dev->current_state == PCI_D0)
328 pci_dev->current_state = PCI_UNKNOWN;
329}
330
355a72d7
RW
331/*
332 * Default "resume" method for devices that have no driver provided resume,
333 * or not even a driver at all (second part).
334 */
bb808945 335static int pci_pm_reenable_device(struct pci_dev *pci_dev)
355a72d7
RW
336{
337 int retval;
338
bbb44d9f
RW
339 /* if the device was enabled before suspend, reenable */
340 retval = pci_reenable_device(pci_dev);
341 /*
342 * if the device was busmaster before the suspend, make it busmaster
343 * again
344 */
345 if (pci_dev->is_busmaster)
346 pci_set_master(pci_dev);
347
348 return retval;
349}
350
351static int pci_legacy_suspend(struct device *dev, pm_message_t state)
1da177e4
LT
352{
353 struct pci_dev * pci_dev = to_pci_dev(dev);
354 struct pci_driver * drv = pci_dev->driver;
355 int i = 0;
356
02669492 357 if (drv && drv->suspend) {
aa8c6c93
RW
358 pci_dev->state_saved = false;
359
1da177e4 360 i = drv->suspend(pci_dev, state);
02669492 361 suspend_report_result(drv->suspend, i);
aa8c6c93
RW
362 if (i)
363 return i;
364
365 if (pci_dev->state_saved)
366 goto Fixup;
367
368 if (WARN_ON_ONCE(pci_dev->current_state != PCI_D0))
369 goto Fixup;
02669492 370 }
ad8cfa1d 371
aa8c6c93
RW
372 pci_save_state(pci_dev);
373 /*
374 * This is for compatibility with existing code with legacy PM support.
375 */
376 pci_pm_set_unknown_state(pci_dev);
377
378 Fixup:
ad8cfa1d
RW
379 pci_fixup_device(pci_fixup_suspend, pci_dev);
380
1da177e4
LT
381 return i;
382}
383
bbb44d9f 384static int pci_legacy_suspend_late(struct device *dev, pm_message_t state)
cbd69dbb
LT
385{
386 struct pci_dev * pci_dev = to_pci_dev(dev);
387 struct pci_driver * drv = pci_dev->driver;
388 int i = 0;
389
390 if (drv && drv->suspend_late) {
391 i = drv->suspend_late(pci_dev, state);
392 suspend_report_result(drv->suspend_late, i);
393 }
394 return i;
395}
1da177e4 396
f6dc1e5e
RW
397static int pci_legacy_resume_early(struct device *dev)
398{
f6dc1e5e
RW
399 struct pci_dev * pci_dev = to_pci_dev(dev);
400 struct pci_driver * drv = pci_dev->driver;
401
aa8c6c93
RW
402 return drv && drv->resume_early ?
403 drv->resume_early(pci_dev) : 0;
f6dc1e5e
RW
404}
405
bbb44d9f 406static int pci_legacy_resume(struct device *dev)
1da177e4
LT
407{
408 struct pci_dev * pci_dev = to_pci_dev(dev);
409 struct pci_driver * drv = pci_dev->driver;
410
ad8cfa1d
RW
411 pci_fixup_device(pci_fixup_resume, pci_dev);
412
aa8c6c93
RW
413 return drv && drv->resume ?
414 drv->resume(pci_dev) : pci_pm_reenable_device(pci_dev);
1da177e4
LT
415}
416
571ff758
RW
417/* Auxiliary functions used by the new power management framework */
418
73410429
RW
419static void pci_pm_default_resume_noirq(struct pci_dev *pci_dev)
420{
aa8c6c93
RW
421 pci_restore_standard_config(pci_dev);
422 pci_fixup_device(pci_fixup_resume_early, pci_dev);
73410429
RW
423}
424
571ff758
RW
425static int pci_pm_default_resume(struct pci_dev *pci_dev)
426{
73410429
RW
427 pci_fixup_device(pci_fixup_resume, pci_dev);
428
571ff758
RW
429 if (!pci_is_bridge(pci_dev))
430 pci_enable_wake(pci_dev, PCI_D0, false);
431
bb808945 432 return pci_pm_reenable_device(pci_dev);
571ff758
RW
433}
434
73410429
RW
435static void pci_pm_default_suspend_generic(struct pci_dev *pci_dev)
436{
437 /* If device is enabled at this point, disable it */
438 pci_disable_enabled_device(pci_dev);
439 /*
440 * Save state with interrupts enabled, because in principle the bus the
441 * device is on may be put into a low power state after this code runs.
442 */
443 pci_save_state(pci_dev);
444}
445
571ff758
RW
446static void pci_pm_default_suspend(struct pci_dev *pci_dev)
447{
73410429 448 pci_pm_default_suspend_generic(pci_dev);
571ff758
RW
449
450 if (!pci_is_bridge(pci_dev))
451 pci_prepare_to_sleep(pci_dev);
d67e37d7
RW
452
453 pci_fixup_device(pci_fixup_suspend, pci_dev);
571ff758
RW
454}
455
07e836e8
RW
456static bool pci_has_legacy_pm_support(struct pci_dev *pci_dev)
457{
458 struct pci_driver *drv = pci_dev->driver;
bb808945 459 bool ret = drv && (drv->suspend || drv->suspend_late || drv->resume
07e836e8 460 || drv->resume_early);
bb808945
RW
461
462 /*
463 * Legacy PM support is used by default, so warn if the new framework is
464 * supported as well. Drivers are supposed to support either the
465 * former, or the latter, but not both at the same time.
466 */
467 WARN_ON(ret && drv->driver.pm);
468
469 return ret;
07e836e8
RW
470}
471
571ff758
RW
472/* New power management framework */
473
bbb44d9f
RW
474static int pci_pm_prepare(struct device *dev)
475{
476 struct device_driver *drv = dev->driver;
477 int error = 0;
478
479 if (drv && drv->pm && drv->pm->prepare)
480 error = drv->pm->prepare(dev);
481
482 return error;
483}
484
485static void pci_pm_complete(struct device *dev)
486{
487 struct device_driver *drv = dev->driver;
488
489 if (drv && drv->pm && drv->pm->complete)
490 drv->pm->complete(dev);
491}
492
493#ifdef CONFIG_SUSPEND
494
495static int pci_pm_suspend(struct device *dev)
496{
497 struct pci_dev *pci_dev = to_pci_dev(dev);
498 struct device_driver *drv = dev->driver;
499 int error = 0;
500
ad8cfa1d
RW
501 if (pci_has_legacy_pm_support(pci_dev))
502 return pci_legacy_suspend(dev, PMSG_SUSPEND);
bb808945 503
d67e37d7
RW
504 if (drv && drv->pm && drv->pm->suspend) {
505 error = drv->pm->suspend(dev);
506 suspend_report_result(drv->pm->suspend, error);
bbb44d9f 507 }
fa58d305 508
d67e37d7
RW
509 if (!error)
510 pci_pm_default_suspend(pci_dev);
bbb44d9f
RW
511
512 return error;
513}
514
515static int pci_pm_suspend_noirq(struct device *dev)
c8958177 516{
355a72d7 517 struct pci_dev *pci_dev = to_pci_dev(dev);
adf09493 518 struct device_driver *drv = dev->driver;
bbb44d9f 519 int error = 0;
c8958177 520
bb808945
RW
521 if (pci_has_legacy_pm_support(pci_dev))
522 return pci_legacy_suspend_late(dev, PMSG_SUSPEND);
523
d67e37d7
RW
524 if (drv && drv->pm && drv->pm->suspend_noirq) {
525 error = drv->pm->suspend_noirq(dev);
526 suspend_report_result(drv->pm->suspend_noirq, error);
bbb44d9f
RW
527 }
528
d67e37d7
RW
529 if (!error)
530 pci_pm_set_unknown_state(pci_dev);
531
bbb44d9f 532 return error;
c8958177 533}
1da177e4 534
f6dc1e5e 535static int pci_pm_resume_noirq(struct device *dev)
bbb44d9f
RW
536{
537 struct pci_dev *pci_dev = to_pci_dev(dev);
538 struct device_driver *drv = dev->driver;
355a72d7 539 int error = 0;
bbb44d9f 540
aa8c6c93
RW
541 pci_pm_default_resume_noirq(pci_dev);
542
ad8cfa1d 543 if (pci_has_legacy_pm_support(pci_dev))
f6dc1e5e 544 return pci_legacy_resume_early(dev);
bb808945 545
f6dc1e5e
RW
546 if (drv && drv->pm && drv->pm->resume_noirq)
547 error = drv->pm->resume_noirq(dev);
bbb44d9f
RW
548
549 return error;
550}
551
f6dc1e5e 552static int pci_pm_resume(struct device *dev)
bbb44d9f 553{
355a72d7 554 struct pci_dev *pci_dev = to_pci_dev(dev);
adf09493 555 struct device_driver *drv = dev->driver;
bbb44d9f
RW
556 int error = 0;
557
ad8cfa1d 558 if (pci_has_legacy_pm_support(pci_dev))
f6dc1e5e 559 return pci_legacy_resume(dev);
bb808945 560
f6dc1e5e 561 error = pci_pm_default_resume(pci_dev);
73410429 562
f6dc1e5e
RW
563 if (!error && drv && drv->pm && drv->pm->resume)
564 error = drv->pm->resume(dev);
bbb44d9f
RW
565
566 return error;
567}
568
569#else /* !CONFIG_SUSPEND */
570
571#define pci_pm_suspend NULL
572#define pci_pm_suspend_noirq NULL
573#define pci_pm_resume NULL
574#define pci_pm_resume_noirq NULL
575
576#endif /* !CONFIG_SUSPEND */
577
578#ifdef CONFIG_HIBERNATION
579
580static int pci_pm_freeze(struct device *dev)
581{
582 struct pci_dev *pci_dev = to_pci_dev(dev);
583 struct device_driver *drv = dev->driver;
584 int error = 0;
585
ad8cfa1d
RW
586 if (pci_has_legacy_pm_support(pci_dev))
587 return pci_legacy_suspend(dev, PMSG_FREEZE);
bb808945 588
d67e37d7
RW
589 if (drv && drv->pm && drv->pm->freeze) {
590 error = drv->pm->freeze(dev);
591 suspend_report_result(drv->pm->freeze, error);
bbb44d9f
RW
592 }
593
d67e37d7
RW
594 if (!error)
595 pci_pm_default_suspend_generic(pci_dev);
596
bbb44d9f
RW
597 return error;
598}
599
600static int pci_pm_freeze_noirq(struct device *dev)
601{
355a72d7 602 struct pci_dev *pci_dev = to_pci_dev(dev);
adf09493 603 struct device_driver *drv = dev->driver;
bbb44d9f
RW
604 int error = 0;
605
bb808945
RW
606 if (pci_has_legacy_pm_support(pci_dev))
607 return pci_legacy_suspend_late(dev, PMSG_FREEZE);
608
d67e37d7
RW
609 if (drv && drv->pm && drv->pm->freeze_noirq) {
610 error = drv->pm->freeze_noirq(dev);
611 suspend_report_result(drv->pm->freeze_noirq, error);
bbb44d9f
RW
612 }
613
d67e37d7
RW
614 if (!error)
615 pci_pm_set_unknown_state(pci_dev);
616
bbb44d9f
RW
617 return error;
618}
619
f6dc1e5e 620static int pci_pm_thaw_noirq(struct device *dev)
bbb44d9f 621{
355a72d7 622 struct pci_dev *pci_dev = to_pci_dev(dev);
bbb44d9f
RW
623 struct device_driver *drv = dev->driver;
624 int error = 0;
625
ad8cfa1d 626 if (pci_has_legacy_pm_support(pci_dev))
f6dc1e5e 627 return pci_legacy_resume_early(dev);
bb808945 628
f6dc1e5e 629 pci_update_current_state(pci_dev, PCI_D0);
d67e37d7 630
f6dc1e5e
RW
631 if (drv && drv->pm && drv->pm->thaw_noirq)
632 error = drv->pm->thaw_noirq(dev);
bbb44d9f
RW
633
634 return error;
635}
636
f6dc1e5e 637static int pci_pm_thaw(struct device *dev)
bbb44d9f 638{
355a72d7 639 struct pci_dev *pci_dev = to_pci_dev(dev);
adf09493 640 struct device_driver *drv = dev->driver;
bbb44d9f
RW
641 int error = 0;
642
ad8cfa1d 643 if (pci_has_legacy_pm_support(pci_dev))
f6dc1e5e 644 return pci_legacy_resume(dev);
bb808945 645
f6dc1e5e 646 pci_pm_reenable_device(pci_dev);
d67e37d7 647
f6dc1e5e
RW
648 if (drv && drv->pm && drv->pm->thaw)
649 error = drv->pm->thaw(dev);
bbb44d9f
RW
650
651 return error;
652}
653
654static int pci_pm_poweroff(struct device *dev)
655{
355a72d7 656 struct pci_dev *pci_dev = to_pci_dev(dev);
bbb44d9f
RW
657 struct device_driver *drv = dev->driver;
658 int error = 0;
659
ad8cfa1d
RW
660 if (pci_has_legacy_pm_support(pci_dev))
661 return pci_legacy_suspend(dev, PMSG_HIBERNATE);
bb808945 662
d67e37d7
RW
663 if (drv && drv->pm && drv->pm->poweroff) {
664 error = drv->pm->poweroff(dev);
665 suspend_report_result(drv->pm->poweroff, error);
bbb44d9f
RW
666 }
667
d67e37d7
RW
668 if (!error)
669 pci_pm_default_suspend(pci_dev);
c9b9972b 670
bbb44d9f
RW
671 return error;
672}
673
674static int pci_pm_poweroff_noirq(struct device *dev)
675{
adf09493 676 struct device_driver *drv = dev->driver;
bbb44d9f
RW
677 int error = 0;
678
bb808945
RW
679 if (pci_has_legacy_pm_support(to_pci_dev(dev)))
680 return pci_legacy_suspend_late(dev, PMSG_HIBERNATE);
681
d67e37d7
RW
682 if (drv && drv->pm && drv->pm->poweroff_noirq) {
683 error = drv->pm->poweroff_noirq(dev);
684 suspend_report_result(drv->pm->poweroff_noirq, error);
bbb44d9f
RW
685 }
686
687 return error;
688}
689
f6dc1e5e 690static int pci_pm_restore_noirq(struct device *dev)
bbb44d9f
RW
691{
692 struct pci_dev *pci_dev = to_pci_dev(dev);
693 struct device_driver *drv = dev->driver;
355a72d7 694 int error = 0;
bbb44d9f 695
aa8c6c93
RW
696 pci_pm_default_resume_noirq(pci_dev);
697
ad8cfa1d 698 if (pci_has_legacy_pm_support(pci_dev))
f6dc1e5e 699 return pci_legacy_resume_early(dev);
bb808945 700
f6dc1e5e
RW
701 if (drv && drv->pm && drv->pm->restore_noirq)
702 error = drv->pm->restore_noirq(dev);
bbb44d9f
RW
703
704 return error;
705}
706
f6dc1e5e 707static int pci_pm_restore(struct device *dev)
bbb44d9f
RW
708{
709 struct pci_dev *pci_dev = to_pci_dev(dev);
adf09493 710 struct device_driver *drv = dev->driver;
bbb44d9f
RW
711 int error = 0;
712
ad8cfa1d 713 if (pci_has_legacy_pm_support(pci_dev))
f6dc1e5e 714 return pci_legacy_resume(dev);
bb808945 715
f6dc1e5e 716 error = pci_pm_default_resume(pci_dev);
73410429 717
f6dc1e5e
RW
718 if (!error && drv && drv->pm && drv->pm->restore)
719 error = drv->pm->restore(dev);
bbb44d9f
RW
720
721 return error;
c8958177 722}
1da177e4 723
bbb44d9f
RW
724#else /* !CONFIG_HIBERNATION */
725
726#define pci_pm_freeze NULL
727#define pci_pm_freeze_noirq NULL
728#define pci_pm_thaw NULL
729#define pci_pm_thaw_noirq NULL
730#define pci_pm_poweroff NULL
731#define pci_pm_poweroff_noirq NULL
732#define pci_pm_restore NULL
733#define pci_pm_restore_noirq NULL
734
735#endif /* !CONFIG_HIBERNATION */
736
adf09493
RW
737struct dev_pm_ops pci_dev_pm_ops = {
738 .prepare = pci_pm_prepare,
739 .complete = pci_pm_complete,
740 .suspend = pci_pm_suspend,
741 .resume = pci_pm_resume,
742 .freeze = pci_pm_freeze,
743 .thaw = pci_pm_thaw,
744 .poweroff = pci_pm_poweroff,
745 .restore = pci_pm_restore,
bbb44d9f
RW
746 .suspend_noirq = pci_pm_suspend_noirq,
747 .resume_noirq = pci_pm_resume_noirq,
748 .freeze_noirq = pci_pm_freeze_noirq,
749 .thaw_noirq = pci_pm_thaw_noirq,
750 .poweroff_noirq = pci_pm_poweroff_noirq,
751 .restore_noirq = pci_pm_restore_noirq,
752};
753
adf09493 754#define PCI_PM_OPS_PTR (&pci_dev_pm_ops)
bbb44d9f
RW
755
756#else /* !CONFIG_PM_SLEEP */
757
758#define PCI_PM_OPS_PTR NULL
759
760#endif /* !CONFIG_PM_SLEEP */
761
1da177e4 762/**
863b18f4 763 * __pci_register_driver - register a new pci driver
1da177e4 764 * @drv: the driver structure to register
863b18f4 765 * @owner: owner module of drv
f95d882d 766 * @mod_name: module name string
1da177e4
LT
767 *
768 * Adds the driver structure to the list of registered drivers.
769 * Returns a negative value on error, otherwise 0.
eaae4b3a 770 * If no error occurred, the driver remains registered even if
1da177e4
LT
771 * no device was claimed during registration.
772 */
725522b5
GKH
773int __pci_register_driver(struct pci_driver *drv, struct module *owner,
774 const char *mod_name)
1da177e4
LT
775{
776 int error;
777
778 /* initialize common driver fields */
779 drv->driver.name = drv->name;
780 drv->driver.bus = &pci_bus_type;
863b18f4 781 drv->driver.owner = owner;
725522b5 782 drv->driver.mod_name = mod_name;
50b00755 783
75865858
GKH
784 spin_lock_init(&drv->dynids.lock);
785 INIT_LIST_HEAD(&drv->dynids.list);
1da177e4
LT
786
787 /* register with core */
788 error = driver_register(&drv->driver);
50bf14b3
AM
789 if (error)
790 return error;
1da177e4 791
50bf14b3
AM
792 error = pci_create_newid_file(drv);
793 if (error)
794 driver_unregister(&drv->driver);
1da177e4
LT
795
796 return error;
797}
798
799/**
800 * pci_unregister_driver - unregister a pci driver
801 * @drv: the driver structure to unregister
802 *
803 * Deletes the driver structure from the list of registered PCI drivers,
804 * gives it a chance to clean up by calling its remove() function for
805 * each device it was responsible for, and marks those devices as
806 * driverless.
807 */
808
809void
810pci_unregister_driver(struct pci_driver *drv)
811{
03d43b19 812 pci_remove_newid_file(drv);
1da177e4
LT
813 driver_unregister(&drv->driver);
814 pci_free_dynids(drv);
815}
816
817static struct pci_driver pci_compat_driver = {
818 .name = "compat"
819};
820
821/**
822 * pci_dev_driver - get the pci_driver of a device
823 * @dev: the device to query
824 *
825 * Returns the appropriate pci_driver structure or %NULL if there is no
826 * registered driver for the device.
827 */
828struct pci_driver *
829pci_dev_driver(const struct pci_dev *dev)
830{
831 if (dev->driver)
832 return dev->driver;
833 else {
834 int i;
835 for(i=0; i<=PCI_ROM_RESOURCE; i++)
836 if (dev->resource[i].flags & IORESOURCE_BUSY)
837 return &pci_compat_driver;
838 }
839 return NULL;
840}
841
842/**
843 * pci_bus_match - Tell if a PCI device structure has a matching PCI device id structure
1da177e4 844 * @dev: the PCI device structure to match against
8f7020d3 845 * @drv: the device driver to search for matching PCI device id structures
1da177e4
LT
846 *
847 * Used by a driver to check whether a PCI device present in the
8f7020d3 848 * system is in its list of supported devices. Returns the matching
1da177e4
LT
849 * pci_device_id structure or %NULL if there is no match.
850 */
75865858 851static int pci_bus_match(struct device *dev, struct device_driver *drv)
1da177e4 852{
75865858
GKH
853 struct pci_dev *pci_dev = to_pci_dev(dev);
854 struct pci_driver *pci_drv = to_pci_driver(drv);
1da177e4
LT
855 const struct pci_device_id *found_id;
856
75865858 857 found_id = pci_match_device(pci_drv, pci_dev);
1da177e4
LT
858 if (found_id)
859 return 1;
860
75865858 861 return 0;
1da177e4
LT
862}
863
864/**
865 * pci_dev_get - increments the reference count of the pci device structure
866 * @dev: the device being referenced
867 *
868 * Each live reference to a device should be refcounted.
869 *
870 * Drivers for PCI devices should normally record such references in
871 * their probe() methods, when they bind to a device, and release
872 * them by calling pci_dev_put(), in their disconnect() methods.
873 *
874 * A pointer to the device with the incremented reference counter is returned.
875 */
876struct pci_dev *pci_dev_get(struct pci_dev *dev)
877{
878 if (dev)
879 get_device(&dev->dev);
880 return dev;
881}
882
883/**
884 * pci_dev_put - release a use of the pci device structure
885 * @dev: device that's been disconnected
886 *
887 * Must be called when a user of a device is finished with it. When the last
888 * user of the device calls this function, the memory of the device is freed.
889 */
890void pci_dev_put(struct pci_dev *dev)
891{
892 if (dev)
893 put_device(&dev->dev);
894}
895
896#ifndef CONFIG_HOTPLUG
7eff2e7a 897int pci_uevent(struct device *dev, struct kobj_uevent_env *env)
1da177e4
LT
898{
899 return -ENODEV;
900}
901#endif
902
903struct bus_type pci_bus_type = {
904 .name = "pci",
905 .match = pci_bus_match,
312c004d 906 .uevent = pci_uevent,
b15d686a
RK
907 .probe = pci_device_probe,
908 .remove = pci_device_remove,
cbd69dbb 909 .shutdown = pci_device_shutdown,
1da177e4 910 .dev_attrs = pci_dev_attrs,
bbb44d9f 911 .pm = PCI_PM_OPS_PTR,
1da177e4
LT
912};
913
914static int __init pci_driver_init(void)
915{
916 return bus_register(&pci_bus_type);
917}
918
919postcore_initcall(pci_driver_init);
920
75865858 921EXPORT_SYMBOL(pci_match_id);
863b18f4 922EXPORT_SYMBOL(__pci_register_driver);
1da177e4
LT
923EXPORT_SYMBOL(pci_unregister_driver);
924EXPORT_SYMBOL(pci_dev_driver);
925EXPORT_SYMBOL(pci_bus_type);
926EXPORT_SYMBOL(pci_dev_get);
927EXPORT_SYMBOL(pci_dev_put);
This page took 0.596911 seconds and 5 git commands to generate.