blob: 57cb0015a470c548270b57738a7c066234aca9fa [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * drivers/pci/pci-driver.c
3 *
Greg Kroah-Hartman2b937302007-11-28 12:23:18 -08004 * (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 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07009 */
10
11#include <linux/pci.h>
12#include <linux/module.h>
13#include <linux/init.h>
14#include <linux/device.h>
Andi Kleend42c6992005-07-06 19:56:03 +020015#include <linux/mempolicy.h>
Tim Schmielau4e57b682005-10-30 15:03:48 -080016#include <linux/string.h>
17#include <linux/slab.h>
Tim Schmielau8c65b4a2005-11-07 00:59:43 -080018#include <linux/sched.h>
Rusty Russell873392c2008-12-31 23:54:56 +103019#include <linux/cpu.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070020#include "pci.h"
21
22/*
Linus Torvalds1da177e2005-04-16 15:20:36 -070023 * Dynamic device IDs are disabled for !CONFIG_HOTPLUG
24 */
25
Greg Kroah-Hartman75865852005-06-30 02:18:12 -070026struct pci_dynid {
27 struct list_head node;
28 struct pci_device_id id;
29};
Linus Torvalds1da177e2005-04-16 15:20:36 -070030
Greg KH3d3c2ae2005-07-06 09:09:38 -070031#ifdef CONFIG_HOTPLUG
32
Linus Torvalds1da177e2005-04-16 15:20:36 -070033/**
Randy Dunlap8f7020d2005-10-23 11:57:38 -070034 * 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
Linus Torvalds1da177e2005-04-16 15:20:36 -070038 *
39 * Adds a new dynamic pci device ID to this driver,
40 * and causes the driver to probe for all devices again.
41 */
Randy Dunlapf8eb1002005-10-28 20:36:51 -070042static ssize_t
Linus Torvalds1da177e2005-04-16 15:20:36 -070043store_new_id(struct device_driver *driver, const char *buf, size_t count)
44{
Greg Kroah-Hartman75865852005-06-30 02:18:12 -070045 struct pci_dynid *dynid;
Linus Torvalds1da177e2005-04-16 15:20:36 -070046 struct pci_driver *pdrv = to_pci_driver(driver);
Jean Delvareb41d6cf2008-08-17 21:06:59 +020047 const struct pci_device_id *ids = pdrv->id_table;
Jean Delvare6ba18632007-04-07 17:21:28 +020048 __u32 vendor, device, subvendor=PCI_ANY_ID,
Linus Torvalds1da177e2005-04-16 15:20:36 -070049 subdevice=PCI_ANY_ID, class=0, class_mask=0;
50 unsigned long driver_data=0;
51 int fields=0;
Chris Wright2debb4d2008-11-25 19:36:10 -080052 int retval=0;
Linus Torvalds1da177e2005-04-16 15:20:36 -070053
Jean Delvareb41d6cf2008-08-17 21:06:59 +020054 fields = sscanf(buf, "%x %x %x %x %x %x %lx",
Linus Torvalds1da177e2005-04-16 15:20:36 -070055 &vendor, &device, &subvendor, &subdevice,
56 &class, &class_mask, &driver_data);
Jean Delvare6ba18632007-04-07 17:21:28 +020057 if (fields < 2)
Linus Torvalds1da177e2005-04-16 15:20:36 -070058 return -EINVAL;
59
Jean Delvareb41d6cf2008-08-17 21:06:59 +020060 /* Only accept driver_data values that match an existing id_table
61 entry */
Chris Wright2debb4d2008-11-25 19:36:10 -080062 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++;
Jean Delvareb41d6cf2008-08-17 21:06:59 +020070 }
Chris Wright2debb4d2008-11-25 19:36:10 -080071 if (retval) /* No match */
72 return retval;
Jean Delvareb41d6cf2008-08-17 21:06:59 +020073 }
Jean Delvareb41d6cf2008-08-17 21:06:59 +020074
Eric Sesterhennf5afe802006-02-28 15:34:49 +010075 dynid = kzalloc(sizeof(*dynid), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -070076 if (!dynid)
77 return -ENOMEM;
78
Linus Torvalds1da177e2005-04-16 15:20:36 -070079 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;
Milton Milleredbc25c2008-07-10 16:29:37 -050085 dynid->id.driver_data = driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -070086
87 spin_lock(&pdrv->dynids.lock);
Michael Ellermana56bc692007-09-14 15:33:13 +100088 list_add_tail(&dynid->node, &pdrv->dynids.list);
Linus Torvalds1da177e2005-04-16 15:20:36 -070089 spin_unlock(&pdrv->dynids.lock);
90
Greg Kroah-Hartman75865852005-06-30 02:18:12 -070091 if (get_driver(&pdrv->driver)) {
Greg Kroah-Hartmanb19441a2006-08-28 11:43:25 -070092 retval = driver_attach(&pdrv->driver);
Greg Kroah-Hartman75865852005-06-30 02:18:12 -070093 put_driver(&pdrv->driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -070094 }
95
Greg Kroah-Hartmanb19441a2006-08-28 11:43:25 -070096 if (retval)
97 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -070098 return count;
99}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100static DRIVER_ATTR(new_id, S_IWUSR, NULL, store_new_id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700101
102static void
103pci_free_dynids(struct pci_driver *drv)
104{
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700105 struct pci_dynid *dynid, *n;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700106
107 spin_lock(&drv->dynids.lock);
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700108 list_for_each_entry_safe(dynid, n, &drv->dynids.list, node) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700109 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)
Greg Kroah-Hartman03d43b12007-11-28 12:23:18 -0800120 error = driver_create_file(&drv->driver, &driver_attr_new_id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700121 return error;
122}
123
Greg Kroah-Hartman03d43b12007-11-28 12:23:18 -0800124static void pci_remove_newid_file(struct pci_driver *drv)
125{
126 driver_remove_file(&drv->driver, &driver_attr_new_id);
127}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700128#else /* !CONFIG_HOTPLUG */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700129static 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}
Greg Kroah-Hartman03d43b12007-11-28 12:23:18 -0800134static inline void pci_remove_newid_file(struct pci_driver *drv) {}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700135#endif
136
137/**
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700138 * pci_match_id - See if a pci device matches a given pci_id table
Linus Torvalds1da177e2005-04-16 15:20:36 -0700139 * @ids: array of PCI device id structures to search in
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700140 * @dev: the PCI device structure to match against.
141 *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700142 * Used by a driver to check whether a PCI device present in the
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700143 * system is in its list of supported devices. Returns the matching
Linus Torvalds1da177e2005-04-16 15:20:36 -0700144 * pci_device_id structure or %NULL if there is no match.
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700145 *
Randy Dunlap8b607562007-05-09 07:19:14 +0200146 * Deprecated, don't use this as it will not catch any dynamic ids
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700147 * that a driver might want to check for.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700148 */
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700149const struct pci_device_id *pci_match_id(const struct pci_device_id *ids,
150 struct pci_dev *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700151{
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700152 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 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700158 }
159 return NULL;
160}
161
162/**
Randy Dunlapae9608a2007-01-09 21:41:01 -0800163 * pci_match_device - Tell if a PCI device structure has a matching PCI device id structure
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700164 * @drv: the PCI driver to match against
Henrik Kretzschmar39ba4872006-08-15 10:57:16 +0200165 * @dev: the PCI device structure to match against
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700166 *
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.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700170 */
Adrian Bunkd73460d2007-10-24 18:27:18 +0200171static const struct pci_device_id *pci_match_device(struct pci_driver *drv,
172 struct pci_dev *dev)
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700173{
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700174 struct pci_dynid *dynid;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700175
Russell King7461b602006-11-29 21:18:04 +0000176 /* Look at the dynamic ids first, before the static ones */
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700177 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 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700183 }
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700184 spin_unlock(&drv->dynids.lock);
Russell King7461b602006-11-29 21:18:04 +0000185
186 return pci_match_id(drv->id_table, dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700187}
188
Rusty Russell873392c2008-12-31 23:54:56 +1030189struct 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
Andi Kleend42c6992005-07-06 19:56:03 +0200202static int pci_call_probe(struct pci_driver *drv, struct pci_dev *dev,
203 const struct pci_device_id *id)
204{
Rusty Russell873392c2008-12-31 23:54:56 +1030205 int error, node;
206 struct drv_dev_and_id ddi = { drv, dev, id };
Mike Travisf70316d2008-04-04 18:11:06 -0700207
Rusty Russell873392c2008-12-31 23:54:56 +1030208 /* 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);
Mike Travisf70316d2008-04-04 18:11:06 -0700213 if (node >= 0) {
Rusty Russell873392c2008-12-31 23:54:56 +1030214 int cpu;
Mike Travisf70316d2008-04-04 18:11:06 -0700215 node_to_cpumask_ptr(nodecpumask, node);
Rusty Russell873392c2008-12-31 23:54:56 +1030216
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);
Andi Kleend42c6992005-07-06 19:56:03 +0200226 return error;
227}
228
Linus Torvalds1da177e2005-04-16 15:20:36 -0700229/**
230 * __pci_device_probe()
Randy Dunlap8f7020d2005-10-23 11:57:38 -0700231 * @drv: driver to call to check if it wants the PCI device
232 * @pci_dev: PCI device being probed
Linus Torvalds1da177e2005-04-16 15:20:36 -0700233 *
Randy Dunlap8f7020d2005-10-23 11:57:38 -0700234 * returns 0 on success, else error.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700235 * 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)
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700239{
240 const struct pci_device_id *id;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700241 int error = 0;
242
243 if (!pci_dev->driver && drv->probe) {
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700244 error = -ENODEV;
245
246 id = pci_match_device(drv, pci_dev);
247 if (id)
Andi Kleend42c6992005-07-06 19:56:03 +0200248 error = pci_call_probe(drv, pci_dev, id);
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700249 if (error >= 0) {
250 pci_dev->driver = drv;
251 error = 0;
252 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700253 }
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
284 /*
Shaohua Li2449e062006-10-20 14:45:32 -0700285 * 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
291 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292 * 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
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200304static 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
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100317static 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
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200325/*
326 * Default "suspend" method for devices that have no driver provided suspend,
Rafael J. Wysockifa58d302009-01-07 13:03:42 +0100327 * or not even a driver at all (first part).
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200328 */
Rafael J. Wysockifa58d302009-01-07 13:03:42 +0100329static 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).
338 */
339static void pci_default_pm_suspend_late(struct pci_dev *pci_dev)
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200340{
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,
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100352 * or not even a driver at all (first part).
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200353 */
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100354static void pci_default_pm_resume_early(struct pci_dev *pci_dev)
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200355{
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200356 /* restore the PCI config space */
357 pci_restore_state(pci_dev);
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100358}
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
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200368 /* 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)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700381{
382 struct pci_dev * pci_dev = to_pci_dev(dev);
383 struct pci_driver * drv = pci_dev->driver;
384 int i = 0;
385
Andrew Morton02669492006-03-23 01:38:34 -0800386 if (drv && drv->suspend) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700387 i = drv->suspend(pci_dev, state);
Andrew Morton02669492006-03-23 01:38:34 -0800388 suspend_report_result(drv->suspend, i);
389 } else {
Rafael J. Wysockifa58d302009-01-07 13:03:42 +0100390 /*
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);
Andrew Morton02669492006-03-23 01:38:34 -0800395 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396 return i;
397}
398
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200399static int pci_legacy_suspend_late(struct device *dev, pm_message_t state)
Linus Torvaldscbd69db2006-06-24 14:50:29 -0700400{
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}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700411
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200412static int pci_legacy_resume(struct device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700413{
Jean Delvare8d92bc22006-04-18 14:49:56 +0200414 int error;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700415 struct pci_dev * pci_dev = to_pci_dev(dev);
416 struct pci_driver * drv = pci_dev->driver;
417
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100418 if (drv && drv->resume) {
Jean Delvare8d92bc22006-04-18 14:49:56 +0200419 error = drv->resume(pci_dev);
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100420 } else {
421 pci_default_pm_resume_early(pci_dev);
422 error = pci_default_pm_resume_late(pci_dev);
423 }
Jean Delvare8d92bc22006-04-18 14:49:56 +0200424 return error;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700425}
426
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200427static int pci_legacy_resume_early(struct device *dev)
Linus Torvaldscbd69db2006-06-24 14:50:29 -0700428{
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
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200438static 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);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200469 }
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100470 } else if (pci_has_legacy_pm_support(pci_dev)) {
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200471 error = pci_legacy_suspend(dev, PMSG_SUSPEND);
Rafael J. Wysockifa58d302009-01-07 13:03:42 +0100472 } else {
473 pci_default_pm_suspend_early(pci_dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200474 }
Rafael J. Wysockifa58d302009-01-07 13:03:42 +0100475
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200476 pci_fixup_device(pci_fixup_suspend, pci_dev);
477
478 return error;
479}
480
481static int pci_pm_suspend_noirq(struct device *dev)
Greg KHc8958172005-04-08 14:53:31 +0900482{
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100483 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200484 struct device_driver *drv = dev->driver;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200485 int error = 0;
Greg KHc8958172005-04-08 14:53:31 +0900486
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200487 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 }
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100492 } else if (pci_has_legacy_pm_support(pci_dev)) {
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200493 error = pci_legacy_suspend_late(dev, PMSG_SUSPEND);
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100494 } else {
Rafael J. Wysockifa58d302009-01-07 13:03:42 +0100495 pci_default_pm_suspend_late(pci_dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200496 }
497
498 return error;
Greg KHc8958172005-04-08 14:53:31 +0900499}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700500
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200501static 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;
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100505 int error = 0;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200506
507 pci_fixup_device(pci_fixup_resume, pci_dev);
508
509 if (drv && drv->pm) {
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100510 if (drv->pm->resume)
511 error = drv->pm->resume(dev);
512 } else if (pci_has_legacy_pm_support(pci_dev)) {
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200513 error = pci_legacy_resume(dev);
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100514 } else {
515 error = pci_default_pm_resume_late(pci_dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200516 }
517
518 return error;
519}
520
521static int pci_pm_resume_noirq(struct device *dev)
522{
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100523 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200524 struct device_driver *drv = dev->driver;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200525 int error = 0;
526
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200527 pci_fixup_device(pci_fixup_resume_early, to_pci_dev(dev));
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200528
529 if (drv && drv->pm) {
530 if (drv->pm->resume_noirq)
531 error = drv->pm->resume_noirq(dev);
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100532 } else if (pci_has_legacy_pm_support(pci_dev)) {
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200533 error = pci_legacy_resume_early(dev);
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100534 } else {
535 pci_default_pm_resume_early(pci_dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200536 }
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);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200562 }
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100563 } else if (pci_has_legacy_pm_support(pci_dev)) {
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200564 error = pci_legacy_suspend(dev, PMSG_FREEZE);
565 pci_fixup_device(pci_fixup_suspend, pci_dev);
Rafael J. Wysockifa58d302009-01-07 13:03:42 +0100566 } else {
567 pci_default_pm_suspend_early(pci_dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200568 }
569
570 return error;
571}
572
573static int pci_pm_freeze_noirq(struct device *dev)
574{
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100575 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200576 struct device_driver *drv = dev->driver;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200577 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 }
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100584 } else if (pci_has_legacy_pm_support(pci_dev)) {
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200585 error = pci_legacy_suspend_late(dev, PMSG_FREEZE);
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100586 } else {
Rafael J. Wysockifa58d302009-01-07 13:03:42 +0100587 pci_default_pm_suspend_late(pci_dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200588 }
589
590 return error;
591}
592
593static int pci_pm_thaw(struct device *dev)
594{
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100595 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200596 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);
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100602 } else if (pci_has_legacy_pm_support(pci_dev)) {
603 pci_fixup_device(pci_fixup_resume, pci_dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200604 error = pci_legacy_resume(dev);
Rafael J. Wysockifa58d302009-01-07 13:03:42 +0100605 } else {
606 pci_default_pm_resume_late(pci_dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200607 }
608
609 return error;
610}
611
612static int pci_pm_thaw_noirq(struct device *dev)
613{
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100614 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200615 struct device_driver *drv = dev->driver;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200616 int error = 0;
617
618 if (drv && drv->pm) {
619 if (drv->pm->thaw_noirq)
620 error = drv->pm->thaw_noirq(dev);
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100621 } else if (pci_has_legacy_pm_support(pci_dev)) {
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200622 pci_fixup_device(pci_fixup_resume_early, to_pci_dev(dev));
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200623 error = pci_legacy_resume_early(dev);
Rafael J. Wysockifa58d302009-01-07 13:03:42 +0100624 } else {
625 pci_default_pm_resume_early(pci_dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200626 }
627
628 return error;
629}
630
631static int pci_pm_poweroff(struct device *dev)
632{
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100633 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200634 struct device_driver *drv = dev->driver;
635 int error = 0;
636
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200637 if (drv && drv->pm) {
638 if (drv->pm->poweroff) {
639 error = drv->pm->poweroff(dev);
640 suspend_report_result(drv->pm->poweroff, error);
641 }
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100642 } else if (pci_has_legacy_pm_support(pci_dev)) {
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200643 error = pci_legacy_suspend(dev, PMSG_HIBERNATE);
Rafael J. Wysockifa58d302009-01-07 13:03:42 +0100644 } else {
645 pci_default_pm_suspend_early(pci_dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200646 }
647
Rafael J. Wysockic9b99722009-01-07 13:02:36 +0100648 pci_fixup_device(pci_fixup_suspend, pci_dev);
649
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200650 return error;
651}
652
653static int pci_pm_poweroff_noirq(struct device *dev)
654{
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200655 struct device_driver *drv = dev->driver;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200656 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 }
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100663 } else if (pci_has_legacy_pm_support(to_pci_dev(dev))) {
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200664 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;
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100674 int error = 0;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200675
Rafael J. Wysockic9b99722009-01-07 13:02:36 +0100676 pci_fixup_device(pci_fixup_resume, pci_dev);
677
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200678 if (drv && drv->pm) {
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100679 if (drv->pm->restore)
680 error = drv->pm->restore(dev);
681 } else if (pci_has_legacy_pm_support(pci_dev)) {
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200682 error = pci_legacy_resume(dev);
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100683 } else {
684 error = pci_default_pm_resume_late(pci_dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200685 }
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200686
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);
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200693 struct device_driver *drv = dev->driver;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200694 int error = 0;
695
Rafael J. Wysockic9b99722009-01-07 13:02:36 +0100696 pci_fixup_device(pci_fixup_resume_early, pci_dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200697
698 if (drv && drv->pm) {
699 if (drv->pm->restore_noirq)
700 error = drv->pm->restore_noirq(dev);
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100701 } else if (pci_has_legacy_pm_support(pci_dev)) {
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200702 error = pci_legacy_resume_early(dev);
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100703 } else {
704 pci_default_pm_resume_early(pci_dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200705 }
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200706
707 return error;
708}
709
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
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200723struct 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,
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200732 .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
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200740#define PCI_PM_OPS_PTR (&pci_dev_pm_ops)
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200741
742#else /* !CONFIG_PM_SLEEP */
743
744#define PCI_PM_OPS_PTR NULL
745
746#endif /* !CONFIG_PM_SLEEP */
747
Linus Torvalds1da177e2005-04-16 15:20:36 -0700748/**
Laurent riffard863b18f2005-10-27 23:12:54 +0200749 * __pci_register_driver - register a new pci driver
Linus Torvalds1da177e2005-04-16 15:20:36 -0700750 * @drv: the driver structure to register
Laurent riffard863b18f2005-10-27 23:12:54 +0200751 * @owner: owner module of drv
Randy Dunlapf95d8822007-02-10 14:41:56 -0800752 * @mod_name: module name string
Linus Torvalds1da177e2005-04-16 15:20:36 -0700753 *
754 * Adds the driver structure to the list of registered drivers.
755 * Returns a negative value on error, otherwise 0.
Steven Coleeaae4b32005-05-03 18:38:30 -0600756 * If no error occurred, the driver remains registered even if
Linus Torvalds1da177e2005-04-16 15:20:36 -0700757 * no device was claimed during registration.
758 */
Greg Kroah-Hartman725522b2007-01-15 11:50:02 -0800759int __pci_register_driver(struct pci_driver *drv, struct module *owner,
760 const char *mod_name)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700761{
762 int error;
763
764 /* initialize common driver fields */
765 drv->driver.name = drv->name;
766 drv->driver.bus = &pci_bus_type;
Laurent riffard863b18f2005-10-27 23:12:54 +0200767 drv->driver.owner = owner;
Greg Kroah-Hartman725522b2007-01-15 11:50:02 -0800768 drv->driver.mod_name = mod_name;
Alan Cox50b00752006-08-16 17:42:18 +0100769
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700770 spin_lock_init(&drv->dynids.lock);
771 INIT_LIST_HEAD(&drv->dynids.list);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700772
773 /* register with core */
774 error = driver_register(&drv->driver);
Akinobu Mita50bf14b2006-11-08 19:53:59 -0800775 if (error)
776 return error;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700777
Akinobu Mita50bf14b2006-11-08 19:53:59 -0800778 error = pci_create_newid_file(drv);
779 if (error)
780 driver_unregister(&drv->driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700781
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{
Greg Kroah-Hartman03d43b12007-11-28 12:23:18 -0800798 pci_remove_newid_file(drv);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700799 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
Linus Torvalds1da177e2005-04-16 15:20:36 -0700830 * @dev: the PCI device structure to match against
Randy Dunlap8f7020d2005-10-23 11:57:38 -0700831 * @drv: the device driver to search for matching PCI device id structures
Linus Torvalds1da177e2005-04-16 15:20:36 -0700832 *
833 * Used by a driver to check whether a PCI device present in the
Randy Dunlap8f7020d2005-10-23 11:57:38 -0700834 * system is in its list of supported devices. Returns the matching
Linus Torvalds1da177e2005-04-16 15:20:36 -0700835 * pci_device_id structure or %NULL if there is no match.
836 */
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700837static int pci_bus_match(struct device *dev, struct device_driver *drv)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700838{
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700839 struct pci_dev *pci_dev = to_pci_dev(dev);
840 struct pci_driver *pci_drv = to_pci_driver(drv);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700841 const struct pci_device_id *found_id;
842
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700843 found_id = pci_match_device(pci_drv, pci_dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700844 if (found_id)
845 return 1;
846
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700847 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700848}
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
Kay Sievers7eff2e72007-08-14 15:15:12 +0200883int pci_uevent(struct device *dev, struct kobj_uevent_env *env)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700884{
885 return -ENODEV;
886}
887#endif
888
889struct bus_type pci_bus_type = {
890 .name = "pci",
891 .match = pci_bus_match,
Kay Sievers312c0042005-11-16 09:00:00 +0100892 .uevent = pci_uevent,
Russell Kingb15d6862006-01-05 14:30:22 +0000893 .probe = pci_device_probe,
894 .remove = pci_device_remove,
Linus Torvaldscbd69db2006-06-24 14:50:29 -0700895 .shutdown = pci_device_shutdown,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700896 .dev_attrs = pci_dev_attrs,
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200897 .pm = PCI_PM_OPS_PTR,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700898};
899
900static int __init pci_driver_init(void)
901{
902 return bus_register(&pci_bus_type);
903}
904
905postcore_initcall(pci_driver_init);
906
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700907EXPORT_SYMBOL(pci_match_id);
Laurent riffard863b18f2005-10-27 23:12:54 +0200908EXPORT_SYMBOL(__pci_register_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700909EXPORT_SYMBOL(pci_unregister_driver);
910EXPORT_SYMBOL(pci_dev_driver);
911EXPORT_SYMBOL(pci_bus_type);
912EXPORT_SYMBOL(pci_dev_get);
913EXPORT_SYMBOL(pci_dev_put);