]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blame - drivers/pci/pci.c
PCI: make acpihp use __pci_remove_bus_device instead
[mirror_ubuntu-artful-kernel.git] / drivers / pci / pci.c
CommitLineData
1da177e4 1/*
1da177e4
LT
2 * 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>
075c1771 14#include <linux/pm.h>
5a0e3ad6 15#include <linux/slab.h>
1da177e4
LT
16#include <linux/module.h>
17#include <linux/spinlock.h>
4e57b681 18#include <linux/string.h>
229f5afd 19#include <linux/log2.h>
7d715a6c 20#include <linux/pci-aspm.h>
c300bd2f 21#include <linux/pm_wakeup.h>
8dd7f803 22#include <linux/interrupt.h>
32a9a682 23#include <linux/device.h>
b67ea761 24#include <linux/pm_runtime.h>
32a9a682 25#include <asm/setup.h>
bc56b9e0 26#include "pci.h"
1da177e4 27
00240c38
AS
28const char *pci_power_names[] = {
29 "error", "D0", "D1", "D2", "D3hot", "D3cold", "unknown",
30};
31EXPORT_SYMBOL_GPL(pci_power_names);
32
93177a74
RW
33int isa_dma_bridge_buggy;
34EXPORT_SYMBOL(isa_dma_bridge_buggy);
35
36int pci_pci_problems;
37EXPORT_SYMBOL(pci_pci_problems);
38
1ae861e6
RW
39unsigned int pci_pm_d3_delay;
40
df17e62e
MG
41static 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
1ae861e6
RW
54static 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}
1da177e4 63
32a2eea7
JG
64#ifdef CONFIG_PCI_DOMAINS
65int pci_domains_supported = 1;
66#endif
67
4516a618
AN
68#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
28760489
EB
74#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
5f39e670 80enum pcie_bus_config_types pcie_bus_config = PCIE_BUS_TUNE_OFF;
b03e7495 81
ac1aa47b
JB
82/*
83 * The default CLS is used if arch didn't set CLS explicitly and not
84 * all pci devices agree on the same value. Arch can override either
85 * the dfl or actual value as it sees fit. Don't forget this is
86 * measured in 32-bit words, not bytes.
87 */
98e724c7 88u8 pci_dfl_cache_line_size __devinitdata = L1_CACHE_BYTES >> 2;
ac1aa47b
JB
89u8 pci_cache_line_size;
90
96c55900
MS
91/*
92 * If we set up a device for bus mastering, we need to check the latency
93 * timer as certain BIOSes forget to set it properly.
94 */
95unsigned int pcibios_max_latency = 255;
96
1da177e4
LT
97/**
98 * pci_bus_max_busnr - returns maximum PCI bus number of given bus' children
99 * @bus: pointer to PCI bus structure to search
100 *
101 * Given a PCI bus, returns the highest PCI bus number present in the set
102 * including the given PCI bus and its list of child PCI buses.
103 */
96bde06a 104unsigned char pci_bus_max_busnr(struct pci_bus* bus)
1da177e4
LT
105{
106 struct list_head *tmp;
107 unsigned char max, n;
108
b82db5ce 109 max = bus->subordinate;
1da177e4
LT
110 list_for_each(tmp, &bus->children) {
111 n = pci_bus_max_busnr(pci_bus_b(tmp));
112 if(n > max)
113 max = n;
114 }
115 return max;
116}
b82db5ce 117EXPORT_SYMBOL_GPL(pci_bus_max_busnr);
1da177e4 118
1684f5dd
AM
119#ifdef CONFIG_HAS_IOMEM
120void __iomem *pci_ioremap_bar(struct pci_dev *pdev, int bar)
121{
122 /*
123 * Make sure the BAR is actually a memory resource, not an IO resource
124 */
125 if (!(pci_resource_flags(pdev, bar) & IORESOURCE_MEM)) {
126 WARN_ON(1);
127 return NULL;
128 }
129 return ioremap_nocache(pci_resource_start(pdev, bar),
130 pci_resource_len(pdev, bar));
131}
132EXPORT_SYMBOL_GPL(pci_ioremap_bar);
133#endif
134
b82db5ce 135#if 0
1da177e4
LT
136/**
137 * pci_max_busnr - returns maximum PCI bus number
138 *
139 * Returns the highest PCI bus number present in the system global list of
140 * PCI buses.
141 */
142unsigned char __devinit
143pci_max_busnr(void)
144{
145 struct pci_bus *bus = NULL;
146 unsigned char max, n;
147
148 max = 0;
149 while ((bus = pci_find_next_bus(bus)) != NULL) {
150 n = pci_bus_max_busnr(bus);
151 if(n > max)
152 max = n;
153 }
154 return max;
155}
156
54c762fe
AB
157#endif /* 0 */
158
687d5fe3
ME
159#define PCI_FIND_CAP_TTL 48
160
161static int __pci_find_next_cap_ttl(struct pci_bus *bus, unsigned int devfn,
162 u8 pos, int cap, int *ttl)
24a4e377
RD
163{
164 u8 id;
24a4e377 165
687d5fe3 166 while ((*ttl)--) {
24a4e377
RD
167 pci_bus_read_config_byte(bus, devfn, pos, &pos);
168 if (pos < 0x40)
169 break;
170 pos &= ~3;
171 pci_bus_read_config_byte(bus, devfn, pos + PCI_CAP_LIST_ID,
172 &id);
173 if (id == 0xff)
174 break;
175 if (id == cap)
176 return pos;
177 pos += PCI_CAP_LIST_NEXT;
178 }
179 return 0;
180}
181
687d5fe3
ME
182static int __pci_find_next_cap(struct pci_bus *bus, unsigned int devfn,
183 u8 pos, int cap)
184{
185 int ttl = PCI_FIND_CAP_TTL;
186
187 return __pci_find_next_cap_ttl(bus, devfn, pos, cap, &ttl);
188}
189
24a4e377
RD
190int pci_find_next_capability(struct pci_dev *dev, u8 pos, int cap)
191{
192 return __pci_find_next_cap(dev->bus, dev->devfn,
193 pos + PCI_CAP_LIST_NEXT, cap);
194}
195EXPORT_SYMBOL_GPL(pci_find_next_capability);
196
d3bac118
ME
197static int __pci_bus_find_cap_start(struct pci_bus *bus,
198 unsigned int devfn, u8 hdr_type)
1da177e4
LT
199{
200 u16 status;
1da177e4
LT
201
202 pci_bus_read_config_word(bus, devfn, PCI_STATUS, &status);
203 if (!(status & PCI_STATUS_CAP_LIST))
204 return 0;
205
206 switch (hdr_type) {
207 case PCI_HEADER_TYPE_NORMAL:
208 case PCI_HEADER_TYPE_BRIDGE:
d3bac118 209 return PCI_CAPABILITY_LIST;
1da177e4 210 case PCI_HEADER_TYPE_CARDBUS:
d3bac118 211 return PCI_CB_CAPABILITY_LIST;
1da177e4
LT
212 default:
213 return 0;
214 }
d3bac118
ME
215
216 return 0;
1da177e4
LT
217}
218
219/**
220 * pci_find_capability - query for devices' capabilities
221 * @dev: PCI device to query
222 * @cap: capability code
223 *
224 * Tell if a device supports a given PCI capability.
225 * Returns the address of the requested capability structure within the
226 * device's PCI configuration space or 0 in case the device does not
227 * support it. Possible values for @cap:
228 *
229 * %PCI_CAP_ID_PM Power Management
230 * %PCI_CAP_ID_AGP Accelerated Graphics Port
231 * %PCI_CAP_ID_VPD Vital Product Data
232 * %PCI_CAP_ID_SLOTID Slot Identification
233 * %PCI_CAP_ID_MSI Message Signalled Interrupts
234 * %PCI_CAP_ID_CHSWP CompactPCI HotSwap
235 * %PCI_CAP_ID_PCIX PCI-X
236 * %PCI_CAP_ID_EXP PCI Express
237 */
238int pci_find_capability(struct pci_dev *dev, int cap)
239{
d3bac118
ME
240 int pos;
241
242 pos = __pci_bus_find_cap_start(dev->bus, dev->devfn, dev->hdr_type);
243 if (pos)
244 pos = __pci_find_next_cap(dev->bus, dev->devfn, pos, cap);
245
246 return pos;
1da177e4
LT
247}
248
249/**
250 * pci_bus_find_capability - query for devices' capabilities
251 * @bus: the PCI bus to query
252 * @devfn: PCI device to query
253 * @cap: capability code
254 *
255 * Like pci_find_capability() but works for pci devices that do not have a
256 * pci_dev structure set up yet.
257 *
258 * Returns the address of the requested capability structure within the
259 * device's PCI configuration space or 0 in case the device does not
260 * support it.
261 */
262int pci_bus_find_capability(struct pci_bus *bus, unsigned int devfn, int cap)
263{
d3bac118 264 int pos;
1da177e4
LT
265 u8 hdr_type;
266
267 pci_bus_read_config_byte(bus, devfn, PCI_HEADER_TYPE, &hdr_type);
268
d3bac118
ME
269 pos = __pci_bus_find_cap_start(bus, devfn, hdr_type & 0x7f);
270 if (pos)
271 pos = __pci_find_next_cap(bus, devfn, pos, cap);
272
273 return pos;
1da177e4
LT
274}
275
276/**
277 * pci_find_ext_capability - Find an extended capability
278 * @dev: PCI device to query
279 * @cap: capability code
280 *
281 * Returns the address of the requested extended capability structure
282 * within the device's PCI configuration space or 0 if the device does
283 * not support it. Possible values for @cap:
284 *
285 * %PCI_EXT_CAP_ID_ERR Advanced Error Reporting
286 * %PCI_EXT_CAP_ID_VC Virtual Channel
287 * %PCI_EXT_CAP_ID_DSN Device Serial Number
288 * %PCI_EXT_CAP_ID_PWR Power Budgeting
289 */
290int pci_find_ext_capability(struct pci_dev *dev, int cap)
291{
292 u32 header;
557848c3
ZY
293 int ttl;
294 int pos = PCI_CFG_SPACE_SIZE;
1da177e4 295
557848c3
ZY
296 /* minimum 8 bytes per capability */
297 ttl = (PCI_CFG_SPACE_EXP_SIZE - PCI_CFG_SPACE_SIZE) / 8;
298
299 if (dev->cfg_size <= PCI_CFG_SPACE_SIZE)
1da177e4
LT
300 return 0;
301
302 if (pci_read_config_dword(dev, pos, &header) != PCIBIOS_SUCCESSFUL)
303 return 0;
304
305 /*
306 * If we have no capabilities, this is indicated by cap ID,
307 * cap version and next pointer all being 0.
308 */
309 if (header == 0)
310 return 0;
311
312 while (ttl-- > 0) {
313 if (PCI_EXT_CAP_ID(header) == cap)
314 return pos;
315
316 pos = PCI_EXT_CAP_NEXT(header);
557848c3 317 if (pos < PCI_CFG_SPACE_SIZE)
1da177e4
LT
318 break;
319
320 if (pci_read_config_dword(dev, pos, &header) != PCIBIOS_SUCCESSFUL)
321 break;
322 }
323
324 return 0;
325}
3a720d72 326EXPORT_SYMBOL_GPL(pci_find_ext_capability);
1da177e4 327
cf4c43dd
JB
328/**
329 * pci_bus_find_ext_capability - find an extended capability
330 * @bus: the PCI bus to query
331 * @devfn: PCI device to query
332 * @cap: capability code
333 *
334 * Like pci_find_ext_capability() but works for pci devices that do not have a
335 * pci_dev structure set up yet.
336 *
337 * Returns the address of the requested capability structure within the
338 * device's PCI configuration space or 0 in case the device does not
339 * support it.
340 */
341int pci_bus_find_ext_capability(struct pci_bus *bus, unsigned int devfn,
342 int cap)
343{
344 u32 header;
345 int ttl;
346 int pos = PCI_CFG_SPACE_SIZE;
347
348 /* minimum 8 bytes per capability */
349 ttl = (PCI_CFG_SPACE_EXP_SIZE - PCI_CFG_SPACE_SIZE) / 8;
350
351 if (!pci_bus_read_config_dword(bus, devfn, pos, &header))
352 return 0;
353 if (header == 0xffffffff || header == 0)
354 return 0;
355
356 while (ttl-- > 0) {
357 if (PCI_EXT_CAP_ID(header) == cap)
358 return pos;
359
360 pos = PCI_EXT_CAP_NEXT(header);
361 if (pos < PCI_CFG_SPACE_SIZE)
362 break;
363
364 if (!pci_bus_read_config_dword(bus, devfn, pos, &header))
365 break;
366 }
367
368 return 0;
369}
370
687d5fe3
ME
371static int __pci_find_next_ht_cap(struct pci_dev *dev, int pos, int ht_cap)
372{
373 int rc, ttl = PCI_FIND_CAP_TTL;
374 u8 cap, mask;
375
376 if (ht_cap == HT_CAPTYPE_SLAVE || ht_cap == HT_CAPTYPE_HOST)
377 mask = HT_3BIT_CAP_MASK;
378 else
379 mask = HT_5BIT_CAP_MASK;
380
381 pos = __pci_find_next_cap_ttl(dev->bus, dev->devfn, pos,
382 PCI_CAP_ID_HT, &ttl);
383 while (pos) {
384 rc = pci_read_config_byte(dev, pos + 3, &cap);
385 if (rc != PCIBIOS_SUCCESSFUL)
386 return 0;
387
388 if ((cap & mask) == ht_cap)
389 return pos;
390
47a4d5be
BG
391 pos = __pci_find_next_cap_ttl(dev->bus, dev->devfn,
392 pos + PCI_CAP_LIST_NEXT,
687d5fe3
ME
393 PCI_CAP_ID_HT, &ttl);
394 }
395
396 return 0;
397}
398/**
399 * pci_find_next_ht_capability - query a device's Hypertransport capabilities
400 * @dev: PCI device to query
401 * @pos: Position from which to continue searching
402 * @ht_cap: Hypertransport capability code
403 *
404 * To be used in conjunction with pci_find_ht_capability() to search for
405 * all capabilities matching @ht_cap. @pos should always be a value returned
406 * from pci_find_ht_capability().
407 *
408 * NB. To be 100% safe against broken PCI devices, the caller should take
409 * steps to avoid an infinite loop.
410 */
411int pci_find_next_ht_capability(struct pci_dev *dev, int pos, int ht_cap)
412{
413 return __pci_find_next_ht_cap(dev, pos + PCI_CAP_LIST_NEXT, ht_cap);
414}
415EXPORT_SYMBOL_GPL(pci_find_next_ht_capability);
416
417/**
418 * pci_find_ht_capability - query a device's Hypertransport capabilities
419 * @dev: PCI device to query
420 * @ht_cap: Hypertransport capability code
421 *
422 * Tell if a device supports a given Hypertransport capability.
423 * Returns an address within the device's PCI configuration space
424 * or 0 in case the device does not support the request capability.
425 * The address points to the PCI capability, of type PCI_CAP_ID_HT,
426 * which has a Hypertransport capability matching @ht_cap.
427 */
428int pci_find_ht_capability(struct pci_dev *dev, int ht_cap)
429{
430 int pos;
431
432 pos = __pci_bus_find_cap_start(dev->bus, dev->devfn, dev->hdr_type);
433 if (pos)
434 pos = __pci_find_next_ht_cap(dev, pos, ht_cap);
435
436 return pos;
437}
438EXPORT_SYMBOL_GPL(pci_find_ht_capability);
439
1da177e4
LT
440/**
441 * pci_find_parent_resource - return resource region of parent bus of given region
442 * @dev: PCI device structure contains resources to be searched
443 * @res: child resource record for which parent is sought
444 *
445 * For given resource region of given device, return the resource
446 * region of parent bus the given region is contained in or where
447 * it should be allocated from.
448 */
449struct resource *
450pci_find_parent_resource(const struct pci_dev *dev, struct resource *res)
451{
452 const struct pci_bus *bus = dev->bus;
453 int i;
89a74ecc 454 struct resource *best = NULL, *r;
1da177e4 455
89a74ecc 456 pci_bus_for_each_resource(bus, r, i) {
1da177e4
LT
457 if (!r)
458 continue;
459 if (res->start && !(res->start >= r->start && res->end <= r->end))
460 continue; /* Not contained */
461 if ((res->flags ^ r->flags) & (IORESOURCE_IO | IORESOURCE_MEM))
462 continue; /* Wrong type */
463 if (!((res->flags ^ r->flags) & IORESOURCE_PREFETCH))
464 return r; /* Exact match */
8c8def26
LT
465 /* We can't insert a non-prefetch resource inside a prefetchable parent .. */
466 if (r->flags & IORESOURCE_PREFETCH)
467 continue;
468 /* .. but we can put a prefetchable resource inside a non-prefetchable one */
469 if (!best)
470 best = r;
1da177e4
LT
471 }
472 return best;
473}
474
064b53db
JL
475/**
476 * pci_restore_bars - restore a devices BAR values (e.g. after wake-up)
477 * @dev: PCI device to have its BARs restored
478 *
479 * Restore the BAR values for a given device, so as to make it
480 * accessible by its driver.
481 */
ad668599 482static void
064b53db
JL
483pci_restore_bars(struct pci_dev *dev)
484{
bc5f5a82 485 int i;
064b53db 486
bc5f5a82 487 for (i = 0; i < PCI_BRIDGE_RESOURCES; i++)
14add80b 488 pci_update_resource(dev, i);
064b53db
JL
489}
490
961d9120
RW
491static struct pci_platform_pm_ops *pci_platform_pm;
492
493int pci_set_platform_pm(struct pci_platform_pm_ops *ops)
494{
eb9d0fe4
RW
495 if (!ops->is_manageable || !ops->set_state || !ops->choose_state
496 || !ops->sleep_wake || !ops->can_wakeup)
961d9120
RW
497 return -EINVAL;
498 pci_platform_pm = ops;
499 return 0;
500}
501
502static inline bool platform_pci_power_manageable(struct pci_dev *dev)
503{
504 return pci_platform_pm ? pci_platform_pm->is_manageable(dev) : false;
505}
506
507static inline int platform_pci_set_power_state(struct pci_dev *dev,
508 pci_power_t t)
509{
510 return pci_platform_pm ? pci_platform_pm->set_state(dev, t) : -ENOSYS;
511}
512
513static inline pci_power_t platform_pci_choose_state(struct pci_dev *dev)
514{
515 return pci_platform_pm ?
516 pci_platform_pm->choose_state(dev) : PCI_POWER_ERROR;
517}
8f7020d3 518
eb9d0fe4
RW
519static inline bool platform_pci_can_wakeup(struct pci_dev *dev)
520{
521 return pci_platform_pm ? pci_platform_pm->can_wakeup(dev) : false;
522}
523
524static inline int platform_pci_sleep_wake(struct pci_dev *dev, bool enable)
525{
526 return pci_platform_pm ?
527 pci_platform_pm->sleep_wake(dev, enable) : -ENODEV;
528}
529
b67ea761
RW
530static inline int platform_pci_run_wake(struct pci_dev *dev, bool enable)
531{
532 return pci_platform_pm ?
533 pci_platform_pm->run_wake(dev, enable) : -ENODEV;
534}
535
1da177e4 536/**
44e4e66e
RW
537 * pci_raw_set_power_state - Use PCI PM registers to set the power state of
538 * given PCI device
539 * @dev: PCI device to handle.
44e4e66e 540 * @state: PCI power state (D0, D1, D2, D3hot) to put the device into.
1da177e4 541 *
44e4e66e
RW
542 * RETURN VALUE:
543 * -EINVAL if the requested state is invalid.
544 * -EIO if device does not support PCI PM or its PM capabilities register has a
545 * wrong version, or device doesn't support the requested state.
546 * 0 if device already is in the requested state.
547 * 0 if device's power state has been successfully changed.
1da177e4 548 */
f00a20ef 549static int pci_raw_set_power_state(struct pci_dev *dev, pci_power_t state)
1da177e4 550{
337001b6 551 u16 pmcsr;
44e4e66e 552 bool need_restore = false;
1da177e4 553
4a865905
RW
554 /* Check if we're already there */
555 if (dev->current_state == state)
556 return 0;
557
337001b6 558 if (!dev->pm_cap)
cca03dec
AL
559 return -EIO;
560
44e4e66e
RW
561 if (state < PCI_D0 || state > PCI_D3hot)
562 return -EINVAL;
563
1da177e4
LT
564 /* Validate current state:
565 * Can enter D0 from any state, but if we can only go deeper
566 * to sleep if we're already in a low power state
567 */
4a865905 568 if (state != PCI_D0 && dev->current_state <= PCI_D3cold
44e4e66e 569 && dev->current_state > state) {
80ccba11
BH
570 dev_err(&dev->dev, "invalid power transition "
571 "(from state %d to %d)\n", dev->current_state, state);
1da177e4 572 return -EINVAL;
44e4e66e 573 }
1da177e4 574
1da177e4 575 /* check if this device supports the desired state */
337001b6
RW
576 if ((state == PCI_D1 && !dev->d1_support)
577 || (state == PCI_D2 && !dev->d2_support))
3fe9d19f 578 return -EIO;
1da177e4 579
337001b6 580 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
064b53db 581
32a36585 582 /* If we're (effectively) in D3, force entire word to 0.
1da177e4
LT
583 * This doesn't affect PME_Status, disables PME_En, and
584 * sets PowerState to 0.
585 */
32a36585 586 switch (dev->current_state) {
d3535fbb
JL
587 case PCI_D0:
588 case PCI_D1:
589 case PCI_D2:
590 pmcsr &= ~PCI_PM_CTRL_STATE_MASK;
591 pmcsr |= state;
592 break;
f62795f1
RW
593 case PCI_D3hot:
594 case PCI_D3cold:
32a36585
JL
595 case PCI_UNKNOWN: /* Boot-up */
596 if ((pmcsr & PCI_PM_CTRL_STATE_MASK) == PCI_D3hot
f00a20ef 597 && !(pmcsr & PCI_PM_CTRL_NO_SOFT_RESET))
44e4e66e 598 need_restore = true;
32a36585 599 /* Fall-through: force to D0 */
32a36585 600 default:
d3535fbb 601 pmcsr = 0;
32a36585 602 break;
1da177e4
LT
603 }
604
605 /* enter specified state */
337001b6 606 pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, pmcsr);
1da177e4
LT
607
608 /* Mandatory power management transition delays */
609 /* see PCI PM 1.1 5.6.1 table 18 */
610 if (state == PCI_D3hot || dev->current_state == PCI_D3hot)
1ae861e6 611 pci_dev_d3_sleep(dev);
1da177e4 612 else if (state == PCI_D2 || dev->current_state == PCI_D2)
aa8c6c93 613 udelay(PCI_PM_D2_DELAY);
1da177e4 614
e13cdbd7
RW
615 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
616 dev->current_state = (pmcsr & PCI_PM_CTRL_STATE_MASK);
617 if (dev->current_state != state && printk_ratelimit())
618 dev_info(&dev->dev, "Refused to change power state, "
619 "currently in D%d\n", dev->current_state);
064b53db
JL
620
621 /* According to section 5.4.1 of the "PCI BUS POWER MANAGEMENT
622 * INTERFACE SPECIFICATION, REV. 1.2", a device transitioning
623 * from D3hot to D0 _may_ perform an internal reset, thereby
624 * going to "D0 Uninitialized" rather than "D0 Initialized".
625 * For example, at least some versions of the 3c905B and the
626 * 3c556B exhibit this behaviour.
627 *
628 * At least some laptop BIOSen (e.g. the Thinkpad T21) leave
629 * devices in a D3hot state at boot. Consequently, we need to
630 * restore at least the BARs so that the device will be
631 * accessible to its driver.
632 */
633 if (need_restore)
634 pci_restore_bars(dev);
635
f00a20ef 636 if (dev->bus->self)
7d715a6c
SL
637 pcie_aspm_pm_state_change(dev->bus->self);
638
1da177e4
LT
639 return 0;
640}
641
44e4e66e
RW
642/**
643 * pci_update_current_state - Read PCI power state of given device from its
644 * PCI PM registers and cache it
645 * @dev: PCI device to handle.
f06fc0b6 646 * @state: State to cache in case the device doesn't have the PM capability
44e4e66e 647 */
73410429 648void pci_update_current_state(struct pci_dev *dev, pci_power_t state)
44e4e66e 649{
337001b6 650 if (dev->pm_cap) {
44e4e66e
RW
651 u16 pmcsr;
652
337001b6 653 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
44e4e66e 654 dev->current_state = (pmcsr & PCI_PM_CTRL_STATE_MASK);
f06fc0b6
RW
655 } else {
656 dev->current_state = state;
44e4e66e
RW
657 }
658}
659
0e5dd46b
RW
660/**
661 * pci_platform_power_transition - Use platform to change device power state
662 * @dev: PCI device to handle.
663 * @state: State to put the device into.
664 */
665static int pci_platform_power_transition(struct pci_dev *dev, pci_power_t state)
666{
667 int error;
668
669 if (platform_pci_power_manageable(dev)) {
670 error = platform_pci_set_power_state(dev, state);
671 if (!error)
672 pci_update_current_state(dev, state);
b51306c6
AH
673 /* Fall back to PCI_D0 if native PM is not supported */
674 if (!dev->pm_cap)
675 dev->current_state = PCI_D0;
0e5dd46b
RW
676 } else {
677 error = -ENODEV;
678 /* Fall back to PCI_D0 if native PM is not supported */
b3bad72e
RW
679 if (!dev->pm_cap)
680 dev->current_state = PCI_D0;
0e5dd46b
RW
681 }
682
683 return error;
684}
685
686/**
687 * __pci_start_power_transition - Start power transition of a PCI device
688 * @dev: PCI device to handle.
689 * @state: State to put the device into.
690 */
691static void __pci_start_power_transition(struct pci_dev *dev, pci_power_t state)
692{
693 if (state == PCI_D0)
694 pci_platform_power_transition(dev, PCI_D0);
695}
696
697/**
698 * __pci_complete_power_transition - Complete power transition of a PCI device
699 * @dev: PCI device to handle.
700 * @state: State to put the device into.
701 *
702 * This function should not be called directly by device drivers.
703 */
704int __pci_complete_power_transition(struct pci_dev *dev, pci_power_t state)
705{
cc2893b6 706 return state >= PCI_D0 ?
0e5dd46b
RW
707 pci_platform_power_transition(dev, state) : -EINVAL;
708}
709EXPORT_SYMBOL_GPL(__pci_complete_power_transition);
710
44e4e66e
RW
711/**
712 * pci_set_power_state - Set the power state of a PCI device
713 * @dev: PCI device to handle.
714 * @state: PCI power state (D0, D1, D2, D3hot) to put the device into.
715 *
877d0310 716 * Transition a device to a new power state, using the platform firmware and/or
44e4e66e
RW
717 * the device's PCI PM registers.
718 *
719 * RETURN VALUE:
720 * -EINVAL if the requested state is invalid.
721 * -EIO if device does not support PCI PM or its PM capabilities register has a
722 * wrong version, or device doesn't support the requested state.
723 * 0 if device already is in the requested state.
724 * 0 if device's power state has been successfully changed.
725 */
726int pci_set_power_state(struct pci_dev *dev, pci_power_t state)
727{
337001b6 728 int error;
44e4e66e
RW
729
730 /* bound the state we're entering */
731 if (state > PCI_D3hot)
732 state = PCI_D3hot;
733 else if (state < PCI_D0)
734 state = PCI_D0;
735 else if ((state == PCI_D1 || state == PCI_D2) && pci_no_d1d2(dev))
736 /*
737 * If the device or the parent bridge do not support PCI PM,
738 * ignore the request if we're doing anything other than putting
739 * it into D0 (which would only happen on boot).
740 */
741 return 0;
742
0e5dd46b
RW
743 __pci_start_power_transition(dev, state);
744
979b1791
AC
745 /* This device is quirked not to be put into D3, so
746 don't put it in D3 */
747 if (state == PCI_D3hot && (dev->dev_flags & PCI_DEV_FLAGS_NO_D3))
748 return 0;
44e4e66e 749
f00a20ef 750 error = pci_raw_set_power_state(dev, state);
44e4e66e 751
0e5dd46b
RW
752 if (!__pci_complete_power_transition(dev, state))
753 error = 0;
1a680b7c
NC
754 /*
755 * When aspm_policy is "powersave" this call ensures
756 * that ASPM is configured.
757 */
758 if (!error && dev->bus->self)
759 pcie_aspm_powersave_config_link(dev->bus->self);
44e4e66e
RW
760
761 return error;
762}
763
1da177e4
LT
764/**
765 * pci_choose_state - Choose the power state of a PCI device
766 * @dev: PCI device to be suspended
767 * @state: target sleep state for the whole system. This is the value
768 * that is passed to suspend() function.
769 *
770 * Returns PCI power state suitable for given device and given system
771 * message.
772 */
773
774pci_power_t pci_choose_state(struct pci_dev *dev, pm_message_t state)
775{
ab826ca4 776 pci_power_t ret;
0f64474b 777
1da177e4
LT
778 if (!pci_find_capability(dev, PCI_CAP_ID_PM))
779 return PCI_D0;
780
961d9120
RW
781 ret = platform_pci_choose_state(dev);
782 if (ret != PCI_POWER_ERROR)
783 return ret;
ca078bae
PM
784
785 switch (state.event) {
786 case PM_EVENT_ON:
787 return PCI_D0;
788 case PM_EVENT_FREEZE:
b887d2e6
DB
789 case PM_EVENT_PRETHAW:
790 /* REVISIT both freeze and pre-thaw "should" use D0 */
ca078bae 791 case PM_EVENT_SUSPEND:
3a2d5b70 792 case PM_EVENT_HIBERNATE:
ca078bae 793 return PCI_D3hot;
1da177e4 794 default:
80ccba11
BH
795 dev_info(&dev->dev, "unrecognized suspend event %d\n",
796 state.event);
1da177e4
LT
797 BUG();
798 }
799 return PCI_D0;
800}
801
802EXPORT_SYMBOL(pci_choose_state);
803
89858517
YZ
804#define PCI_EXP_SAVE_REGS 7
805
1b6b8ce2
YZ
806#define pcie_cap_has_devctl(type, flags) 1
807#define pcie_cap_has_lnkctl(type, flags) \
808 ((flags & PCI_EXP_FLAGS_VERS) > 1 || \
809 (type == PCI_EXP_TYPE_ROOT_PORT || \
810 type == PCI_EXP_TYPE_ENDPOINT || \
811 type == PCI_EXP_TYPE_LEG_END))
812#define pcie_cap_has_sltctl(type, flags) \
813 ((flags & PCI_EXP_FLAGS_VERS) > 1 || \
814 ((type == PCI_EXP_TYPE_ROOT_PORT) || \
815 (type == PCI_EXP_TYPE_DOWNSTREAM && \
816 (flags & PCI_EXP_FLAGS_SLOT))))
817#define pcie_cap_has_rtctl(type, flags) \
818 ((flags & PCI_EXP_FLAGS_VERS) > 1 || \
819 (type == PCI_EXP_TYPE_ROOT_PORT || \
820 type == PCI_EXP_TYPE_RC_EC))
821#define pcie_cap_has_devctl2(type, flags) \
822 ((flags & PCI_EXP_FLAGS_VERS) > 1)
823#define pcie_cap_has_lnkctl2(type, flags) \
824 ((flags & PCI_EXP_FLAGS_VERS) > 1)
825#define pcie_cap_has_sltctl2(type, flags) \
826 ((flags & PCI_EXP_FLAGS_VERS) > 1)
827
34a4876e
YL
828static struct pci_cap_saved_state *pci_find_saved_cap(
829 struct pci_dev *pci_dev, char cap)
830{
831 struct pci_cap_saved_state *tmp;
832 struct hlist_node *pos;
833
834 hlist_for_each_entry(tmp, pos, &pci_dev->saved_cap_space, next) {
835 if (tmp->cap.cap_nr == cap)
836 return tmp;
837 }
838 return NULL;
839}
840
b56a5a23
MT
841static int pci_save_pcie_state(struct pci_dev *dev)
842{
843 int pos, i = 0;
844 struct pci_cap_saved_state *save_state;
845 u16 *cap;
1b6b8ce2 846 u16 flags;
b56a5a23 847
06a1cbaf
KK
848 pos = pci_pcie_cap(dev);
849 if (!pos)
b56a5a23
MT
850 return 0;
851
9f35575d 852 save_state = pci_find_saved_cap(dev, PCI_CAP_ID_EXP);
b56a5a23 853 if (!save_state) {
e496b617 854 dev_err(&dev->dev, "buffer not found in %s\n", __func__);
b56a5a23
MT
855 return -ENOMEM;
856 }
24a4742f 857 cap = (u16 *)&save_state->cap.data[0];
b56a5a23 858
1b6b8ce2
YZ
859 pci_read_config_word(dev, pos + PCI_EXP_FLAGS, &flags);
860
861 if (pcie_cap_has_devctl(dev->pcie_type, flags))
862 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL, &cap[i++]);
863 if (pcie_cap_has_lnkctl(dev->pcie_type, flags))
864 pci_read_config_word(dev, pos + PCI_EXP_LNKCTL, &cap[i++]);
865 if (pcie_cap_has_sltctl(dev->pcie_type, flags))
866 pci_read_config_word(dev, pos + PCI_EXP_SLTCTL, &cap[i++]);
867 if (pcie_cap_has_rtctl(dev->pcie_type, flags))
868 pci_read_config_word(dev, pos + PCI_EXP_RTCTL, &cap[i++]);
869 if (pcie_cap_has_devctl2(dev->pcie_type, flags))
870 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL2, &cap[i++]);
871 if (pcie_cap_has_lnkctl2(dev->pcie_type, flags))
872 pci_read_config_word(dev, pos + PCI_EXP_LNKCTL2, &cap[i++]);
873 if (pcie_cap_has_sltctl2(dev->pcie_type, flags))
874 pci_read_config_word(dev, pos + PCI_EXP_SLTCTL2, &cap[i++]);
63f4898a 875
b56a5a23
MT
876 return 0;
877}
878
879static void pci_restore_pcie_state(struct pci_dev *dev)
880{
881 int i = 0, pos;
882 struct pci_cap_saved_state *save_state;
883 u16 *cap;
1b6b8ce2 884 u16 flags;
b56a5a23
MT
885
886 save_state = pci_find_saved_cap(dev, PCI_CAP_ID_EXP);
887 pos = pci_find_capability(dev, PCI_CAP_ID_EXP);
888 if (!save_state || pos <= 0)
889 return;
24a4742f 890 cap = (u16 *)&save_state->cap.data[0];
b56a5a23 891
1b6b8ce2
YZ
892 pci_read_config_word(dev, pos + PCI_EXP_FLAGS, &flags);
893
894 if (pcie_cap_has_devctl(dev->pcie_type, flags))
895 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL, cap[i++]);
896 if (pcie_cap_has_lnkctl(dev->pcie_type, flags))
897 pci_write_config_word(dev, pos + PCI_EXP_LNKCTL, cap[i++]);
898 if (pcie_cap_has_sltctl(dev->pcie_type, flags))
899 pci_write_config_word(dev, pos + PCI_EXP_SLTCTL, cap[i++]);
900 if (pcie_cap_has_rtctl(dev->pcie_type, flags))
901 pci_write_config_word(dev, pos + PCI_EXP_RTCTL, cap[i++]);
902 if (pcie_cap_has_devctl2(dev->pcie_type, flags))
903 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL2, cap[i++]);
904 if (pcie_cap_has_lnkctl2(dev->pcie_type, flags))
905 pci_write_config_word(dev, pos + PCI_EXP_LNKCTL2, cap[i++]);
906 if (pcie_cap_has_sltctl2(dev->pcie_type, flags))
907 pci_write_config_word(dev, pos + PCI_EXP_SLTCTL2, cap[i++]);
b56a5a23
MT
908}
909
cc692a5f
SH
910
911static int pci_save_pcix_state(struct pci_dev *dev)
912{
63f4898a 913 int pos;
cc692a5f 914 struct pci_cap_saved_state *save_state;
cc692a5f
SH
915
916 pos = pci_find_capability(dev, PCI_CAP_ID_PCIX);
917 if (pos <= 0)
918 return 0;
919
f34303de 920 save_state = pci_find_saved_cap(dev, PCI_CAP_ID_PCIX);
cc692a5f 921 if (!save_state) {
e496b617 922 dev_err(&dev->dev, "buffer not found in %s\n", __func__);
cc692a5f
SH
923 return -ENOMEM;
924 }
cc692a5f 925
24a4742f
AW
926 pci_read_config_word(dev, pos + PCI_X_CMD,
927 (u16 *)save_state->cap.data);
63f4898a 928
cc692a5f
SH
929 return 0;
930}
931
932static void pci_restore_pcix_state(struct pci_dev *dev)
933{
934 int i = 0, pos;
935 struct pci_cap_saved_state *save_state;
936 u16 *cap;
937
938 save_state = pci_find_saved_cap(dev, PCI_CAP_ID_PCIX);
939 pos = pci_find_capability(dev, PCI_CAP_ID_PCIX);
940 if (!save_state || pos <= 0)
941 return;
24a4742f 942 cap = (u16 *)&save_state->cap.data[0];
cc692a5f
SH
943
944 pci_write_config_word(dev, pos + PCI_X_CMD, cap[i++]);
cc692a5f
SH
945}
946
947
1da177e4
LT
948/**
949 * pci_save_state - save the PCI configuration space of a device before suspending
950 * @dev: - PCI device that we're dealing with
1da177e4
LT
951 */
952int
953pci_save_state(struct pci_dev *dev)
954{
955 int i;
956 /* XXX: 100% dword access ok here? */
957 for (i = 0; i < 16; i++)
9e0b5b2c 958 pci_read_config_dword(dev, i * 4, &dev->saved_config_space[i]);
aa8c6c93 959 dev->state_saved = true;
b56a5a23
MT
960 if ((i = pci_save_pcie_state(dev)) != 0)
961 return i;
cc692a5f
SH
962 if ((i = pci_save_pcix_state(dev)) != 0)
963 return i;
1da177e4
LT
964 return 0;
965}
966
967/**
968 * pci_restore_state - Restore the saved state of a PCI device
969 * @dev: - PCI device that we're dealing with
1da177e4 970 */
1d3c16a8 971void pci_restore_state(struct pci_dev *dev)
1da177e4
LT
972{
973 int i;
b4482a4b 974 u32 val;
26f41062 975 int tries;
1da177e4 976
c82f63e4 977 if (!dev->state_saved)
1d3c16a8 978 return;
4b77b0a2 979
b56a5a23
MT
980 /* PCI Express register must be restored first */
981 pci_restore_pcie_state(dev);
1900ca13 982 pci_restore_ats_state(dev);
b56a5a23 983
8b8c8d28
YL
984 /*
985 * The Base Address register should be programmed before the command
986 * register(s)
987 */
988 for (i = 15; i >= 0; i--) {
04d9c1a1 989 pci_read_config_dword(dev, i * 4, &val);
26f41062
KA
990 tries = 10;
991 while (tries && val != dev->saved_config_space[i]) {
85b8582d 992 dev_dbg(&dev->dev, "restoring config "
80ccba11
BH
993 "space at offset %#x (was %#x, writing %#x)\n",
994 i, val, (int)dev->saved_config_space[i]);
04d9c1a1
DJ
995 pci_write_config_dword(dev,i * 4,
996 dev->saved_config_space[i]);
26f41062
KA
997 pci_read_config_dword(dev, i * 4, &val);
998 mdelay(10);
999 tries--;
04d9c1a1
DJ
1000 }
1001 }
cc692a5f 1002 pci_restore_pcix_state(dev);
41017f0c 1003 pci_restore_msi_state(dev);
8c5cdb6a 1004 pci_restore_iov_state(dev);
8fed4b65 1005
4b77b0a2 1006 dev->state_saved = false;
1da177e4
LT
1007}
1008
ffbdd3f7
AW
1009struct pci_saved_state {
1010 u32 config_space[16];
1011 struct pci_cap_saved_data cap[0];
1012};
1013
1014/**
1015 * pci_store_saved_state - Allocate and return an opaque struct containing
1016 * the device saved state.
1017 * @dev: PCI device that we're dealing with
1018 *
1019 * Rerturn NULL if no state or error.
1020 */
1021struct pci_saved_state *pci_store_saved_state(struct pci_dev *dev)
1022{
1023 struct pci_saved_state *state;
1024 struct pci_cap_saved_state *tmp;
1025 struct pci_cap_saved_data *cap;
1026 struct hlist_node *pos;
1027 size_t size;
1028
1029 if (!dev->state_saved)
1030 return NULL;
1031
1032 size = sizeof(*state) + sizeof(struct pci_cap_saved_data);
1033
1034 hlist_for_each_entry(tmp, pos, &dev->saved_cap_space, next)
1035 size += sizeof(struct pci_cap_saved_data) + tmp->cap.size;
1036
1037 state = kzalloc(size, GFP_KERNEL);
1038 if (!state)
1039 return NULL;
1040
1041 memcpy(state->config_space, dev->saved_config_space,
1042 sizeof(state->config_space));
1043
1044 cap = state->cap;
1045 hlist_for_each_entry(tmp, pos, &dev->saved_cap_space, next) {
1046 size_t len = sizeof(struct pci_cap_saved_data) + tmp->cap.size;
1047 memcpy(cap, &tmp->cap, len);
1048 cap = (struct pci_cap_saved_data *)((u8 *)cap + len);
1049 }
1050 /* Empty cap_save terminates list */
1051
1052 return state;
1053}
1054EXPORT_SYMBOL_GPL(pci_store_saved_state);
1055
1056/**
1057 * pci_load_saved_state - Reload the provided save state into struct pci_dev.
1058 * @dev: PCI device that we're dealing with
1059 * @state: Saved state returned from pci_store_saved_state()
1060 */
1061int pci_load_saved_state(struct pci_dev *dev, struct pci_saved_state *state)
1062{
1063 struct pci_cap_saved_data *cap;
1064
1065 dev->state_saved = false;
1066
1067 if (!state)
1068 return 0;
1069
1070 memcpy(dev->saved_config_space, state->config_space,
1071 sizeof(state->config_space));
1072
1073 cap = state->cap;
1074 while (cap->size) {
1075 struct pci_cap_saved_state *tmp;
1076
1077 tmp = pci_find_saved_cap(dev, cap->cap_nr);
1078 if (!tmp || tmp->cap.size != cap->size)
1079 return -EINVAL;
1080
1081 memcpy(tmp->cap.data, cap->data, tmp->cap.size);
1082 cap = (struct pci_cap_saved_data *)((u8 *)cap +
1083 sizeof(struct pci_cap_saved_data) + cap->size);
1084 }
1085
1086 dev->state_saved = true;
1087 return 0;
1088}
1089EXPORT_SYMBOL_GPL(pci_load_saved_state);
1090
1091/**
1092 * pci_load_and_free_saved_state - Reload the save state pointed to by state,
1093 * and free the memory allocated for it.
1094 * @dev: PCI device that we're dealing with
1095 * @state: Pointer to saved state returned from pci_store_saved_state()
1096 */
1097int pci_load_and_free_saved_state(struct pci_dev *dev,
1098 struct pci_saved_state **state)
1099{
1100 int ret = pci_load_saved_state(dev, *state);
1101 kfree(*state);
1102 *state = NULL;
1103 return ret;
1104}
1105EXPORT_SYMBOL_GPL(pci_load_and_free_saved_state);
1106
38cc1302
HS
1107static int do_pci_enable_device(struct pci_dev *dev, int bars)
1108{
1109 int err;
1110
1111 err = pci_set_power_state(dev, PCI_D0);
1112 if (err < 0 && err != -EIO)
1113 return err;
1114 err = pcibios_enable_device(dev, bars);
1115 if (err < 0)
1116 return err;
1117 pci_fixup_device(pci_fixup_enable, dev);
1118
1119 return 0;
1120}
1121
1122/**
0b62e13b 1123 * pci_reenable_device - Resume abandoned device
38cc1302
HS
1124 * @dev: PCI device to be resumed
1125 *
1126 * Note this function is a backend of pci_default_resume and is not supposed
1127 * to be called by normal code, write proper resume handler and use it instead.
1128 */
0b62e13b 1129int pci_reenable_device(struct pci_dev *dev)
38cc1302 1130{
296ccb08 1131 if (pci_is_enabled(dev))
38cc1302
HS
1132 return do_pci_enable_device(dev, (1 << PCI_NUM_RESOURCES) - 1);
1133 return 0;
1134}
1135
b718989d
BH
1136static int __pci_enable_device_flags(struct pci_dev *dev,
1137 resource_size_t flags)
1da177e4
LT
1138{
1139 int err;
b718989d 1140 int i, bars = 0;
1da177e4 1141
97c145f7
JB
1142 /*
1143 * Power state could be unknown at this point, either due to a fresh
1144 * boot or a device removal call. So get the current power state
1145 * so that things like MSI message writing will behave as expected
1146 * (e.g. if the device really is in D0 at enable time).
1147 */
1148 if (dev->pm_cap) {
1149 u16 pmcsr;
1150 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
1151 dev->current_state = (pmcsr & PCI_PM_CTRL_STATE_MASK);
1152 }
1153
9fb625c3
HS
1154 if (atomic_add_return(1, &dev->enable_cnt) > 1)
1155 return 0; /* already enabled */
1156
497f16f2
YL
1157 /* only skip sriov related */
1158 for (i = 0; i <= PCI_ROM_RESOURCE; i++)
1159 if (dev->resource[i].flags & flags)
1160 bars |= (1 << i);
1161 for (i = PCI_BRIDGE_RESOURCES; i < DEVICE_COUNT_RESOURCE; i++)
b718989d
BH
1162 if (dev->resource[i].flags & flags)
1163 bars |= (1 << i);
1164
38cc1302 1165 err = do_pci_enable_device(dev, bars);
95a62965 1166 if (err < 0)
38cc1302 1167 atomic_dec(&dev->enable_cnt);
9fb625c3 1168 return err;
1da177e4
LT
1169}
1170
b718989d
BH
1171/**
1172 * pci_enable_device_io - Initialize a device for use with IO space
1173 * @dev: PCI device to be initialized
1174 *
1175 * Initialize device before it's used by a driver. Ask low-level code
1176 * to enable I/O resources. Wake up the device if it was suspended.
1177 * Beware, this function can fail.
1178 */
1179int pci_enable_device_io(struct pci_dev *dev)
1180{
1181 return __pci_enable_device_flags(dev, IORESOURCE_IO);
1182}
1183
1184/**
1185 * pci_enable_device_mem - Initialize a device for use with Memory space
1186 * @dev: PCI device to be initialized
1187 *
1188 * Initialize device before it's used by a driver. Ask low-level code
1189 * to enable Memory resources. Wake up the device if it was suspended.
1190 * Beware, this function can fail.
1191 */
1192int pci_enable_device_mem(struct pci_dev *dev)
1193{
1194 return __pci_enable_device_flags(dev, IORESOURCE_MEM);
1195}
1196
bae94d02
IPG
1197/**
1198 * pci_enable_device - Initialize device before it's used by a driver.
1199 * @dev: PCI device to be initialized
1200 *
1201 * Initialize device before it's used by a driver. Ask low-level code
1202 * to enable I/O and memory. Wake up the device if it was suspended.
1203 * Beware, this function can fail.
1204 *
1205 * Note we don't actually enable the device many times if we call
1206 * this function repeatedly (we just increment the count).
1207 */
1208int pci_enable_device(struct pci_dev *dev)
1209{
b718989d 1210 return __pci_enable_device_flags(dev, IORESOURCE_MEM | IORESOURCE_IO);
bae94d02
IPG
1211}
1212
9ac7849e
TH
1213/*
1214 * Managed PCI resources. This manages device on/off, intx/msi/msix
1215 * on/off and BAR regions. pci_dev itself records msi/msix status, so
1216 * there's no need to track it separately. pci_devres is initialized
1217 * when a device is enabled using managed PCI device enable interface.
1218 */
1219struct pci_devres {
7f375f32
TH
1220 unsigned int enabled:1;
1221 unsigned int pinned:1;
9ac7849e
TH
1222 unsigned int orig_intx:1;
1223 unsigned int restore_intx:1;
1224 u32 region_mask;
1225};
1226
1227static void pcim_release(struct device *gendev, void *res)
1228{
1229 struct pci_dev *dev = container_of(gendev, struct pci_dev, dev);
1230 struct pci_devres *this = res;
1231 int i;
1232
1233 if (dev->msi_enabled)
1234 pci_disable_msi(dev);
1235 if (dev->msix_enabled)
1236 pci_disable_msix(dev);
1237
1238 for (i = 0; i < DEVICE_COUNT_RESOURCE; i++)
1239 if (this->region_mask & (1 << i))
1240 pci_release_region(dev, i);
1241
1242 if (this->restore_intx)
1243 pci_intx(dev, this->orig_intx);
1244
7f375f32 1245 if (this->enabled && !this->pinned)
9ac7849e
TH
1246 pci_disable_device(dev);
1247}
1248
1249static struct pci_devres * get_pci_dr(struct pci_dev *pdev)
1250{
1251 struct pci_devres *dr, *new_dr;
1252
1253 dr = devres_find(&pdev->dev, pcim_release, NULL, NULL);
1254 if (dr)
1255 return dr;
1256
1257 new_dr = devres_alloc(pcim_release, sizeof(*new_dr), GFP_KERNEL);
1258 if (!new_dr)
1259 return NULL;
1260 return devres_get(&pdev->dev, new_dr, NULL, NULL);
1261}
1262
1263static struct pci_devres * find_pci_dr(struct pci_dev *pdev)
1264{
1265 if (pci_is_managed(pdev))
1266 return devres_find(&pdev->dev, pcim_release, NULL, NULL);
1267 return NULL;
1268}
1269
1270/**
1271 * pcim_enable_device - Managed pci_enable_device()
1272 * @pdev: PCI device to be initialized
1273 *
1274 * Managed pci_enable_device().
1275 */
1276int pcim_enable_device(struct pci_dev *pdev)
1277{
1278 struct pci_devres *dr;
1279 int rc;
1280
1281 dr = get_pci_dr(pdev);
1282 if (unlikely(!dr))
1283 return -ENOMEM;
b95d58ea
TH
1284 if (dr->enabled)
1285 return 0;
9ac7849e
TH
1286
1287 rc = pci_enable_device(pdev);
1288 if (!rc) {
1289 pdev->is_managed = 1;
7f375f32 1290 dr->enabled = 1;
9ac7849e
TH
1291 }
1292 return rc;
1293}
1294
1295/**
1296 * pcim_pin_device - Pin managed PCI device
1297 * @pdev: PCI device to pin
1298 *
1299 * Pin managed PCI device @pdev. Pinned device won't be disabled on
1300 * driver detach. @pdev must have been enabled with
1301 * pcim_enable_device().
1302 */
1303void pcim_pin_device(struct pci_dev *pdev)
1304{
1305 struct pci_devres *dr;
1306
1307 dr = find_pci_dr(pdev);
7f375f32 1308 WARN_ON(!dr || !dr->enabled);
9ac7849e 1309 if (dr)
7f375f32 1310 dr->pinned = 1;
9ac7849e
TH
1311}
1312
1da177e4
LT
1313/**
1314 * pcibios_disable_device - disable arch specific PCI resources for device dev
1315 * @dev: the PCI device to disable
1316 *
1317 * Disables architecture specific PCI resources for the device. This
1318 * is the default implementation. Architecture implementations can
1319 * override this.
1320 */
1321void __attribute__ ((weak)) pcibios_disable_device (struct pci_dev *dev) {}
1322
fa58d305
RW
1323static void do_pci_disable_device(struct pci_dev *dev)
1324{
1325 u16 pci_command;
1326
1327 pci_read_config_word(dev, PCI_COMMAND, &pci_command);
1328 if (pci_command & PCI_COMMAND_MASTER) {
1329 pci_command &= ~PCI_COMMAND_MASTER;
1330 pci_write_config_word(dev, PCI_COMMAND, pci_command);
1331 }
1332
1333 pcibios_disable_device(dev);
1334}
1335
1336/**
1337 * pci_disable_enabled_device - Disable device without updating enable_cnt
1338 * @dev: PCI device to disable
1339 *
1340 * NOTE: This function is a backend of PCI power management routines and is
1341 * not supposed to be called drivers.
1342 */
1343void pci_disable_enabled_device(struct pci_dev *dev)
1344{
296ccb08 1345 if (pci_is_enabled(dev))
fa58d305
RW
1346 do_pci_disable_device(dev);
1347}
1348
1da177e4
LT
1349/**
1350 * pci_disable_device - Disable PCI device after use
1351 * @dev: PCI device to be disabled
1352 *
1353 * Signal to the system that the PCI device is not in use by the system
1354 * anymore. This only involves disabling PCI bus-mastering, if active.
bae94d02
IPG
1355 *
1356 * Note we don't actually disable the device until all callers of
ee6583f6 1357 * pci_enable_device() have called pci_disable_device().
1da177e4
LT
1358 */
1359void
1360pci_disable_device(struct pci_dev *dev)
1361{
9ac7849e 1362 struct pci_devres *dr;
99dc804d 1363
9ac7849e
TH
1364 dr = find_pci_dr(dev);
1365 if (dr)
7f375f32 1366 dr->enabled = 0;
9ac7849e 1367
bae94d02
IPG
1368 if (atomic_sub_return(1, &dev->enable_cnt) != 0)
1369 return;
1370
fa58d305 1371 do_pci_disable_device(dev);
1da177e4 1372
fa58d305 1373 dev->is_busmaster = 0;
1da177e4
LT
1374}
1375
f7bdd12d
BK
1376/**
1377 * pcibios_set_pcie_reset_state - set reset state for device dev
45e829ea 1378 * @dev: the PCIe device reset
f7bdd12d
BK
1379 * @state: Reset state to enter into
1380 *
1381 *
45e829ea 1382 * Sets the PCIe reset state for the device. This is the default
f7bdd12d
BK
1383 * implementation. Architecture implementations can override this.
1384 */
1385int __attribute__ ((weak)) pcibios_set_pcie_reset_state(struct pci_dev *dev,
1386 enum pcie_reset_state state)
1387{
1388 return -EINVAL;
1389}
1390
1391/**
1392 * pci_set_pcie_reset_state - set reset state for device dev
45e829ea 1393 * @dev: the PCIe device reset
f7bdd12d
BK
1394 * @state: Reset state to enter into
1395 *
1396 *
1397 * Sets the PCI reset state for the device.
1398 */
1399int pci_set_pcie_reset_state(struct pci_dev *dev, enum pcie_reset_state state)
1400{
1401 return pcibios_set_pcie_reset_state(dev, state);
1402}
1403
58ff4633
RW
1404/**
1405 * pci_check_pme_status - Check if given device has generated PME.
1406 * @dev: Device to check.
1407 *
1408 * Check the PME status of the device and if set, clear it and clear PME enable
1409 * (if set). Return 'true' if PME status and PME enable were both set or
1410 * 'false' otherwise.
1411 */
1412bool pci_check_pme_status(struct pci_dev *dev)
1413{
1414 int pmcsr_pos;
1415 u16 pmcsr;
1416 bool ret = false;
1417
1418 if (!dev->pm_cap)
1419 return false;
1420
1421 pmcsr_pos = dev->pm_cap + PCI_PM_CTRL;
1422 pci_read_config_word(dev, pmcsr_pos, &pmcsr);
1423 if (!(pmcsr & PCI_PM_CTRL_PME_STATUS))
1424 return false;
1425
1426 /* Clear PME status. */
1427 pmcsr |= PCI_PM_CTRL_PME_STATUS;
1428 if (pmcsr & PCI_PM_CTRL_PME_ENABLE) {
1429 /* Disable PME to avoid interrupt flood. */
1430 pmcsr &= ~PCI_PM_CTRL_PME_ENABLE;
1431 ret = true;
1432 }
1433
1434 pci_write_config_word(dev, pmcsr_pos, pmcsr);
1435
1436 return ret;
1437}
1438
b67ea761
RW
1439/**
1440 * pci_pme_wakeup - Wake up a PCI device if its PME Status bit is set.
1441 * @dev: Device to handle.
379021d5 1442 * @pme_poll_reset: Whether or not to reset the device's pme_poll flag.
b67ea761
RW
1443 *
1444 * Check if @dev has generated PME and queue a resume request for it in that
1445 * case.
1446 */
379021d5 1447static int pci_pme_wakeup(struct pci_dev *dev, void *pme_poll_reset)
b67ea761 1448{
379021d5
RW
1449 if (pme_poll_reset && dev->pme_poll)
1450 dev->pme_poll = false;
1451
c125e96f 1452 if (pci_check_pme_status(dev)) {
c125e96f 1453 pci_wakeup_event(dev);
0f953bf6 1454 pm_request_resume(&dev->dev);
c125e96f 1455 }
b67ea761
RW
1456 return 0;
1457}
1458
1459/**
1460 * pci_pme_wakeup_bus - Walk given bus and wake up devices on it, if necessary.
1461 * @bus: Top bus of the subtree to walk.
1462 */
1463void pci_pme_wakeup_bus(struct pci_bus *bus)
1464{
1465 if (bus)
379021d5 1466 pci_walk_bus(bus, pci_pme_wakeup, (void *)true);
b67ea761
RW
1467}
1468
eb9d0fe4
RW
1469/**
1470 * pci_pme_capable - check the capability of PCI device to generate PME#
1471 * @dev: PCI device to handle.
eb9d0fe4
RW
1472 * @state: PCI state from which device will issue PME#.
1473 */
e5899e1b 1474bool pci_pme_capable(struct pci_dev *dev, pci_power_t state)
eb9d0fe4 1475{
337001b6 1476 if (!dev->pm_cap)
eb9d0fe4
RW
1477 return false;
1478
337001b6 1479 return !!(dev->pme_support & (1 << state));
eb9d0fe4
RW
1480}
1481
df17e62e
MG
1482static void pci_pme_list_scan(struct work_struct *work)
1483{
379021d5 1484 struct pci_pme_device *pme_dev, *n;
df17e62e
MG
1485
1486 mutex_lock(&pci_pme_list_mutex);
1487 if (!list_empty(&pci_pme_list)) {
379021d5
RW
1488 list_for_each_entry_safe(pme_dev, n, &pci_pme_list, list) {
1489 if (pme_dev->dev->pme_poll) {
1490 pci_pme_wakeup(pme_dev->dev, NULL);
1491 } else {
1492 list_del(&pme_dev->list);
1493 kfree(pme_dev);
1494 }
1495 }
1496 if (!list_empty(&pci_pme_list))
1497 schedule_delayed_work(&pci_pme_work,
1498 msecs_to_jiffies(PME_TIMEOUT));
df17e62e
MG
1499 }
1500 mutex_unlock(&pci_pme_list_mutex);
1501}
1502
eb9d0fe4
RW
1503/**
1504 * pci_pme_active - enable or disable PCI device's PME# function
1505 * @dev: PCI device to handle.
eb9d0fe4
RW
1506 * @enable: 'true' to enable PME# generation; 'false' to disable it.
1507 *
1508 * The caller must verify that the device is capable of generating PME# before
1509 * calling this function with @enable equal to 'true'.
1510 */
5a6c9b60 1511void pci_pme_active(struct pci_dev *dev, bool enable)
eb9d0fe4
RW
1512{
1513 u16 pmcsr;
1514
337001b6 1515 if (!dev->pm_cap)
eb9d0fe4
RW
1516 return;
1517
337001b6 1518 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
eb9d0fe4
RW
1519 /* Clear PME_Status by writing 1 to it and enable PME# */
1520 pmcsr |= PCI_PM_CTRL_PME_STATUS | PCI_PM_CTRL_PME_ENABLE;
1521 if (!enable)
1522 pmcsr &= ~PCI_PM_CTRL_PME_ENABLE;
1523
337001b6 1524 pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, pmcsr);
eb9d0fe4 1525
df17e62e
MG
1526 /* PCI (as opposed to PCIe) PME requires that the device have
1527 its PME# line hooked up correctly. Not all hardware vendors
1528 do this, so the PME never gets delivered and the device
1529 remains asleep. The easiest way around this is to
1530 periodically walk the list of suspended devices and check
1531 whether any have their PME flag set. The assumption is that
1532 we'll wake up often enough anyway that this won't be a huge
1533 hit, and the power savings from the devices will still be a
1534 win. */
1535
379021d5 1536 if (dev->pme_poll) {
df17e62e
MG
1537 struct pci_pme_device *pme_dev;
1538 if (enable) {
1539 pme_dev = kmalloc(sizeof(struct pci_pme_device),
1540 GFP_KERNEL);
1541 if (!pme_dev)
1542 goto out;
1543 pme_dev->dev = dev;
1544 mutex_lock(&pci_pme_list_mutex);
1545 list_add(&pme_dev->list, &pci_pme_list);
1546 if (list_is_singular(&pci_pme_list))
1547 schedule_delayed_work(&pci_pme_work,
1548 msecs_to_jiffies(PME_TIMEOUT));
1549 mutex_unlock(&pci_pme_list_mutex);
1550 } else {
1551 mutex_lock(&pci_pme_list_mutex);
1552 list_for_each_entry(pme_dev, &pci_pme_list, list) {
1553 if (pme_dev->dev == dev) {
1554 list_del(&pme_dev->list);
1555 kfree(pme_dev);
1556 break;
1557 }
1558 }
1559 mutex_unlock(&pci_pme_list_mutex);
1560 }
1561 }
1562
1563out:
85b8582d 1564 dev_dbg(&dev->dev, "PME# %s\n", enable ? "enabled" : "disabled");
eb9d0fe4
RW
1565}
1566
1da177e4 1567/**
6cbf8214 1568 * __pci_enable_wake - enable PCI device as wakeup event source
075c1771
DB
1569 * @dev: PCI device affected
1570 * @state: PCI state from which device will issue wakeup events
6cbf8214 1571 * @runtime: True if the events are to be generated at run time
075c1771
DB
1572 * @enable: True to enable event generation; false to disable
1573 *
1574 * This enables the device as a wakeup event source, or disables it.
1575 * When such events involves platform-specific hooks, those hooks are
1576 * called automatically by this routine.
1577 *
1578 * Devices with legacy power management (no standard PCI PM capabilities)
eb9d0fe4 1579 * always require such platform hooks.
075c1771 1580 *
eb9d0fe4
RW
1581 * RETURN VALUE:
1582 * 0 is returned on success
1583 * -EINVAL is returned if device is not supposed to wake up the system
1584 * Error code depending on the platform is returned if both the platform and
1585 * the native mechanism fail to enable the generation of wake-up events
1da177e4 1586 */
6cbf8214
RW
1587int __pci_enable_wake(struct pci_dev *dev, pci_power_t state,
1588 bool runtime, bool enable)
1da177e4 1589{
5bcc2fb4 1590 int ret = 0;
075c1771 1591
6cbf8214 1592 if (enable && !runtime && !device_may_wakeup(&dev->dev))
eb9d0fe4 1593 return -EINVAL;
1da177e4 1594
e80bb09d
RW
1595 /* Don't do the same thing twice in a row for one device. */
1596 if (!!enable == !!dev->wakeup_prepared)
1597 return 0;
1598
eb9d0fe4
RW
1599 /*
1600 * According to "PCI System Architecture" 4th ed. by Tom Shanley & Don
1601 * Anderson we should be doing PME# wake enable followed by ACPI wake
1602 * enable. To disable wake-up we call the platform first, for symmetry.
075c1771 1603 */
1da177e4 1604
5bcc2fb4
RW
1605 if (enable) {
1606 int error;
1da177e4 1607
5bcc2fb4
RW
1608 if (pci_pme_capable(dev, state))
1609 pci_pme_active(dev, true);
1610 else
1611 ret = 1;
6cbf8214
RW
1612 error = runtime ? platform_pci_run_wake(dev, true) :
1613 platform_pci_sleep_wake(dev, true);
5bcc2fb4
RW
1614 if (ret)
1615 ret = error;
e80bb09d
RW
1616 if (!ret)
1617 dev->wakeup_prepared = true;
5bcc2fb4 1618 } else {
6cbf8214
RW
1619 if (runtime)
1620 platform_pci_run_wake(dev, false);
1621 else
1622 platform_pci_sleep_wake(dev, false);
5bcc2fb4 1623 pci_pme_active(dev, false);
e80bb09d 1624 dev->wakeup_prepared = false;
5bcc2fb4 1625 }
1da177e4 1626
5bcc2fb4 1627 return ret;
eb9d0fe4 1628}
6cbf8214 1629EXPORT_SYMBOL(__pci_enable_wake);
1da177e4 1630
0235c4fc
RW
1631/**
1632 * pci_wake_from_d3 - enable/disable device to wake up from D3_hot or D3_cold
1633 * @dev: PCI device to prepare
1634 * @enable: True to enable wake-up event generation; false to disable
1635 *
1636 * Many drivers want the device to wake up the system from D3_hot or D3_cold
1637 * and this function allows them to set that up cleanly - pci_enable_wake()
1638 * should not be called twice in a row to enable wake-up due to PCI PM vs ACPI
1639 * ordering constraints.
1640 *
1641 * This function only returns error code if the device is not capable of
1642 * generating PME# from both D3_hot and D3_cold, and the platform is unable to
1643 * enable wake-up power for it.
1644 */
1645int pci_wake_from_d3(struct pci_dev *dev, bool enable)
1646{
1647 return pci_pme_capable(dev, PCI_D3cold) ?
1648 pci_enable_wake(dev, PCI_D3cold, enable) :
1649 pci_enable_wake(dev, PCI_D3hot, enable);
1650}
1651
404cc2d8 1652/**
37139074
JB
1653 * pci_target_state - find an appropriate low power state for a given PCI dev
1654 * @dev: PCI device
1655 *
1656 * Use underlying platform code to find a supported low power state for @dev.
1657 * If the platform can't manage @dev, return the deepest state from which it
1658 * can generate wake events, based on any available PME info.
404cc2d8 1659 */
e5899e1b 1660pci_power_t pci_target_state(struct pci_dev *dev)
404cc2d8
RW
1661{
1662 pci_power_t target_state = PCI_D3hot;
404cc2d8
RW
1663
1664 if (platform_pci_power_manageable(dev)) {
1665 /*
1666 * Call the platform to choose the target state of the device
1667 * and enable wake-up from this state if supported.
1668 */
1669 pci_power_t state = platform_pci_choose_state(dev);
1670
1671 switch (state) {
1672 case PCI_POWER_ERROR:
1673 case PCI_UNKNOWN:
1674 break;
1675 case PCI_D1:
1676 case PCI_D2:
1677 if (pci_no_d1d2(dev))
1678 break;
1679 default:
1680 target_state = state;
404cc2d8 1681 }
d2abdf62
RW
1682 } else if (!dev->pm_cap) {
1683 target_state = PCI_D0;
404cc2d8
RW
1684 } else if (device_may_wakeup(&dev->dev)) {
1685 /*
1686 * Find the deepest state from which the device can generate
1687 * wake-up events, make it the target state and enable device
1688 * to generate PME#.
1689 */
337001b6
RW
1690 if (dev->pme_support) {
1691 while (target_state
1692 && !(dev->pme_support & (1 << target_state)))
1693 target_state--;
404cc2d8
RW
1694 }
1695 }
1696
e5899e1b
RW
1697 return target_state;
1698}
1699
1700/**
1701 * pci_prepare_to_sleep - prepare PCI device for system-wide transition into a sleep state
1702 * @dev: Device to handle.
1703 *
1704 * Choose the power state appropriate for the device depending on whether
1705 * it can wake up the system and/or is power manageable by the platform
1706 * (PCI_D3hot is the default) and put the device into that state.
1707 */
1708int pci_prepare_to_sleep(struct pci_dev *dev)
1709{
1710 pci_power_t target_state = pci_target_state(dev);
1711 int error;
1712
1713 if (target_state == PCI_POWER_ERROR)
1714 return -EIO;
1715
8efb8c76 1716 pci_enable_wake(dev, target_state, device_may_wakeup(&dev->dev));
c157dfa3 1717
404cc2d8
RW
1718 error = pci_set_power_state(dev, target_state);
1719
1720 if (error)
1721 pci_enable_wake(dev, target_state, false);
1722
1723 return error;
1724}
1725
1726/**
443bd1c4 1727 * pci_back_from_sleep - turn PCI device on during system-wide transition into working state
404cc2d8
RW
1728 * @dev: Device to handle.
1729 *
88393161 1730 * Disable device's system wake-up capability and put it into D0.
404cc2d8
RW
1731 */
1732int pci_back_from_sleep(struct pci_dev *dev)
1733{
1734 pci_enable_wake(dev, PCI_D0, false);
1735 return pci_set_power_state(dev, PCI_D0);
1736}
1737
6cbf8214
RW
1738/**
1739 * pci_finish_runtime_suspend - Carry out PCI-specific part of runtime suspend.
1740 * @dev: PCI device being suspended.
1741 *
1742 * Prepare @dev to generate wake-up events at run time and put it into a low
1743 * power state.
1744 */
1745int pci_finish_runtime_suspend(struct pci_dev *dev)
1746{
1747 pci_power_t target_state = pci_target_state(dev);
1748 int error;
1749
1750 if (target_state == PCI_POWER_ERROR)
1751 return -EIO;
1752
1753 __pci_enable_wake(dev, target_state, true, pci_dev_run_wake(dev));
1754
1755 error = pci_set_power_state(dev, target_state);
1756
1757 if (error)
1758 __pci_enable_wake(dev, target_state, true, false);
1759
1760 return error;
1761}
1762
b67ea761
RW
1763/**
1764 * pci_dev_run_wake - Check if device can generate run-time wake-up events.
1765 * @dev: Device to check.
1766 *
1767 * Return true if the device itself is cabable of generating wake-up events
1768 * (through the platform or using the native PCIe PME) or if the device supports
1769 * PME and one of its upstream bridges can generate wake-up events.
1770 */
1771bool pci_dev_run_wake(struct pci_dev *dev)
1772{
1773 struct pci_bus *bus = dev->bus;
1774
1775 if (device_run_wake(&dev->dev))
1776 return true;
1777
1778 if (!dev->pme_support)
1779 return false;
1780
1781 while (bus->parent) {
1782 struct pci_dev *bridge = bus->self;
1783
1784 if (device_run_wake(&bridge->dev))
1785 return true;
1786
1787 bus = bus->parent;
1788 }
1789
1790 /* We have reached the root bus. */
1791 if (bus->bridge)
1792 return device_run_wake(bus->bridge);
1793
1794 return false;
1795}
1796EXPORT_SYMBOL_GPL(pci_dev_run_wake);
1797
eb9d0fe4
RW
1798/**
1799 * pci_pm_init - Initialize PM functions of given PCI device
1800 * @dev: PCI device to handle.
1801 */
1802void pci_pm_init(struct pci_dev *dev)
1803{
1804 int pm;
1805 u16 pmc;
1da177e4 1806
bb910a70 1807 pm_runtime_forbid(&dev->dev);
a1e4d72c 1808 device_enable_async_suspend(&dev->dev);
e80bb09d 1809 dev->wakeup_prepared = false;
bb910a70 1810
337001b6
RW
1811 dev->pm_cap = 0;
1812
eb9d0fe4
RW
1813 /* find PCI PM capability in list */
1814 pm = pci_find_capability(dev, PCI_CAP_ID_PM);
1815 if (!pm)
50246dd4 1816 return;
eb9d0fe4
RW
1817 /* Check device's ability to generate PME# */
1818 pci_read_config_word(dev, pm + PCI_PM_PMC, &pmc);
075c1771 1819
eb9d0fe4
RW
1820 if ((pmc & PCI_PM_CAP_VER_MASK) > 3) {
1821 dev_err(&dev->dev, "unsupported PM cap regs version (%u)\n",
1822 pmc & PCI_PM_CAP_VER_MASK);
50246dd4 1823 return;
eb9d0fe4
RW
1824 }
1825
337001b6 1826 dev->pm_cap = pm;
1ae861e6 1827 dev->d3_delay = PCI_PM_D3_WAIT;
337001b6
RW
1828
1829 dev->d1_support = false;
1830 dev->d2_support = false;
1831 if (!pci_no_d1d2(dev)) {
c9ed77ee 1832 if (pmc & PCI_PM_CAP_D1)
337001b6 1833 dev->d1_support = true;
c9ed77ee 1834 if (pmc & PCI_PM_CAP_D2)
337001b6 1835 dev->d2_support = true;
c9ed77ee
BH
1836
1837 if (dev->d1_support || dev->d2_support)
1838 dev_printk(KERN_DEBUG, &dev->dev, "supports%s%s\n",
ec84f126
JB
1839 dev->d1_support ? " D1" : "",
1840 dev->d2_support ? " D2" : "");
337001b6
RW
1841 }
1842
1843 pmc &= PCI_PM_CAP_PME_MASK;
1844 if (pmc) {
10c3d71d
BH
1845 dev_printk(KERN_DEBUG, &dev->dev,
1846 "PME# supported from%s%s%s%s%s\n",
c9ed77ee
BH
1847 (pmc & PCI_PM_CAP_PME_D0) ? " D0" : "",
1848 (pmc & PCI_PM_CAP_PME_D1) ? " D1" : "",
1849 (pmc & PCI_PM_CAP_PME_D2) ? " D2" : "",
1850 (pmc & PCI_PM_CAP_PME_D3) ? " D3hot" : "",
1851 (pmc & PCI_PM_CAP_PME_D3cold) ? " D3cold" : "");
337001b6 1852 dev->pme_support = pmc >> PCI_PM_CAP_PME_SHIFT;
379021d5 1853 dev->pme_poll = true;
eb9d0fe4
RW
1854 /*
1855 * Make device's PM flags reflect the wake-up capability, but
1856 * let the user space enable it to wake up the system as needed.
1857 */
1858 device_set_wakeup_capable(&dev->dev, true);
eb9d0fe4 1859 /* Disable the PME# generation functionality */
337001b6
RW
1860 pci_pme_active(dev, false);
1861 } else {
1862 dev->pme_support = 0;
eb9d0fe4 1863 }
1da177e4
LT
1864}
1865
eb9c39d0
JB
1866/**
1867 * platform_pci_wakeup_init - init platform wakeup if present
1868 * @dev: PCI device
1869 *
1870 * Some devices don't have PCI PM caps but can still generate wakeup
1871 * events through platform methods (like ACPI events). If @dev supports
1872 * platform wakeup events, set the device flag to indicate as much. This
1873 * may be redundant if the device also supports PCI PM caps, but double
1874 * initialization should be safe in that case.
1875 */
1876void platform_pci_wakeup_init(struct pci_dev *dev)
1877{
1878 if (!platform_pci_can_wakeup(dev))
1879 return;
1880
1881 device_set_wakeup_capable(&dev->dev, true);
eb9c39d0
JB
1882 platform_pci_sleep_wake(dev, false);
1883}
1884
34a4876e
YL
1885static void pci_add_saved_cap(struct pci_dev *pci_dev,
1886 struct pci_cap_saved_state *new_cap)
1887{
1888 hlist_add_head(&new_cap->next, &pci_dev->saved_cap_space);
1889}
1890
63f4898a
RW
1891/**
1892 * pci_add_save_buffer - allocate buffer for saving given capability registers
1893 * @dev: the PCI device
1894 * @cap: the capability to allocate the buffer for
1895 * @size: requested size of the buffer
1896 */
1897static int pci_add_cap_save_buffer(
1898 struct pci_dev *dev, char cap, unsigned int size)
1899{
1900 int pos;
1901 struct pci_cap_saved_state *save_state;
1902
1903 pos = pci_find_capability(dev, cap);
1904 if (pos <= 0)
1905 return 0;
1906
1907 save_state = kzalloc(sizeof(*save_state) + size, GFP_KERNEL);
1908 if (!save_state)
1909 return -ENOMEM;
1910
24a4742f
AW
1911 save_state->cap.cap_nr = cap;
1912 save_state->cap.size = size;
63f4898a
RW
1913 pci_add_saved_cap(dev, save_state);
1914
1915 return 0;
1916}
1917
1918/**
1919 * pci_allocate_cap_save_buffers - allocate buffers for saving capabilities
1920 * @dev: the PCI device
1921 */
1922void pci_allocate_cap_save_buffers(struct pci_dev *dev)
1923{
1924 int error;
1925
89858517
YZ
1926 error = pci_add_cap_save_buffer(dev, PCI_CAP_ID_EXP,
1927 PCI_EXP_SAVE_REGS * sizeof(u16));
63f4898a
RW
1928 if (error)
1929 dev_err(&dev->dev,
1930 "unable to preallocate PCI Express save buffer\n");
1931
1932 error = pci_add_cap_save_buffer(dev, PCI_CAP_ID_PCIX, sizeof(u16));
1933 if (error)
1934 dev_err(&dev->dev,
1935 "unable to preallocate PCI-X save buffer\n");
1936}
1937
f796841e
YL
1938void pci_free_cap_save_buffers(struct pci_dev *dev)
1939{
1940 struct pci_cap_saved_state *tmp;
1941 struct hlist_node *pos, *n;
1942
1943 hlist_for_each_entry_safe(tmp, pos, n, &dev->saved_cap_space, next)
1944 kfree(tmp);
1945}
1946
58c3a727
YZ
1947/**
1948 * pci_enable_ari - enable ARI forwarding if hardware support it
1949 * @dev: the PCI device
1950 */
1951void pci_enable_ari(struct pci_dev *dev)
1952{
1953 int pos;
1954 u32 cap;
864d296c 1955 u16 flags, ctrl;
8113587c 1956 struct pci_dev *bridge;
58c3a727 1957
5f4d91a1 1958 if (!pci_is_pcie(dev) || dev->devfn)
58c3a727
YZ
1959 return;
1960
8113587c
ZY
1961 pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_ARI);
1962 if (!pos)
58c3a727
YZ
1963 return;
1964
8113587c 1965 bridge = dev->bus->self;
5f4d91a1 1966 if (!bridge || !pci_is_pcie(bridge))
8113587c
ZY
1967 return;
1968
06a1cbaf 1969 pos = pci_pcie_cap(bridge);
58c3a727
YZ
1970 if (!pos)
1971 return;
1972
864d296c
CW
1973 /* ARI is a PCIe v2 feature */
1974 pci_read_config_word(bridge, pos + PCI_EXP_FLAGS, &flags);
1975 if ((flags & PCI_EXP_FLAGS_VERS) < 2)
1976 return;
1977
8113587c 1978 pci_read_config_dword(bridge, pos + PCI_EXP_DEVCAP2, &cap);
58c3a727
YZ
1979 if (!(cap & PCI_EXP_DEVCAP2_ARI))
1980 return;
1981
8113587c 1982 pci_read_config_word(bridge, pos + PCI_EXP_DEVCTL2, &ctrl);
58c3a727 1983 ctrl |= PCI_EXP_DEVCTL2_ARI;
8113587c 1984 pci_write_config_word(bridge, pos + PCI_EXP_DEVCTL2, ctrl);
58c3a727 1985
8113587c 1986 bridge->ari_enabled = 1;
58c3a727
YZ
1987}
1988
b48d4425
JB
1989/**
1990 * pci_enable_ido - enable ID-based ordering on a device
1991 * @dev: the PCI device
1992 * @type: which types of IDO to enable
1993 *
1994 * Enable ID-based ordering on @dev. @type can contain the bits
1995 * %PCI_EXP_IDO_REQUEST and/or %PCI_EXP_IDO_COMPLETION to indicate
1996 * which types of transactions are allowed to be re-ordered.
1997 */
1998void pci_enable_ido(struct pci_dev *dev, unsigned long type)
1999{
2000 int pos;
2001 u16 ctrl;
2002
2003 pos = pci_pcie_cap(dev);
2004 if (!pos)
2005 return;
2006
2007 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL2, &ctrl);
2008 if (type & PCI_EXP_IDO_REQUEST)
2009 ctrl |= PCI_EXP_IDO_REQ_EN;
2010 if (type & PCI_EXP_IDO_COMPLETION)
2011 ctrl |= PCI_EXP_IDO_CMP_EN;
2012 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL2, ctrl);
2013}
2014EXPORT_SYMBOL(pci_enable_ido);
2015
2016/**
2017 * pci_disable_ido - disable ID-based ordering on a device
2018 * @dev: the PCI device
2019 * @type: which types of IDO to disable
2020 */
2021void pci_disable_ido(struct pci_dev *dev, unsigned long type)
2022{
2023 int pos;
2024 u16 ctrl;
2025
2026 if (!pci_is_pcie(dev))
2027 return;
2028
2029 pos = pci_pcie_cap(dev);
2030 if (!pos)
2031 return;
2032
2033 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL2, &ctrl);
2034 if (type & PCI_EXP_IDO_REQUEST)
2035 ctrl &= ~PCI_EXP_IDO_REQ_EN;
2036 if (type & PCI_EXP_IDO_COMPLETION)
2037 ctrl &= ~PCI_EXP_IDO_CMP_EN;
2038 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL2, ctrl);
2039}
2040EXPORT_SYMBOL(pci_disable_ido);
2041
48a92a81
JB
2042/**
2043 * pci_enable_obff - enable optimized buffer flush/fill
2044 * @dev: PCI device
2045 * @type: type of signaling to use
2046 *
2047 * Try to enable @type OBFF signaling on @dev. It will try using WAKE#
2048 * signaling if possible, falling back to message signaling only if
2049 * WAKE# isn't supported. @type should indicate whether the PCIe link
2050 * be brought out of L0s or L1 to send the message. It should be either
2051 * %PCI_EXP_OBFF_SIGNAL_ALWAYS or %PCI_OBFF_SIGNAL_L0.
2052 *
2053 * If your device can benefit from receiving all messages, even at the
2054 * power cost of bringing the link back up from a low power state, use
2055 * %PCI_EXP_OBFF_SIGNAL_ALWAYS. Otherwise, use %PCI_OBFF_SIGNAL_L0 (the
2056 * preferred type).
2057 *
2058 * RETURNS:
2059 * Zero on success, appropriate error number on failure.
2060 */
2061int pci_enable_obff(struct pci_dev *dev, enum pci_obff_signal_type type)
2062{
2063 int pos;
2064 u32 cap;
2065 u16 ctrl;
2066 int ret;
2067
2068 if (!pci_is_pcie(dev))
2069 return -ENOTSUPP;
2070
2071 pos = pci_pcie_cap(dev);
2072 if (!pos)
2073 return -ENOTSUPP;
2074
2075 pci_read_config_dword(dev, pos + PCI_EXP_DEVCAP2, &cap);
2076 if (!(cap & PCI_EXP_OBFF_MASK))
2077 return -ENOTSUPP; /* no OBFF support at all */
2078
2079 /* Make sure the topology supports OBFF as well */
2080 if (dev->bus) {
2081 ret = pci_enable_obff(dev->bus->self, type);
2082 if (ret)
2083 return ret;
2084 }
2085
2086 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL2, &ctrl);
2087 if (cap & PCI_EXP_OBFF_WAKE)
2088 ctrl |= PCI_EXP_OBFF_WAKE_EN;
2089 else {
2090 switch (type) {
2091 case PCI_EXP_OBFF_SIGNAL_L0:
2092 if (!(ctrl & PCI_EXP_OBFF_WAKE_EN))
2093 ctrl |= PCI_EXP_OBFF_MSGA_EN;
2094 break;
2095 case PCI_EXP_OBFF_SIGNAL_ALWAYS:
2096 ctrl &= ~PCI_EXP_OBFF_WAKE_EN;
2097 ctrl |= PCI_EXP_OBFF_MSGB_EN;
2098 break;
2099 default:
2100 WARN(1, "bad OBFF signal type\n");
2101 return -ENOTSUPP;
2102 }
2103 }
2104 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL2, ctrl);
2105
2106 return 0;
2107}
2108EXPORT_SYMBOL(pci_enable_obff);
2109
2110/**
2111 * pci_disable_obff - disable optimized buffer flush/fill
2112 * @dev: PCI device
2113 *
2114 * Disable OBFF on @dev.
2115 */
2116void pci_disable_obff(struct pci_dev *dev)
2117{
2118 int pos;
2119 u16 ctrl;
2120
2121 if (!pci_is_pcie(dev))
2122 return;
2123
2124 pos = pci_pcie_cap(dev);
2125 if (!pos)
2126 return;
2127
2128 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL2, &ctrl);
2129 ctrl &= ~PCI_EXP_OBFF_WAKE_EN;
2130 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL2, ctrl);
2131}
2132EXPORT_SYMBOL(pci_disable_obff);
2133
51c2e0a7
JB
2134/**
2135 * pci_ltr_supported - check whether a device supports LTR
2136 * @dev: PCI device
2137 *
2138 * RETURNS:
2139 * True if @dev supports latency tolerance reporting, false otherwise.
2140 */
2141bool pci_ltr_supported(struct pci_dev *dev)
2142{
2143 int pos;
2144 u32 cap;
2145
2146 if (!pci_is_pcie(dev))
2147 return false;
2148
2149 pos = pci_pcie_cap(dev);
2150 if (!pos)
2151 return false;
2152
2153 pci_read_config_dword(dev, pos + PCI_EXP_DEVCAP2, &cap);
2154
2155 return cap & PCI_EXP_DEVCAP2_LTR;
2156}
2157EXPORT_SYMBOL(pci_ltr_supported);
2158
2159/**
2160 * pci_enable_ltr - enable latency tolerance reporting
2161 * @dev: PCI device
2162 *
2163 * Enable LTR on @dev if possible, which means enabling it first on
2164 * upstream ports.
2165 *
2166 * RETURNS:
2167 * Zero on success, errno on failure.
2168 */
2169int pci_enable_ltr(struct pci_dev *dev)
2170{
2171 int pos;
2172 u16 ctrl;
2173 int ret;
2174
2175 if (!pci_ltr_supported(dev))
2176 return -ENOTSUPP;
2177
2178 pos = pci_pcie_cap(dev);
2179 if (!pos)
2180 return -ENOTSUPP;
2181
2182 /* Only primary function can enable/disable LTR */
2183 if (PCI_FUNC(dev->devfn) != 0)
2184 return -EINVAL;
2185
2186 /* Enable upstream ports first */
2187 if (dev->bus) {
2188 ret = pci_enable_ltr(dev->bus->self);
2189 if (ret)
2190 return ret;
2191 }
2192
2193 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL2, &ctrl);
2194 ctrl |= PCI_EXP_LTR_EN;
2195 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL2, ctrl);
2196
2197 return 0;
2198}
2199EXPORT_SYMBOL(pci_enable_ltr);
2200
2201/**
2202 * pci_disable_ltr - disable latency tolerance reporting
2203 * @dev: PCI device
2204 */
2205void pci_disable_ltr(struct pci_dev *dev)
2206{
2207 int pos;
2208 u16 ctrl;
2209
2210 if (!pci_ltr_supported(dev))
2211 return;
2212
2213 pos = pci_pcie_cap(dev);
2214 if (!pos)
2215 return;
2216
2217 /* Only primary function can enable/disable LTR */
2218 if (PCI_FUNC(dev->devfn) != 0)
2219 return;
2220
2221 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL2, &ctrl);
2222 ctrl &= ~PCI_EXP_LTR_EN;
2223 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL2, ctrl);
2224}
2225EXPORT_SYMBOL(pci_disable_ltr);
2226
2227static int __pci_ltr_scale(int *val)
2228{
2229 int scale = 0;
2230
2231 while (*val > 1023) {
2232 *val = (*val + 31) / 32;
2233 scale++;
2234 }
2235 return scale;
2236}
2237
2238/**
2239 * pci_set_ltr - set LTR latency values
2240 * @dev: PCI device
2241 * @snoop_lat_ns: snoop latency in nanoseconds
2242 * @nosnoop_lat_ns: nosnoop latency in nanoseconds
2243 *
2244 * Figure out the scale and set the LTR values accordingly.
2245 */
2246int pci_set_ltr(struct pci_dev *dev, int snoop_lat_ns, int nosnoop_lat_ns)
2247{
2248 int pos, ret, snoop_scale, nosnoop_scale;
2249 u16 val;
2250
2251 if (!pci_ltr_supported(dev))
2252 return -ENOTSUPP;
2253
2254 snoop_scale = __pci_ltr_scale(&snoop_lat_ns);
2255 nosnoop_scale = __pci_ltr_scale(&nosnoop_lat_ns);
2256
2257 if (snoop_lat_ns > PCI_LTR_VALUE_MASK ||
2258 nosnoop_lat_ns > PCI_LTR_VALUE_MASK)
2259 return -EINVAL;
2260
2261 if ((snoop_scale > (PCI_LTR_SCALE_MASK >> PCI_LTR_SCALE_SHIFT)) ||
2262 (nosnoop_scale > (PCI_LTR_SCALE_MASK >> PCI_LTR_SCALE_SHIFT)))
2263 return -EINVAL;
2264
2265 pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_LTR);
2266 if (!pos)
2267 return -ENOTSUPP;
2268
2269 val = (snoop_scale << PCI_LTR_SCALE_SHIFT) | snoop_lat_ns;
2270 ret = pci_write_config_word(dev, pos + PCI_LTR_MAX_SNOOP_LAT, val);
2271 if (ret != 4)
2272 return -EIO;
2273
2274 val = (nosnoop_scale << PCI_LTR_SCALE_SHIFT) | nosnoop_lat_ns;
2275 ret = pci_write_config_word(dev, pos + PCI_LTR_MAX_NOSNOOP_LAT, val);
2276 if (ret != 4)
2277 return -EIO;
2278
2279 return 0;
2280}
2281EXPORT_SYMBOL(pci_set_ltr);
2282
5d990b62
CW
2283static int pci_acs_enable;
2284
2285/**
2286 * pci_request_acs - ask for ACS to be enabled if supported
2287 */
2288void pci_request_acs(void)
2289{
2290 pci_acs_enable = 1;
2291}
2292
ae21ee65
AK
2293/**
2294 * pci_enable_acs - enable ACS if hardware support it
2295 * @dev: the PCI device
2296 */
2297void pci_enable_acs(struct pci_dev *dev)
2298{
2299 int pos;
2300 u16 cap;
2301 u16 ctrl;
2302
5d990b62
CW
2303 if (!pci_acs_enable)
2304 return;
2305
5f4d91a1 2306 if (!pci_is_pcie(dev))
ae21ee65
AK
2307 return;
2308
2309 pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_ACS);
2310 if (!pos)
2311 return;
2312
2313 pci_read_config_word(dev, pos + PCI_ACS_CAP, &cap);
2314 pci_read_config_word(dev, pos + PCI_ACS_CTRL, &ctrl);
2315
2316 /* Source Validation */
2317 ctrl |= (cap & PCI_ACS_SV);
2318
2319 /* P2P Request Redirect */
2320 ctrl |= (cap & PCI_ACS_RR);
2321
2322 /* P2P Completion Redirect */
2323 ctrl |= (cap & PCI_ACS_CR);
2324
2325 /* Upstream Forwarding */
2326 ctrl |= (cap & PCI_ACS_UF);
2327
2328 pci_write_config_word(dev, pos + PCI_ACS_CTRL, ctrl);
2329}
2330
57c2cf71
BH
2331/**
2332 * pci_swizzle_interrupt_pin - swizzle INTx for device behind bridge
2333 * @dev: the PCI device
2334 * @pin: the INTx pin (1=INTA, 2=INTB, 3=INTD, 4=INTD)
2335 *
2336 * Perform INTx swizzling for a device behind one level of bridge. This is
2337 * required by section 9.1 of the PCI-to-PCI bridge specification for devices
46b952a3
MW
2338 * behind bridges on add-in cards. For devices with ARI enabled, the slot
2339 * number is always 0 (see the Implementation Note in section 2.2.8.1 of
2340 * the PCI Express Base Specification, Revision 2.1)
57c2cf71
BH
2341 */
2342u8 pci_swizzle_interrupt_pin(struct pci_dev *dev, u8 pin)
2343{
46b952a3
MW
2344 int slot;
2345
2346 if (pci_ari_enabled(dev->bus))
2347 slot = 0;
2348 else
2349 slot = PCI_SLOT(dev->devfn);
2350
2351 return (((pin - 1) + slot) % 4) + 1;
57c2cf71
BH
2352}
2353
1da177e4
LT
2354int
2355pci_get_interrupt_pin(struct pci_dev *dev, struct pci_dev **bridge)
2356{
2357 u8 pin;
2358
514d207d 2359 pin = dev->pin;
1da177e4
LT
2360 if (!pin)
2361 return -1;
878f2e50 2362
8784fd4d 2363 while (!pci_is_root_bus(dev->bus)) {
57c2cf71 2364 pin = pci_swizzle_interrupt_pin(dev, pin);
1da177e4
LT
2365 dev = dev->bus->self;
2366 }
2367 *bridge = dev;
2368 return pin;
2369}
2370
68feac87
BH
2371/**
2372 * pci_common_swizzle - swizzle INTx all the way to root bridge
2373 * @dev: the PCI device
2374 * @pinp: pointer to the INTx pin value (1=INTA, 2=INTB, 3=INTD, 4=INTD)
2375 *
2376 * Perform INTx swizzling for a device. This traverses through all PCI-to-PCI
2377 * bridges all the way up to a PCI root bus.
2378 */
2379u8 pci_common_swizzle(struct pci_dev *dev, u8 *pinp)
2380{
2381 u8 pin = *pinp;
2382
1eb39487 2383 while (!pci_is_root_bus(dev->bus)) {
68feac87
BH
2384 pin = pci_swizzle_interrupt_pin(dev, pin);
2385 dev = dev->bus->self;
2386 }
2387 *pinp = pin;
2388 return PCI_SLOT(dev->devfn);
2389}
2390
1da177e4
LT
2391/**
2392 * pci_release_region - Release a PCI bar
2393 * @pdev: PCI device whose resources were previously reserved by pci_request_region
2394 * @bar: BAR to release
2395 *
2396 * Releases the PCI I/O and memory resources previously reserved by a
2397 * successful call to pci_request_region. Call this function only
2398 * after all use of the PCI regions has ceased.
2399 */
2400void pci_release_region(struct pci_dev *pdev, int bar)
2401{
9ac7849e
TH
2402 struct pci_devres *dr;
2403
1da177e4
LT
2404 if (pci_resource_len(pdev, bar) == 0)
2405 return;
2406 if (pci_resource_flags(pdev, bar) & IORESOURCE_IO)
2407 release_region(pci_resource_start(pdev, bar),
2408 pci_resource_len(pdev, bar));
2409 else if (pci_resource_flags(pdev, bar) & IORESOURCE_MEM)
2410 release_mem_region(pci_resource_start(pdev, bar),
2411 pci_resource_len(pdev, bar));
9ac7849e
TH
2412
2413 dr = find_pci_dr(pdev);
2414 if (dr)
2415 dr->region_mask &= ~(1 << bar);
1da177e4
LT
2416}
2417
2418/**
f5ddcac4 2419 * __pci_request_region - Reserved PCI I/O and memory resource
1da177e4
LT
2420 * @pdev: PCI device whose resources are to be reserved
2421 * @bar: BAR to be reserved
2422 * @res_name: Name to be associated with resource.
f5ddcac4 2423 * @exclusive: whether the region access is exclusive or not
1da177e4
LT
2424 *
2425 * Mark the PCI region associated with PCI device @pdev BR @bar as
2426 * being reserved by owner @res_name. Do not access any
2427 * address inside the PCI regions unless this call returns
2428 * successfully.
2429 *
f5ddcac4
RD
2430 * If @exclusive is set, then the region is marked so that userspace
2431 * is explicitly not allowed to map the resource via /dev/mem or
2432 * sysfs MMIO access.
2433 *
1da177e4
LT
2434 * Returns 0 on success, or %EBUSY on error. A warning
2435 * message is also printed on failure.
2436 */
e8de1481
AV
2437static int __pci_request_region(struct pci_dev *pdev, int bar, const char *res_name,
2438 int exclusive)
1da177e4 2439{
9ac7849e
TH
2440 struct pci_devres *dr;
2441
1da177e4
LT
2442 if (pci_resource_len(pdev, bar) == 0)
2443 return 0;
2444
2445 if (pci_resource_flags(pdev, bar) & IORESOURCE_IO) {
2446 if (!request_region(pci_resource_start(pdev, bar),
2447 pci_resource_len(pdev, bar), res_name))
2448 goto err_out;
2449 }
2450 else if (pci_resource_flags(pdev, bar) & IORESOURCE_MEM) {
e8de1481
AV
2451 if (!__request_mem_region(pci_resource_start(pdev, bar),
2452 pci_resource_len(pdev, bar), res_name,
2453 exclusive))
1da177e4
LT
2454 goto err_out;
2455 }
9ac7849e
TH
2456
2457 dr = find_pci_dr(pdev);
2458 if (dr)
2459 dr->region_mask |= 1 << bar;
2460
1da177e4
LT
2461 return 0;
2462
2463err_out:
c7dabef8 2464 dev_warn(&pdev->dev, "BAR %d: can't reserve %pR\n", bar,
096e6f67 2465 &pdev->resource[bar]);
1da177e4
LT
2466 return -EBUSY;
2467}
2468
e8de1481 2469/**
f5ddcac4 2470 * pci_request_region - Reserve PCI I/O and memory resource
e8de1481
AV
2471 * @pdev: PCI device whose resources are to be reserved
2472 * @bar: BAR to be reserved
f5ddcac4 2473 * @res_name: Name to be associated with resource
e8de1481 2474 *
f5ddcac4 2475 * Mark the PCI region associated with PCI device @pdev BAR @bar as
e8de1481
AV
2476 * being reserved by owner @res_name. Do not access any
2477 * address inside the PCI regions unless this call returns
2478 * successfully.
2479 *
2480 * Returns 0 on success, or %EBUSY on error. A warning
2481 * message is also printed on failure.
2482 */
2483int pci_request_region(struct pci_dev *pdev, int bar, const char *res_name)
2484{
2485 return __pci_request_region(pdev, bar, res_name, 0);
2486}
2487
2488/**
2489 * pci_request_region_exclusive - Reserved PCI I/O and memory resource
2490 * @pdev: PCI device whose resources are to be reserved
2491 * @bar: BAR to be reserved
2492 * @res_name: Name to be associated with resource.
2493 *
2494 * Mark the PCI region associated with PCI device @pdev BR @bar as
2495 * being reserved by owner @res_name. Do not access any
2496 * address inside the PCI regions unless this call returns
2497 * successfully.
2498 *
2499 * Returns 0 on success, or %EBUSY on error. A warning
2500 * message is also printed on failure.
2501 *
2502 * The key difference that _exclusive makes it that userspace is
2503 * explicitly not allowed to map the resource via /dev/mem or
2504 * sysfs.
2505 */
2506int pci_request_region_exclusive(struct pci_dev *pdev, int bar, const char *res_name)
2507{
2508 return __pci_request_region(pdev, bar, res_name, IORESOURCE_EXCLUSIVE);
2509}
c87deff7
HS
2510/**
2511 * pci_release_selected_regions - Release selected PCI I/O and memory resources
2512 * @pdev: PCI device whose resources were previously reserved
2513 * @bars: Bitmask of BARs to be released
2514 *
2515 * Release selected PCI I/O and memory resources previously reserved.
2516 * Call this function only after all use of the PCI regions has ceased.
2517 */
2518void pci_release_selected_regions(struct pci_dev *pdev, int bars)
2519{
2520 int i;
2521
2522 for (i = 0; i < 6; i++)
2523 if (bars & (1 << i))
2524 pci_release_region(pdev, i);
2525}
2526
e8de1481
AV
2527int __pci_request_selected_regions(struct pci_dev *pdev, int bars,
2528 const char *res_name, int excl)
c87deff7
HS
2529{
2530 int i;
2531
2532 for (i = 0; i < 6; i++)
2533 if (bars & (1 << i))
e8de1481 2534 if (__pci_request_region(pdev, i, res_name, excl))
c87deff7
HS
2535 goto err_out;
2536 return 0;
2537
2538err_out:
2539 while(--i >= 0)
2540 if (bars & (1 << i))
2541 pci_release_region(pdev, i);
2542
2543 return -EBUSY;
2544}
1da177e4 2545
e8de1481
AV
2546
2547/**
2548 * pci_request_selected_regions - Reserve selected PCI I/O and memory resources
2549 * @pdev: PCI device whose resources are to be reserved
2550 * @bars: Bitmask of BARs to be requested
2551 * @res_name: Name to be associated with resource
2552 */
2553int pci_request_selected_regions(struct pci_dev *pdev, int bars,
2554 const char *res_name)
2555{
2556 return __pci_request_selected_regions(pdev, bars, res_name, 0);
2557}
2558
2559int pci_request_selected_regions_exclusive(struct pci_dev *pdev,
2560 int bars, const char *res_name)
2561{
2562 return __pci_request_selected_regions(pdev, bars, res_name,
2563 IORESOURCE_EXCLUSIVE);
2564}
2565
1da177e4
LT
2566/**
2567 * pci_release_regions - Release reserved PCI I/O and memory resources
2568 * @pdev: PCI device whose resources were previously reserved by pci_request_regions
2569 *
2570 * Releases all PCI I/O and memory resources previously reserved by a
2571 * successful call to pci_request_regions. Call this function only
2572 * after all use of the PCI regions has ceased.
2573 */
2574
2575void pci_release_regions(struct pci_dev *pdev)
2576{
c87deff7 2577 pci_release_selected_regions(pdev, (1 << 6) - 1);
1da177e4
LT
2578}
2579
2580/**
2581 * pci_request_regions - Reserved PCI I/O and memory resources
2582 * @pdev: PCI device whose resources are to be reserved
2583 * @res_name: Name to be associated with resource.
2584 *
2585 * Mark all PCI regions associated with PCI device @pdev as
2586 * being reserved by owner @res_name. Do not access any
2587 * address inside the PCI regions unless this call returns
2588 * successfully.
2589 *
2590 * Returns 0 on success, or %EBUSY on error. A warning
2591 * message is also printed on failure.
2592 */
3c990e92 2593int pci_request_regions(struct pci_dev *pdev, const char *res_name)
1da177e4 2594{
c87deff7 2595 return pci_request_selected_regions(pdev, ((1 << 6) - 1), res_name);
1da177e4
LT
2596}
2597
e8de1481
AV
2598/**
2599 * pci_request_regions_exclusive - Reserved PCI I/O and memory resources
2600 * @pdev: PCI device whose resources are to be reserved
2601 * @res_name: Name to be associated with resource.
2602 *
2603 * Mark all PCI regions associated with PCI device @pdev as
2604 * being reserved by owner @res_name. Do not access any
2605 * address inside the PCI regions unless this call returns
2606 * successfully.
2607 *
2608 * pci_request_regions_exclusive() will mark the region so that
2609 * /dev/mem and the sysfs MMIO access will not be allowed.
2610 *
2611 * Returns 0 on success, or %EBUSY on error. A warning
2612 * message is also printed on failure.
2613 */
2614int pci_request_regions_exclusive(struct pci_dev *pdev, const char *res_name)
2615{
2616 return pci_request_selected_regions_exclusive(pdev,
2617 ((1 << 6) - 1), res_name);
2618}
2619
6a479079
BH
2620static void __pci_set_master(struct pci_dev *dev, bool enable)
2621{
2622 u16 old_cmd, cmd;
2623
2624 pci_read_config_word(dev, PCI_COMMAND, &old_cmd);
2625 if (enable)
2626 cmd = old_cmd | PCI_COMMAND_MASTER;
2627 else
2628 cmd = old_cmd & ~PCI_COMMAND_MASTER;
2629 if (cmd != old_cmd) {
2630 dev_dbg(&dev->dev, "%s bus mastering\n",
2631 enable ? "enabling" : "disabling");
2632 pci_write_config_word(dev, PCI_COMMAND, cmd);
2633 }
2634 dev->is_busmaster = enable;
2635}
e8de1481 2636
96c55900
MS
2637/**
2638 * pcibios_set_master - enable PCI bus-mastering for device dev
2639 * @dev: the PCI device to enable
2640 *
2641 * Enables PCI bus-mastering for the device. This is the default
2642 * implementation. Architecture specific implementations can override
2643 * this if necessary.
2644 */
2645void __weak pcibios_set_master(struct pci_dev *dev)
2646{
2647 u8 lat;
2648
f676678f
MS
2649 /* The latency timer doesn't apply to PCIe (either Type 0 or Type 1) */
2650 if (pci_is_pcie(dev))
2651 return;
2652
96c55900
MS
2653 pci_read_config_byte(dev, PCI_LATENCY_TIMER, &lat);
2654 if (lat < 16)
2655 lat = (64 <= pcibios_max_latency) ? 64 : pcibios_max_latency;
2656 else if (lat > pcibios_max_latency)
2657 lat = pcibios_max_latency;
2658 else
2659 return;
2660 dev_printk(KERN_DEBUG, &dev->dev, "setting latency timer to %d\n", lat);
2661 pci_write_config_byte(dev, PCI_LATENCY_TIMER, lat);
2662}
2663
1da177e4
LT
2664/**
2665 * pci_set_master - enables bus-mastering for device dev
2666 * @dev: the PCI device to enable
2667 *
2668 * Enables bus-mastering on the device and calls pcibios_set_master()
2669 * to do the needed arch specific settings.
2670 */
6a479079 2671void pci_set_master(struct pci_dev *dev)
1da177e4 2672{
6a479079 2673 __pci_set_master(dev, true);
1da177e4
LT
2674 pcibios_set_master(dev);
2675}
2676
6a479079
BH
2677/**
2678 * pci_clear_master - disables bus-mastering for device dev
2679 * @dev: the PCI device to disable
2680 */
2681void pci_clear_master(struct pci_dev *dev)
2682{
2683 __pci_set_master(dev, false);
2684}
2685
1da177e4 2686/**
edb2d97e
MW
2687 * pci_set_cacheline_size - ensure the CACHE_LINE_SIZE register is programmed
2688 * @dev: the PCI device for which MWI is to be enabled
1da177e4 2689 *
edb2d97e
MW
2690 * Helper function for pci_set_mwi.
2691 * Originally copied from drivers/net/acenic.c.
1da177e4
LT
2692 * Copyright 1998-2001 by Jes Sorensen, <jes@trained-monkey.org>.
2693 *
2694 * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
2695 */
15ea76d4 2696int pci_set_cacheline_size(struct pci_dev *dev)
1da177e4
LT
2697{
2698 u8 cacheline_size;
2699
2700 if (!pci_cache_line_size)
15ea76d4 2701 return -EINVAL;
1da177e4
LT
2702
2703 /* Validate current setting: the PCI_CACHE_LINE_SIZE must be
2704 equal to or multiple of the right value. */
2705 pci_read_config_byte(dev, PCI_CACHE_LINE_SIZE, &cacheline_size);
2706 if (cacheline_size >= pci_cache_line_size &&
2707 (cacheline_size % pci_cache_line_size) == 0)
2708 return 0;
2709
2710 /* Write the correct value. */
2711 pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, pci_cache_line_size);
2712 /* Read it back. */
2713 pci_read_config_byte(dev, PCI_CACHE_LINE_SIZE, &cacheline_size);
2714 if (cacheline_size == pci_cache_line_size)
2715 return 0;
2716
80ccba11
BH
2717 dev_printk(KERN_DEBUG, &dev->dev, "cache line size of %d is not "
2718 "supported\n", pci_cache_line_size << 2);
1da177e4
LT
2719
2720 return -EINVAL;
2721}
15ea76d4
TH
2722EXPORT_SYMBOL_GPL(pci_set_cacheline_size);
2723
2724#ifdef PCI_DISABLE_MWI
2725int pci_set_mwi(struct pci_dev *dev)
2726{
2727 return 0;
2728}
2729
2730int pci_try_set_mwi(struct pci_dev *dev)
2731{
2732 return 0;
2733}
2734
2735void pci_clear_mwi(struct pci_dev *dev)
2736{
2737}
2738
2739#else
1da177e4
LT
2740
2741/**
2742 * pci_set_mwi - enables memory-write-invalidate PCI transaction
2743 * @dev: the PCI device for which MWI is enabled
2744 *
694625c0 2745 * Enables the Memory-Write-Invalidate transaction in %PCI_COMMAND.
1da177e4
LT
2746 *
2747 * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
2748 */
2749int
2750pci_set_mwi(struct pci_dev *dev)
2751{
2752 int rc;
2753 u16 cmd;
2754
edb2d97e 2755 rc = pci_set_cacheline_size(dev);
1da177e4
LT
2756 if (rc)
2757 return rc;
2758
2759 pci_read_config_word(dev, PCI_COMMAND, &cmd);
2760 if (! (cmd & PCI_COMMAND_INVALIDATE)) {
80ccba11 2761 dev_dbg(&dev->dev, "enabling Mem-Wr-Inval\n");
1da177e4
LT
2762 cmd |= PCI_COMMAND_INVALIDATE;
2763 pci_write_config_word(dev, PCI_COMMAND, cmd);
2764 }
2765
2766 return 0;
2767}
2768
694625c0
RD
2769/**
2770 * pci_try_set_mwi - enables memory-write-invalidate PCI transaction
2771 * @dev: the PCI device for which MWI is enabled
2772 *
2773 * Enables the Memory-Write-Invalidate transaction in %PCI_COMMAND.
2774 * Callers are not required to check the return value.
2775 *
2776 * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
2777 */
2778int pci_try_set_mwi(struct pci_dev *dev)
2779{
2780 int rc = pci_set_mwi(dev);
2781 return rc;
2782}
2783
1da177e4
LT
2784/**
2785 * pci_clear_mwi - disables Memory-Write-Invalidate for device dev
2786 * @dev: the PCI device to disable
2787 *
2788 * Disables PCI Memory-Write-Invalidate transaction on the device
2789 */
2790void
2791pci_clear_mwi(struct pci_dev *dev)
2792{
2793 u16 cmd;
2794
2795 pci_read_config_word(dev, PCI_COMMAND, &cmd);
2796 if (cmd & PCI_COMMAND_INVALIDATE) {
2797 cmd &= ~PCI_COMMAND_INVALIDATE;
2798 pci_write_config_word(dev, PCI_COMMAND, cmd);
2799 }
2800}
edb2d97e 2801#endif /* ! PCI_DISABLE_MWI */
1da177e4 2802
a04ce0ff
BR
2803/**
2804 * pci_intx - enables/disables PCI INTx for device dev
8f7020d3
RD
2805 * @pdev: the PCI device to operate on
2806 * @enable: boolean: whether to enable or disable PCI INTx
a04ce0ff
BR
2807 *
2808 * Enables/disables PCI INTx for device dev
2809 */
2810void
2811pci_intx(struct pci_dev *pdev, int enable)
2812{
2813 u16 pci_command, new;
2814
2815 pci_read_config_word(pdev, PCI_COMMAND, &pci_command);
2816
2817 if (enable) {
2818 new = pci_command & ~PCI_COMMAND_INTX_DISABLE;
2819 } else {
2820 new = pci_command | PCI_COMMAND_INTX_DISABLE;
2821 }
2822
2823 if (new != pci_command) {
9ac7849e
TH
2824 struct pci_devres *dr;
2825
2fd9d74b 2826 pci_write_config_word(pdev, PCI_COMMAND, new);
9ac7849e
TH
2827
2828 dr = find_pci_dr(pdev);
2829 if (dr && !dr->restore_intx) {
2830 dr->restore_intx = 1;
2831 dr->orig_intx = !enable;
2832 }
a04ce0ff
BR
2833 }
2834}
2835
a2e27787
JK
2836/**
2837 * pci_intx_mask_supported - probe for INTx masking support
6e9292c5 2838 * @dev: the PCI device to operate on
a2e27787
JK
2839 *
2840 * Check if the device dev support INTx masking via the config space
2841 * command word.
2842 */
2843bool pci_intx_mask_supported(struct pci_dev *dev)
2844{
2845 bool mask_supported = false;
2846 u16 orig, new;
2847
2848 pci_cfg_access_lock(dev);
2849
2850 pci_read_config_word(dev, PCI_COMMAND, &orig);
2851 pci_write_config_word(dev, PCI_COMMAND,
2852 orig ^ PCI_COMMAND_INTX_DISABLE);
2853 pci_read_config_word(dev, PCI_COMMAND, &new);
2854
2855 /*
2856 * There's no way to protect against hardware bugs or detect them
2857 * reliably, but as long as we know what the value should be, let's
2858 * go ahead and check it.
2859 */
2860 if ((new ^ orig) & ~PCI_COMMAND_INTX_DISABLE) {
2861 dev_err(&dev->dev, "Command register changed from "
2862 "0x%x to 0x%x: driver or hardware bug?\n", orig, new);
2863 } else if ((new ^ orig) & PCI_COMMAND_INTX_DISABLE) {
2864 mask_supported = true;
2865 pci_write_config_word(dev, PCI_COMMAND, orig);
2866 }
2867
2868 pci_cfg_access_unlock(dev);
2869 return mask_supported;
2870}
2871EXPORT_SYMBOL_GPL(pci_intx_mask_supported);
2872
2873static bool pci_check_and_set_intx_mask(struct pci_dev *dev, bool mask)
2874{
2875 struct pci_bus *bus = dev->bus;
2876 bool mask_updated = true;
2877 u32 cmd_status_dword;
2878 u16 origcmd, newcmd;
2879 unsigned long flags;
2880 bool irq_pending;
2881
2882 /*
2883 * We do a single dword read to retrieve both command and status.
2884 * Document assumptions that make this possible.
2885 */
2886 BUILD_BUG_ON(PCI_COMMAND % 4);
2887 BUILD_BUG_ON(PCI_COMMAND + 2 != PCI_STATUS);
2888
2889 raw_spin_lock_irqsave(&pci_lock, flags);
2890
2891 bus->ops->read(bus, dev->devfn, PCI_COMMAND, 4, &cmd_status_dword);
2892
2893 irq_pending = (cmd_status_dword >> 16) & PCI_STATUS_INTERRUPT;
2894
2895 /*
2896 * Check interrupt status register to see whether our device
2897 * triggered the interrupt (when masking) or the next IRQ is
2898 * already pending (when unmasking).
2899 */
2900 if (mask != irq_pending) {
2901 mask_updated = false;
2902 goto done;
2903 }
2904
2905 origcmd = cmd_status_dword;
2906 newcmd = origcmd & ~PCI_COMMAND_INTX_DISABLE;
2907 if (mask)
2908 newcmd |= PCI_COMMAND_INTX_DISABLE;
2909 if (newcmd != origcmd)
2910 bus->ops->write(bus, dev->devfn, PCI_COMMAND, 2, newcmd);
2911
2912done:
2913 raw_spin_unlock_irqrestore(&pci_lock, flags);
2914
2915 return mask_updated;
2916}
2917
2918/**
2919 * pci_check_and_mask_intx - mask INTx on pending interrupt
6e9292c5 2920 * @dev: the PCI device to operate on
a2e27787
JK
2921 *
2922 * Check if the device dev has its INTx line asserted, mask it and
2923 * return true in that case. False is returned if not interrupt was
2924 * pending.
2925 */
2926bool pci_check_and_mask_intx(struct pci_dev *dev)
2927{
2928 return pci_check_and_set_intx_mask(dev, true);
2929}
2930EXPORT_SYMBOL_GPL(pci_check_and_mask_intx);
2931
2932/**
2933 * pci_check_and_mask_intx - unmask INTx of no interrupt is pending
6e9292c5 2934 * @dev: the PCI device to operate on
a2e27787
JK
2935 *
2936 * Check if the device dev has its INTx line asserted, unmask it if not
2937 * and return true. False is returned and the mask remains active if
2938 * there was still an interrupt pending.
2939 */
2940bool pci_check_and_unmask_intx(struct pci_dev *dev)
2941{
2942 return pci_check_and_set_intx_mask(dev, false);
2943}
2944EXPORT_SYMBOL_GPL(pci_check_and_unmask_intx);
2945
f5f2b131
EB
2946/**
2947 * pci_msi_off - disables any msi or msix capabilities
8d7d86e9 2948 * @dev: the PCI device to operate on
f5f2b131
EB
2949 *
2950 * If you want to use msi see pci_enable_msi and friends.
2951 * This is a lower level primitive that allows us to disable
2952 * msi operation at the device level.
2953 */
2954void pci_msi_off(struct pci_dev *dev)
2955{
2956 int pos;
2957 u16 control;
2958
2959 pos = pci_find_capability(dev, PCI_CAP_ID_MSI);
2960 if (pos) {
2961 pci_read_config_word(dev, pos + PCI_MSI_FLAGS, &control);
2962 control &= ~PCI_MSI_FLAGS_ENABLE;
2963 pci_write_config_word(dev, pos + PCI_MSI_FLAGS, control);
2964 }
2965 pos = pci_find_capability(dev, PCI_CAP_ID_MSIX);
2966 if (pos) {
2967 pci_read_config_word(dev, pos + PCI_MSIX_FLAGS, &control);
2968 control &= ~PCI_MSIX_FLAGS_ENABLE;
2969 pci_write_config_word(dev, pos + PCI_MSIX_FLAGS, control);
2970 }
2971}
b03214d5 2972EXPORT_SYMBOL_GPL(pci_msi_off);
f5f2b131 2973
4d57cdfa
FT
2974int pci_set_dma_max_seg_size(struct pci_dev *dev, unsigned int size)
2975{
2976 return dma_set_max_seg_size(&dev->dev, size);
2977}
2978EXPORT_SYMBOL(pci_set_dma_max_seg_size);
4d57cdfa 2979
59fc67de
FT
2980int pci_set_dma_seg_boundary(struct pci_dev *dev, unsigned long mask)
2981{
2982 return dma_set_seg_boundary(&dev->dev, mask);
2983}
2984EXPORT_SYMBOL(pci_set_dma_seg_boundary);
59fc67de 2985
8c1c699f 2986static int pcie_flr(struct pci_dev *dev, int probe)
8dd7f803 2987{
8c1c699f
YZ
2988 int i;
2989 int pos;
8dd7f803 2990 u32 cap;
04b55c47 2991 u16 status, control;
8dd7f803 2992
06a1cbaf 2993 pos = pci_pcie_cap(dev);
8c1c699f 2994 if (!pos)
8dd7f803 2995 return -ENOTTY;
8c1c699f
YZ
2996
2997 pci_read_config_dword(dev, pos + PCI_EXP_DEVCAP, &cap);
8dd7f803
SY
2998 if (!(cap & PCI_EXP_DEVCAP_FLR))
2999 return -ENOTTY;
3000
d91cdc74
SY
3001 if (probe)
3002 return 0;
3003
8dd7f803 3004 /* Wait for Transaction Pending bit clean */
8c1c699f
YZ
3005 for (i = 0; i < 4; i++) {
3006 if (i)
3007 msleep((1 << (i - 1)) * 100);
5fe5db05 3008
8c1c699f
YZ
3009 pci_read_config_word(dev, pos + PCI_EXP_DEVSTA, &status);
3010 if (!(status & PCI_EXP_DEVSTA_TRPND))
3011 goto clear;
3012 }
3013
3014 dev_err(&dev->dev, "transaction is not cleared; "
3015 "proceeding with reset anyway\n");
3016
3017clear:
04b55c47
SR
3018 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL, &control);
3019 control |= PCI_EXP_DEVCTL_BCR_FLR;
3020 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL, control);
3021
8c1c699f 3022 msleep(100);
8dd7f803 3023
8dd7f803
SY
3024 return 0;
3025}
d91cdc74 3026
8c1c699f 3027static int pci_af_flr(struct pci_dev *dev, int probe)
1ca88797 3028{
8c1c699f
YZ
3029 int i;
3030 int pos;
1ca88797 3031 u8 cap;
8c1c699f 3032 u8 status;
1ca88797 3033
8c1c699f
YZ
3034 pos = pci_find_capability(dev, PCI_CAP_ID_AF);
3035 if (!pos)
1ca88797 3036 return -ENOTTY;
8c1c699f
YZ
3037
3038 pci_read_config_byte(dev, pos + PCI_AF_CAP, &cap);
1ca88797
SY
3039 if (!(cap & PCI_AF_CAP_TP) || !(cap & PCI_AF_CAP_FLR))
3040 return -ENOTTY;
3041
3042 if (probe)
3043 return 0;
3044
1ca88797 3045 /* Wait for Transaction Pending bit clean */
8c1c699f
YZ
3046 for (i = 0; i < 4; i++) {
3047 if (i)
3048 msleep((1 << (i - 1)) * 100);
3049
3050 pci_read_config_byte(dev, pos + PCI_AF_STATUS, &status);
3051 if (!(status & PCI_AF_STATUS_TP))
3052 goto clear;
3053 }
5fe5db05 3054
8c1c699f
YZ
3055 dev_err(&dev->dev, "transaction is not cleared; "
3056 "proceeding with reset anyway\n");
5fe5db05 3057
8c1c699f
YZ
3058clear:
3059 pci_write_config_byte(dev, pos + PCI_AF_CTRL, PCI_AF_CTRL_FLR);
1ca88797 3060 msleep(100);
8c1c699f 3061
1ca88797
SY
3062 return 0;
3063}
3064
83d74e03
RW
3065/**
3066 * pci_pm_reset - Put device into PCI_D3 and back into PCI_D0.
3067 * @dev: Device to reset.
3068 * @probe: If set, only check if the device can be reset this way.
3069 *
3070 * If @dev supports native PCI PM and its PCI_PM_CTRL_NO_SOFT_RESET flag is
3071 * unset, it will be reinitialized internally when going from PCI_D3hot to
3072 * PCI_D0. If that's the case and the device is not in a low-power state
3073 * already, force it into PCI_D3hot and back to PCI_D0, causing it to be reset.
3074 *
3075 * NOTE: This causes the caller to sleep for twice the device power transition
3076 * cooldown period, which for the D0->D3hot and D3hot->D0 transitions is 10 ms
3077 * by devault (i.e. unless the @dev's d3_delay field has a different value).
3078 * Moreover, only devices in D0 can be reset by this function.
3079 */
f85876ba 3080static int pci_pm_reset(struct pci_dev *dev, int probe)
d91cdc74 3081{
f85876ba
YZ
3082 u16 csr;
3083
3084 if (!dev->pm_cap)
3085 return -ENOTTY;
d91cdc74 3086
f85876ba
YZ
3087 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &csr);
3088 if (csr & PCI_PM_CTRL_NO_SOFT_RESET)
3089 return -ENOTTY;
d91cdc74 3090
f85876ba
YZ
3091 if (probe)
3092 return 0;
1ca88797 3093
f85876ba
YZ
3094 if (dev->current_state != PCI_D0)
3095 return -EINVAL;
3096
3097 csr &= ~PCI_PM_CTRL_STATE_MASK;
3098 csr |= PCI_D3hot;
3099 pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, csr);
1ae861e6 3100 pci_dev_d3_sleep(dev);
f85876ba
YZ
3101
3102 csr &= ~PCI_PM_CTRL_STATE_MASK;
3103 csr |= PCI_D0;
3104 pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, csr);
1ae861e6 3105 pci_dev_d3_sleep(dev);
f85876ba
YZ
3106
3107 return 0;
3108}
3109
c12ff1df
YZ
3110static int pci_parent_bus_reset(struct pci_dev *dev, int probe)
3111{
3112 u16 ctrl;
3113 struct pci_dev *pdev;
3114
654b75e0 3115 if (pci_is_root_bus(dev->bus) || dev->subordinate || !dev->bus->self)
c12ff1df
YZ
3116 return -ENOTTY;
3117
3118 list_for_each_entry(pdev, &dev->bus->devices, bus_list)
3119 if (pdev != dev)
3120 return -ENOTTY;
3121
3122 if (probe)
3123 return 0;
3124
3125 pci_read_config_word(dev->bus->self, PCI_BRIDGE_CONTROL, &ctrl);
3126 ctrl |= PCI_BRIDGE_CTL_BUS_RESET;
3127 pci_write_config_word(dev->bus->self, PCI_BRIDGE_CONTROL, ctrl);
3128 msleep(100);
3129
3130 ctrl &= ~PCI_BRIDGE_CTL_BUS_RESET;
3131 pci_write_config_word(dev->bus->self, PCI_BRIDGE_CONTROL, ctrl);
3132 msleep(100);
3133
3134 return 0;
3135}
3136
8c1c699f 3137static int pci_dev_reset(struct pci_dev *dev, int probe)
d91cdc74 3138{
8c1c699f
YZ
3139 int rc;
3140
3141 might_sleep();
3142
3143 if (!probe) {
fb51ccbf 3144 pci_cfg_access_lock(dev);
8c1c699f 3145 /* block PM suspend, driver probe, etc. */
8e9394ce 3146 device_lock(&dev->dev);
8c1c699f 3147 }
d91cdc74 3148
b9c3b266
DC
3149 rc = pci_dev_specific_reset(dev, probe);
3150 if (rc != -ENOTTY)
3151 goto done;
3152
8c1c699f
YZ
3153 rc = pcie_flr(dev, probe);
3154 if (rc != -ENOTTY)
3155 goto done;
d91cdc74 3156
8c1c699f 3157 rc = pci_af_flr(dev, probe);
f85876ba
YZ
3158 if (rc != -ENOTTY)
3159 goto done;
3160
3161 rc = pci_pm_reset(dev, probe);
c12ff1df
YZ
3162 if (rc != -ENOTTY)
3163 goto done;
3164
3165 rc = pci_parent_bus_reset(dev, probe);
8c1c699f
YZ
3166done:
3167 if (!probe) {
8e9394ce 3168 device_unlock(&dev->dev);
fb51ccbf 3169 pci_cfg_access_unlock(dev);
8c1c699f 3170 }
1ca88797 3171
8c1c699f 3172 return rc;
d91cdc74
SY
3173}
3174
3175/**
8c1c699f
YZ
3176 * __pci_reset_function - reset a PCI device function
3177 * @dev: PCI device to reset
d91cdc74
SY
3178 *
3179 * Some devices allow an individual function to be reset without affecting
3180 * other functions in the same device. The PCI device must be responsive
3181 * to PCI config space in order to use this function.
3182 *
3183 * The device function is presumed to be unused when this function is called.
3184 * Resetting the device will make the contents of PCI configuration space
3185 * random, so any caller of this must be prepared to reinitialise the
3186 * device including MSI, bus mastering, BARs, decoding IO and memory spaces,
3187 * etc.
3188 *
8c1c699f 3189 * Returns 0 if the device function was successfully reset or negative if the
d91cdc74
SY
3190 * device doesn't support resetting a single function.
3191 */
8c1c699f 3192int __pci_reset_function(struct pci_dev *dev)
d91cdc74 3193{
8c1c699f 3194 return pci_dev_reset(dev, 0);
d91cdc74 3195}
8c1c699f 3196EXPORT_SYMBOL_GPL(__pci_reset_function);
8dd7f803 3197
6fbf9e7a
KRW
3198/**
3199 * __pci_reset_function_locked - reset a PCI device function while holding
3200 * the @dev mutex lock.
3201 * @dev: PCI device to reset
3202 *
3203 * Some devices allow an individual function to be reset without affecting
3204 * other functions in the same device. The PCI device must be responsive
3205 * to PCI config space in order to use this function.
3206 *
3207 * The device function is presumed to be unused and the caller is holding
3208 * the device mutex lock when this function is called.
3209 * Resetting the device will make the contents of PCI configuration space
3210 * random, so any caller of this must be prepared to reinitialise the
3211 * device including MSI, bus mastering, BARs, decoding IO and memory spaces,
3212 * etc.
3213 *
3214 * Returns 0 if the device function was successfully reset or negative if the
3215 * device doesn't support resetting a single function.
3216 */
3217int __pci_reset_function_locked(struct pci_dev *dev)
3218{
3219 return pci_dev_reset(dev, 1);
3220}
3221EXPORT_SYMBOL_GPL(__pci_reset_function_locked);
3222
711d5779
MT
3223/**
3224 * pci_probe_reset_function - check whether the device can be safely reset
3225 * @dev: PCI device to reset
3226 *
3227 * Some devices allow an individual function to be reset without affecting
3228 * other functions in the same device. The PCI device must be responsive
3229 * to PCI config space in order to use this function.
3230 *
3231 * Returns 0 if the device function can be reset or negative if the
3232 * device doesn't support resetting a single function.
3233 */
3234int pci_probe_reset_function(struct pci_dev *dev)
3235{
3236 return pci_dev_reset(dev, 1);
3237}
3238
8dd7f803 3239/**
8c1c699f
YZ
3240 * pci_reset_function - quiesce and reset a PCI device function
3241 * @dev: PCI device to reset
8dd7f803
SY
3242 *
3243 * Some devices allow an individual function to be reset without affecting
3244 * other functions in the same device. The PCI device must be responsive
3245 * to PCI config space in order to use this function.
3246 *
3247 * This function does not just reset the PCI portion of a device, but
3248 * clears all the state associated with the device. This function differs
8c1c699f 3249 * from __pci_reset_function in that it saves and restores device state
8dd7f803
SY
3250 * over the reset.
3251 *
8c1c699f 3252 * Returns 0 if the device function was successfully reset or negative if the
8dd7f803
SY
3253 * device doesn't support resetting a single function.
3254 */
3255int pci_reset_function(struct pci_dev *dev)
3256{
8c1c699f 3257 int rc;
8dd7f803 3258
8c1c699f
YZ
3259 rc = pci_dev_reset(dev, 1);
3260 if (rc)
3261 return rc;
8dd7f803 3262
8dd7f803
SY
3263 pci_save_state(dev);
3264
8c1c699f
YZ
3265 /*
3266 * both INTx and MSI are disabled after the Interrupt Disable bit
3267 * is set and the Bus Master bit is cleared.
3268 */
8dd7f803
SY
3269 pci_write_config_word(dev, PCI_COMMAND, PCI_COMMAND_INTX_DISABLE);
3270
8c1c699f 3271 rc = pci_dev_reset(dev, 0);
8dd7f803
SY
3272
3273 pci_restore_state(dev);
8dd7f803 3274
8c1c699f 3275 return rc;
8dd7f803
SY
3276}
3277EXPORT_SYMBOL_GPL(pci_reset_function);
3278
d556ad4b
PO
3279/**
3280 * pcix_get_max_mmrbc - get PCI-X maximum designed memory read byte count
3281 * @dev: PCI device to query
3282 *
3283 * Returns mmrbc: maximum designed memory read count in bytes
3284 * or appropriate error value.
3285 */
3286int pcix_get_max_mmrbc(struct pci_dev *dev)
3287{
7c9e2b1c 3288 int cap;
d556ad4b
PO
3289 u32 stat;
3290
3291 cap = pci_find_capability(dev, PCI_CAP_ID_PCIX);
3292 if (!cap)
3293 return -EINVAL;
3294
7c9e2b1c 3295 if (pci_read_config_dword(dev, cap + PCI_X_STATUS, &stat))
d556ad4b
PO
3296 return -EINVAL;
3297
25daeb55 3298 return 512 << ((stat & PCI_X_STATUS_MAX_READ) >> 21);
d556ad4b
PO
3299}
3300EXPORT_SYMBOL(pcix_get_max_mmrbc);
3301
3302/**
3303 * pcix_get_mmrbc - get PCI-X maximum memory read byte count
3304 * @dev: PCI device to query
3305 *
3306 * Returns mmrbc: maximum memory read count in bytes
3307 * or appropriate error value.
3308 */
3309int pcix_get_mmrbc(struct pci_dev *dev)
3310{
7c9e2b1c 3311 int cap;
bdc2bda7 3312 u16 cmd;
d556ad4b
PO
3313
3314 cap = pci_find_capability(dev, PCI_CAP_ID_PCIX);
3315 if (!cap)
3316 return -EINVAL;
3317
7c9e2b1c
DN
3318 if (pci_read_config_word(dev, cap + PCI_X_CMD, &cmd))
3319 return -EINVAL;
d556ad4b 3320
7c9e2b1c 3321 return 512 << ((cmd & PCI_X_CMD_MAX_READ) >> 2);
d556ad4b
PO
3322}
3323EXPORT_SYMBOL(pcix_get_mmrbc);
3324
3325/**
3326 * pcix_set_mmrbc - set PCI-X maximum memory read byte count
3327 * @dev: PCI device to query
3328 * @mmrbc: maximum memory read count in bytes
3329 * valid values are 512, 1024, 2048, 4096
3330 *
3331 * If possible sets maximum memory read byte count, some bridges have erratas
3332 * that prevent this.
3333 */
3334int pcix_set_mmrbc(struct pci_dev *dev, int mmrbc)
3335{
7c9e2b1c 3336 int cap;
bdc2bda7
DN
3337 u32 stat, v, o;
3338 u16 cmd;
d556ad4b 3339
229f5afd 3340 if (mmrbc < 512 || mmrbc > 4096 || !is_power_of_2(mmrbc))
7c9e2b1c 3341 return -EINVAL;
d556ad4b
PO
3342
3343 v = ffs(mmrbc) - 10;
3344
3345 cap = pci_find_capability(dev, PCI_CAP_ID_PCIX);
3346 if (!cap)
7c9e2b1c 3347 return -EINVAL;
d556ad4b 3348
7c9e2b1c
DN
3349 if (pci_read_config_dword(dev, cap + PCI_X_STATUS, &stat))
3350 return -EINVAL;
d556ad4b
PO
3351
3352 if (v > (stat & PCI_X_STATUS_MAX_READ) >> 21)
3353 return -E2BIG;
3354
7c9e2b1c
DN
3355 if (pci_read_config_word(dev, cap + PCI_X_CMD, &cmd))
3356 return -EINVAL;
d556ad4b
PO
3357
3358 o = (cmd & PCI_X_CMD_MAX_READ) >> 2;
3359 if (o != v) {
3360 if (v > o && dev->bus &&
3361 (dev->bus->bus_flags & PCI_BUS_FLAGS_NO_MMRBC))
3362 return -EIO;
3363
3364 cmd &= ~PCI_X_CMD_MAX_READ;
3365 cmd |= v << 2;
7c9e2b1c
DN
3366 if (pci_write_config_word(dev, cap + PCI_X_CMD, cmd))
3367 return -EIO;
d556ad4b 3368 }
7c9e2b1c 3369 return 0;
d556ad4b
PO
3370}
3371EXPORT_SYMBOL(pcix_set_mmrbc);
3372
3373/**
3374 * pcie_get_readrq - get PCI Express read request size
3375 * @dev: PCI device to query
3376 *
3377 * Returns maximum memory read request in bytes
3378 * or appropriate error value.
3379 */
3380int pcie_get_readrq(struct pci_dev *dev)
3381{
3382 int ret, cap;
3383 u16 ctl;
3384
06a1cbaf 3385 cap = pci_pcie_cap(dev);
d556ad4b
PO
3386 if (!cap)
3387 return -EINVAL;
3388
3389 ret = pci_read_config_word(dev, cap + PCI_EXP_DEVCTL, &ctl);
3390 if (!ret)
93e75fab 3391 ret = 128 << ((ctl & PCI_EXP_DEVCTL_READRQ) >> 12);
d556ad4b
PO
3392
3393 return ret;
3394}
3395EXPORT_SYMBOL(pcie_get_readrq);
3396
3397/**
3398 * pcie_set_readrq - set PCI Express maximum memory read request
3399 * @dev: PCI device to query
42e61f4a 3400 * @rq: maximum memory read count in bytes
d556ad4b
PO
3401 * valid values are 128, 256, 512, 1024, 2048, 4096
3402 *
c9b378c7 3403 * If possible sets maximum memory read request in bytes
d556ad4b
PO
3404 */
3405int pcie_set_readrq(struct pci_dev *dev, int rq)
3406{
3407 int cap, err = -EINVAL;
3408 u16 ctl, v;
3409
229f5afd 3410 if (rq < 128 || rq > 4096 || !is_power_of_2(rq))
d556ad4b
PO
3411 goto out;
3412
06a1cbaf 3413 cap = pci_pcie_cap(dev);
d556ad4b
PO
3414 if (!cap)
3415 goto out;
3416
3417 err = pci_read_config_word(dev, cap + PCI_EXP_DEVCTL, &ctl);
3418 if (err)
3419 goto out;
a1c473aa
BH
3420 /*
3421 * If using the "performance" PCIe config, we clamp the
3422 * read rq size to the max packet size to prevent the
3423 * host bridge generating requests larger than we can
3424 * cope with
3425 */
3426 if (pcie_bus_config == PCIE_BUS_PERFORMANCE) {
3427 int mps = pcie_get_mps(dev);
3428
3429 if (mps < 0)
3430 return mps;
3431 if (mps < rq)
3432 rq = mps;
3433 }
3434
3435 v = (ffs(rq) - 8) << 12;
d556ad4b
PO
3436
3437 if ((ctl & PCI_EXP_DEVCTL_READRQ) != v) {
3438 ctl &= ~PCI_EXP_DEVCTL_READRQ;
3439 ctl |= v;
c9b378c7 3440 err = pci_write_config_word(dev, cap + PCI_EXP_DEVCTL, ctl);
d556ad4b
PO
3441 }
3442
3443out:
3444 return err;
3445}
3446EXPORT_SYMBOL(pcie_set_readrq);
3447
b03e7495
JM
3448/**
3449 * pcie_get_mps - get PCI Express maximum payload size
3450 * @dev: PCI device to query
3451 *
3452 * Returns maximum payload size in bytes
3453 * or appropriate error value.
3454 */
3455int pcie_get_mps(struct pci_dev *dev)
3456{
3457 int ret, cap;
3458 u16 ctl;
3459
3460 cap = pci_pcie_cap(dev);
3461 if (!cap)
3462 return -EINVAL;
3463
3464 ret = pci_read_config_word(dev, cap + PCI_EXP_DEVCTL, &ctl);
3465 if (!ret)
3466 ret = 128 << ((ctl & PCI_EXP_DEVCTL_PAYLOAD) >> 5);
3467
3468 return ret;
3469}
3470
3471/**
3472 * pcie_set_mps - set PCI Express maximum payload size
3473 * @dev: PCI device to query
47c08f31 3474 * @mps: maximum payload size in bytes
b03e7495
JM
3475 * valid values are 128, 256, 512, 1024, 2048, 4096
3476 *
3477 * If possible sets maximum payload size
3478 */
3479int pcie_set_mps(struct pci_dev *dev, int mps)
3480{
3481 int cap, err = -EINVAL;
3482 u16 ctl, v;
3483
3484 if (mps < 128 || mps > 4096 || !is_power_of_2(mps))
3485 goto out;
3486
3487 v = ffs(mps) - 8;
3488 if (v > dev->pcie_mpss)
3489 goto out;
3490 v <<= 5;
3491
3492 cap = pci_pcie_cap(dev);
3493 if (!cap)
3494 goto out;
3495
3496 err = pci_read_config_word(dev, cap + PCI_EXP_DEVCTL, &ctl);
3497 if (err)
3498 goto out;
3499
3500 if ((ctl & PCI_EXP_DEVCTL_PAYLOAD) != v) {
3501 ctl &= ~PCI_EXP_DEVCTL_PAYLOAD;
3502 ctl |= v;
3503 err = pci_write_config_word(dev, cap + PCI_EXP_DEVCTL, ctl);
3504 }
3505out:
3506 return err;
3507}
3508
c87deff7
HS
3509/**
3510 * pci_select_bars - Make BAR mask from the type of resource
f95d882d 3511 * @dev: the PCI device for which BAR mask is made
c87deff7
HS
3512 * @flags: resource type mask to be selected
3513 *
3514 * This helper routine makes bar mask from the type of resource.
3515 */
3516int pci_select_bars(struct pci_dev *dev, unsigned long flags)
3517{
3518 int i, bars = 0;
3519 for (i = 0; i < PCI_NUM_RESOURCES; i++)
3520 if (pci_resource_flags(dev, i) & flags)
3521 bars |= (1 << i);
3522 return bars;
3523}
3524
613e7ed6
YZ
3525/**
3526 * pci_resource_bar - get position of the BAR associated with a resource
3527 * @dev: the PCI device
3528 * @resno: the resource number
3529 * @type: the BAR type to be filled in
3530 *
3531 * Returns BAR position in config space, or 0 if the BAR is invalid.
3532 */
3533int pci_resource_bar(struct pci_dev *dev, int resno, enum pci_bar_type *type)
3534{
d1b054da
YZ
3535 int reg;
3536
613e7ed6
YZ
3537 if (resno < PCI_ROM_RESOURCE) {
3538 *type = pci_bar_unknown;
3539 return PCI_BASE_ADDRESS_0 + 4 * resno;
3540 } else if (resno == PCI_ROM_RESOURCE) {
3541 *type = pci_bar_mem32;
3542 return dev->rom_base_reg;
d1b054da
YZ
3543 } else if (resno < PCI_BRIDGE_RESOURCES) {
3544 /* device specific resource */
3545 reg = pci_iov_resource_bar(dev, resno, type);
3546 if (reg)
3547 return reg;
613e7ed6
YZ
3548 }
3549
865df576 3550 dev_err(&dev->dev, "BAR %d: invalid resource\n", resno);
613e7ed6
YZ
3551 return 0;
3552}
3553
95a8b6ef
MT
3554/* Some architectures require additional programming to enable VGA */
3555static arch_set_vga_state_t arch_set_vga_state;
3556
3557void __init pci_register_set_vga_state(arch_set_vga_state_t func)
3558{
3559 arch_set_vga_state = func; /* NULL disables */
3560}
3561
3562static int pci_set_vga_state_arch(struct pci_dev *dev, bool decode,
7ad35cf2 3563 unsigned int command_bits, u32 flags)
95a8b6ef
MT
3564{
3565 if (arch_set_vga_state)
3566 return arch_set_vga_state(dev, decode, command_bits,
7ad35cf2 3567 flags);
95a8b6ef
MT
3568 return 0;
3569}
3570
deb2d2ec
BH
3571/**
3572 * pci_set_vga_state - set VGA decode state on device and parents if requested
19eea630
RD
3573 * @dev: the PCI device
3574 * @decode: true = enable decoding, false = disable decoding
3575 * @command_bits: PCI_COMMAND_IO and/or PCI_COMMAND_MEMORY
3f37d622 3576 * @flags: traverse ancestors and change bridges
3448a19d 3577 * CHANGE_BRIDGE_ONLY / CHANGE_BRIDGE
deb2d2ec
BH
3578 */
3579int pci_set_vga_state(struct pci_dev *dev, bool decode,
3448a19d 3580 unsigned int command_bits, u32 flags)
deb2d2ec
BH
3581{
3582 struct pci_bus *bus;
3583 struct pci_dev *bridge;
3584 u16 cmd;
95a8b6ef 3585 int rc;
deb2d2ec 3586
3448a19d 3587 WARN_ON((flags & PCI_VGA_STATE_CHANGE_DECODES) & (command_bits & ~(PCI_COMMAND_IO|PCI_COMMAND_MEMORY)));
deb2d2ec 3588
95a8b6ef 3589 /* ARCH specific VGA enables */
3448a19d 3590 rc = pci_set_vga_state_arch(dev, decode, command_bits, flags);
95a8b6ef
MT
3591 if (rc)
3592 return rc;
3593
3448a19d
DA
3594 if (flags & PCI_VGA_STATE_CHANGE_DECODES) {
3595 pci_read_config_word(dev, PCI_COMMAND, &cmd);
3596 if (decode == true)
3597 cmd |= command_bits;
3598 else
3599 cmd &= ~command_bits;
3600 pci_write_config_word(dev, PCI_COMMAND, cmd);
3601 }
deb2d2ec 3602
3448a19d 3603 if (!(flags & PCI_VGA_STATE_CHANGE_BRIDGE))
deb2d2ec
BH
3604 return 0;
3605
3606 bus = dev->bus;
3607 while (bus) {
3608 bridge = bus->self;
3609 if (bridge) {
3610 pci_read_config_word(bridge, PCI_BRIDGE_CONTROL,
3611 &cmd);
3612 if (decode == true)
3613 cmd |= PCI_BRIDGE_CTL_VGA;
3614 else
3615 cmd &= ~PCI_BRIDGE_CTL_VGA;
3616 pci_write_config_word(bridge, PCI_BRIDGE_CONTROL,
3617 cmd);
3618 }
3619 bus = bus->parent;
3620 }
3621 return 0;
3622}
3623
32a9a682
YS
3624#define RESOURCE_ALIGNMENT_PARAM_SIZE COMMAND_LINE_SIZE
3625static char resource_alignment_param[RESOURCE_ALIGNMENT_PARAM_SIZE] = {0};
e9d1e492 3626static DEFINE_SPINLOCK(resource_alignment_lock);
32a9a682
YS
3627
3628/**
3629 * pci_specified_resource_alignment - get resource alignment specified by user.
3630 * @dev: the PCI device to get
3631 *
3632 * RETURNS: Resource alignment if it is specified.
3633 * Zero if it is not specified.
3634 */
3635resource_size_t pci_specified_resource_alignment(struct pci_dev *dev)
3636{
3637 int seg, bus, slot, func, align_order, count;
3638 resource_size_t align = 0;
3639 char *p;
3640
3641 spin_lock(&resource_alignment_lock);
3642 p = resource_alignment_param;
3643 while (*p) {
3644 count = 0;
3645 if (sscanf(p, "%d%n", &align_order, &count) == 1 &&
3646 p[count] == '@') {
3647 p += count + 1;
3648 } else {
3649 align_order = -1;
3650 }
3651 if (sscanf(p, "%x:%x:%x.%x%n",
3652 &seg, &bus, &slot, &func, &count) != 4) {
3653 seg = 0;
3654 if (sscanf(p, "%x:%x.%x%n",
3655 &bus, &slot, &func, &count) != 3) {
3656 /* Invalid format */
3657 printk(KERN_ERR "PCI: Can't parse resource_alignment parameter: %s\n",
3658 p);
3659 break;
3660 }
3661 }
3662 p += count;
3663 if (seg == pci_domain_nr(dev->bus) &&
3664 bus == dev->bus->number &&
3665 slot == PCI_SLOT(dev->devfn) &&
3666 func == PCI_FUNC(dev->devfn)) {
3667 if (align_order == -1) {
3668 align = PAGE_SIZE;
3669 } else {
3670 align = 1 << align_order;
3671 }
3672 /* Found */
3673 break;
3674 }
3675 if (*p != ';' && *p != ',') {
3676 /* End of param or invalid format */
3677 break;
3678 }
3679 p++;
3680 }
3681 spin_unlock(&resource_alignment_lock);
3682 return align;
3683}
3684
3685/**
3686 * pci_is_reassigndev - check if specified PCI is target device to reassign
3687 * @dev: the PCI device to check
3688 *
3689 * RETURNS: non-zero for PCI device is a target device to reassign,
3690 * or zero is not.
3691 */
3692int pci_is_reassigndev(struct pci_dev *dev)
3693{
3694 return (pci_specified_resource_alignment(dev) != 0);
3695}
3696
2069ecfb
YL
3697/*
3698 * This function disables memory decoding and releases memory resources
3699 * of the device specified by kernel's boot parameter 'pci=resource_alignment='.
3700 * It also rounds up size to specified alignment.
3701 * Later on, the kernel will assign page-aligned memory resource back
3702 * to the device.
3703 */
3704void pci_reassigndev_resource_alignment(struct pci_dev *dev)
3705{
3706 int i;
3707 struct resource *r;
3708 resource_size_t align, size;
3709 u16 command;
3710
3711 if (!pci_is_reassigndev(dev))
3712 return;
3713
3714 if (dev->hdr_type == PCI_HEADER_TYPE_NORMAL &&
3715 (dev->class >> 8) == PCI_CLASS_BRIDGE_HOST) {
3716 dev_warn(&dev->dev,
3717 "Can't reassign resources to host bridge.\n");
3718 return;
3719 }
3720
3721 dev_info(&dev->dev,
3722 "Disabling memory decoding and releasing memory resources.\n");
3723 pci_read_config_word(dev, PCI_COMMAND, &command);
3724 command &= ~PCI_COMMAND_MEMORY;
3725 pci_write_config_word(dev, PCI_COMMAND, command);
3726
3727 align = pci_specified_resource_alignment(dev);
3728 for (i = 0; i < PCI_BRIDGE_RESOURCES; i++) {
3729 r = &dev->resource[i];
3730 if (!(r->flags & IORESOURCE_MEM))
3731 continue;
3732 size = resource_size(r);
3733 if (size < align) {
3734 size = align;
3735 dev_info(&dev->dev,
3736 "Rounding up size of resource #%d to %#llx.\n",
3737 i, (unsigned long long)size);
3738 }
3739 r->end = size - 1;
3740 r->start = 0;
3741 }
3742 /* Need to disable bridge's resource window,
3743 * to enable the kernel to reassign new resource
3744 * window later on.
3745 */
3746 if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE &&
3747 (dev->class >> 8) == PCI_CLASS_BRIDGE_PCI) {
3748 for (i = PCI_BRIDGE_RESOURCES; i < PCI_NUM_RESOURCES; i++) {
3749 r = &dev->resource[i];
3750 if (!(r->flags & IORESOURCE_MEM))
3751 continue;
3752 r->end = resource_size(r) - 1;
3753 r->start = 0;
3754 }
3755 pci_disable_bridge_window(dev);
3756 }
3757}
3758
32a9a682
YS
3759ssize_t pci_set_resource_alignment_param(const char *buf, size_t count)
3760{
3761 if (count > RESOURCE_ALIGNMENT_PARAM_SIZE - 1)
3762 count = RESOURCE_ALIGNMENT_PARAM_SIZE - 1;
3763 spin_lock(&resource_alignment_lock);
3764 strncpy(resource_alignment_param, buf, count);
3765 resource_alignment_param[count] = '\0';
3766 spin_unlock(&resource_alignment_lock);
3767 return count;
3768}
3769
3770ssize_t pci_get_resource_alignment_param(char *buf, size_t size)
3771{
3772 size_t count;
3773 spin_lock(&resource_alignment_lock);
3774 count = snprintf(buf, size, "%s", resource_alignment_param);
3775 spin_unlock(&resource_alignment_lock);
3776 return count;
3777}
3778
3779static ssize_t pci_resource_alignment_show(struct bus_type *bus, char *buf)
3780{
3781 return pci_get_resource_alignment_param(buf, PAGE_SIZE);
3782}
3783
3784static ssize_t pci_resource_alignment_store(struct bus_type *bus,
3785 const char *buf, size_t count)
3786{
3787 return pci_set_resource_alignment_param(buf, count);
3788}
3789
3790BUS_ATTR(resource_alignment, 0644, pci_resource_alignment_show,
3791 pci_resource_alignment_store);
3792
3793static int __init pci_resource_alignment_sysfs_init(void)
3794{
3795 return bus_create_file(&pci_bus_type,
3796 &bus_attr_resource_alignment);
3797}
3798
3799late_initcall(pci_resource_alignment_sysfs_init);
3800
32a2eea7
JG
3801static void __devinit pci_no_domains(void)
3802{
3803#ifdef CONFIG_PCI_DOMAINS
3804 pci_domains_supported = 0;
3805#endif
3806}
3807
0ef5f8f6
AP
3808/**
3809 * pci_ext_cfg_enabled - can we access extended PCI config space?
3810 * @dev: The PCI device of the root bridge.
3811 *
3812 * Returns 1 if we can access PCI extended config space (offsets
3813 * greater than 0xff). This is the default implementation. Architecture
3814 * implementations can override this.
3815 */
3816int __attribute__ ((weak)) pci_ext_cfg_avail(struct pci_dev *dev)
3817{
3818 return 1;
3819}
3820
2d1c8618
BH
3821void __weak pci_fixup_cardbus(struct pci_bus *bus)
3822{
3823}
3824EXPORT_SYMBOL(pci_fixup_cardbus);
3825
ad04d31e 3826static int __init pci_setup(char *str)
1da177e4
LT
3827{
3828 while (str) {
3829 char *k = strchr(str, ',');
3830 if (k)
3831 *k++ = 0;
3832 if (*str && (str = pcibios_setup(str)) && *str) {
309e57df
MW
3833 if (!strcmp(str, "nomsi")) {
3834 pci_no_msi();
7f785763
RD
3835 } else if (!strcmp(str, "noaer")) {
3836 pci_no_aer();
b55438fd
YL
3837 } else if (!strncmp(str, "realloc=", 8)) {
3838 pci_realloc_get_opt(str + 8);
f483d392 3839 } else if (!strncmp(str, "realloc", 7)) {
b55438fd 3840 pci_realloc_get_opt("on");
32a2eea7
JG
3841 } else if (!strcmp(str, "nodomains")) {
3842 pci_no_domains();
4516a618
AN
3843 } else if (!strncmp(str, "cbiosize=", 9)) {
3844 pci_cardbus_io_size = memparse(str + 9, &str);
3845 } else if (!strncmp(str, "cbmemsize=", 10)) {
3846 pci_cardbus_mem_size = memparse(str + 10, &str);
32a9a682
YS
3847 } else if (!strncmp(str, "resource_alignment=", 19)) {
3848 pci_set_resource_alignment_param(str + 19,
3849 strlen(str + 19));
43c16408
AP
3850 } else if (!strncmp(str, "ecrc=", 5)) {
3851 pcie_ecrc_get_policy(str + 5);
28760489
EB
3852 } else if (!strncmp(str, "hpiosize=", 9)) {
3853 pci_hotplug_io_size = memparse(str + 9, &str);
3854 } else if (!strncmp(str, "hpmemsize=", 10)) {
3855 pci_hotplug_mem_size = memparse(str + 10, &str);
5f39e670
JM
3856 } else if (!strncmp(str, "pcie_bus_tune_off", 17)) {
3857 pcie_bus_config = PCIE_BUS_TUNE_OFF;
b03e7495
JM
3858 } else if (!strncmp(str, "pcie_bus_safe", 13)) {
3859 pcie_bus_config = PCIE_BUS_SAFE;
3860 } else if (!strncmp(str, "pcie_bus_perf", 13)) {
3861 pcie_bus_config = PCIE_BUS_PERFORMANCE;
5f39e670
JM
3862 } else if (!strncmp(str, "pcie_bus_peer2peer", 18)) {
3863 pcie_bus_config = PCIE_BUS_PEER2PEER;
309e57df
MW
3864 } else {
3865 printk(KERN_ERR "PCI: Unknown option `%s'\n",
3866 str);
3867 }
1da177e4
LT
3868 }
3869 str = k;
3870 }
0637a70a 3871 return 0;
1da177e4 3872}
0637a70a 3873early_param("pci", pci_setup);
1da177e4 3874
0b62e13b 3875EXPORT_SYMBOL(pci_reenable_device);
b718989d
BH
3876EXPORT_SYMBOL(pci_enable_device_io);
3877EXPORT_SYMBOL(pci_enable_device_mem);
1da177e4 3878EXPORT_SYMBOL(pci_enable_device);
9ac7849e
TH
3879EXPORT_SYMBOL(pcim_enable_device);
3880EXPORT_SYMBOL(pcim_pin_device);
1da177e4 3881EXPORT_SYMBOL(pci_disable_device);
1da177e4
LT
3882EXPORT_SYMBOL(pci_find_capability);
3883EXPORT_SYMBOL(pci_bus_find_capability);
3884EXPORT_SYMBOL(pci_release_regions);
3885EXPORT_SYMBOL(pci_request_regions);
e8de1481 3886EXPORT_SYMBOL(pci_request_regions_exclusive);
1da177e4
LT
3887EXPORT_SYMBOL(pci_release_region);
3888EXPORT_SYMBOL(pci_request_region);
e8de1481 3889EXPORT_SYMBOL(pci_request_region_exclusive);
c87deff7
HS
3890EXPORT_SYMBOL(pci_release_selected_regions);
3891EXPORT_SYMBOL(pci_request_selected_regions);
e8de1481 3892EXPORT_SYMBOL(pci_request_selected_regions_exclusive);
1da177e4 3893EXPORT_SYMBOL(pci_set_master);
6a479079 3894EXPORT_SYMBOL(pci_clear_master);
1da177e4 3895EXPORT_SYMBOL(pci_set_mwi);
694625c0 3896EXPORT_SYMBOL(pci_try_set_mwi);
1da177e4 3897EXPORT_SYMBOL(pci_clear_mwi);
a04ce0ff 3898EXPORT_SYMBOL_GPL(pci_intx);
1da177e4
LT
3899EXPORT_SYMBOL(pci_assign_resource);
3900EXPORT_SYMBOL(pci_find_parent_resource);
c87deff7 3901EXPORT_SYMBOL(pci_select_bars);
1da177e4
LT
3902
3903EXPORT_SYMBOL(pci_set_power_state);
3904EXPORT_SYMBOL(pci_save_state);
3905EXPORT_SYMBOL(pci_restore_state);
e5899e1b 3906EXPORT_SYMBOL(pci_pme_capable);
5a6c9b60 3907EXPORT_SYMBOL(pci_pme_active);
0235c4fc 3908EXPORT_SYMBOL(pci_wake_from_d3);
e5899e1b 3909EXPORT_SYMBOL(pci_target_state);
404cc2d8
RW
3910EXPORT_SYMBOL(pci_prepare_to_sleep);
3911EXPORT_SYMBOL(pci_back_from_sleep);
f7bdd12d 3912EXPORT_SYMBOL_GPL(pci_set_pcie_reset_state);