blob: 8395206d1aee1bc12cef09278b77bd8ef5bd7791 [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;
Frans Pop57ef8022009-03-16 22:39:56 +0100355 int error = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700356
Andrew Morton02669492006-03-23 01:38:34 -0800357 if (drv && drv->suspend) {
Rafael J. Wysocki99dadce2009-02-04 01:59:09 +0100358 pci_power_t prev = pci_dev->current_state;
359
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100360 pci_dev->state_saved = false;
361
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
367 if (pci_dev->state_saved)
368 goto Fixup;
369
Rafael J. Wysocki99dadce2009-02-04 01:59:09 +0100370 if (pci_dev->current_state != PCI_D0
371 && pci_dev->current_state != PCI_UNKNOWN) {
372 WARN_ONCE(pci_dev->current_state != prev,
373 "PCI PM: Device state not saved by %pF\n",
374 drv->suspend);
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100375 goto Fixup;
Rafael J. Wysocki99dadce2009-02-04 01:59:09 +0100376 }
Andrew Morton02669492006-03-23 01:38:34 -0800377 }
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100378
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100379 pci_save_state(pci_dev);
380 /*
381 * This is for compatibility with existing code with legacy PM support.
382 */
383 pci_pm_set_unknown_state(pci_dev);
384
385 Fixup:
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100386 pci_fixup_device(pci_fixup_suspend, pci_dev);
387
Frans Pop57ef8022009-03-16 22:39:56 +0100388 return error;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700389}
390
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200391static int pci_legacy_suspend_late(struct device *dev, pm_message_t state)
Linus Torvaldscbd69db2006-06-24 14:50:29 -0700392{
393 struct pci_dev * pci_dev = to_pci_dev(dev);
394 struct pci_driver * drv = pci_dev->driver;
Frans Pop57ef8022009-03-16 22:39:56 +0100395 int error = 0;
Linus Torvaldscbd69db2006-06-24 14:50:29 -0700396
397 if (drv && drv->suspend_late) {
Frans Pop57ef8022009-03-16 22:39:56 +0100398 error = drv->suspend_late(pci_dev, state);
399 suspend_report_result(drv->suspend_late, error);
Linus Torvaldscbd69db2006-06-24 14:50:29 -0700400 }
Frans Pop57ef8022009-03-16 22:39:56 +0100401 return error;
Linus Torvaldscbd69db2006-06-24 14:50:29 -0700402}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100404static int pci_legacy_resume_early(struct device *dev)
405{
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100406 struct pci_dev * pci_dev = to_pci_dev(dev);
407 struct pci_driver * drv = pci_dev->driver;
408
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100409 return drv && drv->resume_early ?
410 drv->resume_early(pci_dev) : 0;
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100411}
412
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200413static int pci_legacy_resume(struct device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700414{
415 struct pci_dev * pci_dev = to_pci_dev(dev);
416 struct pci_driver * drv = pci_dev->driver;
417
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100418 pci_fixup_device(pci_fixup_resume, pci_dev);
419
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100420 return drv && drv->resume ?
421 drv->resume(pci_dev) : pci_pm_reenable_device(pci_dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700422}
423
Rafael J. Wysocki571ff752009-01-07 13:05:05 +0100424/* Auxiliary functions used by the new power management framework */
425
Rafael J. Wysocki0128a892009-03-16 22:40:18 +0100426/**
427 * pci_restore_standard_config - restore standard config registers of PCI device
428 * @pci_dev: PCI device to handle
429 */
430static int pci_restore_standard_config(struct pci_dev *pci_dev)
431{
432 pci_update_current_state(pci_dev, PCI_UNKNOWN);
433
434 if (pci_dev->current_state != PCI_D0) {
435 int error = pci_set_power_state(pci_dev, PCI_D0);
436 if (error)
437 return error;
438 }
439
440 return pci_dev->state_saved ? pci_restore_state(pci_dev) : 0;
441}
442
Rafael J. Wysocki734104292009-01-07 13:07:15 +0100443static void pci_pm_default_resume_noirq(struct pci_dev *pci_dev)
444{
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100445 pci_restore_standard_config(pci_dev);
Rafael J. Wysocki418e4da2009-01-26 21:43:08 +0100446 pci_dev->state_saved = false;
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100447 pci_fixup_device(pci_fixup_resume_early, pci_dev);
Rafael J. Wysocki734104292009-01-07 13:07:15 +0100448}
449
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100450static void pci_pm_default_resume(struct pci_dev *pci_dev)
Rafael J. Wysocki571ff752009-01-07 13:05:05 +0100451{
Rafael J. Wysocki734104292009-01-07 13:07:15 +0100452 pci_fixup_device(pci_fixup_resume, pci_dev);
453
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100454 if (!pci_is_bridge(pci_dev))
455 pci_enable_wake(pci_dev, PCI_D0, false);
Rafael J. Wysocki571ff752009-01-07 13:05:05 +0100456}
457
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100458static void pci_pm_default_suspend(struct pci_dev *pci_dev)
Rafael J. Wysocki734104292009-01-07 13:07:15 +0100459{
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100460 /* Disable non-bridge devices without PM support */
Rafael J. Wysockicbbc2f62009-02-04 02:01:15 +0100461 if (!pci_is_bridge(pci_dev))
462 pci_disable_enabled_device(pci_dev);
Rafael J. Wysocki734104292009-01-07 13:07:15 +0100463 pci_save_state(pci_dev);
464}
465
Rafael J. Wysocki07e836e2009-01-07 13:06:10 +0100466static bool pci_has_legacy_pm_support(struct pci_dev *pci_dev)
467{
468 struct pci_driver *drv = pci_dev->driver;
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100469 bool ret = drv && (drv->suspend || drv->suspend_late || drv->resume
Rafael J. Wysocki07e836e2009-01-07 13:06:10 +0100470 || drv->resume_early);
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100471
472 /*
473 * Legacy PM support is used by default, so warn if the new framework is
474 * supported as well. Drivers are supposed to support either the
475 * former, or the latter, but not both at the same time.
476 */
477 WARN_ON(ret && drv->driver.pm);
478
479 return ret;
Rafael J. Wysocki07e836e2009-01-07 13:06:10 +0100480}
481
Rafael J. Wysocki571ff752009-01-07 13:05:05 +0100482/* New power management framework */
483
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200484static int pci_pm_prepare(struct device *dev)
485{
486 struct device_driver *drv = dev->driver;
487 int error = 0;
488
489 if (drv && drv->pm && drv->pm->prepare)
490 error = drv->pm->prepare(dev);
491
492 return error;
493}
494
495static void pci_pm_complete(struct device *dev)
496{
497 struct device_driver *drv = dev->driver;
498
499 if (drv && drv->pm && drv->pm->complete)
500 drv->pm->complete(dev);
501}
502
503#ifdef CONFIG_SUSPEND
504
505static int pci_pm_suspend(struct device *dev)
506{
507 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockiddb7c9d2009-02-04 01:56:14 +0100508 struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200509
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100510 if (pci_has_legacy_pm_support(pci_dev))
511 return pci_legacy_suspend(dev, PMSG_SUSPEND);
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100512
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100513 if (!pm) {
514 pci_pm_default_suspend(pci_dev);
515 goto Fixup;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200516 }
Rafael J. Wysockifa58d302009-01-07 13:03:42 +0100517
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100518 pci_dev->state_saved = false;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200519
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100520 if (pm->suspend) {
521 pci_power_t prev = pci_dev->current_state;
522 int error;
523
524 error = pm->suspend(dev);
525 suspend_report_result(pm->suspend, error);
526 if (error)
527 return error;
528
529 if (pci_dev->state_saved)
530 goto Fixup;
531
532 if (pci_dev->current_state != PCI_D0
533 && pci_dev->current_state != PCI_UNKNOWN) {
534 WARN_ONCE(pci_dev->current_state != prev,
535 "PCI PM: State of device not saved by %pF\n",
536 pm->suspend);
537 goto Fixup;
538 }
539 }
540
541 if (!pci_dev->state_saved) {
542 pci_save_state(pci_dev);
543 if (!pci_is_bridge(pci_dev))
544 pci_prepare_to_sleep(pci_dev);
545 }
546
547 Fixup:
548 pci_fixup_device(pci_fixup_suspend, pci_dev);
549
550 return 0;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200551}
552
553static int pci_pm_suspend_noirq(struct device *dev)
Greg KHc8958172005-04-08 14:53:31 +0900554{
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100555 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200556 struct device_driver *drv = dev->driver;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200557 int error = 0;
Greg KHc8958172005-04-08 14:53:31 +0900558
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100559 if (pci_has_legacy_pm_support(pci_dev))
560 return pci_legacy_suspend_late(dev, PMSG_SUSPEND);
561
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100562 if (drv && drv->pm && drv->pm->suspend_noirq) {
563 error = drv->pm->suspend_noirq(dev);
564 suspend_report_result(drv->pm->suspend_noirq, error);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200565 }
566
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100567 if (!error)
568 pci_pm_set_unknown_state(pci_dev);
569
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200570 return error;
Greg KHc8958172005-04-08 14:53:31 +0900571}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700572
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200573static int pci_pm_resume_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
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100579 pci_pm_default_resume_noirq(pci_dev);
580
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100581 if (pci_has_legacy_pm_support(pci_dev))
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100582 return pci_legacy_resume_early(dev);
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100583
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100584 if (drv && drv->pm && drv->pm->resume_noirq)
585 error = drv->pm->resume_noirq(dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200586
587 return error;
588}
589
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100590static int pci_pm_resume(struct device *dev)
591{
592 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100593 struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100594 int error = 0;
595
Rafael J. Wysocki418e4da2009-01-26 21:43:08 +0100596 /*
597 * This is necessary for the suspend error path in which resume is
598 * called without restoring the standard config registers of the device.
599 */
600 if (pci_dev->state_saved)
601 pci_restore_standard_config(pci_dev);
602
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100603 if (pci_has_legacy_pm_support(pci_dev))
604 return pci_legacy_resume(dev);
605
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100606 pci_pm_default_resume(pci_dev);
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100607
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100608 if (pm) {
609 if (pm->resume)
610 error = pm->resume(dev);
611 } else {
612 pci_pm_reenable_device(pci_dev);
613 }
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100614
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100615 return 0;
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100616}
617
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200618#else /* !CONFIG_SUSPEND */
619
620#define pci_pm_suspend NULL
621#define pci_pm_suspend_noirq NULL
622#define pci_pm_resume NULL
623#define pci_pm_resume_noirq NULL
624
625#endif /* !CONFIG_SUSPEND */
626
627#ifdef CONFIG_HIBERNATION
628
629static int pci_pm_freeze(struct device *dev)
630{
631 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100632 struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200633
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100634 if (pci_has_legacy_pm_support(pci_dev))
635 return pci_legacy_suspend(dev, PMSG_FREEZE);
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100636
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100637 if (!pm) {
638 pci_pm_default_suspend(pci_dev);
639 return 0;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200640 }
641
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100642 pci_dev->state_saved = false;
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100643
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100644 if (pm->freeze) {
645 int error;
646
647 error = pm->freeze(dev);
648 suspend_report_result(pm->freeze, error);
649 if (error)
650 return error;
651 }
652
653 if (!pci_dev->state_saved)
654 pci_save_state(pci_dev);
655
656 return 0;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200657}
658
659static int pci_pm_freeze_noirq(struct device *dev)
660{
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100661 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200662 struct device_driver *drv = dev->driver;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200663 int error = 0;
664
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100665 if (pci_has_legacy_pm_support(pci_dev))
666 return pci_legacy_suspend_late(dev, PMSG_FREEZE);
667
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100668 if (drv && drv->pm && drv->pm->freeze_noirq) {
669 error = drv->pm->freeze_noirq(dev);
670 suspend_report_result(drv->pm->freeze_noirq, error);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200671 }
672
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100673 if (!error)
674 pci_pm_set_unknown_state(pci_dev);
675
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200676 return error;
677}
678
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200679static int pci_pm_thaw_noirq(struct device *dev)
680{
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100681 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200682 struct device_driver *drv = dev->driver;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200683 int error = 0;
684
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100685 if (pci_has_legacy_pm_support(pci_dev))
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100686 return pci_legacy_resume_early(dev);
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100687
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100688 pci_update_current_state(pci_dev, PCI_D0);
689
690 if (drv && drv->pm && drv->pm->thaw_noirq)
691 error = drv->pm->thaw_noirq(dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200692
693 return error;
694}
695
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100696static int pci_pm_thaw(struct device *dev)
697{
698 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100699 struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100700 int error = 0;
701
702 if (pci_has_legacy_pm_support(pci_dev))
703 return pci_legacy_resume(dev);
704
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100705 if (pm) {
706 if (pm->thaw)
707 error = pm->thaw(dev);
708 } else {
709 pci_pm_reenable_device(pci_dev);
710 }
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100711
712 return error;
713}
714
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200715static int pci_pm_poweroff(struct device *dev)
716{
Rafael J. Wysocki355a72d2008-12-08 00:34:57 +0100717 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockiddb7c9d2009-02-04 01:56:14 +0100718 struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200719 int error = 0;
720
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100721 if (pci_has_legacy_pm_support(pci_dev))
722 return pci_legacy_suspend(dev, PMSG_HIBERNATE);
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100723
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100724 if (!pm) {
725 pci_pm_default_suspend(pci_dev);
726 goto Fixup;
727 }
728
729 pci_dev->state_saved = false;
730
731 if (pm->poweroff) {
Rafael J. Wysockiddb7c9d2009-02-04 01:56:14 +0100732 error = pm->poweroff(dev);
733 suspend_report_result(pm->poweroff, error);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200734 }
735
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100736 if (!pci_dev->state_saved && !pci_is_bridge(pci_dev))
737 pci_prepare_to_sleep(pci_dev);
738
739 Fixup:
740 pci_fixup_device(pci_fixup_suspend, pci_dev);
Rafael J. Wysockic9b99722009-01-07 13:02:36 +0100741
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200742 return error;
743}
744
745static int pci_pm_poweroff_noirq(struct device *dev)
746{
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200747 struct device_driver *drv = dev->driver;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200748 int error = 0;
749
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100750 if (pci_has_legacy_pm_support(to_pci_dev(dev)))
751 return pci_legacy_suspend_late(dev, PMSG_HIBERNATE);
752
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100753 if (drv && drv->pm && drv->pm->poweroff_noirq) {
754 error = drv->pm->poweroff_noirq(dev);
755 suspend_report_result(drv->pm->poweroff_noirq, error);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200756 }
757
758 return error;
759}
760
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200761static int pci_pm_restore_noirq(struct device *dev)
762{
763 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200764 struct device_driver *drv = dev->driver;
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200765 int error = 0;
766
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100767 pci_pm_default_resume_noirq(pci_dev);
768
Rafael J. Wysockiad8cfa12009-01-07 13:09:37 +0100769 if (pci_has_legacy_pm_support(pci_dev))
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100770 return pci_legacy_resume_early(dev);
Rafael J. Wysockibb808942009-01-07 14:15:17 +0100771
Rafael J. Wysockid67e37d2009-01-07 13:11:28 +0100772 if (drv && drv->pm && drv->pm->restore_noirq)
773 error = drv->pm->restore_noirq(dev);
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200774
775 return error;
776}
777
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100778static int pci_pm_restore(struct device *dev)
779{
780 struct pci_dev *pci_dev = to_pci_dev(dev);
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100781 struct dev_pm_ops *pm = dev->driver ? dev->driver->pm : NULL;
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100782 int error = 0;
783
Rafael J. Wysocki418e4da2009-01-26 21:43:08 +0100784 /*
785 * This is necessary for the hibernation error path in which restore is
786 * called without restoring the standard config registers of the device.
787 */
788 if (pci_dev->state_saved)
789 pci_restore_standard_config(pci_dev);
790
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100791 if (pci_has_legacy_pm_support(pci_dev))
792 return pci_legacy_resume(dev);
793
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100794 pci_pm_default_resume(pci_dev);
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100795
Rafael J. Wysocki5294e252009-02-04 02:09:07 +0100796 if (pm) {
797 if (pm->restore)
798 error = pm->restore(dev);
799 } else {
800 pci_pm_reenable_device(pci_dev);
801 }
Rafael J. Wysockif6dc1e52009-01-07 13:12:22 +0100802
803 return error;
804}
805
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200806#else /* !CONFIG_HIBERNATION */
807
808#define pci_pm_freeze NULL
809#define pci_pm_freeze_noirq NULL
810#define pci_pm_thaw NULL
811#define pci_pm_thaw_noirq NULL
812#define pci_pm_poweroff NULL
813#define pci_pm_poweroff_noirq NULL
814#define pci_pm_restore NULL
815#define pci_pm_restore_noirq NULL
816
817#endif /* !CONFIG_HIBERNATION */
818
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200819struct dev_pm_ops pci_dev_pm_ops = {
820 .prepare = pci_pm_prepare,
821 .complete = pci_pm_complete,
822 .suspend = pci_pm_suspend,
823 .resume = pci_pm_resume,
824 .freeze = pci_pm_freeze,
825 .thaw = pci_pm_thaw,
826 .poweroff = pci_pm_poweroff,
827 .restore = pci_pm_restore,
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200828 .suspend_noirq = pci_pm_suspend_noirq,
829 .resume_noirq = pci_pm_resume_noirq,
830 .freeze_noirq = pci_pm_freeze_noirq,
831 .thaw_noirq = pci_pm_thaw_noirq,
832 .poweroff_noirq = pci_pm_poweroff_noirq,
833 .restore_noirq = pci_pm_restore_noirq,
834};
835
Rafael J. Wysockiadf09492008-10-06 22:46:05 +0200836#define PCI_PM_OPS_PTR (&pci_dev_pm_ops)
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200837
838#else /* !CONFIG_PM_SLEEP */
839
840#define PCI_PM_OPS_PTR NULL
841
842#endif /* !CONFIG_PM_SLEEP */
843
Linus Torvalds1da177e2005-04-16 15:20:36 -0700844/**
Laurent riffard863b18f2005-10-27 23:12:54 +0200845 * __pci_register_driver - register a new pci driver
Linus Torvalds1da177e2005-04-16 15:20:36 -0700846 * @drv: the driver structure to register
Laurent riffard863b18f2005-10-27 23:12:54 +0200847 * @owner: owner module of drv
Randy Dunlapf95d8822007-02-10 14:41:56 -0800848 * @mod_name: module name string
Linus Torvalds1da177e2005-04-16 15:20:36 -0700849 *
850 * Adds the driver structure to the list of registered drivers.
851 * Returns a negative value on error, otherwise 0.
Steven Coleeaae4b32005-05-03 18:38:30 -0600852 * If no error occurred, the driver remains registered even if
Linus Torvalds1da177e2005-04-16 15:20:36 -0700853 * no device was claimed during registration.
854 */
Greg Kroah-Hartman725522b2007-01-15 11:50:02 -0800855int __pci_register_driver(struct pci_driver *drv, struct module *owner,
856 const char *mod_name)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700857{
858 int error;
859
860 /* initialize common driver fields */
861 drv->driver.name = drv->name;
862 drv->driver.bus = &pci_bus_type;
Laurent riffard863b18f2005-10-27 23:12:54 +0200863 drv->driver.owner = owner;
Greg Kroah-Hartman725522b2007-01-15 11:50:02 -0800864 drv->driver.mod_name = mod_name;
Alan Cox50b00752006-08-16 17:42:18 +0100865
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700866 spin_lock_init(&drv->dynids.lock);
867 INIT_LIST_HEAD(&drv->dynids.list);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700868
869 /* register with core */
870 error = driver_register(&drv->driver);
Akinobu Mita50bf14b2006-11-08 19:53:59 -0800871 if (error)
872 return error;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700873
Akinobu Mita50bf14b2006-11-08 19:53:59 -0800874 error = pci_create_newid_file(drv);
875 if (error)
876 driver_unregister(&drv->driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700877
878 return error;
879}
880
881/**
882 * pci_unregister_driver - unregister a pci driver
883 * @drv: the driver structure to unregister
884 *
885 * Deletes the driver structure from the list of registered PCI drivers,
886 * gives it a chance to clean up by calling its remove() function for
887 * each device it was responsible for, and marks those devices as
888 * driverless.
889 */
890
891void
892pci_unregister_driver(struct pci_driver *drv)
893{
Greg Kroah-Hartman03d43b12007-11-28 12:23:18 -0800894 pci_remove_newid_file(drv);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700895 driver_unregister(&drv->driver);
896 pci_free_dynids(drv);
897}
898
899static struct pci_driver pci_compat_driver = {
900 .name = "compat"
901};
902
903/**
904 * pci_dev_driver - get the pci_driver of a device
905 * @dev: the device to query
906 *
907 * Returns the appropriate pci_driver structure or %NULL if there is no
908 * registered driver for the device.
909 */
910struct pci_driver *
911pci_dev_driver(const struct pci_dev *dev)
912{
913 if (dev->driver)
914 return dev->driver;
915 else {
916 int i;
917 for(i=0; i<=PCI_ROM_RESOURCE; i++)
918 if (dev->resource[i].flags & IORESOURCE_BUSY)
919 return &pci_compat_driver;
920 }
921 return NULL;
922}
923
924/**
925 * pci_bus_match - Tell if a PCI device structure has a matching PCI device id structure
Linus Torvalds1da177e2005-04-16 15:20:36 -0700926 * @dev: the PCI device structure to match against
Randy Dunlap8f7020d2005-10-23 11:57:38 -0700927 * @drv: the device driver to search for matching PCI device id structures
Linus Torvalds1da177e2005-04-16 15:20:36 -0700928 *
929 * Used by a driver to check whether a PCI device present in the
Randy Dunlap8f7020d2005-10-23 11:57:38 -0700930 * system is in its list of supported devices. Returns the matching
Linus Torvalds1da177e2005-04-16 15:20:36 -0700931 * pci_device_id structure or %NULL if there is no match.
932 */
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700933static int pci_bus_match(struct device *dev, struct device_driver *drv)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700934{
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700935 struct pci_dev *pci_dev = to_pci_dev(dev);
936 struct pci_driver *pci_drv = to_pci_driver(drv);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700937 const struct pci_device_id *found_id;
938
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700939 found_id = pci_match_device(pci_drv, pci_dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700940 if (found_id)
941 return 1;
942
Greg Kroah-Hartman75865852005-06-30 02:18:12 -0700943 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700944}
945
946/**
947 * pci_dev_get - increments the reference count of the pci device structure
948 * @dev: the device being referenced
949 *
950 * Each live reference to a device should be refcounted.
951 *
952 * Drivers for PCI devices should normally record such references in
953 * their probe() methods, when they bind to a device, and release
954 * them by calling pci_dev_put(), in their disconnect() methods.
955 *
956 * A pointer to the device with the incremented reference counter is returned.
957 */
958struct pci_dev *pci_dev_get(struct pci_dev *dev)
959{
960 if (dev)
961 get_device(&dev->dev);
962 return dev;
963}
964
965/**
966 * pci_dev_put - release a use of the pci device structure
967 * @dev: device that's been disconnected
968 *
969 * Must be called when a user of a device is finished with it. When the last
970 * user of the device calls this function, the memory of the device is freed.
971 */
972void pci_dev_put(struct pci_dev *dev)
973{
974 if (dev)
975 put_device(&dev->dev);
976}
977
978#ifndef CONFIG_HOTPLUG
Kay Sievers7eff2e72007-08-14 15:15:12 +0200979int pci_uevent(struct device *dev, struct kobj_uevent_env *env)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700980{
981 return -ENODEV;
982}
983#endif
984
985struct bus_type pci_bus_type = {
986 .name = "pci",
987 .match = pci_bus_match,
Kay Sievers312c0042005-11-16 09:00:00 +0100988 .uevent = pci_uevent,
Russell Kingb15d6862006-01-05 14:30:22 +0000989 .probe = pci_device_probe,
990 .remove = pci_device_remove,
Linus Torvaldscbd69db2006-06-24 14:50:29 -0700991 .shutdown = pci_device_shutdown,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700992 .dev_attrs = pci_dev_attrs,
Rafael J. Wysockibbb44d92008-05-20 00:49:04 +0200993 .pm = PCI_PM_OPS_PTR,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700994};
995
996static int __init pci_driver_init(void)
997{
998 return bus_register(&pci_bus_type);
999}
1000
1001postcore_initcall(pci_driver_init);
1002
Greg Kroah-Hartman75865852005-06-30 02:18:12 -07001003EXPORT_SYMBOL(pci_match_id);
Laurent riffard863b18f2005-10-27 23:12:54 +02001004EXPORT_SYMBOL(__pci_register_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001005EXPORT_SYMBOL(pci_unregister_driver);
1006EXPORT_SYMBOL(pci_dev_driver);
1007EXPORT_SYMBOL(pci_bus_type);
1008EXPORT_SYMBOL(pci_dev_get);
1009EXPORT_SYMBOL(pci_dev_put);