2 * drivers/pci/pci-driver.c
4 * (C) Copyright 2002-2004, 2007 Greg Kroah-Hartman <greg@kroah.com>
5 * (C) Copyright 2007 Novell Inc.
7 * Released under the GPL v2 only.
11 #include <linux/pci.h>
12 #include <linux/module.h>
13 #include <linux/init.h>
14 #include <linux/device.h>
15 #include <linux/mempolicy.h>
16 #include <linux/string.h>
17 #include <linux/slab.h>
18 #include <linux/sched.h>
19 #include <linux/cpu.h>
20 #include <linux/pm_runtime.h>
21 #include <linux/suspend.h>
25 struct list_head node
;
26 struct pci_device_id id
;
30 * pci_add_dynid - add a new PCI device ID to this driver and re-probe devices
31 * @drv: target pci driver
32 * @vendor: PCI vendor ID
33 * @device: PCI device ID
34 * @subvendor: PCI subvendor ID
35 * @subdevice: PCI subdevice ID
37 * @class_mask: PCI class mask
38 * @driver_data: private driver data
40 * Adds a new dynamic pci device ID to this driver and causes the
41 * driver to probe for all devices again. @drv must have been
42 * registered prior to calling this function.
45 * Does GFP_KERNEL allocation.
48 * 0 on success, -errno on failure.
50 int pci_add_dynid(struct pci_driver
*drv
,
51 unsigned int vendor
, unsigned int device
,
52 unsigned int subvendor
, unsigned int subdevice
,
53 unsigned int class, unsigned int class_mask
,
54 unsigned long driver_data
)
56 struct pci_dynid
*dynid
;
59 dynid
= kzalloc(sizeof(*dynid
), GFP_KERNEL
);
63 dynid
->id
.vendor
= vendor
;
64 dynid
->id
.device
= device
;
65 dynid
->id
.subvendor
= subvendor
;
66 dynid
->id
.subdevice
= subdevice
;
67 dynid
->id
.class = class;
68 dynid
->id
.class_mask
= class_mask
;
69 dynid
->id
.driver_data
= driver_data
;
71 spin_lock(&drv
->dynids
.lock
);
72 list_add_tail(&dynid
->node
, &drv
->dynids
.list
);
73 spin_unlock(&drv
->dynids
.lock
);
75 retval
= driver_attach(&drv
->driver
);
80 static void pci_free_dynids(struct pci_driver
*drv
)
82 struct pci_dynid
*dynid
, *n
;
84 spin_lock(&drv
->dynids
.lock
);
85 list_for_each_entry_safe(dynid
, n
, &drv
->dynids
.list
, node
) {
86 list_del(&dynid
->node
);
89 spin_unlock(&drv
->dynids
.lock
);
93 * Dynamic device ID manipulation via sysfs is disabled for !CONFIG_HOTPLUG
97 * store_new_id - sysfs frontend to pci_add_dynid()
98 * @driver: target device driver
99 * @buf: buffer for scanning device ID data
102 * Allow PCI IDs to be added to an existing driver via sysfs.
105 store_new_id(struct device_driver
*driver
, const char *buf
, size_t count
)
107 struct pci_driver
*pdrv
= to_pci_driver(driver
);
108 const struct pci_device_id
*ids
= pdrv
->id_table
;
109 __u32 vendor
, device
, subvendor
=PCI_ANY_ID
,
110 subdevice
=PCI_ANY_ID
, class=0, class_mask
=0;
111 unsigned long driver_data
=0;
115 fields
= sscanf(buf
, "%x %x %x %x %x %x %lx",
116 &vendor
, &device
, &subvendor
, &subdevice
,
117 &class, &class_mask
, &driver_data
);
121 /* Only accept driver_data values that match an existing id_table
125 while (ids
->vendor
|| ids
->subvendor
|| ids
->class_mask
) {
126 if (driver_data
== ids
->driver_data
) {
132 if (retval
) /* No match */
136 retval
= pci_add_dynid(pdrv
, vendor
, device
, subvendor
, subdevice
,
137 class, class_mask
, driver_data
);
142 static DRIVER_ATTR(new_id
, S_IWUSR
, NULL
, store_new_id
);
145 * store_remove_id - remove a PCI device ID from this driver
146 * @driver: target device driver
147 * @buf: buffer for scanning device ID data
150 * Removes a dynamic pci device ID to this driver.
153 store_remove_id(struct device_driver
*driver
, const char *buf
, size_t count
)
155 struct pci_dynid
*dynid
, *n
;
156 struct pci_driver
*pdrv
= to_pci_driver(driver
);
157 __u32 vendor
, device
, subvendor
= PCI_ANY_ID
,
158 subdevice
= PCI_ANY_ID
, class = 0, class_mask
= 0;
160 int retval
= -ENODEV
;
162 fields
= sscanf(buf
, "%x %x %x %x %x %x",
163 &vendor
, &device
, &subvendor
, &subdevice
,
164 &class, &class_mask
);
168 spin_lock(&pdrv
->dynids
.lock
);
169 list_for_each_entry_safe(dynid
, n
, &pdrv
->dynids
.list
, node
) {
170 struct pci_device_id
*id
= &dynid
->id
;
171 if ((id
->vendor
== vendor
) &&
172 (id
->device
== device
) &&
173 (subvendor
== PCI_ANY_ID
|| id
->subvendor
== subvendor
) &&
174 (subdevice
== PCI_ANY_ID
|| id
->subdevice
== subdevice
) &&
175 !((id
->class ^ class) & class_mask
)) {
176 list_del(&dynid
->node
);
182 spin_unlock(&pdrv
->dynids
.lock
);
188 static DRIVER_ATTR(remove_id
, S_IWUSR
, NULL
, store_remove_id
);
191 pci_create_newid_files(struct pci_driver
*drv
)
195 if (drv
->probe
!= NULL
) {
196 error
= driver_create_file(&drv
->driver
, &driver_attr_new_id
);
198 error
= driver_create_file(&drv
->driver
,
199 &driver_attr_remove_id
);
201 driver_remove_file(&drv
->driver
,
202 &driver_attr_new_id
);
208 static void pci_remove_newid_files(struct pci_driver
*drv
)
210 driver_remove_file(&drv
->driver
, &driver_attr_remove_id
);
211 driver_remove_file(&drv
->driver
, &driver_attr_new_id
);
213 #else /* !CONFIG_HOTPLUG */
214 static inline int pci_create_newid_files(struct pci_driver
*drv
)
218 static inline void pci_remove_newid_files(struct pci_driver
*drv
) {}
222 * pci_match_id - See if a pci device matches a given pci_id table
223 * @ids: array of PCI device id structures to search in
224 * @dev: the PCI device structure to match against.
226 * Used by a driver to check whether a PCI device present in the
227 * system is in its list of supported devices. Returns the matching
228 * pci_device_id structure or %NULL if there is no match.
230 * Deprecated, don't use this as it will not catch any dynamic ids
231 * that a driver might want to check for.
233 const struct pci_device_id
*pci_match_id(const struct pci_device_id
*ids
,
237 while (ids
->vendor
|| ids
->subvendor
|| ids
->class_mask
) {
238 if (pci_match_one_device(ids
, dev
))
247 * pci_match_device - Tell if a PCI device structure has a matching PCI device id structure
248 * @drv: the PCI driver to match against
249 * @dev: the PCI device structure to match against
251 * Used by a driver to check whether a PCI device present in the
252 * system is in its list of supported devices. Returns the matching
253 * pci_device_id structure or %NULL if there is no match.
255 static const struct pci_device_id
*pci_match_device(struct pci_driver
*drv
,
258 struct pci_dynid
*dynid
;
260 /* Look at the dynamic ids first, before the static ones */
261 spin_lock(&drv
->dynids
.lock
);
262 list_for_each_entry(dynid
, &drv
->dynids
.list
, node
) {
263 if (pci_match_one_device(&dynid
->id
, dev
)) {
264 spin_unlock(&drv
->dynids
.lock
);
268 spin_unlock(&drv
->dynids
.lock
);
270 return pci_match_id(drv
->id_table
, dev
);
273 struct drv_dev_and_id
{
274 struct pci_driver
*drv
;
276 const struct pci_device_id
*id
;
279 static long local_pci_probe(void *_ddi
)
281 struct drv_dev_and_id
*ddi
= _ddi
;
282 struct device
*dev
= &ddi
->dev
->dev
;
285 /* Unbound PCI devices are always set to disabled and suspended.
286 * During probe, the device is set to enabled and active and the
287 * usage count is incremented. If the driver supports runtime PM,
288 * it should call pm_runtime_put_noidle() in its probe routine and
289 * pm_runtime_get_noresume() in its remove routine.
291 pm_runtime_get_noresume(dev
);
292 pm_runtime_set_active(dev
);
293 pm_runtime_enable(dev
);
295 rc
= ddi
->drv
->probe(ddi
->dev
, ddi
->id
);
297 pm_runtime_disable(dev
);
298 pm_runtime_set_suspended(dev
);
299 pm_runtime_put_noidle(dev
);
304 static int pci_call_probe(struct pci_driver
*drv
, struct pci_dev
*dev
,
305 const struct pci_device_id
*id
)
308 struct drv_dev_and_id ddi
= { drv
, dev
, id
};
310 /* Execute driver initialization on node where the device's
311 bus is attached to. This way the driver likely allocates
312 its local memory on the right node without any need to
314 node
= dev_to_node(&dev
->dev
);
319 cpu
= cpumask_any_and(cpumask_of_node(node
), cpu_online_mask
);
320 if (cpu
< nr_cpu_ids
)
321 error
= work_on_cpu(cpu
, local_pci_probe
, &ddi
);
323 error
= local_pci_probe(&ddi
);
326 error
= local_pci_probe(&ddi
);
331 * __pci_device_probe - check if a driver wants to claim a specific PCI device
332 * @drv: driver to call to check if it wants the PCI device
333 * @pci_dev: PCI device being probed
335 * returns 0 on success, else error.
336 * side-effect: pci_dev->driver is set to drv when drv claims pci_dev.
339 __pci_device_probe(struct pci_driver
*drv
, struct pci_dev
*pci_dev
)
341 const struct pci_device_id
*id
;
344 if (!pci_dev
->driver
&& drv
->probe
) {
347 id
= pci_match_device(drv
, pci_dev
);
349 error
= pci_call_probe(drv
, pci_dev
, id
);
351 pci_dev
->driver
= drv
;
358 static int pci_device_probe(struct device
* dev
)
361 struct pci_driver
*drv
;
362 struct pci_dev
*pci_dev
;
364 drv
= to_pci_driver(dev
->driver
);
365 pci_dev
= to_pci_dev(dev
);
366 pci_dev_get(pci_dev
);
367 error
= __pci_device_probe(drv
, pci_dev
);
369 pci_dev_put(pci_dev
);
374 static int pci_device_remove(struct device
* dev
)
376 struct pci_dev
* pci_dev
= to_pci_dev(dev
);
377 struct pci_driver
* drv
= pci_dev
->driver
;
381 pm_runtime_get_sync(dev
);
382 drv
->remove(pci_dev
);
383 pm_runtime_put_noidle(dev
);
385 pci_dev
->driver
= NULL
;
388 /* Undo the runtime PM settings in local_pci_probe() */
389 pm_runtime_disable(dev
);
390 pm_runtime_set_suspended(dev
);
391 pm_runtime_put_noidle(dev
);
394 * If the device is still on, set the power state as "unknown",
395 * since it might change by the next time we load the driver.
397 if (pci_dev
->current_state
== PCI_D0
)
398 pci_dev
->current_state
= PCI_UNKNOWN
;
401 * We would love to complain here if pci_dev->is_enabled is set, that
402 * the driver should have called pci_disable_device(), but the
403 * unfortunate fact is there are too many odd BIOS and bridge setups
404 * that don't like drivers doing that all of the time.
405 * Oh well, we can dream of sane hardware when we sleep, no matter how
406 * horrible the crap we have to deal with is when we are awake...
409 pci_dev_put(pci_dev
);
413 static void pci_device_shutdown(struct device
*dev
)
415 struct pci_dev
*pci_dev
= to_pci_dev(dev
);
416 struct pci_driver
*drv
= pci_dev
->driver
;
418 if (drv
&& drv
->shutdown
)
419 drv
->shutdown(pci_dev
);
420 pci_msi_shutdown(pci_dev
);
421 pci_msix_shutdown(pci_dev
);
424 * Turn off Bus Master bit on the device to tell it to not
427 pci_disable_device(pci_dev
);
430 * Devices may be enabled to wake up by runtime PM, but they need not
431 * be supposed to wake up the system from its "power off" state (e.g.
432 * ACPI S5). Therefore disable wakeup for all devices that aren't
433 * supposed to wake up the system at this point. The state argument
434 * will be ignored by pci_enable_wake().
436 if (!device_may_wakeup(dev
))
437 pci_enable_wake(pci_dev
, PCI_UNKNOWN
, false);
442 /* Auxiliary functions used for system resume and run-time resume. */
445 * pci_restore_standard_config - restore standard config registers of PCI device
446 * @pci_dev: PCI device to handle
448 static int pci_restore_standard_config(struct pci_dev
*pci_dev
)
450 pci_update_current_state(pci_dev
, PCI_UNKNOWN
);
452 if (pci_dev
->current_state
!= PCI_D0
) {
453 int error
= pci_set_power_state(pci_dev
, PCI_D0
);
458 pci_restore_state(pci_dev
);
462 static void pci_pm_default_resume_early(struct pci_dev
*pci_dev
)
464 pci_restore_standard_config(pci_dev
);
465 pci_fixup_device(pci_fixup_resume_early
, pci_dev
);
470 #ifdef CONFIG_PM_SLEEP
473 * Default "suspend" method for devices that have no driver provided suspend,
474 * or not even a driver at all (second part).
476 static void pci_pm_set_unknown_state(struct pci_dev
*pci_dev
)
479 * mark its power state as "unknown", since we don't know if
480 * e.g. the BIOS will change its device state when we suspend.
482 if (pci_dev
->current_state
== PCI_D0
)
483 pci_dev
->current_state
= PCI_UNKNOWN
;
487 * Default "resume" method for devices that have no driver provided resume,
488 * or not even a driver at all (second part).
490 static int pci_pm_reenable_device(struct pci_dev
*pci_dev
)
494 /* if the device was enabled before suspend, reenable */
495 retval
= pci_reenable_device(pci_dev
);
497 * if the device was busmaster before the suspend, make it busmaster
500 if (pci_dev
->is_busmaster
)
501 pci_set_master(pci_dev
);
506 static int pci_legacy_suspend(struct device
*dev
, pm_message_t state
)
508 struct pci_dev
* pci_dev
= to_pci_dev(dev
);
509 struct pci_driver
* drv
= pci_dev
->driver
;
511 if (drv
&& drv
->suspend
) {
512 pci_power_t prev
= pci_dev
->current_state
;
515 error
= drv
->suspend(pci_dev
, state
);
516 suspend_report_result(drv
->suspend
, error
);
520 if (!pci_dev
->state_saved
&& pci_dev
->current_state
!= PCI_D0
521 && pci_dev
->current_state
!= PCI_UNKNOWN
) {
522 WARN_ONCE(pci_dev
->current_state
!= prev
,
523 "PCI PM: Device state not saved by %pF\n",
528 pci_fixup_device(pci_fixup_suspend
, pci_dev
);
533 static int pci_legacy_suspend_late(struct device
*dev
, pm_message_t state
)
535 struct pci_dev
* pci_dev
= to_pci_dev(dev
);
536 struct pci_driver
* drv
= pci_dev
->driver
;
538 if (drv
&& drv
->suspend_late
) {
539 pci_power_t prev
= pci_dev
->current_state
;
542 error
= drv
->suspend_late(pci_dev
, state
);
543 suspend_report_result(drv
->suspend_late
, error
);
547 if (!pci_dev
->state_saved
&& pci_dev
->current_state
!= PCI_D0
548 && pci_dev
->current_state
!= PCI_UNKNOWN
) {
549 WARN_ONCE(pci_dev
->current_state
!= prev
,
550 "PCI PM: Device state not saved by %pF\n",
556 if (!pci_dev
->state_saved
)
557 pci_save_state(pci_dev
);
559 pci_pm_set_unknown_state(pci_dev
);
564 static int pci_legacy_resume_early(struct device
*dev
)
566 struct pci_dev
* pci_dev
= to_pci_dev(dev
);
567 struct pci_driver
* drv
= pci_dev
->driver
;
569 return drv
&& drv
->resume_early
?
570 drv
->resume_early(pci_dev
) : 0;
573 static int pci_legacy_resume(struct device
*dev
)
575 struct pci_dev
* pci_dev
= to_pci_dev(dev
);
576 struct pci_driver
* drv
= pci_dev
->driver
;
578 pci_fixup_device(pci_fixup_resume
, pci_dev
);
580 return drv
&& drv
->resume
?
581 drv
->resume(pci_dev
) : pci_pm_reenable_device(pci_dev
);
584 /* Auxiliary functions used by the new power management framework */
586 static void pci_pm_default_resume(struct pci_dev
*pci_dev
)
588 pci_fixup_device(pci_fixup_resume
, pci_dev
);
590 if (!pci_is_bridge(pci_dev
))
591 pci_enable_wake(pci_dev
, PCI_D0
, false);
594 static void pci_pm_default_suspend(struct pci_dev
*pci_dev
)
596 /* Disable non-bridge devices without PM support */
597 if (!pci_is_bridge(pci_dev
))
598 pci_disable_enabled_device(pci_dev
);
601 static bool pci_has_legacy_pm_support(struct pci_dev
*pci_dev
)
603 struct pci_driver
*drv
= pci_dev
->driver
;
604 bool ret
= drv
&& (drv
->suspend
|| drv
->suspend_late
|| drv
->resume
605 || drv
->resume_early
);
608 * Legacy PM support is used by default, so warn if the new framework is
609 * supported as well. Drivers are supposed to support either the
610 * former, or the latter, but not both at the same time.
612 WARN(ret
&& drv
->driver
.pm
, "driver %s device %04x:%04x\n",
613 drv
->name
, pci_dev
->vendor
, pci_dev
->device
);
618 /* New power management framework */
620 static int pci_pm_prepare(struct device
*dev
)
622 struct device_driver
*drv
= dev
->driver
;
626 * If a PCI device configured to wake up the system from sleep states
627 * has been suspended at run time and there's a resume request pending
628 * for it, this is equivalent to the device signaling wakeup, so the
629 * system suspend operation should be aborted.
631 pm_runtime_get_noresume(dev
);
632 if (pm_runtime_barrier(dev
) && device_may_wakeup(dev
))
633 pm_wakeup_event(dev
, 0);
635 if (pm_wakeup_pending()) {
636 pm_runtime_put_sync(dev
);
641 * PCI devices suspended at run time need to be resumed at this
642 * point, because in general it is necessary to reconfigure them for
643 * system suspend. Namely, if the device is supposed to wake up the
644 * system from the sleep state, we may need to reconfigure it for this
645 * purpose. In turn, if the device is not supposed to wake up the
646 * system from the sleep state, we'll have to prevent it from signaling
649 pm_runtime_resume(dev
);
651 if (drv
&& drv
->pm
&& drv
->pm
->prepare
)
652 error
= drv
->pm
->prepare(dev
);
657 static void pci_pm_complete(struct device
*dev
)
659 struct device_driver
*drv
= dev
->driver
;
661 if (drv
&& drv
->pm
&& drv
->pm
->complete
)
662 drv
->pm
->complete(dev
);
664 pm_runtime_put_sync(dev
);
667 #else /* !CONFIG_PM_SLEEP */
669 #define pci_pm_prepare NULL
670 #define pci_pm_complete NULL
672 #endif /* !CONFIG_PM_SLEEP */
674 #ifdef CONFIG_SUSPEND
676 static int pci_pm_suspend(struct device
*dev
)
678 struct pci_dev
*pci_dev
= to_pci_dev(dev
);
679 const struct dev_pm_ops
*pm
= dev
->driver
? dev
->driver
->pm
: NULL
;
681 if (pci_has_legacy_pm_support(pci_dev
))
682 return pci_legacy_suspend(dev
, PMSG_SUSPEND
);
685 pci_pm_default_suspend(pci_dev
);
690 pci_power_t prev
= pci_dev
->current_state
;
693 error
= pm
->suspend(dev
);
694 suspend_report_result(pm
->suspend
, error
);
698 if (!pci_dev
->state_saved
&& pci_dev
->current_state
!= PCI_D0
699 && pci_dev
->current_state
!= PCI_UNKNOWN
) {
700 WARN_ONCE(pci_dev
->current_state
!= prev
,
701 "PCI PM: State of device not saved by %pF\n",
707 pci_fixup_device(pci_fixup_suspend
, pci_dev
);
712 static int pci_pm_suspend_noirq(struct device
*dev
)
714 struct pci_dev
*pci_dev
= to_pci_dev(dev
);
715 const struct dev_pm_ops
*pm
= dev
->driver
? dev
->driver
->pm
: NULL
;
717 if (pci_has_legacy_pm_support(pci_dev
))
718 return pci_legacy_suspend_late(dev
, PMSG_SUSPEND
);
721 pci_save_state(pci_dev
);
725 if (pm
->suspend_noirq
) {
726 pci_power_t prev
= pci_dev
->current_state
;
729 error
= pm
->suspend_noirq(dev
);
730 suspend_report_result(pm
->suspend_noirq
, error
);
734 if (!pci_dev
->state_saved
&& pci_dev
->current_state
!= PCI_D0
735 && pci_dev
->current_state
!= PCI_UNKNOWN
) {
736 WARN_ONCE(pci_dev
->current_state
!= prev
,
737 "PCI PM: State of device not saved by %pF\n",
743 if (!pci_dev
->state_saved
) {
744 pci_save_state(pci_dev
);
745 if (!pci_is_bridge(pci_dev
))
746 pci_prepare_to_sleep(pci_dev
);
749 pci_pm_set_unknown_state(pci_dev
);
752 * Some BIOSes from ASUS have a bug: If a USB EHCI host controller's
753 * PCI COMMAND register isn't 0, the BIOS assumes that the controller
754 * hasn't been quiesced and tries to turn it off. If the controller
755 * is already in D3, this can hang or cause memory corruption.
757 * Since the value of the COMMAND register doesn't matter once the
758 * device has been suspended, we can safely set it to 0 here.
760 if (pci_dev
->class == PCI_CLASS_SERIAL_USB_EHCI
)
761 pci_write_config_word(pci_dev
, PCI_COMMAND
, 0);
766 static int pci_pm_resume_noirq(struct device
*dev
)
768 struct pci_dev
*pci_dev
= to_pci_dev(dev
);
769 struct device_driver
*drv
= dev
->driver
;
772 pci_pm_default_resume_early(pci_dev
);
774 if (pci_has_legacy_pm_support(pci_dev
))
775 return pci_legacy_resume_early(dev
);
777 if (drv
&& drv
->pm
&& drv
->pm
->resume_noirq
)
778 error
= drv
->pm
->resume_noirq(dev
);
783 static int pci_pm_resume(struct device
*dev
)
785 struct pci_dev
*pci_dev
= to_pci_dev(dev
);
786 const struct dev_pm_ops
*pm
= dev
->driver
? dev
->driver
->pm
: NULL
;
790 * This is necessary for the suspend error path in which resume is
791 * called without restoring the standard config registers of the device.
793 if (pci_dev
->state_saved
)
794 pci_restore_standard_config(pci_dev
);
796 if (pci_has_legacy_pm_support(pci_dev
))
797 return pci_legacy_resume(dev
);
799 pci_pm_default_resume(pci_dev
);
803 error
= pm
->resume(dev
);
805 pci_pm_reenable_device(pci_dev
);
811 #else /* !CONFIG_SUSPEND */
813 #define pci_pm_suspend NULL
814 #define pci_pm_suspend_noirq NULL
815 #define pci_pm_resume NULL
816 #define pci_pm_resume_noirq NULL
818 #endif /* !CONFIG_SUSPEND */
820 #ifdef CONFIG_HIBERNATE_CALLBACKS
822 static int pci_pm_freeze(struct device
*dev
)
824 struct pci_dev
*pci_dev
= to_pci_dev(dev
);
825 const struct dev_pm_ops
*pm
= dev
->driver
? dev
->driver
->pm
: NULL
;
827 if (pci_has_legacy_pm_support(pci_dev
))
828 return pci_legacy_suspend(dev
, PMSG_FREEZE
);
831 pci_pm_default_suspend(pci_dev
);
838 error
= pm
->freeze(dev
);
839 suspend_report_result(pm
->freeze
, error
);
847 static int pci_pm_freeze_noirq(struct device
*dev
)
849 struct pci_dev
*pci_dev
= to_pci_dev(dev
);
850 struct device_driver
*drv
= dev
->driver
;
852 if (pci_has_legacy_pm_support(pci_dev
))
853 return pci_legacy_suspend_late(dev
, PMSG_FREEZE
);
855 if (drv
&& drv
->pm
&& drv
->pm
->freeze_noirq
) {
858 error
= drv
->pm
->freeze_noirq(dev
);
859 suspend_report_result(drv
->pm
->freeze_noirq
, error
);
864 if (!pci_dev
->state_saved
)
865 pci_save_state(pci_dev
);
867 pci_pm_set_unknown_state(pci_dev
);
872 static int pci_pm_thaw_noirq(struct device
*dev
)
874 struct pci_dev
*pci_dev
= to_pci_dev(dev
);
875 struct device_driver
*drv
= dev
->driver
;
878 if (pci_has_legacy_pm_support(pci_dev
))
879 return pci_legacy_resume_early(dev
);
881 pci_update_current_state(pci_dev
, PCI_D0
);
883 if (drv
&& drv
->pm
&& drv
->pm
->thaw_noirq
)
884 error
= drv
->pm
->thaw_noirq(dev
);
889 static int pci_pm_thaw(struct device
*dev
)
891 struct pci_dev
*pci_dev
= to_pci_dev(dev
);
892 const struct dev_pm_ops
*pm
= dev
->driver
? dev
->driver
->pm
: NULL
;
895 if (pci_has_legacy_pm_support(pci_dev
))
896 return pci_legacy_resume(dev
);
900 error
= pm
->thaw(dev
);
902 pci_pm_reenable_device(pci_dev
);
905 pci_dev
->state_saved
= false;
910 static int pci_pm_poweroff(struct device
*dev
)
912 struct pci_dev
*pci_dev
= to_pci_dev(dev
);
913 const struct dev_pm_ops
*pm
= dev
->driver
? dev
->driver
->pm
: NULL
;
915 if (pci_has_legacy_pm_support(pci_dev
))
916 return pci_legacy_suspend(dev
, PMSG_HIBERNATE
);
919 pci_pm_default_suspend(pci_dev
);
926 error
= pm
->poweroff(dev
);
927 suspend_report_result(pm
->poweroff
, error
);
933 pci_fixup_device(pci_fixup_suspend
, pci_dev
);
938 static int pci_pm_poweroff_noirq(struct device
*dev
)
940 struct pci_dev
*pci_dev
= to_pci_dev(dev
);
941 struct device_driver
*drv
= dev
->driver
;
943 if (pci_has_legacy_pm_support(to_pci_dev(dev
)))
944 return pci_legacy_suspend_late(dev
, PMSG_HIBERNATE
);
946 if (!drv
|| !drv
->pm
)
949 if (drv
->pm
->poweroff_noirq
) {
952 error
= drv
->pm
->poweroff_noirq(dev
);
953 suspend_report_result(drv
->pm
->poweroff_noirq
, error
);
958 if (!pci_dev
->state_saved
&& !pci_is_bridge(pci_dev
))
959 pci_prepare_to_sleep(pci_dev
);
964 static int pci_pm_restore_noirq(struct device
*dev
)
966 struct pci_dev
*pci_dev
= to_pci_dev(dev
);
967 struct device_driver
*drv
= dev
->driver
;
970 pci_pm_default_resume_early(pci_dev
);
972 if (pci_has_legacy_pm_support(pci_dev
))
973 return pci_legacy_resume_early(dev
);
975 if (drv
&& drv
->pm
&& drv
->pm
->restore_noirq
)
976 error
= drv
->pm
->restore_noirq(dev
);
981 static int pci_pm_restore(struct device
*dev
)
983 struct pci_dev
*pci_dev
= to_pci_dev(dev
);
984 const struct dev_pm_ops
*pm
= dev
->driver
? dev
->driver
->pm
: NULL
;
988 * This is necessary for the hibernation error path in which restore is
989 * called without restoring the standard config registers of the device.
991 if (pci_dev
->state_saved
)
992 pci_restore_standard_config(pci_dev
);
994 if (pci_has_legacy_pm_support(pci_dev
))
995 return pci_legacy_resume(dev
);
997 pci_pm_default_resume(pci_dev
);
1001 error
= pm
->restore(dev
);
1003 pci_pm_reenable_device(pci_dev
);
1009 #else /* !CONFIG_HIBERNATE_CALLBACKS */
1011 #define pci_pm_freeze NULL
1012 #define pci_pm_freeze_noirq NULL
1013 #define pci_pm_thaw NULL
1014 #define pci_pm_thaw_noirq NULL
1015 #define pci_pm_poweroff NULL
1016 #define pci_pm_poweroff_noirq NULL
1017 #define pci_pm_restore NULL
1018 #define pci_pm_restore_noirq NULL
1020 #endif /* !CONFIG_HIBERNATE_CALLBACKS */
1022 #ifdef CONFIG_PM_RUNTIME
1024 static int pci_pm_runtime_suspend(struct device
*dev
)
1026 struct pci_dev
*pci_dev
= to_pci_dev(dev
);
1027 const struct dev_pm_ops
*pm
= dev
->driver
? dev
->driver
->pm
: NULL
;
1028 pci_power_t prev
= pci_dev
->current_state
;
1031 if (!pm
|| !pm
->runtime_suspend
)
1034 error
= pm
->runtime_suspend(dev
);
1035 suspend_report_result(pm
->runtime_suspend
, error
);
1039 pci_fixup_device(pci_fixup_suspend
, pci_dev
);
1041 if (!pci_dev
->state_saved
&& pci_dev
->current_state
!= PCI_D0
1042 && pci_dev
->current_state
!= PCI_UNKNOWN
) {
1043 WARN_ONCE(pci_dev
->current_state
!= prev
,
1044 "PCI PM: State of device not saved by %pF\n",
1045 pm
->runtime_suspend
);
1049 if (!pci_dev
->state_saved
)
1050 pci_save_state(pci_dev
);
1052 pci_finish_runtime_suspend(pci_dev
);
1057 static int pci_pm_runtime_resume(struct device
*dev
)
1059 struct pci_dev
*pci_dev
= to_pci_dev(dev
);
1060 const struct dev_pm_ops
*pm
= dev
->driver
? dev
->driver
->pm
: NULL
;
1062 if (!pm
|| !pm
->runtime_resume
)
1065 pci_pm_default_resume_early(pci_dev
);
1066 __pci_enable_wake(pci_dev
, PCI_D0
, true, false);
1067 pci_fixup_device(pci_fixup_resume
, pci_dev
);
1069 return pm
->runtime_resume(dev
);
1072 static int pci_pm_runtime_idle(struct device
*dev
)
1074 const struct dev_pm_ops
*pm
= dev
->driver
? dev
->driver
->pm
: NULL
;
1079 if (pm
->runtime_idle
) {
1080 int ret
= pm
->runtime_idle(dev
);
1085 pm_runtime_suspend(dev
);
1090 #else /* !CONFIG_PM_RUNTIME */
1092 #define pci_pm_runtime_suspend NULL
1093 #define pci_pm_runtime_resume NULL
1094 #define pci_pm_runtime_idle NULL
1096 #endif /* !CONFIG_PM_RUNTIME */
1100 const struct dev_pm_ops pci_dev_pm_ops
= {
1101 .prepare
= pci_pm_prepare
,
1102 .complete
= pci_pm_complete
,
1103 .suspend
= pci_pm_suspend
,
1104 .resume
= pci_pm_resume
,
1105 .freeze
= pci_pm_freeze
,
1106 .thaw
= pci_pm_thaw
,
1107 .poweroff
= pci_pm_poweroff
,
1108 .restore
= pci_pm_restore
,
1109 .suspend_noirq
= pci_pm_suspend_noirq
,
1110 .resume_noirq
= pci_pm_resume_noirq
,
1111 .freeze_noirq
= pci_pm_freeze_noirq
,
1112 .thaw_noirq
= pci_pm_thaw_noirq
,
1113 .poweroff_noirq
= pci_pm_poweroff_noirq
,
1114 .restore_noirq
= pci_pm_restore_noirq
,
1115 .runtime_suspend
= pci_pm_runtime_suspend
,
1116 .runtime_resume
= pci_pm_runtime_resume
,
1117 .runtime_idle
= pci_pm_runtime_idle
,
1120 #define PCI_PM_OPS_PTR (&pci_dev_pm_ops)
1122 #else /* !COMFIG_PM_OPS */
1124 #define PCI_PM_OPS_PTR NULL
1126 #endif /* !COMFIG_PM_OPS */
1129 * __pci_register_driver - register a new pci driver
1130 * @drv: the driver structure to register
1131 * @owner: owner module of drv
1132 * @mod_name: module name string
1134 * Adds the driver structure to the list of registered drivers.
1135 * Returns a negative value on error, otherwise 0.
1136 * If no error occurred, the driver remains registered even if
1137 * no device was claimed during registration.
1139 int __pci_register_driver(struct pci_driver
*drv
, struct module
*owner
,
1140 const char *mod_name
)
1144 /* initialize common driver fields */
1145 drv
->driver
.name
= drv
->name
;
1146 drv
->driver
.bus
= &pci_bus_type
;
1147 drv
->driver
.owner
= owner
;
1148 drv
->driver
.mod_name
= mod_name
;
1150 spin_lock_init(&drv
->dynids
.lock
);
1151 INIT_LIST_HEAD(&drv
->dynids
.list
);
1153 /* register with core */
1154 error
= driver_register(&drv
->driver
);
1158 error
= pci_create_newid_files(drv
);
1165 driver_unregister(&drv
->driver
);
1170 * pci_unregister_driver - unregister a pci driver
1171 * @drv: the driver structure to unregister
1173 * Deletes the driver structure from the list of registered PCI drivers,
1174 * gives it a chance to clean up by calling its remove() function for
1175 * each device it was responsible for, and marks those devices as
1180 pci_unregister_driver(struct pci_driver
*drv
)
1182 pci_remove_newid_files(drv
);
1183 driver_unregister(&drv
->driver
);
1184 pci_free_dynids(drv
);
1187 static struct pci_driver pci_compat_driver
= {
1192 * pci_dev_driver - get the pci_driver of a device
1193 * @dev: the device to query
1195 * Returns the appropriate pci_driver structure or %NULL if there is no
1196 * registered driver for the device.
1199 pci_dev_driver(const struct pci_dev
*dev
)
1205 for(i
=0; i
<=PCI_ROM_RESOURCE
; i
++)
1206 if (dev
->resource
[i
].flags
& IORESOURCE_BUSY
)
1207 return &pci_compat_driver
;
1213 * pci_bus_match - Tell if a PCI device structure has a matching PCI device id structure
1214 * @dev: the PCI device structure to match against
1215 * @drv: the device driver to search for matching PCI device id structures
1217 * Used by a driver to check whether a PCI device present in the
1218 * system is in its list of supported devices. Returns the matching
1219 * pci_device_id structure or %NULL if there is no match.
1221 static int pci_bus_match(struct device
*dev
, struct device_driver
*drv
)
1223 struct pci_dev
*pci_dev
= to_pci_dev(dev
);
1224 struct pci_driver
*pci_drv
= to_pci_driver(drv
);
1225 const struct pci_device_id
*found_id
;
1227 found_id
= pci_match_device(pci_drv
, pci_dev
);
1235 * pci_dev_get - increments the reference count of the pci device structure
1236 * @dev: the device being referenced
1238 * Each live reference to a device should be refcounted.
1240 * Drivers for PCI devices should normally record such references in
1241 * their probe() methods, when they bind to a device, and release
1242 * them by calling pci_dev_put(), in their disconnect() methods.
1244 * A pointer to the device with the incremented reference counter is returned.
1246 struct pci_dev
*pci_dev_get(struct pci_dev
*dev
)
1249 get_device(&dev
->dev
);
1254 * pci_dev_put - release a use of the pci device structure
1255 * @dev: device that's been disconnected
1257 * Must be called when a user of a device is finished with it. When the last
1258 * user of the device calls this function, the memory of the device is freed.
1260 void pci_dev_put(struct pci_dev
*dev
)
1263 put_device(&dev
->dev
);
1266 #ifndef CONFIG_HOTPLUG
1267 int pci_uevent(struct device
*dev
, struct kobj_uevent_env
*env
)
1273 struct bus_type pci_bus_type
= {
1275 .match
= pci_bus_match
,
1276 .uevent
= pci_uevent
,
1277 .probe
= pci_device_probe
,
1278 .remove
= pci_device_remove
,
1279 .shutdown
= pci_device_shutdown
,
1280 .dev_attrs
= pci_dev_attrs
,
1281 .bus_attrs
= pci_bus_attrs
,
1282 .pm
= PCI_PM_OPS_PTR
,
1285 static int __init
pci_driver_init(void)
1287 return bus_register(&pci_bus_type
);
1290 postcore_initcall(pci_driver_init
);
1292 EXPORT_SYMBOL_GPL(pci_add_dynid
);
1293 EXPORT_SYMBOL(pci_match_id
);
1294 EXPORT_SYMBOL(__pci_register_driver
);
1295 EXPORT_SYMBOL(pci_unregister_driver
);
1296 EXPORT_SYMBOL(pci_dev_driver
);
1297 EXPORT_SYMBOL(pci_bus_type
);
1298 EXPORT_SYMBOL(pci_dev_get
);
1299 EXPORT_SYMBOL(pci_dev_put
);