drivers/pci/pci-sysfs.c

   1 /*
   2  * drivers/pci/pci-sysfs.c
   3  *
   4  * (C) Copyright 2002-2004 Greg Kroah-Hartman <greg@kroah.com>
   5  * (C) Copyright 2002-2004 IBM Corp.
   6  * (C) Copyright 2003 Matthew Wilcox
   7  * (C) Copyright 2003 Hewlett-Packard
   8  * (C) Copyright 2004 Jon Smirl <jonsmirl@yahoo.com>
   9  * (C) Copyright 2004 Silicon Graphics, Inc. Jesse Barnes <jbarnes@sgi.com>
  10  *
  11  * File attributes for PCI devices
  12  *
  13  * Modeled after usb's driverfs.c
  14  *
  15  */
  16
  17
  18 #include <linux/kernel.h>
  19 #include <linux/sched.h>
  20 #include <linux/pci.h>
  21 #include <linux/stat.h>
  22 #include <linux/export.h>
  23 #include <linux/topology.h>
  24 #include <linux/mm.h>
  25 #include <linux/fs.h>
  26 #include <linux/capability.h>
  27 #include <linux/security.h>
  28 #include <linux/pci-aspm.h>
  29 #include <linux/slab.h>
  30 #include <linux/vgaarb.h>
  31 #include <linux/pm_runtime.h>
  32 #include <linux/of.h>
  33 #include "pci.h"
  34
  35 static int sysfs_initialized;   /* = 0 */
  36
  37 /* show configuration fields */
  38 #define pci_config_attr(field, format_string)                           \
  39 static ssize_t                                                          \
  40 field##_show(struct device *dev, struct device_attribute *attr, char *buf)                              \
  41 {                                                                       \
  42         struct pci_dev *pdev;                                           \
  43                                                                         \
  44         pdev = to_pci_dev(dev);                                         \
  45         return sprintf(buf, format_string, pdev->field);                \
  46 }                                                                       \
  47 static DEVICE_ATTR_RO(field)
  48
  49 pci_config_attr(vendor, "0x%04x\n");
  50 pci_config_attr(device, "0x%04x\n");
  51 pci_config_attr(subsystem_vendor, "0x%04x\n");
  52 pci_config_attr(subsystem_device, "0x%04x\n");
  53 pci_config_attr(class, "0x%06x\n");
  54 pci_config_attr(irq, "%u\n");
  55
  56 static ssize_t broken_parity_status_show(struct device *dev,
  57                                          struct device_attribute *attr,
  58                                          char *buf)
  59 {
  60         struct pci_dev *pdev = to_pci_dev(dev);
  61         return sprintf(buf, "%u\n", pdev->broken_parity_status);
  62 }
  63
  64 static ssize_t broken_parity_status_store(struct device *dev,
  65                                           struct device_attribute *attr,
  66                                           const char *buf, size_t count)
  67 {
  68         struct pci_dev *pdev = to_pci_dev(dev);
  69         unsigned long val;
  70
  71         if (kstrtoul(buf, 0, &val) < 0)
  72                 return -EINVAL;
  73
  74         pdev->broken_parity_status = !!val;
  75
  76         return count;
  77 }
  78 static DEVICE_ATTR_RW(broken_parity_status);
  79
  80 static ssize_t pci_dev_show_local_cpu(struct device *dev, bool list,
  81                                       struct device_attribute *attr, char *buf)
  82 {
  83         const struct cpumask *mask;
  84
  85 #ifdef CONFIG_NUMA
  86         mask = (dev_to_node(dev) == -1) ? cpu_online_mask :
  87                                           cpumask_of_node(dev_to_node(dev));
  88 #else
  89         mask = cpumask_of_pcibus(to_pci_dev(dev)->bus);
  90 #endif
  91         return cpumap_print_to_pagebuf(list, buf, mask);
  92 }
  93
  94 static ssize_t local_cpus_show(struct device *dev,
  95                                struct device_attribute *attr, char *buf)
  96 {
  97         return pci_dev_show_local_cpu(dev, false, attr, buf);
  98 }
  99 static DEVICE_ATTR_RO(local_cpus);
 100
 101 static ssize_t local_cpulist_show(struct device *dev,
 102                                   struct device_attribute *attr, char *buf)
 103 {
 104         return pci_dev_show_local_cpu(dev, true, attr, buf);
 105 }
 106 static DEVICE_ATTR_RO(local_cpulist);
 107
 108 /*
 109  * PCI Bus Class Devices
 110  */
 111 static ssize_t cpuaffinity_show(struct device *dev,
 112                                 struct device_attribute *attr, char *buf)
 113 {
 114         const struct cpumask *cpumask = cpumask_of_pcibus(to_pci_bus(dev));
 115
 116         return cpumap_print_to_pagebuf(false, buf, cpumask);
 117 }
 118 static DEVICE_ATTR_RO(cpuaffinity);
 119
 120 static ssize_t cpulistaffinity_show(struct device *dev,
 121                                     struct device_attribute *attr, char *buf)
 122 {
 123         const struct cpumask *cpumask = cpumask_of_pcibus(to_pci_bus(dev));
 124
 125         return cpumap_print_to_pagebuf(true, buf, cpumask);
 126 }
 127 static DEVICE_ATTR_RO(cpulistaffinity);
 128
 129 /* show resources */
 130 static ssize_t resource_show(struct device *dev, struct device_attribute *attr,
 131                              char *buf)
 132 {
 133         struct pci_dev *pci_dev = to_pci_dev(dev);
 134         char *str = buf;
 135         int i;
 136         int max;
 137         resource_size_t start, end;
 138
 139         if (pci_dev->subordinate)
 140                 max = DEVICE_COUNT_RESOURCE;
 141         else
 142                 max = PCI_BRIDGE_RESOURCES;
 143
 144         for (i = 0; i < max; i++) {
 145                 struct resource *res =  &pci_dev->resource[i];
 146                 pci_resource_to_user(pci_dev, i, res, &start, &end);
 147                 str += sprintf(str, "0x%016llx 0x%016llx 0x%016llx\n",
 148                                (unsigned long long)start,
 149                                (unsigned long long)end,
 150                                (unsigned long long)res->flags);
 151         }
 152         return (str - buf);
 153 }
 154 static DEVICE_ATTR_RO(resource);
 155
 156 static ssize_t modalias_show(struct device *dev, struct device_attribute *attr,
 157                              char *buf)
 158 {
 159         struct pci_dev *pci_dev = to_pci_dev(dev);
 160
 161         return sprintf(buf, "pci:v%08Xd%08Xsv%08Xsd%08Xbc%02Xsc%02Xi%02X\n",
 162                        pci_dev->vendor, pci_dev->device,
 163                        pci_dev->subsystem_vendor, pci_dev->subsystem_device,
 164                        (u8)(pci_dev->class >> 16), (u8)(pci_dev->class >> 8),
 165                        (u8)(pci_dev->class));
 166 }
 167 static DEVICE_ATTR_RO(modalias);
 168
 169 static ssize_t enable_store(struct device *dev, struct device_attribute *attr,
 170                              const char *buf, size_t count)
 171 {
 172         struct pci_dev *pdev = to_pci_dev(dev);
 173         unsigned long val;
 174         ssize_t result = kstrtoul(buf, 0, &val);
 175
 176         if (result < 0)
 177                 return result;
 178
 179         /* this can crash the machine when done on the "wrong" device */
 180         if (!capable(CAP_SYS_ADMIN))
 181                 return -EPERM;
 182
 183         device_lock(dev);
 184         if (dev->driver)
 185                 result = -EBUSY;
 186         else if (val)
 187                 result = pci_enable_device(pdev);
 188         else if (pci_is_enabled(pdev))
 189                 pci_disable_device(pdev);
 190         else
 191                 result = -EIO;
 192         device_unlock(dev);
 193
 194         return result < 0 ? result : count;
 195 }
 196
 197 static ssize_t enable_show(struct device *dev, struct device_attribute *attr,
 198                             char *buf)
 199 {
 200         struct pci_dev *pdev;
 201
 202         pdev = to_pci_dev(dev);
 203         return sprintf(buf, "%u\n", atomic_read(&pdev->enable_cnt));
 204 }
 205 static DEVICE_ATTR_RW(enable);
 206
 207 #ifdef CONFIG_NUMA
 208 static ssize_t numa_node_store(struct device *dev,
 209                                struct device_attribute *attr, const char *buf,
 210                                size_t count)
 211 {
 212         struct pci_dev *pdev = to_pci_dev(dev);
 213         int node, ret;
 214
 215         if (!capable(CAP_SYS_ADMIN))
 216                 return -EPERM;
 217
 218         ret = kstrtoint(buf, 0, &node);
 219         if (ret)
 220                 return ret;
 221
 222         if ((node < 0 && node != NUMA_NO_NODE) || node >= MAX_NUMNODES)
 223                 return -EINVAL;
 224
 225         if (node != NUMA_NO_NODE && !node_online(node))
 226                 return -EINVAL;
 227
 228         add_taint(TAINT_FIRMWARE_WORKAROUND, LOCKDEP_STILL_OK);
 229         dev_alert(&pdev->dev, FW_BUG "Overriding NUMA node to %d.  Contact your vendor for updates.",
 230                   node);
 231
 232         dev->numa_node = node;
 233         return count;
 234 }
 235
 236 static ssize_t numa_node_show(struct device *dev, struct device_attribute *attr,
 237                               char *buf)
 238 {
 239         return sprintf(buf, "%d\n", dev->numa_node);
 240 }
 241 static DEVICE_ATTR_RW(numa_node);
 242 #endif
 243
 244 static ssize_t dma_mask_bits_show(struct device *dev,
 245                                   struct device_attribute *attr, char *buf)
 246 {
 247         struct pci_dev *pdev = to_pci_dev(dev);
 248
 249         return sprintf(buf, "%d\n", fls64(pdev->dma_mask));
 250 }
 251 static DEVICE_ATTR_RO(dma_mask_bits);
 252
 253 static ssize_t consistent_dma_mask_bits_show(struct device *dev,
 254                                              struct device_attribute *attr,
 255                                              char *buf)
 256 {
 257         return sprintf(buf, "%d\n", fls64(dev->coherent_dma_mask));
 258 }
 259 static DEVICE_ATTR_RO(consistent_dma_mask_bits);
 260
 261 static ssize_t msi_bus_show(struct device *dev, struct device_attribute *attr,
 262                             char *buf)
 263 {
 264         struct pci_dev *pdev = to_pci_dev(dev);
 265         struct pci_bus *subordinate = pdev->subordinate;
 266
 267         return sprintf(buf, "%u\n", subordinate ?
 268                        !(subordinate->bus_flags & PCI_BUS_FLAGS_NO_MSI)
 269                            : !pdev->no_msi);
 270 }
 271
 272 static ssize_t msi_bus_store(struct device *dev, struct device_attribute *attr,
 273                              const char *buf, size_t count)
 274 {
 275         struct pci_dev *pdev = to_pci_dev(dev);
 276         struct pci_bus *subordinate = pdev->subordinate;
 277         unsigned long val;
 278
 279         if (kstrtoul(buf, 0, &val) < 0)
 280                 return -EINVAL;
 281
 282         if (!capable(CAP_SYS_ADMIN))
 283                 return -EPERM;
 284
 285         /*
 286          * "no_msi" and "bus_flags" only affect what happens when a driver
 287          * requests MSI or MSI-X.  They don't affect any drivers that have
 288          * already requested MSI or MSI-X.
 289          */
 290         if (!subordinate) {
 291                 pdev->no_msi = !val;
 292                 dev_info(&pdev->dev, "MSI/MSI-X %s for future drivers\n",
 293                          val ? "allowed" : "disallowed");
 294                 return count;
 295         }
 296
 297         if (val)
 298                 subordinate->bus_flags &= ~PCI_BUS_FLAGS_NO_MSI;
 299         else
 300                 subordinate->bus_flags |= PCI_BUS_FLAGS_NO_MSI;
 301
 302         dev_info(&subordinate->dev, "MSI/MSI-X %s for future drivers of devices on this bus\n",
 303                  val ? "allowed" : "disallowed");
 304         return count;
 305 }
 306 static DEVICE_ATTR_RW(msi_bus);
 307
 308 static ssize_t bus_rescan_store(struct bus_type *bus, const char *buf,
 309                                 size_t count)
 310 {
 311         unsigned long val;
 312         struct pci_bus *b = NULL;
 313
 314         if (kstrtoul(buf, 0, &val) < 0)
 315                 return -EINVAL;
 316
 317         if (val) {
 318                 pci_lock_rescan_remove();
 319                 while ((b = pci_find_next_bus(b)) != NULL)
 320                         pci_rescan_bus(b);
 321                 pci_unlock_rescan_remove();
 322         }
 323         return count;
 324 }
 325 static BUS_ATTR(rescan, (S_IWUSR|S_IWGRP), NULL, bus_rescan_store);
 326
 327 static struct attribute *pci_bus_attrs[] = {
 328         &bus_attr_rescan.attr,
 329         NULL,
 330 };
 331
 332 static const struct attribute_group pci_bus_group = {
 333         .attrs = pci_bus_attrs,
 334 };
 335
 336 const struct attribute_group *pci_bus_groups[] = {
 337         &pci_bus_group,
 338         NULL,
 339 };
 340
 341 static ssize_t dev_rescan_store(struct device *dev,
 342                                 struct device_attribute *attr, const char *buf,
 343                                 size_t count)
 344 {
 345         unsigned long val;
 346         struct pci_dev *pdev = to_pci_dev(dev);
 347
 348         if (kstrtoul(buf, 0, &val) < 0)
 349                 return -EINVAL;
 350
 351         if (val) {
 352                 pci_lock_rescan_remove();
 353                 pci_rescan_bus(pdev->bus);
 354                 pci_unlock_rescan_remove();
 355         }
 356         return count;
 357 }
 358 static struct device_attribute dev_rescan_attr = __ATTR(rescan,
 359                                                         (S_IWUSR|S_IWGRP),
 360                                                         NULL, dev_rescan_store);
 361
 362 static ssize_t remove_store(struct device *dev, struct device_attribute *attr,
 363                             const char *buf, size_t count)
 364 {
 365         unsigned long val;
 366
 367         if (kstrtoul(buf, 0, &val) < 0)
 368                 return -EINVAL;
 369
 370         if (val && device_remove_file_self(dev, attr))
 371                 pci_stop_and_remove_bus_device_locked(to_pci_dev(dev));
 372         return count;
 373 }
 374 static struct device_attribute dev_remove_attr = __ATTR_IGNORE_LOCKDEP(remove,
 375                                                         (S_IWUSR|S_IWGRP),
 376                                                         NULL, remove_store);
 377
 378 static ssize_t dev_bus_rescan_store(struct device *dev,
 379                                     struct device_attribute *attr,
 380                                     const char *buf, size_t count)
 381 {
 382         unsigned long val;
 383         struct pci_bus *bus = to_pci_bus(dev);
 384
 385         if (kstrtoul(buf, 0, &val) < 0)
 386                 return -EINVAL;
 387
 388         if (val) {
 389                 pci_lock_rescan_remove();
 390                 if (!pci_is_root_bus(bus) && list_empty(&bus->devices))
 391                         pci_rescan_bus_bridge_resize(bus->self);
 392                 else
 393                         pci_rescan_bus(bus);
 394                 pci_unlock_rescan_remove();
 395         }
 396         return count;
 397 }
 398 static DEVICE_ATTR(rescan, (S_IWUSR|S_IWGRP), NULL, dev_bus_rescan_store);
 399
 400 #if defined(CONFIG_PM) && defined(CONFIG_ACPI)
 401 static ssize_t d3cold_allowed_store(struct device *dev,
 402                                     struct device_attribute *attr,
 403                                     const char *buf, size_t count)
 404 {
 405         struct pci_dev *pdev = to_pci_dev(dev);
 406         unsigned long val;
 407
 408         if (kstrtoul(buf, 0, &val) < 0)
 409                 return -EINVAL;
 410
 411         pdev->d3cold_allowed = !!val;
 412         pm_runtime_resume(dev);
 413
 414         return count;
 415 }
 416
 417 static ssize_t d3cold_allowed_show(struct device *dev,
 418                                    struct device_attribute *attr, char *buf)
 419 {
 420         struct pci_dev *pdev = to_pci_dev(dev);
 421         return sprintf(buf, "%u\n", pdev->d3cold_allowed);
 422 }
 423 static DEVICE_ATTR_RW(d3cold_allowed);
 424 #endif
 425
 426 #ifdef CONFIG_OF
 427 static ssize_t devspec_show(struct device *dev,
 428                             struct device_attribute *attr, char *buf)
 429 {
 430         struct pci_dev *pdev = to_pci_dev(dev);
 431         struct device_node *np = pci_device_to_OF_node(pdev);
 432
 433         if (np == NULL || np->full_name == NULL)
 434                 return 0;
 435         return sprintf(buf, "%s", np->full_name);
 436 }
 437 static DEVICE_ATTR_RO(devspec);
 438 #endif
 439
 440 #ifdef CONFIG_PCI_IOV
 441 static ssize_t sriov_totalvfs_show(struct device *dev,
 442                                    struct device_attribute *attr,
 443                                    char *buf)
 444 {
 445         struct pci_dev *pdev = to_pci_dev(dev);
 446
 447         return sprintf(buf, "%u\n", pci_sriov_get_totalvfs(pdev));
 448 }
 449
 450
 451 static ssize_t sriov_numvfs_show(struct device *dev,
 452                                  struct device_attribute *attr,
 453                                  char *buf)
 454 {
 455         struct pci_dev *pdev = to_pci_dev(dev);
 456
 457         return sprintf(buf, "%u\n", pdev->sriov->num_VFs);
 458 }
 459
 460 /*
 461  * num_vfs > 0; number of VFs to enable
 462  * num_vfs = 0; disable all VFs
 463  *
 464  * Note: SRIOV spec doesn't allow partial VF
 465  *       disable, so it's all or none.
 466  */
 467 static ssize_t sriov_numvfs_store(struct device *dev,
 468                                   struct device_attribute *attr,
 469                                   const char *buf, size_t count)
 470 {
 471         struct pci_dev *pdev = to_pci_dev(dev);
 472         int ret;
 473         u16 num_vfs;
 474
 475         ret = kstrtou16(buf, 0, &num_vfs);
 476         if (ret < 0)
 477                 return ret;
 478
 479         if (num_vfs > pci_sriov_get_totalvfs(pdev))
 480                 return -ERANGE;
 481
 482         if (num_vfs == pdev->sriov->num_VFs)
 483                 return count;           /* no change */
 484
 485         /* is PF driver loaded w/callback */
 486         if (!pdev->driver || !pdev->driver->sriov_configure) {
 487                 dev_info(&pdev->dev, "Driver doesn't support SRIOV configuration via sysfs\n");
 488                 return -ENOSYS;
 489         }
 490
 491         if (num_vfs == 0) {
 492                 /* disable VFs */
 493                 ret = pdev->driver->sriov_configure(pdev, 0);
 494                 if (ret < 0)
 495                         return ret;
 496                 return count;
 497         }
 498
 499         /* enable VFs */
 500         if (pdev->sriov->num_VFs) {
 501                 dev_warn(&pdev->dev, "%d VFs already enabled. Disable before enabling %d VFs\n",
 502                          pdev->sriov->num_VFs, num_vfs);
 503                 return -EBUSY;
 504         }
 505
 506         ret = pdev->driver->sriov_configure(pdev, num_vfs);
 507         if (ret < 0)
 508                 return ret;
 509
 510         if (ret != num_vfs)
 511                 dev_warn(&pdev->dev, "%d VFs requested; only %d enabled\n",
 512                          num_vfs, ret);
 513
 514         return count;
 515 }
 516
 517 static struct device_attribute sriov_totalvfs_attr = __ATTR_RO(sriov_totalvfs);
 518 static struct device_attribute sriov_numvfs_attr =
 519                 __ATTR(sriov_numvfs, (S_IRUGO|S_IWUSR|S_IWGRP),
 520                        sriov_numvfs_show, sriov_numvfs_store);
 521 #endif /* CONFIG_PCI_IOV */
 522
 523 static ssize_t driver_override_store(struct device *dev,
 524                                      struct device_attribute *attr,
 525                                      const char *buf, size_t count)
 526 {
 527         struct pci_dev *pdev = to_pci_dev(dev);
 528         char *driver_override, *old, *cp;
 529
 530         /* We need to keep extra room for a newline */
 531         if (count >= (PAGE_SIZE - 1))
 532                 return -EINVAL;
 533
 534         driver_override = kstrndup(buf, count, GFP_KERNEL);
 535         if (!driver_override)
 536                 return -ENOMEM;
 537
 538         cp = strchr(driver_override, '\n');
 539         if (cp)
 540                 *cp = '\0';
 541
 542         device_lock(dev);
 543         old = pdev->driver_override;
 544         if (strlen(driver_override)) {
 545                 pdev->driver_override = driver_override;
 546         } else {
 547                 kfree(driver_override);
 548                 pdev->driver_override = NULL;
 549         }
 550         device_unlock(dev);
 551
 552         kfree(old);
 553
 554         return count;
 555 }
 556
 557 static ssize_t driver_override_show(struct device *dev,
 558                                     struct device_attribute *attr, char *buf)
 559 {
 560         struct pci_dev *pdev = to_pci_dev(dev);
 561         ssize_t len;
 562
 563         device_lock(dev);
 564         len = snprintf(buf, PAGE_SIZE, "%s\n", pdev->driver_override);
 565         device_unlock(dev);
 566         return len;
 567 }
 568 static DEVICE_ATTR_RW(driver_override);
 569
 570 static struct attribute *pci_dev_attrs[] = {
 571         &dev_attr_resource.attr,
 572         &dev_attr_vendor.attr,
 573         &dev_attr_device.attr,
 574         &dev_attr_subsystem_vendor.attr,
 575         &dev_attr_subsystem_device.attr,
 576         &dev_attr_class.attr,
 577         &dev_attr_irq.attr,
 578         &dev_attr_local_cpus.attr,
 579         &dev_attr_local_cpulist.attr,
 580         &dev_attr_modalias.attr,
 581 #ifdef CONFIG_NUMA
 582         &dev_attr_numa_node.attr,
 583 #endif
 584         &dev_attr_dma_mask_bits.attr,
 585         &dev_attr_consistent_dma_mask_bits.attr,
 586         &dev_attr_enable.attr,
 587         &dev_attr_broken_parity_status.attr,
 588         &dev_attr_msi_bus.attr,
 589 #if defined(CONFIG_PM) && defined(CONFIG_ACPI)
 590         &dev_attr_d3cold_allowed.attr,
 591 #endif
 592 #ifdef CONFIG_OF
 593         &dev_attr_devspec.attr,
 594 #endif
 595         &dev_attr_driver_override.attr,
 596         NULL,
 597 };
 598
 599 static const struct attribute_group pci_dev_group = {
 600         .attrs = pci_dev_attrs,
 601 };
 602
 603 const struct attribute_group *pci_dev_groups[] = {
 604         &pci_dev_group,
 605         NULL,
 606 };
 607
 608 static struct attribute *pcibus_attrs[] = {
 609         &dev_attr_rescan.attr,
 610         &dev_attr_cpuaffinity.attr,
 611         &dev_attr_cpulistaffinity.attr,
 612         NULL,
 613 };
 614
 615 static const struct attribute_group pcibus_group = {
 616         .attrs = pcibus_attrs,
 617 };
 618
 619 const struct attribute_group *pcibus_groups[] = {
 620         &pcibus_group,
 621         NULL,
 622 };
 623
 624 static ssize_t boot_vga_show(struct device *dev, struct device_attribute *attr,
 625                              char *buf)
 626 {
 627         struct pci_dev *pdev = to_pci_dev(dev);
 628         struct pci_dev *vga_dev = vga_default_device();
 629
 630         if (vga_dev)
 631                 return sprintf(buf, "%u\n", (pdev == vga_dev));
 632
 633         return sprintf(buf, "%u\n",
 634                 !!(pdev->resource[PCI_ROM_RESOURCE].flags &
 635                    IORESOURCE_ROM_SHADOW));
 636 }
 637 static struct device_attribute vga_attr = __ATTR_RO(boot_vga);
 638
 639 static ssize_t pci_read_config(struct file *filp, struct kobject *kobj,
 640                                struct bin_attribute *bin_attr, char *buf,
 641                                loff_t off, size_t count)
 642 {
 643         struct pci_dev *dev = to_pci_dev(container_of(kobj, struct device,
 644                                                       kobj));
 645         unsigned int size = 64;
 646         loff_t init_off = off;
 647         u8 *data = (u8 *) buf;
 648
 649         /* Several chips lock up trying to read undefined config space */
 650         if (security_capable(filp->f_cred, &init_user_ns, CAP_SYS_ADMIN) == 0)
 651                 size = dev->cfg_size;
 652         else if (dev->hdr_type == PCI_HEADER_TYPE_CARDBUS)
 653                 size = 128;
 654
 655         if (off > size)
 656                 return 0;
 657         if (off + count > size) {
 658                 size -= off;
 659                 count = size;
 660         } else {
 661                 size = count;
 662         }
 663
 664         pci_config_pm_runtime_get(dev);
 665
 666         if ((off & 1) && size) {
 667                 u8 val;
 668                 pci_user_read_config_byte(dev, off, &val);
 669                 data[off - init_off] = val;
 670                 off++;
 671                 size--;
 672         }
 673
 674         if ((off & 3) && size > 2) {
 675                 u16 val;
 676                 pci_user_read_config_word(dev, off, &val);
 677                 data[off - init_off] = val & 0xff;
 678                 data[off - init_off + 1] = (val >> 8) & 0xff;
 679                 off += 2;
 680                 size -= 2;
 681         }
 682
 683         while (size > 3) {
 684                 u32 val;
 685                 pci_user_read_config_dword(dev, off, &val);
 686                 data[off - init_off] = val & 0xff;
 687                 data[off - init_off + 1] = (val >> 8) & 0xff;
 688                 data[off - init_off + 2] = (val >> 16) & 0xff;
 689                 data[off - init_off + 3] = (val >> 24) & 0xff;
 690                 off += 4;
 691                 size -= 4;
 692         }
 693
 694         if (size >= 2) {
 695                 u16 val;
 696                 pci_user_read_config_word(dev, off, &val);
 697                 data[off - init_off] = val & 0xff;
 698                 data[off - init_off + 1] = (val >> 8) & 0xff;
 699                 off += 2;
 700                 size -= 2;
 701         }
 702
 703         if (size > 0) {
 704                 u8 val;
 705                 pci_user_read_config_byte(dev, off, &val);
 706                 data[off - init_off] = val;
 707                 off++;
 708                 --size;
 709         }
 710
 711         pci_config_pm_runtime_put(dev);
 712
 713         return count;
 714 }
 715
 716 static ssize_t pci_write_config(struct file *filp, struct kobject *kobj,
 717                                 struct bin_attribute *bin_attr, char *buf,
 718                                 loff_t off, size_t count)
 719 {
 720         struct pci_dev *dev = to_pci_dev(container_of(kobj, struct device,
 721                                                       kobj));
 722         unsigned int size = count;
 723         loff_t init_off = off;
 724         u8 *data = (u8 *) buf;
 725
 726         if (off > dev->cfg_size)
 727                 return 0;
 728         if (off + count > dev->cfg_size) {
 729                 size = dev->cfg_size - off;
 730                 count = size;
 731         }
 732
 733         pci_config_pm_runtime_get(dev);
 734
 735         if ((off & 1) && size) {
 736                 pci_user_write_config_byte(dev, off, data[off - init_off]);
 737                 off++;
 738                 size--;
 739         }
 740
 741         if ((off & 3) && size > 2) {
 742                 u16 val = data[off - init_off];
 743                 val |= (u16) data[off - init_off + 1] << 8;
 744                 pci_user_write_config_word(dev, off, val);
 745                 off += 2;
 746                 size -= 2;
 747         }
 748
 749         while (size > 3) {
 750                 u32 val = data[off - init_off];
 751                 val |= (u32) data[off - init_off + 1] << 8;
 752                 val |= (u32) data[off - init_off + 2] << 16;
 753                 val |= (u32) data[off - init_off + 3] << 24;
 754                 pci_user_write_config_dword(dev, off, val);
 755                 off += 4;
 756                 size -= 4;
 757         }
 758
 759         if (size >= 2) {
 760                 u16 val = data[off - init_off];
 761                 val |= (u16) data[off - init_off + 1] << 8;
 762                 pci_user_write_config_word(dev, off, val);
 763                 off += 2;
 764                 size -= 2;
 765         }
 766
 767         if (size) {
 768                 pci_user_write_config_byte(dev, off, data[off - init_off]);
 769                 off++;
 770                 --size;
 771         }
 772
 773         pci_config_pm_runtime_put(dev);
 774
 775         return count;
 776 }
 777
 778 static ssize_t read_vpd_attr(struct file *filp, struct kobject *kobj,
 779                              struct bin_attribute *bin_attr, char *buf,
 780                              loff_t off, size_t count)
 781 {
 782         struct pci_dev *dev =
 783                 to_pci_dev(container_of(kobj, struct device, kobj));
 784
 785         if (off > bin_attr->size)
 786                 count = 0;
 787         else if (count > bin_attr->size - off)
 788                 count = bin_attr->size - off;
 789
 790         return pci_read_vpd(dev, off, count, buf);
 791 }
 792
 793 static ssize_t write_vpd_attr(struct file *filp, struct kobject *kobj,
 794                               struct bin_attribute *bin_attr, char *buf,
 795                               loff_t off, size_t count)
 796 {
 797         struct pci_dev *dev =
 798                 to_pci_dev(container_of(kobj, struct device, kobj));
 799
 800         if (off > bin_attr->size)
 801                 count = 0;
 802         else if (count > bin_attr->size - off)
 803                 count = bin_attr->size - off;
 804
 805         return pci_write_vpd(dev, off, count, buf);
 806 }
 807
 808 #ifdef HAVE_PCI_LEGACY
 809 /**
 810  * pci_read_legacy_io - read byte(s) from legacy I/O port space
 811  * @filp: open sysfs file
 812  * @kobj: kobject corresponding to file to read from
 813  * @bin_attr: struct bin_attribute for this file
 814  * @buf: buffer to store results
 815  * @off: offset into legacy I/O port space
 816  * @count: number of bytes to read
 817  *
 818  * Reads 1, 2, or 4 bytes from legacy I/O port space using an arch specific
 819  * callback routine (pci_legacy_read).
 820  */
 821 static ssize_t pci_read_legacy_io(struct file *filp, struct kobject *kobj,
 822                                   struct bin_attribute *bin_attr, char *buf,
 823                                   loff_t off, size_t count)
 824 {
 825         struct pci_bus *bus = to_pci_bus(container_of(kobj, struct device,
 826                                                       kobj));
 827
 828         /* Only support 1, 2 or 4 byte accesses */
 829         if (count != 1 && count != 2 && count != 4)
 830                 return -EINVAL;
 831
 832         return pci_legacy_read(bus, off, (u32 *)buf, count);
 833 }
 834
 835 /**
 836  * pci_write_legacy_io - write byte(s) to legacy I/O port space
 837  * @filp: open sysfs file
 838  * @kobj: kobject corresponding to file to read from
 839  * @bin_attr: struct bin_attribute for this file
 840  * @buf: buffer containing value to be written
 841  * @off: offset into legacy I/O port space
 842  * @count: number of bytes to write
 843  *
 844  * Writes 1, 2, or 4 bytes from legacy I/O port space using an arch specific
 845  * callback routine (pci_legacy_write).
 846  */
 847 static ssize_t pci_write_legacy_io(struct file *filp, struct kobject *kobj,
 848                                    struct bin_attribute *bin_attr, char *buf,
 849                                    loff_t off, size_t count)
 850 {
 851         struct pci_bus *bus = to_pci_bus(container_of(kobj, struct device,
 852                                                       kobj));
 853
 854         /* Only support 1, 2 or 4 byte accesses */
 855         if (count != 1 && count != 2 && count != 4)
 856                 return -EINVAL;
 857
 858         return pci_legacy_write(bus, off, *(u32 *)buf, count);
 859 }
 860
 861 /**
 862  * pci_mmap_legacy_mem - map legacy PCI memory into user memory space
 863  * @filp: open sysfs file
 864  * @kobj: kobject corresponding to device to be mapped
 865  * @attr: struct bin_attribute for this file
 866  * @vma: struct vm_area_struct passed to mmap
 867  *
 868  * Uses an arch specific callback, pci_mmap_legacy_mem_page_range, to mmap
 869  * legacy memory space (first meg of bus space) into application virtual
 870  * memory space.
 871  */
 872 static int pci_mmap_legacy_mem(struct file *filp, struct kobject *kobj,
 873                                struct bin_attribute *attr,
 874                                struct vm_area_struct *vma)
 875 {
 876         struct pci_bus *bus = to_pci_bus(container_of(kobj, struct device,
 877                                                       kobj));
 878
 879         return pci_mmap_legacy_page_range(bus, vma, pci_mmap_mem);
 880 }
 881
 882 /**
 883  * pci_mmap_legacy_io - map legacy PCI IO into user memory space
 884  * @filp: open sysfs file
 885  * @kobj: kobject corresponding to device to be mapped
 886  * @attr: struct bin_attribute for this file
 887  * @vma: struct vm_area_struct passed to mmap
 888  *
 889  * Uses an arch specific callback, pci_mmap_legacy_io_page_range, to mmap
 890  * legacy IO space (first meg of bus space) into application virtual
 891  * memory space. Returns -ENOSYS if the operation isn't supported
 892  */
 893 static int pci_mmap_legacy_io(struct file *filp, struct kobject *kobj,
 894                               struct bin_attribute *attr,
 895                               struct vm_area_struct *vma)
 896 {
 897         struct pci_bus *bus = to_pci_bus(container_of(kobj, struct device,
 898                                                       kobj));
 899
 900         return pci_mmap_legacy_page_range(bus, vma, pci_mmap_io);
 901 }
 902
 903 /**
 904  * pci_adjust_legacy_attr - adjustment of legacy file attributes
 905  * @b: bus to create files under
 906  * @mmap_type: I/O port or memory
 907  *
 908  * Stub implementation. Can be overridden by arch if necessary.
 909  */
 910 void __weak pci_adjust_legacy_attr(struct pci_bus *b,
 911                                    enum pci_mmap_state mmap_type)
 912 {
 913 }
 914
 915 /**
 916  * pci_create_legacy_files - create legacy I/O port and memory files
 917  * @b: bus to create files under
 918  *
 919  * Some platforms allow access to legacy I/O port and ISA memory space on
 920  * a per-bus basis.  This routine creates the files and ties them into
 921  * their associated read, write and mmap files from pci-sysfs.c
 922  *
 923  * On error unwind, but don't propagate the error to the caller
 924  * as it is ok to set up the PCI bus without these files.
 925  */
 926 void pci_create_legacy_files(struct pci_bus *b)
 927 {
 928         int error;
 929
 930         b->legacy_io = kzalloc(sizeof(struct bin_attribute) * 2,
 931                                GFP_ATOMIC);
 932         if (!b->legacy_io)
 933                 goto kzalloc_err;
 934
 935         sysfs_bin_attr_init(b->legacy_io);
 936         b->legacy_io->attr.name = "legacy_io";
 937         b->legacy_io->size = 0xffff;
 938         b->legacy_io->attr.mode = S_IRUSR | S_IWUSR;
 939         b->legacy_io->read = pci_read_legacy_io;
 940         b->legacy_io->write = pci_write_legacy_io;
 941         b->legacy_io->mmap = pci_mmap_legacy_io;
 942         pci_adjust_legacy_attr(b, pci_mmap_io);
 943         error = device_create_bin_file(&b->dev, b->legacy_io);
 944         if (error)
 945                 goto legacy_io_err;
 946
 947         /* Allocated above after the legacy_io struct */
 948         b->legacy_mem = b->legacy_io + 1;
 949         sysfs_bin_attr_init(b->legacy_mem);
 950         b->legacy_mem->attr.name = "legacy_mem";
 951         b->legacy_mem->size = 1024*1024;
 952         b->legacy_mem->attr.mode = S_IRUSR | S_IWUSR;
 953         b->legacy_mem->mmap = pci_mmap_legacy_mem;
 954         pci_adjust_legacy_attr(b, pci_mmap_mem);
 955         error = device_create_bin_file(&b->dev, b->legacy_mem);
 956         if (error)
 957                 goto legacy_mem_err;
 958
 959         return;
 960
 961 legacy_mem_err:
 962         device_remove_bin_file(&b->dev, b->legacy_io);
 963 legacy_io_err:
 964         kfree(b->legacy_io);
 965         b->legacy_io = NULL;
 966 kzalloc_err:
 967         printk(KERN_WARNING "pci: warning: could not create legacy I/O port and ISA memory resources to sysfs\n");
 968         return;
 969 }
 970
 971 void pci_remove_legacy_files(struct pci_bus *b)
 972 {
 973         if (b->legacy_io) {
 974                 device_remove_bin_file(&b->dev, b->legacy_io);
 975                 device_remove_bin_file(&b->dev, b->legacy_mem);
 976                 kfree(b->legacy_io); /* both are allocated here */
 977         }
 978 }
 979 #endif /* HAVE_PCI_LEGACY */
 980
 981 #ifdef HAVE_PCI_MMAP
 982
 983 int pci_mmap_fits(struct pci_dev *pdev, int resno, struct vm_area_struct *vma,
 984                   enum pci_mmap_api mmap_api)
 985 {
 986         unsigned long nr, start, size;
 987         resource_size_t pci_start = 0, pci_end;
 988
 989         if (pci_resource_len(pdev, resno) == 0)
 990                 return 0;
 991         nr = vma_pages(vma);
 992         start = vma->vm_pgoff;
 993         size = ((pci_resource_len(pdev, resno) - 1) >> PAGE_SHIFT) + 1;
 994         if (mmap_api == PCI_MMAP_PROCFS) {
 995                 pci_resource_to_user(pdev, resno, &pdev->resource[resno],
 996                                      &pci_start, &pci_end);
 997                 pci_start >>= PAGE_SHIFT;
 998         }
 999         if (start >= pci_start && start < pci_start + size &&
1000                         start + nr <= pci_start + size)
1001                 return 1;
1002         return 0;
1003 }
1004
1005 /**
1006  * pci_mmap_resource - map a PCI resource into user memory space
1007  * @kobj: kobject for mapping
1008  * @attr: struct bin_attribute for the file being mapped
1009  * @vma: struct vm_area_struct passed into the mmap
1010  * @write_combine: 1 for write_combine mapping
1011  *
1012  * Use the regular PCI mapping routines to map a PCI resource into userspace.
1013  */
1014 static int pci_mmap_resource(struct kobject *kobj, struct bin_attribute *attr,
1015                              struct vm_area_struct *vma, int write_combine)
1016 {
1017         struct pci_dev *pdev = to_pci_dev(container_of(kobj,
1018                                                        struct device, kobj));
1019         struct resource *res = attr->private;
1020         enum pci_mmap_state mmap_type;
1021         resource_size_t start, end;
1022         int i;
1023
1024         for (i = 0; i < PCI_ROM_RESOURCE; i++)
1025                 if (res == &pdev->resource[i])
1026                         break;
1027         if (i >= PCI_ROM_RESOURCE)
1028                 return -ENODEV;
1029
1030         if (res->flags & IORESOURCE_MEM && iomem_is_exclusive(res->start))
1031                 return -EINVAL;
1032
1033         if (!pci_mmap_fits(pdev, i, vma, PCI_MMAP_SYSFS)) {
1034                 WARN(1, "process \"%s\" tried to map 0x%08lx bytes at page 0x%08lx on %s BAR %d (start 0x%16Lx, size 0x%16Lx)\n",
1035                         current->comm, vma->vm_end-vma->vm_start, vma->vm_pgoff,
1036                         pci_name(pdev), i,
1037                         (u64)pci_resource_start(pdev, i),
1038                         (u64)pci_resource_len(pdev, i));
1039                 return -EINVAL;
1040         }
1041
1042         /* pci_mmap_page_range() expects the same kind of entry as coming
1043          * from /proc/bus/pci/ which is a "user visible" value. If this is
1044          * different from the resource itself, arch will do necessary fixup.
1045          */
1046         pci_resource_to_user(pdev, i, res, &start, &end);
1047         vma->vm_pgoff += start >> PAGE_SHIFT;
1048         mmap_type = res->flags & IORESOURCE_MEM ? pci_mmap_mem : pci_mmap_io;
1049         return pci_mmap_page_range(pdev, vma, mmap_type, write_combine);
1050 }
1051
1052 static int pci_mmap_resource_uc(struct file *filp, struct kobject *kobj,
1053                                 struct bin_attribute *attr,
1054                                 struct vm_area_struct *vma)
1055 {
1056         return pci_mmap_resource(kobj, attr, vma, 0);
1057 }
1058
1059 static int pci_mmap_resource_wc(struct file *filp, struct kobject *kobj,
1060                                 struct bin_attribute *attr,
1061                                 struct vm_area_struct *vma)
1062 {
1063         return pci_mmap_resource(kobj, attr, vma, 1);
1064 }
1065
1066 static ssize_t pci_resource_io(struct file *filp, struct kobject *kobj,
1067                                struct bin_attribute *attr, char *buf,
1068                                loff_t off, size_t count, bool write)
1069 {
1070         struct pci_dev *pdev = to_pci_dev(container_of(kobj,
1071                                                        struct device, kobj));
1072         struct resource *res = attr->private;
1073         unsigned long port = off;
1074         int i;
1075
1076         for (i = 0; i < PCI_ROM_RESOURCE; i++)
1077                 if (res == &pdev->resource[i])
1078                         break;
1079         if (i >= PCI_ROM_RESOURCE)
1080                 return -ENODEV;
1081
1082         port += pci_resource_start(pdev, i);
1083
1084         if (port > pci_resource_end(pdev, i))
1085                 return 0;
1086
1087         if (port + count - 1 > pci_resource_end(pdev, i))
1088                 return -EINVAL;
1089
1090         switch (count) {
1091         case 1:
1092                 if (write)
1093                         outb(*(u8 *)buf, port);
1094                 else
1095                         *(u8 *)buf = inb(port);
1096                 return 1;
1097         case 2:
1098                 if (write)
1099                         outw(*(u16 *)buf, port);
1100                 else
1101                         *(u16 *)buf = inw(port);
1102                 return 2;
1103         case 4:
1104                 if (write)
1105                         outl(*(u32 *)buf, port);
1106                 else
1107                         *(u32 *)buf = inl(port);
1108                 return 4;
1109         }
1110         return -EINVAL;
1111 }
1112
1113 static ssize_t pci_read_resource_io(struct file *filp, struct kobject *kobj,
1114                                     struct bin_attribute *attr, char *buf,
1115                                     loff_t off, size_t count)
1116 {
1117         return pci_resource_io(filp, kobj, attr, buf, off, count, false);
1118 }
1119
1120 static ssize_t pci_write_resource_io(struct file *filp, struct kobject *kobj,
1121                                      struct bin_attribute *attr, char *buf,
1122                                      loff_t off, size_t count)
1123 {
1124         return pci_resource_io(filp, kobj, attr, buf, off, count, true);
1125 }
1126
1127 /**
1128  * pci_remove_resource_files - cleanup resource files
1129  * @pdev: dev to cleanup
1130  *
1131  * If we created resource files for @pdev, remove them from sysfs and
1132  * free their resources.
1133  */
1134 static void pci_remove_resource_files(struct pci_dev *pdev)
1135 {
1136         int i;
1137
1138         for (i = 0; i < PCI_ROM_RESOURCE; i++) {
1139                 struct bin_attribute *res_attr;
1140
1141                 res_attr = pdev->res_attr[i];
1142                 if (res_attr) {
1143                         sysfs_remove_bin_file(&pdev->dev.kobj, res_attr);
1144                         kfree(res_attr);
1145                 }
1146
1147                 res_attr = pdev->res_attr_wc[i];
1148                 if (res_attr) {
1149                         sysfs_remove_bin_file(&pdev->dev.kobj, res_attr);
1150                         kfree(res_attr);
1151                 }
1152         }
1153 }
1154
1155 static int pci_create_attr(struct pci_dev *pdev, int num, int write_combine)
1156 {
1157         /* allocate attribute structure, piggyback attribute name */
1158         int name_len = write_combine ? 13 : 10;
1159         struct bin_attribute *res_attr;
1160         int retval;
1161
1162         res_attr = kzalloc(sizeof(*res_attr) + name_len, GFP_ATOMIC);
1163         if (res_attr) {
1164                 char *res_attr_name = (char *)(res_attr + 1);
1165
1166                 sysfs_bin_attr_init(res_attr);
1167                 if (write_combine) {
1168                         pdev->res_attr_wc[num] = res_attr;
1169                         sprintf(res_attr_name, "resource%d_wc", num);
1170                         res_attr->mmap = pci_mmap_resource_wc;
1171                 } else {
1172                         pdev->res_attr[num] = res_attr;
1173                         sprintf(res_attr_name, "resource%d", num);
1174                         res_attr->mmap = pci_mmap_resource_uc;
1175                 }
1176                 if (pci_resource_flags(pdev, num) & IORESOURCE_IO) {
1177                         res_attr->read = pci_read_resource_io;
1178                         res_attr->write = pci_write_resource_io;
1179                 }
1180                 res_attr->attr.name = res_attr_name;
1181                 res_attr->attr.mode = S_IRUSR | S_IWUSR;
1182                 res_attr->size = pci_resource_len(pdev, num);
1183                 res_attr->private = &pdev->resource[num];
1184                 retval = sysfs_create_bin_file(&pdev->dev.kobj, res_attr);
1185         } else
1186                 retval = -ENOMEM;
1187
1188         return retval;
1189 }
1190
1191 /**
1192  * pci_create_resource_files - create resource files in sysfs for @dev
1193  * @pdev: dev in question
1194  *
1195  * Walk the resources in @pdev creating files for each resource available.
1196  */
1197 static int pci_create_resource_files(struct pci_dev *pdev)
1198 {
1199         int i;
1200         int retval;
1201
1202         /* Expose the PCI resources from this device as files */
1203         for (i = 0; i < PCI_ROM_RESOURCE; i++) {
1204
1205                 /* skip empty resources */
1206                 if (!pci_resource_len(pdev, i))
1207                         continue;
1208
1209                 retval = pci_create_attr(pdev, i, 0);
1210                 /* for prefetchable resources, create a WC mappable file */
1211                 if (!retval && pdev->resource[i].flags & IORESOURCE_PREFETCH)
1212                         retval = pci_create_attr(pdev, i, 1);
1213
1214                 if (retval) {
1215                         pci_remove_resource_files(pdev);
1216                         return retval;
1217                 }
1218         }
1219         return 0;
1220 }
1221 #else /* !HAVE_PCI_MMAP */
1222 int __weak pci_create_resource_files(struct pci_dev *dev) { return 0; }
1223 void __weak pci_remove_resource_files(struct pci_dev *dev) { return; }
1224 #endif /* HAVE_PCI_MMAP */
1225
1226 /**
1227  * pci_write_rom - used to enable access to the PCI ROM display
1228  * @filp: sysfs file
1229  * @kobj: kernel object handle
1230  * @bin_attr: struct bin_attribute for this file
1231  * @buf: user input
1232  * @off: file offset
1233  * @count: number of byte in input
1234  *
1235  * writing anything except 0 enables it
1236  */
1237 static ssize_t pci_write_rom(struct file *filp, struct kobject *kobj,
1238                              struct bin_attribute *bin_attr, char *buf,
1239                              loff_t off, size_t count)
1240 {
1241         struct pci_dev *pdev = to_pci_dev(container_of(kobj, struct device, kobj));
1242
1243         if ((off ==  0) && (*buf == '0') && (count == 2))
1244                 pdev->rom_attr_enabled = 0;
1245         else
1246                 pdev->rom_attr_enabled = 1;
1247
1248         return count;
1249 }
1250
1251 /**
1252  * pci_read_rom - read a PCI ROM
1253  * @filp: sysfs file
1254  * @kobj: kernel object handle
1255  * @bin_attr: struct bin_attribute for this file
1256  * @buf: where to put the data we read from the ROM
1257  * @off: file offset
1258  * @count: number of bytes to read
1259  *
1260  * Put @count bytes starting at @off into @buf from the ROM in the PCI
1261  * device corresponding to @kobj.
1262  */
1263 static ssize_t pci_read_rom(struct file *filp, struct kobject *kobj,
1264                             struct bin_attribute *bin_attr, char *buf,
1265                             loff_t off, size_t count)
1266 {
1267         struct pci_dev *pdev = to_pci_dev(container_of(kobj, struct device, kobj));
1268         void __iomem *rom;
1269         size_t size;
1270
1271         if (!pdev->rom_attr_enabled)
1272                 return -EINVAL;
1273
1274         rom = pci_map_rom(pdev, &size); /* size starts out as PCI window size */
1275         if (!rom || !size)
1276                 return -EIO;
1277
1278         if (off >= size)
1279                 count = 0;
1280         else {
1281                 if (off + count > size)
1282                         count = size - off;
1283
1284                 memcpy_fromio(buf, rom + off, count);
1285         }
1286         pci_unmap_rom(pdev, rom);
1287
1288         return count;
1289 }
1290
1291 static struct bin_attribute pci_config_attr = {
1292         .attr = {
1293                 .name = "config",
1294                 .mode = S_IRUGO | S_IWUSR,
1295         },
1296         .size = PCI_CFG_SPACE_SIZE,
1297         .read = pci_read_config,
1298         .write = pci_write_config,
1299 };
1300
1301 static struct bin_attribute pcie_config_attr = {
1302         .attr = {
1303                 .name = "config",
1304                 .mode = S_IRUGO | S_IWUSR,
1305         },
1306         .size = PCI_CFG_SPACE_EXP_SIZE,
1307         .read = pci_read_config,
1308         .write = pci_write_config,
1309 };
1310
1311 static ssize_t reset_store(struct device *dev, struct device_attribute *attr,
1312                            const char *buf, size_t count)
1313 {
1314         struct pci_dev *pdev = to_pci_dev(dev);
1315         unsigned long val;
1316         ssize_t result = kstrtoul(buf, 0, &val);
1317
1318         if (result < 0)
1319                 return result;
1320
1321         if (val != 1)
1322                 return -EINVAL;
1323
1324         result = pci_reset_function(pdev);
1325         if (result < 0)
1326                 return result;
1327
1328         return count;
1329 }
1330
1331 static struct device_attribute reset_attr = __ATTR(reset, 0200, NULL, reset_store);
1332
1333 static int pci_create_capabilities_sysfs(struct pci_dev *dev)
1334 {
1335         int retval;
1336         struct bin_attribute *attr;
1337
1338         /* If the device has VPD, try to expose it in sysfs. */
1339         if (dev->vpd) {
1340                 attr = kzalloc(sizeof(*attr), GFP_ATOMIC);
1341                 if (!attr)
1342                         return -ENOMEM;
1343
1344                 sysfs_bin_attr_init(attr);
1345                 attr->size = dev->vpd->len;
1346                 attr->attr.name = "vpd";
1347                 attr->attr.mode = S_IRUSR | S_IWUSR;
1348                 attr->read = read_vpd_attr;
1349                 attr->write = write_vpd_attr;
1350                 retval = sysfs_create_bin_file(&dev->dev.kobj, attr);
1351                 if (retval) {
1352                         kfree(attr);
1353                         return retval;
1354                 }
1355                 dev->vpd->attr = attr;
1356         }
1357
1358         /* Active State Power Management */
1359         pcie_aspm_create_sysfs_dev_files(dev);
1360
1361         if (!pci_probe_reset_function(dev)) {
1362                 retval = device_create_file(&dev->dev, &reset_attr);
1363                 if (retval)
1364                         goto error;
1365                 dev->reset_fn = 1;
1366         }
1367         return 0;
1368
1369 error:
1370         pcie_aspm_remove_sysfs_dev_files(dev);
1371         if (dev->vpd && dev->vpd->attr) {
1372                 sysfs_remove_bin_file(&dev->dev.kobj, dev->vpd->attr);
1373                 kfree(dev->vpd->attr);
1374         }
1375
1376         return retval;
1377 }
1378
1379 int __must_check pci_create_sysfs_dev_files(struct pci_dev *pdev)
1380 {
1381         int retval;
1382         int rom_size = 0;
1383         struct bin_attribute *attr;
1384
1385         if (!sysfs_initialized)
1386                 return -EACCES;
1387
1388         if (pdev->cfg_size > PCI_CFG_SPACE_SIZE)
1389                 retval = sysfs_create_bin_file(&pdev->dev.kobj, &pcie_config_attr);
1390         else
1391                 retval = sysfs_create_bin_file(&pdev->dev.kobj, &pci_config_attr);
1392         if (retval)
1393                 goto err;
1394
1395         retval = pci_create_resource_files(pdev);
1396         if (retval)
1397                 goto err_config_file;
1398
1399         if (pci_resource_len(pdev, PCI_ROM_RESOURCE))
1400                 rom_size = pci_resource_len(pdev, PCI_ROM_RESOURCE);
1401         else if (pdev->resource[PCI_ROM_RESOURCE].flags & IORESOURCE_ROM_SHADOW)
1402                 rom_size = 0x20000;
1403
1404         /* If the device has a ROM, try to expose it in sysfs. */
1405         if (rom_size) {
1406                 attr = kzalloc(sizeof(*attr), GFP_ATOMIC);
1407                 if (!attr) {
1408                         retval = -ENOMEM;
1409                         goto err_resource_files;
1410                 }
1411                 sysfs_bin_attr_init(attr);
1412                 attr->size = rom_size;
1413                 attr->attr.name = "rom";
1414                 attr->attr.mode = S_IRUSR | S_IWUSR;
1415                 attr->read = pci_read_rom;
1416                 attr->write = pci_write_rom;
1417                 retval = sysfs_create_bin_file(&pdev->dev.kobj, attr);
1418                 if (retval) {
1419                         kfree(attr);
1420                         goto err_resource_files;
1421                 }
1422                 pdev->rom_attr = attr;
1423         }
1424
1425         /* add sysfs entries for various capabilities */
1426         retval = pci_create_capabilities_sysfs(pdev);
1427         if (retval)
1428                 goto err_rom_file;
1429
1430         pci_create_firmware_label_files(pdev);
1431
1432         return 0;
1433
1434 err_rom_file:
1435         if (rom_size) {
1436                 sysfs_remove_bin_file(&pdev->dev.kobj, pdev->rom_attr);
1437                 kfree(pdev->rom_attr);
1438                 pdev->rom_attr = NULL;
1439         }
1440 err_resource_files:
1441         pci_remove_resource_files(pdev);
1442 err_config_file:
1443         if (pdev->cfg_size > PCI_CFG_SPACE_SIZE)
1444                 sysfs_remove_bin_file(&pdev->dev.kobj, &pcie_config_attr);
1445         else
1446                 sysfs_remove_bin_file(&pdev->dev.kobj, &pci_config_attr);
1447 err:
1448         return retval;
1449 }
1450
1451 static void pci_remove_capabilities_sysfs(struct pci_dev *dev)
1452 {
1453         if (dev->vpd && dev->vpd->attr) {
1454                 sysfs_remove_bin_file(&dev->dev.kobj, dev->vpd->attr);
1455                 kfree(dev->vpd->attr);
1456         }
1457
1458         pcie_aspm_remove_sysfs_dev_files(dev);
1459         if (dev->reset_fn) {
1460                 device_remove_file(&dev->dev, &reset_attr);
1461                 dev->reset_fn = 0;
1462         }
1463 }
1464
1465 /**
1466  * pci_remove_sysfs_dev_files - cleanup PCI specific sysfs files
1467  * @pdev: device whose entries we should free
1468  *
1469  * Cleanup when @pdev is removed from sysfs.
1470  */
1471 void pci_remove_sysfs_dev_files(struct pci_dev *pdev)
1472 {
1473         int rom_size = 0;
1474
1475         if (!sysfs_initialized)
1476                 return;
1477
1478         pci_remove_capabilities_sysfs(pdev);
1479
1480         if (pdev->cfg_size > PCI_CFG_SPACE_SIZE)
1481                 sysfs_remove_bin_file(&pdev->dev.kobj, &pcie_config_attr);
1482         else
1483                 sysfs_remove_bin_file(&pdev->dev.kobj, &pci_config_attr);
1484
1485         pci_remove_resource_files(pdev);
1486
1487         if (pci_resource_len(pdev, PCI_ROM_RESOURCE))
1488                 rom_size = pci_resource_len(pdev, PCI_ROM_RESOURCE);
1489         else if (pdev->resource[PCI_ROM_RESOURCE].flags & IORESOURCE_ROM_SHADOW)
1490                 rom_size = 0x20000;
1491
1492         if (rom_size && pdev->rom_attr) {
1493                 sysfs_remove_bin_file(&pdev->dev.kobj, pdev->rom_attr);
1494                 kfree(pdev->rom_attr);
1495         }
1496
1497         pci_remove_firmware_label_files(pdev);
1498
1499 }
1500
1501 static int __init pci_sysfs_init(void)
1502 {
1503         struct pci_dev *pdev = NULL;
1504         int retval;
1505
1506         sysfs_initialized = 1;
1507         for_each_pci_dev(pdev) {
1508                 retval = pci_create_sysfs_dev_files(pdev);
1509                 if (retval) {
1510                         pci_dev_put(pdev);
1511                         return retval;
1512                 }
1513         }
1514
1515         return 0;
1516 }
1517 late_initcall(pci_sysfs_init);
1518
1519 static struct attribute *pci_dev_dev_attrs[] = {
1520         &vga_attr.attr,
1521         NULL,
1522 };
1523
1524 static umode_t pci_dev_attrs_are_visible(struct kobject *kobj,
1525                                          struct attribute *a, int n)
1526 {
1527         struct device *dev = container_of(kobj, struct device, kobj);
1528         struct pci_dev *pdev = to_pci_dev(dev);
1529
1530         if (a == &vga_attr.attr)
1531                 if ((pdev->class >> 8) != PCI_CLASS_DISPLAY_VGA)
1532                         return 0;
1533
1534         return a->mode;
1535 }
1536
1537 static struct attribute *pci_dev_hp_attrs[] = {
1538         &dev_remove_attr.attr,
1539         &dev_rescan_attr.attr,
1540         NULL,
1541 };
1542
1543 static umode_t pci_dev_hp_attrs_are_visible(struct kobject *kobj,
1544                                             struct attribute *a, int n)
1545 {
1546         struct device *dev = container_of(kobj, struct device, kobj);
1547         struct pci_dev *pdev = to_pci_dev(dev);
1548
1549         if (pdev->is_virtfn)
1550                 return 0;
1551
1552         return a->mode;
1553 }
1554
1555 static struct attribute_group pci_dev_hp_attr_group = {
1556         .attrs = pci_dev_hp_attrs,
1557         .is_visible = pci_dev_hp_attrs_are_visible,
1558 };
1559
1560 #ifdef CONFIG_PCI_IOV
1561 static struct attribute *sriov_dev_attrs[] = {
1562         &sriov_totalvfs_attr.attr,
1563         &sriov_numvfs_attr.attr,
1564         NULL,
1565 };
1566
1567 static umode_t sriov_attrs_are_visible(struct kobject *kobj,
1568                                        struct attribute *a, int n)
1569 {
1570         struct device *dev = container_of(kobj, struct device, kobj);
1571
1572         if (!dev_is_pf(dev))
1573                 return 0;
1574
1575         return a->mode;
1576 }
1577
1578 static struct attribute_group sriov_dev_attr_group = {
1579         .attrs = sriov_dev_attrs,
1580         .is_visible = sriov_attrs_are_visible,
1581 };
1582 #endif /* CONFIG_PCI_IOV */
1583
1584 static struct attribute_group pci_dev_attr_group = {
1585         .attrs = pci_dev_dev_attrs,
1586         .is_visible = pci_dev_attrs_are_visible,
1587 };
1588
1589 static const struct attribute_group *pci_dev_attr_groups[] = {
1590         &pci_dev_attr_group,
1591         &pci_dev_hp_attr_group,
1592 #ifdef CONFIG_PCI_IOV
1593         &sriov_dev_attr_group,
1594 #endif
1595         NULL,
1596 };
1597
1598 struct device_type pci_dev_type = {
1599         .groups = pci_dev_attr_groups,
1600 };