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