drivers/pci/pci.c

   1 /*
   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>
  14 #include <linux/pm.h>
  15 #include <linux/module.h>
  16 #include <linux/spinlock.h>
  17 #include <linux/string.h>
  18 #include <linux/log2.h>
  19 #include <linux/pci-aspm.h>
  20 #include <linux/pm_wakeup.h>
  21 #include <linux/interrupt.h>
  22 #include <asm/dma.h>    /* isa_dma_bridge_buggy */
  23 #include <linux/device.h>
  24 #include <asm/setup.h>
  25 #include "pci.h"
  26
  27 const char *pci_power_names[] = {
  28         "error", "D0", "D1", "D2", "D3hot", "D3cold", "unknown",
  29 };
  30 EXPORT_SYMBOL_GPL(pci_power_names);
  31
  32 unsigned int pci_pm_d3_delay = PCI_PM_D3_WAIT;
  33
  34 #ifdef CONFIG_PCI_DOMAINS
  35 int pci_domains_supported = 1;
  36 #endif
  37
  38 #define DEFAULT_CARDBUS_IO_SIZE         (256)
  39 #define DEFAULT_CARDBUS_MEM_SIZE        (64*1024*1024)
  40 /* pci=cbmemsize=nnM,cbiosize=nn can override this */
  41 unsigned long pci_cardbus_io_size = DEFAULT_CARDBUS_IO_SIZE;
  42 unsigned long pci_cardbus_mem_size = DEFAULT_CARDBUS_MEM_SIZE;
  43
  44 #define DEFAULT_HOTPLUG_IO_SIZE         (256)
  45 #define DEFAULT_HOTPLUG_MEM_SIZE        (2*1024*1024)
  46 /* pci=hpmemsize=nnM,hpiosize=nn can override this */
  47 unsigned long pci_hotplug_io_size  = DEFAULT_HOTPLUG_IO_SIZE;
  48 unsigned long pci_hotplug_mem_size = DEFAULT_HOTPLUG_MEM_SIZE;
  49
  50 /*
  51  * The default CLS is used if arch didn't set CLS explicitly and not
  52  * all pci devices agree on the same value.  Arch can override either
  53  * the dfl or actual value as it sees fit.  Don't forget this is
  54  * measured in 32-bit words, not bytes.
  55  */
  56 u8 pci_dfl_cache_line_size __devinitdata = L1_CACHE_BYTES >> 2;
  57 u8 pci_cache_line_size;
  58
  59 /**
  60  * pci_bus_max_busnr - returns maximum PCI bus number of given bus' children
  61  * @bus: pointer to PCI bus structure to search
  62  *
  63  * Given a PCI bus, returns the highest PCI bus number present in the set
  64  * including the given PCI bus and its list of child PCI buses.
  65  */
  66 unsigned char pci_bus_max_busnr(struct pci_bus* bus)
  67 {
  68         struct list_head *tmp;
  69         unsigned char max, n;
  70
  71         max = bus->subordinate;
  72         list_for_each(tmp, &bus->children) {
  73                 n = pci_bus_max_busnr(pci_bus_b(tmp));
  74                 if(n > max)
  75                         max = n;
  76         }
  77         return max;
  78 }
  79 EXPORT_SYMBOL_GPL(pci_bus_max_busnr);
  80
  81 #ifdef CONFIG_HAS_IOMEM
  82 void __iomem *pci_ioremap_bar(struct pci_dev *pdev, int bar)
  83 {
  84         /*
  85          * Make sure the BAR is actually a memory resource, not an IO resource
  86          */
  87         if (!(pci_resource_flags(pdev, bar) & IORESOURCE_MEM)) {
  88                 WARN_ON(1);
  89                 return NULL;
  90         }
  91         return ioremap_nocache(pci_resource_start(pdev, bar),
  92                                      pci_resource_len(pdev, bar));
  93 }
  94 EXPORT_SYMBOL_GPL(pci_ioremap_bar);
  95 #endif
  96
  97 #if 0
  98 /**
  99  * pci_max_busnr - returns maximum PCI bus number
 100  *
 101  * Returns the highest PCI bus number present in the system global list of
 102  * PCI buses.
 103  */
 104 unsigned char __devinit
 105 pci_max_busnr(void)
 106 {
 107         struct pci_bus *bus = NULL;
 108         unsigned char max, n;
 109
 110         max = 0;
 111         while ((bus = pci_find_next_bus(bus)) != NULL) {
 112                 n = pci_bus_max_busnr(bus);
 113                 if(n > max)
 114                         max = n;
 115         }
 116         return max;
 117 }
 118
 119 #endif  /*  0  */
 120
 121 #define PCI_FIND_CAP_TTL        48
 122
 123 static int __pci_find_next_cap_ttl(struct pci_bus *bus, unsigned int devfn,
 124                                    u8 pos, int cap, int *ttl)
 125 {
 126         u8 id;
 127
 128         while ((*ttl)--) {
 129                 pci_bus_read_config_byte(bus, devfn, pos, &pos);
 130                 if (pos < 0x40)
 131                         break;
 132                 pos &= ~3;
 133                 pci_bus_read_config_byte(bus, devfn, pos + PCI_CAP_LIST_ID,
 134                                          &id);
 135                 if (id == 0xff)
 136                         break;
 137                 if (id == cap)
 138                         return pos;
 139                 pos += PCI_CAP_LIST_NEXT;
 140         }
 141         return 0;
 142 }
 143
 144 static int __pci_find_next_cap(struct pci_bus *bus, unsigned int devfn,
 145                                u8 pos, int cap)
 146 {
 147         int ttl = PCI_FIND_CAP_TTL;
 148
 149         return __pci_find_next_cap_ttl(bus, devfn, pos, cap, &ttl);
 150 }
 151
 152 int pci_find_next_capability(struct pci_dev *dev, u8 pos, int cap)
 153 {
 154         return __pci_find_next_cap(dev->bus, dev->devfn,
 155                                    pos + PCI_CAP_LIST_NEXT, cap);
 156 }
 157 EXPORT_SYMBOL_GPL(pci_find_next_capability);
 158
 159 static int __pci_bus_find_cap_start(struct pci_bus *bus,
 160                                     unsigned int devfn, u8 hdr_type)
 161 {
 162         u16 status;
 163
 164         pci_bus_read_config_word(bus, devfn, PCI_STATUS, &status);
 165         if (!(status & PCI_STATUS_CAP_LIST))
 166                 return 0;
 167
 168         switch (hdr_type) {
 169         case PCI_HEADER_TYPE_NORMAL:
 170         case PCI_HEADER_TYPE_BRIDGE:
 171                 return PCI_CAPABILITY_LIST;
 172         case PCI_HEADER_TYPE_CARDBUS:
 173                 return PCI_CB_CAPABILITY_LIST;
 174         default:
 175                 return 0;
 176         }
 177
 178         return 0;
 179 }
 180
 181 /**
 182  * pci_find_capability - query for devices' capabilities
 183  * @dev: PCI device to query
 184  * @cap: capability code
 185  *
 186  * Tell if a device supports a given PCI capability.
 187  * Returns the address of the requested capability structure within the
 188  * device's PCI configuration space or 0 in case the device does not
 189  * support it.  Possible values for @cap:
 190  *
 191  *  %PCI_CAP_ID_PM           Power Management
 192  *  %PCI_CAP_ID_AGP          Accelerated Graphics Port
 193  *  %PCI_CAP_ID_VPD          Vital Product Data
 194  *  %PCI_CAP_ID_SLOTID       Slot Identification
 195  *  %PCI_CAP_ID_MSI          Message Signalled Interrupts
 196  *  %PCI_CAP_ID_CHSWP        CompactPCI HotSwap
 197  *  %PCI_CAP_ID_PCIX         PCI-X
 198  *  %PCI_CAP_ID_EXP          PCI Express
 199  */
 200 int pci_find_capability(struct pci_dev *dev, int cap)
 201 {
 202         int pos;
 203
 204         pos = __pci_bus_find_cap_start(dev->bus, dev->devfn, dev->hdr_type);
 205         if (pos)
 206                 pos = __pci_find_next_cap(dev->bus, dev->devfn, pos, cap);
 207
 208         return pos;
 209 }
 210
 211 /**
 212  * pci_bus_find_capability - query for devices' capabilities
 213  * @bus:   the PCI bus to query
 214  * @devfn: PCI device to query
 215  * @cap:   capability code
 216  *
 217  * Like pci_find_capability() but works for pci devices that do not have a
 218  * pci_dev structure set up yet.
 219  *
 220  * Returns the address of the requested capability structure within the
 221  * device's PCI configuration space or 0 in case the device does not
 222  * support it.
 223  */
 224 int pci_bus_find_capability(struct pci_bus *bus, unsigned int devfn, int cap)
 225 {
 226         int pos;
 227         u8 hdr_type;
 228
 229         pci_bus_read_config_byte(bus, devfn, PCI_HEADER_TYPE, &hdr_type);
 230
 231         pos = __pci_bus_find_cap_start(bus, devfn, hdr_type & 0x7f);
 232         if (pos)
 233                 pos = __pci_find_next_cap(bus, devfn, pos, cap);
 234
 235         return pos;
 236 }
 237
 238 /**
 239  * pci_find_ext_capability - Find an extended capability
 240  * @dev: PCI device to query
 241  * @cap: capability code
 242  *
 243  * Returns the address of the requested extended capability structure
 244  * within the device's PCI configuration space or 0 if the device does
 245  * not support it.  Possible values for @cap:
 246  *
 247  *  %PCI_EXT_CAP_ID_ERR         Advanced Error Reporting
 248  *  %PCI_EXT_CAP_ID_VC          Virtual Channel
 249  *  %PCI_EXT_CAP_ID_DSN         Device Serial Number
 250  *  %PCI_EXT_CAP_ID_PWR         Power Budgeting
 251  */
 252 int pci_find_ext_capability(struct pci_dev *dev, int cap)
 253 {
 254         u32 header;
 255         int ttl;
 256         int pos = PCI_CFG_SPACE_SIZE;
 257
 258         /* minimum 8 bytes per capability */
 259         ttl = (PCI_CFG_SPACE_EXP_SIZE - PCI_CFG_SPACE_SIZE) / 8;
 260
 261         if (dev->cfg_size <= PCI_CFG_SPACE_SIZE)
 262                 return 0;
 263
 264         if (pci_read_config_dword(dev, pos, &header) != PCIBIOS_SUCCESSFUL)
 265                 return 0;
 266
 267         /*
 268          * If we have no capabilities, this is indicated by cap ID,
 269          * cap version and next pointer all being 0.
 270          */
 271         if (header == 0)
 272                 return 0;
 273
 274         while (ttl-- > 0) {
 275                 if (PCI_EXT_CAP_ID(header) == cap)
 276                         return pos;
 277
 278                 pos = PCI_EXT_CAP_NEXT(header);
 279                 if (pos < PCI_CFG_SPACE_SIZE)
 280                         break;
 281
 282                 if (pci_read_config_dword(dev, pos, &header) != PCIBIOS_SUCCESSFUL)
 283                         break;
 284         }
 285
 286         return 0;
 287 }
 288 EXPORT_SYMBOL_GPL(pci_find_ext_capability);
 289
 290 static int __pci_find_next_ht_cap(struct pci_dev *dev, int pos, int ht_cap)
 291 {
 292         int rc, ttl = PCI_FIND_CAP_TTL;
 293         u8 cap, mask;
 294
 295         if (ht_cap == HT_CAPTYPE_SLAVE || ht_cap == HT_CAPTYPE_HOST)
 296                 mask = HT_3BIT_CAP_MASK;
 297         else
 298                 mask = HT_5BIT_CAP_MASK;
 299
 300         pos = __pci_find_next_cap_ttl(dev->bus, dev->devfn, pos,
 301                                       PCI_CAP_ID_HT, &ttl);
 302         while (pos) {
 303                 rc = pci_read_config_byte(dev, pos + 3, &cap);
 304                 if (rc != PCIBIOS_SUCCESSFUL)
 305                         return 0;
 306
 307                 if ((cap & mask) == ht_cap)
 308                         return pos;
 309
 310                 pos = __pci_find_next_cap_ttl(dev->bus, dev->devfn,
 311                                               pos + PCI_CAP_LIST_NEXT,
 312                                               PCI_CAP_ID_HT, &ttl);
 313         }
 314
 315         return 0;
 316 }
 317 /**
 318  * pci_find_next_ht_capability - query a device's Hypertransport capabilities
 319  * @dev: PCI device to query
 320  * @pos: Position from which to continue searching
 321  * @ht_cap: Hypertransport capability code
 322  *
 323  * To be used in conjunction with pci_find_ht_capability() to search for
 324  * all capabilities matching @ht_cap. @pos should always be a value returned
 325  * from pci_find_ht_capability().
 326  *
 327  * NB. To be 100% safe against broken PCI devices, the caller should take
 328  * steps to avoid an infinite loop.
 329  */
 330 int pci_find_next_ht_capability(struct pci_dev *dev, int pos, int ht_cap)
 331 {
 332         return __pci_find_next_ht_cap(dev, pos + PCI_CAP_LIST_NEXT, ht_cap);
 333 }
 334 EXPORT_SYMBOL_GPL(pci_find_next_ht_capability);
 335
 336 /**
 337  * pci_find_ht_capability - query a device's Hypertransport capabilities
 338  * @dev: PCI device to query
 339  * @ht_cap: Hypertransport capability code
 340  *
 341  * Tell if a device supports a given Hypertransport capability.
 342  * Returns an address within the device's PCI configuration space
 343  * or 0 in case the device does not support the request capability.
 344  * The address points to the PCI capability, of type PCI_CAP_ID_HT,
 345  * which has a Hypertransport capability matching @ht_cap.
 346  */
 347 int pci_find_ht_capability(struct pci_dev *dev, int ht_cap)
 348 {
 349         int pos;
 350
 351         pos = __pci_bus_find_cap_start(dev->bus, dev->devfn, dev->hdr_type);
 352         if (pos)
 353                 pos = __pci_find_next_ht_cap(dev, pos, ht_cap);
 354
 355         return pos;
 356 }
 357 EXPORT_SYMBOL_GPL(pci_find_ht_capability);
 358
 359 /**
 360  * pci_find_parent_resource - return resource region of parent bus of given region
 361  * @dev: PCI device structure contains resources to be searched
 362  * @res: child resource record for which parent is sought
 363  *
 364  *  For given resource region of given device, return the resource
 365  *  region of parent bus the given region is contained in or where
 366  *  it should be allocated from.
 367  */
 368 struct resource *
 369 pci_find_parent_resource(const struct pci_dev *dev, struct resource *res)
 370 {
 371         const struct pci_bus *bus = dev->bus;
 372         int i;
 373         struct resource *best = NULL;
 374
 375         for(i = 0; i < PCI_BUS_NUM_RESOURCES; i++) {
 376                 struct resource *r = bus->resource[i];
 377                 if (!r)
 378                         continue;
 379                 if (res->start && !(res->start >= r->start && res->end <= r->end))
 380                         continue;       /* Not contained */
 381                 if ((res->flags ^ r->flags) & (IORESOURCE_IO | IORESOURCE_MEM))
 382                         continue;       /* Wrong type */
 383                 if (!((res->flags ^ r->flags) & IORESOURCE_PREFETCH))
 384                         return r;       /* Exact match */
 385                 if ((res->flags & IORESOURCE_PREFETCH) && !(r->flags & IORESOURCE_PREFETCH))
 386                         best = r;       /* Approximating prefetchable by non-prefetchable */
 387         }
 388         return best;
 389 }
 390
 391 /**
 392  * pci_restore_bars - restore a devices BAR values (e.g. after wake-up)
 393  * @dev: PCI device to have its BARs restored
 394  *
 395  * Restore the BAR values for a given device, so as to make it
 396  * accessible by its driver.
 397  */
 398 static void
 399 pci_restore_bars(struct pci_dev *dev)
 400 {
 401         int i;
 402
 403         for (i = 0; i < PCI_BRIDGE_RESOURCES; i++)
 404                 pci_update_resource(dev, i);
 405 }
 406
 407 static struct pci_platform_pm_ops *pci_platform_pm;
 408
 409 int pci_set_platform_pm(struct pci_platform_pm_ops *ops)
 410 {
 411         if (!ops->is_manageable || !ops->set_state || !ops->choose_state
 412             || !ops->sleep_wake || !ops->can_wakeup)
 413                 return -EINVAL;
 414         pci_platform_pm = ops;
 415         return 0;
 416 }
 417
 418 static inline bool platform_pci_power_manageable(struct pci_dev *dev)
 419 {
 420         return pci_platform_pm ? pci_platform_pm->is_manageable(dev) : false;
 421 }
 422
 423 static inline int platform_pci_set_power_state(struct pci_dev *dev,
 424                                                 pci_power_t t)
 425 {
 426         return pci_platform_pm ? pci_platform_pm->set_state(dev, t) : -ENOSYS;
 427 }
 428
 429 static inline pci_power_t platform_pci_choose_state(struct pci_dev *dev)
 430 {
 431         return pci_platform_pm ?
 432                         pci_platform_pm->choose_state(dev) : PCI_POWER_ERROR;
 433 }
 434
 435 static inline bool platform_pci_can_wakeup(struct pci_dev *dev)
 436 {
 437         return pci_platform_pm ? pci_platform_pm->can_wakeup(dev) : false;
 438 }
 439
 440 static inline int platform_pci_sleep_wake(struct pci_dev *dev, bool enable)
 441 {
 442         return pci_platform_pm ?
 443                         pci_platform_pm->sleep_wake(dev, enable) : -ENODEV;
 444 }
 445
 446 /**
 447  * pci_raw_set_power_state - Use PCI PM registers to set the power state of
 448  *                           given PCI device
 449  * @dev: PCI device to handle.
 450  * @state: PCI power state (D0, D1, D2, D3hot) to put the device into.
 451  *
 452  * RETURN VALUE:
 453  * -EINVAL if the requested state is invalid.
 454  * -EIO if device does not support PCI PM or its PM capabilities register has a
 455  * wrong version, or device doesn't support the requested state.
 456  * 0 if device already is in the requested state.
 457  * 0 if device's power state has been successfully changed.
 458  */
 459 static int pci_raw_set_power_state(struct pci_dev *dev, pci_power_t state)
 460 {
 461         u16 pmcsr;
 462         bool need_restore = false;
 463
 464         /* Check if we're already there */
 465         if (dev->current_state == state)
 466                 return 0;
 467
 468         if (!dev->pm_cap)
 469                 return -EIO;
 470
 471         if (state < PCI_D0 || state > PCI_D3hot)
 472                 return -EINVAL;
 473
 474         /* Validate current state:
 475          * Can enter D0 from any state, but if we can only go deeper
 476          * to sleep if we're already in a low power state
 477          */
 478         if (state != PCI_D0 && dev->current_state <= PCI_D3cold
 479             && dev->current_state > state) {
 480                 dev_err(&dev->dev, "invalid power transition "
 481                         "(from state %d to %d)\n", dev->current_state, state);
 482                 return -EINVAL;
 483         }
 484
 485         /* check if this device supports the desired state */
 486         if ((state == PCI_D1 && !dev->d1_support)
 487            || (state == PCI_D2 && !dev->d2_support))
 488                 return -EIO;
 489
 490         pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
 491
 492         /* If we're (effectively) in D3, force entire word to 0.
 493          * This doesn't affect PME_Status, disables PME_En, and
 494          * sets PowerState to 0.
 495          */
 496         switch (dev->current_state) {
 497         case PCI_D0:
 498         case PCI_D1:
 499         case PCI_D2:
 500                 pmcsr &= ~PCI_PM_CTRL_STATE_MASK;
 501                 pmcsr |= state;
 502                 break;
 503         case PCI_D3hot:
 504         case PCI_D3cold:
 505         case PCI_UNKNOWN: /* Boot-up */
 506                 if ((pmcsr & PCI_PM_CTRL_STATE_MASK) == PCI_D3hot
 507                  && !(pmcsr & PCI_PM_CTRL_NO_SOFT_RESET))
 508                         need_restore = true;
 509                 /* Fall-through: force to D0 */
 510         default:
 511                 pmcsr = 0;
 512                 break;
 513         }
 514
 515         /* enter specified state */
 516         pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, pmcsr);
 517
 518         /* Mandatory power management transition delays */
 519         /* see PCI PM 1.1 5.6.1 table 18 */
 520         if (state == PCI_D3hot || dev->current_state == PCI_D3hot)
 521                 msleep(pci_pm_d3_delay);
 522         else if (state == PCI_D2 || dev->current_state == PCI_D2)
 523                 udelay(PCI_PM_D2_DELAY);
 524
 525         pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
 526         dev->current_state = (pmcsr & PCI_PM_CTRL_STATE_MASK);
 527         if (dev->current_state != state && printk_ratelimit())
 528                 dev_info(&dev->dev, "Refused to change power state, "
 529                         "currently in D%d\n", dev->current_state);
 530
 531         /* According to section 5.4.1 of the "PCI BUS POWER MANAGEMENT
 532          * INTERFACE SPECIFICATION, REV. 1.2", a device transitioning
 533          * from D3hot to D0 _may_ perform an internal reset, thereby
 534          * going to "D0 Uninitialized" rather than "D0 Initialized".
 535          * For example, at least some versions of the 3c905B and the
 536          * 3c556B exhibit this behaviour.
 537          *
 538          * At least some laptop BIOSen (e.g. the Thinkpad T21) leave
 539          * devices in a D3hot state at boot.  Consequently, we need to
 540          * restore at least the BARs so that the device will be
 541          * accessible to its driver.
 542          */
 543         if (need_restore)
 544                 pci_restore_bars(dev);
 545
 546         if (dev->bus->self)
 547                 pcie_aspm_pm_state_change(dev->bus->self);
 548
 549         return 0;
 550 }
 551
 552 /**
 553  * pci_update_current_state - Read PCI power state of given device from its
 554  *                            PCI PM registers and cache it
 555  * @dev: PCI device to handle.
 556  * @state: State to cache in case the device doesn't have the PM capability
 557  */
 558 void pci_update_current_state(struct pci_dev *dev, pci_power_t state)
 559 {
 560         if (dev->pm_cap) {
 561                 u16 pmcsr;
 562
 563                 pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
 564                 dev->current_state = (pmcsr & PCI_PM_CTRL_STATE_MASK);
 565         } else {
 566                 dev->current_state = state;
 567         }
 568 }
 569
 570 /**
 571  * pci_platform_power_transition - Use platform to change device power state
 572  * @dev: PCI device to handle.
 573  * @state: State to put the device into.
 574  */
 575 static int pci_platform_power_transition(struct pci_dev *dev, pci_power_t state)
 576 {
 577         int error;
 578
 579         if (platform_pci_power_manageable(dev)) {
 580                 error = platform_pci_set_power_state(dev, state);
 581                 if (!error)
 582                         pci_update_current_state(dev, state);
 583         } else {
 584                 error = -ENODEV;
 585                 /* Fall back to PCI_D0 if native PM is not supported */
 586                 if (!dev->pm_cap)
 587                         dev->current_state = PCI_D0;
 588         }
 589
 590         return error;
 591 }
 592
 593 /**
 594  * __pci_start_power_transition - Start power transition of a PCI device
 595  * @dev: PCI device to handle.
 596  * @state: State to put the device into.
 597  */
 598 static void __pci_start_power_transition(struct pci_dev *dev, pci_power_t state)
 599 {
 600         if (state == PCI_D0)
 601                 pci_platform_power_transition(dev, PCI_D0);
 602 }
 603
 604 /**
 605  * __pci_complete_power_transition - Complete power transition of a PCI device
 606  * @dev: PCI device to handle.
 607  * @state: State to put the device into.
 608  *
 609  * This function should not be called directly by device drivers.
 610  */
 611 int __pci_complete_power_transition(struct pci_dev *dev, pci_power_t state)
 612 {
 613         return state > PCI_D0 ?
 614                         pci_platform_power_transition(dev, state) : -EINVAL;
 615 }
 616 EXPORT_SYMBOL_GPL(__pci_complete_power_transition);
 617
 618 /**
 619  * pci_set_power_state - Set the power state of a PCI device
 620  * @dev: PCI device to handle.
 621  * @state: PCI power state (D0, D1, D2, D3hot) to put the device into.
 622  *
 623  * Transition a device to a new power state, using the platform firmware and/or
 624  * the device's PCI PM registers.
 625  *
 626  * RETURN VALUE:
 627  * -EINVAL if the requested state is invalid.
 628  * -EIO if device does not support PCI PM or its PM capabilities register has a
 629  * wrong version, or device doesn't support the requested state.
 630  * 0 if device already is in the requested state.
 631  * 0 if device's power state has been successfully changed.
 632  */
 633 int pci_set_power_state(struct pci_dev *dev, pci_power_t state)
 634 {
 635         int error;
 636
 637         /* bound the state we're entering */
 638         if (state > PCI_D3hot)
 639                 state = PCI_D3hot;
 640         else if (state < PCI_D0)
 641                 state = PCI_D0;
 642         else if ((state == PCI_D1 || state == PCI_D2) && pci_no_d1d2(dev))
 643                 /*
 644                  * If the device or the parent bridge do not support PCI PM,
 645                  * ignore the request if we're doing anything other than putting
 646                  * it into D0 (which would only happen on boot).
 647                  */
 648                 return 0;
 649
 650         /* Check if we're already there */
 651         if (dev->current_state == state)
 652                 return 0;
 653
 654         __pci_start_power_transition(dev, state);
 655
 656         /* This device is quirked not to be put into D3, so
 657            don't put it in D3 */
 658         if (state == PCI_D3hot && (dev->dev_flags & PCI_DEV_FLAGS_NO_D3))
 659                 return 0;
 660
 661         error = pci_raw_set_power_state(dev, state);
 662
 663         if (!__pci_complete_power_transition(dev, state))
 664                 error = 0;
 665
 666         return error;
 667 }
 668
 669 /**
 670  * pci_choose_state - Choose the power state of a PCI device
 671  * @dev: PCI device to be suspended
 672  * @state: target sleep state for the whole system. This is the value
 673  *      that is passed to suspend() function.
 674  *
 675  * Returns PCI power state suitable for given device and given system
 676  * message.
 677  */
 678
 679 pci_power_t pci_choose_state(struct pci_dev *dev, pm_message_t state)
 680 {
 681         pci_power_t ret;
 682
 683         if (!pci_find_capability(dev, PCI_CAP_ID_PM))
 684                 return PCI_D0;
 685
 686         ret = platform_pci_choose_state(dev);
 687         if (ret != PCI_POWER_ERROR)
 688                 return ret;
 689
 690         switch (state.event) {
 691         case PM_EVENT_ON:
 692                 return PCI_D0;
 693         case PM_EVENT_FREEZE:
 694         case PM_EVENT_PRETHAW:
 695                 /* REVISIT both freeze and pre-thaw "should" use D0 */
 696         case PM_EVENT_SUSPEND:
 697         case PM_EVENT_HIBERNATE:
 698                 return PCI_D3hot;
 699         default:
 700                 dev_info(&dev->dev, "unrecognized suspend event %d\n",
 701                          state.event);
 702                 BUG();
 703         }
 704         return PCI_D0;
 705 }
 706
 707 EXPORT_SYMBOL(pci_choose_state);
 708
 709 #define PCI_EXP_SAVE_REGS       7
 710
 711 #define pcie_cap_has_devctl(type, flags)        1
 712 #define pcie_cap_has_lnkctl(type, flags)                \
 713                 ((flags & PCI_EXP_FLAGS_VERS) > 1 ||    \
 714                  (type == PCI_EXP_TYPE_ROOT_PORT ||     \
 715                   type == PCI_EXP_TYPE_ENDPOINT ||      \
 716                   type == PCI_EXP_TYPE_LEG_END))
 717 #define pcie_cap_has_sltctl(type, flags)                \
 718                 ((flags & PCI_EXP_FLAGS_VERS) > 1 ||    \
 719                  ((type == PCI_EXP_TYPE_ROOT_PORT) ||   \
 720                   (type == PCI_EXP_TYPE_DOWNSTREAM &&   \
 721                    (flags & PCI_EXP_FLAGS_SLOT))))
 722 #define pcie_cap_has_rtctl(type, flags)                 \
 723                 ((flags & PCI_EXP_FLAGS_VERS) > 1 ||    \
 724                  (type == PCI_EXP_TYPE_ROOT_PORT ||     \
 725                   type == PCI_EXP_TYPE_RC_EC))
 726 #define pcie_cap_has_devctl2(type, flags)               \
 727                 ((flags & PCI_EXP_FLAGS_VERS) > 1)
 728 #define pcie_cap_has_lnkctl2(type, flags)               \
 729                 ((flags & PCI_EXP_FLAGS_VERS) > 1)
 730 #define pcie_cap_has_sltctl2(type, flags)               \
 731                 ((flags & PCI_EXP_FLAGS_VERS) > 1)
 732
 733 static int pci_save_pcie_state(struct pci_dev *dev)
 734 {
 735         int pos, i = 0;
 736         struct pci_cap_saved_state *save_state;
 737         u16 *cap;
 738         u16 flags;
 739
 740         pos = pci_find_capability(dev, PCI_CAP_ID_EXP);
 741         if (pos <= 0)
 742                 return 0;
 743
 744         save_state = pci_find_saved_cap(dev, PCI_CAP_ID_EXP);
 745         if (!save_state) {
 746                 dev_err(&dev->dev, "buffer not found in %s\n", __func__);
 747                 return -ENOMEM;
 748         }
 749         cap = (u16 *)&save_state->data[0];
 750
 751         pci_read_config_word(dev, pos + PCI_EXP_FLAGS, &flags);
 752
 753         if (pcie_cap_has_devctl(dev->pcie_type, flags))
 754                 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL, &cap[i++]);
 755         if (pcie_cap_has_lnkctl(dev->pcie_type, flags))
 756                 pci_read_config_word(dev, pos + PCI_EXP_LNKCTL, &cap[i++]);
 757         if (pcie_cap_has_sltctl(dev->pcie_type, flags))
 758                 pci_read_config_word(dev, pos + PCI_EXP_SLTCTL, &cap[i++]);
 759         if (pcie_cap_has_rtctl(dev->pcie_type, flags))
 760                 pci_read_config_word(dev, pos + PCI_EXP_RTCTL, &cap[i++]);
 761         if (pcie_cap_has_devctl2(dev->pcie_type, flags))
 762                 pci_read_config_word(dev, pos + PCI_EXP_DEVCTL2, &cap[i++]);
 763         if (pcie_cap_has_lnkctl2(dev->pcie_type, flags))
 764                 pci_read_config_word(dev, pos + PCI_EXP_LNKCTL2, &cap[i++]);
 765         if (pcie_cap_has_sltctl2(dev->pcie_type, flags))
 766                 pci_read_config_word(dev, pos + PCI_EXP_SLTCTL2, &cap[i++]);
 767
 768         return 0;
 769 }
 770
 771 static void pci_restore_pcie_state(struct pci_dev *dev)
 772 {
 773         int i = 0, pos;
 774         struct pci_cap_saved_state *save_state;
 775         u16 *cap;
 776         u16 flags;
 777
 778         save_state = pci_find_saved_cap(dev, PCI_CAP_ID_EXP);
 779         pos = pci_find_capability(dev, PCI_CAP_ID_EXP);
 780         if (!save_state || pos <= 0)
 781                 return;
 782         cap = (u16 *)&save_state->data[0];
 783
 784         pci_read_config_word(dev, pos + PCI_EXP_FLAGS, &flags);
 785
 786         if (pcie_cap_has_devctl(dev->pcie_type, flags))
 787                 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL, cap[i++]);
 788         if (pcie_cap_has_lnkctl(dev->pcie_type, flags))
 789                 pci_write_config_word(dev, pos + PCI_EXP_LNKCTL, cap[i++]);
 790         if (pcie_cap_has_sltctl(dev->pcie_type, flags))
 791                 pci_write_config_word(dev, pos + PCI_EXP_SLTCTL, cap[i++]);
 792         if (pcie_cap_has_rtctl(dev->pcie_type, flags))
 793                 pci_write_config_word(dev, pos + PCI_EXP_RTCTL, cap[i++]);
 794         if (pcie_cap_has_devctl2(dev->pcie_type, flags))
 795                 pci_write_config_word(dev, pos + PCI_EXP_DEVCTL2, cap[i++]);
 796         if (pcie_cap_has_lnkctl2(dev->pcie_type, flags))
 797                 pci_write_config_word(dev, pos + PCI_EXP_LNKCTL2, cap[i++]);
 798         if (pcie_cap_has_sltctl2(dev->pcie_type, flags))
 799                 pci_write_config_word(dev, pos + PCI_EXP_SLTCTL2, cap[i++]);
 800 }
 801
 802
 803 static int pci_save_pcix_state(struct pci_dev *dev)
 804 {
 805         int pos;
 806         struct pci_cap_saved_state *save_state;
 807
 808         pos = pci_find_capability(dev, PCI_CAP_ID_PCIX);
 809         if (pos <= 0)
 810                 return 0;
 811
 812         save_state = pci_find_saved_cap(dev, PCI_CAP_ID_PCIX);
 813         if (!save_state) {
 814                 dev_err(&dev->dev, "buffer not found in %s\n", __func__);
 815                 return -ENOMEM;
 816         }
 817
 818         pci_read_config_word(dev, pos + PCI_X_CMD, (u16 *)save_state->data);
 819
 820         return 0;
 821 }
 822
 823 static void pci_restore_pcix_state(struct pci_dev *dev)
 824 {
 825         int i = 0, pos;
 826         struct pci_cap_saved_state *save_state;
 827         u16 *cap;
 828
 829         save_state = pci_find_saved_cap(dev, PCI_CAP_ID_PCIX);
 830         pos = pci_find_capability(dev, PCI_CAP_ID_PCIX);
 831         if (!save_state || pos <= 0)
 832                 return;
 833         cap = (u16 *)&save_state->data[0];
 834
 835         pci_write_config_word(dev, pos + PCI_X_CMD, cap[i++]);
 836 }
 837
 838
 839 /**
 840  * pci_save_state - save the PCI configuration space of a device before suspending
 841  * @dev: - PCI device that we're dealing with
 842  */
 843 int
 844 pci_save_state(struct pci_dev *dev)
 845 {
 846         int i;
 847         /* XXX: 100% dword access ok here? */
 848         for (i = 0; i < 16; i++)
 849                 pci_read_config_dword(dev, i * 4,&dev->saved_config_space[i]);
 850         dev->state_saved = true;
 851         if ((i = pci_save_pcie_state(dev)) != 0)
 852                 return i;
 853         if ((i = pci_save_pcix_state(dev)) != 0)
 854                 return i;
 855         return 0;
 856 }
 857
 858 /**
 859  * pci_restore_state - Restore the saved state of a PCI device
 860  * @dev: - PCI device that we're dealing with
 861  */
 862 int
 863 pci_restore_state(struct pci_dev *dev)
 864 {
 865         int i;
 866         u32 val;
 867
 868         if (!dev->state_saved)
 869                 return 0;
 870
 871         /* PCI Express register must be restored first */
 872         pci_restore_pcie_state(dev);
 873
 874         /*
 875          * The Base Address register should be programmed before the command
 876          * register(s)
 877          */
 878         for (i = 15; i >= 0; i--) {
 879                 pci_read_config_dword(dev, i * 4, &val);
 880                 if (val != dev->saved_config_space[i]) {
 881                         dev_printk(KERN_DEBUG, &dev->dev, "restoring config "
 882                                 "space at offset %#x (was %#x, writing %#x)\n",
 883                                 i, val, (int)dev->saved_config_space[i]);
 884                         pci_write_config_dword(dev,i * 4,
 885                                 dev->saved_config_space[i]);
 886                 }
 887         }
 888         pci_restore_pcix_state(dev);
 889         pci_restore_msi_state(dev);
 890         pci_restore_iov_state(dev);
 891
 892         dev->state_saved = false;
 893
 894         return 0;
 895 }
 896
 897 static int do_pci_enable_device(struct pci_dev *dev, int bars)
 898 {
 899         int err;
 900
 901         err = pci_set_power_state(dev, PCI_D0);
 902         if (err < 0 && err != -EIO)
 903                 return err;
 904         err = pcibios_enable_device(dev, bars);
 905         if (err < 0)
 906                 return err;
 907         pci_fixup_device(pci_fixup_enable, dev);
 908
 909         return 0;
 910 }
 911
 912 /**
 913  * pci_reenable_device - Resume abandoned device
 914  * @dev: PCI device to be resumed
 915  *
 916  *  Note this function is a backend of pci_default_resume and is not supposed
 917  *  to be called by normal code, write proper resume handler and use it instead.
 918  */
 919 int pci_reenable_device(struct pci_dev *dev)
 920 {
 921         if (pci_is_enabled(dev))
 922                 return do_pci_enable_device(dev, (1 << PCI_NUM_RESOURCES) - 1);
 923         return 0;
 924 }
 925
 926 static int __pci_enable_device_flags(struct pci_dev *dev,
 927                                      resource_size_t flags)
 928 {
 929         int err;
 930         int i, bars = 0;
 931
 932         if (atomic_add_return(1, &dev->enable_cnt) > 1)
 933                 return 0;               /* already enabled */
 934
 935         for (i = 0; i < DEVICE_COUNT_RESOURCE; i++)
 936                 if (dev->resource[i].flags & flags)
 937                         bars |= (1 << i);
 938
 939         err = do_pci_enable_device(dev, bars);
 940         if (err < 0)
 941                 atomic_dec(&dev->enable_cnt);
 942         return err;
 943 }
 944
 945 /**
 946  * pci_enable_device_io - Initialize a device for use with IO space
 947  * @dev: PCI device to be initialized
 948  *
 949  *  Initialize device before it's used by a driver. Ask low-level code
 950  *  to enable I/O resources. Wake up the device if it was suspended.
 951  *  Beware, this function can fail.
 952  */
 953 int pci_enable_device_io(struct pci_dev *dev)
 954 {
 955         return __pci_enable_device_flags(dev, IORESOURCE_IO);
 956 }
 957
 958 /**
 959  * pci_enable_device_mem - Initialize a device for use with Memory space
 960  * @dev: PCI device to be initialized
 961  *
 962  *  Initialize device before it's used by a driver. Ask low-level code
 963  *  to enable Memory resources. Wake up the device if it was suspended.
 964  *  Beware, this function can fail.
 965  */
 966 int pci_enable_device_mem(struct pci_dev *dev)
 967 {
 968         return __pci_enable_device_flags(dev, IORESOURCE_MEM);
 969 }
 970
 971 /**
 972  * pci_enable_device - Initialize device before it's used by a driver.
 973  * @dev: PCI device to be initialized
 974  *
 975  *  Initialize device before it's used by a driver. Ask low-level code
 976  *  to enable I/O and memory. Wake up the device if it was suspended.
 977  *  Beware, this function can fail.
 978  *
 979  *  Note we don't actually enable the device many times if we call
 980  *  this function repeatedly (we just increment the count).
 981  */
 982 int pci_enable_device(struct pci_dev *dev)
 983 {
 984         return __pci_enable_device_flags(dev, IORESOURCE_MEM | IORESOURCE_IO);
 985 }
 986
 987 /*
 988  * Managed PCI resources.  This manages device on/off, intx/msi/msix
 989  * on/off and BAR regions.  pci_dev itself records msi/msix status, so
 990  * there's no need to track it separately.  pci_devres is initialized
 991  * when a device is enabled using managed PCI device enable interface.
 992  */
 993 struct pci_devres {
 994         unsigned int enabled:1;
 995         unsigned int pinned:1;
 996         unsigned int orig_intx:1;
 997         unsigned int restore_intx:1;
 998         u32 region_mask;
 999 };
