blob: 897fa5ccdb789d56724a5e2504a99836f6076baf [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 * PCI Bus Services, see include/linux/pci.h for further explanation.
3 *
4 * Copyright 1993 -- 1997 Drew Eckhardt, Frederic Potter,
5 * David Mosberger-Tang
6 *
7 * Copyright 1997 -- 2000 Martin Mares <mj@ucw.cz>
8 */
9
10#include <linux/kernel.h>
11#include <linux/delay.h>
12#include <linux/init.h>
13#include <linux/pci.h>
David Brownell075c1772007-04-26 00:12:06 -070014#include <linux/pm.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070015#include <linux/module.h>
16#include <linux/spinlock.h>
Tim Schmielau4e57b682005-10-30 15:03:48 -080017#include <linux/string.h>
vignesh babu229f5af2007-08-13 18:23:14 +053018#include <linux/log2.h>
Shaohua Li7d715a62008-02-25 09:46:41 +080019#include <linux/pci-aspm.h>
Stephen Rothwellc300bd2fb2008-07-10 02:16:44 +020020#include <linux/pm_wakeup.h>
Sheng Yang8dd7f802008-10-21 17:38:25 +080021#include <linux/interrupt.h>
Yuji Shimada32a9a6822009-03-16 17:13:39 +090022#include <linux/device.h>
Rafael J. Wysockib67ea762010-02-17 23:44:09 +010023#include <linux/pm_runtime.h>
Yuji Shimada32a9a6822009-03-16 17:13:39 +090024#include <asm/setup.h>
Greg KHbc56b9e2005-04-08 14:53:31 +090025#include "pci.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070026
Alan Stern00240c32009-04-27 13:33:16 -040027const char *pci_power_names[] = {
28 "error", "D0", "D1", "D2", "D3hot", "D3cold", "unknown",
29};
30EXPORT_SYMBOL_GPL(pci_power_names);
31
Rafael J. Wysocki93177a72010-01-02 22:57:24 +010032int isa_dma_bridge_buggy;
33EXPORT_SYMBOL(isa_dma_bridge_buggy);
34
35int pci_pci_problems;
36EXPORT_SYMBOL(pci_pci_problems);
37
Rafael J. Wysocki1ae861e2009-12-31 12:15:54 +010038unsigned int pci_pm_d3_delay;
39
40static void pci_dev_d3_sleep(struct pci_dev *dev)
41{
42 unsigned int delay = dev->d3_delay;
43
44 if (delay < pci_pm_d3_delay)
45 delay = pci_pm_d3_delay;
46
47 msleep(delay);
48}
Linus Torvalds1da177e2005-04-16 15:20:36 -070049
Jeff Garzik32a2eea2007-10-11 16:57:27 -040050#ifdef CONFIG_PCI_DOMAINS
51int pci_domains_supported = 1;
52#endif
53
Atsushi Nemoto4516a612007-02-05 16:36:06 -080054#define DEFAULT_CARDBUS_IO_SIZE (256)
55#define DEFAULT_CARDBUS_MEM_SIZE (64*1024*1024)
56/* pci=cbmemsize=nnM,cbiosize=nn can override this */
57unsigned long pci_cardbus_io_size = DEFAULT_CARDBUS_IO_SIZE;
58unsigned long pci_cardbus_mem_size = DEFAULT_CARDBUS_MEM_SIZE;
59
Eric W. Biederman28760482009-09-09 14:09:24 -070060#define DEFAULT_HOTPLUG_IO_SIZE (256)
61#define DEFAULT_HOTPLUG_MEM_SIZE (2*1024*1024)
62/* pci=hpmemsize=nnM,hpiosize=nn can override this */
63unsigned long pci_hotplug_io_size = DEFAULT_HOTPLUG_IO_SIZE;
64unsigned long pci_hotplug_mem_size = DEFAULT_HOTPLUG_MEM_SIZE;
65
Jesse Barnesac1aa472009-10-26 13:20:44 -070066/*
67 * The default CLS is used if arch didn't set CLS explicitly and not
68 * all pci devices agree on the same value. Arch can override either
69 * the dfl or actual value as it sees fit. Don't forget this is
70 * measured in 32-bit words, not bytes.
71 */
Tejun Heo98e724c2009-10-08 18:59:53 +090072u8 pci_dfl_cache_line_size __devinitdata = L1_CACHE_BYTES >> 2;
Jesse Barnesac1aa472009-10-26 13:20:44 -070073u8 pci_cache_line_size;
74
Linus Torvalds1da177e2005-04-16 15:20:36 -070075/**
76 * pci_bus_max_busnr - returns maximum PCI bus number of given bus' children
77 * @bus: pointer to PCI bus structure to search
78 *
79 * Given a PCI bus, returns the highest PCI bus number present in the set
80 * including the given PCI bus and its list of child PCI buses.
81 */
Sam Ravnborg96bde062007-03-26 21:53:30 -080082unsigned char pci_bus_max_busnr(struct pci_bus* bus)
Linus Torvalds1da177e2005-04-16 15:20:36 -070083{
84 struct list_head *tmp;
85 unsigned char max, n;
86
Kristen Accardib82db5c2006-01-17 16:56:56 -080087 max = bus->subordinate;
Linus Torvalds1da177e2005-04-16 15:20:36 -070088 list_for_each(tmp, &bus->children) {
89 n = pci_bus_max_busnr(pci_bus_b(tmp));
90 if(n > max)
91 max = n;
92 }
93 return max;
94}
Kristen Accardib82db5c2006-01-17 16:56:56 -080095EXPORT_SYMBOL_GPL(pci_bus_max_busnr);
Linus Torvalds1da177e2005-04-16 15:20:36 -070096
Andrew Morton1684f5d2008-12-01 14:30:30 -080097#ifdef CONFIG_HAS_IOMEM
98void __iomem *pci_ioremap_bar(struct pci_dev *pdev, int bar)
99{
100 /*
101 * Make sure the BAR is actually a memory resource, not an IO resource
102 */
103 if (!(pci_resource_flags(pdev, bar) & IORESOURCE_MEM)) {
104 WARN_ON(1);
105 return NULL;
106 }
107 return ioremap_nocache(pci_resource_start(pdev, bar),
108 pci_resource_len(pdev, bar));
109}
110EXPORT_SYMBOL_GPL(pci_ioremap_bar);
111#endif
112
Kristen Accardib82db5c2006-01-17 16:56:56 -0800113#if 0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700114/**
115 * pci_max_busnr - returns maximum PCI bus number
116 *
117 * Returns the highest PCI bus number present in the system global list of
118 * PCI buses.
119 */
120unsigned char __devinit
121pci_max_busnr(void)
122{
123 struct pci_bus *bus = NULL;
124 unsigned char max, n;
125
126 max = 0;
127 while ((bus = pci_find_next_bus(bus)) != NULL) {
128 n = pci_bus_max_busnr(bus);
129 if(n > max)
130 max = n;
131 }
132 return max;
133}
134
Adrian Bunk54c762f2005-12-22 01:08:52 +0100135#endif /* 0 */
136
Michael Ellerman687d5fe2006-11-22 18:26:18 +1100137#define PCI_FIND_CAP_TTL 48
138
139static int __pci_find_next_cap_ttl(struct pci_bus *bus, unsigned int devfn,
140 u8 pos, int cap, int *ttl)
Roland Dreier24a4e372005-10-28 17:35:34 -0700141{
142 u8 id;
Roland Dreier24a4e372005-10-28 17:35:34 -0700143
Michael Ellerman687d5fe2006-11-22 18:26:18 +1100144 while ((*ttl)--) {
Roland Dreier24a4e372005-10-28 17:35:34 -0700145 pci_bus_read_config_byte(bus, devfn, pos, &pos);
146 if (pos < 0x40)
147 break;
148 pos &= ~3;
149 pci_bus_read_config_byte(bus, devfn, pos + PCI_CAP_LIST_ID,
150 &id);
151 if (id == 0xff)
152 break;
153 if (id == cap)
154 return pos;
155 pos += PCI_CAP_LIST_NEXT;
156 }
157 return 0;
158}
159
Michael Ellerman687d5fe2006-11-22 18:26:18 +1100160static int __pci_find_next_cap(struct pci_bus *bus, unsigned int devfn,
161 u8 pos, int cap)
162{
163 int ttl = PCI_FIND_CAP_TTL;
164
165 return __pci_find_next_cap_ttl(bus, devfn, pos, cap, &ttl);
166}
167
Roland Dreier24a4e372005-10-28 17:35:34 -0700168int pci_find_next_capability(struct pci_dev *dev, u8 pos, int cap)
169{
170 return __pci_find_next_cap(dev->bus, dev->devfn,
171 pos + PCI_CAP_LIST_NEXT, cap);
172}
173EXPORT_SYMBOL_GPL(pci_find_next_capability);
174
Michael Ellermand3bac112006-11-22 18:26:16 +1100175static int __pci_bus_find_cap_start(struct pci_bus *bus,
176 unsigned int devfn, u8 hdr_type)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700177{
178 u16 status;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700179
180 pci_bus_read_config_word(bus, devfn, PCI_STATUS, &status);
181 if (!(status & PCI_STATUS_CAP_LIST))
182 return 0;
183
184 switch (hdr_type) {
185 case PCI_HEADER_TYPE_NORMAL:
186 case PCI_HEADER_TYPE_BRIDGE:
Michael Ellermand3bac112006-11-22 18:26:16 +1100187 return PCI_CAPABILITY_LIST;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700188 case PCI_HEADER_TYPE_CARDBUS:
Michael Ellermand3bac112006-11-22 18:26:16 +1100189 return PCI_CB_CAPABILITY_LIST;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700190 default:
191 return 0;
192 }
Michael Ellermand3bac112006-11-22 18:26:16 +1100193
194 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700195}
196
197/**
198 * pci_find_capability - query for devices' capabilities
199 * @dev: PCI device to query
200 * @cap: capability code
201 *
202 * Tell if a device supports a given PCI capability.
203 * Returns the address of the requested capability structure within the
204 * device's PCI configuration space or 0 in case the device does not
205 * support it. Possible values for @cap:
206 *
207 * %PCI_CAP_ID_PM Power Management
208 * %PCI_CAP_ID_AGP Accelerated Graphics Port
209 * %PCI_CAP_ID_VPD Vital Product Data
210 * %PCI_CAP_ID_SLOTID Slot Identification
211 * %PCI_CAP_ID_MSI Message Signalled Interrupts
212 * %PCI_CAP_ID_CHSWP CompactPCI HotSwap
213 * %PCI_CAP_ID_PCIX PCI-X
214 * %PCI_CAP_ID_EXP PCI Express
215 */
216int pci_find_capability(struct pci_dev *dev, int cap)
217{
Michael Ellermand3bac112006-11-22 18:26:16 +1100218 int pos;
219
220 pos = __pci_bus_find_cap_start(dev->bus, dev->devfn, dev->hdr_type);
221 if (pos)
222 pos = __pci_find_next_cap(dev->bus, dev->devfn, pos, cap);
223
224 return pos;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700225}
226
227/**
228 * pci_bus_find_capability - query for devices' capabilities
229 * @bus: the PCI bus to query
230 * @devfn: PCI device to query
231 * @cap: capability code
232 *
233 * Like pci_find_capability() but works for pci devices that do not have a
234 * pci_dev structure set up yet.
235 *
236 * Returns the address of the requested capability structure within the
237 * device's PCI configuration space or 0 in case the device does not
238 * support it.
239 */
240int pci_bus_find_capability(struct pci_bus *bus, unsigned int devfn, int cap)
241{
Michael Ellermand3bac112006-11-22 18:26:16 +1100242 int pos;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700243 u8 hdr_type;
244
245 pci_bus_read_config_byte(bus, devfn, PCI_HEADER_TYPE, &hdr_type);
246
Michael Ellermand3bac112006-11-22 18:26:16 +1100247 pos = __pci_bus_find_cap_start(bus, devfn, hdr_type & 0x7f);
248 if (pos)
249 pos = __pci_find_next_cap(bus, devfn, pos, cap);
250
251 return pos;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700252}
253
254/**
255 * pci_find_ext_capability - Find an extended capability
256 * @dev: PCI device to query
257 * @cap: capability code
258 *
259 * Returns the address of the requested extended capability structure
260 * within the device's PCI configuration space or 0 if the device does
261 * not support it. Possible values for @cap:
262 *
263 * %PCI_EXT_CAP_ID_ERR Advanced Error Reporting
264 * %PCI_EXT_CAP_ID_VC Virtual Channel
265 * %PCI_EXT_CAP_ID_DSN Device Serial Number
266 * %PCI_EXT_CAP_ID_PWR Power Budgeting
267 */
268int pci_find_ext_capability(struct pci_dev *dev, int cap)
269{
270 u32 header;
Zhao, Yu557848c2008-10-13 19:18:07 +0800271 int ttl;
272 int pos = PCI_CFG_SPACE_SIZE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700273
Zhao, Yu557848c2008-10-13 19:18:07 +0800274 /* minimum 8 bytes per capability */
275 ttl = (PCI_CFG_SPACE_EXP_SIZE - PCI_CFG_SPACE_SIZE) / 8;
276
277 if (dev->cfg_size <= PCI_CFG_SPACE_SIZE)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700278 return 0;
279
280 if (pci_read_config_dword(dev, pos, &header) != PCIBIOS_SUCCESSFUL)
281 return 0;
282
283 /*
284 * If we have no capabilities, this is indicated by cap ID,
285 * cap version and next pointer all being 0.
286 */
287 if (header == 0)
288 return 0;
289
290 while (ttl-- > 0) {
291 if (PCI_EXT_CAP_ID(header) == cap)
292 return pos;
293
294 pos = PCI_EXT_CAP_NEXT(header);
Zhao, Yu557848c2008-10-13 19:18:07 +0800295 if (pos < PCI_CFG_SPACE_SIZE)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700296 break;
297
298 if (pci_read_config_dword(dev, pos, &header) != PCIBIOS_SUCCESSFUL)
299 break;
300 }
301
302 return 0;
303}
Brice Goglin3a720d72006-05-23 06:10:01 -0400304EXPORT_SYMBOL_GPL(pci_find_ext_capability);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700305
Jesse Barnescf4c43d2009-07-15 13:13:00 -0700306/**
307 * pci_bus_find_ext_capability - find an extended capability
308 * @bus: the PCI bus to query
309 * @devfn: PCI device to query
310 * @cap: capability code
311 *
312 * Like pci_find_ext_capability() but works for pci devices that do not have a
313 * pci_dev structure set up yet.
314 *
315 * Returns the address of the requested capability structure within the
316 * device's PCI configuration space or 0 in case the device does not
317 * support it.
318 */
319int pci_bus_find_ext_capability(struct pci_bus *bus, unsigned int devfn,
320 int cap)
321{
322 u32 header;
323 int ttl;
324 int pos = PCI_CFG_SPACE_SIZE;
325
326 /* minimum 8 bytes per capability */
327 ttl = (PCI_CFG_SPACE_EXP_SIZE - PCI_CFG_SPACE_SIZE) / 8;
328
329 if (!pci_bus_read_config_dword(bus, devfn, pos, &header))
330 return 0;
331 if (header == 0xffffffff || header == 0)
332 return 0;
333
334 while (ttl-- > 0) {
335 if (PCI_EXT_CAP_ID(header) == cap)
336 return pos;
337
338 pos = PCI_EXT_CAP_NEXT(header);
339 if (pos < PCI_CFG_SPACE_SIZE)
340 break;
341
342 if (!pci_bus_read_config_dword(bus, devfn, pos, &header))
343 break;
344 }
345
346 return 0;
347}
348
Michael Ellerman687d5fe2006-11-22 18:26:18 +1100349static int __pci_find_next_ht_cap(struct pci_dev *dev, int pos, int ht_cap)
350{
351 int rc, ttl = PCI_FIND_CAP_TTL;
352 u8 cap, mask;
353
354 if (ht_cap == HT_CAPTYPE_SLAVE || ht_cap == HT_CAPTYPE_HOST)
355 mask = HT_3BIT_CAP_MASK;
356 else
357 mask = HT_5BIT_CAP_MASK;
358
359 pos = __pci_find_next_cap_ttl(dev->bus, dev->devfn, pos,
360 PCI_CAP_ID_HT, &ttl);
361 while (pos) {
362 rc = pci_read_config_byte(dev, pos + 3, &cap);
363 if (rc != PCIBIOS_SUCCESSFUL)
364 return 0;
365
366 if ((cap & mask) == ht_cap)
367 return pos;
368
Brice Goglin47a4d5b2007-01-10 23:15:29 -0800369 pos = __pci_find_next_cap_ttl(dev->bus, dev->devfn,
370 pos + PCI_CAP_LIST_NEXT,
Michael Ellerman687d5fe2006-11-22 18:26:18 +1100371 PCI_CAP_ID_HT, &ttl);
372 }
373
374 return 0;
375}
376/**
377 * pci_find_next_ht_capability - query a device's Hypertransport capabilities
378 * @dev: PCI device to query
379 * @pos: Position from which to continue searching
380 * @ht_cap: Hypertransport capability code
381 *
382 * To be used in conjunction with pci_find_ht_capability() to search for
383 * all capabilities matching @ht_cap. @pos should always be a value returned
384 * from pci_find_ht_capability().
385 *
386 * NB. To be 100% safe against broken PCI devices, the caller should take
387 * steps to avoid an infinite loop.
388 */
389int pci_find_next_ht_capability(struct pci_dev *dev, int pos, int ht_cap)
390{
391 return __pci_find_next_ht_cap(dev, pos + PCI_CAP_LIST_NEXT, ht_cap);
392}
393EXPORT_SYMBOL_GPL(pci_find_next_ht_capability);
394
395/**
396 * pci_find_ht_capability - query a device's Hypertransport capabilities
397 * @dev: PCI device to query
398 * @ht_cap: Hypertransport capability code
399 *
400 * Tell if a device supports a given Hypertransport capability.
401 * Returns an address within the device's PCI configuration space
402 * or 0 in case the device does not support the request capability.
403 * The address points to the PCI capability, of type PCI_CAP_ID_HT,
404 * which has a Hypertransport capability matching @ht_cap.
405 */
406int pci_find_ht_capability(struct pci_dev *dev, int ht_cap)
407{
408 int pos;
409
410 pos = __pci_bus_find_cap_start(dev->bus, dev->devfn, dev->hdr_type);
411 if (pos)
412 pos = __pci_find_next_ht_cap(dev, pos, ht_cap);
413
414 return pos;
415}
416EXPORT_SYMBOL_GPL(pci_find_ht_capability);
417
Linus Torvalds1da177e2005-04-16 15:20:36 -0700418/**
419 * pci_find_parent_resource - return resource region of parent bus of given region
420 * @dev: PCI device structure contains resources to be searched
421 * @res: child resource record for which parent is sought
422 *
423 * For given resource region of given device, return the resource
424 * region of parent bus the given region is contained in or where
425 * it should be allocated from.
426 */
427struct resource *
428pci_find_parent_resource(const struct pci_dev *dev, struct resource *res)
429{
430 const struct pci_bus *bus = dev->bus;
431 int i;
Bjorn Helgaas89a74ec2010-02-23 10:24:31 -0700432 struct resource *best = NULL, *r;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700433
Bjorn Helgaas89a74ec2010-02-23 10:24:31 -0700434 pci_bus_for_each_resource(bus, r, i) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700435 if (!r)
436 continue;
437 if (res->start && !(res->start >= r->start && res->end <= r->end))
438 continue; /* Not contained */
439 if ((res->flags ^ r->flags) & (IORESOURCE_IO | IORESOURCE_MEM))
440 continue; /* Wrong type */
441 if (!((res->flags ^ r->flags) & IORESOURCE_PREFETCH))
442 return r; /* Exact match */
Linus Torvalds8c8def22009-11-09 12:04:32 -0800443 /* We can't insert a non-prefetch resource inside a prefetchable parent .. */
444 if (r->flags & IORESOURCE_PREFETCH)
445 continue;
446 /* .. but we can put a prefetchable resource inside a non-prefetchable one */
447 if (!best)
448 best = r;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700449 }
450 return best;
451}
452
453/**
John W. Linville064b53db2005-07-27 10:19:44 -0400454 * pci_restore_bars - restore a devices BAR values (e.g. after wake-up)
455 * @dev: PCI device to have its BARs restored
456 *
457 * Restore the BAR values for a given device, so as to make it
458 * accessible by its driver.
459 */
Adrian Bunkad6685992007-10-27 03:06:22 +0200460static void
John W. Linville064b53db2005-07-27 10:19:44 -0400461pci_restore_bars(struct pci_dev *dev)
462{
Yu Zhaobc5f5a82008-11-22 02:40:00 +0800463 int i;
John W. Linville064b53db2005-07-27 10:19:44 -0400464
Yu Zhaobc5f5a82008-11-22 02:40:00 +0800465 for (i = 0; i < PCI_BRIDGE_RESOURCES; i++)
Yu Zhao14add802008-11-22 02:38:52 +0800466 pci_update_resource(dev, i);
John W. Linville064b53db2005-07-27 10:19:44 -0400467}
468
Rafael J. Wysocki961d9122008-07-07 03:32:02 +0200469static struct pci_platform_pm_ops *pci_platform_pm;
470
471int pci_set_platform_pm(struct pci_platform_pm_ops *ops)
472{
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +0200473 if (!ops->is_manageable || !ops->set_state || !ops->choose_state
474 || !ops->sleep_wake || !ops->can_wakeup)
Rafael J. Wysocki961d9122008-07-07 03:32:02 +0200475 return -EINVAL;
476 pci_platform_pm = ops;
477 return 0;
478}
479
480static inline bool platform_pci_power_manageable(struct pci_dev *dev)
481{
482 return pci_platform_pm ? pci_platform_pm->is_manageable(dev) : false;
483}
484
485static inline int platform_pci_set_power_state(struct pci_dev *dev,
486 pci_power_t t)
487{
488 return pci_platform_pm ? pci_platform_pm->set_state(dev, t) : -ENOSYS;
489}
490
491static inline pci_power_t platform_pci_choose_state(struct pci_dev *dev)
492{
493 return pci_platform_pm ?
494 pci_platform_pm->choose_state(dev) : PCI_POWER_ERROR;
495}
Randy Dunlap8f7020d2005-10-23 11:57:38 -0700496
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +0200497static inline bool platform_pci_can_wakeup(struct pci_dev *dev)
498{
499 return pci_platform_pm ? pci_platform_pm->can_wakeup(dev) : false;
500}
501
502static inline int platform_pci_sleep_wake(struct pci_dev *dev, bool enable)
503{
504 return pci_platform_pm ?
505 pci_platform_pm->sleep_wake(dev, enable) : -ENODEV;
506}
507
Rafael J. Wysockib67ea762010-02-17 23:44:09 +0100508static inline int platform_pci_run_wake(struct pci_dev *dev, bool enable)
509{
510 return pci_platform_pm ?
511 pci_platform_pm->run_wake(dev, enable) : -ENODEV;
512}
513
John W. Linville064b53db2005-07-27 10:19:44 -0400514/**
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200515 * pci_raw_set_power_state - Use PCI PM registers to set the power state of
516 * given PCI device
517 * @dev: PCI device to handle.
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200518 * @state: PCI power state (D0, D1, D2, D3hot) to put the device into.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700519 *
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200520 * RETURN VALUE:
521 * -EINVAL if the requested state is invalid.
522 * -EIO if device does not support PCI PM or its PM capabilities register has a
523 * wrong version, or device doesn't support the requested state.
524 * 0 if device already is in the requested state.
525 * 0 if device's power state has been successfully changed.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700526 */
Rafael J. Wysockif00a20e2009-03-16 22:40:08 +0100527static int pci_raw_set_power_state(struct pci_dev *dev, pci_power_t state)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700528{
Rafael J. Wysocki337001b2008-07-07 03:36:24 +0200529 u16 pmcsr;
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200530 bool need_restore = false;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700531
Rafael J. Wysocki4a865902009-03-16 22:40:36 +0100532 /* Check if we're already there */
533 if (dev->current_state == state)
534 return 0;
535
Rafael J. Wysocki337001b2008-07-07 03:36:24 +0200536 if (!dev->pm_cap)
Andrew Lunncca03de2007-07-09 11:55:58 -0700537 return -EIO;
538
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200539 if (state < PCI_D0 || state > PCI_D3hot)
540 return -EINVAL;
541
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542 /* Validate current state:
543 * Can enter D0 from any state, but if we can only go deeper
544 * to sleep if we're already in a low power state
545 */
Rafael J. Wysocki4a865902009-03-16 22:40:36 +0100546 if (state != PCI_D0 && dev->current_state <= PCI_D3cold
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200547 && dev->current_state > state) {
Bjorn Helgaas80ccba12008-06-13 10:52:11 -0600548 dev_err(&dev->dev, "invalid power transition "
549 "(from state %d to %d)\n", dev->current_state, state);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700550 return -EINVAL;
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200551 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700552
Linus Torvalds1da177e2005-04-16 15:20:36 -0700553 /* check if this device supports the desired state */
Rafael J. Wysocki337001b2008-07-07 03:36:24 +0200554 if ((state == PCI_D1 && !dev->d1_support)
555 || (state == PCI_D2 && !dev->d2_support))
Daniel Ritz3fe9d192005-08-17 15:32:19 -0700556 return -EIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700557
Rafael J. Wysocki337001b2008-07-07 03:36:24 +0200558 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
John W. Linville064b53db2005-07-27 10:19:44 -0400559
John W. Linville32a36582005-09-14 09:52:42 -0400560 /* If we're (effectively) in D3, force entire word to 0.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700561 * This doesn't affect PME_Status, disables PME_En, and
562 * sets PowerState to 0.
563 */
John W. Linville32a36582005-09-14 09:52:42 -0400564 switch (dev->current_state) {
John W. Linvilled3535fb2005-09-28 17:50:51 -0400565 case PCI_D0:
566 case PCI_D1:
567 case PCI_D2:
568 pmcsr &= ~PCI_PM_CTRL_STATE_MASK;
569 pmcsr |= state;
570 break;
Rafael J. Wysockif62795f2009-05-18 22:51:12 +0200571 case PCI_D3hot:
572 case PCI_D3cold:
John W. Linville32a36582005-09-14 09:52:42 -0400573 case PCI_UNKNOWN: /* Boot-up */
574 if ((pmcsr & PCI_PM_CTRL_STATE_MASK) == PCI_D3hot
Rafael J. Wysockif00a20e2009-03-16 22:40:08 +0100575 && !(pmcsr & PCI_PM_CTRL_NO_SOFT_RESET))
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200576 need_restore = true;
John W. Linville32a36582005-09-14 09:52:42 -0400577 /* Fall-through: force to D0 */
John W. Linville32a36582005-09-14 09:52:42 -0400578 default:
John W. Linvilled3535fb2005-09-28 17:50:51 -0400579 pmcsr = 0;
John W. Linville32a36582005-09-14 09:52:42 -0400580 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700581 }
582
583 /* enter specified state */
Rafael J. Wysocki337001b2008-07-07 03:36:24 +0200584 pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, pmcsr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700585
586 /* Mandatory power management transition delays */
587 /* see PCI PM 1.1 5.6.1 table 18 */
588 if (state == PCI_D3hot || dev->current_state == PCI_D3hot)
Rafael J. Wysocki1ae861e2009-12-31 12:15:54 +0100589 pci_dev_d3_sleep(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700590 else if (state == PCI_D2 || dev->current_state == PCI_D2)
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100591 udelay(PCI_PM_D2_DELAY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700592
Rafael J. Wysockie13cdbd2009-10-05 00:48:40 +0200593 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
594 dev->current_state = (pmcsr & PCI_PM_CTRL_STATE_MASK);
595 if (dev->current_state != state && printk_ratelimit())
596 dev_info(&dev->dev, "Refused to change power state, "
597 "currently in D%d\n", dev->current_state);
John W. Linville064b53db2005-07-27 10:19:44 -0400598
599 /* According to section 5.4.1 of the "PCI BUS POWER MANAGEMENT
600 * INTERFACE SPECIFICATION, REV. 1.2", a device transitioning
601 * from D3hot to D0 _may_ perform an internal reset, thereby
602 * going to "D0 Uninitialized" rather than "D0 Initialized".
603 * For example, at least some versions of the 3c905B and the
604 * 3c556B exhibit this behaviour.
605 *
606 * At least some laptop BIOSen (e.g. the Thinkpad T21) leave
607 * devices in a D3hot state at boot. Consequently, we need to
608 * restore at least the BARs so that the device will be
609 * accessible to its driver.
610 */
611 if (need_restore)
612 pci_restore_bars(dev);
613
Rafael J. Wysockif00a20e2009-03-16 22:40:08 +0100614 if (dev->bus->self)
Shaohua Li7d715a62008-02-25 09:46:41 +0800615 pcie_aspm_pm_state_change(dev->bus->self);
616
Linus Torvalds1da177e2005-04-16 15:20:36 -0700617 return 0;
618}
619
620/**
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200621 * pci_update_current_state - Read PCI power state of given device from its
622 * PCI PM registers and cache it
623 * @dev: PCI device to handle.
Rafael J. Wysockif06fc0b2008-12-27 16:30:52 +0100624 * @state: State to cache in case the device doesn't have the PM capability
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200625 */
Rafael J. Wysocki734104292009-01-07 13:07:15 +0100626void pci_update_current_state(struct pci_dev *dev, pci_power_t state)
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200627{
Rafael J. Wysocki337001b2008-07-07 03:36:24 +0200628 if (dev->pm_cap) {
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200629 u16 pmcsr;
630
Rafael J. Wysocki337001b2008-07-07 03:36:24 +0200631 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200632 dev->current_state = (pmcsr & PCI_PM_CTRL_STATE_MASK);
Rafael J. Wysockif06fc0b2008-12-27 16:30:52 +0100633 } else {
634 dev->current_state = state;
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200635 }
636}
637
638/**
Rafael J. Wysocki0e5dd462009-03-26 22:51:40 +0100639 * pci_platform_power_transition - Use platform to change device power state
640 * @dev: PCI device to handle.
641 * @state: State to put the device into.
642 */
643static int pci_platform_power_transition(struct pci_dev *dev, pci_power_t state)
644{
645 int error;
646
647 if (platform_pci_power_manageable(dev)) {
648 error = platform_pci_set_power_state(dev, state);
649 if (!error)
650 pci_update_current_state(dev, state);
651 } else {
652 error = -ENODEV;
653 /* Fall back to PCI_D0 if native PM is not supported */
Rafael J. Wysockib3bad722009-05-17 20:17:06 +0200654 if (!dev->pm_cap)
655 dev->current_state = PCI_D0;
Rafael J. Wysocki0e5dd462009-03-26 22:51:40 +0100656 }
657
658 return error;
659}
660
661/**
662 * __pci_start_power_transition - Start power transition of a PCI device
663 * @dev: PCI device to handle.
664 * @state: State to put the device into.
665 */
666static void __pci_start_power_transition(struct pci_dev *dev, pci_power_t state)
667{
668 if (state == PCI_D0)
669 pci_platform_power_transition(dev, PCI_D0);
670}
671
672/**
673 * __pci_complete_power_transition - Complete power transition of a PCI device
674 * @dev: PCI device to handle.
675 * @state: State to put the device into.
676 *
677 * This function should not be called directly by device drivers.
678 */
679int __pci_complete_power_transition(struct pci_dev *dev, pci_power_t state)
680{
681 return state > PCI_D0 ?
682 pci_platform_power_transition(dev, state) : -EINVAL;
683}
684EXPORT_SYMBOL_GPL(__pci_complete_power_transition);
685
686/**
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200687 * pci_set_power_state - Set the power state of a PCI device
688 * @dev: PCI device to handle.
689 * @state: PCI power state (D0, D1, D2, D3hot) to put the device into.
690 *
Nick Andrew877d0312009-01-26 11:06:57 +0100691 * Transition a device to a new power state, using the platform firmware and/or
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200692 * the device's PCI PM registers.
693 *
694 * RETURN VALUE:
695 * -EINVAL if the requested state is invalid.
696 * -EIO if device does not support PCI PM or its PM capabilities register has a
697 * wrong version, or device doesn't support the requested state.
698 * 0 if device already is in the requested state.
699 * 0 if device's power state has been successfully changed.
700 */
701int pci_set_power_state(struct pci_dev *dev, pci_power_t state)
702{
Rafael J. Wysocki337001b2008-07-07 03:36:24 +0200703 int error;
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200704
705 /* bound the state we're entering */
706 if (state > PCI_D3hot)
707 state = PCI_D3hot;
708 else if (state < PCI_D0)
709 state = PCI_D0;
710 else if ((state == PCI_D1 || state == PCI_D2) && pci_no_d1d2(dev))
711 /*
712 * If the device or the parent bridge do not support PCI PM,
713 * ignore the request if we're doing anything other than putting
714 * it into D0 (which would only happen on boot).
715 */
716 return 0;
717
Rafael J. Wysocki4a865902009-03-16 22:40:36 +0100718 /* Check if we're already there */
719 if (dev->current_state == state)
720 return 0;
721
Rafael J. Wysocki0e5dd462009-03-26 22:51:40 +0100722 __pci_start_power_transition(dev, state);
723
Alan Cox979b1792008-07-24 17:18:38 +0100724 /* This device is quirked not to be put into D3, so
725 don't put it in D3 */
726 if (state == PCI_D3hot && (dev->dev_flags & PCI_DEV_FLAGS_NO_D3))
727 return 0;
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200728
Rafael J. Wysockif00a20e2009-03-16 22:40:08 +0100729 error = pci_raw_set_power_state(dev, state);
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200730
Rafael J. Wysocki0e5dd462009-03-26 22:51:40 +0100731 if (!__pci_complete_power_transition(dev, state))
732 error = 0;
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200733
734 return error;
735}
736
737/**
Linus Torvalds1da177e2005-04-16 15:20:36 -0700738 * pci_choose_state - Choose the power state of a PCI device
739 * @dev: PCI device to be suspended
740 * @state: target sleep state for the whole system. This is the value
741 * that is passed to suspend() function.
742 *
743 * Returns PCI power state suitable for given device and given system
744 * message.
745 */
746
747pci_power_t pci_choose_state(struct pci_dev *dev, pm_message_t state)
748{
Shaohua Liab826ca2007-07-20 10:03:22 +0800749 pci_power_t ret;
David Shaohua Li0f644742005-03-19 00:15:48 -0500750
Linus Torvalds1da177e2005-04-16 15:20:36 -0700751 if (!pci_find_capability(dev, PCI_CAP_ID_PM))
752 return PCI_D0;
753
Rafael J. Wysocki961d9122008-07-07 03:32:02 +0200754 ret = platform_pci_choose_state(dev);
755 if (ret != PCI_POWER_ERROR)
756 return ret;
Pavel Machekca078ba2005-09-03 15:56:57 -0700757
758 switch (state.event) {
759 case PM_EVENT_ON:
760 return PCI_D0;
761 case PM_EVENT_FREEZE:
David Brownellb887d2e2006-08-14 23:11:05 -0700762 case PM_EVENT_PRETHAW:
763 /* REVISIT both freeze and pre-thaw "should" use D0 */
Pavel Machekca078ba2005-09-03 15:56:57 -0700764 case PM_EVENT_SUSPEND:
Rafael J. Wysocki3a2d5b72008-02-23 19:13:25 +0100765 case PM_EVENT_HIBERNATE:
Pavel Machekca078ba2005-09-03 15:56:57 -0700766 return PCI_D3hot;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700767 default:
Bjorn Helgaas80ccba12008-06-13 10:52:11 -0600768 dev_info(&dev->dev, "unrecognized suspend event %d\n",
769 state.event);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700770 BUG();
771 }
772 return PCI_D0;
773}
774
775EXPORT_SYMBOL(pci_choose_state);
776
Yu Zhao89858512009-02-16 02:55:47 +0800777#define PCI_EXP_SAVE_REGS 7
778
Yu Zhao1b6b8ce2009-04-09 14:57:39 +0800779#define pcie_cap_has_devctl(type, flags) 1
780#define pcie_cap_has_lnkctl(type, flags) \
781 ((flags & PCI_EXP_FLAGS_VERS) > 1 || \
782 (type == PCI_EXP_TYPE_ROOT_PORT || \
783 type == PCI_EXP_TYPE_ENDPOINT || \
784 type == PCI_EXP_TYPE_LEG_END))
785#define pcie_cap_has_sltctl(type, flags) \
786 ((flags & PCI_EXP_FLAGS_VERS) > 1 || \
787 ((type == PCI_EXP_TYPE_ROOT_PORT) || \
788 (type == PCI_EXP_TYPE_DOWNSTREAM && \
789 (flags & PCI_EXP_FLAGS_SLOT))))
790#define pcie_cap_has_rtctl(type, flags) \
791 ((flags & PCI_EXP_FLAGS_VERS) > 1 || \
792 (type == PCI_EXP_TYPE_ROOT_PORT || \
793 type == PCI_EXP_TYPE_RC_EC))
794#define pcie_cap_has_devctl2(type, flags) \
795 ((flags & PCI_EXP_FLAGS_VERS) > 1)
796#define pcie_cap_has_lnkctl2(type, flags) \
797 ((flags & PCI_EXP_FLAGS_VERS) > 1)
798#define pcie_cap_has_sltctl2(type, flags) \
799 ((flags & PCI_EXP_FLAGS_VERS) > 1)
800
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300801static int pci_save_pcie_state(struct pci_dev *dev)
802{
803 int pos, i = 0;
804 struct pci_cap_saved_state *save_state;
805 u16 *cap;
Yu Zhao1b6b8ce2009-04-09 14:57:39 +0800806 u16 flags;
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300807
Kenji Kaneshige06a1cba2009-11-11 14:30:56 +0900808 pos = pci_pcie_cap(dev);
809 if (!pos)
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300810 return 0;
811
Eric W. Biederman9f355752007-03-08 13:06:13 -0700812 save_state = pci_find_saved_cap(dev, PCI_CAP_ID_EXP);
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300813 if (!save_state) {
Harvey Harrisone496b612009-01-07 16:22:37 -0800814 dev_err(&dev->dev, "buffer not found in %s\n", __func__);
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300815 return -ENOMEM;
816 }
817 cap = (u16 *)&save_state->data[0];
818
Yu Zhao1b6b8ce2009-04-09 14:57:39 +0800819 pci_read_config_word(dev, pos + PCI_EXP_FLAGS, &flags);
820
821 if (pcie_cap_has_devctl(dev->pcie_type, flags))
822 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL, &cap[i++]);
823 if (pcie_cap_has_lnkctl(dev->pcie_type, flags))
824 pci_read_config_word(dev, pos + PCI_EXP_LNKCTL, &cap[i++]);
825 if (pcie_cap_has_sltctl(dev->pcie_type, flags))
826 pci_read_config_word(dev, pos + PCI_EXP_SLTCTL, &cap[i++]);
827 if (pcie_cap_has_rtctl(dev->pcie_type, flags))
828 pci_read_config_word(dev, pos + PCI_EXP_RTCTL, &cap[i++]);
829 if (pcie_cap_has_devctl2(dev->pcie_type, flags))
830 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL2, &cap[i++]);
831 if (pcie_cap_has_lnkctl2(dev->pcie_type, flags))
832 pci_read_config_word(dev, pos + PCI_EXP_LNKCTL2, &cap[i++]);
833 if (pcie_cap_has_sltctl2(dev->pcie_type, flags))
834 pci_read_config_word(dev, pos + PCI_EXP_SLTCTL2, &cap[i++]);
Rafael J. Wysocki63f48982008-12-07 22:02:58 +0100835
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300836 return 0;
837}
838
839static void pci_restore_pcie_state(struct pci_dev *dev)
840{
841 int i = 0, pos;
842 struct pci_cap_saved_state *save_state;
843 u16 *cap;
Yu Zhao1b6b8ce2009-04-09 14:57:39 +0800844 u16 flags;
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300845
846 save_state = pci_find_saved_cap(dev, PCI_CAP_ID_EXP);
847 pos = pci_find_capability(dev, PCI_CAP_ID_EXP);
848 if (!save_state || pos <= 0)
849 return;
850 cap = (u16 *)&save_state->data[0];
851
Yu Zhao1b6b8ce2009-04-09 14:57:39 +0800852 pci_read_config_word(dev, pos + PCI_EXP_FLAGS, &flags);
853
854 if (pcie_cap_has_devctl(dev->pcie_type, flags))
855 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL, cap[i++]);
856 if (pcie_cap_has_lnkctl(dev->pcie_type, flags))
857 pci_write_config_word(dev, pos + PCI_EXP_LNKCTL, cap[i++]);
858 if (pcie_cap_has_sltctl(dev->pcie_type, flags))
859 pci_write_config_word(dev, pos + PCI_EXP_SLTCTL, cap[i++]);
860 if (pcie_cap_has_rtctl(dev->pcie_type, flags))
861 pci_write_config_word(dev, pos + PCI_EXP_RTCTL, cap[i++]);
862 if (pcie_cap_has_devctl2(dev->pcie_type, flags))
863 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL2, cap[i++]);
864 if (pcie_cap_has_lnkctl2(dev->pcie_type, flags))
865 pci_write_config_word(dev, pos + PCI_EXP_LNKCTL2, cap[i++]);
866 if (pcie_cap_has_sltctl2(dev->pcie_type, flags))
867 pci_write_config_word(dev, pos + PCI_EXP_SLTCTL2, cap[i++]);
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300868}
869
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800870
871static int pci_save_pcix_state(struct pci_dev *dev)
872{
Rafael J. Wysocki63f48982008-12-07 22:02:58 +0100873 int pos;
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800874 struct pci_cap_saved_state *save_state;
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800875
876 pos = pci_find_capability(dev, PCI_CAP_ID_PCIX);
877 if (pos <= 0)
878 return 0;
879
Shaohua Lif34303d2007-12-18 09:56:47 +0800880 save_state = pci_find_saved_cap(dev, PCI_CAP_ID_PCIX);
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800881 if (!save_state) {
Harvey Harrisone496b612009-01-07 16:22:37 -0800882 dev_err(&dev->dev, "buffer not found in %s\n", __func__);
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800883 return -ENOMEM;
884 }
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800885
Rafael J. Wysocki63f48982008-12-07 22:02:58 +0100886 pci_read_config_word(dev, pos + PCI_X_CMD, (u16 *)save_state->data);
887
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800888 return 0;
889}
890
891static void pci_restore_pcix_state(struct pci_dev *dev)
892{
893 int i = 0, pos;
894 struct pci_cap_saved_state *save_state;
895 u16 *cap;
896
897 save_state = pci_find_saved_cap(dev, PCI_CAP_ID_PCIX);
898 pos = pci_find_capability(dev, PCI_CAP_ID_PCIX);
899 if (!save_state || pos <= 0)
900 return;
901 cap = (u16 *)&save_state->data[0];
902
903 pci_write_config_word(dev, pos + PCI_X_CMD, cap[i++]);
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800904}
905
906
Linus Torvalds1da177e2005-04-16 15:20:36 -0700907/**
908 * pci_save_state - save the PCI configuration space of a device before suspending
909 * @dev: - PCI device that we're dealing with
Linus Torvalds1da177e2005-04-16 15:20:36 -0700910 */
911int
912pci_save_state(struct pci_dev *dev)
913{
914 int i;
915 /* XXX: 100% dword access ok here? */
916 for (i = 0; i < 16; i++)
Kleber Sacilotto de Souza9e0b5b22009-11-25 00:55:51 -0200917 pci_read_config_dword(dev, i * 4, &dev->saved_config_space[i]);
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100918 dev->state_saved = true;
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300919 if ((i = pci_save_pcie_state(dev)) != 0)
920 return i;
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800921 if ((i = pci_save_pcix_state(dev)) != 0)
922 return i;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700923 return 0;
924}
925
926/**
927 * pci_restore_state - Restore the saved state of a PCI device
928 * @dev: - PCI device that we're dealing with
Linus Torvalds1da177e2005-04-16 15:20:36 -0700929 */
930int
931pci_restore_state(struct pci_dev *dev)
932{
933 int i;
Al Virob4482a42007-10-14 19:35:40 +0100934 u32 val;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700935
Alek Duc82f63e2009-08-08 08:46:19 +0800936 if (!dev->state_saved)
937 return 0;
Rafael J. Wysocki4b77b0a2009-09-09 23:49:59 +0200938
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300939 /* PCI Express register must be restored first */
940 pci_restore_pcie_state(dev);
941
Yu, Luming8b8c8d22006-04-25 00:00:34 -0700942 /*
943 * The Base Address register should be programmed before the command
944 * register(s)
945 */
946 for (i = 15; i >= 0; i--) {
Dave Jones04d9c1a2006-04-18 21:06:51 -0700947 pci_read_config_dword(dev, i * 4, &val);
948 if (val != dev->saved_config_space[i]) {
Bjorn Helgaas80ccba12008-06-13 10:52:11 -0600949 dev_printk(KERN_DEBUG, &dev->dev, "restoring config "
950 "space at offset %#x (was %#x, writing %#x)\n",
951 i, val, (int)dev->saved_config_space[i]);
Dave Jones04d9c1a2006-04-18 21:06:51 -0700952 pci_write_config_dword(dev,i * 4,
953 dev->saved_config_space[i]);
954 }
955 }
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800956 pci_restore_pcix_state(dev);
Shaohua Li41017f02006-02-08 17:11:38 +0800957 pci_restore_msi_state(dev);
Yu Zhao8c5cdb62009-03-20 11:25:12 +0800958 pci_restore_iov_state(dev);
Michael Ellerman8fed4b62007-01-25 19:34:08 +1100959
Rafael J. Wysocki4b77b0a2009-09-09 23:49:59 +0200960 dev->state_saved = false;
961
Linus Torvalds1da177e2005-04-16 15:20:36 -0700962 return 0;
963}
964
Hidetoshi Seto38cc1302006-12-18 10:30:00 +0900965static int do_pci_enable_device(struct pci_dev *dev, int bars)
966{
967 int err;
968
969 err = pci_set_power_state(dev, PCI_D0);
970 if (err < 0 && err != -EIO)
971 return err;
972 err = pcibios_enable_device(dev, bars);
973 if (err < 0)
974 return err;
975 pci_fixup_device(pci_fixup_enable, dev);
976
977 return 0;
978}
979
980/**
Tejun Heo0b62e132007-07-27 14:43:35 +0900981 * pci_reenable_device - Resume abandoned device
Hidetoshi Seto38cc1302006-12-18 10:30:00 +0900982 * @dev: PCI device to be resumed
983 *
984 * Note this function is a backend of pci_default_resume and is not supposed
985 * to be called by normal code, write proper resume handler and use it instead.
986 */
Tejun Heo0b62e132007-07-27 14:43:35 +0900987int pci_reenable_device(struct pci_dev *dev)
Hidetoshi Seto38cc1302006-12-18 10:30:00 +0900988{
Yuji Shimada296ccb02009-04-03 16:41:46 +0900989 if (pci_is_enabled(dev))
Hidetoshi Seto38cc1302006-12-18 10:30:00 +0900990 return do_pci_enable_device(dev, (1 << PCI_NUM_RESOURCES) - 1);
991 return 0;
992}
993
Benjamin Herrenschmidtb7189892007-12-20 15:28:08 +1100994static int __pci_enable_device_flags(struct pci_dev *dev,
995 resource_size_t flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700996{
997 int err;
Benjamin Herrenschmidtb7189892007-12-20 15:28:08 +1100998 int i, bars = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700999
Hidetoshi Seto9fb625c2006-12-18 10:28:43 +09001000 if (atomic_add_return(1, &dev->enable_cnt) > 1)
1001 return 0; /* already enabled */
1002
Benjamin Herrenschmidtb7189892007-12-20 15:28:08 +11001003 for (i = 0; i < DEVICE_COUNT_RESOURCE; i++)
1004 if (dev->resource[i].flags & flags)
1005 bars |= (1 << i);
1006
Hidetoshi Seto38cc1302006-12-18 10:30:00 +09001007 err = do_pci_enable_device(dev, bars);
Greg Kroah-Hartman95a62962005-07-28 11:37:33 -07001008 if (err < 0)
Hidetoshi Seto38cc1302006-12-18 10:30:00 +09001009 atomic_dec(&dev->enable_cnt);
Hidetoshi Seto9fb625c2006-12-18 10:28:43 +09001010 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001011}
1012
1013/**
Benjamin Herrenschmidtb7189892007-12-20 15:28:08 +11001014 * pci_enable_device_io - Initialize a device for use with IO space
1015 * @dev: PCI device to be initialized
1016 *
1017 * Initialize device before it's used by a driver. Ask low-level code
1018 * to enable I/O resources. Wake up the device if it was suspended.
1019 * Beware, this function can fail.
1020 */
1021int pci_enable_device_io(struct pci_dev *dev)
1022{
1023 return __pci_enable_device_flags(dev, IORESOURCE_IO);
1024}
1025
1026/**
1027 * pci_enable_device_mem - Initialize a device for use with Memory space
1028 * @dev: PCI device to be initialized
1029 *
1030 * Initialize device before it's used by a driver. Ask low-level code
1031 * to enable Memory resources. Wake up the device if it was suspended.
1032 * Beware, this function can fail.
1033 */
1034int pci_enable_device_mem(struct pci_dev *dev)
1035{
1036 return __pci_enable_device_flags(dev, IORESOURCE_MEM);
1037}
1038
Linus Torvalds1da177e2005-04-16 15:20:36 -07001039/**
1040 * pci_enable_device - Initialize device before it's used by a driver.
1041 * @dev: PCI device to be initialized
1042 *
1043 * Initialize device before it's used by a driver. Ask low-level code
1044 * to enable I/O and memory. Wake up the device if it was suspended.
1045 * Beware, this function can fail.
Inaky Perez-Gonzalezbae94d02006-11-22 12:40:31 -08001046 *
1047 * Note we don't actually enable the device many times if we call
1048 * this function repeatedly (we just increment the count).
Linus Torvalds1da177e2005-04-16 15:20:36 -07001049 */
Inaky Perez-Gonzalezbae94d02006-11-22 12:40:31 -08001050int pci_enable_device(struct pci_dev *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001051{
Benjamin Herrenschmidtb7189892007-12-20 15:28:08 +11001052 return __pci_enable_device_flags(dev, IORESOURCE_MEM | IORESOURCE_IO);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001053}
1054
Tejun Heo9ac78492007-01-20 16:00:26 +09001055/*
1056 * Managed PCI resources. This manages device on/off, intx/msi/msix
1057 * on/off and BAR regions. pci_dev itself records msi/msix status, so
1058 * there's no need to track it separately. pci_devres is initialized
1059 * when a device is enabled using managed PCI device enable interface.
1060 */
1061struct pci_devres {
Tejun Heo7f375f32007-02-25 04:36:01 -08001062 unsigned int enabled:1;
1063 unsigned int pinned:1;
Tejun Heo9ac78492007-01-20 16:00:26 +09001064 unsigned int orig_intx:1;
1065 unsigned int restore_intx:1;
1066 u32 region_mask;
1067};
1068
1069static void pcim_release(struct device *gendev, void *res)
1070{
1071 struct pci_dev *dev = container_of(gendev, struct pci_dev, dev);
1072 struct pci_devres *this = res;
1073 int i;
1074
1075 if (dev->msi_enabled)
1076 pci_disable_msi(dev);
1077 if (dev->msix_enabled)
1078 pci_disable_msix(dev);
1079
1080 for (i = 0; i < DEVICE_COUNT_RESOURCE; i++)
1081 if (this->region_mask & (1 << i))
1082 pci_release_region(dev, i);
1083
1084 if (this->restore_intx)
1085 pci_intx(dev, this->orig_intx);
1086
Tejun Heo7f375f32007-02-25 04:36:01 -08001087 if (this->enabled && !this->pinned)
Tejun Heo9ac78492007-01-20 16:00:26 +09001088 pci_disable_device(dev);
1089}
1090
1091static struct pci_devres * get_pci_dr(struct pci_dev *pdev)
1092{
1093 struct pci_devres *dr, *new_dr;
1094
1095 dr = devres_find(&pdev->dev, pcim_release, NULL, NULL);
1096 if (dr)
1097 return dr;
1098
1099 new_dr = devres_alloc(pcim_release, sizeof(*new_dr), GFP_KERNEL);
1100 if (!new_dr)
1101 return NULL;
1102 return devres_get(&pdev->dev, new_dr, NULL, NULL);
1103}
1104
1105static struct pci_devres * find_pci_dr(struct pci_dev *pdev)
1106{
1107 if (pci_is_managed(pdev))
1108 return devres_find(&pdev->dev, pcim_release, NULL, NULL);
1109 return NULL;
1110}
1111
1112/**
1113 * pcim_enable_device - Managed pci_enable_device()
1114 * @pdev: PCI device to be initialized
1115 *
1116 * Managed pci_enable_device().
1117 */
1118int pcim_enable_device(struct pci_dev *pdev)
1119{
1120 struct pci_devres *dr;
1121 int rc;
1122
1123 dr = get_pci_dr(pdev);
1124 if (unlikely(!dr))
1125 return -ENOMEM;
Tejun Heob95d58e2008-01-30 18:20:04 +09001126 if (dr->enabled)
1127 return 0;
Tejun Heo9ac78492007-01-20 16:00:26 +09001128
1129 rc = pci_enable_device(pdev);
1130 if (!rc) {
1131 pdev->is_managed = 1;
Tejun Heo7f375f32007-02-25 04:36:01 -08001132 dr->enabled = 1;
Tejun Heo9ac78492007-01-20 16:00:26 +09001133 }
1134 return rc;
1135}
1136
1137/**
1138 * pcim_pin_device - Pin managed PCI device
1139 * @pdev: PCI device to pin
1140 *
1141 * Pin managed PCI device @pdev. Pinned device won't be disabled on
1142 * driver detach. @pdev must have been enabled with
1143 * pcim_enable_device().
1144 */
1145void pcim_pin_device(struct pci_dev *pdev)
1146{
1147 struct pci_devres *dr;
1148
1149 dr = find_pci_dr(pdev);
Tejun Heo7f375f32007-02-25 04:36:01 -08001150 WARN_ON(!dr || !dr->enabled);
Tejun Heo9ac78492007-01-20 16:00:26 +09001151 if (dr)
Tejun Heo7f375f32007-02-25 04:36:01 -08001152 dr->pinned = 1;
Tejun Heo9ac78492007-01-20 16:00:26 +09001153}
1154
Linus Torvalds1da177e2005-04-16 15:20:36 -07001155/**
1156 * pcibios_disable_device - disable arch specific PCI resources for device dev
1157 * @dev: the PCI device to disable
1158 *
1159 * Disables architecture specific PCI resources for the device. This
1160 * is the default implementation. Architecture implementations can
1161 * override this.
1162 */
1163void __attribute__ ((weak)) pcibios_disable_device (struct pci_dev *dev) {}
1164
Rafael J. Wysockifa58d302009-01-07 13:03:42 +01001165static void do_pci_disable_device(struct pci_dev *dev)
1166{
1167 u16 pci_command;
1168
1169 pci_read_config_word(dev, PCI_COMMAND, &pci_command);
1170 if (pci_command & PCI_COMMAND_MASTER) {
1171 pci_command &= ~PCI_COMMAND_MASTER;
1172 pci_write_config_word(dev, PCI_COMMAND, pci_command);
1173 }
1174
1175 pcibios_disable_device(dev);
1176}
1177
1178/**
1179 * pci_disable_enabled_device - Disable device without updating enable_cnt
1180 * @dev: PCI device to disable
1181 *
1182 * NOTE: This function is a backend of PCI power management routines and is
1183 * not supposed to be called drivers.
1184 */
1185void pci_disable_enabled_device(struct pci_dev *dev)
1186{
Yuji Shimada296ccb02009-04-03 16:41:46 +09001187 if (pci_is_enabled(dev))
Rafael J. Wysockifa58d302009-01-07 13:03:42 +01001188 do_pci_disable_device(dev);
1189}
1190
Linus Torvalds1da177e2005-04-16 15:20:36 -07001191/**
1192 * pci_disable_device - Disable PCI device after use
1193 * @dev: PCI device to be disabled
1194 *
1195 * Signal to the system that the PCI device is not in use by the system
1196 * anymore. This only involves disabling PCI bus-mastering, if active.
Inaky Perez-Gonzalezbae94d02006-11-22 12:40:31 -08001197 *
1198 * Note we don't actually disable the device until all callers of
1199 * pci_device_enable() have called pci_device_disable().
Linus Torvalds1da177e2005-04-16 15:20:36 -07001200 */
1201void
1202pci_disable_device(struct pci_dev *dev)
1203{
Tejun Heo9ac78492007-01-20 16:00:26 +09001204 struct pci_devres *dr;
Shaohua Li99dc8042006-05-26 10:58:27 +08001205
Tejun Heo9ac78492007-01-20 16:00:26 +09001206 dr = find_pci_dr(dev);
1207 if (dr)
Tejun Heo7f375f32007-02-25 04:36:01 -08001208 dr->enabled = 0;
Tejun Heo9ac78492007-01-20 16:00:26 +09001209
Inaky Perez-Gonzalezbae94d02006-11-22 12:40:31 -08001210 if (atomic_sub_return(1, &dev->enable_cnt) != 0)
1211 return;
1212
Rafael J. Wysockifa58d302009-01-07 13:03:42 +01001213 do_pci_disable_device(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001214
Rafael J. Wysockifa58d302009-01-07 13:03:42 +01001215 dev->is_busmaster = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001216}
1217
1218/**
Brian Kingf7bdd122007-04-06 16:39:36 -05001219 * pcibios_set_pcie_reset_state - set reset state for device dev
Stefan Assmann45e829e2009-12-03 06:49:24 -05001220 * @dev: the PCIe device reset
Brian Kingf7bdd122007-04-06 16:39:36 -05001221 * @state: Reset state to enter into
1222 *
1223 *
Stefan Assmann45e829e2009-12-03 06:49:24 -05001224 * Sets the PCIe reset state for the device. This is the default
Brian Kingf7bdd122007-04-06 16:39:36 -05001225 * implementation. Architecture implementations can override this.
1226 */
1227int __attribute__ ((weak)) pcibios_set_pcie_reset_state(struct pci_dev *dev,
1228 enum pcie_reset_state state)
1229{
1230 return -EINVAL;
1231}
1232
1233/**
1234 * pci_set_pcie_reset_state - set reset state for device dev
Stefan Assmann45e829e2009-12-03 06:49:24 -05001235 * @dev: the PCIe device reset
Brian Kingf7bdd122007-04-06 16:39:36 -05001236 * @state: Reset state to enter into
1237 *
1238 *
1239 * Sets the PCI reset state for the device.
1240 */
1241int pci_set_pcie_reset_state(struct pci_dev *dev, enum pcie_reset_state state)
1242{
1243 return pcibios_set_pcie_reset_state(dev, state);
1244}
1245
1246/**
Rafael J. Wysocki58ff4632010-02-17 23:36:58 +01001247 * pci_check_pme_status - Check if given device has generated PME.
1248 * @dev: Device to check.
1249 *
1250 * Check the PME status of the device and if set, clear it and clear PME enable
1251 * (if set). Return 'true' if PME status and PME enable were both set or
1252 * 'false' otherwise.
1253 */
1254bool pci_check_pme_status(struct pci_dev *dev)
1255{
1256 int pmcsr_pos;
1257 u16 pmcsr;
1258 bool ret = false;
1259
1260 if (!dev->pm_cap)
1261 return false;
1262
1263 pmcsr_pos = dev->pm_cap + PCI_PM_CTRL;
1264 pci_read_config_word(dev, pmcsr_pos, &pmcsr);
1265 if (!(pmcsr & PCI_PM_CTRL_PME_STATUS))
1266 return false;
1267
1268 /* Clear PME status. */
1269 pmcsr |= PCI_PM_CTRL_PME_STATUS;
1270 if (pmcsr & PCI_PM_CTRL_PME_ENABLE) {
1271 /* Disable PME to avoid interrupt flood. */
1272 pmcsr &= ~PCI_PM_CTRL_PME_ENABLE;
1273 ret = true;
1274 }
1275
1276 pci_write_config_word(dev, pmcsr_pos, pmcsr);
1277
1278 return ret;
1279}
1280
1281/**
Rafael J. Wysockib67ea762010-02-17 23:44:09 +01001282 * pci_pme_wakeup - Wake up a PCI device if its PME Status bit is set.
1283 * @dev: Device to handle.
1284 * @ign: Ignored.
1285 *
1286 * Check if @dev has generated PME and queue a resume request for it in that
1287 * case.
1288 */
1289static int pci_pme_wakeup(struct pci_dev *dev, void *ign)
1290{
1291 if (pci_check_pme_status(dev))
1292 pm_request_resume(&dev->dev);
1293 return 0;
1294}
1295
1296/**
1297 * pci_pme_wakeup_bus - Walk given bus and wake up devices on it, if necessary.
1298 * @bus: Top bus of the subtree to walk.
1299 */
1300void pci_pme_wakeup_bus(struct pci_bus *bus)
1301{
1302 if (bus)
1303 pci_walk_bus(bus, pci_pme_wakeup, NULL);
1304}
1305
1306/**
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001307 * pci_pme_capable - check the capability of PCI device to generate PME#
1308 * @dev: PCI device to handle.
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001309 * @state: PCI state from which device will issue PME#.
1310 */
Rafael J. Wysockie5899e12008-07-19 14:39:24 +02001311bool pci_pme_capable(struct pci_dev *dev, pci_power_t state)
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001312{
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001313 if (!dev->pm_cap)
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001314 return false;
1315
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001316 return !!(dev->pme_support & (1 << state));
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001317}
1318
1319/**
1320 * pci_pme_active - enable or disable PCI device's PME# function
1321 * @dev: PCI device to handle.
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001322 * @enable: 'true' to enable PME# generation; 'false' to disable it.
1323 *
1324 * The caller must verify that the device is capable of generating PME# before
1325 * calling this function with @enable equal to 'true'.
1326 */
Rafael J. Wysocki5a6c9b62008-08-08 00:14:24 +02001327void pci_pme_active(struct pci_dev *dev, bool enable)
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001328{
1329 u16 pmcsr;
1330
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001331 if (!dev->pm_cap)
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001332 return;
1333
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001334 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001335 /* Clear PME_Status by writing 1 to it and enable PME# */
1336 pmcsr |= PCI_PM_CTRL_PME_STATUS | PCI_PM_CTRL_PME_ENABLE;
1337 if (!enable)
1338 pmcsr &= ~PCI_PM_CTRL_PME_ENABLE;
1339
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001340 pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, pmcsr);
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001341
Bjorn Helgaas10c3d712009-11-04 10:32:42 -07001342 dev_printk(KERN_DEBUG, &dev->dev, "PME# %s\n",
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001343 enable ? "enabled" : "disabled");
1344}
1345
1346/**
Rafael J. Wysocki6cbf8212010-02-17 23:44:58 +01001347 * __pci_enable_wake - enable PCI device as wakeup event source
David Brownell075c1772007-04-26 00:12:06 -07001348 * @dev: PCI device affected
1349 * @state: PCI state from which device will issue wakeup events
Rafael J. Wysocki6cbf8212010-02-17 23:44:58 +01001350 * @runtime: True if the events are to be generated at run time
David Brownell075c1772007-04-26 00:12:06 -07001351 * @enable: True to enable event generation; false to disable
Linus Torvalds1da177e2005-04-16 15:20:36 -07001352 *
David Brownell075c1772007-04-26 00:12:06 -07001353 * This enables the device as a wakeup event source, or disables it.
1354 * When such events involves platform-specific hooks, those hooks are
1355 * called automatically by this routine.
1356 *
1357 * Devices with legacy power management (no standard PCI PM capabilities)
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001358 * always require such platform hooks.
David Brownell075c1772007-04-26 00:12:06 -07001359 *
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001360 * RETURN VALUE:
1361 * 0 is returned on success
1362 * -EINVAL is returned if device is not supposed to wake up the system
1363 * Error code depending on the platform is returned if both the platform and
1364 * the native mechanism fail to enable the generation of wake-up events
Linus Torvalds1da177e2005-04-16 15:20:36 -07001365 */
Rafael J. Wysocki6cbf8212010-02-17 23:44:58 +01001366int __pci_enable_wake(struct pci_dev *dev, pci_power_t state,
1367 bool runtime, bool enable)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001368{
Rafael J. Wysocki5bcc2fb2009-09-08 23:12:59 +02001369 int ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001370
Rafael J. Wysocki6cbf8212010-02-17 23:44:58 +01001371 if (enable && !runtime && !device_may_wakeup(&dev->dev))
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001372 return -EINVAL;
1373
Rafael J. Wysockie80bb092009-09-08 23:14:49 +02001374 /* Don't do the same thing twice in a row for one device. */
1375 if (!!enable == !!dev->wakeup_prepared)
1376 return 0;
1377
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001378 /*
1379 * According to "PCI System Architecture" 4th ed. by Tom Shanley & Don
1380 * Anderson we should be doing PME# wake enable followed by ACPI wake
1381 * enable. To disable wake-up we call the platform first, for symmetry.
David Brownell075c1772007-04-26 00:12:06 -07001382 */
1383
Rafael J. Wysocki5bcc2fb2009-09-08 23:12:59 +02001384 if (enable) {
1385 int error;
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001386
Rafael J. Wysocki5bcc2fb2009-09-08 23:12:59 +02001387 if (pci_pme_capable(dev, state))
1388 pci_pme_active(dev, true);
1389 else
1390 ret = 1;
Rafael J. Wysocki6cbf8212010-02-17 23:44:58 +01001391 error = runtime ? platform_pci_run_wake(dev, true) :
1392 platform_pci_sleep_wake(dev, true);
Rafael J. Wysocki5bcc2fb2009-09-08 23:12:59 +02001393 if (ret)
1394 ret = error;
Rafael J. Wysockie80bb092009-09-08 23:14:49 +02001395 if (!ret)
1396 dev->wakeup_prepared = true;
Rafael J. Wysocki5bcc2fb2009-09-08 23:12:59 +02001397 } else {
Rafael J. Wysocki6cbf8212010-02-17 23:44:58 +01001398 if (runtime)
1399 platform_pci_run_wake(dev, false);
1400 else
1401 platform_pci_sleep_wake(dev, false);
Rafael J. Wysocki5bcc2fb2009-09-08 23:12:59 +02001402 pci_pme_active(dev, false);
Rafael J. Wysockie80bb092009-09-08 23:14:49 +02001403 dev->wakeup_prepared = false;
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001404 }
1405
Rafael J. Wysocki5bcc2fb2009-09-08 23:12:59 +02001406 return ret;
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001407}
Rafael J. Wysocki6cbf8212010-02-17 23:44:58 +01001408EXPORT_SYMBOL(__pci_enable_wake);
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001409
1410/**
Rafael J. Wysocki0235c4f2008-08-18 21:38:00 +02001411 * pci_wake_from_d3 - enable/disable device to wake up from D3_hot or D3_cold
1412 * @dev: PCI device to prepare
1413 * @enable: True to enable wake-up event generation; false to disable
1414 *
1415 * Many drivers want the device to wake up the system from D3_hot or D3_cold
1416 * and this function allows them to set that up cleanly - pci_enable_wake()
1417 * should not be called twice in a row to enable wake-up due to PCI PM vs ACPI
1418 * ordering constraints.
1419 *
1420 * This function only returns error code if the device is not capable of
1421 * generating PME# from both D3_hot and D3_cold, and the platform is unable to
1422 * enable wake-up power for it.
1423 */
1424int pci_wake_from_d3(struct pci_dev *dev, bool enable)
1425{
1426 return pci_pme_capable(dev, PCI_D3cold) ?
1427 pci_enable_wake(dev, PCI_D3cold, enable) :
1428 pci_enable_wake(dev, PCI_D3hot, enable);
1429}
1430
1431/**
Jesse Barnes37139072008-07-28 11:49:26 -07001432 * pci_target_state - find an appropriate low power state for a given PCI dev
1433 * @dev: PCI device
1434 *
1435 * Use underlying platform code to find a supported low power state for @dev.
1436 * If the platform can't manage @dev, return the deepest state from which it
1437 * can generate wake events, based on any available PME info.
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001438 */
Rafael J. Wysockie5899e12008-07-19 14:39:24 +02001439pci_power_t pci_target_state(struct pci_dev *dev)
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001440{
1441 pci_power_t target_state = PCI_D3hot;
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001442
1443 if (platform_pci_power_manageable(dev)) {
1444 /*
1445 * Call the platform to choose the target state of the device
1446 * and enable wake-up from this state if supported.
1447 */
1448 pci_power_t state = platform_pci_choose_state(dev);
1449
1450 switch (state) {
1451 case PCI_POWER_ERROR:
1452 case PCI_UNKNOWN:
1453 break;
1454 case PCI_D1:
1455 case PCI_D2:
1456 if (pci_no_d1d2(dev))
1457 break;
1458 default:
1459 target_state = state;
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001460 }
Rafael J. Wysockid2abdf62009-06-14 21:25:02 +02001461 } else if (!dev->pm_cap) {
1462 target_state = PCI_D0;
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001463 } else if (device_may_wakeup(&dev->dev)) {
1464 /*
1465 * Find the deepest state from which the device can generate
1466 * wake-up events, make it the target state and enable device
1467 * to generate PME#.
1468 */
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001469 if (dev->pme_support) {
1470 while (target_state
1471 && !(dev->pme_support & (1 << target_state)))
1472 target_state--;
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001473 }
1474 }
1475
Rafael J. Wysockie5899e12008-07-19 14:39:24 +02001476 return target_state;
1477}
1478
1479/**
1480 * pci_prepare_to_sleep - prepare PCI device for system-wide transition into a sleep state
1481 * @dev: Device to handle.
1482 *
1483 * Choose the power state appropriate for the device depending on whether
1484 * it can wake up the system and/or is power manageable by the platform
1485 * (PCI_D3hot is the default) and put the device into that state.
1486 */
1487int pci_prepare_to_sleep(struct pci_dev *dev)
1488{
1489 pci_power_t target_state = pci_target_state(dev);
1490 int error;
1491
1492 if (target_state == PCI_POWER_ERROR)
1493 return -EIO;
1494
Rafael J. Wysocki8efb8c72009-03-30 21:46:27 +02001495 pci_enable_wake(dev, target_state, device_may_wakeup(&dev->dev));
Rafael J. Wysockic157dfa2008-07-13 22:45:06 +02001496
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001497 error = pci_set_power_state(dev, target_state);
1498
1499 if (error)
1500 pci_enable_wake(dev, target_state, false);
1501
1502 return error;
1503}
1504
1505/**
Randy Dunlap443bd1c2008-07-21 09:27:18 -07001506 * pci_back_from_sleep - turn PCI device on during system-wide transition into working state
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001507 * @dev: Device to handle.
1508 *
1509 * Disable device's sytem wake-up capability and put it into D0.
1510 */
1511int pci_back_from_sleep(struct pci_dev *dev)
1512{
1513 pci_enable_wake(dev, PCI_D0, false);
1514 return pci_set_power_state(dev, PCI_D0);
1515}
1516
1517/**
Rafael J. Wysocki6cbf8212010-02-17 23:44:58 +01001518 * pci_finish_runtime_suspend - Carry out PCI-specific part of runtime suspend.
1519 * @dev: PCI device being suspended.
1520 *
1521 * Prepare @dev to generate wake-up events at run time and put it into a low
1522 * power state.
1523 */
1524int pci_finish_runtime_suspend(struct pci_dev *dev)
1525{
1526 pci_power_t target_state = pci_target_state(dev);
1527 int error;
1528
1529 if (target_state == PCI_POWER_ERROR)
1530 return -EIO;
1531
1532 __pci_enable_wake(dev, target_state, true, pci_dev_run_wake(dev));
1533
1534 error = pci_set_power_state(dev, target_state);
1535
1536 if (error)
1537 __pci_enable_wake(dev, target_state, true, false);
1538
1539 return error;
1540}
1541
1542/**
Rafael J. Wysockib67ea762010-02-17 23:44:09 +01001543 * pci_dev_run_wake - Check if device can generate run-time wake-up events.
1544 * @dev: Device to check.
1545 *
1546 * Return true if the device itself is cabable of generating wake-up events
1547 * (through the platform or using the native PCIe PME) or if the device supports
1548 * PME and one of its upstream bridges can generate wake-up events.
1549 */
1550bool pci_dev_run_wake(struct pci_dev *dev)
1551{
1552 struct pci_bus *bus = dev->bus;
1553
1554 if (device_run_wake(&dev->dev))
1555 return true;
1556
1557 if (!dev->pme_support)
1558 return false;
1559
1560 while (bus->parent) {
1561 struct pci_dev *bridge = bus->self;
1562
1563 if (device_run_wake(&bridge->dev))
1564 return true;
1565
1566 bus = bus->parent;
1567 }
1568
1569 /* We have reached the root bus. */
1570 if (bus->bridge)
1571 return device_run_wake(bus->bridge);
1572
1573 return false;
1574}
1575EXPORT_SYMBOL_GPL(pci_dev_run_wake);
1576
1577/**
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001578 * pci_pm_init - Initialize PM functions of given PCI device
1579 * @dev: PCI device to handle.
1580 */
1581void pci_pm_init(struct pci_dev *dev)
1582{
1583 int pm;
1584 u16 pmc;
David Brownell075c1772007-04-26 00:12:06 -07001585
Rafael J. Wysockia1e4d722010-02-08 19:16:33 +01001586 device_enable_async_suspend(&dev->dev);
Rafael J. Wysockie80bb092009-09-08 23:14:49 +02001587 dev->wakeup_prepared = false;
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001588 dev->pm_cap = 0;
1589
Linus Torvalds1da177e2005-04-16 15:20:36 -07001590 /* find PCI PM capability in list */
1591 pm = pci_find_capability(dev, PCI_CAP_ID_PM);
David Brownell075c1772007-04-26 00:12:06 -07001592 if (!pm)
Linus Torvalds50246dd2009-01-16 08:14:51 -08001593 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001594 /* Check device's ability to generate PME# */
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001595 pci_read_config_word(dev, pm + PCI_PM_PMC, &pmc);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001596
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001597 if ((pmc & PCI_PM_CAP_VER_MASK) > 3) {
1598 dev_err(&dev->dev, "unsupported PM cap regs version (%u)\n",
1599 pmc & PCI_PM_CAP_VER_MASK);
Linus Torvalds50246dd2009-01-16 08:14:51 -08001600 return;
David Brownell075c1772007-04-26 00:12:06 -07001601 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001602
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001603 dev->pm_cap = pm;
Rafael J. Wysocki1ae861e2009-12-31 12:15:54 +01001604 dev->d3_delay = PCI_PM_D3_WAIT;
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001605
1606 dev->d1_support = false;
1607 dev->d2_support = false;
1608 if (!pci_no_d1d2(dev)) {
Bjorn Helgaasc9ed77e2008-08-22 09:37:02 -06001609 if (pmc & PCI_PM_CAP_D1)
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001610 dev->d1_support = true;
Bjorn Helgaasc9ed77e2008-08-22 09:37:02 -06001611 if (pmc & PCI_PM_CAP_D2)
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001612 dev->d2_support = true;
Bjorn Helgaasc9ed77e2008-08-22 09:37:02 -06001613
1614 if (dev->d1_support || dev->d2_support)
1615 dev_printk(KERN_DEBUG, &dev->dev, "supports%s%s\n",
Jesse Barnesec84f122008-09-23 11:43:34 -07001616 dev->d1_support ? " D1" : "",
1617 dev->d2_support ? " D2" : "");
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001618 }
1619
1620 pmc &= PCI_PM_CAP_PME_MASK;
1621 if (pmc) {
Bjorn Helgaas10c3d712009-11-04 10:32:42 -07001622 dev_printk(KERN_DEBUG, &dev->dev,
1623 "PME# supported from%s%s%s%s%s\n",
Bjorn Helgaasc9ed77e2008-08-22 09:37:02 -06001624 (pmc & PCI_PM_CAP_PME_D0) ? " D0" : "",
1625 (pmc & PCI_PM_CAP_PME_D1) ? " D1" : "",
1626 (pmc & PCI_PM_CAP_PME_D2) ? " D2" : "",
1627 (pmc & PCI_PM_CAP_PME_D3) ? " D3hot" : "",
1628 (pmc & PCI_PM_CAP_PME_D3cold) ? " D3cold" : "");
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001629 dev->pme_support = pmc >> PCI_PM_CAP_PME_SHIFT;
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001630 /*
1631 * Make device's PM flags reflect the wake-up capability, but
1632 * let the user space enable it to wake up the system as needed.
1633 */
1634 device_set_wakeup_capable(&dev->dev, true);
1635 device_set_wakeup_enable(&dev->dev, false);
1636 /* Disable the PME# generation functionality */
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001637 pci_pme_active(dev, false);
1638 } else {
1639 dev->pme_support = 0;
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001640 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001641}
1642
Yu Zhao58c3a722008-10-14 14:02:53 +08001643/**
Jesse Barneseb9c39d2008-12-17 12:10:05 -08001644 * platform_pci_wakeup_init - init platform wakeup if present
1645 * @dev: PCI device
1646 *
1647 * Some devices don't have PCI PM caps but can still generate wakeup
1648 * events through platform methods (like ACPI events). If @dev supports
1649 * platform wakeup events, set the device flag to indicate as much. This
1650 * may be redundant if the device also supports PCI PM caps, but double
1651 * initialization should be safe in that case.
1652 */
1653void platform_pci_wakeup_init(struct pci_dev *dev)
1654{
1655 if (!platform_pci_can_wakeup(dev))
1656 return;
1657
1658 device_set_wakeup_capable(&dev->dev, true);
1659 device_set_wakeup_enable(&dev->dev, false);
1660 platform_pci_sleep_wake(dev, false);
1661}
1662
1663/**
Rafael J. Wysocki63f48982008-12-07 22:02:58 +01001664 * pci_add_save_buffer - allocate buffer for saving given capability registers
1665 * @dev: the PCI device
1666 * @cap: the capability to allocate the buffer for
1667 * @size: requested size of the buffer
1668 */
1669static int pci_add_cap_save_buffer(
1670 struct pci_dev *dev, char cap, unsigned int size)
1671{
1672 int pos;
1673 struct pci_cap_saved_state *save_state;
1674
1675 pos = pci_find_capability(dev, cap);
1676 if (pos <= 0)
1677 return 0;
1678
1679 save_state = kzalloc(sizeof(*save_state) + size, GFP_KERNEL);
1680 if (!save_state)
1681 return -ENOMEM;
1682
1683 save_state->cap_nr = cap;
1684 pci_add_saved_cap(dev, save_state);
1685
1686 return 0;
1687}
1688
1689/**
1690 * pci_allocate_cap_save_buffers - allocate buffers for saving capabilities
1691 * @dev: the PCI device
1692 */
1693void pci_allocate_cap_save_buffers(struct pci_dev *dev)
1694{
1695 int error;
1696
Yu Zhao89858512009-02-16 02:55:47 +08001697 error = pci_add_cap_save_buffer(dev, PCI_CAP_ID_EXP,
1698 PCI_EXP_SAVE_REGS * sizeof(u16));
Rafael J. Wysocki63f48982008-12-07 22:02:58 +01001699 if (error)
1700 dev_err(&dev->dev,
1701 "unable to preallocate PCI Express save buffer\n");
1702
1703 error = pci_add_cap_save_buffer(dev, PCI_CAP_ID_PCIX, sizeof(u16));
1704 if (error)
1705 dev_err(&dev->dev,
1706 "unable to preallocate PCI-X save buffer\n");
1707}
1708
1709/**
Yu Zhao58c3a722008-10-14 14:02:53 +08001710 * pci_enable_ari - enable ARI forwarding if hardware support it
1711 * @dev: the PCI device
1712 */
1713void pci_enable_ari(struct pci_dev *dev)
1714{
1715 int pos;
1716 u32 cap;
1717 u16 ctrl;
Zhao, Yu81135872008-10-23 13:15:39 +08001718 struct pci_dev *bridge;
Yu Zhao58c3a722008-10-14 14:02:53 +08001719
Kenji Kaneshige5f4d91a2009-11-11 14:36:17 +09001720 if (!pci_is_pcie(dev) || dev->devfn)
Yu Zhao58c3a722008-10-14 14:02:53 +08001721 return;
1722
Zhao, Yu81135872008-10-23 13:15:39 +08001723 pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_ARI);
Yu Zhao58c3a722008-10-14 14:02:53 +08001724 if (!pos)
1725 return;
1726
Zhao, Yu81135872008-10-23 13:15:39 +08001727 bridge = dev->bus->self;
Kenji Kaneshige5f4d91a2009-11-11 14:36:17 +09001728 if (!bridge || !pci_is_pcie(bridge))
Zhao, Yu81135872008-10-23 13:15:39 +08001729 return;
1730
Kenji Kaneshige06a1cba2009-11-11 14:30:56 +09001731 pos = pci_pcie_cap(bridge);
Zhao, Yu81135872008-10-23 13:15:39 +08001732 if (!pos)
1733 return;
1734
1735 pci_read_config_dword(bridge, pos + PCI_EXP_DEVCAP2, &cap);
Yu Zhao58c3a722008-10-14 14:02:53 +08001736 if (!(cap & PCI_EXP_DEVCAP2_ARI))
1737 return;
1738
Zhao, Yu81135872008-10-23 13:15:39 +08001739 pci_read_config_word(bridge, pos + PCI_EXP_DEVCTL2, &ctrl);
Yu Zhao58c3a722008-10-14 14:02:53 +08001740 ctrl |= PCI_EXP_DEVCTL2_ARI;
Zhao, Yu81135872008-10-23 13:15:39 +08001741 pci_write_config_word(bridge, pos + PCI_EXP_DEVCTL2, ctrl);
Yu Zhao58c3a722008-10-14 14:02:53 +08001742
Zhao, Yu81135872008-10-23 13:15:39 +08001743 bridge->ari_enabled = 1;
Yu Zhao58c3a722008-10-14 14:02:53 +08001744}
1745
Chris Wright5d990b62009-12-04 12:15:21 -08001746static int pci_acs_enable;
1747
1748/**
1749 * pci_request_acs - ask for ACS to be enabled if supported
1750 */
1751void pci_request_acs(void)
1752{
1753 pci_acs_enable = 1;
1754}
1755
Bjorn Helgaas57c2cf72008-12-11 11:24:23 -07001756/**
Allen Kayae21ee62009-10-07 10:27:17 -07001757 * pci_enable_acs - enable ACS if hardware support it
1758 * @dev: the PCI device
1759 */
1760void pci_enable_acs(struct pci_dev *dev)
1761{
1762 int pos;
1763 u16 cap;
1764 u16 ctrl;
1765
Chris Wright5d990b62009-12-04 12:15:21 -08001766 if (!pci_acs_enable)
1767 return;
1768
Kenji Kaneshige5f4d91a2009-11-11 14:36:17 +09001769 if (!pci_is_pcie(dev))
Allen Kayae21ee62009-10-07 10:27:17 -07001770 return;
1771
1772 pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_ACS);
1773 if (!pos)
1774 return;
1775
1776 pci_read_config_word(dev, pos + PCI_ACS_CAP, &cap);
1777 pci_read_config_word(dev, pos + PCI_ACS_CTRL, &ctrl);
1778
1779 /* Source Validation */
1780 ctrl |= (cap & PCI_ACS_SV);
1781
1782 /* P2P Request Redirect */
1783 ctrl |= (cap & PCI_ACS_RR);
1784
1785 /* P2P Completion Redirect */
1786 ctrl |= (cap & PCI_ACS_CR);
1787
1788 /* Upstream Forwarding */
1789 ctrl |= (cap & PCI_ACS_UF);
1790
1791 pci_write_config_word(dev, pos + PCI_ACS_CTRL, ctrl);
1792}
1793
1794/**
Bjorn Helgaas57c2cf72008-12-11 11:24:23 -07001795 * pci_swizzle_interrupt_pin - swizzle INTx for device behind bridge
1796 * @dev: the PCI device
1797 * @pin: the INTx pin (1=INTA, 2=INTB, 3=INTD, 4=INTD)
1798 *
1799 * Perform INTx swizzling for a device behind one level of bridge. This is
1800 * required by section 9.1 of the PCI-to-PCI bridge specification for devices
Matthew Wilcox46b952a2009-07-01 14:24:30 -07001801 * behind bridges on add-in cards. For devices with ARI enabled, the slot
1802 * number is always 0 (see the Implementation Note in section 2.2.8.1 of
1803 * the PCI Express Base Specification, Revision 2.1)
Bjorn Helgaas57c2cf72008-12-11 11:24:23 -07001804 */
1805u8 pci_swizzle_interrupt_pin(struct pci_dev *dev, u8 pin)
1806{
Matthew Wilcox46b952a2009-07-01 14:24:30 -07001807 int slot;
1808
1809 if (pci_ari_enabled(dev->bus))
1810 slot = 0;
1811 else
1812 slot = PCI_SLOT(dev->devfn);
1813
1814 return (((pin - 1) + slot) % 4) + 1;
Bjorn Helgaas57c2cf72008-12-11 11:24:23 -07001815}
1816
Linus Torvalds1da177e2005-04-16 15:20:36 -07001817int
1818pci_get_interrupt_pin(struct pci_dev *dev, struct pci_dev **bridge)
1819{
1820 u8 pin;
1821
Kristen Accardi514d2072005-11-02 16:24:39 -08001822 pin = dev->pin;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001823 if (!pin)
1824 return -1;
Bjorn Helgaas878f2e52008-12-09 16:11:46 -07001825
Kenji Kaneshige8784fd42009-05-26 16:07:33 +09001826 while (!pci_is_root_bus(dev->bus)) {
Bjorn Helgaas57c2cf72008-12-11 11:24:23 -07001827 pin = pci_swizzle_interrupt_pin(dev, pin);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001828 dev = dev->bus->self;
1829 }
1830 *bridge = dev;
1831 return pin;
1832}
1833
1834/**
Bjorn Helgaas68feac82008-12-16 21:36:55 -07001835 * pci_common_swizzle - swizzle INTx all the way to root bridge
1836 * @dev: the PCI device
1837 * @pinp: pointer to the INTx pin value (1=INTA, 2=INTB, 3=INTD, 4=INTD)
1838 *
1839 * Perform INTx swizzling for a device. This traverses through all PCI-to-PCI
1840 * bridges all the way up to a PCI root bus.
1841 */
1842u8 pci_common_swizzle(struct pci_dev *dev, u8 *pinp)
1843{
1844 u8 pin = *pinp;
1845
Kenji Kaneshige1eb39482009-05-26 16:08:36 +09001846 while (!pci_is_root_bus(dev->bus)) {
Bjorn Helgaas68feac82008-12-16 21:36:55 -07001847 pin = pci_swizzle_interrupt_pin(dev, pin);
1848 dev = dev->bus->self;
1849 }
1850 *pinp = pin;
1851 return PCI_SLOT(dev->devfn);
1852}
1853
1854/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07001855 * pci_release_region - Release a PCI bar
1856 * @pdev: PCI device whose resources were previously reserved by pci_request_region
1857 * @bar: BAR to release
1858 *
1859 * Releases the PCI I/O and memory resources previously reserved by a
1860 * successful call to pci_request_region. Call this function only
1861 * after all use of the PCI regions has ceased.
1862 */
1863void pci_release_region(struct pci_dev *pdev, int bar)
1864{
Tejun Heo9ac78492007-01-20 16:00:26 +09001865 struct pci_devres *dr;
1866
Linus Torvalds1da177e2005-04-16 15:20:36 -07001867 if (pci_resource_len(pdev, bar) == 0)
1868 return;
1869 if (pci_resource_flags(pdev, bar) & IORESOURCE_IO)
1870 release_region(pci_resource_start(pdev, bar),
1871 pci_resource_len(pdev, bar));
1872 else if (pci_resource_flags(pdev, bar) & IORESOURCE_MEM)
1873 release_mem_region(pci_resource_start(pdev, bar),
1874 pci_resource_len(pdev, bar));
Tejun Heo9ac78492007-01-20 16:00:26 +09001875
1876 dr = find_pci_dr(pdev);
1877 if (dr)
1878 dr->region_mask &= ~(1 << bar);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001879}
1880
1881/**
Randy Dunlapf5ddcac2009-01-09 17:03:20 -08001882 * __pci_request_region - Reserved PCI I/O and memory resource
Linus Torvalds1da177e2005-04-16 15:20:36 -07001883 * @pdev: PCI device whose resources are to be reserved
1884 * @bar: BAR to be reserved
1885 * @res_name: Name to be associated with resource.
Randy Dunlapf5ddcac2009-01-09 17:03:20 -08001886 * @exclusive: whether the region access is exclusive or not
Linus Torvalds1da177e2005-04-16 15:20:36 -07001887 *
1888 * Mark the PCI region associated with PCI device @pdev BR @bar as
1889 * being reserved by owner @res_name. Do not access any
1890 * address inside the PCI regions unless this call returns
1891 * successfully.
1892 *
Randy Dunlapf5ddcac2009-01-09 17:03:20 -08001893 * If @exclusive is set, then the region is marked so that userspace
1894 * is explicitly not allowed to map the resource via /dev/mem or
1895 * sysfs MMIO access.
1896 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07001897 * Returns 0 on success, or %EBUSY on error. A warning
1898 * message is also printed on failure.
1899 */
Arjan van de Vene8de1482008-10-22 19:55:31 -07001900static int __pci_request_region(struct pci_dev *pdev, int bar, const char *res_name,
1901 int exclusive)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001902{
Tejun Heo9ac78492007-01-20 16:00:26 +09001903 struct pci_devres *dr;
1904
Linus Torvalds1da177e2005-04-16 15:20:36 -07001905 if (pci_resource_len(pdev, bar) == 0)
1906 return 0;
1907
1908 if (pci_resource_flags(pdev, bar) & IORESOURCE_IO) {
1909 if (!request_region(pci_resource_start(pdev, bar),
1910 pci_resource_len(pdev, bar), res_name))
1911 goto err_out;
1912 }
1913 else if (pci_resource_flags(pdev, bar) & IORESOURCE_MEM) {
Arjan van de Vene8de1482008-10-22 19:55:31 -07001914 if (!__request_mem_region(pci_resource_start(pdev, bar),
1915 pci_resource_len(pdev, bar), res_name,
1916 exclusive))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001917 goto err_out;
1918 }
Tejun Heo9ac78492007-01-20 16:00:26 +09001919
1920 dr = find_pci_dr(pdev);
1921 if (dr)
1922 dr->region_mask |= 1 << bar;
1923
Linus Torvalds1da177e2005-04-16 15:20:36 -07001924 return 0;
1925
1926err_out:
Bjorn Helgaasc7dabef2009-10-27 13:26:47 -06001927 dev_warn(&pdev->dev, "BAR %d: can't reserve %pR\n", bar,
Benjamin Herrenschmidt096e6f62008-10-20 15:07:37 +11001928 &pdev->resource[bar]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001929 return -EBUSY;
1930}
1931
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09001932/**
Randy Dunlapf5ddcac2009-01-09 17:03:20 -08001933 * pci_request_region - Reserve PCI I/O and memory resource
Arjan van de Vene8de1482008-10-22 19:55:31 -07001934 * @pdev: PCI device whose resources are to be reserved
1935 * @bar: BAR to be reserved
Randy Dunlapf5ddcac2009-01-09 17:03:20 -08001936 * @res_name: Name to be associated with resource
Arjan van de Vene8de1482008-10-22 19:55:31 -07001937 *
Randy Dunlapf5ddcac2009-01-09 17:03:20 -08001938 * Mark the PCI region associated with PCI device @pdev BAR @bar as
Arjan van de Vene8de1482008-10-22 19:55:31 -07001939 * being reserved by owner @res_name. Do not access any
1940 * address inside the PCI regions unless this call returns
1941 * successfully.
1942 *
1943 * Returns 0 on success, or %EBUSY on error. A warning
1944 * message is also printed on failure.
1945 */
1946int pci_request_region(struct pci_dev *pdev, int bar, const char *res_name)
1947{
1948 return __pci_request_region(pdev, bar, res_name, 0);
1949}
1950
1951/**
1952 * pci_request_region_exclusive - Reserved PCI I/O and memory resource
1953 * @pdev: PCI device whose resources are to be reserved
1954 * @bar: BAR to be reserved
1955 * @res_name: Name to be associated with resource.
1956 *
1957 * Mark the PCI region associated with PCI device @pdev BR @bar as
1958 * being reserved by owner @res_name. Do not access any
1959 * address inside the PCI regions unless this call returns
1960 * successfully.
1961 *
1962 * Returns 0 on success, or %EBUSY on error. A warning
1963 * message is also printed on failure.
1964 *
1965 * The key difference that _exclusive makes it that userspace is
1966 * explicitly not allowed to map the resource via /dev/mem or
1967 * sysfs.
1968 */
1969int pci_request_region_exclusive(struct pci_dev *pdev, int bar, const char *res_name)
1970{
1971 return __pci_request_region(pdev, bar, res_name, IORESOURCE_EXCLUSIVE);
1972}
1973/**
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09001974 * pci_release_selected_regions - Release selected PCI I/O and memory resources
1975 * @pdev: PCI device whose resources were previously reserved
1976 * @bars: Bitmask of BARs to be released
1977 *
1978 * Release selected PCI I/O and memory resources previously reserved.
1979 * Call this function only after all use of the PCI regions has ceased.
1980 */
1981void pci_release_selected_regions(struct pci_dev *pdev, int bars)
1982{
1983 int i;
1984
1985 for (i = 0; i < 6; i++)
1986 if (bars & (1 << i))
1987 pci_release_region(pdev, i);
1988}
1989
Arjan van de Vene8de1482008-10-22 19:55:31 -07001990int __pci_request_selected_regions(struct pci_dev *pdev, int bars,
1991 const char *res_name, int excl)
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09001992{
1993 int i;
1994
1995 for (i = 0; i < 6; i++)
1996 if (bars & (1 << i))
Arjan van de Vene8de1482008-10-22 19:55:31 -07001997 if (__pci_request_region(pdev, i, res_name, excl))
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09001998 goto err_out;
1999 return 0;
2000
2001err_out:
2002 while(--i >= 0)
2003 if (bars & (1 << i))
2004 pci_release_region(pdev, i);
2005
2006 return -EBUSY;
2007}
Linus Torvalds1da177e2005-04-16 15:20:36 -07002008
Arjan van de Vene8de1482008-10-22 19:55:31 -07002009
2010/**
2011 * pci_request_selected_regions - Reserve selected PCI I/O and memory resources
2012 * @pdev: PCI device whose resources are to be reserved
2013 * @bars: Bitmask of BARs to be requested
2014 * @res_name: Name to be associated with resource
2015 */
2016int pci_request_selected_regions(struct pci_dev *pdev, int bars,
2017 const char *res_name)
2018{
2019 return __pci_request_selected_regions(pdev, bars, res_name, 0);
2020}
2021
2022int pci_request_selected_regions_exclusive(struct pci_dev *pdev,
2023 int bars, const char *res_name)
2024{
2025 return __pci_request_selected_regions(pdev, bars, res_name,
2026 IORESOURCE_EXCLUSIVE);
2027}
2028
Linus Torvalds1da177e2005-04-16 15:20:36 -07002029/**
2030 * pci_release_regions - Release reserved PCI I/O and memory resources
2031 * @pdev: PCI device whose resources were previously reserved by pci_request_regions
2032 *
2033 * Releases all PCI I/O and memory resources previously reserved by a
2034 * successful call to pci_request_regions. Call this function only
2035 * after all use of the PCI regions has ceased.
2036 */
2037
2038void pci_release_regions(struct pci_dev *pdev)
2039{
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09002040 pci_release_selected_regions(pdev, (1 << 6) - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002041}
2042
2043/**
2044 * pci_request_regions - Reserved PCI I/O and memory resources
2045 * @pdev: PCI device whose resources are to be reserved
2046 * @res_name: Name to be associated with resource.
2047 *
2048 * Mark all PCI regions associated with PCI device @pdev as
2049 * being reserved by owner @res_name. Do not access any
2050 * address inside the PCI regions unless this call returns
2051 * successfully.
2052 *
2053 * Returns 0 on success, or %EBUSY on error. A warning
2054 * message is also printed on failure.
2055 */
Jeff Garzik3c990e92006-03-04 21:52:42 -05002056int pci_request_regions(struct pci_dev *pdev, const char *res_name)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002057{
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09002058 return pci_request_selected_regions(pdev, ((1 << 6) - 1), res_name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002059}
2060
2061/**
Arjan van de Vene8de1482008-10-22 19:55:31 -07002062 * pci_request_regions_exclusive - Reserved PCI I/O and memory resources
2063 * @pdev: PCI device whose resources are to be reserved
2064 * @res_name: Name to be associated with resource.
2065 *
2066 * Mark all PCI regions associated with PCI device @pdev as
2067 * being reserved by owner @res_name. Do not access any
2068 * address inside the PCI regions unless this call returns
2069 * successfully.
2070 *
2071 * pci_request_regions_exclusive() will mark the region so that
2072 * /dev/mem and the sysfs MMIO access will not be allowed.
2073 *
2074 * Returns 0 on success, or %EBUSY on error. A warning
2075 * message is also printed on failure.
2076 */
2077int pci_request_regions_exclusive(struct pci_dev *pdev, const char *res_name)
2078{
2079 return pci_request_selected_regions_exclusive(pdev,
2080 ((1 << 6) - 1), res_name);
2081}
2082
Ben Hutchings6a479072008-12-23 03:08:29 +00002083static void __pci_set_master(struct pci_dev *dev, bool enable)
2084{
2085 u16 old_cmd, cmd;
2086
2087 pci_read_config_word(dev, PCI_COMMAND, &old_cmd);
2088 if (enable)
2089 cmd = old_cmd | PCI_COMMAND_MASTER;
2090 else
2091 cmd = old_cmd & ~PCI_COMMAND_MASTER;
2092 if (cmd != old_cmd) {
2093 dev_dbg(&dev->dev, "%s bus mastering\n",
2094 enable ? "enabling" : "disabling");
2095 pci_write_config_word(dev, PCI_COMMAND, cmd);
2096 }
2097 dev->is_busmaster = enable;
2098}
Arjan van de Vene8de1482008-10-22 19:55:31 -07002099
2100/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07002101 * pci_set_master - enables bus-mastering for device dev
2102 * @dev: the PCI device to enable
2103 *
2104 * Enables bus-mastering on the device and calls pcibios_set_master()
2105 * to do the needed arch specific settings.
2106 */
Ben Hutchings6a479072008-12-23 03:08:29 +00002107void pci_set_master(struct pci_dev *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002108{
Ben Hutchings6a479072008-12-23 03:08:29 +00002109 __pci_set_master(dev, true);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002110 pcibios_set_master(dev);
2111}
2112
Ben Hutchings6a479072008-12-23 03:08:29 +00002113/**
2114 * pci_clear_master - disables bus-mastering for device dev
2115 * @dev: the PCI device to disable
2116 */
2117void pci_clear_master(struct pci_dev *dev)
2118{
2119 __pci_set_master(dev, false);
2120}
2121
Linus Torvalds1da177e2005-04-16 15:20:36 -07002122/**
Matthew Wilcoxedb2d972006-10-10 08:01:21 -06002123 * pci_set_cacheline_size - ensure the CACHE_LINE_SIZE register is programmed
2124 * @dev: the PCI device for which MWI is to be enabled
Linus Torvalds1da177e2005-04-16 15:20:36 -07002125 *
Matthew Wilcoxedb2d972006-10-10 08:01:21 -06002126 * Helper function for pci_set_mwi.
2127 * Originally copied from drivers/net/acenic.c.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002128 * Copyright 1998-2001 by Jes Sorensen, <jes@trained-monkey.org>.
2129 *
2130 * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
2131 */
Tejun Heo15ea76d2009-09-22 17:34:48 +09002132int pci_set_cacheline_size(struct pci_dev *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002133{
2134 u8 cacheline_size;
2135
2136 if (!pci_cache_line_size)
Tejun Heo15ea76d2009-09-22 17:34:48 +09002137 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002138
2139 /* Validate current setting: the PCI_CACHE_LINE_SIZE must be
2140 equal to or multiple of the right value. */
2141 pci_read_config_byte(dev, PCI_CACHE_LINE_SIZE, &cacheline_size);
2142 if (cacheline_size >= pci_cache_line_size &&
2143 (cacheline_size % pci_cache_line_size) == 0)
2144 return 0;
2145
2146 /* Write the correct value. */
2147 pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, pci_cache_line_size);
2148 /* Read it back. */
2149 pci_read_config_byte(dev, PCI_CACHE_LINE_SIZE, &cacheline_size);
2150 if (cacheline_size == pci_cache_line_size)
2151 return 0;
2152
Bjorn Helgaas80ccba12008-06-13 10:52:11 -06002153 dev_printk(KERN_DEBUG, &dev->dev, "cache line size of %d is not "
2154 "supported\n", pci_cache_line_size << 2);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002155
2156 return -EINVAL;
2157}
Tejun Heo15ea76d2009-09-22 17:34:48 +09002158EXPORT_SYMBOL_GPL(pci_set_cacheline_size);
2159
2160#ifdef PCI_DISABLE_MWI
2161int pci_set_mwi(struct pci_dev *dev)
2162{
2163 return 0;
2164}
2165
2166int pci_try_set_mwi(struct pci_dev *dev)
2167{
2168 return 0;
2169}
2170
2171void pci_clear_mwi(struct pci_dev *dev)
2172{
2173}
2174
2175#else
Linus Torvalds1da177e2005-04-16 15:20:36 -07002176
2177/**
2178 * pci_set_mwi - enables memory-write-invalidate PCI transaction
2179 * @dev: the PCI device for which MWI is enabled
2180 *
Randy Dunlap694625c2007-07-09 11:55:54 -07002181 * Enables the Memory-Write-Invalidate transaction in %PCI_COMMAND.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002182 *
2183 * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
2184 */
2185int
2186pci_set_mwi(struct pci_dev *dev)
2187{
2188 int rc;
2189 u16 cmd;
2190
Matthew Wilcoxedb2d972006-10-10 08:01:21 -06002191 rc = pci_set_cacheline_size(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002192 if (rc)
2193 return rc;
2194
2195 pci_read_config_word(dev, PCI_COMMAND, &cmd);
2196 if (! (cmd & PCI_COMMAND_INVALIDATE)) {
Bjorn Helgaas80ccba12008-06-13 10:52:11 -06002197 dev_dbg(&dev->dev, "enabling Mem-Wr-Inval\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002198 cmd |= PCI_COMMAND_INVALIDATE;
2199 pci_write_config_word(dev, PCI_COMMAND, cmd);
2200 }
2201
2202 return 0;
2203}
2204
2205/**
Randy Dunlap694625c2007-07-09 11:55:54 -07002206 * pci_try_set_mwi - enables memory-write-invalidate PCI transaction
2207 * @dev: the PCI device for which MWI is enabled
2208 *
2209 * Enables the Memory-Write-Invalidate transaction in %PCI_COMMAND.
2210 * Callers are not required to check the return value.
2211 *
2212 * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
2213 */
2214int pci_try_set_mwi(struct pci_dev *dev)
2215{
2216 int rc = pci_set_mwi(dev);
2217 return rc;
2218}
2219
2220/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07002221 * pci_clear_mwi - disables Memory-Write-Invalidate for device dev
2222 * @dev: the PCI device to disable
2223 *
2224 * Disables PCI Memory-Write-Invalidate transaction on the device
2225 */
2226void
2227pci_clear_mwi(struct pci_dev *dev)
2228{
2229 u16 cmd;
2230
2231 pci_read_config_word(dev, PCI_COMMAND, &cmd);
2232 if (cmd & PCI_COMMAND_INVALIDATE) {
2233 cmd &= ~PCI_COMMAND_INVALIDATE;
2234 pci_write_config_word(dev, PCI_COMMAND, cmd);
2235 }
2236}
Matthew Wilcoxedb2d972006-10-10 08:01:21 -06002237#endif /* ! PCI_DISABLE_MWI */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002238
Brett M Russa04ce0f2005-08-15 15:23:41 -04002239/**
2240 * pci_intx - enables/disables PCI INTx for device dev
Randy Dunlap8f7020d2005-10-23 11:57:38 -07002241 * @pdev: the PCI device to operate on
2242 * @enable: boolean: whether to enable or disable PCI INTx
Brett M Russa04ce0f2005-08-15 15:23:41 -04002243 *
2244 * Enables/disables PCI INTx for device dev
2245 */
2246void
2247pci_intx(struct pci_dev *pdev, int enable)
2248{
2249 u16 pci_command, new;
2250
2251 pci_read_config_word(pdev, PCI_COMMAND, &pci_command);
2252
2253 if (enable) {
2254 new = pci_command & ~PCI_COMMAND_INTX_DISABLE;
2255 } else {
2256 new = pci_command | PCI_COMMAND_INTX_DISABLE;
2257 }
2258
2259 if (new != pci_command) {
Tejun Heo9ac78492007-01-20 16:00:26 +09002260 struct pci_devres *dr;
2261
Brett M Russ2fd9d742005-09-09 10:02:22 -07002262 pci_write_config_word(pdev, PCI_COMMAND, new);
Tejun Heo9ac78492007-01-20 16:00:26 +09002263
2264 dr = find_pci_dr(pdev);
2265 if (dr && !dr->restore_intx) {
2266 dr->restore_intx = 1;
2267 dr->orig_intx = !enable;
2268 }
Brett M Russa04ce0f2005-08-15 15:23:41 -04002269 }
2270}
2271
Eric W. Biedermanf5f2b132007-03-05 00:30:07 -08002272/**
2273 * pci_msi_off - disables any msi or msix capabilities
Randy Dunlap8d7d86e2007-03-16 19:55:52 -07002274 * @dev: the PCI device to operate on
Eric W. Biedermanf5f2b132007-03-05 00:30:07 -08002275 *
2276 * If you want to use msi see pci_enable_msi and friends.
2277 * This is a lower level primitive that allows us to disable
2278 * msi operation at the device level.
2279 */
2280void pci_msi_off(struct pci_dev *dev)
2281{
2282 int pos;
2283 u16 control;
2284
2285 pos = pci_find_capability(dev, PCI_CAP_ID_MSI);
2286 if (pos) {
2287 pci_read_config_word(dev, pos + PCI_MSI_FLAGS, &control);
2288 control &= ~PCI_MSI_FLAGS_ENABLE;
2289 pci_write_config_word(dev, pos + PCI_MSI_FLAGS, control);
2290 }
2291 pos = pci_find_capability(dev, PCI_CAP_ID_MSIX);
2292 if (pos) {
2293 pci_read_config_word(dev, pos + PCI_MSIX_FLAGS, &control);
2294 control &= ~PCI_MSIX_FLAGS_ENABLE;
2295 pci_write_config_word(dev, pos + PCI_MSIX_FLAGS, control);
2296 }
2297}
2298
Linus Torvalds1da177e2005-04-16 15:20:36 -07002299#ifndef HAVE_ARCH_PCI_SET_DMA_MASK
2300/*
2301 * These can be overridden by arch-specific implementations
2302 */
2303int
2304pci_set_dma_mask(struct pci_dev *dev, u64 mask)
2305{
2306 if (!pci_dma_supported(dev, mask))
2307 return -EIO;
2308
2309 dev->dma_mask = mask;
Yinghai Luc6a41572009-11-25 16:28:50 -08002310 dev_dbg(&dev->dev, "using %dbit DMA mask\n", fls64(mask));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002311
2312 return 0;
2313}
2314
2315int
Linus Torvalds1da177e2005-04-16 15:20:36 -07002316pci_set_consistent_dma_mask(struct pci_dev *dev, u64 mask)
2317{
2318 if (!pci_dma_supported(dev, mask))
2319 return -EIO;
2320
2321 dev->dev.coherent_dma_mask = mask;
Yinghai Luc6a41572009-11-25 16:28:50 -08002322 dev_dbg(&dev->dev, "using %dbit consistent DMA mask\n", fls64(mask));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002323
2324 return 0;
2325}
2326#endif
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09002327
FUJITA Tomonori4d57cdf2008-02-04 22:27:55 -08002328#ifndef HAVE_ARCH_PCI_SET_DMA_MAX_SEGMENT_SIZE
2329int pci_set_dma_max_seg_size(struct pci_dev *dev, unsigned int size)
2330{
2331 return dma_set_max_seg_size(&dev->dev, size);
2332}
2333EXPORT_SYMBOL(pci_set_dma_max_seg_size);
2334#endif
2335
FUJITA Tomonori59fc67d2008-02-04 22:28:14 -08002336#ifndef HAVE_ARCH_PCI_SET_DMA_SEGMENT_BOUNDARY
2337int pci_set_dma_seg_boundary(struct pci_dev *dev, unsigned long mask)
2338{
2339 return dma_set_seg_boundary(&dev->dev, mask);
2340}
2341EXPORT_SYMBOL(pci_set_dma_seg_boundary);
2342#endif
2343
Yu Zhao8c1c6992009-06-13 15:52:13 +08002344static int pcie_flr(struct pci_dev *dev, int probe)
Sheng Yang8dd7f802008-10-21 17:38:25 +08002345{
Yu Zhao8c1c6992009-06-13 15:52:13 +08002346 int i;
2347 int pos;
Sheng Yang8dd7f802008-10-21 17:38:25 +08002348 u32 cap;
Shmulik Ravid04b55c42009-12-03 22:27:51 +02002349 u16 status, control;
Sheng Yang8dd7f802008-10-21 17:38:25 +08002350
Kenji Kaneshige06a1cba2009-11-11 14:30:56 +09002351 pos = pci_pcie_cap(dev);
Yu Zhao8c1c6992009-06-13 15:52:13 +08002352 if (!pos)
Sheng Yang8dd7f802008-10-21 17:38:25 +08002353 return -ENOTTY;
Yu Zhao8c1c6992009-06-13 15:52:13 +08002354
2355 pci_read_config_dword(dev, pos + PCI_EXP_DEVCAP, &cap);
Sheng Yang8dd7f802008-10-21 17:38:25 +08002356 if (!(cap & PCI_EXP_DEVCAP_FLR))
2357 return -ENOTTY;
2358
Sheng Yangd91cdc72008-11-11 17:17:47 +08002359 if (probe)
2360 return 0;
2361
Sheng Yang8dd7f802008-10-21 17:38:25 +08002362 /* Wait for Transaction Pending bit clean */
Yu Zhao8c1c6992009-06-13 15:52:13 +08002363 for (i = 0; i < 4; i++) {
2364 if (i)
2365 msleep((1 << (i - 1)) * 100);
Sheng Yang5fe5db02009-02-09 14:53:47 +08002366
Yu Zhao8c1c6992009-06-13 15:52:13 +08002367 pci_read_config_word(dev, pos + PCI_EXP_DEVSTA, &status);
2368 if (!(status & PCI_EXP_DEVSTA_TRPND))
2369 goto clear;
2370 }
Sheng Yang8dd7f802008-10-21 17:38:25 +08002371
Yu Zhao8c1c6992009-06-13 15:52:13 +08002372 dev_err(&dev->dev, "transaction is not cleared; "
2373 "proceeding with reset anyway\n");
Sheng Yang5fe5db02009-02-09 14:53:47 +08002374
Yu Zhao8c1c6992009-06-13 15:52:13 +08002375clear:
Shmulik Ravid04b55c42009-12-03 22:27:51 +02002376 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL, &control);
2377 control |= PCI_EXP_DEVCTL_BCR_FLR;
2378 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL, control);
2379
Yu Zhao8c1c6992009-06-13 15:52:13 +08002380 msleep(100);
Sheng Yang8dd7f802008-10-21 17:38:25 +08002381
Sheng Yang8dd7f802008-10-21 17:38:25 +08002382 return 0;
2383}
Sheng Yangd91cdc72008-11-11 17:17:47 +08002384
Yu Zhao8c1c6992009-06-13 15:52:13 +08002385static int pci_af_flr(struct pci_dev *dev, int probe)
Sheng Yang1ca88792008-11-11 17:17:48 +08002386{
Yu Zhao8c1c6992009-06-13 15:52:13 +08002387 int i;
2388 int pos;
Sheng Yang1ca88792008-11-11 17:17:48 +08002389 u8 cap;
Yu Zhao8c1c6992009-06-13 15:52:13 +08002390 u8 status;
Sheng Yang1ca88792008-11-11 17:17:48 +08002391
Yu Zhao8c1c6992009-06-13 15:52:13 +08002392 pos = pci_find_capability(dev, PCI_CAP_ID_AF);
2393 if (!pos)
Sheng Yang1ca88792008-11-11 17:17:48 +08002394 return -ENOTTY;
Yu Zhao8c1c6992009-06-13 15:52:13 +08002395
2396 pci_read_config_byte(dev, pos + PCI_AF_CAP, &cap);
Sheng Yang1ca88792008-11-11 17:17:48 +08002397 if (!(cap & PCI_AF_CAP_TP) || !(cap & PCI_AF_CAP_FLR))
2398 return -ENOTTY;
2399
2400 if (probe)
2401 return 0;
2402
Sheng Yang1ca88792008-11-11 17:17:48 +08002403 /* Wait for Transaction Pending bit clean */
Yu Zhao8c1c6992009-06-13 15:52:13 +08002404 for (i = 0; i < 4; i++) {
2405 if (i)
2406 msleep((1 << (i - 1)) * 100);
Sheng Yang5fe5db02009-02-09 14:53:47 +08002407
Yu Zhao8c1c6992009-06-13 15:52:13 +08002408 pci_read_config_byte(dev, pos + PCI_AF_STATUS, &status);
2409 if (!(status & PCI_AF_STATUS_TP))
2410 goto clear;
2411 }
2412
2413 dev_err(&dev->dev, "transaction is not cleared; "
2414 "proceeding with reset anyway\n");
2415
2416clear:
2417 pci_write_config_byte(dev, pos + PCI_AF_CTRL, PCI_AF_CTRL_FLR);
Sheng Yang1ca88792008-11-11 17:17:48 +08002418 msleep(100);
Sheng Yang5fe5db02009-02-09 14:53:47 +08002419
Sheng Yang1ca88792008-11-11 17:17:48 +08002420 return 0;
2421}
2422
Yu Zhaof85876b2009-06-13 15:52:14 +08002423static int pci_pm_reset(struct pci_dev *dev, int probe)
Sheng Yangd91cdc72008-11-11 17:17:47 +08002424{
Yu Zhaof85876b2009-06-13 15:52:14 +08002425 u16 csr;
Sheng Yangd91cdc72008-11-11 17:17:47 +08002426
Yu Zhaof85876b2009-06-13 15:52:14 +08002427 if (!dev->pm_cap)
2428 return -ENOTTY;
Sheng Yangd91cdc72008-11-11 17:17:47 +08002429
Yu Zhaof85876b2009-06-13 15:52:14 +08002430 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &csr);
2431 if (csr & PCI_PM_CTRL_NO_SOFT_RESET)
2432 return -ENOTTY;
Sheng Yang1ca88792008-11-11 17:17:48 +08002433
Yu Zhaof85876b2009-06-13 15:52:14 +08002434 if (probe)
2435 return 0;
2436
2437 if (dev->current_state != PCI_D0)
2438 return -EINVAL;
2439
2440 csr &= ~PCI_PM_CTRL_STATE_MASK;
2441 csr |= PCI_D3hot;
2442 pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, csr);
Rafael J. Wysocki1ae861e2009-12-31 12:15:54 +01002443 pci_dev_d3_sleep(dev);
Yu Zhaof85876b2009-06-13 15:52:14 +08002444
2445 csr &= ~PCI_PM_CTRL_STATE_MASK;
2446 csr |= PCI_D0;
2447 pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, csr);
Rafael J. Wysocki1ae861e2009-12-31 12:15:54 +01002448 pci_dev_d3_sleep(dev);
Yu Zhaof85876b2009-06-13 15:52:14 +08002449
2450 return 0;
2451}
2452
Yu Zhaoc12ff1d2009-06-13 15:52:15 +08002453static int pci_parent_bus_reset(struct pci_dev *dev, int probe)
2454{
2455 u16 ctrl;
2456 struct pci_dev *pdev;
2457
Yu Zhao654b75e2009-06-26 14:04:46 +08002458 if (pci_is_root_bus(dev->bus) || dev->subordinate || !dev->bus->self)
Yu Zhaoc12ff1d2009-06-13 15:52:15 +08002459 return -ENOTTY;
2460
2461 list_for_each_entry(pdev, &dev->bus->devices, bus_list)
2462 if (pdev != dev)
2463 return -ENOTTY;
2464
2465 if (probe)
2466 return 0;
2467
2468 pci_read_config_word(dev->bus->self, PCI_BRIDGE_CONTROL, &ctrl);
2469 ctrl |= PCI_BRIDGE_CTL_BUS_RESET;
2470 pci_write_config_word(dev->bus->self, PCI_BRIDGE_CONTROL, ctrl);
2471 msleep(100);
2472
2473 ctrl &= ~PCI_BRIDGE_CTL_BUS_RESET;
2474 pci_write_config_word(dev->bus->self, PCI_BRIDGE_CONTROL, ctrl);
2475 msleep(100);
2476
2477 return 0;
2478}
2479
Yu Zhao8c1c6992009-06-13 15:52:13 +08002480static int pci_dev_reset(struct pci_dev *dev, int probe)
Sheng Yang8dd7f802008-10-21 17:38:25 +08002481{
Yu Zhao8c1c6992009-06-13 15:52:13 +08002482 int rc;
Sheng Yang8dd7f802008-10-21 17:38:25 +08002483
Yu Zhao8c1c6992009-06-13 15:52:13 +08002484 might_sleep();
Sheng Yang8dd7f802008-10-21 17:38:25 +08002485
Yu Zhao8c1c6992009-06-13 15:52:13 +08002486 if (!probe) {
2487 pci_block_user_cfg_access(dev);
2488 /* block PM suspend, driver probe, etc. */
Greg Kroah-Hartman8e9394c2010-02-17 10:57:05 -08002489 device_lock(&dev->dev);
Yu Zhao8c1c6992009-06-13 15:52:13 +08002490 }
Sheng Yang8dd7f802008-10-21 17:38:25 +08002491
Dexuan Cuib9c3b262009-12-07 13:03:21 +08002492 rc = pci_dev_specific_reset(dev, probe);
2493 if (rc != -ENOTTY)
2494 goto done;
2495
Yu Zhao8c1c6992009-06-13 15:52:13 +08002496 rc = pcie_flr(dev, probe);
2497 if (rc != -ENOTTY)
2498 goto done;
2499
2500 rc = pci_af_flr(dev, probe);
Yu Zhaof85876b2009-06-13 15:52:14 +08002501 if (rc != -ENOTTY)
2502 goto done;
2503
2504 rc = pci_pm_reset(dev, probe);
Yu Zhaoc12ff1d2009-06-13 15:52:15 +08002505 if (rc != -ENOTTY)
2506 goto done;
2507
2508 rc = pci_parent_bus_reset(dev, probe);
Yu Zhao8c1c6992009-06-13 15:52:13 +08002509done:
2510 if (!probe) {
Greg Kroah-Hartman8e9394c2010-02-17 10:57:05 -08002511 device_unlock(&dev->dev);
Yu Zhao8c1c6992009-06-13 15:52:13 +08002512 pci_unblock_user_cfg_access(dev);
2513 }
2514
2515 return rc;
Sheng Yang8dd7f802008-10-21 17:38:25 +08002516}
2517
2518/**
Yu Zhao8c1c6992009-06-13 15:52:13 +08002519 * __pci_reset_function - reset a PCI device function
2520 * @dev: PCI device to reset
Sheng Yang8dd7f802008-10-21 17:38:25 +08002521 *
2522 * Some devices allow an individual function to be reset without affecting
2523 * other functions in the same device. The PCI device must be responsive
2524 * to PCI config space in order to use this function.
2525 *
2526 * The device function is presumed to be unused when this function is called.
2527 * Resetting the device will make the contents of PCI configuration space
2528 * random, so any caller of this must be prepared to reinitialise the
2529 * device including MSI, bus mastering, BARs, decoding IO and memory spaces,
2530 * etc.
2531 *
Yu Zhao8c1c6992009-06-13 15:52:13 +08002532 * Returns 0 if the device function was successfully reset or negative if the
Sheng Yang8dd7f802008-10-21 17:38:25 +08002533 * device doesn't support resetting a single function.
2534 */
Yu Zhao8c1c6992009-06-13 15:52:13 +08002535int __pci_reset_function(struct pci_dev *dev)
Sheng Yang8dd7f802008-10-21 17:38:25 +08002536{
Yu Zhao8c1c6992009-06-13 15:52:13 +08002537 return pci_dev_reset(dev, 0);
Sheng Yang8dd7f802008-10-21 17:38:25 +08002538}
Yu Zhao8c1c6992009-06-13 15:52:13 +08002539EXPORT_SYMBOL_GPL(__pci_reset_function);
Sheng Yang8dd7f802008-10-21 17:38:25 +08002540
2541/**
Michael S. Tsirkin711d5772009-07-27 23:37:48 +03002542 * pci_probe_reset_function - check whether the device can be safely reset
2543 * @dev: PCI device to reset
2544 *
2545 * Some devices allow an individual function to be reset without affecting
2546 * other functions in the same device. The PCI device must be responsive
2547 * to PCI config space in order to use this function.
2548 *
2549 * Returns 0 if the device function can be reset or negative if the
2550 * device doesn't support resetting a single function.
2551 */
2552int pci_probe_reset_function(struct pci_dev *dev)
2553{
2554 return pci_dev_reset(dev, 1);
2555}
2556
2557/**
Yu Zhao8c1c6992009-06-13 15:52:13 +08002558 * pci_reset_function - quiesce and reset a PCI device function
2559 * @dev: PCI device to reset
Sheng Yang8dd7f802008-10-21 17:38:25 +08002560 *
2561 * Some devices allow an individual function to be reset without affecting
2562 * other functions in the same device. The PCI device must be responsive
2563 * to PCI config space in order to use this function.
2564 *
2565 * This function does not just reset the PCI portion of a device, but
2566 * clears all the state associated with the device. This function differs
Yu Zhao8c1c6992009-06-13 15:52:13 +08002567 * from __pci_reset_function in that it saves and restores device state
Sheng Yang8dd7f802008-10-21 17:38:25 +08002568 * over the reset.
2569 *
Yu Zhao8c1c6992009-06-13 15:52:13 +08002570 * Returns 0 if the device function was successfully reset or negative if the
Sheng Yang8dd7f802008-10-21 17:38:25 +08002571 * device doesn't support resetting a single function.
2572 */
2573int pci_reset_function(struct pci_dev *dev)
2574{
Yu Zhao8c1c6992009-06-13 15:52:13 +08002575 int rc;
Sheng Yang8dd7f802008-10-21 17:38:25 +08002576
Yu Zhao8c1c6992009-06-13 15:52:13 +08002577 rc = pci_dev_reset(dev, 1);
2578 if (rc)
2579 return rc;
Sheng Yang8dd7f802008-10-21 17:38:25 +08002580
Sheng Yang8dd7f802008-10-21 17:38:25 +08002581 pci_save_state(dev);
2582
Yu Zhao8c1c6992009-06-13 15:52:13 +08002583 /*
2584 * both INTx and MSI are disabled after the Interrupt Disable bit
2585 * is set and the Bus Master bit is cleared.
2586 */
Sheng Yang8dd7f802008-10-21 17:38:25 +08002587 pci_write_config_word(dev, PCI_COMMAND, PCI_COMMAND_INTX_DISABLE);
2588
Yu Zhao8c1c6992009-06-13 15:52:13 +08002589 rc = pci_dev_reset(dev, 0);
Sheng Yang8dd7f802008-10-21 17:38:25 +08002590
2591 pci_restore_state(dev);
Sheng Yang8dd7f802008-10-21 17:38:25 +08002592
Yu Zhao8c1c6992009-06-13 15:52:13 +08002593 return rc;
Sheng Yang8dd7f802008-10-21 17:38:25 +08002594}
2595EXPORT_SYMBOL_GPL(pci_reset_function);
2596
2597/**
Peter Orubad556ad42007-05-15 13:59:13 +02002598 * pcix_get_max_mmrbc - get PCI-X maximum designed memory read byte count
2599 * @dev: PCI device to query
2600 *
2601 * Returns mmrbc: maximum designed memory read count in bytes
2602 * or appropriate error value.
2603 */
2604int pcix_get_max_mmrbc(struct pci_dev *dev)
2605{
Andrew Mortonb7b095c2007-07-09 11:55:50 -07002606 int err, cap;
Peter Orubad556ad42007-05-15 13:59:13 +02002607 u32 stat;
2608
2609 cap = pci_find_capability(dev, PCI_CAP_ID_PCIX);
2610 if (!cap)
2611 return -EINVAL;
2612
2613 err = pci_read_config_dword(dev, cap + PCI_X_STATUS, &stat);
2614 if (err)
2615 return -EINVAL;
2616
Andrew Mortonb7b095c2007-07-09 11:55:50 -07002617 return (stat & PCI_X_STATUS_MAX_READ) >> 12;
Peter Orubad556ad42007-05-15 13:59:13 +02002618}
2619EXPORT_SYMBOL(pcix_get_max_mmrbc);
2620
2621/**
2622 * pcix_get_mmrbc - get PCI-X maximum memory read byte count
2623 * @dev: PCI device to query
2624 *
2625 * Returns mmrbc: maximum memory read count in bytes
2626 * or appropriate error value.
2627 */
2628int pcix_get_mmrbc(struct pci_dev *dev)
2629{
2630 int ret, cap;
2631 u32 cmd;
2632
2633 cap = pci_find_capability(dev, PCI_CAP_ID_PCIX);
2634 if (!cap)
2635 return -EINVAL;
2636
2637 ret = pci_read_config_dword(dev, cap + PCI_X_CMD, &cmd);
2638 if (!ret)
2639 ret = 512 << ((cmd & PCI_X_CMD_MAX_READ) >> 2);
2640
2641 return ret;
2642}
2643EXPORT_SYMBOL(pcix_get_mmrbc);
2644
2645/**
2646 * pcix_set_mmrbc - set PCI-X maximum memory read byte count
2647 * @dev: PCI device to query
2648 * @mmrbc: maximum memory read count in bytes
2649 * valid values are 512, 1024, 2048, 4096
2650 *
2651 * If possible sets maximum memory read byte count, some bridges have erratas
2652 * that prevent this.
2653 */
2654int pcix_set_mmrbc(struct pci_dev *dev, int mmrbc)
2655{
2656 int cap, err = -EINVAL;
2657 u32 stat, cmd, v, o;
2658
vignesh babu229f5af2007-08-13 18:23:14 +05302659 if (mmrbc < 512 || mmrbc > 4096 || !is_power_of_2(mmrbc))
Peter Orubad556ad42007-05-15 13:59:13 +02002660 goto out;
2661
2662 v = ffs(mmrbc) - 10;
2663
2664 cap = pci_find_capability(dev, PCI_CAP_ID_PCIX);
2665 if (!cap)
2666 goto out;
2667
2668 err = pci_read_config_dword(dev, cap + PCI_X_STATUS, &stat);
2669 if (err)
2670 goto out;
2671
2672 if (v > (stat & PCI_X_STATUS_MAX_READ) >> 21)
2673 return -E2BIG;
2674
2675 err = pci_read_config_dword(dev, cap + PCI_X_CMD, &cmd);
2676 if (err)
2677 goto out;
2678
2679 o = (cmd & PCI_X_CMD_MAX_READ) >> 2;
2680 if (o != v) {
2681 if (v > o && dev->bus &&
2682 (dev->bus->bus_flags & PCI_BUS_FLAGS_NO_MMRBC))
2683 return -EIO;
2684
2685 cmd &= ~PCI_X_CMD_MAX_READ;
2686 cmd |= v << 2;
2687 err = pci_write_config_dword(dev, cap + PCI_X_CMD, cmd);
2688 }
2689out:
2690 return err;
2691}
2692EXPORT_SYMBOL(pcix_set_mmrbc);
2693
2694/**
2695 * pcie_get_readrq - get PCI Express read request size
2696 * @dev: PCI device to query
2697 *
2698 * Returns maximum memory read request in bytes
2699 * or appropriate error value.
2700 */
2701int pcie_get_readrq(struct pci_dev *dev)
2702{
2703 int ret, cap;
2704 u16 ctl;
2705
Kenji Kaneshige06a1cba2009-11-11 14:30:56 +09002706 cap = pci_pcie_cap(dev);
Peter Orubad556ad42007-05-15 13:59:13 +02002707 if (!cap)
2708 return -EINVAL;
2709
2710 ret = pci_read_config_word(dev, cap + PCI_EXP_DEVCTL, &ctl);
2711 if (!ret)
2712 ret = 128 << ((ctl & PCI_EXP_DEVCTL_READRQ) >> 12);
2713
2714 return ret;
2715}
2716EXPORT_SYMBOL(pcie_get_readrq);
2717
2718/**
2719 * pcie_set_readrq - set PCI Express maximum memory read request
2720 * @dev: PCI device to query
Randy Dunlap42e61f42007-07-23 21:42:11 -07002721 * @rq: maximum memory read count in bytes
Peter Orubad556ad42007-05-15 13:59:13 +02002722 * valid values are 128, 256, 512, 1024, 2048, 4096
2723 *
2724 * If possible sets maximum read byte count
2725 */
2726int pcie_set_readrq(struct pci_dev *dev, int rq)
2727{
2728 int cap, err = -EINVAL;
2729 u16 ctl, v;
2730
vignesh babu229f5af2007-08-13 18:23:14 +05302731 if (rq < 128 || rq > 4096 || !is_power_of_2(rq))
Peter Orubad556ad42007-05-15 13:59:13 +02002732 goto out;
2733
2734 v = (ffs(rq) - 8) << 12;
2735
Kenji Kaneshige06a1cba2009-11-11 14:30:56 +09002736 cap = pci_pcie_cap(dev);
Peter Orubad556ad42007-05-15 13:59:13 +02002737 if (!cap)
2738 goto out;
2739
2740 err = pci_read_config_word(dev, cap + PCI_EXP_DEVCTL, &ctl);
2741 if (err)
2742 goto out;
2743
2744 if ((ctl & PCI_EXP_DEVCTL_READRQ) != v) {
2745 ctl &= ~PCI_EXP_DEVCTL_READRQ;
2746 ctl |= v;
2747 err = pci_write_config_dword(dev, cap + PCI_EXP_DEVCTL, ctl);
2748 }
2749
2750out:
2751 return err;
2752}
2753EXPORT_SYMBOL(pcie_set_readrq);
2754
2755/**
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09002756 * pci_select_bars - Make BAR mask from the type of resource
Randy Dunlapf95d8822007-02-10 14:41:56 -08002757 * @dev: the PCI device for which BAR mask is made
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09002758 * @flags: resource type mask to be selected
2759 *
2760 * This helper routine makes bar mask from the type of resource.
2761 */
2762int pci_select_bars(struct pci_dev *dev, unsigned long flags)
2763{
2764 int i, bars = 0;
2765 for (i = 0; i < PCI_NUM_RESOURCES; i++)
2766 if (pci_resource_flags(dev, i) & flags)
2767 bars |= (1 << i);
2768 return bars;
2769}
2770
Yu Zhao613e7ed2008-11-22 02:41:27 +08002771/**
2772 * pci_resource_bar - get position of the BAR associated with a resource
2773 * @dev: the PCI device
2774 * @resno: the resource number
2775 * @type: the BAR type to be filled in
2776 *
2777 * Returns BAR position in config space, or 0 if the BAR is invalid.
2778 */
2779int pci_resource_bar(struct pci_dev *dev, int resno, enum pci_bar_type *type)
2780{
Yu Zhaod1b054d2009-03-20 11:25:11 +08002781 int reg;
2782
Yu Zhao613e7ed2008-11-22 02:41:27 +08002783 if (resno < PCI_ROM_RESOURCE) {
2784 *type = pci_bar_unknown;
2785 return PCI_BASE_ADDRESS_0 + 4 * resno;
2786 } else if (resno == PCI_ROM_RESOURCE) {
2787 *type = pci_bar_mem32;
2788 return dev->rom_base_reg;
Yu Zhaod1b054d2009-03-20 11:25:11 +08002789 } else if (resno < PCI_BRIDGE_RESOURCES) {
2790 /* device specific resource */
2791 reg = pci_iov_resource_bar(dev, resno, type);
2792 if (reg)
2793 return reg;
Yu Zhao613e7ed2008-11-22 02:41:27 +08002794 }
2795
Bjorn Helgaas865df572009-11-04 10:32:57 -07002796 dev_err(&dev->dev, "BAR %d: invalid resource\n", resno);
Yu Zhao613e7ed2008-11-22 02:41:27 +08002797 return 0;
2798}
2799
Mike Travis95a8b6e2010-02-02 14:38:13 -08002800/* Some architectures require additional programming to enable VGA */
2801static arch_set_vga_state_t arch_set_vga_state;
2802
2803void __init pci_register_set_vga_state(arch_set_vga_state_t func)
2804{
2805 arch_set_vga_state = func; /* NULL disables */
2806}
2807
2808static int pci_set_vga_state_arch(struct pci_dev *dev, bool decode,
2809 unsigned int command_bits, bool change_bridge)
2810{
2811 if (arch_set_vga_state)
2812 return arch_set_vga_state(dev, decode, command_bits,
2813 change_bridge);
2814 return 0;
2815}
2816
Benjamin Herrenschmidtdeb2d2e2009-08-11 15:52:06 +10002817/**
2818 * pci_set_vga_state - set VGA decode state on device and parents if requested
Randy Dunlap19eea632009-09-17 15:28:22 -07002819 * @dev: the PCI device
2820 * @decode: true = enable decoding, false = disable decoding
2821 * @command_bits: PCI_COMMAND_IO and/or PCI_COMMAND_MEMORY
2822 * @change_bridge: traverse ancestors and change bridges
Benjamin Herrenschmidtdeb2d2e2009-08-11 15:52:06 +10002823 */
2824int pci_set_vga_state(struct pci_dev *dev, bool decode,
2825 unsigned int command_bits, bool change_bridge)
2826{
2827 struct pci_bus *bus;
2828 struct pci_dev *bridge;
2829 u16 cmd;
Mike Travis95a8b6e2010-02-02 14:38:13 -08002830 int rc;
Benjamin Herrenschmidtdeb2d2e2009-08-11 15:52:06 +10002831
2832 WARN_ON(command_bits & ~(PCI_COMMAND_IO|PCI_COMMAND_MEMORY));
2833
Mike Travis95a8b6e2010-02-02 14:38:13 -08002834 /* ARCH specific VGA enables */
2835 rc = pci_set_vga_state_arch(dev, decode, command_bits, change_bridge);
2836 if (rc)
2837 return rc;
2838
Benjamin Herrenschmidtdeb2d2e2009-08-11 15:52:06 +10002839 pci_read_config_word(dev, PCI_COMMAND, &cmd);
2840 if (decode == true)
2841 cmd |= command_bits;
2842 else
2843 cmd &= ~command_bits;
2844 pci_write_config_word(dev, PCI_COMMAND, cmd);
2845
2846 if (change_bridge == false)
2847 return 0;
2848
2849 bus = dev->bus;
2850 while (bus) {
2851 bridge = bus->self;
2852 if (bridge) {
2853 pci_read_config_word(bridge, PCI_BRIDGE_CONTROL,
2854 &cmd);
2855 if (decode == true)
2856 cmd |= PCI_BRIDGE_CTL_VGA;
2857 else
2858 cmd &= ~PCI_BRIDGE_CTL_VGA;
2859 pci_write_config_word(bridge, PCI_BRIDGE_CONTROL,
2860 cmd);
2861 }
2862 bus = bus->parent;
2863 }
2864 return 0;
2865}
2866
Yuji Shimada32a9a6822009-03-16 17:13:39 +09002867#define RESOURCE_ALIGNMENT_PARAM_SIZE COMMAND_LINE_SIZE
2868static char resource_alignment_param[RESOURCE_ALIGNMENT_PARAM_SIZE] = {0};
Thomas Gleixnere9d1e492009-11-06 22:41:23 +00002869static DEFINE_SPINLOCK(resource_alignment_lock);
Yuji Shimada32a9a6822009-03-16 17:13:39 +09002870
2871/**
2872 * pci_specified_resource_alignment - get resource alignment specified by user.
2873 * @dev: the PCI device to get
2874 *
2875 * RETURNS: Resource alignment if it is specified.
2876 * Zero if it is not specified.
2877 */
2878resource_size_t pci_specified_resource_alignment(struct pci_dev *dev)
2879{
2880 int seg, bus, slot, func, align_order, count;
2881 resource_size_t align = 0;
2882 char *p;
2883
2884 spin_lock(&resource_alignment_lock);
2885 p = resource_alignment_param;
2886 while (*p) {
2887 count = 0;
2888 if (sscanf(p, "%d%n", &align_order, &count) == 1 &&
2889 p[count] == '@') {
2890 p += count + 1;
2891 } else {
2892 align_order = -1;
2893 }
2894 if (sscanf(p, "%x:%x:%x.%x%n",
2895 &seg, &bus, &slot, &func, &count) != 4) {
2896 seg = 0;
2897 if (sscanf(p, "%x:%x.%x%n",
2898 &bus, &slot, &func, &count) != 3) {
2899 /* Invalid format */
2900 printk(KERN_ERR "PCI: Can't parse resource_alignment parameter: %s\n",
2901 p);
2902 break;
2903 }
2904 }
2905 p += count;
2906 if (seg == pci_domain_nr(dev->bus) &&
2907 bus == dev->bus->number &&
2908 slot == PCI_SLOT(dev->devfn) &&
2909 func == PCI_FUNC(dev->devfn)) {
2910 if (align_order == -1) {
2911 align = PAGE_SIZE;
2912 } else {
2913 align = 1 << align_order;
2914 }
2915 /* Found */
2916 break;
2917 }
2918 if (*p != ';' && *p != ',') {
2919 /* End of param or invalid format */
2920 break;
2921 }
2922 p++;
2923 }
2924 spin_unlock(&resource_alignment_lock);
2925 return align;
2926}
2927
2928/**
2929 * pci_is_reassigndev - check if specified PCI is target device to reassign
2930 * @dev: the PCI device to check
2931 *
2932 * RETURNS: non-zero for PCI device is a target device to reassign,
2933 * or zero is not.
2934 */
2935int pci_is_reassigndev(struct pci_dev *dev)
2936{
2937 return (pci_specified_resource_alignment(dev) != 0);
2938}
2939
2940ssize_t pci_set_resource_alignment_param(const char *buf, size_t count)
2941{
2942 if (count > RESOURCE_ALIGNMENT_PARAM_SIZE - 1)
2943 count = RESOURCE_ALIGNMENT_PARAM_SIZE - 1;
2944 spin_lock(&resource_alignment_lock);
2945 strncpy(resource_alignment_param, buf, count);
2946 resource_alignment_param[count] = '\0';
2947 spin_unlock(&resource_alignment_lock);
2948 return count;
2949}
2950
2951ssize_t pci_get_resource_alignment_param(char *buf, size_t size)
2952{
2953 size_t count;
2954 spin_lock(&resource_alignment_lock);
2955 count = snprintf(buf, size, "%s", resource_alignment_param);
2956 spin_unlock(&resource_alignment_lock);
2957 return count;
2958}
2959
2960static ssize_t pci_resource_alignment_show(struct bus_type *bus, char *buf)
2961{
2962 return pci_get_resource_alignment_param(buf, PAGE_SIZE);
2963}
2964
2965static ssize_t pci_resource_alignment_store(struct bus_type *bus,
2966 const char *buf, size_t count)
2967{
2968 return pci_set_resource_alignment_param(buf, count);
2969}
2970
2971BUS_ATTR(resource_alignment, 0644, pci_resource_alignment_show,
2972 pci_resource_alignment_store);
2973
2974static int __init pci_resource_alignment_sysfs_init(void)
2975{
2976 return bus_create_file(&pci_bus_type,
2977 &bus_attr_resource_alignment);
2978}
2979
2980late_initcall(pci_resource_alignment_sysfs_init);
2981
Jeff Garzik32a2eea2007-10-11 16:57:27 -04002982static void __devinit pci_no_domains(void)
2983{
2984#ifdef CONFIG_PCI_DOMAINS
2985 pci_domains_supported = 0;
2986#endif
2987}
2988
Andrew Patterson0ef5f8f2008-11-10 15:30:50 -07002989/**
2990 * pci_ext_cfg_enabled - can we access extended PCI config space?
2991 * @dev: The PCI device of the root bridge.
2992 *
2993 * Returns 1 if we can access PCI extended config space (offsets
2994 * greater than 0xff). This is the default implementation. Architecture
2995 * implementations can override this.
2996 */
2997int __attribute__ ((weak)) pci_ext_cfg_avail(struct pci_dev *dev)
2998{
2999 return 1;
3000}
3001
Benjamin Herrenschmidt2d1c8612009-12-09 17:52:13 +11003002void __weak pci_fixup_cardbus(struct pci_bus *bus)
3003{
3004}
3005EXPORT_SYMBOL(pci_fixup_cardbus);
3006
Al Viroad04d312008-11-22 17:37:14 +00003007static int __init pci_setup(char *str)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003008{
3009 while (str) {
3010 char *k = strchr(str, ',');
3011 if (k)
3012 *k++ = 0;
3013 if (*str && (str = pcibios_setup(str)) && *str) {
Matthew Wilcox309e57d2006-03-05 22:33:34 -07003014 if (!strcmp(str, "nomsi")) {
3015 pci_no_msi();
Randy Dunlap7f785762007-10-05 13:17:58 -07003016 } else if (!strcmp(str, "noaer")) {
3017 pci_no_aer();
Jeff Garzik32a2eea2007-10-11 16:57:27 -04003018 } else if (!strcmp(str, "nodomains")) {
3019 pci_no_domains();
Atsushi Nemoto4516a612007-02-05 16:36:06 -08003020 } else if (!strncmp(str, "cbiosize=", 9)) {
3021 pci_cardbus_io_size = memparse(str + 9, &str);
3022 } else if (!strncmp(str, "cbmemsize=", 10)) {
3023 pci_cardbus_mem_size = memparse(str + 10, &str);
Yuji Shimada32a9a6822009-03-16 17:13:39 +09003024 } else if (!strncmp(str, "resource_alignment=", 19)) {
3025 pci_set_resource_alignment_param(str + 19,
3026 strlen(str + 19));
Andrew Patterson43c16402009-04-22 16:52:09 -06003027 } else if (!strncmp(str, "ecrc=", 5)) {
3028 pcie_ecrc_get_policy(str + 5);
Eric W. Biederman28760482009-09-09 14:09:24 -07003029 } else if (!strncmp(str, "hpiosize=", 9)) {
3030 pci_hotplug_io_size = memparse(str + 9, &str);
3031 } else if (!strncmp(str, "hpmemsize=", 10)) {
3032 pci_hotplug_mem_size = memparse(str + 10, &str);
Matthew Wilcox309e57d2006-03-05 22:33:34 -07003033 } else {
3034 printk(KERN_ERR "PCI: Unknown option `%s'\n",
3035 str);
3036 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003037 }
3038 str = k;
3039 }
Andi Kleen0637a702006-09-26 10:52:41 +02003040 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003041}
Andi Kleen0637a702006-09-26 10:52:41 +02003042early_param("pci", pci_setup);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003043
Tejun Heo0b62e132007-07-27 14:43:35 +09003044EXPORT_SYMBOL(pci_reenable_device);
Benjamin Herrenschmidtb7189892007-12-20 15:28:08 +11003045EXPORT_SYMBOL(pci_enable_device_io);
3046EXPORT_SYMBOL(pci_enable_device_mem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003047EXPORT_SYMBOL(pci_enable_device);
Tejun Heo9ac78492007-01-20 16:00:26 +09003048EXPORT_SYMBOL(pcim_enable_device);
3049EXPORT_SYMBOL(pcim_pin_device);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003050EXPORT_SYMBOL(pci_disable_device);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003051EXPORT_SYMBOL(pci_find_capability);
3052EXPORT_SYMBOL(pci_bus_find_capability);
Mike Travis95a8b6e2010-02-02 14:38:13 -08003053EXPORT_SYMBOL(pci_register_set_vga_state);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003054EXPORT_SYMBOL(pci_release_regions);
3055EXPORT_SYMBOL(pci_request_regions);
Arjan van de Vene8de1482008-10-22 19:55:31 -07003056EXPORT_SYMBOL(pci_request_regions_exclusive);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003057EXPORT_SYMBOL(pci_release_region);
3058EXPORT_SYMBOL(pci_request_region);
Arjan van de Vene8de1482008-10-22 19:55:31 -07003059EXPORT_SYMBOL(pci_request_region_exclusive);
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09003060EXPORT_SYMBOL(pci_release_selected_regions);
3061EXPORT_SYMBOL(pci_request_selected_regions);
Arjan van de Vene8de1482008-10-22 19:55:31 -07003062EXPORT_SYMBOL(pci_request_selected_regions_exclusive);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003063EXPORT_SYMBOL(pci_set_master);
Ben Hutchings6a479072008-12-23 03:08:29 +00003064EXPORT_SYMBOL(pci_clear_master);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003065EXPORT_SYMBOL(pci_set_mwi);
Randy Dunlap694625c2007-07-09 11:55:54 -07003066EXPORT_SYMBOL(pci_try_set_mwi);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003067EXPORT_SYMBOL(pci_clear_mwi);
Brett M Russa04ce0f2005-08-15 15:23:41 -04003068EXPORT_SYMBOL_GPL(pci_intx);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003069EXPORT_SYMBOL(pci_set_dma_mask);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003070EXPORT_SYMBOL(pci_set_consistent_dma_mask);
3071EXPORT_SYMBOL(pci_assign_resource);
3072EXPORT_SYMBOL(pci_find_parent_resource);
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09003073EXPORT_SYMBOL(pci_select_bars);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003074
3075EXPORT_SYMBOL(pci_set_power_state);
3076EXPORT_SYMBOL(pci_save_state);
3077EXPORT_SYMBOL(pci_restore_state);
Rafael J. Wysockie5899e12008-07-19 14:39:24 +02003078EXPORT_SYMBOL(pci_pme_capable);
Rafael J. Wysocki5a6c9b62008-08-08 00:14:24 +02003079EXPORT_SYMBOL(pci_pme_active);
Rafael J. Wysocki0235c4f2008-08-18 21:38:00 +02003080EXPORT_SYMBOL(pci_wake_from_d3);
Rafael J. Wysockie5899e12008-07-19 14:39:24 +02003081EXPORT_SYMBOL(pci_target_state);
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02003082EXPORT_SYMBOL(pci_prepare_to_sleep);
3083EXPORT_SYMBOL(pci_back_from_sleep);
Brian Kingf7bdd122007-04-06 16:39:36 -05003084EXPORT_SYMBOL_GPL(pci_set_pcie_reset_state);