blob: 3c1831c82f5b45eef5caf78cfc8df12312beb2ea [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
317/*
318 * Default "suspend" method for devices that have no driver provided suspend,
Rafael J. Wysockifa58d302009-01-07 13:03:42 +0100319 * or not even a driver at all (second part).
320 */
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100321static void pci_pm_set_unknown_state(struct pci_dev *pci_dev)
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200322{
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200323 /*
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
331/*
332 * Default "resume" method for devices that have no driver provided resume,
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100333 * or not even a driver at all (second part).
334 */
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100335static int pci_pm_reenable_device(struct pci_dev *pci_dev)
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100336{
337 int retval;
338
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200339 /* 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)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700352{
353 struct pci_dev * pci_dev = to_pci_dev(dev);
354 struct pci_driver * drv = pci_dev->driver;
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100355
356 pci_dev->state_saved = false;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700357
Andrew Morton02669492006-03-23 01:38:34 -0800358 if (drv && drv->suspend) {
Rafael J. Wysocki99dadce2009-02-04 01:59:09 +0100359 pci_power_t prev = pci_dev->current_state;
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100360 int error;
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100361
Frans Pop57ef8022009-03-16 22:39:56 +0100362 error = drv->suspend(pci_dev, state);
363 suspend_report_result(drv->suspend, error);
364 if (error)
365 return error;
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100366
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100367 if (!pci_dev->state_saved && pci_dev->current_state != PCI_D0
Rafael J. Wysocki99dadce2009-02-04 01:59:09 +0100368 && 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);
Rafael J. Wysocki99dadce2009-02-04 01:59:09 +0100372 }
Andrew Morton02669492006-03-23 01:38:34 -0800373 }
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100374
375 pci_fixup_device(pci_fixup_suspend, pci_dev);
376
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100377 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700378}
379
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200380static int pci_legacy_suspend_late(struct device *dev, pm_message_t state)
Linus Torvaldscbd69db2006-06-24 14:50:29 -0700381{
382 struct pci_dev * pci_dev = to_pci_dev(dev);
383 struct pci_driver * drv = pci_dev->driver;
Linus Torvaldscbd69db2006-06-24 14:50:29 -0700384
385 if (drv && drv->suspend_late) {
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100386 pci_power_t prev = pci_dev->current_state;
387 int error;
388
Frans Pop57ef8022009-03-16 22:39:56 +0100389 error = drv->suspend_late(pci_dev, state);
390 suspend_report_result(drv->suspend_late, error);
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100391 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 }
Linus Torvaldscbd69db2006-06-24 14:50:29 -0700401 }
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100402
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;
Linus Torvaldscbd69db2006-06-24 14:50:29 -0700409}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100411static int pci_legacy_resume_early(struct device *dev)
412{
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100413 struct pci_dev * pci_dev = to_pci_dev(dev);
414 struct pci_driver * drv = pci_dev->driver;
415
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100416 return drv && drv->resume_early ?
417 drv->resume_early(pci_dev) : 0;
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100418}
419
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200420static int pci_legacy_resume(struct device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700421{
422 struct pci_dev * pci_dev = to_pci_dev(dev);
423 struct pci_driver * drv = pci_dev->driver;
424
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100425 pci_fixup_device(pci_fixup_resume, pci_dev);
426
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100427 return drv && drv->resume ?
428 drv->resume(pci_dev) : pci_pm_reenable_device(pci_dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700429}
430
Rafael J. Wysocki571ff752009-01-07 13:05:05 +0100431/* Auxiliary functions used by the new power management framework */
432
Rafael J. Wysocki0128a892009-03-16 22:40:18 +0100433/**
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
Rafael J. Wysocki734104292009-01-07 13:07:15 +0100450static void pci_pm_default_resume_noirq(struct pci_dev *pci_dev)
451{
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100452 pci_restore_standard_config(pci_dev);
Rafael J. Wysocki418e4da2009-01-26 21:43:08 +0100453 pci_dev->state_saved = false;
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100454 pci_fixup_device(pci_fixup_resume_early, pci_dev);
Rafael J. Wysocki734104292009-01-07 13:07:15 +0100455}
456
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100457static void pci_pm_default_resume(struct pci_dev *pci_dev)
Rafael J. Wysocki571ff752009-01-07 13:05:05 +0100458{
Rafael J. Wysocki734104292009-01-07 13:07:15 +0100459 pci_fixup_device(pci_fixup_resume, pci_dev);
460
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100461 if (!pci_is_bridge(pci_dev))
462 pci_enable_wake(pci_dev, PCI_D0, false);
Rafael J. Wysocki571ff752009-01-07 13:05:05 +0100463}
464
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100465static void pci_pm_default_suspend(struct pci_dev *pci_dev)
Rafael J. Wysocki734104292009-01-07 13:07:15 +0100466{
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100467 /* Disable non-bridge devices without PM support */
Rafael J. Wysockicbbc2f62009-02-04 02:01:15 +0100468 if (!pci_is_bridge(pci_dev))
469 pci_disable_enabled_device(pci_dev);
Rafael J. Wysocki734104292009-01-07 13:07:15 +0100470}
471
Rafael J. Wysocki07e836e2009-01-07 13:06:10 +0100472static bool pci_has_legacy_pm_support(struct pci_dev *pci_dev)
473{
474 struct pci_driver *drv = pci_dev->driver;
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100475 bool ret = drv && (drv->suspend || drv->suspend_late || drv->resume
Rafael J. Wysocki07e836e2009-01-07 13:06:10 +0100476 || drv->resume_early);
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100477
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;
Rafael J. Wysocki07e836e2009-01-07 13:06:10 +0100486}
487
Rafael J. Wysocki571ff752009-01-07 13:05:05 +0100488/* New power management framework */
489
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200490static 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);
Rafael J. Wysockiddb7c9d2009-02-04 01:56:14 +0100514 struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200515
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100516 if (pci_has_legacy_pm_support(pci_dev))
517 return pci_legacy_suspend(dev, PMSG_SUSPEND);
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100518
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100519 if (!pm) {
520 pci_pm_default_suspend(pci_dev);
521 goto Fixup;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200522 }
Rafael J. Wysockifa58d302009-01-07 13:03:42 +0100523
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100524 pci_dev->state_saved = false;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200525
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100526 if (pm->suspend) {
527 pci_power_t prev = pci_dev->current_state;
528 int error;
529
530 error = pm->suspend(dev);
531 suspend_report_result(pm->suspend, error);
532 if (error)
533 return error;
534
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100535 if (!pci_dev->state_saved && pci_dev->current_state != PCI_D0
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100536 && 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);
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100540 }
541 }
542
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100543 Fixup:
544 pci_fixup_device(pci_fixup_suspend, pci_dev);
545
546 return 0;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200547}
548
549static int pci_pm_suspend_noirq(struct device *dev)
Greg KHc8958172005-04-08 14:53:31 +0900550{
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100551 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100552 struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
Greg KHc8958172005-04-08 14:53:31 +0900553
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100554 if (pci_has_legacy_pm_support(pci_dev))
555 return pci_legacy_suspend_late(dev, PMSG_SUSPEND);
556
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100557 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 }
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200576 }
577
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100578 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 }
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100583
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100584 pci_pm_set_unknown_state(pci_dev);
585
586 return 0;
Greg KHc8958172005-04-08 14:53:31 +0900587}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700588
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200589static int pci_pm_resume_noirq(struct device *dev)
590{
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100591 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200592 struct device_driver *drv = dev->driver;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200593 int error = 0;
594
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100595 pci_pm_default_resume_noirq(pci_dev);
596
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100597 if (pci_has_legacy_pm_support(pci_dev))
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100598 return pci_legacy_resume_early(dev);
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100599
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100600 if (drv && drv->pm && drv->pm->resume_noirq)
601 error = drv->pm->resume_noirq(dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200602
603 return error;
604}
605
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100606static int pci_pm_resume(struct device *dev)
607{
608 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100609 struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100610 int error = 0;
611
Rafael J. Wysocki418e4da2009-01-26 21:43:08 +0100612 /*
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
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100619 if (pci_has_legacy_pm_support(pci_dev))
620 return pci_legacy_resume(dev);
621
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100622 pci_pm_default_resume(pci_dev);
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100623
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100624 if (pm) {
625 if (pm->resume)
626 error = pm->resume(dev);
627 } else {
628 pci_pm_reenable_device(pci_dev);
629 }
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100630
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100631 return 0;
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100632}
633
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200634#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);
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100648 struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200649
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100650 if (pci_has_legacy_pm_support(pci_dev))
651 return pci_legacy_suspend(dev, PMSG_FREEZE);
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100652
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100653 if (!pm) {
654 pci_pm_default_suspend(pci_dev);
655 return 0;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200656 }
657
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100658 pci_dev->state_saved = false;
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100659
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100660 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
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100669 return 0;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200670}
671
672static int pci_pm_freeze_noirq(struct device *dev)
673{
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100674 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200675 struct device_driver *drv = dev->driver;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200676
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100677 if (pci_has_legacy_pm_support(pci_dev))
678 return pci_legacy_suspend_late(dev, PMSG_FREEZE);
679
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100680 if (drv && drv->pm && drv->pm->freeze_noirq) {
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100681 int error;
682
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100683 error = drv->pm->freeze_noirq(dev);
684 suspend_report_result(drv->pm->freeze_noirq, error);
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100685 if (error)
686 return error;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200687 }
688
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100689 if (!pci_dev->state_saved)
690 pci_save_state(pci_dev);
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100691
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100692 pci_pm_set_unknown_state(pci_dev);
693
694 return 0;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200695}
696
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200697static int pci_pm_thaw_noirq(struct device *dev)
698{
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100699 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200700 struct device_driver *drv = dev->driver;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200701 int error = 0;
702
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100703 if (pci_has_legacy_pm_support(pci_dev))
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100704 return pci_legacy_resume_early(dev);
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100705
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100706 pci_update_current_state(pci_dev, PCI_D0);
707
708 if (drv && drv->pm && drv->pm->thaw_noirq)
709 error = drv->pm->thaw_noirq(dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200710
711 return error;
712}
713
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100714static int pci_pm_thaw(struct device *dev)
715{
716 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100717 struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100718 int error = 0;
719
720 if (pci_has_legacy_pm_support(pci_dev))
721 return pci_legacy_resume(dev);
722
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100723 if (pm) {
724 if (pm->thaw)
725 error = pm->thaw(dev);
726 } else {
727 pci_pm_reenable_device(pci_dev);
728 }
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100729
730 return error;
731}
732
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200733static int pci_pm_poweroff(struct device *dev)
734{
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100735 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockiddb7c9d2009-02-04 01:56:14 +0100736 struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200737
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100738 if (pci_has_legacy_pm_support(pci_dev))
739 return pci_legacy_suspend(dev, PMSG_HIBERNATE);
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100740
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100741 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) {
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100749 int error;
750
Rafael J. Wysockiddb7c9d2009-02-04 01:56:14 +0100751 error = pm->poweroff(dev);
752 suspend_report_result(pm->poweroff, error);
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100753 if (error)
754 return error;
755 }
756
757 Fixup:
758 pci_fixup_device(pci_fixup_suspend, pci_dev);
759
760 return 0;
761}
762
763static int pci_pm_poweroff_noirq(struct device *dev)
764{
765 struct pci_dev *pci_dev = to_pci_dev(dev);
766 struct device_driver *drv = dev->driver;
767
768 if (pci_has_legacy_pm_support(to_pci_dev(dev)))
769 return pci_legacy_suspend_late(dev, PMSG_HIBERNATE);
770
771 if (!drv || !drv->pm)
772 return 0;
773
774 if (drv->pm->poweroff_noirq) {
775 int error;
776
777 error = drv->pm->poweroff_noirq(dev);
778 suspend_report_result(drv->pm->poweroff_noirq, error);
779 if (error)
780 return error;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200781 }
782
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100783 if (!pci_dev->state_saved && !pci_is_bridge(pci_dev))
784 pci_prepare_to_sleep(pci_dev);
785
Rafael J. Wysocki46939f82009-03-16 22:40:26 +0100786 return 0;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200787}
788
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200789static int pci_pm_restore_noirq(struct device *dev)
790{
791 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200792 struct device_driver *drv = dev->driver;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200793 int error = 0;
794
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100795 pci_pm_default_resume_noirq(pci_dev);
796
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100797 if (pci_has_legacy_pm_support(pci_dev))
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100798 return pci_legacy_resume_early(dev);
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100799
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100800 if (drv && drv->pm && drv->pm->restore_noirq)
801 error = drv->pm->restore_noirq(dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200802
803 return error;
804}
805
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100806static int pci_pm_restore(struct device *dev)
807{
808 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100809 struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100810 int error = 0;
811
Rafael J. Wysocki418e4da2009-01-26 21:43:08 +0100812 /*
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
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100819 if (pci_has_legacy_pm_support(pci_dev))
820 return pci_legacy_resume(dev);
821
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100822 pci_pm_default_resume(pci_dev);
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100823
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100824 if (pm) {
825 if (pm->restore)
826 error = pm->restore(dev);
827 } else {
828 pci_pm_reenable_device(pci_dev);
829 }
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100830
831 return error;
832}
833
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200834#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
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200847struct 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,
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200856 .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
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200864#define PCI_PM_OPS_PTR (&pci_dev_pm_ops)
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200865
866#else /* !CONFIG_PM_SLEEP */
867
868#define PCI_PM_OPS_PTR NULL
869
870#endif /* !CONFIG_PM_SLEEP */
871
Linus Torvalds1da177e2005-04-16 15:20:36 -0700872/**
Laurent riffard863b18f2005-10-27 23:12:54 +0200873 * __pci_register_driver - register a new pci driver
Linus Torvalds1da177e2005-04-16 15:20:36 -0700874 * @drv: the driver structure to register
Laurent riffard863b18f2005-10-27 23:12:54 +0200875 * @owner: owner module of drv
Randy Dunlapf95d8822007-02-10 14:41:56 -0800876 * @mod_name: module name string
Linus Torvalds1da177e2005-04-16 15:20:36 -0700877 *
878 * Adds the driver structure to the list of registered drivers.
879 * Returns a negative value on error, otherwise 0.
Steven Coleeaae4b32005-05-03 18:38:30 -0600880 * If no error occurred, the driver remains registered even if
Linus Torvalds1da177e2005-04-16 15:20:36 -0700881 * no device was claimed during registration.
882 */
Greg Kroah-Hartman725522b2007-01-15 11:50:02 -0800883int __pci_register_driver(struct pci_driver *drv, struct module *owner,
884 const char *mod_name)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700885{
886 int error;
887
888 /* initialize common driver fields */
889 drv->driver.name = drv->name;
890 drv->driver.bus = &pci_bus_type;
Laurent riffard863b18f2005-10-27 23:12:54 +0200891 drv->driver.owner = owner;
Greg Kroah-Hartman725522b2007-01-15 11:50:02 -0800892 drv->driver.mod_name = mod_name;
Alan Cox50b00752006-08-16 17:42:18 +0100893
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700894 spin_lock_init(&drv->dynids.lock);
895 INIT_LIST_HEAD(&drv->dynids.list);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700896
897 /* register with core */
898 error = driver_register(&drv->driver);
Akinobu Mita50bf14b2006-11-08 19:53:59 -0800899 if (error)
900 return error;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700901
Akinobu Mita50bf14b2006-11-08 19:53:59 -0800902 error = pci_create_newid_file(drv);
903 if (error)
904 driver_unregister(&drv->driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700905
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{
Greg Kroah-Hartman03d43b12007-11-28 12:23:18 -0800922 pci_remove_newid_file(drv);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700923 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
Linus Torvalds1da177e2005-04-16 15:20:36 -0700954 * @dev: the PCI device structure to match against
Randy Dunlap8f7020d2005-10-23 11:57:38 -0700955 * @drv: the device driver to search for matching PCI device id structures
Linus Torvalds1da177e2005-04-16 15:20:36 -0700956 *
957 * Used by a driver to check whether a PCI device present in the
Randy Dunlap8f7020d2005-10-23 11:57:38 -0700958 * system is in its list of supported devices. Returns the matching
Linus Torvalds1da177e2005-04-16 15:20:36 -0700959 * pci_device_id structure or %NULL if there is no match.
960 */
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700961static int pci_bus_match(struct device *dev, struct device_driver *drv)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700962{
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700963 struct pci_dev *pci_dev = to_pci_dev(dev);
964 struct pci_driver *pci_drv = to_pci_driver(drv);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700965 const struct pci_device_id *found_id;
966
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700967 found_id = pci_match_device(pci_drv, pci_dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700968 if (found_id)
969 return 1;
970
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700971 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700972}
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
Kay Sievers7eff2e72007-08-14 15:15:12 +02001007int pci_uevent(struct device *dev, struct kobj_uevent_env *env)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001008{
1009 return -ENODEV;
1010}
1011#endif
1012
1013struct bus_type pci_bus_type = {
1014 .name = "pci",
1015 .match = pci_bus_match,
Kay Sievers312c0042005-11-16 09:00:00 +01001016 .uevent = pci_uevent,
Russell Kingb15d6862006-01-05 14:30:22 +00001017 .probe = pci_device_probe,
1018 .remove = pci_device_remove,
Linus Torvaldscbd69db2006-06-24 14:50:29 -07001019 .shutdown = pci_device_shutdown,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001020 .dev_attrs = pci_dev_attrs,
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +02001021 .pm = PCI_PM_OPS_PTR,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001022};
1023
1024static int __init pci_driver_init(void)
1025{
1026 return bus_register(&pci_bus_type);
1027}
1028
1029postcore_initcall(pci_driver_init);
1030
Greg Kroah-Hartman75865852005-06-30 02:18:12 -07001031EXPORT_SYMBOL(pci_match_id);
Laurent riffard863b18f2005-10-27 23:12:54 +02001032EXPORT_SYMBOL(__pci_register_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001033EXPORT_SYMBOL(pci_unregister_driver);
1034EXPORT_SYMBOL(pci_dev_driver);
1035EXPORT_SYMBOL(pci_bus_type);
1036EXPORT_SYMBOL(pci_dev_get);
1037EXPORT_SYMBOL(pci_dev_put);