blob: d0182bed7acce00ef325a92dcf00f1d785a8a16f [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>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090015#include <linux/slab.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070016#include <linux/module.h>
17#include <linux/spinlock.h>
Tim Schmielau4e57b682005-10-30 15:03:48 -080018#include <linux/string.h>
vignesh babu229f5af2007-08-13 18:23:14 +053019#include <linux/log2.h>
Shaohua Li7d715a62008-02-25 09:46:41 +080020#include <linux/pci-aspm.h>
Stephen Rothwellc300bd2fb2008-07-10 02:16:44 +020021#include <linux/pm_wakeup.h>
Sheng Yang8dd7f802008-10-21 17:38:25 +080022#include <linux/interrupt.h>
Yuji Shimada32a9a6822009-03-16 17:13:39 +090023#include <linux/device.h>
Rafael J. Wysockib67ea762010-02-17 23:44:09 +010024#include <linux/pm_runtime.h>
Yuji Shimada32a9a6822009-03-16 17:13:39 +090025#include <asm/setup.h>
Greg KHbc56b9e2005-04-08 14:53:31 +090026#include "pci.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070027
Alan Stern00240c32009-04-27 13:33:16 -040028const char *pci_power_names[] = {
29 "error", "D0", "D1", "D2", "D3hot", "D3cold", "unknown",
30};
31EXPORT_SYMBOL_GPL(pci_power_names);
32
Rafael J. Wysocki93177a72010-01-02 22:57:24 +010033int isa_dma_bridge_buggy;
34EXPORT_SYMBOL(isa_dma_bridge_buggy);
35
36int pci_pci_problems;
37EXPORT_SYMBOL(pci_pci_problems);
38
Rafael J. Wysocki1ae861e2009-12-31 12:15:54 +010039unsigned int pci_pm_d3_delay;
40
Matthew Garrettdf17e622010-10-04 14:22:29 -040041static void pci_pme_list_scan(struct work_struct *work);
42
43static LIST_HEAD(pci_pme_list);
44static DEFINE_MUTEX(pci_pme_list_mutex);
45static DECLARE_DELAYED_WORK(pci_pme_work, pci_pme_list_scan);
46
47struct pci_pme_device {
48 struct list_head list;
49 struct pci_dev *dev;
50};
51
52#define PME_TIMEOUT 1000 /* How long between PME checks */
53
Rafael J. Wysocki1ae861e2009-12-31 12:15:54 +010054static void pci_dev_d3_sleep(struct pci_dev *dev)
55{
56 unsigned int delay = dev->d3_delay;
57
58 if (delay < pci_pm_d3_delay)
59 delay = pci_pm_d3_delay;
60
61 msleep(delay);
62}
Linus Torvalds1da177e2005-04-16 15:20:36 -070063
Jeff Garzik32a2eea2007-10-11 16:57:27 -040064#ifdef CONFIG_PCI_DOMAINS
65int pci_domains_supported = 1;
66#endif
67
Atsushi Nemoto4516a612007-02-05 16:36:06 -080068#define DEFAULT_CARDBUS_IO_SIZE (256)
69#define DEFAULT_CARDBUS_MEM_SIZE (64*1024*1024)
70/* pci=cbmemsize=nnM,cbiosize=nn can override this */
71unsigned long pci_cardbus_io_size = DEFAULT_CARDBUS_IO_SIZE;
72unsigned long pci_cardbus_mem_size = DEFAULT_CARDBUS_MEM_SIZE;
73
Eric W. Biederman28760482009-09-09 14:09:24 -070074#define DEFAULT_HOTPLUG_IO_SIZE (256)
75#define DEFAULT_HOTPLUG_MEM_SIZE (2*1024*1024)
76/* pci=hpmemsize=nnM,hpiosize=nn can override this */
77unsigned long pci_hotplug_io_size = DEFAULT_HOTPLUG_IO_SIZE;
78unsigned long pci_hotplug_mem_size = DEFAULT_HOTPLUG_MEM_SIZE;
79
Jesse Barnesac1aa472009-10-26 13:20:44 -070080/*
81 * The default CLS is used if arch didn't set CLS explicitly and not
82 * all pci devices agree on the same value. Arch can override either
83 * the dfl or actual value as it sees fit. Don't forget this is
84 * measured in 32-bit words, not bytes.
85 */
Tejun Heo98e724c2009-10-08 18:59:53 +090086u8 pci_dfl_cache_line_size __devinitdata = L1_CACHE_BYTES >> 2;
Jesse Barnesac1aa472009-10-26 13:20:44 -070087u8 pci_cache_line_size;
88
Linus Torvalds1da177e2005-04-16 15:20:36 -070089/**
90 * pci_bus_max_busnr - returns maximum PCI bus number of given bus' children
91 * @bus: pointer to PCI bus structure to search
92 *
93 * Given a PCI bus, returns the highest PCI bus number present in the set
94 * including the given PCI bus and its list of child PCI buses.
95 */
Sam Ravnborg96bde062007-03-26 21:53:30 -080096unsigned char pci_bus_max_busnr(struct pci_bus* bus)
Linus Torvalds1da177e2005-04-16 15:20:36 -070097{
98 struct list_head *tmp;
99 unsigned char max, n;
100
Kristen Accardib82db5c2006-01-17 16:56:56 -0800101 max = bus->subordinate;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102 list_for_each(tmp, &bus->children) {
103 n = pci_bus_max_busnr(pci_bus_b(tmp));
104 if(n > max)
105 max = n;
106 }
107 return max;
108}
Kristen Accardib82db5c2006-01-17 16:56:56 -0800109EXPORT_SYMBOL_GPL(pci_bus_max_busnr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110
Andrew Morton1684f5d2008-12-01 14:30:30 -0800111#ifdef CONFIG_HAS_IOMEM
112void __iomem *pci_ioremap_bar(struct pci_dev *pdev, int bar)
113{
114 /*
115 * Make sure the BAR is actually a memory resource, not an IO resource
116 */
117 if (!(pci_resource_flags(pdev, bar) & IORESOURCE_MEM)) {
118 WARN_ON(1);
119 return NULL;
120 }
121 return ioremap_nocache(pci_resource_start(pdev, bar),
122 pci_resource_len(pdev, bar));
123}
124EXPORT_SYMBOL_GPL(pci_ioremap_bar);
125#endif
126
Kristen Accardib82db5c2006-01-17 16:56:56 -0800127#if 0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700128/**
129 * pci_max_busnr - returns maximum PCI bus number
130 *
131 * Returns the highest PCI bus number present in the system global list of
132 * PCI buses.
133 */
134unsigned char __devinit
135pci_max_busnr(void)
136{
137 struct pci_bus *bus = NULL;
138 unsigned char max, n;
139
140 max = 0;
141 while ((bus = pci_find_next_bus(bus)) != NULL) {
142 n = pci_bus_max_busnr(bus);
143 if(n > max)
144 max = n;
145 }
146 return max;
147}
148
Adrian Bunk54c762f2005-12-22 01:08:52 +0100149#endif /* 0 */
150
Michael Ellerman687d5fe2006-11-22 18:26:18 +1100151#define PCI_FIND_CAP_TTL 48
152
153static int __pci_find_next_cap_ttl(struct pci_bus *bus, unsigned int devfn,
154 u8 pos, int cap, int *ttl)
Roland Dreier24a4e372005-10-28 17:35:34 -0700155{
156 u8 id;
Roland Dreier24a4e372005-10-28 17:35:34 -0700157
Michael Ellerman687d5fe2006-11-22 18:26:18 +1100158 while ((*ttl)--) {
Roland Dreier24a4e372005-10-28 17:35:34 -0700159 pci_bus_read_config_byte(bus, devfn, pos, &pos);
160 if (pos < 0x40)
161 break;
162 pos &= ~3;
163 pci_bus_read_config_byte(bus, devfn, pos + PCI_CAP_LIST_ID,
164 &id);
165 if (id == 0xff)
166 break;
167 if (id == cap)
168 return pos;
169 pos += PCI_CAP_LIST_NEXT;
170 }
171 return 0;
172}
173
Michael Ellerman687d5fe2006-11-22 18:26:18 +1100174static int __pci_find_next_cap(struct pci_bus *bus, unsigned int devfn,
175 u8 pos, int cap)
176{
177 int ttl = PCI_FIND_CAP_TTL;
178
179 return __pci_find_next_cap_ttl(bus, devfn, pos, cap, &ttl);
180}
181
Roland Dreier24a4e372005-10-28 17:35:34 -0700182int pci_find_next_capability(struct pci_dev *dev, u8 pos, int cap)
183{
184 return __pci_find_next_cap(dev->bus, dev->devfn,
185 pos + PCI_CAP_LIST_NEXT, cap);
186}
187EXPORT_SYMBOL_GPL(pci_find_next_capability);
188
Michael Ellermand3bac112006-11-22 18:26:16 +1100189static int __pci_bus_find_cap_start(struct pci_bus *bus,
190 unsigned int devfn, u8 hdr_type)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700191{
192 u16 status;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700193
194 pci_bus_read_config_word(bus, devfn, PCI_STATUS, &status);
195 if (!(status & PCI_STATUS_CAP_LIST))
196 return 0;
197
198 switch (hdr_type) {
199 case PCI_HEADER_TYPE_NORMAL:
200 case PCI_HEADER_TYPE_BRIDGE:
Michael Ellermand3bac112006-11-22 18:26:16 +1100201 return PCI_CAPABILITY_LIST;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700202 case PCI_HEADER_TYPE_CARDBUS:
Michael Ellermand3bac112006-11-22 18:26:16 +1100203 return PCI_CB_CAPABILITY_LIST;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700204 default:
205 return 0;
206 }
Michael Ellermand3bac112006-11-22 18:26:16 +1100207
208 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700209}
210
211/**
212 * pci_find_capability - query for devices' capabilities
213 * @dev: PCI device to query
214 * @cap: capability code
215 *
216 * Tell if a device supports a given PCI capability.
217 * Returns the address of the requested capability structure within the
218 * device's PCI configuration space or 0 in case the device does not
219 * support it. Possible values for @cap:
220 *
221 * %PCI_CAP_ID_PM Power Management
222 * %PCI_CAP_ID_AGP Accelerated Graphics Port
223 * %PCI_CAP_ID_VPD Vital Product Data
224 * %PCI_CAP_ID_SLOTID Slot Identification
225 * %PCI_CAP_ID_MSI Message Signalled Interrupts
226 * %PCI_CAP_ID_CHSWP CompactPCI HotSwap
227 * %PCI_CAP_ID_PCIX PCI-X
228 * %PCI_CAP_ID_EXP PCI Express
229 */
230int pci_find_capability(struct pci_dev *dev, int cap)
231{
Michael Ellermand3bac112006-11-22 18:26:16 +1100232 int pos;
233
234 pos = __pci_bus_find_cap_start(dev->bus, dev->devfn, dev->hdr_type);
235 if (pos)
236 pos = __pci_find_next_cap(dev->bus, dev->devfn, pos, cap);
237
238 return pos;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700239}
240
241/**
242 * pci_bus_find_capability - query for devices' capabilities
243 * @bus: the PCI bus to query
244 * @devfn: PCI device to query
245 * @cap: capability code
246 *
247 * Like pci_find_capability() but works for pci devices that do not have a
248 * pci_dev structure set up yet.
249 *
250 * Returns the address of the requested capability structure within the
251 * device's PCI configuration space or 0 in case the device does not
252 * support it.
253 */
254int pci_bus_find_capability(struct pci_bus *bus, unsigned int devfn, int cap)
255{
Michael Ellermand3bac112006-11-22 18:26:16 +1100256 int pos;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700257 u8 hdr_type;
258
259 pci_bus_read_config_byte(bus, devfn, PCI_HEADER_TYPE, &hdr_type);
260
Michael Ellermand3bac112006-11-22 18:26:16 +1100261 pos = __pci_bus_find_cap_start(bus, devfn, hdr_type & 0x7f);
262 if (pos)
263 pos = __pci_find_next_cap(bus, devfn, pos, cap);
264
265 return pos;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700266}
267
268/**
269 * pci_find_ext_capability - Find an extended capability
270 * @dev: PCI device to query
271 * @cap: capability code
272 *
273 * Returns the address of the requested extended capability structure
274 * within the device's PCI configuration space or 0 if the device does
275 * not support it. Possible values for @cap:
276 *
277 * %PCI_EXT_CAP_ID_ERR Advanced Error Reporting
278 * %PCI_EXT_CAP_ID_VC Virtual Channel
279 * %PCI_EXT_CAP_ID_DSN Device Serial Number
280 * %PCI_EXT_CAP_ID_PWR Power Budgeting
281 */
282int pci_find_ext_capability(struct pci_dev *dev, int cap)
283{
284 u32 header;
Zhao, Yu557848c2008-10-13 19:18:07 +0800285 int ttl;
286 int pos = PCI_CFG_SPACE_SIZE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700287
Zhao, Yu557848c2008-10-13 19:18:07 +0800288 /* minimum 8 bytes per capability */
289 ttl = (PCI_CFG_SPACE_EXP_SIZE - PCI_CFG_SPACE_SIZE) / 8;
290
291 if (dev->cfg_size <= PCI_CFG_SPACE_SIZE)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292 return 0;
293
294 if (pci_read_config_dword(dev, pos, &header) != PCIBIOS_SUCCESSFUL)
295 return 0;
296
297 /*
298 * If we have no capabilities, this is indicated by cap ID,
299 * cap version and next pointer all being 0.
300 */
301 if (header == 0)
302 return 0;
303
304 while (ttl-- > 0) {
305 if (PCI_EXT_CAP_ID(header) == cap)
306 return pos;
307
308 pos = PCI_EXT_CAP_NEXT(header);
Zhao, Yu557848c2008-10-13 19:18:07 +0800309 if (pos < PCI_CFG_SPACE_SIZE)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700310 break;
311
312 if (pci_read_config_dword(dev, pos, &header) != PCIBIOS_SUCCESSFUL)
313 break;
314 }
315
316 return 0;
317}
Brice Goglin3a720d72006-05-23 06:10:01 -0400318EXPORT_SYMBOL_GPL(pci_find_ext_capability);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700319
Jesse Barnescf4c43d2009-07-15 13:13:00 -0700320/**
321 * pci_bus_find_ext_capability - find an extended capability
322 * @bus: the PCI bus to query
323 * @devfn: PCI device to query
324 * @cap: capability code
325 *
326 * Like pci_find_ext_capability() but works for pci devices that do not have a
327 * pci_dev structure set up yet.
328 *
329 * Returns the address of the requested capability structure within the
330 * device's PCI configuration space or 0 in case the device does not
331 * support it.
332 */
333int pci_bus_find_ext_capability(struct pci_bus *bus, unsigned int devfn,
334 int cap)
335{
336 u32 header;
337 int ttl;
338 int pos = PCI_CFG_SPACE_SIZE;
339
340 /* minimum 8 bytes per capability */
341 ttl = (PCI_CFG_SPACE_EXP_SIZE - PCI_CFG_SPACE_SIZE) / 8;
342
343 if (!pci_bus_read_config_dword(bus, devfn, pos, &header))
344 return 0;
345 if (header == 0xffffffff || header == 0)
346 return 0;
347
348 while (ttl-- > 0) {
349 if (PCI_EXT_CAP_ID(header) == cap)
350 return pos;
351
352 pos = PCI_EXT_CAP_NEXT(header);
353 if (pos < PCI_CFG_SPACE_SIZE)
354 break;
355
356 if (!pci_bus_read_config_dword(bus, devfn, pos, &header))
357 break;
358 }
359
360 return 0;
361}
362
Michael Ellerman687d5fe2006-11-22 18:26:18 +1100363static int __pci_find_next_ht_cap(struct pci_dev *dev, int pos, int ht_cap)
364{
365 int rc, ttl = PCI_FIND_CAP_TTL;
366 u8 cap, mask;
367
368 if (ht_cap == HT_CAPTYPE_SLAVE || ht_cap == HT_CAPTYPE_HOST)
369 mask = HT_3BIT_CAP_MASK;
370 else
371 mask = HT_5BIT_CAP_MASK;
372
373 pos = __pci_find_next_cap_ttl(dev->bus, dev->devfn, pos,
374 PCI_CAP_ID_HT, &ttl);
375 while (pos) {
376 rc = pci_read_config_byte(dev, pos + 3, &cap);
377 if (rc != PCIBIOS_SUCCESSFUL)
378 return 0;
379
380 if ((cap & mask) == ht_cap)
381 return pos;
382
Brice Goglin47a4d5b2007-01-10 23:15:29 -0800383 pos = __pci_find_next_cap_ttl(dev->bus, dev->devfn,
384 pos + PCI_CAP_LIST_NEXT,
Michael Ellerman687d5fe2006-11-22 18:26:18 +1100385 PCI_CAP_ID_HT, &ttl);
386 }
387
388 return 0;
389}
390/**
391 * pci_find_next_ht_capability - query a device's Hypertransport capabilities
392 * @dev: PCI device to query
393 * @pos: Position from which to continue searching
394 * @ht_cap: Hypertransport capability code
395 *
396 * To be used in conjunction with pci_find_ht_capability() to search for
397 * all capabilities matching @ht_cap. @pos should always be a value returned
398 * from pci_find_ht_capability().
399 *
400 * NB. To be 100% safe against broken PCI devices, the caller should take
401 * steps to avoid an infinite loop.
402 */
403int pci_find_next_ht_capability(struct pci_dev *dev, int pos, int ht_cap)
404{
405 return __pci_find_next_ht_cap(dev, pos + PCI_CAP_LIST_NEXT, ht_cap);
406}
407EXPORT_SYMBOL_GPL(pci_find_next_ht_capability);
408
409/**
410 * pci_find_ht_capability - query a device's Hypertransport capabilities
411 * @dev: PCI device to query
412 * @ht_cap: Hypertransport capability code
413 *
414 * Tell if a device supports a given Hypertransport capability.
415 * Returns an address within the device's PCI configuration space
416 * or 0 in case the device does not support the request capability.
417 * The address points to the PCI capability, of type PCI_CAP_ID_HT,
418 * which has a Hypertransport capability matching @ht_cap.
419 */
420int pci_find_ht_capability(struct pci_dev *dev, int ht_cap)
421{
422 int pos;
423
424 pos = __pci_bus_find_cap_start(dev->bus, dev->devfn, dev->hdr_type);
425 if (pos)
426 pos = __pci_find_next_ht_cap(dev, pos, ht_cap);
427
428 return pos;
429}
430EXPORT_SYMBOL_GPL(pci_find_ht_capability);
431
Linus Torvalds1da177e2005-04-16 15:20:36 -0700432/**
433 * pci_find_parent_resource - return resource region of parent bus of given region
434 * @dev: PCI device structure contains resources to be searched
435 * @res: child resource record for which parent is sought
436 *
437 * For given resource region of given device, return the resource
438 * region of parent bus the given region is contained in or where
439 * it should be allocated from.
440 */
441struct resource *
442pci_find_parent_resource(const struct pci_dev *dev, struct resource *res)
443{
444 const struct pci_bus *bus = dev->bus;
445 int i;
Bjorn Helgaas89a74ec2010-02-23 10:24:31 -0700446 struct resource *best = NULL, *r;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700447
Bjorn Helgaas89a74ec2010-02-23 10:24:31 -0700448 pci_bus_for_each_resource(bus, r, i) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700449 if (!r)
450 continue;
451 if (res->start && !(res->start >= r->start && res->end <= r->end))
452 continue; /* Not contained */
453 if ((res->flags ^ r->flags) & (IORESOURCE_IO | IORESOURCE_MEM))
454 continue; /* Wrong type */
455 if (!((res->flags ^ r->flags) & IORESOURCE_PREFETCH))
456 return r; /* Exact match */
Linus Torvalds8c8def22009-11-09 12:04:32 -0800457 /* We can't insert a non-prefetch resource inside a prefetchable parent .. */
458 if (r->flags & IORESOURCE_PREFETCH)
459 continue;
460 /* .. but we can put a prefetchable resource inside a non-prefetchable one */
461 if (!best)
462 best = r;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700463 }
464 return best;
465}
466
467/**
John W. Linville064b53db2005-07-27 10:19:44 -0400468 * pci_restore_bars - restore a devices BAR values (e.g. after wake-up)
469 * @dev: PCI device to have its BARs restored
470 *
471 * Restore the BAR values for a given device, so as to make it
472 * accessible by its driver.
473 */
Adrian Bunkad6685992007-10-27 03:06:22 +0200474static void
John W. Linville064b53db2005-07-27 10:19:44 -0400475pci_restore_bars(struct pci_dev *dev)
476{
Yu Zhaobc5f5a82008-11-22 02:40:00 +0800477 int i;
John W. Linville064b53db2005-07-27 10:19:44 -0400478
Yu Zhaobc5f5a82008-11-22 02:40:00 +0800479 for (i = 0; i < PCI_BRIDGE_RESOURCES; i++)
Yu Zhao14add802008-11-22 02:38:52 +0800480 pci_update_resource(dev, i);
John W. Linville064b53db2005-07-27 10:19:44 -0400481}
482
Rafael J. Wysocki961d9122008-07-07 03:32:02 +0200483static struct pci_platform_pm_ops *pci_platform_pm;
484
485int pci_set_platform_pm(struct pci_platform_pm_ops *ops)
486{
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +0200487 if (!ops->is_manageable || !ops->set_state || !ops->choose_state
488 || !ops->sleep_wake || !ops->can_wakeup)
Rafael J. Wysocki961d9122008-07-07 03:32:02 +0200489 return -EINVAL;
490 pci_platform_pm = ops;
491 return 0;
492}
493
494static inline bool platform_pci_power_manageable(struct pci_dev *dev)
495{
496 return pci_platform_pm ? pci_platform_pm->is_manageable(dev) : false;
497}
498
499static inline int platform_pci_set_power_state(struct pci_dev *dev,
500 pci_power_t t)
501{
502 return pci_platform_pm ? pci_platform_pm->set_state(dev, t) : -ENOSYS;
503}
504
505static inline pci_power_t platform_pci_choose_state(struct pci_dev *dev)
506{
507 return pci_platform_pm ?
508 pci_platform_pm->choose_state(dev) : PCI_POWER_ERROR;
509}
Randy Dunlap8f7020d2005-10-23 11:57:38 -0700510
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +0200511static inline bool platform_pci_can_wakeup(struct pci_dev *dev)
512{
513 return pci_platform_pm ? pci_platform_pm->can_wakeup(dev) : false;
514}
515
516static inline int platform_pci_sleep_wake(struct pci_dev *dev, bool enable)
517{
518 return pci_platform_pm ?
519 pci_platform_pm->sleep_wake(dev, enable) : -ENODEV;
520}
521
Rafael J. Wysockib67ea762010-02-17 23:44:09 +0100522static inline int platform_pci_run_wake(struct pci_dev *dev, bool enable)
523{
524 return pci_platform_pm ?
525 pci_platform_pm->run_wake(dev, enable) : -ENODEV;
526}
527
John W. Linville064b53db2005-07-27 10:19:44 -0400528/**
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200529 * pci_raw_set_power_state - Use PCI PM registers to set the power state of
530 * given PCI device
531 * @dev: PCI device to handle.
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200532 * @state: PCI power state (D0, D1, D2, D3hot) to put the device into.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700533 *
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200534 * RETURN VALUE:
535 * -EINVAL if the requested state is invalid.
536 * -EIO if device does not support PCI PM or its PM capabilities register has a
537 * wrong version, or device doesn't support the requested state.
538 * 0 if device already is in the requested state.
539 * 0 if device's power state has been successfully changed.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700540 */
Rafael J. Wysockif00a20e2009-03-16 22:40:08 +0100541static int pci_raw_set_power_state(struct pci_dev *dev, pci_power_t state)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542{
Rafael J. Wysocki337001b2008-07-07 03:36:24 +0200543 u16 pmcsr;
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200544 bool need_restore = false;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700545
Rafael J. Wysocki4a865902009-03-16 22:40:36 +0100546 /* Check if we're already there */
547 if (dev->current_state == state)
548 return 0;
549
Rafael J. Wysocki337001b2008-07-07 03:36:24 +0200550 if (!dev->pm_cap)
Andrew Lunncca03de2007-07-09 11:55:58 -0700551 return -EIO;
552
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200553 if (state < PCI_D0 || state > PCI_D3hot)
554 return -EINVAL;
555
Linus Torvalds1da177e2005-04-16 15:20:36 -0700556 /* Validate current state:
557 * Can enter D0 from any state, but if we can only go deeper
558 * to sleep if we're already in a low power state
559 */
Rafael J. Wysocki4a865902009-03-16 22:40:36 +0100560 if (state != PCI_D0 && dev->current_state <= PCI_D3cold
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200561 && dev->current_state > state) {
Bjorn Helgaas80ccba12008-06-13 10:52:11 -0600562 dev_err(&dev->dev, "invalid power transition "
563 "(from state %d to %d)\n", dev->current_state, state);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700564 return -EINVAL;
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200565 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700566
Linus Torvalds1da177e2005-04-16 15:20:36 -0700567 /* check if this device supports the desired state */
Rafael J. Wysocki337001b2008-07-07 03:36:24 +0200568 if ((state == PCI_D1 && !dev->d1_support)
569 || (state == PCI_D2 && !dev->d2_support))
Daniel Ritz3fe9d192005-08-17 15:32:19 -0700570 return -EIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700571
Rafael J. Wysocki337001b2008-07-07 03:36:24 +0200572 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
John W. Linville064b53db2005-07-27 10:19:44 -0400573
John W. Linville32a36582005-09-14 09:52:42 -0400574 /* If we're (effectively) in D3, force entire word to 0.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700575 * This doesn't affect PME_Status, disables PME_En, and
576 * sets PowerState to 0.
577 */
John W. Linville32a36582005-09-14 09:52:42 -0400578 switch (dev->current_state) {
John W. Linvilled3535fb2005-09-28 17:50:51 -0400579 case PCI_D0:
580 case PCI_D1:
581 case PCI_D2:
582 pmcsr &= ~PCI_PM_CTRL_STATE_MASK;
583 pmcsr |= state;
584 break;
Rafael J. Wysockif62795f2009-05-18 22:51:12 +0200585 case PCI_D3hot:
586 case PCI_D3cold:
John W. Linville32a36582005-09-14 09:52:42 -0400587 case PCI_UNKNOWN: /* Boot-up */
588 if ((pmcsr & PCI_PM_CTRL_STATE_MASK) == PCI_D3hot
Rafael J. Wysockif00a20e2009-03-16 22:40:08 +0100589 && !(pmcsr & PCI_PM_CTRL_NO_SOFT_RESET))
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200590 need_restore = true;
John W. Linville32a36582005-09-14 09:52:42 -0400591 /* Fall-through: force to D0 */
John W. Linville32a36582005-09-14 09:52:42 -0400592 default:
John W. Linvilled3535fb2005-09-28 17:50:51 -0400593 pmcsr = 0;
John W. Linville32a36582005-09-14 09:52:42 -0400594 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700595 }
596
597 /* enter specified state */
Rafael J. Wysocki337001b2008-07-07 03:36:24 +0200598 pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, pmcsr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700599
600 /* Mandatory power management transition delays */
601 /* see PCI PM 1.1 5.6.1 table 18 */
602 if (state == PCI_D3hot || dev->current_state == PCI_D3hot)
Rafael J. Wysocki1ae861e2009-12-31 12:15:54 +0100603 pci_dev_d3_sleep(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700604 else if (state == PCI_D2 || dev->current_state == PCI_D2)
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100605 udelay(PCI_PM_D2_DELAY);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700606
Rafael J. Wysockie13cdbd2009-10-05 00:48:40 +0200607 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
608 dev->current_state = (pmcsr & PCI_PM_CTRL_STATE_MASK);
609 if (dev->current_state != state && printk_ratelimit())
610 dev_info(&dev->dev, "Refused to change power state, "
611 "currently in D%d\n", dev->current_state);
John W. Linville064b53db2005-07-27 10:19:44 -0400612
613 /* According to section 5.4.1 of the "PCI BUS POWER MANAGEMENT
614 * INTERFACE SPECIFICATION, REV. 1.2", a device transitioning
615 * from D3hot to D0 _may_ perform an internal reset, thereby
616 * going to "D0 Uninitialized" rather than "D0 Initialized".
617 * For example, at least some versions of the 3c905B and the
618 * 3c556B exhibit this behaviour.
619 *
620 * At least some laptop BIOSen (e.g. the Thinkpad T21) leave
621 * devices in a D3hot state at boot. Consequently, we need to
622 * restore at least the BARs so that the device will be
623 * accessible to its driver.
624 */
625 if (need_restore)
626 pci_restore_bars(dev);
627
Rafael J. Wysockif00a20e2009-03-16 22:40:08 +0100628 if (dev->bus->self)
Shaohua Li7d715a62008-02-25 09:46:41 +0800629 pcie_aspm_pm_state_change(dev->bus->self);
630
Linus Torvalds1da177e2005-04-16 15:20:36 -0700631 return 0;
632}
633
634/**
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200635 * pci_update_current_state - Read PCI power state of given device from its
636 * PCI PM registers and cache it
637 * @dev: PCI device to handle.
Rafael J. Wysockif06fc0b2008-12-27 16:30:52 +0100638 * @state: State to cache in case the device doesn't have the PM capability
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200639 */
Rafael J. Wysocki734104292009-01-07 13:07:15 +0100640void pci_update_current_state(struct pci_dev *dev, pci_power_t state)
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200641{
Rafael J. Wysocki337001b2008-07-07 03:36:24 +0200642 if (dev->pm_cap) {
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200643 u16 pmcsr;
644
Rafael J. Wysocki337001b2008-07-07 03:36:24 +0200645 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200646 dev->current_state = (pmcsr & PCI_PM_CTRL_STATE_MASK);
Rafael J. Wysockif06fc0b2008-12-27 16:30:52 +0100647 } else {
648 dev->current_state = state;
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200649 }
650}
651
652/**
Rafael J. Wysocki0e5dd462009-03-26 22:51:40 +0100653 * pci_platform_power_transition - Use platform to change device power state
654 * @dev: PCI device to handle.
655 * @state: State to put the device into.
656 */
657static int pci_platform_power_transition(struct pci_dev *dev, pci_power_t state)
658{
659 int error;
660
661 if (platform_pci_power_manageable(dev)) {
662 error = platform_pci_set_power_state(dev, state);
663 if (!error)
664 pci_update_current_state(dev, state);
665 } else {
666 error = -ENODEV;
667 /* Fall back to PCI_D0 if native PM is not supported */
Rafael J. Wysockib3bad722009-05-17 20:17:06 +0200668 if (!dev->pm_cap)
669 dev->current_state = PCI_D0;
Rafael J. Wysocki0e5dd462009-03-26 22:51:40 +0100670 }
671
672 return error;
673}
674
675/**
676 * __pci_start_power_transition - Start power transition of a PCI device
677 * @dev: PCI device to handle.
678 * @state: State to put the device into.
679 */
680static void __pci_start_power_transition(struct pci_dev *dev, pci_power_t state)
681{
682 if (state == PCI_D0)
683 pci_platform_power_transition(dev, PCI_D0);
684}
685
686/**
687 * __pci_complete_power_transition - Complete power transition of a PCI device
688 * @dev: PCI device to handle.
689 * @state: State to put the device into.
690 *
691 * This function should not be called directly by device drivers.
692 */
693int __pci_complete_power_transition(struct pci_dev *dev, pci_power_t state)
694{
Matthew Garrettcc2893b2010-04-22 09:30:51 -0400695 return state >= PCI_D0 ?
Rafael J. Wysocki0e5dd462009-03-26 22:51:40 +0100696 pci_platform_power_transition(dev, state) : -EINVAL;
697}
698EXPORT_SYMBOL_GPL(__pci_complete_power_transition);
699
700/**
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200701 * pci_set_power_state - Set the power state of a PCI device
702 * @dev: PCI device to handle.
703 * @state: PCI power state (D0, D1, D2, D3hot) to put the device into.
704 *
Nick Andrew877d0312009-01-26 11:06:57 +0100705 * Transition a device to a new power state, using the platform firmware and/or
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200706 * the device's PCI PM registers.
707 *
708 * RETURN VALUE:
709 * -EINVAL if the requested state is invalid.
710 * -EIO if device does not support PCI PM or its PM capabilities register has a
711 * wrong version, or device doesn't support the requested state.
712 * 0 if device already is in the requested state.
713 * 0 if device's power state has been successfully changed.
714 */
715int pci_set_power_state(struct pci_dev *dev, pci_power_t state)
716{
Rafael J. Wysocki337001b2008-07-07 03:36:24 +0200717 int error;
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200718
719 /* bound the state we're entering */
720 if (state > PCI_D3hot)
721 state = PCI_D3hot;
722 else if (state < PCI_D0)
723 state = PCI_D0;
724 else if ((state == PCI_D1 || state == PCI_D2) && pci_no_d1d2(dev))
725 /*
726 * If the device or the parent bridge do not support PCI PM,
727 * ignore the request if we're doing anything other than putting
728 * it into D0 (which would only happen on boot).
729 */
730 return 0;
731
Rafael J. Wysocki0e5dd462009-03-26 22:51:40 +0100732 __pci_start_power_transition(dev, state);
733
Alan Cox979b1792008-07-24 17:18:38 +0100734 /* This device is quirked not to be put into D3, so
735 don't put it in D3 */
736 if (state == PCI_D3hot && (dev->dev_flags & PCI_DEV_FLAGS_NO_D3))
737 return 0;
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200738
Rafael J. Wysockif00a20e2009-03-16 22:40:08 +0100739 error = pci_raw_set_power_state(dev, state);
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200740
Rafael J. Wysocki0e5dd462009-03-26 22:51:40 +0100741 if (!__pci_complete_power_transition(dev, state))
742 error = 0;
Naga Chumbalkar1a680b72011-03-21 03:29:08 +0000743 /*
744 * When aspm_policy is "powersave" this call ensures
745 * that ASPM is configured.
746 */
747 if (!error && dev->bus->self)
748 pcie_aspm_powersave_config_link(dev->bus->self);
Rafael J. Wysocki44e4e662008-07-07 03:32:52 +0200749
750 return error;
751}
752
753/**
Linus Torvalds1da177e2005-04-16 15:20:36 -0700754 * pci_choose_state - Choose the power state of a PCI device
755 * @dev: PCI device to be suspended
756 * @state: target sleep state for the whole system. This is the value
757 * that is passed to suspend() function.
758 *
759 * Returns PCI power state suitable for given device and given system
760 * message.
761 */
762
763pci_power_t pci_choose_state(struct pci_dev *dev, pm_message_t state)
764{
Shaohua Liab826ca2007-07-20 10:03:22 +0800765 pci_power_t ret;
David Shaohua Li0f644742005-03-19 00:15:48 -0500766
Linus Torvalds1da177e2005-04-16 15:20:36 -0700767 if (!pci_find_capability(dev, PCI_CAP_ID_PM))
768 return PCI_D0;
769
Rafael J. Wysocki961d9122008-07-07 03:32:02 +0200770 ret = platform_pci_choose_state(dev);
771 if (ret != PCI_POWER_ERROR)
772 return ret;
Pavel Machekca078ba2005-09-03 15:56:57 -0700773
774 switch (state.event) {
775 case PM_EVENT_ON:
776 return PCI_D0;
777 case PM_EVENT_FREEZE:
David Brownellb887d2e2006-08-14 23:11:05 -0700778 case PM_EVENT_PRETHAW:
779 /* REVISIT both freeze and pre-thaw "should" use D0 */
Pavel Machekca078ba2005-09-03 15:56:57 -0700780 case PM_EVENT_SUSPEND:
Rafael J. Wysocki3a2d5b72008-02-23 19:13:25 +0100781 case PM_EVENT_HIBERNATE:
Pavel Machekca078ba2005-09-03 15:56:57 -0700782 return PCI_D3hot;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700783 default:
Bjorn Helgaas80ccba12008-06-13 10:52:11 -0600784 dev_info(&dev->dev, "unrecognized suspend event %d\n",
785 state.event);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700786 BUG();
787 }
788 return PCI_D0;
789}
790
791EXPORT_SYMBOL(pci_choose_state);
792
Yu Zhao89858512009-02-16 02:55:47 +0800793#define PCI_EXP_SAVE_REGS 7
794
Yu Zhao1b6b8ce2009-04-09 14:57:39 +0800795#define pcie_cap_has_devctl(type, flags) 1
796#define pcie_cap_has_lnkctl(type, flags) \
797 ((flags & PCI_EXP_FLAGS_VERS) > 1 || \
798 (type == PCI_EXP_TYPE_ROOT_PORT || \
799 type == PCI_EXP_TYPE_ENDPOINT || \
800 type == PCI_EXP_TYPE_LEG_END))
801#define pcie_cap_has_sltctl(type, flags) \
802 ((flags & PCI_EXP_FLAGS_VERS) > 1 || \
803 ((type == PCI_EXP_TYPE_ROOT_PORT) || \
804 (type == PCI_EXP_TYPE_DOWNSTREAM && \
805 (flags & PCI_EXP_FLAGS_SLOT))))
806#define pcie_cap_has_rtctl(type, flags) \
807 ((flags & PCI_EXP_FLAGS_VERS) > 1 || \
808 (type == PCI_EXP_TYPE_ROOT_PORT || \
809 type == PCI_EXP_TYPE_RC_EC))
810#define pcie_cap_has_devctl2(type, flags) \
811 ((flags & PCI_EXP_FLAGS_VERS) > 1)
812#define pcie_cap_has_lnkctl2(type, flags) \
813 ((flags & PCI_EXP_FLAGS_VERS) > 1)
814#define pcie_cap_has_sltctl2(type, flags) \
815 ((flags & PCI_EXP_FLAGS_VERS) > 1)
816
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300817static int pci_save_pcie_state(struct pci_dev *dev)
818{
819 int pos, i = 0;
820 struct pci_cap_saved_state *save_state;
821 u16 *cap;
Yu Zhao1b6b8ce2009-04-09 14:57:39 +0800822 u16 flags;
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300823
Kenji Kaneshige06a1cba2009-11-11 14:30:56 +0900824 pos = pci_pcie_cap(dev);
825 if (!pos)
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300826 return 0;
827
Eric W. Biederman9f355752007-03-08 13:06:13 -0700828 save_state = pci_find_saved_cap(dev, PCI_CAP_ID_EXP);
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300829 if (!save_state) {
Harvey Harrisone496b612009-01-07 16:22:37 -0800830 dev_err(&dev->dev, "buffer not found in %s\n", __func__);
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300831 return -ENOMEM;
832 }
833 cap = (u16 *)&save_state->data[0];
834
Yu Zhao1b6b8ce2009-04-09 14:57:39 +0800835 pci_read_config_word(dev, pos + PCI_EXP_FLAGS, &flags);
836
837 if (pcie_cap_has_devctl(dev->pcie_type, flags))
838 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL, &cap[i++]);
839 if (pcie_cap_has_lnkctl(dev->pcie_type, flags))
840 pci_read_config_word(dev, pos + PCI_EXP_LNKCTL, &cap[i++]);
841 if (pcie_cap_has_sltctl(dev->pcie_type, flags))
842 pci_read_config_word(dev, pos + PCI_EXP_SLTCTL, &cap[i++]);
843 if (pcie_cap_has_rtctl(dev->pcie_type, flags))
844 pci_read_config_word(dev, pos + PCI_EXP_RTCTL, &cap[i++]);
845 if (pcie_cap_has_devctl2(dev->pcie_type, flags))
846 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL2, &cap[i++]);
847 if (pcie_cap_has_lnkctl2(dev->pcie_type, flags))
848 pci_read_config_word(dev, pos + PCI_EXP_LNKCTL2, &cap[i++]);
849 if (pcie_cap_has_sltctl2(dev->pcie_type, flags))
850 pci_read_config_word(dev, pos + PCI_EXP_SLTCTL2, &cap[i++]);
Rafael J. Wysocki63f48982008-12-07 22:02:58 +0100851
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300852 return 0;
853}
854
855static void pci_restore_pcie_state(struct pci_dev *dev)
856{
857 int i = 0, pos;
858 struct pci_cap_saved_state *save_state;
859 u16 *cap;
Yu Zhao1b6b8ce2009-04-09 14:57:39 +0800860 u16 flags;
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300861
862 save_state = pci_find_saved_cap(dev, PCI_CAP_ID_EXP);
863 pos = pci_find_capability(dev, PCI_CAP_ID_EXP);
864 if (!save_state || pos <= 0)
865 return;
866 cap = (u16 *)&save_state->data[0];
867
Yu Zhao1b6b8ce2009-04-09 14:57:39 +0800868 pci_read_config_word(dev, pos + PCI_EXP_FLAGS, &flags);
869
870 if (pcie_cap_has_devctl(dev->pcie_type, flags))
871 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL, cap[i++]);
872 if (pcie_cap_has_lnkctl(dev->pcie_type, flags))
873 pci_write_config_word(dev, pos + PCI_EXP_LNKCTL, cap[i++]);
874 if (pcie_cap_has_sltctl(dev->pcie_type, flags))
875 pci_write_config_word(dev, pos + PCI_EXP_SLTCTL, cap[i++]);
876 if (pcie_cap_has_rtctl(dev->pcie_type, flags))
877 pci_write_config_word(dev, pos + PCI_EXP_RTCTL, cap[i++]);
878 if (pcie_cap_has_devctl2(dev->pcie_type, flags))
879 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL2, cap[i++]);
880 if (pcie_cap_has_lnkctl2(dev->pcie_type, flags))
881 pci_write_config_word(dev, pos + PCI_EXP_LNKCTL2, cap[i++]);
882 if (pcie_cap_has_sltctl2(dev->pcie_type, flags))
883 pci_write_config_word(dev, pos + PCI_EXP_SLTCTL2, cap[i++]);
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300884}
885
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800886
887static int pci_save_pcix_state(struct pci_dev *dev)
888{
Rafael J. Wysocki63f48982008-12-07 22:02:58 +0100889 int pos;
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800890 struct pci_cap_saved_state *save_state;
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800891
892 pos = pci_find_capability(dev, PCI_CAP_ID_PCIX);
893 if (pos <= 0)
894 return 0;
895
Shaohua Lif34303d2007-12-18 09:56:47 +0800896 save_state = pci_find_saved_cap(dev, PCI_CAP_ID_PCIX);
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800897 if (!save_state) {
Harvey Harrisone496b612009-01-07 16:22:37 -0800898 dev_err(&dev->dev, "buffer not found in %s\n", __func__);
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800899 return -ENOMEM;
900 }
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800901
Rafael J. Wysocki63f48982008-12-07 22:02:58 +0100902 pci_read_config_word(dev, pos + PCI_X_CMD, (u16 *)save_state->data);
903
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800904 return 0;
905}
906
907static void pci_restore_pcix_state(struct pci_dev *dev)
908{
909 int i = 0, pos;
910 struct pci_cap_saved_state *save_state;
911 u16 *cap;
912
913 save_state = pci_find_saved_cap(dev, PCI_CAP_ID_PCIX);
914 pos = pci_find_capability(dev, PCI_CAP_ID_PCIX);
915 if (!save_state || pos <= 0)
916 return;
917 cap = (u16 *)&save_state->data[0];
918
919 pci_write_config_word(dev, pos + PCI_X_CMD, cap[i++]);
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800920}
921
922
Linus Torvalds1da177e2005-04-16 15:20:36 -0700923/**
924 * pci_save_state - save the PCI configuration space of a device before suspending
925 * @dev: - PCI device that we're dealing with
Linus Torvalds1da177e2005-04-16 15:20:36 -0700926 */
927int
928pci_save_state(struct pci_dev *dev)
929{
930 int i;
931 /* XXX: 100% dword access ok here? */
932 for (i = 0; i < 16; i++)
Kleber Sacilotto de Souza9e0b5b22009-11-25 00:55:51 -0200933 pci_read_config_dword(dev, i * 4, &dev->saved_config_space[i]);
Rafael J. Wysockiaa8c6c92009-01-16 21:54:43 +0100934 dev->state_saved = true;
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300935 if ((i = pci_save_pcie_state(dev)) != 0)
936 return i;
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800937 if ((i = pci_save_pcix_state(dev)) != 0)
938 return i;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700939 return 0;
940}
941
942/**
943 * pci_restore_state - Restore the saved state of a PCI device
944 * @dev: - PCI device that we're dealing with
Linus Torvalds1da177e2005-04-16 15:20:36 -0700945 */
Jon Mason1d3c16a2010-11-30 17:43:26 -0600946void pci_restore_state(struct pci_dev *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700947{
948 int i;
Al Virob4482a42007-10-14 19:35:40 +0100949 u32 val;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700950
Alek Duc82f63e2009-08-08 08:46:19 +0800951 if (!dev->state_saved)
Jon Mason1d3c16a2010-11-30 17:43:26 -0600952 return;
Rafael J. Wysocki4b77b0a2009-09-09 23:49:59 +0200953
Michael S. Tsirkinb56a5a22006-08-21 16:22:22 +0300954 /* PCI Express register must be restored first */
955 pci_restore_pcie_state(dev);
956
Yu, Luming8b8c8d22006-04-25 00:00:34 -0700957 /*
958 * The Base Address register should be programmed before the command
959 * register(s)
960 */
961 for (i = 15; i >= 0; i--) {
Dave Jones04d9c1a2006-04-18 21:06:51 -0700962 pci_read_config_dword(dev, i * 4, &val);
963 if (val != dev->saved_config_space[i]) {
Bjorn Helgaas80ccba12008-06-13 10:52:11 -0600964 dev_printk(KERN_DEBUG, &dev->dev, "restoring config "
965 "space at offset %#x (was %#x, writing %#x)\n",
966 i, val, (int)dev->saved_config_space[i]);
Dave Jones04d9c1a2006-04-18 21:06:51 -0700967 pci_write_config_dword(dev,i * 4,
968 dev->saved_config_space[i]);
969 }
970 }
Stephen Hemmingercc692a52006-11-08 16:17:15 -0800971 pci_restore_pcix_state(dev);
Shaohua Li41017f02006-02-08 17:11:38 +0800972 pci_restore_msi_state(dev);
Yu Zhao8c5cdb62009-03-20 11:25:12 +0800973 pci_restore_iov_state(dev);
Michael Ellerman8fed4b62007-01-25 19:34:08 +1100974
Rafael J. Wysocki4b77b0a2009-09-09 23:49:59 +0200975 dev->state_saved = false;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700976}
977
Hidetoshi Seto38cc1302006-12-18 10:30:00 +0900978static int do_pci_enable_device(struct pci_dev *dev, int bars)
979{
980 int err;
981
982 err = pci_set_power_state(dev, PCI_D0);
983 if (err < 0 && err != -EIO)
984 return err;
985 err = pcibios_enable_device(dev, bars);
986 if (err < 0)
987 return err;
988 pci_fixup_device(pci_fixup_enable, dev);
989
990 return 0;
991}
992
993/**
Tejun Heo0b62e132007-07-27 14:43:35 +0900994 * pci_reenable_device - Resume abandoned device
Hidetoshi Seto38cc1302006-12-18 10:30:00 +0900995 * @dev: PCI device to be resumed
996 *
997 * Note this function is a backend of pci_default_resume and is not supposed
998 * to be called by normal code, write proper resume handler and use it instead.
999 */
Tejun Heo0b62e132007-07-27 14:43:35 +09001000int pci_reenable_device(struct pci_dev *dev)
Hidetoshi Seto38cc1302006-12-18 10:30:00 +09001001{
Yuji Shimada296ccb02009-04-03 16:41:46 +09001002 if (pci_is_enabled(dev))
Hidetoshi Seto38cc1302006-12-18 10:30:00 +09001003 return do_pci_enable_device(dev, (1 << PCI_NUM_RESOURCES) - 1);
1004 return 0;
1005}
1006
Benjamin Herrenschmidtb7189892007-12-20 15:28:08 +11001007static int __pci_enable_device_flags(struct pci_dev *dev,
1008 resource_size_t flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001009{
1010 int err;
Benjamin Herrenschmidtb7189892007-12-20 15:28:08 +11001011 int i, bars = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001012
Jesse Barnes97c145f2010-11-05 15:16:36 -04001013 /*
1014 * Power state could be unknown at this point, either due to a fresh
1015 * boot or a device removal call. So get the current power state
1016 * so that things like MSI message writing will behave as expected
1017 * (e.g. if the device really is in D0 at enable time).
1018 */
1019 if (dev->pm_cap) {
1020 u16 pmcsr;
1021 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
1022 dev->current_state = (pmcsr & PCI_PM_CTRL_STATE_MASK);
1023 }
1024
Hidetoshi Seto9fb625c2006-12-18 10:28:43 +09001025 if (atomic_add_return(1, &dev->enable_cnt) > 1)
1026 return 0; /* already enabled */
1027
Benjamin Herrenschmidtb7189892007-12-20 15:28:08 +11001028 for (i = 0; i < DEVICE_COUNT_RESOURCE; i++)
1029 if (dev->resource[i].flags & flags)
1030 bars |= (1 << i);
1031
Hidetoshi Seto38cc1302006-12-18 10:30:00 +09001032 err = do_pci_enable_device(dev, bars);
Greg Kroah-Hartman95a62962005-07-28 11:37:33 -07001033 if (err < 0)
Hidetoshi Seto38cc1302006-12-18 10:30:00 +09001034 atomic_dec(&dev->enable_cnt);
Hidetoshi Seto9fb625c2006-12-18 10:28:43 +09001035 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001036}
1037
1038/**
Benjamin Herrenschmidtb7189892007-12-20 15:28:08 +11001039 * pci_enable_device_io - Initialize a device for use with IO space
1040 * @dev: PCI device to be initialized
1041 *
1042 * Initialize device before it's used by a driver. Ask low-level code
1043 * to enable I/O resources. Wake up the device if it was suspended.
1044 * Beware, this function can fail.
1045 */
1046int pci_enable_device_io(struct pci_dev *dev)
1047{
1048 return __pci_enable_device_flags(dev, IORESOURCE_IO);
1049}
1050
1051/**
1052 * pci_enable_device_mem - Initialize a device for use with Memory space
1053 * @dev: PCI device to be initialized
1054 *
1055 * Initialize device before it's used by a driver. Ask low-level code
1056 * to enable Memory resources. Wake up the device if it was suspended.
1057 * Beware, this function can fail.
1058 */
1059int pci_enable_device_mem(struct pci_dev *dev)
1060{
1061 return __pci_enable_device_flags(dev, IORESOURCE_MEM);
1062}
1063
Linus Torvalds1da177e2005-04-16 15:20:36 -07001064/**
1065 * pci_enable_device - Initialize device before it's used by a driver.
1066 * @dev: PCI device to be initialized
1067 *
1068 * Initialize device before it's used by a driver. Ask low-level code
1069 * to enable I/O and memory. Wake up the device if it was suspended.
1070 * Beware, this function can fail.
Inaky Perez-Gonzalezbae94d02006-11-22 12:40:31 -08001071 *
1072 * Note we don't actually enable the device many times if we call
1073 * this function repeatedly (we just increment the count).
Linus Torvalds1da177e2005-04-16 15:20:36 -07001074 */
Inaky Perez-Gonzalezbae94d02006-11-22 12:40:31 -08001075int pci_enable_device(struct pci_dev *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001076{
Benjamin Herrenschmidtb7189892007-12-20 15:28:08 +11001077 return __pci_enable_device_flags(dev, IORESOURCE_MEM | IORESOURCE_IO);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001078}
1079
Tejun Heo9ac78492007-01-20 16:00:26 +09001080/*
1081 * Managed PCI resources. This manages device on/off, intx/msi/msix
1082 * on/off and BAR regions. pci_dev itself records msi/msix status, so
1083 * there's no need to track it separately. pci_devres is initialized
1084 * when a device is enabled using managed PCI device enable interface.
1085 */
1086struct pci_devres {
Tejun Heo7f375f32007-02-25 04:36:01 -08001087 unsigned int enabled:1;
1088 unsigned int pinned:1;
Tejun Heo9ac78492007-01-20 16:00:26 +09001089 unsigned int orig_intx:1;
1090 unsigned int restore_intx:1;
1091 u32 region_mask;
1092};
1093
1094static void pcim_release(struct device *gendev, void *res)
1095{
1096 struct pci_dev *dev = container_of(gendev, struct pci_dev, dev);
1097 struct pci_devres *this = res;
1098 int i;
1099
1100 if (dev->msi_enabled)
1101 pci_disable_msi(dev);
1102 if (dev->msix_enabled)
1103 pci_disable_msix(dev);
1104
1105 for (i = 0; i < DEVICE_COUNT_RESOURCE; i++)
1106 if (this->region_mask & (1 << i))
1107 pci_release_region(dev, i);
1108
1109 if (this->restore_intx)
1110 pci_intx(dev, this->orig_intx);
1111
Tejun Heo7f375f32007-02-25 04:36:01 -08001112 if (this->enabled && !this->pinned)
Tejun Heo9ac78492007-01-20 16:00:26 +09001113 pci_disable_device(dev);
1114}
1115
1116static struct pci_devres * get_pci_dr(struct pci_dev *pdev)
1117{
1118 struct pci_devres *dr, *new_dr;
1119
1120 dr = devres_find(&pdev->dev, pcim_release, NULL, NULL);
1121 if (dr)
1122 return dr;
1123
1124 new_dr = devres_alloc(pcim_release, sizeof(*new_dr), GFP_KERNEL);
1125 if (!new_dr)
1126 return NULL;
1127 return devres_get(&pdev->dev, new_dr, NULL, NULL);
1128}
1129
1130static struct pci_devres * find_pci_dr(struct pci_dev *pdev)
1131{
1132 if (pci_is_managed(pdev))
1133 return devres_find(&pdev->dev, pcim_release, NULL, NULL);
1134 return NULL;
1135}
1136
1137/**
1138 * pcim_enable_device - Managed pci_enable_device()
1139 * @pdev: PCI device to be initialized
1140 *
1141 * Managed pci_enable_device().
1142 */
1143int pcim_enable_device(struct pci_dev *pdev)
1144{
1145 struct pci_devres *dr;
1146 int rc;
1147
1148 dr = get_pci_dr(pdev);
1149 if (unlikely(!dr))
1150 return -ENOMEM;
Tejun Heob95d58e2008-01-30 18:20:04 +09001151 if (dr->enabled)
1152 return 0;
Tejun Heo9ac78492007-01-20 16:00:26 +09001153
1154 rc = pci_enable_device(pdev);
1155 if (!rc) {
1156 pdev->is_managed = 1;
Tejun Heo7f375f32007-02-25 04:36:01 -08001157 dr->enabled = 1;
Tejun Heo9ac78492007-01-20 16:00:26 +09001158 }
1159 return rc;
1160}
1161
1162/**
1163 * pcim_pin_device - Pin managed PCI device
1164 * @pdev: PCI device to pin
1165 *
1166 * Pin managed PCI device @pdev. Pinned device won't be disabled on
1167 * driver detach. @pdev must have been enabled with
1168 * pcim_enable_device().
1169 */
1170void pcim_pin_device(struct pci_dev *pdev)
1171{
1172 struct pci_devres *dr;
1173
1174 dr = find_pci_dr(pdev);
Tejun Heo7f375f32007-02-25 04:36:01 -08001175 WARN_ON(!dr || !dr->enabled);
Tejun Heo9ac78492007-01-20 16:00:26 +09001176 if (dr)
Tejun Heo7f375f32007-02-25 04:36:01 -08001177 dr->pinned = 1;
Tejun Heo9ac78492007-01-20 16:00:26 +09001178}
1179
Linus Torvalds1da177e2005-04-16 15:20:36 -07001180/**
1181 * pcibios_disable_device - disable arch specific PCI resources for device dev
1182 * @dev: the PCI device to disable
1183 *
1184 * Disables architecture specific PCI resources for the device. This
1185 * is the default implementation. Architecture implementations can
1186 * override this.
1187 */
1188void __attribute__ ((weak)) pcibios_disable_device (struct pci_dev *dev) {}
1189
Rafael J. Wysockifa58d302009-01-07 13:03:42 +01001190static void do_pci_disable_device(struct pci_dev *dev)
1191{
1192 u16 pci_command;
1193
1194 pci_read_config_word(dev, PCI_COMMAND, &pci_command);
1195 if (pci_command & PCI_COMMAND_MASTER) {
1196 pci_command &= ~PCI_COMMAND_MASTER;
1197 pci_write_config_word(dev, PCI_COMMAND, pci_command);
1198 }
1199
1200 pcibios_disable_device(dev);
1201}
1202
1203/**
1204 * pci_disable_enabled_device - Disable device without updating enable_cnt
1205 * @dev: PCI device to disable
1206 *
1207 * NOTE: This function is a backend of PCI power management routines and is
1208 * not supposed to be called drivers.
1209 */
1210void pci_disable_enabled_device(struct pci_dev *dev)
1211{
Yuji Shimada296ccb02009-04-03 16:41:46 +09001212 if (pci_is_enabled(dev))
Rafael J. Wysockifa58d302009-01-07 13:03:42 +01001213 do_pci_disable_device(dev);
1214}
1215
Linus Torvalds1da177e2005-04-16 15:20:36 -07001216/**
1217 * pci_disable_device - Disable PCI device after use
1218 * @dev: PCI device to be disabled
1219 *
1220 * Signal to the system that the PCI device is not in use by the system
1221 * anymore. This only involves disabling PCI bus-mastering, if active.
Inaky Perez-Gonzalezbae94d02006-11-22 12:40:31 -08001222 *
1223 * Note we don't actually disable the device until all callers of
Roman Fietzeee6583f2010-05-18 14:45:47 +02001224 * pci_enable_device() have called pci_disable_device().
Linus Torvalds1da177e2005-04-16 15:20:36 -07001225 */
1226void
1227pci_disable_device(struct pci_dev *dev)
1228{
Tejun Heo9ac78492007-01-20 16:00:26 +09001229 struct pci_devres *dr;
Shaohua Li99dc8042006-05-26 10:58:27 +08001230
Tejun Heo9ac78492007-01-20 16:00:26 +09001231 dr = find_pci_dr(dev);
1232 if (dr)
Tejun Heo7f375f32007-02-25 04:36:01 -08001233 dr->enabled = 0;
Tejun Heo9ac78492007-01-20 16:00:26 +09001234
Inaky Perez-Gonzalezbae94d02006-11-22 12:40:31 -08001235 if (atomic_sub_return(1, &dev->enable_cnt) != 0)
1236 return;
1237
Rafael J. Wysockifa58d302009-01-07 13:03:42 +01001238 do_pci_disable_device(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001239
Rafael J. Wysockifa58d302009-01-07 13:03:42 +01001240 dev->is_busmaster = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001241}
1242
1243/**
Brian Kingf7bdd122007-04-06 16:39:36 -05001244 * pcibios_set_pcie_reset_state - set reset state for device dev
Stefan Assmann45e829e2009-12-03 06:49:24 -05001245 * @dev: the PCIe device reset
Brian Kingf7bdd122007-04-06 16:39:36 -05001246 * @state: Reset state to enter into
1247 *
1248 *
Stefan Assmann45e829e2009-12-03 06:49:24 -05001249 * Sets the PCIe reset state for the device. This is the default
Brian Kingf7bdd122007-04-06 16:39:36 -05001250 * implementation. Architecture implementations can override this.
1251 */
1252int __attribute__ ((weak)) pcibios_set_pcie_reset_state(struct pci_dev *dev,
1253 enum pcie_reset_state state)
1254{
1255 return -EINVAL;
1256}
1257
1258/**
1259 * pci_set_pcie_reset_state - set reset state for device dev
Stefan Assmann45e829e2009-12-03 06:49:24 -05001260 * @dev: the PCIe device reset
Brian Kingf7bdd122007-04-06 16:39:36 -05001261 * @state: Reset state to enter into
1262 *
1263 *
1264 * Sets the PCI reset state for the device.
1265 */
1266int pci_set_pcie_reset_state(struct pci_dev *dev, enum pcie_reset_state state)
1267{
1268 return pcibios_set_pcie_reset_state(dev, state);
1269}
1270
1271/**
Rafael J. Wysocki58ff4632010-02-17 23:36:58 +01001272 * pci_check_pme_status - Check if given device has generated PME.
1273 * @dev: Device to check.
1274 *
1275 * Check the PME status of the device and if set, clear it and clear PME enable
1276 * (if set). Return 'true' if PME status and PME enable were both set or
1277 * 'false' otherwise.
1278 */
1279bool pci_check_pme_status(struct pci_dev *dev)
1280{
1281 int pmcsr_pos;
1282 u16 pmcsr;
1283 bool ret = false;
1284
1285 if (!dev->pm_cap)
1286 return false;
1287
1288 pmcsr_pos = dev->pm_cap + PCI_PM_CTRL;
1289 pci_read_config_word(dev, pmcsr_pos, &pmcsr);
1290 if (!(pmcsr & PCI_PM_CTRL_PME_STATUS))
1291 return false;
1292
1293 /* Clear PME status. */
1294 pmcsr |= PCI_PM_CTRL_PME_STATUS;
1295 if (pmcsr & PCI_PM_CTRL_PME_ENABLE) {
1296 /* Disable PME to avoid interrupt flood. */
1297 pmcsr &= ~PCI_PM_CTRL_PME_ENABLE;
1298 ret = true;
1299 }
1300
1301 pci_write_config_word(dev, pmcsr_pos, pmcsr);
1302
1303 return ret;
1304}
1305
1306/**
Rafael J. Wysockib67ea762010-02-17 23:44:09 +01001307 * pci_pme_wakeup - Wake up a PCI device if its PME Status bit is set.
1308 * @dev: Device to handle.
1309 * @ign: Ignored.
1310 *
1311 * Check if @dev has generated PME and queue a resume request for it in that
1312 * case.
1313 */
1314static int pci_pme_wakeup(struct pci_dev *dev, void *ign)
1315{
Rafael J. Wysockic125e962010-07-05 22:43:53 +02001316 if (pci_check_pme_status(dev)) {
Rafael J. Wysockic125e962010-07-05 22:43:53 +02001317 pci_wakeup_event(dev);
Rafael J. Wysocki0f953bf2010-12-29 13:22:08 +01001318 pm_request_resume(&dev->dev);
Rafael J. Wysockic125e962010-07-05 22:43:53 +02001319 }
Rafael J. Wysockib67ea762010-02-17 23:44:09 +01001320 return 0;
1321}
1322
1323/**
1324 * pci_pme_wakeup_bus - Walk given bus and wake up devices on it, if necessary.
1325 * @bus: Top bus of the subtree to walk.
1326 */
1327void pci_pme_wakeup_bus(struct pci_bus *bus)
1328{
1329 if (bus)
1330 pci_walk_bus(bus, pci_pme_wakeup, NULL);
1331}
1332
1333/**
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001334 * pci_pme_capable - check the capability of PCI device to generate PME#
1335 * @dev: PCI device to handle.
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001336 * @state: PCI state from which device will issue PME#.
1337 */
Rafael J. Wysockie5899e12008-07-19 14:39:24 +02001338bool pci_pme_capable(struct pci_dev *dev, pci_power_t state)
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001339{
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001340 if (!dev->pm_cap)
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001341 return false;
1342
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001343 return !!(dev->pme_support & (1 << state));
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001344}
1345
Matthew Garrettdf17e622010-10-04 14:22:29 -04001346static void pci_pme_list_scan(struct work_struct *work)
1347{
1348 struct pci_pme_device *pme_dev;
1349
1350 mutex_lock(&pci_pme_list_mutex);
1351 if (!list_empty(&pci_pme_list)) {
1352 list_for_each_entry(pme_dev, &pci_pme_list, list)
1353 pci_pme_wakeup(pme_dev->dev, NULL);
1354 schedule_delayed_work(&pci_pme_work, msecs_to_jiffies(PME_TIMEOUT));
1355 }
1356 mutex_unlock(&pci_pme_list_mutex);
1357}
1358
1359/**
1360 * pci_external_pme - is a device an external PCI PME source?
1361 * @dev: PCI device to check
1362 *
1363 */
1364
1365static bool pci_external_pme(struct pci_dev *dev)
1366{
1367 if (pci_is_pcie(dev) || dev->bus->number == 0)
1368 return false;
1369 return true;
1370}
1371
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001372/**
1373 * pci_pme_active - enable or disable PCI device's PME# function
1374 * @dev: PCI device to handle.
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001375 * @enable: 'true' to enable PME# generation; 'false' to disable it.
1376 *
1377 * The caller must verify that the device is capable of generating PME# before
1378 * calling this function with @enable equal to 'true'.
1379 */
Rafael J. Wysocki5a6c9b62008-08-08 00:14:24 +02001380void pci_pme_active(struct pci_dev *dev, bool enable)
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001381{
1382 u16 pmcsr;
1383
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001384 if (!dev->pm_cap)
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001385 return;
1386
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001387 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001388 /* Clear PME_Status by writing 1 to it and enable PME# */
1389 pmcsr |= PCI_PM_CTRL_PME_STATUS | PCI_PM_CTRL_PME_ENABLE;
1390 if (!enable)
1391 pmcsr &= ~PCI_PM_CTRL_PME_ENABLE;
1392
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001393 pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, pmcsr);
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001394
Matthew Garrettdf17e622010-10-04 14:22:29 -04001395 /* PCI (as opposed to PCIe) PME requires that the device have
1396 its PME# line hooked up correctly. Not all hardware vendors
1397 do this, so the PME never gets delivered and the device
1398 remains asleep. The easiest way around this is to
1399 periodically walk the list of suspended devices and check
1400 whether any have their PME flag set. The assumption is that
1401 we'll wake up often enough anyway that this won't be a huge
1402 hit, and the power savings from the devices will still be a
1403 win. */
1404
1405 if (pci_external_pme(dev)) {
1406 struct pci_pme_device *pme_dev;
1407 if (enable) {
1408 pme_dev = kmalloc(sizeof(struct pci_pme_device),
1409 GFP_KERNEL);
1410 if (!pme_dev)
1411 goto out;
1412 pme_dev->dev = dev;
1413 mutex_lock(&pci_pme_list_mutex);
1414 list_add(&pme_dev->list, &pci_pme_list);
1415 if (list_is_singular(&pci_pme_list))
1416 schedule_delayed_work(&pci_pme_work,
1417 msecs_to_jiffies(PME_TIMEOUT));
1418 mutex_unlock(&pci_pme_list_mutex);
1419 } else {
1420 mutex_lock(&pci_pme_list_mutex);
1421 list_for_each_entry(pme_dev, &pci_pme_list, list) {
1422 if (pme_dev->dev == dev) {
1423 list_del(&pme_dev->list);
1424 kfree(pme_dev);
1425 break;
1426 }
1427 }
1428 mutex_unlock(&pci_pme_list_mutex);
1429 }
1430 }
1431
1432out:
Bjorn Helgaas10c3d712009-11-04 10:32:42 -07001433 dev_printk(KERN_DEBUG, &dev->dev, "PME# %s\n",
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001434 enable ? "enabled" : "disabled");
1435}
1436
1437/**
Rafael J. Wysocki6cbf8212010-02-17 23:44:58 +01001438 * __pci_enable_wake - enable PCI device as wakeup event source
David Brownell075c1772007-04-26 00:12:06 -07001439 * @dev: PCI device affected
1440 * @state: PCI state from which device will issue wakeup events
Rafael J. Wysocki6cbf8212010-02-17 23:44:58 +01001441 * @runtime: True if the events are to be generated at run time
David Brownell075c1772007-04-26 00:12:06 -07001442 * @enable: True to enable event generation; false to disable
Linus Torvalds1da177e2005-04-16 15:20:36 -07001443 *
David Brownell075c1772007-04-26 00:12:06 -07001444 * This enables the device as a wakeup event source, or disables it.
1445 * When such events involves platform-specific hooks, those hooks are
1446 * called automatically by this routine.
1447 *
1448 * Devices with legacy power management (no standard PCI PM capabilities)
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001449 * always require such platform hooks.
David Brownell075c1772007-04-26 00:12:06 -07001450 *
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001451 * RETURN VALUE:
1452 * 0 is returned on success
1453 * -EINVAL is returned if device is not supposed to wake up the system
1454 * Error code depending on the platform is returned if both the platform and
1455 * the native mechanism fail to enable the generation of wake-up events
Linus Torvalds1da177e2005-04-16 15:20:36 -07001456 */
Rafael J. Wysocki6cbf8212010-02-17 23:44:58 +01001457int __pci_enable_wake(struct pci_dev *dev, pci_power_t state,
1458 bool runtime, bool enable)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001459{
Rafael J. Wysocki5bcc2fb2009-09-08 23:12:59 +02001460 int ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001461
Rafael J. Wysocki6cbf8212010-02-17 23:44:58 +01001462 if (enable && !runtime && !device_may_wakeup(&dev->dev))
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001463 return -EINVAL;
1464
Rafael J. Wysockie80bb092009-09-08 23:14:49 +02001465 /* Don't do the same thing twice in a row for one device. */
1466 if (!!enable == !!dev->wakeup_prepared)
1467 return 0;
1468
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001469 /*
1470 * According to "PCI System Architecture" 4th ed. by Tom Shanley & Don
1471 * Anderson we should be doing PME# wake enable followed by ACPI wake
1472 * enable. To disable wake-up we call the platform first, for symmetry.
David Brownell075c1772007-04-26 00:12:06 -07001473 */
1474
Rafael J. Wysocki5bcc2fb2009-09-08 23:12:59 +02001475 if (enable) {
1476 int error;
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001477
Rafael J. Wysocki5bcc2fb2009-09-08 23:12:59 +02001478 if (pci_pme_capable(dev, state))
1479 pci_pme_active(dev, true);
1480 else
1481 ret = 1;
Rafael J. Wysocki6cbf8212010-02-17 23:44:58 +01001482 error = runtime ? platform_pci_run_wake(dev, true) :
1483 platform_pci_sleep_wake(dev, true);
Rafael J. Wysocki5bcc2fb2009-09-08 23:12:59 +02001484 if (ret)
1485 ret = error;
Rafael J. Wysockie80bb092009-09-08 23:14:49 +02001486 if (!ret)
1487 dev->wakeup_prepared = true;
Rafael J. Wysocki5bcc2fb2009-09-08 23:12:59 +02001488 } else {
Rafael J. Wysocki6cbf8212010-02-17 23:44:58 +01001489 if (runtime)
1490 platform_pci_run_wake(dev, false);
1491 else
1492 platform_pci_sleep_wake(dev, false);
Rafael J. Wysocki5bcc2fb2009-09-08 23:12:59 +02001493 pci_pme_active(dev, false);
Rafael J. Wysockie80bb092009-09-08 23:14:49 +02001494 dev->wakeup_prepared = false;
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001495 }
1496
Rafael J. Wysocki5bcc2fb2009-09-08 23:12:59 +02001497 return ret;
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001498}
Rafael J. Wysocki6cbf8212010-02-17 23:44:58 +01001499EXPORT_SYMBOL(__pci_enable_wake);
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001500
1501/**
Rafael J. Wysocki0235c4f2008-08-18 21:38:00 +02001502 * pci_wake_from_d3 - enable/disable device to wake up from D3_hot or D3_cold
1503 * @dev: PCI device to prepare
1504 * @enable: True to enable wake-up event generation; false to disable
1505 *
1506 * Many drivers want the device to wake up the system from D3_hot or D3_cold
1507 * and this function allows them to set that up cleanly - pci_enable_wake()
1508 * should not be called twice in a row to enable wake-up due to PCI PM vs ACPI
1509 * ordering constraints.
1510 *
1511 * This function only returns error code if the device is not capable of
1512 * generating PME# from both D3_hot and D3_cold, and the platform is unable to
1513 * enable wake-up power for it.
1514 */
1515int pci_wake_from_d3(struct pci_dev *dev, bool enable)
1516{
1517 return pci_pme_capable(dev, PCI_D3cold) ?
1518 pci_enable_wake(dev, PCI_D3cold, enable) :
1519 pci_enable_wake(dev, PCI_D3hot, enable);
1520}
1521
1522/**
Jesse Barnes37139072008-07-28 11:49:26 -07001523 * pci_target_state - find an appropriate low power state for a given PCI dev
1524 * @dev: PCI device
1525 *
1526 * Use underlying platform code to find a supported low power state for @dev.
1527 * If the platform can't manage @dev, return the deepest state from which it
1528 * can generate wake events, based on any available PME info.
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001529 */
Rafael J. Wysockie5899e12008-07-19 14:39:24 +02001530pci_power_t pci_target_state(struct pci_dev *dev)
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001531{
1532 pci_power_t target_state = PCI_D3hot;
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001533
1534 if (platform_pci_power_manageable(dev)) {
1535 /*
1536 * Call the platform to choose the target state of the device
1537 * and enable wake-up from this state if supported.
1538 */
1539 pci_power_t state = platform_pci_choose_state(dev);
1540
1541 switch (state) {
1542 case PCI_POWER_ERROR:
1543 case PCI_UNKNOWN:
1544 break;
1545 case PCI_D1:
1546 case PCI_D2:
1547 if (pci_no_d1d2(dev))
1548 break;
1549 default:
1550 target_state = state;
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001551 }
Rafael J. Wysockid2abdf62009-06-14 21:25:02 +02001552 } else if (!dev->pm_cap) {
1553 target_state = PCI_D0;
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001554 } else if (device_may_wakeup(&dev->dev)) {
1555 /*
1556 * Find the deepest state from which the device can generate
1557 * wake-up events, make it the target state and enable device
1558 * to generate PME#.
1559 */
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001560 if (dev->pme_support) {
1561 while (target_state
1562 && !(dev->pme_support & (1 << target_state)))
1563 target_state--;
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001564 }
1565 }
1566
Rafael J. Wysockie5899e12008-07-19 14:39:24 +02001567 return target_state;
1568}
1569
1570/**
1571 * pci_prepare_to_sleep - prepare PCI device for system-wide transition into a sleep state
1572 * @dev: Device to handle.
1573 *
1574 * Choose the power state appropriate for the device depending on whether
1575 * it can wake up the system and/or is power manageable by the platform
1576 * (PCI_D3hot is the default) and put the device into that state.
1577 */
1578int pci_prepare_to_sleep(struct pci_dev *dev)
1579{
1580 pci_power_t target_state = pci_target_state(dev);
1581 int error;
1582
1583 if (target_state == PCI_POWER_ERROR)
1584 return -EIO;
1585
Rafael J. Wysocki8efb8c72009-03-30 21:46:27 +02001586 pci_enable_wake(dev, target_state, device_may_wakeup(&dev->dev));
Rafael J. Wysockic157dfa2008-07-13 22:45:06 +02001587
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001588 error = pci_set_power_state(dev, target_state);
1589
1590 if (error)
1591 pci_enable_wake(dev, target_state, false);
1592
1593 return error;
1594}
1595
1596/**
Randy Dunlap443bd1c2008-07-21 09:27:18 -07001597 * pci_back_from_sleep - turn PCI device on during system-wide transition into working state
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001598 * @dev: Device to handle.
1599 *
Thomas Weber88393162010-03-16 11:47:56 +01001600 * Disable device's system wake-up capability and put it into D0.
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02001601 */
1602int pci_back_from_sleep(struct pci_dev *dev)
1603{
1604 pci_enable_wake(dev, PCI_D0, false);
1605 return pci_set_power_state(dev, PCI_D0);
1606}
1607
1608/**
Rafael J. Wysocki6cbf8212010-02-17 23:44:58 +01001609 * pci_finish_runtime_suspend - Carry out PCI-specific part of runtime suspend.
1610 * @dev: PCI device being suspended.
1611 *
1612 * Prepare @dev to generate wake-up events at run time and put it into a low
1613 * power state.
1614 */
1615int pci_finish_runtime_suspend(struct pci_dev *dev)
1616{
1617 pci_power_t target_state = pci_target_state(dev);
1618 int error;
1619
1620 if (target_state == PCI_POWER_ERROR)
1621 return -EIO;
1622
1623 __pci_enable_wake(dev, target_state, true, pci_dev_run_wake(dev));
1624
1625 error = pci_set_power_state(dev, target_state);
1626
1627 if (error)
1628 __pci_enable_wake(dev, target_state, true, false);
1629
1630 return error;
1631}
1632
1633/**
Rafael J. Wysockib67ea762010-02-17 23:44:09 +01001634 * pci_dev_run_wake - Check if device can generate run-time wake-up events.
1635 * @dev: Device to check.
1636 *
1637 * Return true if the device itself is cabable of generating wake-up events
1638 * (through the platform or using the native PCIe PME) or if the device supports
1639 * PME and one of its upstream bridges can generate wake-up events.
1640 */
1641bool pci_dev_run_wake(struct pci_dev *dev)
1642{
1643 struct pci_bus *bus = dev->bus;
1644
1645 if (device_run_wake(&dev->dev))
1646 return true;
1647
1648 if (!dev->pme_support)
1649 return false;
1650
1651 while (bus->parent) {
1652 struct pci_dev *bridge = bus->self;
1653
1654 if (device_run_wake(&bridge->dev))
1655 return true;
1656
1657 bus = bus->parent;
1658 }
1659
1660 /* We have reached the root bus. */
1661 if (bus->bridge)
1662 return device_run_wake(bus->bridge);
1663
1664 return false;
1665}
1666EXPORT_SYMBOL_GPL(pci_dev_run_wake);
1667
1668/**
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001669 * pci_pm_init - Initialize PM functions of given PCI device
1670 * @dev: PCI device to handle.
1671 */
1672void pci_pm_init(struct pci_dev *dev)
1673{
1674 int pm;
1675 u16 pmc;
David Brownell075c1772007-04-26 00:12:06 -07001676
Rafael J. Wysockibb910a72010-02-27 21:37:37 +01001677 pm_runtime_forbid(&dev->dev);
Rafael J. Wysockia1e4d722010-02-08 19:16:33 +01001678 device_enable_async_suspend(&dev->dev);
Rafael J. Wysockie80bb092009-09-08 23:14:49 +02001679 dev->wakeup_prepared = false;
Rafael J. Wysockibb910a72010-02-27 21:37:37 +01001680
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001681 dev->pm_cap = 0;
1682
Linus Torvalds1da177e2005-04-16 15:20:36 -07001683 /* find PCI PM capability in list */
1684 pm = pci_find_capability(dev, PCI_CAP_ID_PM);
David Brownell075c1772007-04-26 00:12:06 -07001685 if (!pm)
Linus Torvalds50246dd2009-01-16 08:14:51 -08001686 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001687 /* Check device's ability to generate PME# */
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001688 pci_read_config_word(dev, pm + PCI_PM_PMC, &pmc);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001689
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001690 if ((pmc & PCI_PM_CAP_VER_MASK) > 3) {
1691 dev_err(&dev->dev, "unsupported PM cap regs version (%u)\n",
1692 pmc & PCI_PM_CAP_VER_MASK);
Linus Torvalds50246dd2009-01-16 08:14:51 -08001693 return;
David Brownell075c1772007-04-26 00:12:06 -07001694 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001695
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001696 dev->pm_cap = pm;
Rafael J. Wysocki1ae861e2009-12-31 12:15:54 +01001697 dev->d3_delay = PCI_PM_D3_WAIT;
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001698
1699 dev->d1_support = false;
1700 dev->d2_support = false;
1701 if (!pci_no_d1d2(dev)) {
Bjorn Helgaasc9ed77e2008-08-22 09:37:02 -06001702 if (pmc & PCI_PM_CAP_D1)
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001703 dev->d1_support = true;
Bjorn Helgaasc9ed77e2008-08-22 09:37:02 -06001704 if (pmc & PCI_PM_CAP_D2)
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001705 dev->d2_support = true;
Bjorn Helgaasc9ed77e2008-08-22 09:37:02 -06001706
1707 if (dev->d1_support || dev->d2_support)
1708 dev_printk(KERN_DEBUG, &dev->dev, "supports%s%s\n",
Jesse Barnesec84f122008-09-23 11:43:34 -07001709 dev->d1_support ? " D1" : "",
1710 dev->d2_support ? " D2" : "");
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001711 }
1712
1713 pmc &= PCI_PM_CAP_PME_MASK;
1714 if (pmc) {
Bjorn Helgaas10c3d712009-11-04 10:32:42 -07001715 dev_printk(KERN_DEBUG, &dev->dev,
1716 "PME# supported from%s%s%s%s%s\n",
Bjorn Helgaasc9ed77e2008-08-22 09:37:02 -06001717 (pmc & PCI_PM_CAP_PME_D0) ? " D0" : "",
1718 (pmc & PCI_PM_CAP_PME_D1) ? " D1" : "",
1719 (pmc & PCI_PM_CAP_PME_D2) ? " D2" : "",
1720 (pmc & PCI_PM_CAP_PME_D3) ? " D3hot" : "",
1721 (pmc & PCI_PM_CAP_PME_D3cold) ? " D3cold" : "");
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001722 dev->pme_support = pmc >> PCI_PM_CAP_PME_SHIFT;
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001723 /*
1724 * Make device's PM flags reflect the wake-up capability, but
1725 * let the user space enable it to wake up the system as needed.
1726 */
1727 device_set_wakeup_capable(&dev->dev, true);
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001728 /* Disable the PME# generation functionality */
Rafael J. Wysocki337001b2008-07-07 03:36:24 +02001729 pci_pme_active(dev, false);
1730 } else {
1731 dev->pme_support = 0;
Rafael J. Wysockieb9d0fe2008-07-07 03:34:48 +02001732 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001733}
1734
Yu Zhao58c3a722008-10-14 14:02:53 +08001735/**
Jesse Barneseb9c39d2008-12-17 12:10:05 -08001736 * platform_pci_wakeup_init - init platform wakeup if present
1737 * @dev: PCI device
1738 *
1739 * Some devices don't have PCI PM caps but can still generate wakeup
1740 * events through platform methods (like ACPI events). If @dev supports
1741 * platform wakeup events, set the device flag to indicate as much. This
1742 * may be redundant if the device also supports PCI PM caps, but double
1743 * initialization should be safe in that case.
1744 */
1745void platform_pci_wakeup_init(struct pci_dev *dev)
1746{
1747 if (!platform_pci_can_wakeup(dev))
1748 return;
1749
1750 device_set_wakeup_capable(&dev->dev, true);
Jesse Barneseb9c39d2008-12-17 12:10:05 -08001751 platform_pci_sleep_wake(dev, false);
1752}
1753
1754/**
Rafael J. Wysocki63f48982008-12-07 22:02:58 +01001755 * pci_add_save_buffer - allocate buffer for saving given capability registers
1756 * @dev: the PCI device
1757 * @cap: the capability to allocate the buffer for
1758 * @size: requested size of the buffer
1759 */
1760static int pci_add_cap_save_buffer(
1761 struct pci_dev *dev, char cap, unsigned int size)
1762{
1763 int pos;
1764 struct pci_cap_saved_state *save_state;
1765
1766 pos = pci_find_capability(dev, cap);
1767 if (pos <= 0)
1768 return 0;
1769
1770 save_state = kzalloc(sizeof(*save_state) + size, GFP_KERNEL);
1771 if (!save_state)
1772 return -ENOMEM;
1773
1774 save_state->cap_nr = cap;
1775 pci_add_saved_cap(dev, save_state);
1776
1777 return 0;
1778}
1779
1780/**
1781 * pci_allocate_cap_save_buffers - allocate buffers for saving capabilities
1782 * @dev: the PCI device
1783 */
1784void pci_allocate_cap_save_buffers(struct pci_dev *dev)
1785{
1786 int error;
1787
Yu Zhao89858512009-02-16 02:55:47 +08001788 error = pci_add_cap_save_buffer(dev, PCI_CAP_ID_EXP,
1789 PCI_EXP_SAVE_REGS * sizeof(u16));
Rafael J. Wysocki63f48982008-12-07 22:02:58 +01001790 if (error)
1791 dev_err(&dev->dev,
1792 "unable to preallocate PCI Express save buffer\n");
1793
1794 error = pci_add_cap_save_buffer(dev, PCI_CAP_ID_PCIX, sizeof(u16));
1795 if (error)
1796 dev_err(&dev->dev,
1797 "unable to preallocate PCI-X save buffer\n");
1798}
1799
1800/**
Yu Zhao58c3a722008-10-14 14:02:53 +08001801 * pci_enable_ari - enable ARI forwarding if hardware support it
1802 * @dev: the PCI device
1803 */
1804void pci_enable_ari(struct pci_dev *dev)
1805{
1806 int pos;
1807 u32 cap;
1808 u16 ctrl;
Zhao, Yu81135872008-10-23 13:15:39 +08001809 struct pci_dev *bridge;
Yu Zhao58c3a722008-10-14 14:02:53 +08001810
Kenji Kaneshige5f4d91a2009-11-11 14:36:17 +09001811 if (!pci_is_pcie(dev) || dev->devfn)
Yu Zhao58c3a722008-10-14 14:02:53 +08001812 return;
1813
Zhao, Yu81135872008-10-23 13:15:39 +08001814 pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_ARI);
Yu Zhao58c3a722008-10-14 14:02:53 +08001815 if (!pos)
1816 return;
1817
Zhao, Yu81135872008-10-23 13:15:39 +08001818 bridge = dev->bus->self;
Kenji Kaneshige5f4d91a2009-11-11 14:36:17 +09001819 if (!bridge || !pci_is_pcie(bridge))
Zhao, Yu81135872008-10-23 13:15:39 +08001820 return;
1821
Kenji Kaneshige06a1cba2009-11-11 14:30:56 +09001822 pos = pci_pcie_cap(bridge);
Zhao, Yu81135872008-10-23 13:15:39 +08001823 if (!pos)
1824 return;
1825
1826 pci_read_config_dword(bridge, pos + PCI_EXP_DEVCAP2, &cap);
Yu Zhao58c3a722008-10-14 14:02:53 +08001827 if (!(cap & PCI_EXP_DEVCAP2_ARI))
1828 return;
1829
Zhao, Yu81135872008-10-23 13:15:39 +08001830 pci_read_config_word(bridge, pos + PCI_EXP_DEVCTL2, &ctrl);
Yu Zhao58c3a722008-10-14 14:02:53 +08001831 ctrl |= PCI_EXP_DEVCTL2_ARI;
Zhao, Yu81135872008-10-23 13:15:39 +08001832 pci_write_config_word(bridge, pos + PCI_EXP_DEVCTL2, ctrl);
Yu Zhao58c3a722008-10-14 14:02:53 +08001833
Zhao, Yu81135872008-10-23 13:15:39 +08001834 bridge->ari_enabled = 1;
Yu Zhao58c3a722008-10-14 14:02:53 +08001835}
1836
Jesse Barnesb48d4422010-10-19 13:07:57 -07001837/**
1838 * pci_enable_ido - enable ID-based ordering on a device
1839 * @dev: the PCI device
1840 * @type: which types of IDO to enable
1841 *
1842 * Enable ID-based ordering on @dev. @type can contain the bits
1843 * %PCI_EXP_IDO_REQUEST and/or %PCI_EXP_IDO_COMPLETION to indicate
1844 * which types of transactions are allowed to be re-ordered.
1845 */
1846void pci_enable_ido(struct pci_dev *dev, unsigned long type)
1847{
1848 int pos;
1849 u16 ctrl;
1850
1851 pos = pci_pcie_cap(dev);
1852 if (!pos)
1853 return;
1854
1855 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL2, &ctrl);
1856 if (type & PCI_EXP_IDO_REQUEST)
1857 ctrl |= PCI_EXP_IDO_REQ_EN;
1858 if (type & PCI_EXP_IDO_COMPLETION)
1859 ctrl |= PCI_EXP_IDO_CMP_EN;
1860 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL2, ctrl);
1861}
1862EXPORT_SYMBOL(pci_enable_ido);
1863
1864/**
1865 * pci_disable_ido - disable ID-based ordering on a device
1866 * @dev: the PCI device
1867 * @type: which types of IDO to disable
1868 */
1869void pci_disable_ido(struct pci_dev *dev, unsigned long type)
1870{
1871 int pos;
1872 u16 ctrl;
1873
1874 if (!pci_is_pcie(dev))
1875 return;
1876
1877 pos = pci_pcie_cap(dev);
1878 if (!pos)
1879 return;
1880
1881 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL2, &ctrl);
1882 if (type & PCI_EXP_IDO_REQUEST)
1883 ctrl &= ~PCI_EXP_IDO_REQ_EN;
1884 if (type & PCI_EXP_IDO_COMPLETION)
1885 ctrl &= ~PCI_EXP_IDO_CMP_EN;
1886 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL2, ctrl);
1887}
1888EXPORT_SYMBOL(pci_disable_ido);
1889
Chris Wright5d990b62009-12-04 12:15:21 -08001890static int pci_acs_enable;
1891
1892/**
1893 * pci_request_acs - ask for ACS to be enabled if supported
1894 */
1895void pci_request_acs(void)
1896{
1897 pci_acs_enable = 1;
1898}
1899
Bjorn Helgaas57c2cf72008-12-11 11:24:23 -07001900/**
Allen Kayae21ee62009-10-07 10:27:17 -07001901 * pci_enable_acs - enable ACS if hardware support it
1902 * @dev: the PCI device
1903 */
1904void pci_enable_acs(struct pci_dev *dev)
1905{
1906 int pos;
1907 u16 cap;
1908 u16 ctrl;
1909
Chris Wright5d990b62009-12-04 12:15:21 -08001910 if (!pci_acs_enable)
1911 return;
1912
Kenji Kaneshige5f4d91a2009-11-11 14:36:17 +09001913 if (!pci_is_pcie(dev))
Allen Kayae21ee62009-10-07 10:27:17 -07001914 return;
1915
1916 pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_ACS);
1917 if (!pos)
1918 return;
1919
1920 pci_read_config_word(dev, pos + PCI_ACS_CAP, &cap);
1921 pci_read_config_word(dev, pos + PCI_ACS_CTRL, &ctrl);
1922
1923 /* Source Validation */
1924 ctrl |= (cap & PCI_ACS_SV);
1925
1926 /* P2P Request Redirect */
1927 ctrl |= (cap & PCI_ACS_RR);
1928
1929 /* P2P Completion Redirect */
1930 ctrl |= (cap & PCI_ACS_CR);
1931
1932 /* Upstream Forwarding */
1933 ctrl |= (cap & PCI_ACS_UF);
1934
1935 pci_write_config_word(dev, pos + PCI_ACS_CTRL, ctrl);
1936}
1937
1938/**
Bjorn Helgaas57c2cf72008-12-11 11:24:23 -07001939 * pci_swizzle_interrupt_pin - swizzle INTx for device behind bridge
1940 * @dev: the PCI device
1941 * @pin: the INTx pin (1=INTA, 2=INTB, 3=INTD, 4=INTD)
1942 *
1943 * Perform INTx swizzling for a device behind one level of bridge. This is
1944 * required by section 9.1 of the PCI-to-PCI bridge specification for devices
Matthew Wilcox46b952a2009-07-01 14:24:30 -07001945 * behind bridges on add-in cards. For devices with ARI enabled, the slot
1946 * number is always 0 (see the Implementation Note in section 2.2.8.1 of
1947 * the PCI Express Base Specification, Revision 2.1)
Bjorn Helgaas57c2cf72008-12-11 11:24:23 -07001948 */
1949u8 pci_swizzle_interrupt_pin(struct pci_dev *dev, u8 pin)
1950{
Matthew Wilcox46b952a2009-07-01 14:24:30 -07001951 int slot;
1952
1953 if (pci_ari_enabled(dev->bus))
1954 slot = 0;
1955 else
1956 slot = PCI_SLOT(dev->devfn);
1957
1958 return (((pin - 1) + slot) % 4) + 1;
Bjorn Helgaas57c2cf72008-12-11 11:24:23 -07001959}
1960
Linus Torvalds1da177e2005-04-16 15:20:36 -07001961int
1962pci_get_interrupt_pin(struct pci_dev *dev, struct pci_dev **bridge)
1963{
1964 u8 pin;
1965
Kristen Accardi514d2072005-11-02 16:24:39 -08001966 pin = dev->pin;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001967 if (!pin)
1968 return -1;
Bjorn Helgaas878f2e52008-12-09 16:11:46 -07001969
Kenji Kaneshige8784fd42009-05-26 16:07:33 +09001970 while (!pci_is_root_bus(dev->bus)) {
Bjorn Helgaas57c2cf72008-12-11 11:24:23 -07001971 pin = pci_swizzle_interrupt_pin(dev, pin);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001972 dev = dev->bus->self;
1973 }
1974 *bridge = dev;
1975 return pin;
1976}
1977
1978/**
Bjorn Helgaas68feac82008-12-16 21:36:55 -07001979 * pci_common_swizzle - swizzle INTx all the way to root bridge
1980 * @dev: the PCI device
1981 * @pinp: pointer to the INTx pin value (1=INTA, 2=INTB, 3=INTD, 4=INTD)
1982 *
1983 * Perform INTx swizzling for a device. This traverses through all PCI-to-PCI
1984 * bridges all the way up to a PCI root bus.
1985 */
1986u8 pci_common_swizzle(struct pci_dev *dev, u8 *pinp)
1987{
1988 u8 pin = *pinp;
1989
Kenji Kaneshige1eb39482009-05-26 16:08:36 +09001990 while (!pci_is_root_bus(dev->bus)) {
Bjorn Helgaas68feac82008-12-16 21:36:55 -07001991 pin = pci_swizzle_interrupt_pin(dev, pin);
1992 dev = dev->bus->self;
1993 }
1994 *pinp = pin;
1995 return PCI_SLOT(dev->devfn);
1996}
1997
1998/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07001999 * pci_release_region - Release a PCI bar
2000 * @pdev: PCI device whose resources were previously reserved by pci_request_region
2001 * @bar: BAR to release
2002 *
2003 * Releases the PCI I/O and memory resources previously reserved by a
2004 * successful call to pci_request_region. Call this function only
2005 * after all use of the PCI regions has ceased.
2006 */
2007void pci_release_region(struct pci_dev *pdev, int bar)
2008{
Tejun Heo9ac78492007-01-20 16:00:26 +09002009 struct pci_devres *dr;
2010
Linus Torvalds1da177e2005-04-16 15:20:36 -07002011 if (pci_resource_len(pdev, bar) == 0)
2012 return;
2013 if (pci_resource_flags(pdev, bar) & IORESOURCE_IO)
2014 release_region(pci_resource_start(pdev, bar),
2015 pci_resource_len(pdev, bar));
2016 else if (pci_resource_flags(pdev, bar) & IORESOURCE_MEM)
2017 release_mem_region(pci_resource_start(pdev, bar),
2018 pci_resource_len(pdev, bar));
Tejun Heo9ac78492007-01-20 16:00:26 +09002019
2020 dr = find_pci_dr(pdev);
2021 if (dr)
2022 dr->region_mask &= ~(1 << bar);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002023}
2024
2025/**
Randy Dunlapf5ddcac2009-01-09 17:03:20 -08002026 * __pci_request_region - Reserved PCI I/O and memory resource
Linus Torvalds1da177e2005-04-16 15:20:36 -07002027 * @pdev: PCI device whose resources are to be reserved
2028 * @bar: BAR to be reserved
2029 * @res_name: Name to be associated with resource.
Randy Dunlapf5ddcac2009-01-09 17:03:20 -08002030 * @exclusive: whether the region access is exclusive or not
Linus Torvalds1da177e2005-04-16 15:20:36 -07002031 *
2032 * Mark the PCI region associated with PCI device @pdev BR @bar as
2033 * being reserved by owner @res_name. Do not access any
2034 * address inside the PCI regions unless this call returns
2035 * successfully.
2036 *
Randy Dunlapf5ddcac2009-01-09 17:03:20 -08002037 * If @exclusive is set, then the region is marked so that userspace
2038 * is explicitly not allowed to map the resource via /dev/mem or
2039 * sysfs MMIO access.
2040 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07002041 * Returns 0 on success, or %EBUSY on error. A warning
2042 * message is also printed on failure.
2043 */
Arjan van de Vene8de1482008-10-22 19:55:31 -07002044static int __pci_request_region(struct pci_dev *pdev, int bar, const char *res_name,
2045 int exclusive)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002046{
Tejun Heo9ac78492007-01-20 16:00:26 +09002047 struct pci_devres *dr;
2048
Linus Torvalds1da177e2005-04-16 15:20:36 -07002049 if (pci_resource_len(pdev, bar) == 0)
2050 return 0;
2051
2052 if (pci_resource_flags(pdev, bar) & IORESOURCE_IO) {
2053 if (!request_region(pci_resource_start(pdev, bar),
2054 pci_resource_len(pdev, bar), res_name))
2055 goto err_out;
2056 }
2057 else if (pci_resource_flags(pdev, bar) & IORESOURCE_MEM) {
Arjan van de Vene8de1482008-10-22 19:55:31 -07002058 if (!__request_mem_region(pci_resource_start(pdev, bar),
2059 pci_resource_len(pdev, bar), res_name,
2060 exclusive))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002061 goto err_out;
2062 }
Tejun Heo9ac78492007-01-20 16:00:26 +09002063
2064 dr = find_pci_dr(pdev);
2065 if (dr)
2066 dr->region_mask |= 1 << bar;
2067
Linus Torvalds1da177e2005-04-16 15:20:36 -07002068 return 0;
2069
2070err_out:
Bjorn Helgaasc7dabef2009-10-27 13:26:47 -06002071 dev_warn(&pdev->dev, "BAR %d: can't reserve %pR\n", bar,
Benjamin Herrenschmidt096e6f62008-10-20 15:07:37 +11002072 &pdev->resource[bar]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002073 return -EBUSY;
2074}
2075
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09002076/**
Randy Dunlapf5ddcac2009-01-09 17:03:20 -08002077 * pci_request_region - Reserve PCI I/O and memory resource
Arjan van de Vene8de1482008-10-22 19:55:31 -07002078 * @pdev: PCI device whose resources are to be reserved
2079 * @bar: BAR to be reserved
Randy Dunlapf5ddcac2009-01-09 17:03:20 -08002080 * @res_name: Name to be associated with resource
Arjan van de Vene8de1482008-10-22 19:55:31 -07002081 *
Randy Dunlapf5ddcac2009-01-09 17:03:20 -08002082 * Mark the PCI region associated with PCI device @pdev BAR @bar as
Arjan van de Vene8de1482008-10-22 19:55:31 -07002083 * being reserved by owner @res_name. Do not access any
2084 * address inside the PCI regions unless this call returns
2085 * successfully.
2086 *
2087 * Returns 0 on success, or %EBUSY on error. A warning
2088 * message is also printed on failure.
2089 */
2090int pci_request_region(struct pci_dev *pdev, int bar, const char *res_name)
2091{
2092 return __pci_request_region(pdev, bar, res_name, 0);
2093}
2094
2095/**
2096 * pci_request_region_exclusive - Reserved PCI I/O and memory resource
2097 * @pdev: PCI device whose resources are to be reserved
2098 * @bar: BAR to be reserved
2099 * @res_name: Name to be associated with resource.
2100 *
2101 * Mark the PCI region associated with PCI device @pdev BR @bar as
2102 * being reserved by owner @res_name. Do not access any
2103 * address inside the PCI regions unless this call returns
2104 * successfully.
2105 *
2106 * Returns 0 on success, or %EBUSY on error. A warning
2107 * message is also printed on failure.
2108 *
2109 * The key difference that _exclusive makes it that userspace is
2110 * explicitly not allowed to map the resource via /dev/mem or
2111 * sysfs.
2112 */
2113int pci_request_region_exclusive(struct pci_dev *pdev, int bar, const char *res_name)
2114{
2115 return __pci_request_region(pdev, bar, res_name, IORESOURCE_EXCLUSIVE);
2116}
2117/**
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09002118 * pci_release_selected_regions - Release selected PCI I/O and memory resources
2119 * @pdev: PCI device whose resources were previously reserved
2120 * @bars: Bitmask of BARs to be released
2121 *
2122 * Release selected PCI I/O and memory resources previously reserved.
2123 * Call this function only after all use of the PCI regions has ceased.
2124 */
2125void pci_release_selected_regions(struct pci_dev *pdev, int bars)
2126{
2127 int i;
2128
2129 for (i = 0; i < 6; i++)
2130 if (bars & (1 << i))
2131 pci_release_region(pdev, i);
2132}
2133
Arjan van de Vene8de1482008-10-22 19:55:31 -07002134int __pci_request_selected_regions(struct pci_dev *pdev, int bars,
2135 const char *res_name, int excl)
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09002136{
2137 int i;
2138
2139 for (i = 0; i < 6; i++)
2140 if (bars & (1 << i))
Arjan van de Vene8de1482008-10-22 19:55:31 -07002141 if (__pci_request_region(pdev, i, res_name, excl))
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09002142 goto err_out;
2143 return 0;
2144
2145err_out:
2146 while(--i >= 0)
2147 if (bars & (1 << i))
2148 pci_release_region(pdev, i);
2149
2150 return -EBUSY;
2151}
Linus Torvalds1da177e2005-04-16 15:20:36 -07002152
Arjan van de Vene8de1482008-10-22 19:55:31 -07002153
2154/**
2155 * pci_request_selected_regions - Reserve selected PCI I/O and memory resources
2156 * @pdev: PCI device whose resources are to be reserved
2157 * @bars: Bitmask of BARs to be requested
2158 * @res_name: Name to be associated with resource
2159 */
2160int pci_request_selected_regions(struct pci_dev *pdev, int bars,
2161 const char *res_name)
2162{
2163 return __pci_request_selected_regions(pdev, bars, res_name, 0);
2164}
2165
2166int pci_request_selected_regions_exclusive(struct pci_dev *pdev,
2167 int bars, const char *res_name)
2168{
2169 return __pci_request_selected_regions(pdev, bars, res_name,
2170 IORESOURCE_EXCLUSIVE);
2171}
2172
Linus Torvalds1da177e2005-04-16 15:20:36 -07002173/**
2174 * pci_release_regions - Release reserved PCI I/O and memory resources
2175 * @pdev: PCI device whose resources were previously reserved by pci_request_regions
2176 *
2177 * Releases all PCI I/O and memory resources previously reserved by a
2178 * successful call to pci_request_regions. Call this function only
2179 * after all use of the PCI regions has ceased.
2180 */
2181
2182void pci_release_regions(struct pci_dev *pdev)
2183{
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09002184 pci_release_selected_regions(pdev, (1 << 6) - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002185}
2186
2187/**
2188 * pci_request_regions - Reserved PCI I/O and memory resources
2189 * @pdev: PCI device whose resources are to be reserved
2190 * @res_name: Name to be associated with resource.
2191 *
2192 * Mark all PCI regions associated with PCI device @pdev as
2193 * being reserved by owner @res_name. Do not access any
2194 * address inside the PCI regions unless this call returns
2195 * successfully.
2196 *
2197 * Returns 0 on success, or %EBUSY on error. A warning
2198 * message is also printed on failure.
2199 */
Jeff Garzik3c990e92006-03-04 21:52:42 -05002200int pci_request_regions(struct pci_dev *pdev, const char *res_name)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002201{
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09002202 return pci_request_selected_regions(pdev, ((1 << 6) - 1), res_name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002203}
2204
2205/**
Arjan van de Vene8de1482008-10-22 19:55:31 -07002206 * pci_request_regions_exclusive - Reserved PCI I/O and memory resources
2207 * @pdev: PCI device whose resources are to be reserved
2208 * @res_name: Name to be associated with resource.
2209 *
2210 * Mark all PCI regions associated with PCI device @pdev as
2211 * being reserved by owner @res_name. Do not access any
2212 * address inside the PCI regions unless this call returns
2213 * successfully.
2214 *
2215 * pci_request_regions_exclusive() will mark the region so that
2216 * /dev/mem and the sysfs MMIO access will not be allowed.
2217 *
2218 * Returns 0 on success, or %EBUSY on error. A warning
2219 * message is also printed on failure.
2220 */
2221int pci_request_regions_exclusive(struct pci_dev *pdev, const char *res_name)
2222{
2223 return pci_request_selected_regions_exclusive(pdev,
2224 ((1 << 6) - 1), res_name);
2225}
2226
Ben Hutchings6a479072008-12-23 03:08:29 +00002227static void __pci_set_master(struct pci_dev *dev, bool enable)
2228{
2229 u16 old_cmd, cmd;
2230
2231 pci_read_config_word(dev, PCI_COMMAND, &old_cmd);
2232 if (enable)
2233 cmd = old_cmd | PCI_COMMAND_MASTER;
2234 else
2235 cmd = old_cmd & ~PCI_COMMAND_MASTER;
2236 if (cmd != old_cmd) {
2237 dev_dbg(&dev->dev, "%s bus mastering\n",
2238 enable ? "enabling" : "disabling");
2239 pci_write_config_word(dev, PCI_COMMAND, cmd);
2240 }
2241 dev->is_busmaster = enable;
2242}
Arjan van de Vene8de1482008-10-22 19:55:31 -07002243
2244/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07002245 * pci_set_master - enables bus-mastering for device dev
2246 * @dev: the PCI device to enable
2247 *
2248 * Enables bus-mastering on the device and calls pcibios_set_master()
2249 * to do the needed arch specific settings.
2250 */
Ben Hutchings6a479072008-12-23 03:08:29 +00002251void pci_set_master(struct pci_dev *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002252{
Ben Hutchings6a479072008-12-23 03:08:29 +00002253 __pci_set_master(dev, true);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002254 pcibios_set_master(dev);
2255}
2256
Ben Hutchings6a479072008-12-23 03:08:29 +00002257/**
2258 * pci_clear_master - disables bus-mastering for device dev
2259 * @dev: the PCI device to disable
2260 */
2261void pci_clear_master(struct pci_dev *dev)
2262{
2263 __pci_set_master(dev, false);
2264}
2265
Linus Torvalds1da177e2005-04-16 15:20:36 -07002266/**
Matthew Wilcoxedb2d972006-10-10 08:01:21 -06002267 * pci_set_cacheline_size - ensure the CACHE_LINE_SIZE register is programmed
2268 * @dev: the PCI device for which MWI is to be enabled
Linus Torvalds1da177e2005-04-16 15:20:36 -07002269 *
Matthew Wilcoxedb2d972006-10-10 08:01:21 -06002270 * Helper function for pci_set_mwi.
2271 * Originally copied from drivers/net/acenic.c.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002272 * Copyright 1998-2001 by Jes Sorensen, <jes@trained-monkey.org>.
2273 *
2274 * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
2275 */
Tejun Heo15ea76d2009-09-22 17:34:48 +09002276int pci_set_cacheline_size(struct pci_dev *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002277{
2278 u8 cacheline_size;
2279
2280 if (!pci_cache_line_size)
Tejun Heo15ea76d2009-09-22 17:34:48 +09002281 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002282
2283 /* Validate current setting: the PCI_CACHE_LINE_SIZE must be
2284 equal to or multiple of the right value. */
2285 pci_read_config_byte(dev, PCI_CACHE_LINE_SIZE, &cacheline_size);
2286 if (cacheline_size >= pci_cache_line_size &&
2287 (cacheline_size % pci_cache_line_size) == 0)
2288 return 0;
2289
2290 /* Write the correct value. */
2291 pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, pci_cache_line_size);
2292 /* Read it back. */
2293 pci_read_config_byte(dev, PCI_CACHE_LINE_SIZE, &cacheline_size);
2294 if (cacheline_size == pci_cache_line_size)
2295 return 0;
2296
Bjorn Helgaas80ccba12008-06-13 10:52:11 -06002297 dev_printk(KERN_DEBUG, &dev->dev, "cache line size of %d is not "
2298 "supported\n", pci_cache_line_size << 2);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002299
2300 return -EINVAL;
2301}
Tejun Heo15ea76d2009-09-22 17:34:48 +09002302EXPORT_SYMBOL_GPL(pci_set_cacheline_size);
2303
2304#ifdef PCI_DISABLE_MWI
2305int pci_set_mwi(struct pci_dev *dev)
2306{
2307 return 0;
2308}
2309
2310int pci_try_set_mwi(struct pci_dev *dev)
2311{
2312 return 0;
2313}
2314
2315void pci_clear_mwi(struct pci_dev *dev)
2316{
2317}
2318
2319#else
Linus Torvalds1da177e2005-04-16 15:20:36 -07002320
2321/**
2322 * pci_set_mwi - enables memory-write-invalidate PCI transaction
2323 * @dev: the PCI device for which MWI is enabled
2324 *
Randy Dunlap694625c2007-07-09 11:55:54 -07002325 * Enables the Memory-Write-Invalidate transaction in %PCI_COMMAND.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002326 *
2327 * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
2328 */
2329int
2330pci_set_mwi(struct pci_dev *dev)
2331{
2332 int rc;
2333 u16 cmd;
2334
Matthew Wilcoxedb2d972006-10-10 08:01:21 -06002335 rc = pci_set_cacheline_size(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002336 if (rc)
2337 return rc;
2338
2339 pci_read_config_word(dev, PCI_COMMAND, &cmd);
2340 if (! (cmd & PCI_COMMAND_INVALIDATE)) {
Bjorn Helgaas80ccba12008-06-13 10:52:11 -06002341 dev_dbg(&dev->dev, "enabling Mem-Wr-Inval\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002342 cmd |= PCI_COMMAND_INVALIDATE;
2343 pci_write_config_word(dev, PCI_COMMAND, cmd);
2344 }
2345
2346 return 0;
2347}
2348
2349/**
Randy Dunlap694625c2007-07-09 11:55:54 -07002350 * pci_try_set_mwi - enables memory-write-invalidate PCI transaction
2351 * @dev: the PCI device for which MWI is enabled
2352 *
2353 * Enables the Memory-Write-Invalidate transaction in %PCI_COMMAND.
2354 * Callers are not required to check the return value.
2355 *
2356 * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
2357 */
2358int pci_try_set_mwi(struct pci_dev *dev)
2359{
2360 int rc = pci_set_mwi(dev);
2361 return rc;
2362}
2363
2364/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07002365 * pci_clear_mwi - disables Memory-Write-Invalidate for device dev
2366 * @dev: the PCI device to disable
2367 *
2368 * Disables PCI Memory-Write-Invalidate transaction on the device
2369 */
2370void
2371pci_clear_mwi(struct pci_dev *dev)
2372{
2373 u16 cmd;
2374
2375 pci_read_config_word(dev, PCI_COMMAND, &cmd);
2376 if (cmd & PCI_COMMAND_INVALIDATE) {
2377 cmd &= ~PCI_COMMAND_INVALIDATE;
2378 pci_write_config_word(dev, PCI_COMMAND, cmd);
2379 }
2380}
Matthew Wilcoxedb2d972006-10-10 08:01:21 -06002381#endif /* ! PCI_DISABLE_MWI */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002382
Brett M Russa04ce0f2005-08-15 15:23:41 -04002383/**
2384 * pci_intx - enables/disables PCI INTx for device dev
Randy Dunlap8f7020d2005-10-23 11:57:38 -07002385 * @pdev: the PCI device to operate on
2386 * @enable: boolean: whether to enable or disable PCI INTx
Brett M Russa04ce0f2005-08-15 15:23:41 -04002387 *
2388 * Enables/disables PCI INTx for device dev
2389 */
2390void
2391pci_intx(struct pci_dev *pdev, int enable)
2392{
2393 u16 pci_command, new;
2394
2395 pci_read_config_word(pdev, PCI_COMMAND, &pci_command);
2396
2397 if (enable) {
2398 new = pci_command & ~PCI_COMMAND_INTX_DISABLE;
2399 } else {
2400 new = pci_command | PCI_COMMAND_INTX_DISABLE;
2401 }
2402
2403 if (new != pci_command) {
Tejun Heo9ac78492007-01-20 16:00:26 +09002404 struct pci_devres *dr;
2405
Brett M Russ2fd9d742005-09-09 10:02:22 -07002406 pci_write_config_word(pdev, PCI_COMMAND, new);
Tejun Heo9ac78492007-01-20 16:00:26 +09002407
2408 dr = find_pci_dr(pdev);
2409 if (dr && !dr->restore_intx) {
2410 dr->restore_intx = 1;
2411 dr->orig_intx = !enable;
2412 }
Brett M Russa04ce0f2005-08-15 15:23:41 -04002413 }
2414}
2415
Eric W. Biedermanf5f2b132007-03-05 00:30:07 -08002416/**
2417 * pci_msi_off - disables any msi or msix capabilities
Randy Dunlap8d7d86e2007-03-16 19:55:52 -07002418 * @dev: the PCI device to operate on
Eric W. Biedermanf5f2b132007-03-05 00:30:07 -08002419 *
2420 * If you want to use msi see pci_enable_msi and friends.
2421 * This is a lower level primitive that allows us to disable
2422 * msi operation at the device level.
2423 */
2424void pci_msi_off(struct pci_dev *dev)
2425{
2426 int pos;
2427 u16 control;
2428
2429 pos = pci_find_capability(dev, PCI_CAP_ID_MSI);
2430 if (pos) {
2431 pci_read_config_word(dev, pos + PCI_MSI_FLAGS, &control);
2432 control &= ~PCI_MSI_FLAGS_ENABLE;
2433 pci_write_config_word(dev, pos + PCI_MSI_FLAGS, control);
2434 }
2435 pos = pci_find_capability(dev, PCI_CAP_ID_MSIX);
2436 if (pos) {
2437 pci_read_config_word(dev, pos + PCI_MSIX_FLAGS, &control);
2438 control &= ~PCI_MSIX_FLAGS_ENABLE;
2439 pci_write_config_word(dev, pos + PCI_MSIX_FLAGS, control);
2440 }
2441}
Michael S. Tsirkinb03214d2010-06-23 22:49:06 -06002442EXPORT_SYMBOL_GPL(pci_msi_off);
Eric W. Biedermanf5f2b132007-03-05 00:30:07 -08002443
FUJITA Tomonori4d57cdf2008-02-04 22:27:55 -08002444int pci_set_dma_max_seg_size(struct pci_dev *dev, unsigned int size)
2445{
2446 return dma_set_max_seg_size(&dev->dev, size);
2447}
2448EXPORT_SYMBOL(pci_set_dma_max_seg_size);
FUJITA Tomonori4d57cdf2008-02-04 22:27:55 -08002449
FUJITA Tomonori59fc67d2008-02-04 22:28:14 -08002450int pci_set_dma_seg_boundary(struct pci_dev *dev, unsigned long mask)
2451{
2452 return dma_set_seg_boundary(&dev->dev, mask);
2453}
2454EXPORT_SYMBOL(pci_set_dma_seg_boundary);
FUJITA Tomonori59fc67d2008-02-04 22:28:14 -08002455
Yu Zhao8c1c6992009-06-13 15:52:13 +08002456static int pcie_flr(struct pci_dev *dev, int probe)
Sheng Yang8dd7f802008-10-21 17:38:25 +08002457{
Yu Zhao8c1c6992009-06-13 15:52:13 +08002458 int i;
2459 int pos;
Sheng Yang8dd7f802008-10-21 17:38:25 +08002460 u32 cap;
Shmulik Ravid04b55c42009-12-03 22:27:51 +02002461 u16 status, control;
Sheng Yang8dd7f802008-10-21 17:38:25 +08002462
Kenji Kaneshige06a1cba2009-11-11 14:30:56 +09002463 pos = pci_pcie_cap(dev);
Yu Zhao8c1c6992009-06-13 15:52:13 +08002464 if (!pos)
Sheng Yang8dd7f802008-10-21 17:38:25 +08002465 return -ENOTTY;
Yu Zhao8c1c6992009-06-13 15:52:13 +08002466
2467 pci_read_config_dword(dev, pos + PCI_EXP_DEVCAP, &cap);
Sheng Yang8dd7f802008-10-21 17:38:25 +08002468 if (!(cap & PCI_EXP_DEVCAP_FLR))
2469 return -ENOTTY;
2470
Sheng Yangd91cdc72008-11-11 17:17:47 +08002471 if (probe)
2472 return 0;
2473
Sheng Yang8dd7f802008-10-21 17:38:25 +08002474 /* Wait for Transaction Pending bit clean */
Yu Zhao8c1c6992009-06-13 15:52:13 +08002475 for (i = 0; i < 4; i++) {
2476 if (i)
2477 msleep((1 << (i - 1)) * 100);
Sheng Yang5fe5db02009-02-09 14:53:47 +08002478
Yu Zhao8c1c6992009-06-13 15:52:13 +08002479 pci_read_config_word(dev, pos + PCI_EXP_DEVSTA, &status);
2480 if (!(status & PCI_EXP_DEVSTA_TRPND))
2481 goto clear;
2482 }
Sheng Yang8dd7f802008-10-21 17:38:25 +08002483
Yu Zhao8c1c6992009-06-13 15:52:13 +08002484 dev_err(&dev->dev, "transaction is not cleared; "
2485 "proceeding with reset anyway\n");
Sheng Yang5fe5db02009-02-09 14:53:47 +08002486
Yu Zhao8c1c6992009-06-13 15:52:13 +08002487clear:
Shmulik Ravid04b55c42009-12-03 22:27:51 +02002488 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL, &control);
2489 control |= PCI_EXP_DEVCTL_BCR_FLR;
2490 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL, control);
2491
Yu Zhao8c1c6992009-06-13 15:52:13 +08002492 msleep(100);
Sheng Yang8dd7f802008-10-21 17:38:25 +08002493
Sheng Yang8dd7f802008-10-21 17:38:25 +08002494 return 0;
2495}
Sheng Yangd91cdc72008-11-11 17:17:47 +08002496
Yu Zhao8c1c6992009-06-13 15:52:13 +08002497static int pci_af_flr(struct pci_dev *dev, int probe)
Sheng Yang1ca88792008-11-11 17:17:48 +08002498{
Yu Zhao8c1c6992009-06-13 15:52:13 +08002499 int i;
2500 int pos;
Sheng Yang1ca88792008-11-11 17:17:48 +08002501 u8 cap;
Yu Zhao8c1c6992009-06-13 15:52:13 +08002502 u8 status;
Sheng Yang1ca88792008-11-11 17:17:48 +08002503
Yu Zhao8c1c6992009-06-13 15:52:13 +08002504 pos = pci_find_capability(dev, PCI_CAP_ID_AF);
2505 if (!pos)
Sheng Yang1ca88792008-11-11 17:17:48 +08002506 return -ENOTTY;
Yu Zhao8c1c6992009-06-13 15:52:13 +08002507
2508 pci_read_config_byte(dev, pos + PCI_AF_CAP, &cap);
Sheng Yang1ca88792008-11-11 17:17:48 +08002509 if (!(cap & PCI_AF_CAP_TP) || !(cap & PCI_AF_CAP_FLR))
2510 return -ENOTTY;
2511
2512 if (probe)
2513 return 0;
2514
Sheng Yang1ca88792008-11-11 17:17:48 +08002515 /* Wait for Transaction Pending bit clean */
Yu Zhao8c1c6992009-06-13 15:52:13 +08002516 for (i = 0; i < 4; i++) {
2517 if (i)
2518 msleep((1 << (i - 1)) * 100);
Sheng Yang5fe5db02009-02-09 14:53:47 +08002519
Yu Zhao8c1c6992009-06-13 15:52:13 +08002520 pci_read_config_byte(dev, pos + PCI_AF_STATUS, &status);
2521 if (!(status & PCI_AF_STATUS_TP))
2522 goto clear;
2523 }
2524
2525 dev_err(&dev->dev, "transaction is not cleared; "
2526 "proceeding with reset anyway\n");
2527
2528clear:
2529 pci_write_config_byte(dev, pos + PCI_AF_CTRL, PCI_AF_CTRL_FLR);
Sheng Yang1ca88792008-11-11 17:17:48 +08002530 msleep(100);
Sheng Yang5fe5db02009-02-09 14:53:47 +08002531
Sheng Yang1ca88792008-11-11 17:17:48 +08002532 return 0;
2533}
2534
Rafael J. Wysocki83d74e02011-03-05 21:48:44 +01002535/**
2536 * pci_pm_reset - Put device into PCI_D3 and back into PCI_D0.
2537 * @dev: Device to reset.
2538 * @probe: If set, only check if the device can be reset this way.
2539 *
2540 * If @dev supports native PCI PM and its PCI_PM_CTRL_NO_SOFT_RESET flag is
2541 * unset, it will be reinitialized internally when going from PCI_D3hot to
2542 * PCI_D0. If that's the case and the device is not in a low-power state
2543 * already, force it into PCI_D3hot and back to PCI_D0, causing it to be reset.
2544 *
2545 * NOTE: This causes the caller to sleep for twice the device power transition
2546 * cooldown period, which for the D0->D3hot and D3hot->D0 transitions is 10 ms
2547 * by devault (i.e. unless the @dev's d3_delay field has a different value).
2548 * Moreover, only devices in D0 can be reset by this function.
2549 */
Yu Zhaof85876b2009-06-13 15:52:14 +08002550static int pci_pm_reset(struct pci_dev *dev, int probe)
Sheng Yangd91cdc72008-11-11 17:17:47 +08002551{
Yu Zhaof85876b2009-06-13 15:52:14 +08002552 u16 csr;
Sheng Yangd91cdc72008-11-11 17:17:47 +08002553
Yu Zhaof85876b2009-06-13 15:52:14 +08002554 if (!dev->pm_cap)
2555 return -ENOTTY;
Sheng Yangd91cdc72008-11-11 17:17:47 +08002556
Yu Zhaof85876b2009-06-13 15:52:14 +08002557 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &csr);
2558 if (csr & PCI_PM_CTRL_NO_SOFT_RESET)
2559 return -ENOTTY;
Sheng Yang1ca88792008-11-11 17:17:48 +08002560
Yu Zhaof85876b2009-06-13 15:52:14 +08002561 if (probe)
2562 return 0;
2563
2564 if (dev->current_state != PCI_D0)
2565 return -EINVAL;
2566
2567 csr &= ~PCI_PM_CTRL_STATE_MASK;
2568 csr |= PCI_D3hot;
2569 pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, csr);
Rafael J. Wysocki1ae861e2009-12-31 12:15:54 +01002570 pci_dev_d3_sleep(dev);
Yu Zhaof85876b2009-06-13 15:52:14 +08002571
2572 csr &= ~PCI_PM_CTRL_STATE_MASK;
2573 csr |= PCI_D0;
2574 pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, csr);
Rafael J. Wysocki1ae861e2009-12-31 12:15:54 +01002575 pci_dev_d3_sleep(dev);
Yu Zhaof85876b2009-06-13 15:52:14 +08002576
2577 return 0;
2578}
2579
Yu Zhaoc12ff1d2009-06-13 15:52:15 +08002580static int pci_parent_bus_reset(struct pci_dev *dev, int probe)
2581{
2582 u16 ctrl;
2583 struct pci_dev *pdev;
2584
Yu Zhao654b75e2009-06-26 14:04:46 +08002585 if (pci_is_root_bus(dev->bus) || dev->subordinate || !dev->bus->self)
Yu Zhaoc12ff1d2009-06-13 15:52:15 +08002586 return -ENOTTY;
2587
2588 list_for_each_entry(pdev, &dev->bus->devices, bus_list)
2589 if (pdev != dev)
2590 return -ENOTTY;
2591
2592 if (probe)
2593 return 0;
2594
2595 pci_read_config_word(dev->bus->self, PCI_BRIDGE_CONTROL, &ctrl);
2596 ctrl |= PCI_BRIDGE_CTL_BUS_RESET;
2597 pci_write_config_word(dev->bus->self, PCI_BRIDGE_CONTROL, ctrl);
2598 msleep(100);
2599
2600 ctrl &= ~PCI_BRIDGE_CTL_BUS_RESET;
2601 pci_write_config_word(dev->bus->self, PCI_BRIDGE_CONTROL, ctrl);
2602 msleep(100);
2603
2604 return 0;
2605}
2606
Yu Zhao8c1c6992009-06-13 15:52:13 +08002607static int pci_dev_reset(struct pci_dev *dev, int probe)
Sheng Yang8dd7f802008-10-21 17:38:25 +08002608{
Yu Zhao8c1c6992009-06-13 15:52:13 +08002609 int rc;
Sheng Yang8dd7f802008-10-21 17:38:25 +08002610
Yu Zhao8c1c6992009-06-13 15:52:13 +08002611 might_sleep();
Sheng Yang8dd7f802008-10-21 17:38:25 +08002612
Yu Zhao8c1c6992009-06-13 15:52:13 +08002613 if (!probe) {
2614 pci_block_user_cfg_access(dev);
2615 /* block PM suspend, driver probe, etc. */
Greg Kroah-Hartman8e9394c2010-02-17 10:57:05 -08002616 device_lock(&dev->dev);
Yu Zhao8c1c6992009-06-13 15:52:13 +08002617 }
Sheng Yang8dd7f802008-10-21 17:38:25 +08002618
Dexuan Cuib9c3b262009-12-07 13:03:21 +08002619 rc = pci_dev_specific_reset(dev, probe);
2620 if (rc != -ENOTTY)
2621 goto done;
2622
Yu Zhao8c1c6992009-06-13 15:52:13 +08002623 rc = pcie_flr(dev, probe);
2624 if (rc != -ENOTTY)
2625 goto done;
2626
2627 rc = pci_af_flr(dev, probe);
Yu Zhaof85876b2009-06-13 15:52:14 +08002628 if (rc != -ENOTTY)
2629 goto done;
2630
2631 rc = pci_pm_reset(dev, probe);
Yu Zhaoc12ff1d2009-06-13 15:52:15 +08002632 if (rc != -ENOTTY)
2633 goto done;
2634
2635 rc = pci_parent_bus_reset(dev, probe);
Yu Zhao8c1c6992009-06-13 15:52:13 +08002636done:
2637 if (!probe) {
Greg Kroah-Hartman8e9394c2010-02-17 10:57:05 -08002638 device_unlock(&dev->dev);
Yu Zhao8c1c6992009-06-13 15:52:13 +08002639 pci_unblock_user_cfg_access(dev);
2640 }
2641
2642 return rc;
Sheng Yang8dd7f802008-10-21 17:38:25 +08002643}
2644
2645/**
Yu Zhao8c1c6992009-06-13 15:52:13 +08002646 * __pci_reset_function - reset a PCI device function
2647 * @dev: PCI device to reset
Sheng Yang8dd7f802008-10-21 17:38:25 +08002648 *
2649 * Some devices allow an individual function to be reset without affecting
2650 * other functions in the same device. The PCI device must be responsive
2651 * to PCI config space in order to use this function.
2652 *
2653 * The device function is presumed to be unused when this function is called.
2654 * Resetting the device will make the contents of PCI configuration space
2655 * random, so any caller of this must be prepared to reinitialise the
2656 * device including MSI, bus mastering, BARs, decoding IO and memory spaces,
2657 * etc.
2658 *
Yu Zhao8c1c6992009-06-13 15:52:13 +08002659 * Returns 0 if the device function was successfully reset or negative if the
Sheng Yang8dd7f802008-10-21 17:38:25 +08002660 * device doesn't support resetting a single function.
2661 */
Yu Zhao8c1c6992009-06-13 15:52:13 +08002662int __pci_reset_function(struct pci_dev *dev)
Sheng Yang8dd7f802008-10-21 17:38:25 +08002663{
Yu Zhao8c1c6992009-06-13 15:52:13 +08002664 return pci_dev_reset(dev, 0);
Sheng Yang8dd7f802008-10-21 17:38:25 +08002665}
Yu Zhao8c1c6992009-06-13 15:52:13 +08002666EXPORT_SYMBOL_GPL(__pci_reset_function);
Sheng Yang8dd7f802008-10-21 17:38:25 +08002667
2668/**
Michael S. Tsirkin711d5772009-07-27 23:37:48 +03002669 * pci_probe_reset_function - check whether the device can be safely reset
2670 * @dev: PCI device to reset
2671 *
2672 * Some devices allow an individual function to be reset without affecting
2673 * other functions in the same device. The PCI device must be responsive
2674 * to PCI config space in order to use this function.
2675 *
2676 * Returns 0 if the device function can be reset or negative if the
2677 * device doesn't support resetting a single function.
2678 */
2679int pci_probe_reset_function(struct pci_dev *dev)
2680{
2681 return pci_dev_reset(dev, 1);
2682}
2683
2684/**
Yu Zhao8c1c6992009-06-13 15:52:13 +08002685 * pci_reset_function - quiesce and reset a PCI device function
2686 * @dev: PCI device to reset
Sheng Yang8dd7f802008-10-21 17:38:25 +08002687 *
2688 * Some devices allow an individual function to be reset without affecting
2689 * other functions in the same device. The PCI device must be responsive
2690 * to PCI config space in order to use this function.
2691 *
2692 * This function does not just reset the PCI portion of a device, but
2693 * clears all the state associated with the device. This function differs
Yu Zhao8c1c6992009-06-13 15:52:13 +08002694 * from __pci_reset_function in that it saves and restores device state
Sheng Yang8dd7f802008-10-21 17:38:25 +08002695 * over the reset.
2696 *
Yu Zhao8c1c6992009-06-13 15:52:13 +08002697 * Returns 0 if the device function was successfully reset or negative if the
Sheng Yang8dd7f802008-10-21 17:38:25 +08002698 * device doesn't support resetting a single function.
2699 */
2700int pci_reset_function(struct pci_dev *dev)
2701{
Yu Zhao8c1c6992009-06-13 15:52:13 +08002702 int rc;
Sheng Yang8dd7f802008-10-21 17:38:25 +08002703
Yu Zhao8c1c6992009-06-13 15:52:13 +08002704 rc = pci_dev_reset(dev, 1);
2705 if (rc)
2706 return rc;
Sheng Yang8dd7f802008-10-21 17:38:25 +08002707
Sheng Yang8dd7f802008-10-21 17:38:25 +08002708 pci_save_state(dev);
2709
Yu Zhao8c1c6992009-06-13 15:52:13 +08002710 /*
2711 * both INTx and MSI are disabled after the Interrupt Disable bit
2712 * is set and the Bus Master bit is cleared.
2713 */
Sheng Yang8dd7f802008-10-21 17:38:25 +08002714 pci_write_config_word(dev, PCI_COMMAND, PCI_COMMAND_INTX_DISABLE);
2715
Yu Zhao8c1c6992009-06-13 15:52:13 +08002716 rc = pci_dev_reset(dev, 0);
Sheng Yang8dd7f802008-10-21 17:38:25 +08002717
2718 pci_restore_state(dev);
Sheng Yang8dd7f802008-10-21 17:38:25 +08002719
Yu Zhao8c1c6992009-06-13 15:52:13 +08002720 return rc;
Sheng Yang8dd7f802008-10-21 17:38:25 +08002721}
2722EXPORT_SYMBOL_GPL(pci_reset_function);
2723
2724/**
Peter Orubad556ad42007-05-15 13:59:13 +02002725 * pcix_get_max_mmrbc - get PCI-X maximum designed memory read byte count
2726 * @dev: PCI device to query
2727 *
2728 * Returns mmrbc: maximum designed memory read count in bytes
2729 * or appropriate error value.
2730 */
2731int pcix_get_max_mmrbc(struct pci_dev *dev)
2732{
Dean Nelson7c9e2b12010-03-09 22:26:55 -05002733 int cap;
Peter Orubad556ad42007-05-15 13:59:13 +02002734 u32 stat;
2735
2736 cap = pci_find_capability(dev, PCI_CAP_ID_PCIX);
2737 if (!cap)
2738 return -EINVAL;
2739
Dean Nelson7c9e2b12010-03-09 22:26:55 -05002740 if (pci_read_config_dword(dev, cap + PCI_X_STATUS, &stat))
Peter Orubad556ad42007-05-15 13:59:13 +02002741 return -EINVAL;
2742
Dean Nelson25daeb52010-03-09 22:26:40 -05002743 return 512 << ((stat & PCI_X_STATUS_MAX_READ) >> 21);
Peter Orubad556ad42007-05-15 13:59:13 +02002744}
2745EXPORT_SYMBOL(pcix_get_max_mmrbc);
2746
2747/**
2748 * pcix_get_mmrbc - get PCI-X maximum memory read byte count
2749 * @dev: PCI device to query
2750 *
2751 * Returns mmrbc: maximum memory read count in bytes
2752 * or appropriate error value.
2753 */
2754int pcix_get_mmrbc(struct pci_dev *dev)
2755{
Dean Nelson7c9e2b12010-03-09 22:26:55 -05002756 int cap;
Dean Nelsonbdc2bda2010-03-09 22:26:48 -05002757 u16 cmd;
Peter Orubad556ad42007-05-15 13:59:13 +02002758
2759 cap = pci_find_capability(dev, PCI_CAP_ID_PCIX);
2760 if (!cap)
2761 return -EINVAL;
2762
Dean Nelson7c9e2b12010-03-09 22:26:55 -05002763 if (pci_read_config_word(dev, cap + PCI_X_CMD, &cmd))
2764 return -EINVAL;
Peter Orubad556ad42007-05-15 13:59:13 +02002765
Dean Nelson7c9e2b12010-03-09 22:26:55 -05002766 return 512 << ((cmd & PCI_X_CMD_MAX_READ) >> 2);
Peter Orubad556ad42007-05-15 13:59:13 +02002767}
2768EXPORT_SYMBOL(pcix_get_mmrbc);
2769
2770/**
2771 * pcix_set_mmrbc - set PCI-X maximum memory read byte count
2772 * @dev: PCI device to query
2773 * @mmrbc: maximum memory read count in bytes
2774 * valid values are 512, 1024, 2048, 4096
2775 *
2776 * If possible sets maximum memory read byte count, some bridges have erratas
2777 * that prevent this.
2778 */
2779int pcix_set_mmrbc(struct pci_dev *dev, int mmrbc)
2780{
Dean Nelson7c9e2b12010-03-09 22:26:55 -05002781 int cap;
Dean Nelsonbdc2bda2010-03-09 22:26:48 -05002782 u32 stat, v, o;
2783 u16 cmd;
Peter Orubad556ad42007-05-15 13:59:13 +02002784
vignesh babu229f5af2007-08-13 18:23:14 +05302785 if (mmrbc < 512 || mmrbc > 4096 || !is_power_of_2(mmrbc))
Dean Nelson7c9e2b12010-03-09 22:26:55 -05002786 return -EINVAL;
Peter Orubad556ad42007-05-15 13:59:13 +02002787
2788 v = ffs(mmrbc) - 10;
2789
2790 cap = pci_find_capability(dev, PCI_CAP_ID_PCIX);
2791 if (!cap)
Dean Nelson7c9e2b12010-03-09 22:26:55 -05002792 return -EINVAL;
Peter Orubad556ad42007-05-15 13:59:13 +02002793
Dean Nelson7c9e2b12010-03-09 22:26:55 -05002794 if (pci_read_config_dword(dev, cap + PCI_X_STATUS, &stat))
2795 return -EINVAL;
Peter Orubad556ad42007-05-15 13:59:13 +02002796
2797 if (v > (stat & PCI_X_STATUS_MAX_READ) >> 21)
2798 return -E2BIG;
2799
Dean Nelson7c9e2b12010-03-09 22:26:55 -05002800 if (pci_read_config_word(dev, cap + PCI_X_CMD, &cmd))
2801 return -EINVAL;
Peter Orubad556ad42007-05-15 13:59:13 +02002802
2803 o = (cmd & PCI_X_CMD_MAX_READ) >> 2;
2804 if (o != v) {
2805 if (v > o && dev->bus &&
2806 (dev->bus->bus_flags & PCI_BUS_FLAGS_NO_MMRBC))
2807 return -EIO;
2808
2809 cmd &= ~PCI_X_CMD_MAX_READ;
2810 cmd |= v << 2;
Dean Nelson7c9e2b12010-03-09 22:26:55 -05002811 if (pci_write_config_word(dev, cap + PCI_X_CMD, cmd))
2812 return -EIO;
Peter Orubad556ad42007-05-15 13:59:13 +02002813 }
Dean Nelson7c9e2b12010-03-09 22:26:55 -05002814 return 0;
Peter Orubad556ad42007-05-15 13:59:13 +02002815}
2816EXPORT_SYMBOL(pcix_set_mmrbc);
2817
2818/**
2819 * pcie_get_readrq - get PCI Express read request size
2820 * @dev: PCI device to query
2821 *
2822 * Returns maximum memory read request in bytes
2823 * or appropriate error value.
2824 */
2825int pcie_get_readrq(struct pci_dev *dev)
2826{
2827 int ret, cap;
2828 u16 ctl;
2829
Kenji Kaneshige06a1cba2009-11-11 14:30:56 +09002830 cap = pci_pcie_cap(dev);
Peter Orubad556ad42007-05-15 13:59:13 +02002831 if (!cap)
2832 return -EINVAL;
2833
2834 ret = pci_read_config_word(dev, cap + PCI_EXP_DEVCTL, &ctl);
2835 if (!ret)
Julia Lawall93e75fa2010-08-05 22:23:16 +02002836 ret = 128 << ((ctl & PCI_EXP_DEVCTL_READRQ) >> 12);
Peter Orubad556ad42007-05-15 13:59:13 +02002837
2838 return ret;
2839}
2840EXPORT_SYMBOL(pcie_get_readrq);
2841
2842/**
2843 * pcie_set_readrq - set PCI Express maximum memory read request
2844 * @dev: PCI device to query
Randy Dunlap42e61f42007-07-23 21:42:11 -07002845 * @rq: maximum memory read count in bytes
Peter Orubad556ad42007-05-15 13:59:13 +02002846 * valid values are 128, 256, 512, 1024, 2048, 4096
2847 *
2848 * If possible sets maximum read byte count
2849 */
2850int pcie_set_readrq(struct pci_dev *dev, int rq)
2851{
2852 int cap, err = -EINVAL;
2853 u16 ctl, v;
2854
vignesh babu229f5af2007-08-13 18:23:14 +05302855 if (rq < 128 || rq > 4096 || !is_power_of_2(rq))
Peter Orubad556ad42007-05-15 13:59:13 +02002856 goto out;
2857
2858 v = (ffs(rq) - 8) << 12;
2859
Kenji Kaneshige06a1cba2009-11-11 14:30:56 +09002860 cap = pci_pcie_cap(dev);
Peter Orubad556ad42007-05-15 13:59:13 +02002861 if (!cap)
2862 goto out;
2863
2864 err = pci_read_config_word(dev, cap + PCI_EXP_DEVCTL, &ctl);
2865 if (err)
2866 goto out;
2867
2868 if ((ctl & PCI_EXP_DEVCTL_READRQ) != v) {
2869 ctl &= ~PCI_EXP_DEVCTL_READRQ;
2870 ctl |= v;
2871 err = pci_write_config_dword(dev, cap + PCI_EXP_DEVCTL, ctl);
2872 }
2873
2874out:
2875 return err;
2876}
2877EXPORT_SYMBOL(pcie_set_readrq);
2878
2879/**
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09002880 * pci_select_bars - Make BAR mask from the type of resource
Randy Dunlapf95d8822007-02-10 14:41:56 -08002881 * @dev: the PCI device for which BAR mask is made
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09002882 * @flags: resource type mask to be selected
2883 *
2884 * This helper routine makes bar mask from the type of resource.
2885 */
2886int pci_select_bars(struct pci_dev *dev, unsigned long flags)
2887{
2888 int i, bars = 0;
2889 for (i = 0; i < PCI_NUM_RESOURCES; i++)
2890 if (pci_resource_flags(dev, i) & flags)
2891 bars |= (1 << i);
2892 return bars;
2893}
2894
Yu Zhao613e7ed2008-11-22 02:41:27 +08002895/**
2896 * pci_resource_bar - get position of the BAR associated with a resource
2897 * @dev: the PCI device
2898 * @resno: the resource number
2899 * @type: the BAR type to be filled in
2900 *
2901 * Returns BAR position in config space, or 0 if the BAR is invalid.
2902 */
2903int pci_resource_bar(struct pci_dev *dev, int resno, enum pci_bar_type *type)
2904{
Yu Zhaod1b054d2009-03-20 11:25:11 +08002905 int reg;
2906
Yu Zhao613e7ed2008-11-22 02:41:27 +08002907 if (resno < PCI_ROM_RESOURCE) {
2908 *type = pci_bar_unknown;
2909 return PCI_BASE_ADDRESS_0 + 4 * resno;
2910 } else if (resno == PCI_ROM_RESOURCE) {
2911 *type = pci_bar_mem32;
2912 return dev->rom_base_reg;
Yu Zhaod1b054d2009-03-20 11:25:11 +08002913 } else if (resno < PCI_BRIDGE_RESOURCES) {
2914 /* device specific resource */
2915 reg = pci_iov_resource_bar(dev, resno, type);
2916 if (reg)
2917 return reg;
Yu Zhao613e7ed2008-11-22 02:41:27 +08002918 }
2919
Bjorn Helgaas865df572009-11-04 10:32:57 -07002920 dev_err(&dev->dev, "BAR %d: invalid resource\n", resno);
Yu Zhao613e7ed2008-11-22 02:41:27 +08002921 return 0;
2922}
2923
Mike Travis95a8b6e2010-02-02 14:38:13 -08002924/* Some architectures require additional programming to enable VGA */
2925static arch_set_vga_state_t arch_set_vga_state;
2926
2927void __init pci_register_set_vga_state(arch_set_vga_state_t func)
2928{
2929 arch_set_vga_state = func; /* NULL disables */
2930}
2931
2932static int pci_set_vga_state_arch(struct pci_dev *dev, bool decode,
2933 unsigned int command_bits, bool change_bridge)
2934{
2935 if (arch_set_vga_state)
2936 return arch_set_vga_state(dev, decode, command_bits,
2937 change_bridge);
2938 return 0;
2939}
2940
Benjamin Herrenschmidtdeb2d2e2009-08-11 15:52:06 +10002941/**
2942 * pci_set_vga_state - set VGA decode state on device and parents if requested
Randy Dunlap19eea632009-09-17 15:28:22 -07002943 * @dev: the PCI device
2944 * @decode: true = enable decoding, false = disable decoding
2945 * @command_bits: PCI_COMMAND_IO and/or PCI_COMMAND_MEMORY
2946 * @change_bridge: traverse ancestors and change bridges
Benjamin Herrenschmidtdeb2d2e2009-08-11 15:52:06 +10002947 */
2948int pci_set_vga_state(struct pci_dev *dev, bool decode,
2949 unsigned int command_bits, bool change_bridge)
2950{
2951 struct pci_bus *bus;
2952 struct pci_dev *bridge;
2953 u16 cmd;
Mike Travis95a8b6e2010-02-02 14:38:13 -08002954 int rc;
Benjamin Herrenschmidtdeb2d2e2009-08-11 15:52:06 +10002955
2956 WARN_ON(command_bits & ~(PCI_COMMAND_IO|PCI_COMMAND_MEMORY));
2957
Mike Travis95a8b6e2010-02-02 14:38:13 -08002958 /* ARCH specific VGA enables */
2959 rc = pci_set_vga_state_arch(dev, decode, command_bits, change_bridge);
2960 if (rc)
2961 return rc;
2962
Benjamin Herrenschmidtdeb2d2e2009-08-11 15:52:06 +10002963 pci_read_config_word(dev, PCI_COMMAND, &cmd);
2964 if (decode == true)
2965 cmd |= command_bits;
2966 else
2967 cmd &= ~command_bits;
2968 pci_write_config_word(dev, PCI_COMMAND, cmd);
2969
2970 if (change_bridge == false)
2971 return 0;
2972
2973 bus = dev->bus;
2974 while (bus) {
2975 bridge = bus->self;
2976 if (bridge) {
2977 pci_read_config_word(bridge, PCI_BRIDGE_CONTROL,
2978 &cmd);
2979 if (decode == true)
2980 cmd |= PCI_BRIDGE_CTL_VGA;
2981 else
2982 cmd &= ~PCI_BRIDGE_CTL_VGA;
2983 pci_write_config_word(bridge, PCI_BRIDGE_CONTROL,
2984 cmd);
2985 }
2986 bus = bus->parent;
2987 }
2988 return 0;
2989}
2990
Yuji Shimada32a9a6822009-03-16 17:13:39 +09002991#define RESOURCE_ALIGNMENT_PARAM_SIZE COMMAND_LINE_SIZE
2992static char resource_alignment_param[RESOURCE_ALIGNMENT_PARAM_SIZE] = {0};
Thomas Gleixnere9d1e492009-11-06 22:41:23 +00002993static DEFINE_SPINLOCK(resource_alignment_lock);
Yuji Shimada32a9a6822009-03-16 17:13:39 +09002994
2995/**
2996 * pci_specified_resource_alignment - get resource alignment specified by user.
2997 * @dev: the PCI device to get
2998 *
2999 * RETURNS: Resource alignment if it is specified.
3000 * Zero if it is not specified.
3001 */
3002resource_size_t pci_specified_resource_alignment(struct pci_dev *dev)
3003{
3004 int seg, bus, slot, func, align_order, count;
3005 resource_size_t align = 0;
3006 char *p;
3007
3008 spin_lock(&resource_alignment_lock);
3009 p = resource_alignment_param;
3010 while (*p) {
3011 count = 0;
3012 if (sscanf(p, "%d%n", &align_order, &count) == 1 &&
3013 p[count] == '@') {
3014 p += count + 1;
3015 } else {
3016 align_order = -1;
3017 }
3018 if (sscanf(p, "%x:%x:%x.%x%n",
3019 &seg, &bus, &slot, &func, &count) != 4) {
3020 seg = 0;
3021 if (sscanf(p, "%x:%x.%x%n",
3022 &bus, &slot, &func, &count) != 3) {
3023 /* Invalid format */
3024 printk(KERN_ERR "PCI: Can't parse resource_alignment parameter: %s\n",
3025 p);
3026 break;
3027 }
3028 }
3029 p += count;
3030 if (seg == pci_domain_nr(dev->bus) &&
3031 bus == dev->bus->number &&
3032 slot == PCI_SLOT(dev->devfn) &&
3033 func == PCI_FUNC(dev->devfn)) {
3034 if (align_order == -1) {
3035 align = PAGE_SIZE;
3036 } else {
3037 align = 1 << align_order;
3038 }
3039 /* Found */
3040 break;
3041 }
3042 if (*p != ';' && *p != ',') {
3043 /* End of param or invalid format */
3044 break;
3045 }
3046 p++;
3047 }
3048 spin_unlock(&resource_alignment_lock);
3049 return align;
3050}
3051
3052/**
3053 * pci_is_reassigndev - check if specified PCI is target device to reassign
3054 * @dev: the PCI device to check
3055 *
3056 * RETURNS: non-zero for PCI device is a target device to reassign,
3057 * or zero is not.
3058 */
3059int pci_is_reassigndev(struct pci_dev *dev)
3060{
3061 return (pci_specified_resource_alignment(dev) != 0);
3062}
3063
3064ssize_t pci_set_resource_alignment_param(const char *buf, size_t count)
3065{
3066 if (count > RESOURCE_ALIGNMENT_PARAM_SIZE - 1)
3067 count = RESOURCE_ALIGNMENT_PARAM_SIZE - 1;
3068 spin_lock(&resource_alignment_lock);
3069 strncpy(resource_alignment_param, buf, count);
3070 resource_alignment_param[count] = '\0';
3071 spin_unlock(&resource_alignment_lock);
3072 return count;
3073}
3074
3075ssize_t pci_get_resource_alignment_param(char *buf, size_t size)
3076{
3077 size_t count;
3078 spin_lock(&resource_alignment_lock);
3079 count = snprintf(buf, size, "%s", resource_alignment_param);
3080 spin_unlock(&resource_alignment_lock);
3081 return count;
3082}
3083
3084static ssize_t pci_resource_alignment_show(struct bus_type *bus, char *buf)
3085{
3086 return pci_get_resource_alignment_param(buf, PAGE_SIZE);
3087}
3088
3089static ssize_t pci_resource_alignment_store(struct bus_type *bus,
3090 const char *buf, size_t count)
3091{
3092 return pci_set_resource_alignment_param(buf, count);
3093}
3094
3095BUS_ATTR(resource_alignment, 0644, pci_resource_alignment_show,
3096 pci_resource_alignment_store);
3097
3098static int __init pci_resource_alignment_sysfs_init(void)
3099{
3100 return bus_create_file(&pci_bus_type,
3101 &bus_attr_resource_alignment);
3102}
3103
3104late_initcall(pci_resource_alignment_sysfs_init);
3105
Jeff Garzik32a2eea2007-10-11 16:57:27 -04003106static void __devinit pci_no_domains(void)
3107{
3108#ifdef CONFIG_PCI_DOMAINS
3109 pci_domains_supported = 0;
3110#endif
3111}
3112
Andrew Patterson0ef5f8f2008-11-10 15:30:50 -07003113/**
3114 * pci_ext_cfg_enabled - can we access extended PCI config space?
3115 * @dev: The PCI device of the root bridge.
3116 *
3117 * Returns 1 if we can access PCI extended config space (offsets
3118 * greater than 0xff). This is the default implementation. Architecture
3119 * implementations can override this.
3120 */
3121int __attribute__ ((weak)) pci_ext_cfg_avail(struct pci_dev *dev)
3122{
3123 return 1;
3124}
3125
Benjamin Herrenschmidt2d1c8612009-12-09 17:52:13 +11003126void __weak pci_fixup_cardbus(struct pci_bus *bus)
3127{
3128}
3129EXPORT_SYMBOL(pci_fixup_cardbus);
3130
Al Viroad04d312008-11-22 17:37:14 +00003131static int __init pci_setup(char *str)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003132{
3133 while (str) {
3134 char *k = strchr(str, ',');
3135 if (k)
3136 *k++ = 0;
3137 if (*str && (str = pcibios_setup(str)) && *str) {
Matthew Wilcox309e57d2006-03-05 22:33:34 -07003138 if (!strcmp(str, "nomsi")) {
3139 pci_no_msi();
Randy Dunlap7f785762007-10-05 13:17:58 -07003140 } else if (!strcmp(str, "noaer")) {
3141 pci_no_aer();
Jeff Garzik32a2eea2007-10-11 16:57:27 -04003142 } else if (!strcmp(str, "nodomains")) {
3143 pci_no_domains();
Atsushi Nemoto4516a612007-02-05 16:36:06 -08003144 } else if (!strncmp(str, "cbiosize=", 9)) {
3145 pci_cardbus_io_size = memparse(str + 9, &str);
3146 } else if (!strncmp(str, "cbmemsize=", 10)) {
3147 pci_cardbus_mem_size = memparse(str + 10, &str);
Yuji Shimada32a9a6822009-03-16 17:13:39 +09003148 } else if (!strncmp(str, "resource_alignment=", 19)) {
3149 pci_set_resource_alignment_param(str + 19,
3150 strlen(str + 19));
Andrew Patterson43c16402009-04-22 16:52:09 -06003151 } else if (!strncmp(str, "ecrc=", 5)) {
3152 pcie_ecrc_get_policy(str + 5);
Eric W. Biederman28760482009-09-09 14:09:24 -07003153 } else if (!strncmp(str, "hpiosize=", 9)) {
3154 pci_hotplug_io_size = memparse(str + 9, &str);
3155 } else if (!strncmp(str, "hpmemsize=", 10)) {
3156 pci_hotplug_mem_size = memparse(str + 10, &str);
Matthew Wilcox309e57d2006-03-05 22:33:34 -07003157 } else {
3158 printk(KERN_ERR "PCI: Unknown option `%s'\n",
3159 str);
3160 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003161 }
3162 str = k;
3163 }
Andi Kleen0637a702006-09-26 10:52:41 +02003164 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003165}
Andi Kleen0637a702006-09-26 10:52:41 +02003166early_param("pci", pci_setup);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003167
Tejun Heo0b62e132007-07-27 14:43:35 +09003168EXPORT_SYMBOL(pci_reenable_device);
Benjamin Herrenschmidtb7189892007-12-20 15:28:08 +11003169EXPORT_SYMBOL(pci_enable_device_io);
3170EXPORT_SYMBOL(pci_enable_device_mem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003171EXPORT_SYMBOL(pci_enable_device);
Tejun Heo9ac78492007-01-20 16:00:26 +09003172EXPORT_SYMBOL(pcim_enable_device);
3173EXPORT_SYMBOL(pcim_pin_device);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003174EXPORT_SYMBOL(pci_disable_device);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003175EXPORT_SYMBOL(pci_find_capability);
3176EXPORT_SYMBOL(pci_bus_find_capability);
3177EXPORT_SYMBOL(pci_release_regions);
3178EXPORT_SYMBOL(pci_request_regions);
Arjan van de Vene8de1482008-10-22 19:55:31 -07003179EXPORT_SYMBOL(pci_request_regions_exclusive);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003180EXPORT_SYMBOL(pci_release_region);
3181EXPORT_SYMBOL(pci_request_region);
Arjan van de Vene8de1482008-10-22 19:55:31 -07003182EXPORT_SYMBOL(pci_request_region_exclusive);
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09003183EXPORT_SYMBOL(pci_release_selected_regions);
3184EXPORT_SYMBOL(pci_request_selected_regions);
Arjan van de Vene8de1482008-10-22 19:55:31 -07003185EXPORT_SYMBOL(pci_request_selected_regions_exclusive);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003186EXPORT_SYMBOL(pci_set_master);
Ben Hutchings6a479072008-12-23 03:08:29 +00003187EXPORT_SYMBOL(pci_clear_master);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003188EXPORT_SYMBOL(pci_set_mwi);
Randy Dunlap694625c2007-07-09 11:55:54 -07003189EXPORT_SYMBOL(pci_try_set_mwi);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003190EXPORT_SYMBOL(pci_clear_mwi);
Brett M Russa04ce0f2005-08-15 15:23:41 -04003191EXPORT_SYMBOL_GPL(pci_intx);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003192EXPORT_SYMBOL(pci_assign_resource);
3193EXPORT_SYMBOL(pci_find_parent_resource);
Hidetoshi Setoc87deff2006-12-18 10:31:06 +09003194EXPORT_SYMBOL(pci_select_bars);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003195
3196EXPORT_SYMBOL(pci_set_power_state);
3197EXPORT_SYMBOL(pci_save_state);
3198EXPORT_SYMBOL(pci_restore_state);
Rafael J. Wysockie5899e12008-07-19 14:39:24 +02003199EXPORT_SYMBOL(pci_pme_capable);
Rafael J. Wysocki5a6c9b62008-08-08 00:14:24 +02003200EXPORT_SYMBOL(pci_pme_active);
Rafael J. Wysocki0235c4f2008-08-18 21:38:00 +02003201EXPORT_SYMBOL(pci_wake_from_d3);
Rafael J. Wysockie5899e12008-07-19 14:39:24 +02003202EXPORT_SYMBOL(pci_target_state);
Rafael J. Wysocki404cc2d2008-07-07 03:35:26 +02003203EXPORT_SYMBOL(pci_prepare_to_sleep);
3204EXPORT_SYMBOL(pci_back_from_sleep);
Brian Kingf7bdd122007-04-06 16:39:36 -05003205EXPORT_SYMBOL_GPL(pci_set_pcie_reset_state);