PCI PM: Add suspend counterpart of pci_reenable_device
[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
355a72d7
RW
317static bool pci_has_legacy_pm_support(struct pci_dev *pci_dev)
318{
319 struct pci_driver *drv = pci_dev->driver;
320
321 return drv && (drv->suspend || drv->suspend_late || drv->resume
322 || drv->resume_early);
323}
324
bbb44d9f
RW
325/*
326 * Default "suspend" method for devices that have no driver provided suspend,
fa58d305
RW
327 * or not even a driver at all (first part).
328 */
329static void pci_default_pm_suspend_early(struct pci_dev *pci_dev)
330{
331 /* If device is enabled at this point, disable it */
332 pci_disable_enabled_device(pci_dev);
333}
334
335/*
336 * Default "suspend" method for devices that have no driver provided suspend,
337 * or not even a driver at all (second part).
bbb44d9f 338 */
fa58d305 339static void pci_default_pm_suspend_late(struct pci_dev *pci_dev)
bbb44d9f
RW
340{
341 pci_save_state(pci_dev);
342 /*
343 * mark its power state as "unknown", since we don't know if
344 * e.g. the BIOS will change its device state when we suspend.
345 */
346 if (pci_dev->current_state == PCI_D0)
347 pci_dev->current_state = PCI_UNKNOWN;
348}
349
350/*
351 * Default "resume" method for devices that have no driver provided resume,
355a72d7 352 * or not even a driver at all (first part).
bbb44d9f 353 */
355a72d7 354static void pci_default_pm_resume_early(struct pci_dev *pci_dev)
bbb44d9f 355{
bbb44d9f
RW
356 /* restore the PCI config space */
357 pci_restore_state(pci_dev);
355a72d7
RW
358}
359
360/*
361 * Default "resume" method for devices that have no driver provided resume,
362 * or not even a driver at all (second part).
363 */
364static int pci_default_pm_resume_late(struct pci_dev *pci_dev)
365{
366 int retval;
367
bbb44d9f
RW
368 /* if the device was enabled before suspend, reenable */
369 retval = pci_reenable_device(pci_dev);
370 /*
371 * if the device was busmaster before the suspend, make it busmaster
372 * again
373 */
374 if (pci_dev->is_busmaster)
375 pci_set_master(pci_dev);
376
377 return retval;
378}
379
380static int pci_legacy_suspend(struct device *dev, pm_message_t state)
1da177e4
LT
381{
382 struct pci_dev * pci_dev = to_pci_dev(dev);
383 struct pci_driver * drv = pci_dev->driver;
384 int i = 0;
385
02669492 386 if (drv && drv->suspend) {
1da177e4 387 i = drv->suspend(pci_dev, state);
02669492
AM
388 suspend_report_result(drv->suspend, i);
389 } else {
fa58d305
RW
390 /*
391 * For compatibility with existing code with legacy PM support
392 * don't call pci_default_pm_suspend_early() here.
393 */
394 pci_default_pm_suspend_late(pci_dev);
02669492 395 }
1da177e4
LT
396 return i;
397}
398
bbb44d9f 399static int pci_legacy_suspend_late(struct device *dev, pm_message_t state)
cbd69dbb
LT
400{
401 struct pci_dev * pci_dev = to_pci_dev(dev);
402 struct pci_driver * drv = pci_dev->driver;
403 int i = 0;
404
405 if (drv && drv->suspend_late) {
406 i = drv->suspend_late(pci_dev, state);
407 suspend_report_result(drv->suspend_late, i);
408 }
409 return i;
410}
1da177e4 411
bbb44d9f 412static int pci_legacy_resume(struct device *dev)
1da177e4 413{
8d92bc22 414 int error;
1da177e4
LT
415 struct pci_dev * pci_dev = to_pci_dev(dev);
416 struct pci_driver * drv = pci_dev->driver;
417
355a72d7 418 if (drv && drv->resume) {
8d92bc22 419 error = drv->resume(pci_dev);
355a72d7
RW
420 } else {
421 pci_default_pm_resume_early(pci_dev);
422 error = pci_default_pm_resume_late(pci_dev);
423 }
8d92bc22 424 return error;
1da177e4
LT
425}
426
bbb44d9f 427static int pci_legacy_resume_early(struct device *dev)
cbd69dbb
LT
428{
429 int error = 0;
430 struct pci_dev * pci_dev = to_pci_dev(dev);
431 struct pci_driver * drv = pci_dev->driver;
432
433 if (drv && drv->resume_early)
434 error = drv->resume_early(pci_dev);
435 return error;
436}
437
bbb44d9f
RW
438static int pci_pm_prepare(struct device *dev)
439{
440 struct device_driver *drv = dev->driver;
441 int error = 0;
442
443 if (drv && drv->pm && drv->pm->prepare)
444 error = drv->pm->prepare(dev);
445
446 return error;
447}
448
449static void pci_pm_complete(struct device *dev)
450{
451 struct device_driver *drv = dev->driver;
452
453 if (drv && drv->pm && drv->pm->complete)
454 drv->pm->complete(dev);
455}
456
457#ifdef CONFIG_SUSPEND
458
459static int pci_pm_suspend(struct device *dev)
460{
461 struct pci_dev *pci_dev = to_pci_dev(dev);
462 struct device_driver *drv = dev->driver;
463 int error = 0;
464
465 if (drv && drv->pm) {
466 if (drv->pm->suspend) {
467 error = drv->pm->suspend(dev);
468 suspend_report_result(drv->pm->suspend, error);
bbb44d9f 469 }
355a72d7 470 } else if (pci_has_legacy_pm_support(pci_dev)) {
bbb44d9f 471 error = pci_legacy_suspend(dev, PMSG_SUSPEND);
fa58d305
RW
472 } else {
473 pci_default_pm_suspend_early(pci_dev);
bbb44d9f 474 }
fa58d305 475
bbb44d9f
RW
476 pci_fixup_device(pci_fixup_suspend, pci_dev);
477
478 return error;
479}
480
481static int pci_pm_suspend_noirq(struct device *dev)
c8958177 482{
355a72d7 483 struct pci_dev *pci_dev = to_pci_dev(dev);
adf09493 484 struct device_driver *drv = dev->driver;
bbb44d9f 485 int error = 0;
c8958177 486
bbb44d9f
RW
487 if (drv && drv->pm) {
488 if (drv->pm->suspend_noirq) {
489 error = drv->pm->suspend_noirq(dev);
490 suspend_report_result(drv->pm->suspend_noirq, error);
491 }
355a72d7 492 } else if (pci_has_legacy_pm_support(pci_dev)) {
bbb44d9f 493 error = pci_legacy_suspend_late(dev, PMSG_SUSPEND);
355a72d7 494 } else {
fa58d305 495 pci_default_pm_suspend_late(pci_dev);
bbb44d9f
RW
496 }
497
498 return error;
c8958177 499}
1da177e4 500
bbb44d9f
RW
501static int pci_pm_resume(struct device *dev)
502{
503 struct pci_dev *pci_dev = to_pci_dev(dev);
504 struct device_driver *drv = dev->driver;
355a72d7 505 int error = 0;
bbb44d9f
RW
506
507 pci_fixup_device(pci_fixup_resume, pci_dev);
508
509 if (drv && drv->pm) {
355a72d7
RW
510 if (drv->pm->resume)
511 error = drv->pm->resume(dev);
512 } else if (pci_has_legacy_pm_support(pci_dev)) {
bbb44d9f 513 error = pci_legacy_resume(dev);
355a72d7
RW
514 } else {
515 error = pci_default_pm_resume_late(pci_dev);
bbb44d9f
RW
516 }
517
518 return error;
519}
520
521static int pci_pm_resume_noirq(struct device *dev)
522{
355a72d7 523 struct pci_dev *pci_dev = to_pci_dev(dev);
adf09493 524 struct device_driver *drv = dev->driver;
bbb44d9f
RW
525 int error = 0;
526
adf09493 527 pci_fixup_device(pci_fixup_resume_early, to_pci_dev(dev));
bbb44d9f
RW
528
529 if (drv && drv->pm) {
530 if (drv->pm->resume_noirq)
531 error = drv->pm->resume_noirq(dev);
355a72d7 532 } else if (pci_has_legacy_pm_support(pci_dev)) {
bbb44d9f 533 error = pci_legacy_resume_early(dev);
355a72d7
RW
534 } else {
535 pci_default_pm_resume_early(pci_dev);
bbb44d9f
RW
536 }
537
538 return error;
539}
540
541#else /* !CONFIG_SUSPEND */
542
543#define pci_pm_suspend NULL
544#define pci_pm_suspend_noirq NULL
545#define pci_pm_resume NULL
546#define pci_pm_resume_noirq NULL
547
548#endif /* !CONFIG_SUSPEND */
549
550#ifdef CONFIG_HIBERNATION
551
552static int pci_pm_freeze(struct device *dev)
553{
554 struct pci_dev *pci_dev = to_pci_dev(dev);
555 struct device_driver *drv = dev->driver;
556 int error = 0;
557
558 if (drv && drv->pm) {
559 if (drv->pm->freeze) {
560 error = drv->pm->freeze(dev);
561 suspend_report_result(drv->pm->freeze, error);
bbb44d9f 562 }
355a72d7 563 } else if (pci_has_legacy_pm_support(pci_dev)) {
bbb44d9f
RW
564 error = pci_legacy_suspend(dev, PMSG_FREEZE);
565 pci_fixup_device(pci_fixup_suspend, pci_dev);
fa58d305
RW
566 } else {
567 pci_default_pm_suspend_early(pci_dev);
bbb44d9f
RW
568 }
569
570 return error;
571}
572
573static int pci_pm_freeze_noirq(struct device *dev)
574{
355a72d7 575 struct pci_dev *pci_dev = to_pci_dev(dev);
adf09493 576 struct device_driver *drv = dev->driver;
bbb44d9f
RW
577 int error = 0;
578
579 if (drv && drv->pm) {
580 if (drv->pm->freeze_noirq) {
581 error = drv->pm->freeze_noirq(dev);
582 suspend_report_result(drv->pm->freeze_noirq, error);
583 }
355a72d7 584 } else if (pci_has_legacy_pm_support(pci_dev)) {
bbb44d9f 585 error = pci_legacy_suspend_late(dev, PMSG_FREEZE);
355a72d7 586 } else {
fa58d305 587 pci_default_pm_suspend_late(pci_dev);
bbb44d9f
RW
588 }
589
590 return error;
591}
592
593static int pci_pm_thaw(struct device *dev)
594{
355a72d7 595 struct pci_dev *pci_dev = to_pci_dev(dev);
bbb44d9f
RW
596 struct device_driver *drv = dev->driver;
597 int error = 0;
598
599 if (drv && drv->pm) {
600 if (drv->pm->thaw)
601 error = drv->pm->thaw(dev);
355a72d7
RW
602 } else if (pci_has_legacy_pm_support(pci_dev)) {
603 pci_fixup_device(pci_fixup_resume, pci_dev);
bbb44d9f 604 error = pci_legacy_resume(dev);
fa58d305
RW
605 } else {
606 pci_default_pm_resume_late(pci_dev);
bbb44d9f
RW
607 }
608
609 return error;
610}
611
612static int pci_pm_thaw_noirq(struct device *dev)
613{
355a72d7 614 struct pci_dev *pci_dev = to_pci_dev(dev);
adf09493 615 struct device_driver *drv = dev->driver;
bbb44d9f
RW
616 int error = 0;
617
618 if (drv && drv->pm) {
619 if (drv->pm->thaw_noirq)
620 error = drv->pm->thaw_noirq(dev);
355a72d7 621 } else if (pci_has_legacy_pm_support(pci_dev)) {
adf09493 622 pci_fixup_device(pci_fixup_resume_early, to_pci_dev(dev));
bbb44d9f 623 error = pci_legacy_resume_early(dev);
fa58d305
RW
624 } else {
625 pci_default_pm_resume_early(pci_dev);
bbb44d9f
RW
626 }
627
628 return error;
629}
630
631static int pci_pm_poweroff(struct device *dev)
632{
355a72d7 633 struct pci_dev *pci_dev = to_pci_dev(dev);
bbb44d9f
RW
634 struct device_driver *drv = dev->driver;
635 int error = 0;
636
bbb44d9f
RW
637 if (drv && drv->pm) {
638 if (drv->pm->poweroff) {
639 error = drv->pm->poweroff(dev);
640 suspend_report_result(drv->pm->poweroff, error);
641 }
355a72d7 642 } else if (pci_has_legacy_pm_support(pci_dev)) {
bbb44d9f 643 error = pci_legacy_suspend(dev, PMSG_HIBERNATE);
fa58d305
RW
644 } else {
645 pci_default_pm_suspend_early(pci_dev);
bbb44d9f
RW
646 }
647
c9b9972b
RW
648 pci_fixup_device(pci_fixup_suspend, pci_dev);
649
bbb44d9f
RW
650 return error;
651}
652
653static int pci_pm_poweroff_noirq(struct device *dev)
654{
adf09493 655 struct device_driver *drv = dev->driver;
bbb44d9f
RW
656 int error = 0;
657
658 if (drv && drv->pm) {
659 if (drv->pm->poweroff_noirq) {
660 error = drv->pm->poweroff_noirq(dev);
661 suspend_report_result(drv->pm->poweroff_noirq, error);
662 }
355a72d7 663 } else if (pci_has_legacy_pm_support(to_pci_dev(dev))) {
bbb44d9f
RW
664 error = pci_legacy_suspend_late(dev, PMSG_HIBERNATE);
665 }
666
667 return error;
668}
669
670static int pci_pm_restore(struct device *dev)
671{
672 struct pci_dev *pci_dev = to_pci_dev(dev);
673 struct device_driver *drv = dev->driver;
355a72d7 674 int error = 0;
bbb44d9f 675
c9b9972b
RW
676 pci_fixup_device(pci_fixup_resume, pci_dev);
677
bbb44d9f 678 if (drv && drv->pm) {
355a72d7
RW
679 if (drv->pm->restore)
680 error = drv->pm->restore(dev);
681 } else if (pci_has_legacy_pm_support(pci_dev)) {
bbb44d9f 682 error = pci_legacy_resume(dev);
355a72d7
RW
683 } else {
684 error = pci_default_pm_resume_late(pci_dev);
bbb44d9f 685 }
bbb44d9f
RW
686
687 return error;
688}
689
690static int pci_pm_restore_noirq(struct device *dev)
691{
692 struct pci_dev *pci_dev = to_pci_dev(dev);
adf09493 693 struct device_driver *drv = dev->driver;
bbb44d9f
RW
694 int error = 0;
695
c9b9972b 696 pci_fixup_device(pci_fixup_resume_early, pci_dev);
bbb44d9f
RW
697
698 if (drv && drv->pm) {
699 if (drv->pm->restore_noirq)
700 error = drv->pm->restore_noirq(dev);
355a72d7 701 } else if (pci_has_legacy_pm_support(pci_dev)) {
bbb44d9f 702 error = pci_legacy_resume_early(dev);
355a72d7
RW
703 } else {
704 pci_default_pm_resume_early(pci_dev);
bbb44d9f 705 }
bbb44d9f
RW
706
707 return error;
c8958177 708}
1da177e4 709
bbb44d9f
RW
710#else /* !CONFIG_HIBERNATION */
711
712#define pci_pm_freeze NULL
713#define pci_pm_freeze_noirq NULL
714#define pci_pm_thaw NULL
715#define pci_pm_thaw_noirq NULL
716#define pci_pm_poweroff NULL
717#define pci_pm_poweroff_noirq NULL
718#define pci_pm_restore NULL
719#define pci_pm_restore_noirq NULL
720
721#endif /* !CONFIG_HIBERNATION */
722
adf09493
RW
723struct dev_pm_ops pci_dev_pm_ops = {
724 .prepare = pci_pm_prepare,
725 .complete = pci_pm_complete,
726 .suspend = pci_pm_suspend,
727 .resume = pci_pm_resume,
728 .freeze = pci_pm_freeze,
729 .thaw = pci_pm_thaw,
730 .poweroff = pci_pm_poweroff,
731 .restore = pci_pm_restore,
bbb44d9f
RW
732 .suspend_noirq = pci_pm_suspend_noirq,
733 .resume_noirq = pci_pm_resume_noirq,
734 .freeze_noirq = pci_pm_freeze_noirq,
735 .thaw_noirq = pci_pm_thaw_noirq,
736 .poweroff_noirq = pci_pm_poweroff_noirq,
737 .restore_noirq = pci_pm_restore_noirq,
738};
739
adf09493 740#define PCI_PM_OPS_PTR (&pci_dev_pm_ops)
bbb44d9f
RW
741
742#else /* !CONFIG_PM_SLEEP */
743
744#define PCI_PM_OPS_PTR NULL
745
746#endif /* !CONFIG_PM_SLEEP */
747
1da177e4 748/**
863b18f4 749 * __pci_register_driver - register a new pci driver
1da177e4 750 * @drv: the driver structure to register
863b18f4 751 * @owner: owner module of drv
f95d882d 752 * @mod_name: module name string
1da177e4
LT
753 *
754 * Adds the driver structure to the list of registered drivers.
755 * Returns a negative value on error, otherwise 0.
eaae4b3a 756 * If no error occurred, the driver remains registered even if
1da177e4
LT
757 * no device was claimed during registration.
758 */
725522b5
GKH
759int __pci_register_driver(struct pci_driver *drv, struct module *owner,
760 const char *mod_name)
1da177e4
LT
761{
762 int error;
763
764 /* initialize common driver fields */
765 drv->driver.name = drv->name;
766 drv->driver.bus = &pci_bus_type;
863b18f4 767 drv->driver.owner = owner;
725522b5 768 drv->driver.mod_name = mod_name;
50b00755 769
75865858
GKH
770 spin_lock_init(&drv->dynids.lock);
771 INIT_LIST_HEAD(&drv->dynids.list);
1da177e4
LT
772
773 /* register with core */
774 error = driver_register(&drv->driver);
50bf14b3
AM
775 if (error)
776 return error;
1da177e4 777
50bf14b3
AM
778 error = pci_create_newid_file(drv);
779 if (error)
780 driver_unregister(&drv->driver);
1da177e4
LT
781
782 return error;
783}
784
785/**
786 * pci_unregister_driver - unregister a pci driver
787 * @drv: the driver structure to unregister
788 *
789 * Deletes the driver structure from the list of registered PCI drivers,
790 * gives it a chance to clean up by calling its remove() function for
791 * each device it was responsible for, and marks those devices as
792 * driverless.
793 */
794
795void
796pci_unregister_driver(struct pci_driver *drv)
797{
03d43b19 798 pci_remove_newid_file(drv);
1da177e4
LT
799 driver_unregister(&drv->driver);
800 pci_free_dynids(drv);
801}
802
803static struct pci_driver pci_compat_driver = {
804 .name = "compat"
805};
806
807/**
808 * pci_dev_driver - get the pci_driver of a device
809 * @dev: the device to query
810 *
811 * Returns the appropriate pci_driver structure or %NULL if there is no
812 * registered driver for the device.
813 */
814struct pci_driver *
815pci_dev_driver(const struct pci_dev *dev)
816{
817 if (dev->driver)
818 return dev->driver;
819 else {
820 int i;
821 for(i=0; i<=PCI_ROM_RESOURCE; i++)
822 if (dev->resource[i].flags & IORESOURCE_BUSY)
823 return &pci_compat_driver;
824 }
825 return NULL;
826}
827
828/**
829 * pci_bus_match - Tell if a PCI device structure has a matching PCI device id structure
1da177e4 830 * @dev: the PCI device structure to match against
8f7020d3 831 * @drv: the device driver to search for matching PCI device id structures
1da177e4
LT
832 *
833 * Used by a driver to check whether a PCI device present in the
8f7020d3 834 * system is in its list of supported devices. Returns the matching
1da177e4
LT
835 * pci_device_id structure or %NULL if there is no match.
836 */
75865858 837static int pci_bus_match(struct device *dev, struct device_driver *drv)
1da177e4 838{
75865858
GKH
839 struct pci_dev *pci_dev = to_pci_dev(dev);
840 struct pci_driver *pci_drv = to_pci_driver(drv);
1da177e4
LT
841 const struct pci_device_id *found_id;
842
75865858 843 found_id = pci_match_device(pci_drv, pci_dev);
1da177e4
LT
844 if (found_id)
845 return 1;
846
75865858 847 return 0;
1da177e4
LT
848}
849
850/**
851 * pci_dev_get - increments the reference count of the pci device structure
852 * @dev: the device being referenced
853 *
854 * Each live reference to a device should be refcounted.
855 *
856 * Drivers for PCI devices should normally record such references in
857 * their probe() methods, when they bind to a device, and release
858 * them by calling pci_dev_put(), in their disconnect() methods.
859 *
860 * A pointer to the device with the incremented reference counter is returned.
861 */
862struct pci_dev *pci_dev_get(struct pci_dev *dev)
863{
864 if (dev)
865 get_device(&dev->dev);
866 return dev;
867}
868
869/**
870 * pci_dev_put - release a use of the pci device structure
871 * @dev: device that's been disconnected
872 *
873 * Must be called when a user of a device is finished with it. When the last
874 * user of the device calls this function, the memory of the device is freed.
875 */
876void pci_dev_put(struct pci_dev *dev)
877{
878 if (dev)
879 put_device(&dev->dev);
880}
881
882#ifndef CONFIG_HOTPLUG
7eff2e7a 883int pci_uevent(struct device *dev, struct kobj_uevent_env *env)
1da177e4
LT
884{
885 return -ENODEV;
886}
887#endif
888
889struct bus_type pci_bus_type = {
890 .name = "pci",
891 .match = pci_bus_match,
312c004d 892 .uevent = pci_uevent,
b15d686a
RK
893 .probe = pci_device_probe,
894 .remove = pci_device_remove,
cbd69dbb 895 .shutdown = pci_device_shutdown,
1da177e4 896 .dev_attrs = pci_dev_attrs,
bbb44d9f 897 .pm = PCI_PM_OPS_PTR,
1da177e4
LT
898};
899
900static int __init pci_driver_init(void)
901{
902 return bus_register(&pci_bus_type);
903}
904
905postcore_initcall(pci_driver_init);
906
75865858 907EXPORT_SYMBOL(pci_match_id);
863b18f4 908EXPORT_SYMBOL(__pci_register_driver);
1da177e4
LT
909EXPORT_SYMBOL(pci_unregister_driver);
910EXPORT_SYMBOL(pci_dev_driver);
911EXPORT_SYMBOL(pci_bus_type);
912EXPORT_SYMBOL(pci_dev_get);
913EXPORT_SYMBOL(pci_dev_put);
This page took 0.480096 seconds and 5 git commands to generate.