1000
1001 static void pcim_release(struct device *gendev, void *res)
1002 {
1003         struct pci_dev *dev = container_of(gendev, struct pci_dev, dev);
1004         struct pci_devres *this = res;
1005         int i;
1006
1007         if (dev->msi_enabled)
1008                 pci_disable_msi(dev);
1009         if (dev->msix_enabled)
1010                 pci_disable_msix(dev);
1011
1012         for (i = 0; i < DEVICE_COUNT_RESOURCE; i++)
1013                 if (this->region_mask & (1 << i))
1014                         pci_release_region(dev, i);
1015
1016         if (this->restore_intx)
1017                 pci_intx(dev, this->orig_intx);
1018
1019         if (this->enabled && !this->pinned)
1020                 pci_disable_device(dev);
1021 }
1022
1023 static struct pci_devres * get_pci_dr(struct pci_dev *pdev)
1024 {
1025         struct pci_devres *dr, *new_dr;
1026
1027         dr = devres_find(&pdev->dev, pcim_release, NULL, NULL);
1028         if (dr)
1029                 return dr;
1030
1031         new_dr = devres_alloc(pcim_release, sizeof(*new_dr), GFP_KERNEL);
1032         if (!new_dr)
1033                 return NULL;
1034         return devres_get(&pdev->dev, new_dr, NULL, NULL);
1035 }
1036
1037 static struct pci_devres * find_pci_dr(struct pci_dev *pdev)
1038 {
1039         if (pci_is_managed(pdev))
1040                 return devres_find(&pdev->dev, pcim_release, NULL, NULL);
1041         return NULL;
1042 }
1043
1044 /**
1045  * pcim_enable_device - Managed pci_enable_device()
1046  * @pdev: PCI device to be initialized
1047  *
1048  * Managed pci_enable_device().
1049  */
1050 int pcim_enable_device(struct pci_dev *pdev)
1051 {
1052         struct pci_devres *dr;
1053         int rc;
1054
1055         dr = get_pci_dr(pdev);
1056         if (unlikely(!dr))
1057                 return -ENOMEM;
1058         if (dr->enabled)
1059                 return 0;
1060
1061         rc = pci_enable_device(pdev);
1062         if (!rc) {
1063                 pdev->is_managed = 1;
1064                 dr->enabled = 1;
1065         }
1066         return rc;
1067 }
1068
1069 /**
1070  * pcim_pin_device - Pin managed PCI device
1071  * @pdev: PCI device to pin
1072  *
1073  * Pin managed PCI device @pdev.  Pinned device won't be disabled on
1074  * driver detach.  @pdev must have been enabled with
1075  * pcim_enable_device().
1076  */
1077 void pcim_pin_device(struct pci_dev *pdev)
1078 {
1079         struct pci_devres *dr;
1080
1081         dr = find_pci_dr(pdev);
1082         WARN_ON(!dr || !dr->enabled);
1083         if (dr)
1084                 dr->pinned = 1;
1085 }
1086
1087 /**
1088  * pcibios_disable_device - disable arch specific PCI resources for device dev
1089  * @dev: the PCI device to disable
1090  *
1091  * Disables architecture specific PCI resources for the device. This
1092  * is the default implementation. Architecture implementations can
1093  * override this.
1094  */
1095 void __attribute__ ((weak)) pcibios_disable_device (struct pci_dev *dev) {}
1096
1097 static void do_pci_disable_device(struct pci_dev *dev)
1098 {
1099         u16 pci_command;
1100
1101         pci_read_config_word(dev, PCI_COMMAND, &pci_command);
1102         if (pci_command & PCI_COMMAND_MASTER) {
1103                 pci_command &= ~PCI_COMMAND_MASTER;
1104                 pci_write_config_word(dev, PCI_COMMAND, pci_command);
1105         }
1106
1107         pcibios_disable_device(dev);
1108 }
1109
1110 /**
1111  * pci_disable_enabled_device - Disable device without updating enable_cnt
1112  * @dev: PCI device to disable
1113  *
1114  * NOTE: This function is a backend of PCI power management routines and is
1115  * not supposed to be called drivers.
1116  */
1117 void pci_disable_enabled_device(struct pci_dev *dev)
1118 {
1119         if (pci_is_enabled(dev))
1120                 do_pci_disable_device(dev);
1121 }
1122
1123 /**
1124  * pci_disable_device - Disable PCI device after use
1125  * @dev: PCI device to be disabled
1126  *
1127  * Signal to the system that the PCI device is not in use by the system
1128  * anymore.  This only involves disabling PCI bus-mastering, if active.
1129  *
1130  * Note we don't actually disable the device until all callers of
1131  * pci_device_enable() have called pci_device_disable().
1132  */
1133 void
1134 pci_disable_device(struct pci_dev *dev)
1135 {
1136         struct pci_devres *dr;
1137
1138         dr = find_pci_dr(dev);
1139         if (dr)
1140                 dr->enabled = 0;
1141
1142         if (atomic_sub_return(1, &dev->enable_cnt) != 0)
1143                 return;
1144
1145         do_pci_disable_device(dev);
1146
1147         dev->is_busmaster = 0;
1148 }
1149
1150 /**
1151  * pcibios_set_pcie_reset_state - set reset state for device dev
1152  * @dev: the PCI-E device reset
1153  * @state: Reset state to enter into
1154  *
1155  *
1156  * Sets the PCI-E reset state for the device. This is the default
1157  * implementation. Architecture implementations can override this.
1158  */
1159 int __attribute__ ((weak)) pcibios_set_pcie_reset_state(struct pci_dev *dev,
1160                                                         enum pcie_reset_state state)
1161 {
1162         return -EINVAL;
1163 }
1164
1165 /**
1166  * pci_set_pcie_reset_state - set reset state for device dev
1167  * @dev: the PCI-E device reset
1168  * @state: Reset state to enter into
1169  *
1170  *
1171  * Sets the PCI reset state for the device.
1172  */
1173 int pci_set_pcie_reset_state(struct pci_dev *dev, enum pcie_reset_state state)
1174 {
1175         return pcibios_set_pcie_reset_state(dev, state);
1176 }
1177
1178 /**
1179  * pci_pme_capable - check the capability of PCI device to generate PME#
1180  * @dev: PCI device to handle.
1181  * @state: PCI state from which device will issue PME#.
1182  */
1183 bool pci_pme_capable(struct pci_dev *dev, pci_power_t state)
1184 {
1185         if (!dev->pm_cap)
1186                 return false;
1187
1188         return !!(dev->pme_support & (1 << state));
1189 }
1190
1191 /**
1192  * pci_pme_active - enable or disable PCI device's PME# function
1193  * @dev: PCI device to handle.
1194  * @enable: 'true' to enable PME# generation; 'false' to disable it.
1195  *
1196  * The caller must verify that the device is capable of generating PME# before
1197  * calling this function with @enable equal to 'true'.
1198  */
1199 void pci_pme_active(struct pci_dev *dev, bool enable)
1200 {
1201         u16 pmcsr;
1202
1203         if (!dev->pm_cap)
1204                 return;
1205
1206         pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &pmcsr);
1207         /* Clear PME_Status by writing 1 to it and enable PME# */
1208         pmcsr |= PCI_PM_CTRL_PME_STATUS | PCI_PM_CTRL_PME_ENABLE;
1209         if (!enable)
1210                 pmcsr &= ~PCI_PM_CTRL_PME_ENABLE;
1211
1212         pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, pmcsr);
1213
1214         dev_printk(KERN_INFO, &dev->dev, "PME# %s\n",
1215                         enable ? "enabled" : "disabled");
1216 }
1217
1218 /**
1219  * pci_enable_wake - enable PCI device as wakeup event source
1220  * @dev: PCI device affected
1221  * @state: PCI state from which device will issue wakeup events
1222  * @enable: True to enable event generation; false to disable
1223  *
1224  * This enables the device as a wakeup event source, or disables it.
1225  * When such events involves platform-specific hooks, those hooks are
1226  * called automatically by this routine.
1227  *
1228  * Devices with legacy power management (no standard PCI PM capabilities)
1229  * always require such platform hooks.
1230  *
1231  * RETURN VALUE:
1232  * 0 is returned on success
1233  * -EINVAL is returned if device is not supposed to wake up the system
1234  * Error code depending on the platform is returned if both the platform and
1235  * the native mechanism fail to enable the generation of wake-up events
1236  */
1237 int pci_enable_wake(struct pci_dev *dev, pci_power_t state, bool enable)
1238 {
1239         int ret = 0;
1240
1241         if (enable && !device_may_wakeup(&dev->dev))
1242                 return -EINVAL;
1243
1244         /* Don't do the same thing twice in a row for one device. */
1245         if (!!enable == !!dev->wakeup_prepared)
1246                 return 0;
1247
1248         /*
1249          * According to "PCI System Architecture" 4th ed. by Tom Shanley & Don
1250          * Anderson we should be doing PME# wake enable followed by ACPI wake
1251          * enable.  To disable wake-up we call the platform first, for symmetry.
1252          */
1253
1254         if (enable) {
1255                 int error;
1256
1257                 if (pci_pme_capable(dev, state))
1258                         pci_pme_active(dev, true);
1259                 else
1260                         ret = 1;
1261                 error = platform_pci_sleep_wake(dev, true);
1262                 if (ret)
1263                         ret = error;
1264                 if (!ret)
1265                         dev->wakeup_prepared = true;
1266         } else {
1267                 platform_pci_sleep_wake(dev, false);
1268                 pci_pme_active(dev, false);
1269                 dev->wakeup_prepared = false;
1270         }
1271
1272         return ret;
1273 }
1274
1275 /**
1276  * pci_wake_from_d3 - enable/disable device to wake up from D3_hot or D3_cold
1277  * @dev: PCI device to prepare
1278  * @enable: True to enable wake-up event generation; false to disable
1279  *
1280  * Many drivers want the device to wake up the system from D3_hot or D3_cold
1281  * and this function allows them to set that up cleanly - pci_enable_wake()
1282  * should not be called twice in a row to enable wake-up due to PCI PM vs ACPI
1283  * ordering constraints.
1284  *
1285  * This function only returns error code if the device is not capable of
1286  * generating PME# from both D3_hot and D3_cold, and the platform is unable to
1287  * enable wake-up power for it.
1288  */
1289 int pci_wake_from_d3(struct pci_dev *dev, bool enable)
1290 {
1291         return pci_pme_capable(dev, PCI_D3cold) ?
1292                         pci_enable_wake(dev, PCI_D3cold, enable) :
1293                         pci_enable_wake(dev, PCI_D3hot, enable);
1294 }
1295
1296 /**
1297  * pci_target_state - find an appropriate low power state for a given PCI dev
1298  * @dev: PCI device
1299  *
1300  * Use underlying platform code to find a supported low power state for @dev.
1301  * If the platform can't manage @dev, return the deepest state from which it
1302  * can generate wake events, based on any available PME info.
1303  */
1304 pci_power_t pci_target_state(struct pci_dev *dev)
1305 {
1306         pci_power_t target_state = PCI_D3hot;
1307
1308         if (platform_pci_power_manageable(dev)) {
1309                 /*
1310                  * Call the platform to choose the target state of the device
1311                  * and enable wake-up from this state if supported.
1312                  */
1313                 pci_power_t state = platform_pci_choose_state(dev);
1314
1315                 switch (state) {
1316                 case PCI_POWER_ERROR:
1317                 case PCI_UNKNOWN:
1318                         break;
1319                 case PCI_D1:
1320                 case PCI_D2:
1321                         if (pci_no_d1d2(dev))
1322                                 break;
1323                 default:
1324                         target_state = state;
1325                 }
1326         } else if (!dev->pm_cap) {
1327                 target_state = PCI_D0;
1328         } else if (device_may_wakeup(&dev->dev)) {
1329                 /*
1330                  * Find the deepest state from which the device can generate
1331                  * wake-up events, make it the target state and enable device
1332                  * to generate PME#.
1333                  */
1334                 if (dev->pme_support) {
1335                         while (target_state
1336                               && !(dev->pme_support & (1 << target_state)))
1337                                 target_state--;
1338                 }
1339         }
1340
1341         return target_state;
1342 }
1343
1344 /**
1345  * pci_prepare_to_sleep - prepare PCI device for system-wide transition into a sleep state
1346  * @dev: Device to handle.
1347  *
1348  * Choose the power state appropriate for the device depending on whether
1349  * it can wake up the system and/or is power manageable by the platform
1350  * (PCI_D3hot is the default) and put the device into that state.
1351  */
1352 int pci_prepare_to_sleep(struct pci_dev *dev)
1353 {
1354         pci_power_t target_state = pci_target_state(dev);
1355         int error;
1356
1357         if (target_state == PCI_POWER_ERROR)
1358                 return -EIO;
1359
1360         pci_enable_wake(dev, target_state, device_may_wakeup(&dev->dev));
1361
1362         error = pci_set_power_state(dev, target_state);
1363
1364         if (error)
1365                 pci_enable_wake(dev, target_state, false);
1366
1367         return error;
1368 }
1369
1370 /**
1371  * pci_back_from_sleep - turn PCI device on during system-wide transition into working state
1372  * @dev: Device to handle.
1373  *
1374  * Disable device's sytem wake-up capability and put it into D0.
1375  */
1376 int pci_back_from_sleep(struct pci_dev *dev)
1377 {
1378         pci_enable_wake(dev, PCI_D0, false);
1379         return pci_set_power_state(dev, PCI_D0);
1380 }
1381
1382 /**
1383  * pci_pm_init - Initialize PM functions of given PCI device
1384  * @dev: PCI device to handle.
1385  */
1386 void pci_pm_init(struct pci_dev *dev)
1387 {
1388         int pm;
1389         u16 pmc;
1390
1391         dev->wakeup_prepared = false;
1392         dev->pm_cap = 0;
1393
1394         /* find PCI PM capability in list */
1395         pm = pci_find_capability(dev, PCI_CAP_ID_PM);
1396         if (!pm)
1397                 return;
1398         /* Check device's ability to generate PME# */
1399         pci_read_config_word(dev, pm + PCI_PM_PMC, &pmc);
1400
1401         if ((pmc & PCI_PM_CAP_VER_MASK) > 3) {
1402                 dev_err(&dev->dev, "unsupported PM cap regs version (%u)\n",
1403                         pmc & PCI_PM_CAP_VER_MASK);
1404                 return;
1405         }
1406
1407         dev->pm_cap = pm;
1408
1409         dev->d1_support = false;
1410         dev->d2_support = false;
1411         if (!pci_no_d1d2(dev)) {
1412                 if (pmc & PCI_PM_CAP_D1)
1413                         dev->d1_support = true;
1414                 if (pmc & PCI_PM_CAP_D2)
1415                         dev->d2_support = true;
1416
1417                 if (dev->d1_support || dev->d2_support)
1418                         dev_printk(KERN_DEBUG, &dev->dev, "supports%s%s\n",
1419                                    dev->d1_support ? " D1" : "",
1420                                    dev->d2_support ? " D2" : "");
1421         }
1422
1423         pmc &= PCI_PM_CAP_PME_MASK;
1424         if (pmc) {
1425                 dev_info(&dev->dev, "PME# supported from%s%s%s%s%s\n",
1426                          (pmc & PCI_PM_CAP_PME_D0) ? " D0" : "",
1427                          (pmc & PCI_PM_CAP_PME_D1) ? " D1" : "",
1428                          (pmc & PCI_PM_CAP_PME_D2) ? " D2" : "",
1429                          (pmc & PCI_PM_CAP_PME_D3) ? " D3hot" : "",
1430                          (pmc & PCI_PM_CAP_PME_D3cold) ? " D3cold" : "");
1431                 dev->pme_support = pmc >> PCI_PM_CAP_PME_SHIFT;
1432                 /*
1433                  * Make device's PM flags reflect the wake-up capability, but
1434                  * let the user space enable it to wake up the system as needed.
1435                  */
1436                 device_set_wakeup_capable(&dev->dev, true);
1437                 device_set_wakeup_enable(&dev->dev, false);
1438                 /* Disable the PME# generation functionality */
1439                 pci_pme_active(dev, false);
1440         } else {
1441                 dev->pme_support = 0;
1442         }
1443 }
1444
1445 /**
1446  * platform_pci_wakeup_init - init platform wakeup if present
1447  * @dev: PCI device
1448  *
1449  * Some devices don't have PCI PM caps but can still generate wakeup
1450  * events through platform methods (like ACPI events).  If @dev supports
1451  * platform wakeup events, set the device flag to indicate as much.  This
1452  * may be redundant if the device also supports PCI PM caps, but double
1453  * initialization should be safe in that case.
1454  */
1455 void platform_pci_wakeup_init(struct pci_dev *dev)
1456 {
1457         if (!platform_pci_can_wakeup(dev))
1458                 return;
1459
1460         device_set_wakeup_capable(&dev->dev, true);
1461         device_set_wakeup_enable(&dev->dev, false);
1462         platform_pci_sleep_wake(dev, false);
1463 }
1464
1465 /**
1466  * pci_add_save_buffer - allocate buffer for saving given capability registers
1467  * @dev: the PCI device
1468  * @cap: the capability to allocate the buffer for
1469  * @size: requested size of the buffer
1470  */
1471 static int pci_add_cap_save_buffer(
1472         struct pci_dev *dev, char cap, unsigned int size)
1473 {
1474         int pos;
1475         struct pci_cap_saved_state *save_state;
1476
1477         pos = pci_find_capability(dev, cap);
1478         if (pos <= 0)
1479                 return 0;
1480
1481         save_state = kzalloc(sizeof(*save_state) + size, GFP_KERNEL);
1482         if (!save_state)
1483                 return -ENOMEM;
1484
1485         save_state->cap_nr = cap;
1486         pci_add_saved_cap(dev, save_state);
1487
1488         return 0;
1489 }
1490
1491 /**
1492  * pci_allocate_cap_save_buffers - allocate buffers for saving capabilities
1493  * @dev: the PCI device
1494  */
1495 void pci_allocate_cap_save_buffers(struct pci_dev *dev)
1496 {
1497         int error;
1498
1499         error = pci_add_cap_save_buffer(dev, PCI_CAP_ID_EXP,
1500                                         PCI_EXP_SAVE_REGS * sizeof(u16));
1501         if (error)
1502                 dev_err(&dev->dev,
1503                         "unable to preallocate PCI Express save buffer\n");
1504
1505         error = pci_add_cap_save_buffer(dev, PCI_CAP_ID_PCIX, sizeof(u16));
1506         if (error)
1507                 dev_err(&dev->dev,
1508                         "unable to preallocate PCI-X save buffer\n");
1509 }
1510
1511 /**
1512  * pci_enable_ari - enable ARI forwarding if hardware support it
1513  * @dev: the PCI device
1514  */
1515 void pci_enable_ari(struct pci_dev *dev)
1516 {
1517         int pos;
1518         u32 cap;
1519         u16 ctrl;
1520         struct pci_dev *bridge;
1521
1522         if (!dev->is_pcie || dev->devfn)
1523                 return;
1524
1525         pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_ARI);
1526         if (!pos)
1527                 return;
1528
1529         bridge = dev->bus->self;
1530         if (!bridge || !bridge->is_pcie)
1531                 return;
1532
1533         pos = pci_find_capability(bridge, PCI_CAP_ID_EXP);
1534         if (!pos)
1535                 return;
1536
1537         pci_read_config_dword(bridge, pos + PCI_EXP_DEVCAP2, &cap);
1538         if (!(cap & PCI_EXP_DEVCAP2_ARI))
1539                 return;
1540
1541         pci_read_config_word(bridge, pos + PCI_EXP_DEVCTL2, &ctrl);
1542         ctrl |= PCI_EXP_DEVCTL2_ARI;
1543         pci_write_config_word(bridge, pos + PCI_EXP_DEVCTL2, ctrl);
1544
1545         bridge->ari_enabled = 1;
1546 }
1547
1548 /**
1549  * pci_enable_acs - enable ACS if hardware support it
1550  * @dev: the PCI device
1551  */
1552 void pci_enable_acs(struct pci_dev *dev)
1553 {
1554         int pos;
1555         u16 cap;
1556         u16 ctrl;
1557
1558         if (!dev->is_pcie)
1559                 return;
1560
1561         pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_ACS);
1562         if (!pos)
1563                 return;
1564
1565         pci_read_config_word(dev, pos + PCI_ACS_CAP, &cap);
1566         pci_read_config_word(dev, pos + PCI_ACS_CTRL, &ctrl);
1567
1568         /* Source Validation */
1569         ctrl |= (cap & PCI_ACS_SV);
1570
1571         /* P2P Request Redirect */
1572         ctrl |= (cap & PCI_ACS_RR);
1573
1574         /* P2P Completion Redirect */
1575         ctrl |= (cap & PCI_ACS_CR);
1576
1577         /* Upstream Forwarding */
1578         ctrl |= (cap & PCI_ACS_UF);
1579
1580         pci_write_config_word(dev, pos + PCI_ACS_CTRL, ctrl);
1581 }
1582
1583 /**
1584  * pci_swizzle_interrupt_pin - swizzle INTx for device behind bridge
1585  * @dev: the PCI device
1586  * @pin: the INTx pin (1=INTA, 2=INTB, 3=INTD, 4=INTD)
1587  *
1588  * Perform INTx swizzling for a device behind one level of bridge.  This is
1589  * required by section 9.1 of the PCI-to-PCI bridge specification for devices
1590  * behind bridges on add-in cards.  For devices with ARI enabled, the slot
1591  * number is always 0 (see the Implementation Note in section 2.2.8.1 of
1592  * the PCI Express Base Specification, Revision 2.1)
1593  */
1594 u8 pci_swizzle_interrupt_pin(struct pci_dev *dev, u8 pin)
1595 {
1596         int slot;
1597
1598         if (pci_ari_enabled(dev->bus))
1599                 slot = 0;
1600         else
1601                 slot = PCI_SLOT(dev->devfn);
1602
1603         return (((pin - 1) + slot) % 4) + 1;
1604 }
1605
1606 int
1607 pci_get_interrupt_pin(struct pci_dev *dev, struct pci_dev **bridge)
1608 {
1609         u8 pin;
1610
1611         pin = dev->pin;
1612         if (!pin)
1613                 return -1;
1614
1615         while (!pci_is_root_bus(dev->bus)) {
1616                 pin = pci_swizzle_interrupt_pin(dev, pin);
1617                 dev = dev->bus->self;
1618         }
1619         *bridge = dev;
1620         return pin;
1621 }
1622
1623 /**
1624  * pci_common_swizzle - swizzle INTx all the way to root bridge
1625  * @dev: the PCI device
1626  * @pinp: pointer to the INTx pin value (1=INTA, 2=INTB, 3=INTD, 4=INTD)
1627  *
1628  * Perform INTx swizzling for a device.  This traverses through all PCI-to-PCI
1629  * bridges all the way up to a PCI root bus.
1630  */
1631 u8 pci_common_swizzle(struct pci_dev *dev, u8 *pinp)
1632 {
1633         u8 pin = *pinp;
1634
1635         while (!pci_is_root_bus(dev->bus)) {
1636                 pin = pci_swizzle_interrupt_pin(dev, pin);
1637                 dev = dev->bus->self;
1638         }
1639         *pinp = pin;
1640         return PCI_SLOT(dev->devfn);
1641 }
1642
1643 /**
1644  *      pci_release_region - Release a PCI bar
1645  *      @pdev: PCI device whose resources were previously reserved by pci_request_region
1646  *      @bar: BAR to release
1647  *
1648  *      Releases the PCI I/O and memory resources previously reserved by a
1649  *      successful call to pci_request_region.  Call this function only
1650  *      after all use of the PCI regions has ceased.
1651  */
1652 void pci_release_region(struct pci_dev *pdev, int bar)
1653 {
1654         struct pci_devres *dr;
1655
1656         if (pci_resource_len(pdev, bar) == 0)
1657                 return;
1658         if (pci_resource_flags(pdev, bar) & IORESOURCE_IO)
1659                 release_region(pci_resource_start(pdev, bar),
1660                                 pci_resource_len(pdev, bar));
1661         else if (pci_resource_flags(pdev, bar) & IORESOURCE_MEM)
1662                 release_mem_region(pci_resource_start(pdev, bar),
1663                                 pci_resource_len(pdev, bar));
1664
1665         dr = find_pci_dr(pdev);
1666         if (dr)
1667                 dr->region_mask &= ~(1 << bar);
1668 }
1669
1670 /**
1671  *      __pci_request_region - Reserved PCI I/O and memory resource
1672  *      @pdev: PCI device whose resources are to be reserved
1673  *      @bar: BAR to be reserved
1674  *      @res_name: Name to be associated with resource.
1675  *      @exclusive: whether the region access is exclusive or not
1676  *
1677  *      Mark the PCI region associated with PCI device @pdev BR @bar as
1678  *      being reserved by owner @res_name.  Do not access any
1679  *      address inside the PCI regions unless this call returns
1680  *      successfully.
1681  *
1682  *      If @exclusive is set, then the region is marked so that userspace
1683  *      is explicitly not allowed to map the resource via /dev/mem or
1684  *      sysfs MMIO access.
1685  *
1686  *      Returns 0 on success, or %EBUSY on error.  A warning
1687  *      message is also printed on failure.
1688  */
1689 static int __pci_request_region(struct pci_dev *pdev, int bar, const char *res_name,
1690                                                                         int exclusive)
1691 {
1692         struct pci_devres *dr;
1693
1694         if (pci_resource_len(pdev, bar) == 0)
1695                 return 0;
1696
1697         if (pci_resource_flags(pdev, bar) & IORESOURCE_IO) {
1698                 if (!request_region(pci_resource_start(pdev, bar),
1699                             pci_resource_len(pdev, bar), res_name))
1700                         goto err_out;
1701         }
1702         else if (pci_resource_flags(pdev, bar) & IORESOURCE_MEM) {
1703                 if (!__request_mem_region(pci_resource_start(pdev, bar),
1704                                         pci_resource_len(pdev, bar), res_name,
1705                                         exclusive))
1706                         goto err_out;
1707         }
1708
1709         dr = find_pci_dr(pdev);
1710         if (dr)
1711                 dr->region_mask |= 1 << bar;
1712
1713         return 0;
1714
1715 err_out:
1716         dev_warn(&pdev->dev, "BAR %d: can't reserve %pRt\n", bar,
1717                  &pdev->resource[bar]);
1718         return -EBUSY;
1719 }
1720
1721 /**
1722  *      pci_request_region - Reserve PCI I/O and memory resource
1723  *      @pdev: PCI device whose resources are to be reserved
1724  *      @bar: BAR to be reserved
1725  *      @res_name: Name to be associated with resource
1726  *
1727  *      Mark the PCI region associated with PCI device @pdev BAR @bar as
1728  *      being reserved by owner @res_name.  Do not access any
1729  *      address inside the PCI regions unless this call returns
1730  *      successfully.
1731  *
1732  *      Returns 0 on success, or %EBUSY on error.  A warning
1733  *      message is also printed on failure.
1734  */
1735 int pci_request_region(struct pci_dev *pdev, int bar, const char *res_name)
1736 {
1737         return __pci_request_region(pdev, bar, res_name, 0);
1738 }
1739
1740 /**
1741  *      pci_request_region_exclusive - Reserved PCI I/O and memory resource
1742  *      @pdev: PCI device whose resources are to be reserved
1743  *      @bar: BAR to be reserved
1744  *      @res_name: Name to be associated with resource.
1745  *
1746  *      Mark the PCI region associated with PCI device @pdev BR @bar as
1747  *      being reserved by owner @res_name.  Do not access any
1748  *      address inside the PCI regions unless this call returns
1749  *      successfully.
1750  *
1751  *      Returns 0 on success, or %EBUSY on error.  A warning
1752  *      message is also printed on failure.
1753  *
1754  *      The key difference that _exclusive makes it that userspace is
1755  *      explicitly not allowed to map the resource via /dev/mem or
1756  *      sysfs.
1757  */
1758 int pci_request_region_exclusive(struct pci_dev *pdev, int bar, const char *res_name)
1759 {
1760         return __pci_request_region(pdev, bar, res_name, IORESOURCE_EXCLUSIVE);
1761 }
1762 /**
1763  * pci_release_selected_regions - Release selected PCI I/O and memory resources
1764  * @pdev: PCI device whose resources were previously reserved
1765  * @bars: Bitmask of BARs to be released
1766  *
1767  * Release selected PCI I/O and memory resources previously reserved.
1768  * Call this function only after all use of the PCI regions has ceased.
1769  */
1770 void pci_release_selected_regions(struct pci_dev *pdev, int bars)
1771 {
1772         int i;
1773
1774         for (i = 0; i < 6; i++)
1775                 if (bars & (1 << i))
1776                         pci_release_region(pdev, i);
1777 }
1778
1779 int __pci_request_selected_regions(struct pci_dev *pdev, int bars,
1780                                  const char *res_name, int excl)
1781 {
1782         int i;
1783
1784         for (i = 0; i < 6; i++)
1785                 if (bars & (1 << i))
1786                         if (__pci_request_region(pdev, i, res_name, excl))
1787                                 goto err_out;
1788         return 0;
1789
1790 err_out:
1791         while(--i >= 0)
1792                 if (bars & (1 << i))
1793                         pci_release_region(pdev, i);
1794
1795         return -EBUSY;
1796 }
1797
1798
1799 /**
1800  * pci_request_selected_regions - Reserve selected PCI I/O and memory resources
1801  * @pdev: PCI device whose resources are to be reserved
1802  * @bars: Bitmask of BARs to be requested
1803  * @res_name: Name to be associated with resource
1804  */
1805 int pci_request_selected_regions(struct pci_dev *pdev, int bars,
1806                                  const char *res_name)
1807 {
1808         return __pci_request_selected_regions(pdev, bars, res_name, 0);
1809 }
1810
1811 int pci_request_selected_regions_exclusive(struct pci_dev *pdev,
1812                                  int bars, const char *res_name)
1813 {
1814         return __pci_request_selected_regions(pdev, bars, res_name,
1815                         IORESOURCE_EXCLUSIVE);
1816 }
1817
1818 /**
1819  *      pci_release_regions - Release reserved PCI I/O and memory resources
1820  *      @pdev: PCI device whose resources were previously reserved by pci_request_regions
1821  *
1822  *      Releases all PCI I/O and memory resources previously reserved by a
1823  *      successful call to pci_request_regions.  Call this function only
1824  *      after all use of the PCI regions has ceased.
1825  */
1826
1827 void pci_release_regions(struct pci_dev *pdev)
1828 {
1829         pci_release_selected_regions(pdev, (1 << 6) - 1);
1830 }
1831
1832 /**
1833  *      pci_request_regions - Reserved PCI I/O and memory resources
1834  *      @pdev: PCI device whose resources are to be reserved
1835  *      @res_name: Name to be associated with resource.
1836  *
1837  *      Mark all PCI regions associated with PCI device @pdev as
1838  *      being reserved by owner @res_name.  Do not access any
1839  *      address inside the PCI regions unless this call returns
1840  *      successfully.
1841  *
1842  *      Returns 0 on success, or %EBUSY on error.  A warning
1843  *      message is also printed on failure.
1844  */
1845 int pci_request_regions(struct pci_dev *pdev, const char *res_name)
1846 {
1847         return pci_request_selected_regions(pdev, ((1 << 6) - 1), res_name);
1848 }
1849
1850 /**
1851  *      pci_request_regions_exclusive - Reserved PCI I/O and memory resources
1852  *      @pdev: PCI device whose resources are to be reserved
1853  *      @res_name: Name to be associated with resource.
1854  *
1855  *      Mark all PCI regions associated with PCI device @pdev as
1856  *      being reserved by owner @res_name.  Do not access any
1857  *      address inside the PCI regions unless this call returns
1858  *      successfully.
1859  *
1860  *      pci_request_regions_exclusive() will mark the region so that
1861  *      /dev/mem and the sysfs MMIO access will not be allowed.
1862  *
1863  *      Returns 0 on success, or %EBUSY on error.  A warning
1864  *      message is also printed on failure.
1865  */
1866 int pci_request_regions_exclusive(struct pci_dev *pdev, const char *res_name)
1867 {
1868         return pci_request_selected_regions_exclusive(pdev,
1869                                         ((1 << 6) - 1), res_name);
1870 }
1871
1872 static void __pci_set_master(struct pci_dev *dev, bool enable)
1873 {
1874         u16 old_cmd, cmd;
1875
1876         pci_read_config_word(dev, PCI_COMMAND, &old_cmd);
1877         if (enable)
1878                 cmd = old_cmd | PCI_COMMAND_MASTER;
1879         else
1880                 cmd = old_cmd & ~PCI_COMMAND_MASTER;
1881         if (cmd != old_cmd) {
1882                 dev_dbg(&dev->dev, "%s bus mastering\n",
1883                         enable ? "enabling" : "disabling");
1884                 pci_write_config_word(dev, PCI_COMMAND, cmd);
1885         }
1886         dev->is_busmaster = enable;
1887 }
1888
1889 /**
1890  * pci_set_master - enables bus-mastering for device dev
1891  * @dev: the PCI device to enable
1892  *
1893  * Enables bus-mastering on the device and calls pcibios_set_master()
1894  * to do the needed arch specific settings.
1895  */
1896 void pci_set_master(struct pci_dev *dev)
1897 {
1898         __pci_set_master(dev, true);
1899         pcibios_set_master(dev);
1900 }
1901
1902 /**
1903  * pci_clear_master - disables bus-mastering for device dev
1904  * @dev: the PCI device to disable
1905  */
1906 void pci_clear_master(struct pci_dev *dev)
1907 {
1908         __pci_set_master(dev, false);
1909 }
1910
1911 /**
1912  * pci_set_cacheline_size - ensure the CACHE_LINE_SIZE register is programmed
1913  * @dev: the PCI device for which MWI is to be enabled
1914  *
1915  * Helper function for pci_set_mwi.
1916  * Originally copied from drivers/net/acenic.c.
1917  * Copyright 1998-2001 by Jes Sorensen, <jes@trained-monkey.org>.
1918  *
1919  * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
1920  */
1921 int pci_set_cacheline_size(struct pci_dev *dev)
1922 {
1923         u8 cacheline_size;
1924
1925         if (!pci_cache_line_size)
1926                 return -EINVAL;
1927
1928         /* Validate current setting: the PCI_CACHE_LINE_SIZE must be
1929            equal to or multiple of the right value. */
1930         pci_read_config_byte(dev, PCI_CACHE_LINE_SIZE, &cacheline_size);
1931         if (cacheline_size >= pci_cache_line_size &&
1932             (cacheline_size % pci_cache_line_size) == 0)
1933                 return 0;
1934
1935         /* Write the correct value. */
1936         pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, pci_cache_line_size);
1937         /* Read it back. */
1938         pci_read_config_byte(dev, PCI_CACHE_LINE_SIZE, &cacheline_size);
1939         if (cacheline_size == pci_cache_line_size)
1940                 return 0;
1941
1942         dev_printk(KERN_DEBUG, &dev->dev, "cache line size of %d is not "
1943                    "supported\n", pci_cache_line_size << 2);
1944
1945         return -EINVAL;
1946 }
1947 EXPORT_SYMBOL_GPL(pci_set_cacheline_size);
1948
1949 #ifdef PCI_DISABLE_MWI
1950 int pci_set_mwi(struct pci_dev *dev)
1951 {
1952         return 0;
1953 }
1954
1955 int pci_try_set_mwi(struct pci_dev *dev)
1956 {
1957         return 0;
1958 }
1959
1960 void pci_clear_mwi(struct pci_dev *dev)
1961 {
1962 }
1963
1964 #else
1965
1966 /**
1967  * pci_set_mwi - enables memory-write-invalidate PCI transaction
1968  * @dev: the PCI device for which MWI is enabled
1969  *
1970  * Enables the Memory-Write-Invalidate transaction in %PCI_COMMAND.
1971  *
1972  * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
1973  */
1974 int
1975 pci_set_mwi(struct pci_dev *dev)
1976 {
1977         int rc;
1978         u16 cmd;
1979
1980         rc = pci_set_cacheline_size(dev);
1981         if (rc)
1982                 return rc;
1983
1984         pci_read_config_word(dev, PCI_COMMAND, &cmd);
1985         if (! (cmd & PCI_COMMAND_INVALIDATE)) {
1986                 dev_dbg(&dev->dev, "enabling Mem-Wr-Inval\n");
1987                 cmd |= PCI_COMMAND_INVALIDATE;
1988                 pci_write_config_word(dev, PCI_COMMAND, cmd);
1989         }
1990
1991         return 0;
1992 }
1993
1994 /**
1995  * pci_try_set_mwi - enables memory-write-invalidate PCI transaction
1996  * @dev: the PCI device for which MWI is enabled
1997  *
1998  * Enables the Memory-Write-Invalidate transaction in %PCI_COMMAND.
1999  * Callers are not required to check the return value.
2000  *
2001  * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
2002  */
2003 int pci_try_set_mwi(struct pci_dev *dev)
2004 {
2005         int rc = pci_set_mwi(dev);
2006         return rc;
2007 }
2008
2009 /**
2010  * pci_clear_mwi - disables Memory-Write-Invalidate for device dev
2011  * @dev: the PCI device to disable
2012  *
2013  * Disables PCI Memory-Write-Invalidate transaction on the device
2014  */
2015 void
2016 pci_clear_mwi(struct pci_dev *dev)
2017 {
2018         u16 cmd;
2019
2020         pci_read_config_word(dev, PCI_COMMAND, &cmd);
2021         if (cmd & PCI_COMMAND_INVALIDATE) {
2022                 cmd &= ~PCI_COMMAND_INVALIDATE;
2023                 pci_write_config_word(dev, PCI_COMMAND, cmd);
2024         }
2025 }
2026 #endif /* ! PCI_DISABLE_MWI */
2027
2028 /**
2029  * pci_intx - enables/disables PCI INTx for device dev
2030  * @pdev: the PCI device to operate on
2031  * @enable: boolean: whether to enable or disable PCI INTx
2032  *
2033  * Enables/disables PCI INTx for device dev
2034  */
2035 void
2036 pci_intx(struct pci_dev *pdev, int enable)
2037 {
2038         u16 pci_command, new;
2039
2040         pci_read_config_word(pdev, PCI_COMMAND, &pci_command);
2041
2042         if (enable) {
2043                 new = pci_command & ~PCI_COMMAND_INTX_DISABLE;
2044         } else {
2045                 new = pci_command | PCI_COMMAND_INTX_DISABLE;
2046         }
2047
2048         if (new != pci_command) {
2049                 struct pci_devres *dr;
2050
2051                 pci_write_config_word(pdev, PCI_COMMAND, new);
2052
2053                 dr = find_pci_dr(pdev);
2054                 if (dr && !dr->restore_intx) {
2055                         dr->restore_intx = 1;
2056                         dr->orig_intx = !enable;
2057                 }
2058         }
2059 }
2060
2061 /**
2062  * pci_msi_off - disables any msi or msix capabilities
2063  * @dev: the PCI device to operate on
2064  *
2065  * If you want to use msi see pci_enable_msi and friends.
2066  * This is a lower level primitive that allows us to disable
2067  * msi operation at the device level.
2068  */
2069 void pci_msi_off(struct pci_dev *dev)
2070 {
2071         int pos;
2072         u16 control;
2073
2074         pos = pci_find_capability(dev, PCI_CAP_ID_MSI);
2075         if (pos) {
2076                 pci_read_config_word(dev, pos + PCI_MSI_FLAGS, &control);
2077                 control &= ~PCI_MSI_FLAGS_ENABLE;
2078                 pci_write_config_word(dev, pos + PCI_MSI_FLAGS, control);
2079         }
2080         pos = pci_find_capability(dev, PCI_CAP_ID_MSIX);
2081         if (pos) {
2082                 pci_read_config_word(dev, pos + PCI_MSIX_FLAGS, &control);
2083                 control &= ~PCI_MSIX_FLAGS_ENABLE;
2084                 pci_write_config_word(dev, pos + PCI_MSIX_FLAGS, control);
2085         }
2086 }
2087
2088 #ifndef HAVE_ARCH_PCI_SET_DMA_MASK
2089 /*
2090  * These can be overridden by arch-specific implementations
2091  */
2092 int
2093 pci_set_dma_mask(struct pci_dev *dev, u64 mask)
2094 {
2095         if (!pci_dma_supported(dev, mask))
2096                 return -EIO;
2097
2098         dev->dma_mask = mask;
2099
2100         return 0;
2101 }
2102
2103 int
2104 pci_set_consistent_dma_mask(struct pci_dev *dev, u64 mask)
2105 {
2106         if (!pci_dma_supported(dev, mask))
2107                 return -EIO;
2108
2109         dev->dev.coherent_dma_mask = mask;
2110
2111         return 0;
2112 }
2113 #endif
2114
2115 #ifndef HAVE_ARCH_PCI_SET_DMA_MAX_SEGMENT_SIZE
2116 int pci_set_dma_max_seg_size(struct pci_dev *dev, unsigned int size)
2117 {
2118         return dma_set_max_seg_size(&dev->dev, size);
2119 }
2120 EXPORT_SYMBOL(pci_set_dma_max_seg_size);
2121 #endif
2122
2123 #ifndef HAVE_ARCH_PCI_SET_DMA_SEGMENT_BOUNDARY
2124 int pci_set_dma_seg_boundary(struct pci_dev *dev, unsigned long mask)
2125 {
2126         return dma_set_seg_boundary(&dev->dev, mask);
2127 }
2128 EXPORT_SYMBOL(pci_set_dma_seg_boundary);
2129 #endif
2130
2131 static int pcie_flr(struct pci_dev *dev, int probe)
2132 {
2133         int i;
2134         int pos;
2135         u32 cap;
2136         u16 status;
2137
2138         pos = pci_find_capability(dev, PCI_CAP_ID_EXP);
2139         if (!pos)
2140                 return -ENOTTY;
2141
2142         pci_read_config_dword(dev, pos + PCI_EXP_DEVCAP, &cap);
2143         if (!(cap & PCI_EXP_DEVCAP_FLR))
2144                 return -ENOTTY;
2145
2146         if (probe)
2147                 return 0;
2148
2149         /* Wait for Transaction Pending bit clean */
2150         for (i = 0; i < 4; i++) {
2151                 if (i)
2152                         msleep((1 << (i - 1)) * 100);
2153
2154                 pci_read_config_word(dev, pos + PCI_EXP_DEVSTA, &status);
2155                 if (!(status & PCI_EXP_DEVSTA_TRPND))
2156                         goto clear;
2157         }
2158
2159         dev_err(&dev->dev, "transaction is not cleared; "
2160                         "proceeding with reset anyway\n");
2161
2162 clear:
2163         pci_write_config_word(dev, pos + PCI_EXP_DEVCTL,
2164                                 PCI_EXP_DEVCTL_BCR_FLR);
2165         msleep(100);
2166
2167         return 0;
2168 }
2169
2170 static int pci_af_flr(struct pci_dev *dev, int probe)
2171 {
2172         int i;
2173         int pos;
2174         u8 cap;
2175         u8 status;
2176
2177         pos = pci_find_capability(dev, PCI_CAP_ID_AF);
2178         if (!pos)
2179                 return -ENOTTY;
2180
2181         pci_read_config_byte(dev, pos + PCI_AF_CAP, &cap);
2182         if (!(cap & PCI_AF_CAP_TP) || !(cap & PCI_AF_CAP_FLR))
2183                 return -ENOTTY;
2184
2185         if (probe)
2186                 return 0;
2187
2188         /* Wait for Transaction Pending bit clean */
2189         for (i = 0; i < 4; i++) {
2190                 if (i)
2191                         msleep((1 << (i - 1)) * 100);
2192
2193                 pci_read_config_byte(dev, pos + PCI_AF_STATUS, &status);
2194                 if (!(status & PCI_AF_STATUS_TP))
2195                         goto clear;
2196         }
2197
2198         dev_err(&dev->dev, "transaction is not cleared; "
2199                         "proceeding with reset anyway\n");
2200
2201 clear:
2202         pci_write_config_byte(dev, pos + PCI_AF_CTRL, PCI_AF_CTRL_FLR);
2203         msleep(100);
2204
2205         return 0;
2206 }
2207
2208 static int pci_pm_reset(struct pci_dev *dev, int probe)
2209 {
2210         u16 csr;
2211
2212         if (!dev->pm_cap)
2213                 return -ENOTTY;
2214
2215         pci_read_config_word(dev, dev->pm_cap + PCI_PM_CTRL, &csr);
2216         if (csr & PCI_PM_CTRL_NO_SOFT_RESET)
2217                 return -ENOTTY;
2218
2219         if (probe)
2220                 return 0;
2221
2222         if (dev->current_state != PCI_D0)
2223                 return -EINVAL;
2224
2225         csr &= ~PCI_PM_CTRL_STATE_MASK;
2226         csr |= PCI_D3hot;
2227         pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, csr);
2228         msleep(pci_pm_d3_delay);
2229
2230         csr &= ~PCI_PM_CTRL_STATE_MASK;
2231         csr |= PCI_D0;
2232         pci_write_config_word(dev, dev->pm_cap + PCI_PM_CTRL, csr);
2233         msleep(pci_pm_d3_delay);
2234
2235         return 0;
2236 }
2237
2238 static int pci_parent_bus_reset(struct pci_dev *dev, int probe)
2239 {
2240         u16 ctrl;
2241         struct pci_dev *pdev;
2242
2243         if (pci_is_root_bus(dev->bus) || dev->subordinate || !dev->bus->self)
2244                 return -ENOTTY;
2245
2246         list_for_each_entry(pdev, &dev->bus->devices, bus_list)
2247                 if (pdev != dev)
2248                         return -ENOTTY;
2249
2250         if (probe)
2251                 return 0;
2252
2253         pci_read_config_word(dev->bus->self, PCI_BRIDGE_CONTROL, &ctrl);
2254         ctrl |= PCI_BRIDGE_CTL_BUS_RESET;
2255         pci_write_config_word(dev->bus->self, PCI_BRIDGE_CONTROL, ctrl);
2256         msleep(100);
2257
2258         ctrl &= ~PCI_BRIDGE_CTL_BUS_RESET;
2259         pci_write_config_word(dev->bus->self, PCI_BRIDGE_CONTROL, ctrl);
2260         msleep(100);
2261
2262         return 0;
2263 }
2264
2265 static int pci_dev_reset(struct pci_dev *dev, int probe)
2266 {
2267         int rc;
2268
2269         might_sleep();
2270
2271         if (!probe) {
2272                 pci_block_user_cfg_access(dev);
2273                 /* block PM suspend, driver probe, etc. */
2274                 down(&dev->dev.sem);
2275         }
2276
2277         rc = pcie_flr(dev, probe);
2278         if (rc != -ENOTTY)
2279                 goto done;
2280
2281         rc = pci_af_flr(dev, probe);
2282         if (rc != -ENOTTY)
2283                 goto done;
2284
2285         rc = pci_pm_reset(dev, probe);
2286         if (rc != -ENOTTY)
2287                 goto done;
2288
2289         rc = pci_parent_bus_reset(dev, probe);
2290 done:
2291         if (!probe) {
2292                 up(&dev->dev.sem);
2293                 pci_unblock_user_cfg_access(dev);
2294         }
2295
2296         return rc;
2297 }
2298
2299 /**
2300  * __pci_reset_function - reset a PCI device function
2301  * @dev: PCI device to reset
2302  *
2303  * Some devices allow an individual function to be reset without affecting
2304  * other functions in the same device.  The PCI device must be responsive
2305  * to PCI config space in order to use this function.
2306  *
2307  * The device function is presumed to be unused when this function is called.
2308  * Resetting the device will make the contents of PCI configuration space
2309  * random, so any caller of this must be prepared to reinitialise the
2310  * device including MSI, bus mastering, BARs, decoding IO and memory spaces,
2311  * etc.
2312  *
2313  * Returns 0 if the device function was successfully reset or negative if the
2314  * device doesn't support resetting a single function.
2315  */
2316 int __pci_reset_function(struct pci_dev *dev)
2317 {
2318         return pci_dev_reset(dev, 0);
2319 }
2320 EXPORT_SYMBOL_GPL(__pci_reset_function);
2321
2322 /**
2323  * pci_probe_reset_function - check whether the device can be safely reset
2324  * @dev: PCI device to reset
2325  *
2326  * Some devices allow an individual function to be reset without affecting
2327  * other functions in the same device.  The PCI device must be responsive
2328  * to PCI config space in order to use this function.
2329  *
2330  * Returns 0 if the device function can be reset or negative if the
2331  * device doesn't support resetting a single function.
2332  */
2333 int pci_probe_reset_function(struct pci_dev *dev)
2334 {
2335         return pci_dev_reset(dev, 1);
2336 }
2337
2338 /**
2339  * pci_reset_function - quiesce and reset a PCI device function
2340  * @dev: PCI device to reset
2341  *
2342  * Some devices allow an individual function to be reset without affecting
2343  * other functions in the same device.  The PCI device must be responsive
2344  * to PCI config space in order to use this function.
2345  *
2346  * This function does not just reset the PCI portion of a device, but
2347  * clears all the state associated with the device.  This function differs
2348  * from __pci_reset_function in that it saves and restores device state
2349  * over the reset.
2350  *
2351  * Returns 0 if the device function was successfully reset or negative if the
2352  * device doesn't support resetting a single function.
2353  */
2354 int pci_reset_function(struct pci_dev *dev)
2355 {
2356         int rc;
2357
2358         rc = pci_dev_reset(dev, 1);
2359         if (rc)
2360                 return rc;
2361
2362         pci_save_state(dev);
2363
2364         /*
2365          * both INTx and MSI are disabled after the Interrupt Disable bit
2366          * is set and the Bus Master bit is cleared.
2367          */
2368         pci_write_config_word(dev, PCI_COMMAND, PCI_COMMAND_INTX_DISABLE);
2369
2370         rc = pci_dev_reset(dev, 0);
2371
2372         pci_restore_state(dev);
2373
2374         return rc;
2375 }
2376 EXPORT_SYMBOL_GPL(pci_reset_function);
2377
2378 /**
2379  * pcix_get_max_mmrbc - get PCI-X maximum designed memory read byte count
2380  * @dev: PCI device to query
2381  *
2382  * Returns mmrbc: maximum designed memory read count in bytes
2383  *    or appropriate error value.
2384  */
2385 int pcix_get_max_mmrbc(struct pci_dev *dev)
2386 {
2387         int err, cap;
2388         u32 stat;
2389
2390         cap = pci_find_capability(dev, PCI_CAP_ID_PCIX);
2391         if (!cap)
2392                 return -EINVAL;
2393
2394         err = pci_read_config_dword(dev, cap + PCI_X_STATUS, &stat);
2395         if (err)
2396                 return -EINVAL;
2397
2398         return (stat & PCI_X_STATUS_MAX_READ) >> 12;
2399 }
2400 EXPORT_SYMBOL(pcix_get_max_mmrbc);
2401
2402 /**
2403  * pcix_get_mmrbc - get PCI-X maximum memory read byte count
2404  * @dev: PCI device to query
2405  *
2406  * Returns mmrbc: maximum memory read count in bytes
2407  *    or appropriate error value.
2408  */
2409 int pcix_get_mmrbc(struct pci_dev *dev)
2410 {
2411         int ret, cap;
2412         u32 cmd;
2413
2414         cap = pci_find_capability(dev, PCI_CAP_ID_PCIX);
2415         if (!cap)
2416                 return -EINVAL;
2417
2418         ret = pci_read_config_dword(dev, cap + PCI_X_CMD, &cmd);
2419         if (!ret)
2420                 ret = 512 << ((cmd & PCI_X_CMD_MAX_READ) >> 2);
2421
2422         return ret;
2423 }
2424 EXPORT_SYMBOL(pcix_get_mmrbc);
2425
2426 /**
2427  * pcix_set_mmrbc - set PCI-X maximum memory read byte count
2428  * @dev: PCI device to query
2429  * @mmrbc: maximum memory read count in bytes
2430  *    valid values are 512, 1024, 2048, 4096
2431  *
2432  * If possible sets maximum memory read byte count, some bridges have erratas
2433  * that prevent this.
2434  */
2435 int pcix_set_mmrbc(struct pci_dev *dev, int mmrbc)
2436 {
2437         int cap, err = -EINVAL;
2438         u32 stat, cmd, v, o;
2439
2440         if (mmrbc < 512 || mmrbc > 4096 || !is_power_of_2(mmrbc))
2441                 goto out;
2442
2443         v = ffs(mmrbc) - 10;
2444
2445         cap = pci_find_capability(dev, PCI_CAP_ID_PCIX);
2446         if (!cap)
2447                 goto out;
2448
2449         err = pci_read_config_dword(dev, cap + PCI_X_STATUS, &stat);
2450         if (err)
2451                 goto out;
2452
2453         if (v > (stat & PCI_X_STATUS_MAX_READ) >> 21)
2454                 return -E2BIG;
2455
2456         err = pci_read_config_dword(dev, cap + PCI_X_CMD, &cmd);
2457         if (err)
2458                 goto out;
2459
2460         o = (cmd & PCI_X_CMD_MAX_READ) >> 2;
2461         if (o != v) {
2462                 if (v > o && dev->bus &&
2463                    (dev->bus->bus_flags & PCI_BUS_FLAGS_NO_MMRBC))
2464                         return -EIO;
2465
2466                 cmd &= ~PCI_X_CMD_MAX_READ;
2467                 cmd |= v << 2;
2468                 err = pci_write_config_dword(dev, cap + PCI_X_CMD, cmd);
2469         }
2470 out:
2471         return err;
2472 }
2473 EXPORT_SYMBOL(pcix_set_mmrbc);
2474
2475 /**
2476  * pcie_get_readrq - get PCI Express read request size
2477  * @dev: PCI device to query
2478  *
2479  * Returns maximum memory read request in bytes
2480  *    or appropriate error value.
2481  */
2482 int pcie_get_readrq(struct pci_dev *dev)
2483 {
2484         int ret, cap;
2485         u16 ctl;
2486
2487         cap = pci_find_capability(dev, PCI_CAP_ID_EXP);
2488         if (!cap)
2489                 return -EINVAL;
2490
2491         ret = pci_read_config_word(dev, cap + PCI_EXP_DEVCTL, &ctl);
2492         if (!ret)
2493         ret = 128 << ((ctl & PCI_EXP_DEVCTL_READRQ) >> 12);
2494
2495         return ret;
2496 }
2497 EXPORT_SYMBOL(pcie_get_readrq);
2498
2499 /**
2500  * pcie_set_readrq - set PCI Express maximum memory read request
2501  * @dev: PCI device to query
2502  * @rq: maximum memory read count in bytes
2503  *    valid values are 128, 256, 512, 1024, 2048, 4096
2504  *
2505  * If possible sets maximum read byte count
2506  */
2507 int pcie_set_readrq(struct pci_dev *dev, int rq)
2508 {
2509         int cap, err = -EINVAL;
2510         u16 ctl, v;
2511
2512         if (rq < 128 || rq > 4096 || !is_power_of_2(rq))
2513                 goto out;
2514
2515         v = (ffs(rq) - 8) << 12;
2516
2517         cap = pci_find_capability(dev, PCI_CAP_ID_EXP);
2518         if (!cap)
2519                 goto out;
2520
2521         err = pci_read_config_word(dev, cap + PCI_EXP_DEVCTL, &ctl);
2522         if (err)
2523                 goto out;
2524
2525         if ((ctl & PCI_EXP_DEVCTL_READRQ) != v) {
2526                 ctl &= ~PCI_EXP_DEVCTL_READRQ;
2527                 ctl |= v;
2528                 err = pci_write_config_dword(dev, cap + PCI_EXP_DEVCTL, ctl);
2529         }
2530
2531 out:
2532         return err;
2533 }
2534 EXPORT_SYMBOL(pcie_set_readrq);
2535
2536 /**
2537  * pci_select_bars - Make BAR mask from the type of resource
2538  * @dev: the PCI device for which BAR mask is made
2539  * @flags: resource type mask to be selected
2540  *
2541  * This helper routine makes bar mask from the type of resource.
2542  */
2543 int pci_select_bars(struct pci_dev *dev, unsigned long flags)
2544 {
2545         int i, bars = 0;
2546         for (i = 0; i < PCI_NUM_RESOURCES; i++)
2547                 if (pci_resource_flags(dev, i) & flags)
2548                         bars |= (1 << i);
2549         return bars;
2550 }
2551
2552 /**
2553  * pci_resource_bar - get position of the BAR associated with a resource
2554  * @dev: the PCI device
2555  * @resno: the resource number
2556  * @type: the BAR type to be filled in
2557  *
2558  * Returns BAR position in config space, or 0 if the BAR is invalid.
2559  */
2560 int pci_resource_bar(struct pci_dev *dev, int resno, enum pci_bar_type *type)
2561 {
2562         int reg;
2563
2564         if (resno < PCI_ROM_RESOURCE) {
2565                 *type = pci_bar_unknown;
2566                 return PCI_BASE_ADDRESS_0 + 4 * resno;
2567         } else if (resno == PCI_ROM_RESOURCE) {
2568                 *type = pci_bar_mem32;
2569                 return dev->rom_base_reg;
2570         } else if (resno < PCI_BRIDGE_RESOURCES) {
2571                 /* device specific resource */
2572                 reg = pci_iov_resource_bar(dev, resno, type);
2573                 if (reg)
2574                         return reg;
2575         }
2576
2577         dev_err(&dev->dev, "BAR: invalid resource #%d\n", resno);
2578         return 0;
2579 }
2580
2581 /**
2582  * pci_set_vga_state - set VGA decode state on device and parents if requested
2583  * @dev: the PCI device
2584  * @decode: true = enable decoding, false = disable decoding
2585  * @command_bits: PCI_COMMAND_IO and/or PCI_COMMAND_MEMORY
2586  * @change_bridge: traverse ancestors and change bridges
2587  */
2588 int pci_set_vga_state(struct pci_dev *dev, bool decode,
2589                       unsigned int command_bits, bool change_bridge)
2590 {
2591         struct pci_bus *bus;
2592         struct pci_dev *bridge;
2593         u16 cmd;
2594
2595         WARN_ON(command_bits & ~(PCI_COMMAND_IO|PCI_COMMAND_MEMORY));
2596
2597         pci_read_config_word(dev, PCI_COMMAND, &cmd);
2598         if (decode == true)
2599                 cmd |= command_bits;
2600         else
2601                 cmd &= ~command_bits;
2602         pci_write_config_word(dev, PCI_COMMAND, cmd);
2603
2604         if (change_bridge == false)
2605                 return 0;
2606
2607         bus = dev->bus;
2608         while (bus) {
2609                 bridge = bus->self;
2610                 if (bridge) {
2611                         pci_read_config_word(bridge, PCI_BRIDGE_CONTROL,
2612                                              &cmd);
2613                         if (decode == true)
2614                                 cmd |= PCI_BRIDGE_CTL_VGA;
2615                         else
2616                                 cmd &= ~PCI_BRIDGE_CTL_VGA;
2617                         pci_write_config_word(bridge, PCI_BRIDGE_CONTROL,
2618                                               cmd);
2619                 }
2620                 bus = bus->parent;
2621         }
2622         return 0;
2623 }
2624
2625 #define RESOURCE_ALIGNMENT_PARAM_SIZE COMMAND_LINE_SIZE
2626 static char resource_alignment_param[RESOURCE_ALIGNMENT_PARAM_SIZE] = {0};
2627 spinlock_t resource_alignment_lock = SPIN_LOCK_UNLOCKED;
2628
2629 /**
2630  * pci_specified_resource_alignment - get resource alignment specified by user.
2631  * @dev: the PCI device to get
2632  *
2633  * RETURNS: Resource alignment if it is specified.
2634  *          Zero if it is not specified.
2635  */
2636 resource_size_t pci_specified_resource_alignment(struct pci_dev *dev)
2637 {
2638         int seg, bus, slot, func, align_order, count;
2639         resource_size_t align = 0;
2640         char *p;
2641
2642         spin_lock(&resource_alignment_lock);
2643         p = resource_alignment_param;
2644         while (*p) {
2645                 count = 0;
2646                 if (sscanf(p, "%d%n", &align_order, &count) == 1 &&
2647                                                         p[count] == '@') {
2648                         p += count + 1;
2649                 } else {
2650                         align_order = -1;
2651                 }
2652                 if (sscanf(p, "%x:%x:%x.%x%n",
2653                         &seg, &bus, &slot, &func, &count) != 4) {
2654                         seg = 0;
2655                         if (sscanf(p, "%x:%x.%x%n",
2656                                         &bus, &slot, &func, &count) != 3) {
2657                                 /* Invalid format */
2658                                 printk(KERN_ERR "PCI: Can't parse resource_alignment parameter: %s\n",
2659                                         p);
2660                                 break;
2661                         }
2662                 }
2663                 p += count;
2664                 if (seg == pci_domain_nr(dev->bus) &&
2665                         bus == dev->bus->number &&
2666                         slot == PCI_SLOT(dev->devfn) &&
2667                         func == PCI_FUNC(dev->devfn)) {
2668                         if (align_order == -1) {
2669                                 align = PAGE_SIZE;
2670                         } else {
2671                                 align = 1 << align_order;
2672                         }
2673                         /* Found */
2674                         break;
2675                 }
2676                 if (*p != ';' && *p != ',') {
2677                         /* End of param or invalid format */
2678                         break;
2679                 }
2680                 p++;
2681         }
2682         spin_unlock(&resource_alignment_lock);
2683         return align;
2684 }
2685
2686 /**
2687  * pci_is_reassigndev - check if specified PCI is target device to reassign
2688  * @dev: the PCI device to check
2689  *
2690  * RETURNS: non-zero for PCI device is a target device to reassign,
2691  *          or zero is not.
2692  */
2693 int pci_is_reassigndev(struct pci_dev *dev)
2694 {
2695         return (pci_specified_resource_alignment(dev) != 0);
2696 }
2697
2698 ssize_t pci_set_resource_alignment_param(const char *buf, size_t count)
2699 {
2700         if (count > RESOURCE_ALIGNMENT_PARAM_SIZE - 1)
2701                 count = RESOURCE_ALIGNMENT_PARAM_SIZE - 1;
2702         spin_lock(&resource_alignment_lock);
2703         strncpy(resource_alignment_param, buf, count);
2704         resource_alignment_param[count] = '\0';
2705         spin_unlock(&resource_alignment_lock);
2706         return count;
2707 }
2708
2709 ssize_t pci_get_resource_alignment_param(char *buf, size_t size)
2710 {
2711         size_t count;
2712         spin_lock(&resource_alignment_lock);
2713         count = snprintf(buf, size, "%s", resource_alignment_param);
2714         spin_unlock(&resource_alignment_lock);
2715         return count;
2716 }
2717
2718 static ssize_t pci_resource_alignment_show(struct bus_type *bus, char *buf)
2719 {
2720         return pci_get_resource_alignment_param(buf, PAGE_SIZE);
2721 }
2722
2723 static ssize_t pci_resource_alignment_store(struct bus_type *bus,
2724                                         const char *buf, size_t count)
2725 {
2726         return pci_set_resource_alignment_param(buf, count);
2727 }
2728
2729 BUS_ATTR(resource_alignment, 0644, pci_resource_alignment_show,
2730                                         pci_resource_alignment_store);
2731
2732 static int __init pci_resource_alignment_sysfs_init(void)
2733 {
2734         return bus_create_file(&pci_bus_type,
2735                                         &bus_attr_resource_alignment);
2736 }
2737
2738 late_initcall(pci_resource_alignment_sysfs_init);
2739
2740 static void __devinit pci_no_domains(void)
2741 {
2742 #ifdef CONFIG_PCI_DOMAINS
2743         pci_domains_supported = 0;
2744 #endif
2745 }
2746
2747 /**
2748  * pci_ext_cfg_enabled - can we access extended PCI config space?
2749  * @dev: The PCI device of the root bridge.
2750  *
2751  * Returns 1 if we can access PCI extended config space (offsets
2752  * greater than 0xff). This is the default implementation. Architecture
2753  * implementations can override this.
2754  */
2755 int __attribute__ ((weak)) pci_ext_cfg_avail(struct pci_dev *dev)
2756 {
2757         return 1;
2758 }
2759
2760 static int __init pci_setup(char *str)
2761 {
2762         while (str) {
2763                 char *k = strchr(str, ',');
2764                 if (k)
2765                         *k++ = 0;
2766                 if (*str && (str = pcibios_setup(str)) && *str) {
2767                         if (!strcmp(str, "nomsi")) {
2768                                 pci_no_msi();
2769                         } else if (!strcmp(str, "noaer")) {
2770                                 pci_no_aer();
2771                         } else if (!strcmp(str, "nodomains")) {
2772                                 pci_no_domains();
2773                         } else if (!strncmp(str, "cbiosize=", 9)) {
2774                                 pci_cardbus_io_size = memparse(str + 9, &str);
2775                         } else if (!strncmp(str, "cbmemsize=", 10)) {
2776                                 pci_cardbus_mem_size = memparse(str + 10, &str);
2777                         } else if (!strncmp(str, "resource_alignment=", 19)) {
2778                                 pci_set_resource_alignment_param(str + 19,
2779                                                         strlen(str + 19));
2780                         } else if (!strncmp(str, "ecrc=", 5)) {
2781                                 pcie_ecrc_get_policy(str + 5);
2782                         } else if (!strncmp(str, "hpiosize=", 9)) {
2783                                 pci_hotplug_io_size = memparse(str + 9, &str);
2784                         } else if (!strncmp(str, "hpmemsize=", 10)) {
2785                                 pci_hotplug_mem_size = memparse(str + 10, &str);
2786                         } else {
2787                                 printk(KERN_ERR "PCI: Unknown option `%s'\n",
2788                                                 str);
2789                         }
2790                 }
2791                 str = k;
2792         }
2793         return 0;
2794 }
2795 early_param("pci", pci_setup);
2796
2797 EXPORT_SYMBOL(pci_reenable_device);
2798 EXPORT_SYMBOL(pci_enable_device_io);
2799 EXPORT_SYMBOL(pci_enable_device_mem);
2800 EXPORT_SYMBOL(pci_enable_device);
2801 EXPORT_SYMBOL(pcim_enable_device);
2802 EXPORT_SYMBOL(pcim_pin_device);
2803 EXPORT_SYMBOL(pci_disable_device);
2804 EXPORT_SYMBOL(pci_find_capability);
2805 EXPORT_SYMBOL(pci_bus_find_capability);
2806 EXPORT_SYMBOL(pci_release_regions);
2807 EXPORT_SYMBOL(pci_request_regions);
2808 EXPORT_SYMBOL(pci_request_regions_exclusive);
2809 EXPORT_SYMBOL(pci_release_region);
2810 EXPORT_SYMBOL(pci_request_region);
2811 EXPORT_SYMBOL(pci_request_region_exclusive);
2812 EXPORT_SYMBOL(pci_release_selected_regions);
2813 EXPORT_SYMBOL(pci_request_selected_regions);
2814 EXPORT_SYMBOL(pci_request_selected_regions_exclusive);
2815 EXPORT_SYMBOL(pci_set_master);
2816 EXPORT_SYMBOL(pci_clear_master);
2817 EXPORT_SYMBOL(pci_set_mwi);
2818 EXPORT_SYMBOL(pci_try_set_mwi);
2819 EXPORT_SYMBOL(pci_clear_mwi);
2820 EXPORT_SYMBOL_GPL(pci_intx);
2821 EXPORT_SYMBOL(pci_set_dma_mask);
2822 EXPORT_SYMBOL(pci_set_consistent_dma_mask);
2823 EXPORT_SYMBOL(pci_assign_resource);
2824 EXPORT_SYMBOL(pci_find_parent_resource);
2825 EXPORT_SYMBOL(pci_select_bars);
2826
2827 EXPORT_SYMBOL(pci_set_power_state);
2828 EXPORT_SYMBOL(pci_save_state);
2829 EXPORT_SYMBOL(pci_restore_state);
2830 EXPORT_SYMBOL(pci_pme_capable);
2831 EXPORT_SYMBOL(pci_pme_active);
2832 EXPORT_SYMBOL(pci_enable_wake);
2833 EXPORT_SYMBOL(pci_wake_from_d3);
2834 EXPORT_SYMBOL(pci_target_state);
2835 EXPORT_SYMBOL(pci_prepare_to_sleep);
2836 EXPORT_SYMBOL(pci_back_from_sleep);
2837 EXPORT_SYMBOL_GPL(pci_set_pcie_reset_state);
2838