PCI PM: Rearrange code in pci-driver.c
[GitHub/mt8127/android_kernel_alcatel_ttab.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
GKH
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) {
1da177e4 358 i = drv->suspend(pci_dev, state);
02669492
AM
359 suspend_report_result(drv->suspend, i);
360 } else {
73410429 361 pci_save_state(pci_dev);
fa58d305 362 /*
73410429
RW
363 * This is for compatibility with existing code with legacy PM
364 * support.
fa58d305 365 */
bb808945 366 pci_pm_set_unknown_state(pci_dev);
02669492 367 }
1da177e4
LT
368 return i;
369}
370
bbb44d9f 371static int pci_legacy_suspend_late(struct device *dev, pm_message_t state)
cbd69dbb
LT
372{
373 struct pci_dev * pci_dev = to_pci_dev(dev);
374 struct pci_driver * drv = pci_dev->driver;
375 int i = 0;
376
377 if (drv && drv->suspend_late) {
378 i = drv->suspend_late(pci_dev, state);
379 suspend_report_result(drv->suspend_late, i);
380 }
381 return i;
382}
1da177e4 383
bbb44d9f 384static int pci_legacy_resume(struct device *dev)
1da177e4 385{
8d92bc22 386 int error;
1da177e4
LT
387 struct pci_dev * pci_dev = to_pci_dev(dev);
388 struct pci_driver * drv = pci_dev->driver;
389
355a72d7 390 if (drv && drv->resume) {
8d92bc22 391 error = drv->resume(pci_dev);
355a72d7 392 } else {
73410429
RW
393 /* restore the PCI config space */
394 pci_restore_state(pci_dev);
bb808945 395 error = pci_pm_reenable_device(pci_dev);
355a72d7 396 }
8d92bc22 397 return error;
1da177e4
LT
398}
399
bbb44d9f 400static int pci_legacy_resume_early(struct device *dev)
cbd69dbb
LT
401{
402 int error = 0;
403 struct pci_dev * pci_dev = to_pci_dev(dev);
404 struct pci_driver * drv = pci_dev->driver;
405
406 if (drv && drv->resume_early)
407 error = drv->resume_early(pci_dev);
408 return error;
409}
410
571ff758
RW
411/* Auxiliary functions used by the new power management framework */
412
73410429
RW
413static int pci_restore_standard_config(struct pci_dev *pci_dev)
414{
415 struct pci_dev *parent = pci_dev->bus->self;
416 int error = 0;
417
418 /* Check if the device's bus is operational */
419 if (!parent || parent->current_state == PCI_D0) {
420 pci_restore_state(pci_dev);
421 pci_update_current_state(pci_dev, PCI_D0);
422 } else {
423 dev_warn(&pci_dev->dev, "unable to restore config, "
424 "bridge %s in low power state D%d\n", pci_name(parent),
425 parent->current_state);
426 pci_dev->current_state = PCI_UNKNOWN;
427 error = -EAGAIN;
428 }
429
430 return error;
431}
432
571ff758
RW
433static bool pci_is_bridge(struct pci_dev *pci_dev)
434{
435 return !!(pci_dev->subordinate);
436}
437
73410429
RW
438static void pci_pm_default_resume_noirq(struct pci_dev *pci_dev)
439{
440 if (pci_restore_standard_config(pci_dev))
441 pci_fixup_device(pci_fixup_resume_early, pci_dev);
442}
443
571ff758
RW
444static int pci_pm_default_resume(struct pci_dev *pci_dev)
445{
73410429
RW
446 /*
447 * pci_restore_standard_config() should have been called once already,
448 * but it would have failed if the device's parent bridge had not been
449 * in power state D0 at that time. Check it and try again if necessary.
450 */
451 if (pci_dev->current_state == PCI_UNKNOWN) {
452 int error = pci_restore_standard_config(pci_dev);
453 if (error)
454 return error;
455 }
456
457 pci_fixup_device(pci_fixup_resume, pci_dev);
458
571ff758
RW
459 if (!pci_is_bridge(pci_dev))
460 pci_enable_wake(pci_dev, PCI_D0, false);
461
bb808945 462 return pci_pm_reenable_device(pci_dev);
571ff758
RW
463}
464
73410429
RW
465static void pci_pm_default_suspend_generic(struct pci_dev *pci_dev)
466{
467 /* If device is enabled at this point, disable it */
468 pci_disable_enabled_device(pci_dev);
469 /*
470 * Save state with interrupts enabled, because in principle the bus the
471 * device is on may be put into a low power state after this code runs.
472 */
473 pci_save_state(pci_dev);
474}
475
571ff758
RW
476static void pci_pm_default_suspend(struct pci_dev *pci_dev)
477{
73410429 478 pci_pm_default_suspend_generic(pci_dev);
571ff758
RW
479
480 if (!pci_is_bridge(pci_dev))
481 pci_prepare_to_sleep(pci_dev);
482}
483
07e836e8
RW
484static bool pci_has_legacy_pm_support(struct pci_dev *pci_dev)
485{
486 struct pci_driver *drv = pci_dev->driver;
bb808945 487 bool ret = drv && (drv->suspend || drv->suspend_late || drv->resume
07e836e8 488 || drv->resume_early);
bb808945
RW
489
490 /*
491 * Legacy PM support is used by default, so warn if the new framework is
492 * supported as well. Drivers are supposed to support either the
493 * former, or the latter, but not both at the same time.
494 */
495 WARN_ON(ret && drv->driver.pm);
496
497 return ret;
07e836e8
RW
498}
499
571ff758
RW
500/* New power management framework */
501
bbb44d9f
RW
502static int pci_pm_prepare(struct device *dev)
503{
504 struct device_driver *drv = dev->driver;
505 int error = 0;
506
507 if (drv && drv->pm && drv->pm->prepare)
508 error = drv->pm->prepare(dev);
509
510 return error;
511}
512
513static void pci_pm_complete(struct device *dev)
514{
515 struct device_driver *drv = dev->driver;
516
517 if (drv && drv->pm && drv->pm->complete)
518 drv->pm->complete(dev);
519}
520
521#ifdef CONFIG_SUSPEND
522
523static int pci_pm_suspend(struct device *dev)
524{
525 struct pci_dev *pci_dev = to_pci_dev(dev);
526 struct device_driver *drv = dev->driver;
527 int error = 0;
528
bb808945
RW
529 if (pci_has_legacy_pm_support(pci_dev)) {
530 error = pci_legacy_suspend(dev, PMSG_SUSPEND);
531 goto Exit;
532 }
533
bbb44d9f
RW
534 if (drv && drv->pm) {
535 if (drv->pm->suspend) {
536 error = drv->pm->suspend(dev);
537 suspend_report_result(drv->pm->suspend, error);
bbb44d9f 538 }
fa58d305 539 } else {
571ff758 540 pci_pm_default_suspend(pci_dev);
bbb44d9f 541 }
fa58d305 542
bb808945 543 Exit:
bbb44d9f
RW
544 pci_fixup_device(pci_fixup_suspend, pci_dev);
545
546 return error;
547}
548
549static int pci_pm_suspend_noirq(struct device *dev)
c8958177 550{
355a72d7 551 struct pci_dev *pci_dev = to_pci_dev(dev);
adf09493 552 struct device_driver *drv = dev->driver;
bbb44d9f 553 int error = 0;
c8958177 554
bb808945
RW
555 if (pci_has_legacy_pm_support(pci_dev))
556 return pci_legacy_suspend_late(dev, PMSG_SUSPEND);
557
bbb44d9f
RW
558 if (drv && drv->pm) {
559 if (drv->pm->suspend_noirq) {
560 error = drv->pm->suspend_noirq(dev);
561 suspend_report_result(drv->pm->suspend_noirq, error);
562 }
355a72d7 563 } else {
bb808945 564 pci_pm_set_unknown_state(pci_dev);
bbb44d9f
RW
565 }
566
567 return error;
c8958177 568}
1da177e4 569
bbb44d9f
RW
570static int pci_pm_resume(struct device *dev)
571{
572 struct pci_dev *pci_dev = to_pci_dev(dev);
573 struct device_driver *drv = dev->driver;
355a72d7 574 int error = 0;
bbb44d9f 575
bb808945
RW
576 if (pci_has_legacy_pm_support(pci_dev)) {
577 pci_fixup_device(pci_fixup_resume, pci_dev);
578 return pci_legacy_resume(dev);
579 }
580
bbb44d9f 581 if (drv && drv->pm) {
73410429
RW
582 pci_fixup_device(pci_fixup_resume, pci_dev);
583
355a72d7
RW
584 if (drv->pm->resume)
585 error = drv->pm->resume(dev);
355a72d7 586 } else {
571ff758 587 error = pci_pm_default_resume(pci_dev);
bbb44d9f
RW
588 }
589
590 return error;
591}
592
593static int pci_pm_resume_noirq(struct device *dev)
594{
355a72d7 595 struct pci_dev *pci_dev = to_pci_dev(dev);
adf09493 596 struct device_driver *drv = dev->driver;
bbb44d9f
RW
597 int error = 0;
598
bb808945
RW
599 if (pci_has_legacy_pm_support(pci_dev)) {
600 pci_fixup_device(pci_fixup_resume_early, pci_dev);
601 return pci_legacy_resume_early(dev);
602 }
603
bbb44d9f 604 if (drv && drv->pm) {
73410429
RW
605 pci_fixup_device(pci_fixup_resume_early, pci_dev);
606
bbb44d9f
RW
607 if (drv->pm->resume_noirq)
608 error = drv->pm->resume_noirq(dev);
355a72d7 609 } else {
73410429 610 pci_pm_default_resume_noirq(pci_dev);
bbb44d9f
RW
611 }
612
613 return error;
614}
615
616#else /* !CONFIG_SUSPEND */
617
618#define pci_pm_suspend NULL
619#define pci_pm_suspend_noirq NULL
620#define pci_pm_resume NULL
621#define pci_pm_resume_noirq NULL
622
623#endif /* !CONFIG_SUSPEND */
624
625#ifdef CONFIG_HIBERNATION
626
627static int pci_pm_freeze(struct device *dev)
628{
629 struct pci_dev *pci_dev = to_pci_dev(dev);
630 struct device_driver *drv = dev->driver;
631 int error = 0;
632
bb808945
RW
633 if (pci_has_legacy_pm_support(pci_dev)) {
634 error = pci_legacy_suspend(dev, PMSG_FREEZE);
635 pci_fixup_device(pci_fixup_suspend, pci_dev);
636 return error;
637 }
638
bbb44d9f
RW
639 if (drv && drv->pm) {
640 if (drv->pm->freeze) {
641 error = drv->pm->freeze(dev);
642 suspend_report_result(drv->pm->freeze, error);
bbb44d9f 643 }
fa58d305 644 } else {
73410429 645 pci_pm_default_suspend_generic(pci_dev);
bbb44d9f
RW
646 }
647
648 return error;
649}
650
651static int pci_pm_freeze_noirq(struct device *dev)
652{
355a72d7 653 struct pci_dev *pci_dev = to_pci_dev(dev);
adf09493 654 struct device_driver *drv = dev->driver;
bbb44d9f
RW
655 int error = 0;
656
bb808945
RW
657 if (pci_has_legacy_pm_support(pci_dev))
658 return pci_legacy_suspend_late(dev, PMSG_FREEZE);
659
bbb44d9f
RW
660 if (drv && drv->pm) {
661 if (drv->pm->freeze_noirq) {
662 error = drv->pm->freeze_noirq(dev);
663 suspend_report_result(drv->pm->freeze_noirq, error);
664 }
355a72d7 665 } else {
bb808945 666 pci_pm_set_unknown_state(pci_dev);
bbb44d9f
RW
667 }
668
669 return error;
670}
671
672static int pci_pm_thaw(struct device *dev)
673{
355a72d7 674 struct pci_dev *pci_dev = to_pci_dev(dev);
bbb44d9f
RW
675 struct device_driver *drv = dev->driver;
676 int error = 0;
677
bb808945
RW
678 if (pci_has_legacy_pm_support(pci_dev)) {
679 pci_fixup_device(pci_fixup_resume, pci_dev);
680 return pci_legacy_resume(dev);
681 }
682
bbb44d9f
RW
683 if (drv && drv->pm) {
684 if (drv->pm->thaw)
685 error = drv->pm->thaw(dev);
fa58d305 686 } else {
bb808945 687 pci_pm_reenable_device(pci_dev);
bbb44d9f
RW
688 }
689
690 return error;
691}
692
693static int pci_pm_thaw_noirq(struct device *dev)
694{
355a72d7 695 struct pci_dev *pci_dev = to_pci_dev(dev);
adf09493 696 struct device_driver *drv = dev->driver;
bbb44d9f
RW
697 int error = 0;
698
bb808945
RW
699 if (pci_has_legacy_pm_support(pci_dev)) {
700 pci_fixup_device(pci_fixup_resume_early, to_pci_dev(dev));
701 return pci_legacy_resume_early(dev);
702 }
703
bbb44d9f
RW
704 if (drv && drv->pm) {
705 if (drv->pm->thaw_noirq)
706 error = drv->pm->thaw_noirq(dev);
fa58d305 707 } else {
73410429 708 pci_update_current_state(pci_dev, PCI_D0);
bbb44d9f
RW
709 }
710
711 return error;
712}
713
714static int pci_pm_poweroff(struct device *dev)
715{
355a72d7 716 struct pci_dev *pci_dev = to_pci_dev(dev);
bbb44d9f
RW
717 struct device_driver *drv = dev->driver;
718 int error = 0;
719
bb808945
RW
720 if (pci_has_legacy_pm_support(pci_dev)) {
721 error = pci_legacy_suspend(dev, PMSG_HIBERNATE);
722 goto Exit;
723 }
724
bbb44d9f
RW
725 if (drv && drv->pm) {
726 if (drv->pm->poweroff) {
727 error = drv->pm->poweroff(dev);
728 suspend_report_result(drv->pm->poweroff, error);
729 }
fa58d305 730 } else {
571ff758 731 pci_pm_default_suspend(pci_dev);
bbb44d9f
RW
732 }
733
bb808945 734 Exit:
c9b9972b
RW
735 pci_fixup_device(pci_fixup_suspend, pci_dev);
736
bbb44d9f
RW
737 return error;
738}
739
740static int pci_pm_poweroff_noirq(struct device *dev)
741{
adf09493 742 struct device_driver *drv = dev->driver;
bbb44d9f
RW
743 int error = 0;
744
bb808945
RW
745 if (pci_has_legacy_pm_support(to_pci_dev(dev)))
746 return pci_legacy_suspend_late(dev, PMSG_HIBERNATE);
747
bbb44d9f
RW
748 if (drv && drv->pm) {
749 if (drv->pm->poweroff_noirq) {
750 error = drv->pm->poweroff_noirq(dev);
751 suspend_report_result(drv->pm->poweroff_noirq, error);
752 }
bbb44d9f
RW
753 }
754
755 return error;
756}
757
758static int pci_pm_restore(struct device *dev)
759{
760 struct pci_dev *pci_dev = to_pci_dev(dev);
761 struct device_driver *drv = dev->driver;
355a72d7 762 int error = 0;
bbb44d9f 763
bb808945
RW
764 if (pci_has_legacy_pm_support(pci_dev)) {
765 pci_fixup_device(pci_fixup_resume, pci_dev);
766 return pci_legacy_resume(dev);
767 }
768
bbb44d9f 769 if (drv && drv->pm) {
73410429
RW
770 pci_fixup_device(pci_fixup_resume, pci_dev);
771
355a72d7
RW
772 if (drv->pm->restore)
773 error = drv->pm->restore(dev);
355a72d7 774 } else {
571ff758 775 error = pci_pm_default_resume(pci_dev);
bbb44d9f 776 }
bbb44d9f
RW
777
778 return error;
779}
780
781static int pci_pm_restore_noirq(struct device *dev)
782{
783 struct pci_dev *pci_dev = to_pci_dev(dev);
adf09493 784 struct device_driver *drv = dev->driver;
bbb44d9f
RW
785 int error = 0;
786
bb808945
RW
787 if (pci_has_legacy_pm_support(pci_dev)) {
788 pci_fixup_device(pci_fixup_resume_early, pci_dev);
789 return pci_legacy_resume_early(dev);
790 }
791
bbb44d9f 792 if (drv && drv->pm) {
73410429
RW
793 pci_fixup_device(pci_fixup_resume_early, pci_dev);
794
bbb44d9f
RW
795 if (drv->pm->restore_noirq)
796 error = drv->pm->restore_noirq(dev);
355a72d7 797 } else {
73410429 798 pci_pm_default_resume_noirq(pci_dev);
bbb44d9f 799 }
bbb44d9f
RW
800
801 return error;
c8958177 802}
1da177e4 803
bbb44d9f
RW
804#else /* !CONFIG_HIBERNATION */
805
806#define pci_pm_freeze NULL
807#define pci_pm_freeze_noirq NULL
808#define pci_pm_thaw NULL
809#define pci_pm_thaw_noirq NULL
810#define pci_pm_poweroff NULL
811#define pci_pm_poweroff_noirq NULL
812#define pci_pm_restore NULL
813#define pci_pm_restore_noirq NULL
814
815#endif /* !CONFIG_HIBERNATION */
816
adf09493
RW
817struct dev_pm_ops pci_dev_pm_ops = {
818 .prepare = pci_pm_prepare,
819 .complete = pci_pm_complete,
820 .suspend = pci_pm_suspend,
821 .resume = pci_pm_resume,
822 .freeze = pci_pm_freeze,
823 .thaw = pci_pm_thaw,
824 .poweroff = pci_pm_poweroff,
825 .restore = pci_pm_restore,
bbb44d9f
RW
826 .suspend_noirq = pci_pm_suspend_noirq,
827 .resume_noirq = pci_pm_resume_noirq,
828 .freeze_noirq = pci_pm_freeze_noirq,
829 .thaw_noirq = pci_pm_thaw_noirq,
830 .poweroff_noirq = pci_pm_poweroff_noirq,
831 .restore_noirq = pci_pm_restore_noirq,
832};
833
adf09493 834#define PCI_PM_OPS_PTR (&pci_dev_pm_ops)
bbb44d9f
RW
835
836#else /* !CONFIG_PM_SLEEP */
837
838#define PCI_PM_OPS_PTR NULL
839
840#endif /* !CONFIG_PM_SLEEP */
841
1da177e4 842/**
863b18f4 843 * __pci_register_driver - register a new pci driver
1da177e4 844 * @drv: the driver structure to register
863b18f4 845 * @owner: owner module of drv
f95d882d 846 * @mod_name: module name string
1da177e4
LT
847 *
848 * Adds the driver structure to the list of registered drivers.
849 * Returns a negative value on error, otherwise 0.
eaae4b3a 850 * If no error occurred, the driver remains registered even if
1da177e4
LT
851 * no device was claimed during registration.
852 */
725522b5
GKH
853int __pci_register_driver(struct pci_driver *drv, struct module *owner,
854 const char *mod_name)
1da177e4
LT
855{
856 int error;
857
858 /* initialize common driver fields */
859 drv->driver.name = drv->name;
860 drv->driver.bus = &pci_bus_type;
863b18f4 861 drv->driver.owner = owner;
725522b5 862 drv->driver.mod_name = mod_name;
50b00755 863
75865858
GKH
864 spin_lock_init(&drv->dynids.lock);
865 INIT_LIST_HEAD(&drv->dynids.list);
1da177e4
LT
866
867 /* register with core */
868 error = driver_register(&drv->driver);
50bf14b3
AM
869 if (error)
870 return error;
1da177e4 871
50bf14b3
AM
872 error = pci_create_newid_file(drv);
873 if (error)
874 driver_unregister(&drv->driver);
1da177e4
LT
875
876 return error;
877}
878
879/**
880 * pci_unregister_driver - unregister a pci driver
881 * @drv: the driver structure to unregister
882 *
883 * Deletes the driver structure from the list of registered PCI drivers,
884 * gives it a chance to clean up by calling its remove() function for
885 * each device it was responsible for, and marks those devices as
886 * driverless.
887 */
888
889void
890pci_unregister_driver(struct pci_driver *drv)
891{
03d43b19 892 pci_remove_newid_file(drv);
1da177e4
LT
893 driver_unregister(&drv->driver);
894 pci_free_dynids(drv);
895}
896
897static struct pci_driver pci_compat_driver = {
898 .name = "compat"
899};
900
901/**
902 * pci_dev_driver - get the pci_driver of a device
903 * @dev: the device to query
904 *
905 * Returns the appropriate pci_driver structure or %NULL if there is no
906 * registered driver for the device.
907 */
908struct pci_driver *
909pci_dev_driver(const struct pci_dev *dev)
910{
911 if (dev->driver)
912 return dev->driver;
913 else {
914 int i;
915 for(i=0; i<=PCI_ROM_RESOURCE; i++)
916 if (dev->resource[i].flags & IORESOURCE_BUSY)
917 return &pci_compat_driver;
918 }
919 return NULL;
920}
921
922/**
923 * pci_bus_match - Tell if a PCI device structure has a matching PCI device id structure
1da177e4 924 * @dev: the PCI device structure to match against
8f7020d3 925 * @drv: the device driver to search for matching PCI device id structures
1da177e4
LT
926 *
927 * Used by a driver to check whether a PCI device present in the
8f7020d3 928 * system is in its list of supported devices. Returns the matching
1da177e4
LT
929 * pci_device_id structure or %NULL if there is no match.
930 */
75865858 931static int pci_bus_match(struct device *dev, struct device_driver *drv)
1da177e4 932{
75865858
GKH
933 struct pci_dev *pci_dev = to_pci_dev(dev);
934 struct pci_driver *pci_drv = to_pci_driver(drv);
1da177e4
LT
935 const struct pci_device_id *found_id;
936
75865858 937 found_id = pci_match_device(pci_drv, pci_dev);
1da177e4
LT
938 if (found_id)
939 return 1;
940
75865858 941 return 0;
1da177e4
LT
942}
943
944/**
945 * pci_dev_get - increments the reference count of the pci device structure
946 * @dev: the device being referenced
947 *
948 * Each live reference to a device should be refcounted.
949 *
950 * Drivers for PCI devices should normally record such references in
951 * their probe() methods, when they bind to a device, and release
952 * them by calling pci_dev_put(), in their disconnect() methods.
953 *
954 * A pointer to the device with the incremented reference counter is returned.
955 */
956struct pci_dev *pci_dev_get(struct pci_dev *dev)
957{
958 if (dev)
959 get_device(&dev->dev);
960 return dev;
961}
962
963/**
964 * pci_dev_put - release a use of the pci device structure
965 * @dev: device that's been disconnected
966 *
967 * Must be called when a user of a device is finished with it. When the last
968 * user of the device calls this function, the memory of the device is freed.
969 */
970void pci_dev_put(struct pci_dev *dev)
971{
972 if (dev)
973 put_device(&dev->dev);
974}
975
976#ifndef CONFIG_HOTPLUG
7eff2e7a 977int pci_uevent(struct device *dev, struct kobj_uevent_env *env)
1da177e4
LT
978{
979 return -ENODEV;
980}
981#endif
982
983struct bus_type pci_bus_type = {
984 .name = "pci",
985 .match = pci_bus_match,
312c004d 986 .uevent = pci_uevent,
b15d686a
RK
987 .probe = pci_device_probe,
988 .remove = pci_device_remove,
cbd69dbb 989 .shutdown = pci_device_shutdown,
1da177e4 990 .dev_attrs = pci_dev_attrs,
bbb44d9f 991 .pm = PCI_PM_OPS_PTR,
1da177e4
LT
992};
993
994static int __init pci_driver_init(void)
995{
996 return bus_register(&pci_bus_type);
997}
998
999postcore_initcall(pci_driver_init);
1000
75865858 1001EXPORT_SYMBOL(pci_match_id);
863b18f4 1002EXPORT_SYMBOL(__pci_register_driver);
1da177e4
LT
1003EXPORT_SYMBOL(pci_unregister_driver);
1004EXPORT_SYMBOL(pci_dev_driver);
1005EXPORT_SYMBOL(pci_bus_type);
1006EXPORT_SYMBOL(pci_dev_get);
1007EXPORT_SYMBOL(pci_dev_put);