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/topology.h>
  23 #include <linux/mm.h>
  24 #include <linux/capability.h>
  25 #include <linux/pci-aspm.h>
  26 #include <linux/slab.h>
  27 #include "pci.h"
  28
  29 static int sysfs_initialized;   /* = 0 */
  30
  31 /* show configuration fields */
  32 #define pci_config_attr(field, format_string)                           \
  33 static ssize_t                                                          \
  34 field##_show(struct device *dev, struct device_attribute *attr, char *buf)                              \
  35 {                                                                       \
  36         struct pci_dev *pdev;                                           \
  37                                                                         \
  38         pdev = to_pci_dev (dev);                                        \
  39         return sprintf (buf, format_string, pdev->field);               \
  40 }
  41
  42 pci_config_attr(vendor, "0x%04x\n");
  43 pci_config_attr(device, "0x%04x\n");
  44 pci_config_attr(subsystem_vendor, "0x%04x\n");
  45 pci_config_attr(subsystem_device, "0x%04x\n");
  46 pci_config_attr(class, "0x%06x\n");
  47 pci_config_attr(irq, "%u\n");
  48
  49 static ssize_t broken_parity_status_show(struct device *dev,
  50                                          struct device_attribute *attr,
  51                                          char *buf)
  52 {
  53         struct pci_dev *pdev = to_pci_dev(dev);
  54         return sprintf (buf, "%u\n", pdev->broken_parity_status);
  55 }
  56
  57 static ssize_t broken_parity_status_store(struct device *dev,
  58                                           struct device_attribute *attr,
  59                                           const char *buf, size_t count)
  60 {
  61         struct pci_dev *pdev = to_pci_dev(dev);
  62         unsigned long val;
  63
  64         if (strict_strtoul(buf, 0, &val) < 0)
  65                 return -EINVAL;
  66
  67         pdev->broken_parity_status = !!val;
  68
  69         return count;
  70 }
  71
  72 static ssize_t local_cpus_show(struct device *dev,
  73                         struct device_attribute *attr, char *buf)
  74 {
  75         const struct cpumask *mask;
  76         int len;
  77
  78 #ifdef CONFIG_NUMA
  79         mask = (dev_to_node(dev) == -1) ? cpu_online_mask :
  80                                           cpumask_of_node(dev_to_node(dev));
  81 #else
  82         mask = cpumask_of_pcibus(to_pci_dev(dev)->bus);
  83 #endif
  84         len = cpumask_scnprintf(buf, PAGE_SIZE-2, mask);
  85         buf[len++] = '\n';
  86         buf[len] = '\0';
  87         return len;
  88 }
  89
  90
  91 static ssize_t local_cpulist_show(struct device *dev,
  92                         struct device_attribute *attr, char *buf)
  93 {
  94         const struct cpumask *mask;
  95         int len;
  96
  97 #ifdef CONFIG_NUMA
  98         mask = (dev_to_node(dev) == -1) ? cpu_online_mask :
  99                                           cpumask_of_node(dev_to_node(dev));
 100 #else
 101         mask = cpumask_of_pcibus(to_pci_dev(dev)->bus);
 102 #endif
 103         len = cpulist_scnprintf(buf, PAGE_SIZE-2, mask);
 104         buf[len++] = '\n';
 105         buf[len] = '\0';
 106         return len;
 107 }
 108
 109 /* show resources */
 110 static ssize_t
 111 resource_show(struct device * dev, struct device_attribute *attr, char * buf)
 112 {
 113         struct pci_dev * pci_dev = to_pci_dev(dev);
 114         char * str = buf;
 115         int i;
 116         int max;
 117         resource_size_t start, end;
 118
 119         if (pci_dev->subordinate)
 120                 max = DEVICE_COUNT_RESOURCE;
 121         else
 122                 max = PCI_BRIDGE_RESOURCES;
 123
 124         for (i = 0; i < max; i++) {
 125                 struct resource *res =  &pci_dev->resource[i];
 126                 pci_resource_to_user(pci_dev, i, res, &start, &end);
 127                 str += sprintf(str,"0x%016llx 0x%016llx 0x%016llx\n",
 128                                (unsigned long long)start,
 129                                (unsigned long long)end,
 130                                (unsigned long long)res->flags);
 131         }
 132         return (str - buf);
 133 }
 134
 135 static ssize_t modalias_show(struct device *dev, struct device_attribute *attr, char *buf)
 136 {
 137         struct pci_dev *pci_dev = to_pci_dev(dev);
 138
 139         return sprintf(buf, "pci:v%08Xd%08Xsv%08Xsd%08Xbc%02Xsc%02Xi%02x\n",
 140                        pci_dev->vendor, pci_dev->device,
 141                        pci_dev->subsystem_vendor, pci_dev->subsystem_device,
 142                        (u8)(pci_dev->class >> 16), (u8)(pci_dev->class >> 8),
 143                        (u8)(pci_dev->class));
 144 }
 145
 146 static ssize_t is_enabled_store(struct device *dev,
 147                                 struct device_attribute *attr, const char *buf,
 148                                 size_t count)
 149 {
 150         struct pci_dev *pdev = to_pci_dev(dev);
 151         unsigned long val;
 152         ssize_t result = strict_strtoul(buf, 0, &val);
 153
 154         if (result < 0)
 155                 return result;
 156
 157         /* this can crash the machine when done on the "wrong" device */
 158         if (!capable(CAP_SYS_ADMIN))
 159                 return -EPERM;
 160
 161         if (!val) {
 162                 if (pci_is_enabled(pdev))
 163                         pci_disable_device(pdev);
 164                 else
 165                         result = -EIO;
 166         } else
 167                 result = pci_enable_device(pdev);
 168
 169         return result < 0 ? result : count;
 170 }
 171
 172 static ssize_t is_enabled_show(struct device *dev,
 173                                struct device_attribute *attr, char *buf)
 174 {
 175         struct pci_dev *pdev;
 176
 177         pdev = to_pci_dev (dev);
 178         return sprintf (buf, "%u\n", atomic_read(&pdev->enable_cnt));
 179 }
 180
 181 #ifdef CONFIG_NUMA
 182 static ssize_t
 183 numa_node_show(struct device *dev, struct device_attribute *attr, char *buf)
 184 {
 185         return sprintf (buf, "%d\n", dev->numa_node);
 186 }
 187 #endif
 188
 189 static ssize_t
 190 dma_mask_bits_show(struct device *dev, struct device_attribute *attr, char *buf)
 191 {
 192         struct pci_dev *pdev = to_pci_dev(dev);
 193
 194         return sprintf (buf, "%d\n", fls64(pdev->dma_mask));
 195 }
 196
 197 static ssize_t
 198 consistent_dma_mask_bits_show(struct device *dev, struct device_attribute *attr,
 199                                  char *buf)
 200 {
 201         return sprintf (buf, "%d\n", fls64(dev->coherent_dma_mask));
 202 }
 203
 204 static ssize_t
 205 msi_bus_show(struct device *dev, struct device_attribute *attr, char *buf)
 206 {
 207         struct pci_dev *pdev = to_pci_dev(dev);
 208
 209         if (!pdev->subordinate)
 210                 return 0;
 211
 212         return sprintf (buf, "%u\n",
 213                         !(pdev->subordinate->bus_flags & PCI_BUS_FLAGS_NO_MSI));
 214 }
 215
 216 static ssize_t
 217 msi_bus_store(struct device *dev, struct device_attribute *attr,
 218               const char *buf, size_t count)
 219 {
 220         struct pci_dev *pdev = to_pci_dev(dev);
 221         unsigned long val;
 222
 223         if (strict_strtoul(buf, 0, &val) < 0)
 224                 return -EINVAL;
 225
 226         /* bad things may happen if the no_msi flag is changed
 227          * while some drivers are loaded */
 228         if (!capable(CAP_SYS_ADMIN))
 229                 return -EPERM;
 230
 231         /* Maybe pci devices without subordinate busses shouldn't even have this
 232          * attribute in the first place?  */
 233         if (!pdev->subordinate)
 234                 return count;
 235
 236         /* Is the flag going to change, or keep the value it already had? */
 237         if (!(pdev->subordinate->bus_flags & PCI_BUS_FLAGS_NO_MSI) ^
 238             !!val) {
 239                 pdev->subordinate->bus_flags ^= PCI_BUS_FLAGS_NO_MSI;
 240
 241                 dev_warn(&pdev->dev, "forced subordinate bus to%s support MSI,"
 242                          " bad things could happen\n", val ? "" : " not");
 243         }
 244
 245         return count;
 246 }
 247
 248 #ifdef CONFIG_HOTPLUG
 249 static DEFINE_MUTEX(pci_remove_rescan_mutex);
 250 static ssize_t bus_rescan_store(struct bus_type *bus, const char *buf,
 251                                 size_t count)
 252 {
 253         unsigned long val;
 254         struct pci_bus *b = NULL;
 255
 256         if (strict_strtoul(buf, 0, &val) < 0)
 257                 return -EINVAL;
 258
 259         if (val) {
 260                 mutex_lock(&pci_remove_rescan_mutex);
 261                 while ((b = pci_find_next_bus(b)) != NULL)
 262                         pci_rescan_bus(b);
 263                 mutex_unlock(&pci_remove_rescan_mutex);
 264         }
 265         return count;
 266 }
 267
 268 struct bus_attribute pci_bus_attrs[] = {
 269         __ATTR(rescan, (S_IWUSR|S_IWGRP), NULL, bus_rescan_store),
 270         __ATTR_NULL
 271 };
 272
 273 static ssize_t
 274 dev_rescan_store(struct device *dev, struct device_attribute *attr,
 275                  const char *buf, size_t count)
 276 {
 277         unsigned long val;
 278         struct pci_dev *pdev = to_pci_dev(dev);
 279
 280         if (strict_strtoul(buf, 0, &val) < 0)
 281                 return -EINVAL;
 282
 283         if (val) {
 284                 mutex_lock(&pci_remove_rescan_mutex);
 285                 pci_rescan_bus(pdev->bus);
 286                 mutex_unlock(&pci_remove_rescan_mutex);
 287         }
 288         return count;
 289 }
 290
 291 static void remove_callback(struct device *dev)
 292 {
 293         struct pci_dev *pdev = to_pci_dev(dev);
 294
 295         mutex_lock(&pci_remove_rescan_mutex);
 296         pci_remove_bus_device(pdev);
 297         mutex_unlock(&pci_remove_rescan_mutex);
 298 }
 299
 300 static ssize_t
 301 remove_store(struct device *dev, struct device_attribute *dummy,
 302              const char *buf, size_t count)
 303 {
 304         int ret = 0;
 305         unsigned long val;
 306
 307         if (strict_strtoul(buf, 0, &val) < 0)
 308                 return -EINVAL;
 309
 310         /* An attribute cannot be unregistered by one of its own methods,
 311          * so we have to use this roundabout approach.
 312          */
 313         if (val)
 314                 ret = device_schedule_callback(dev, remove_callback);
 315         if (ret)
 316                 count = ret;
 317         return count;
 318 }
 319 #endif
 320
 321 struct device_attribute pci_dev_attrs[] = {
 322         __ATTR_RO(resource),
 323         __ATTR_RO(vendor),
 324         __ATTR_RO(device),
 325         __ATTR_RO(subsystem_vendor),
 326         __ATTR_RO(subsystem_device),
 327         __ATTR_RO(class),
 328         __ATTR_RO(irq),
 329         __ATTR_RO(local_cpus),
 330         __ATTR_RO(local_cpulist),
 331         __ATTR_RO(modalias),
 332 #ifdef CONFIG_NUMA
 333         __ATTR_RO(numa_node),
 334 #endif
 335         __ATTR_RO(dma_mask_bits),
 336         __ATTR_RO(consistent_dma_mask_bits),
 337         __ATTR(enable, 0600, is_enabled_show, is_enabled_store),
 338         __ATTR(broken_parity_status,(S_IRUGO|S_IWUSR),
 339                 broken_parity_status_show,broken_parity_status_store),
 340         __ATTR(msi_bus, 0644, msi_bus_show, msi_bus_store),
 341 #ifdef CONFIG_HOTPLUG
 342         __ATTR(remove, (S_IWUSR|S_IWGRP), NULL, remove_store),
 343         __ATTR(rescan, (S_IWUSR|S_IWGRP), NULL, dev_rescan_store),
 344 #endif
 345         __ATTR_NULL,
 346 };
 347
 348 static ssize_t
 349 boot_vga_show(struct device *dev, struct device_attribute *attr, char *buf)
 350 {
 351         struct pci_dev *pdev = to_pci_dev(dev);
 352
 353         return sprintf(buf, "%u\n",
 354                 !!(pdev->resource[PCI_ROM_RESOURCE].flags &
 355                    IORESOURCE_ROM_SHADOW));
 356 }
 357 struct device_attribute vga_attr = __ATTR_RO(boot_vga);
 358
 359 static ssize_t
 360 pci_read_config(struct kobject *kobj, struct bin_attribute *bin_attr,
 361                 char *buf, loff_t off, size_t count)
 362 {
 363         struct pci_dev *dev = to_pci_dev(container_of(kobj,struct device,kobj));
 364         unsigned int size = 64;
 365         loff_t init_off = off;
 366         u8 *data = (u8*) buf;
 367
 368         /* Several chips lock up trying to read undefined config space */
 369         if (capable(CAP_SYS_ADMIN)) {
 370                 size = dev->cfg_size;
 371         } else if (dev->hdr_type == PCI_HEADER_TYPE_CARDBUS) {
 372                 size = 128;
 373         }
 374
 375         if (off > size)
 376                 return 0;
 377         if (off + count > size) {
 378                 size -= off;
 379                 count = size;
 380         } else {
 381                 size = count;
 382         }
 383
 384         if ((off & 1) && size) {
 385                 u8 val;
 386                 pci_user_read_config_byte(dev, off, &val);
 387                 data[off - init_off] = val;
 388                 off++;
 389                 size--;
 390         }
 391
 392         if ((off & 3) && size > 2) {
 393                 u16 val;
 394                 pci_user_read_config_word(dev, off, &val);
 395                 data[off - init_off] = val & 0xff;
 396                 data[off - init_off + 1] = (val >> 8) & 0xff;
 397                 off += 2;
 398                 size -= 2;
 399         }
 400
 401         while (size > 3) {
 402                 u32 val;
 403                 pci_user_read_config_dword(dev, off, &val);
 404                 data[off - init_off] = val & 0xff;
 405                 data[off - init_off + 1] = (val >> 8) & 0xff;
 406                 data[off - init_off + 2] = (val >> 16) & 0xff;
 407                 data[off - init_off + 3] = (val >> 24) & 0xff;
 408                 off += 4;
 409                 size -= 4;
 410         }
 411
 412         if (size >= 2) {
 413                 u16 val;
 414                 pci_user_read_config_word(dev, off, &val);
 415                 data[off - init_off] = val & 0xff;
 416                 data[off - init_off + 1] = (val >> 8) & 0xff;
 417                 off += 2;
 418                 size -= 2;
 419         }
 420
 421         if (size > 0) {
 422                 u8 val;
 423                 pci_user_read_config_byte(dev, off, &val);
 424                 data[off - init_off] = val;
 425                 off++;
 426                 --size;
 427         }
 428
 429         return count;
 430 }
 431
 432 static ssize_t
 433 pci_write_config(struct kobject *kobj, struct bin_attribute *bin_attr,
 434                  char *buf, loff_t off, size_t count)
 435 {
 436         struct pci_dev *dev = to_pci_dev(container_of(kobj,struct device,kobj));
 437         unsigned int size = count;
 438         loff_t init_off = off;
 439         u8 *data = (u8*) buf;
 440
 441         if (off > dev->cfg_size)
 442                 return 0;
 443         if (off + count > dev->cfg_size) {
 444                 size = dev->cfg_size - off;
 445                 count = size;
 446         }
 447
 448         if ((off & 1) && size) {
 449                 pci_user_write_config_byte(dev, off, data[off - init_off]);
 450                 off++;
 451                 size--;
 452         }
 453
 454         if ((off & 3) && size > 2) {
 455                 u16 val = data[off - init_off];
 456                 val |= (u16) data[off - init_off + 1] << 8;
 457                 pci_user_write_config_word(dev, off, val);
 458                 off += 2;
 459                 size -= 2;
 460         }
 461
 462         while (size > 3) {
 463                 u32 val = data[off - init_off];
 464                 val |= (u32) data[off - init_off + 1] << 8;
 465                 val |= (u32) data[off - init_off + 2] << 16;
 466                 val |= (u32) data[off - init_off + 3] << 24;
 467                 pci_user_write_config_dword(dev, off, val);
 468                 off += 4;
 469                 size -= 4;
 470         }
 471
 472         if (size >= 2) {
 473                 u16 val = data[off - init_off];
 474                 val |= (u16) data[off - init_off + 1] << 8;
 475                 pci_user_write_config_word(dev, off, val);
 476                 off += 2;
 477                 size -= 2;
 478         }
 479
 480         if (size) {
 481                 pci_user_write_config_byte(dev, off, data[off - init_off]);
 482                 off++;
 483                 --size;
 484         }
 485
 486         return count;
 487 }
 488
 489 static ssize_t
 490 read_vpd_attr(struct kobject *kobj, struct bin_attribute *bin_attr,
 491               char *buf, loff_t off, size_t count)
 492 {
 493         struct pci_dev *dev =
 494                 to_pci_dev(container_of(kobj, struct device, kobj));
 495
 496         if (off > bin_attr->size)
 497                 count = 0;
 498         else if (count > bin_attr->size - off)
 499                 count = bin_attr->size - off;
 500
 501         return pci_read_vpd(dev, off, count, buf);
 502 }
 503
 504 static ssize_t
 505 write_vpd_attr(struct kobject *kobj, struct bin_attribute *bin_attr,
 506                char *buf, loff_t off, size_t count)
 507 {
 508         struct pci_dev *dev =
 509                 to_pci_dev(container_of(kobj, struct device, kobj));
 510
 511         if (off > bin_attr->size)
 512                 count = 0;
 513         else if (count > bin_attr->size - off)
 514                 count = bin_attr->size - off;
 515
 516         return pci_write_vpd(dev, off, count, buf);
 517 }
 518
 519 #ifdef HAVE_PCI_LEGACY
 520 /**
 521  * pci_read_legacy_io - read byte(s) from legacy I/O port space
 522  * @kobj: kobject corresponding to file to read from
 523  * @bin_attr: struct bin_attribute for this file
 524  * @buf: buffer to store results
 525  * @off: offset into legacy I/O port space
 526  * @count: number of bytes to read
 527  *
 528  * Reads 1, 2, or 4 bytes from legacy I/O port space using an arch specific
 529  * callback routine (pci_legacy_read).
 530  */
 531 static ssize_t
 532 pci_read_legacy_io(struct kobject *kobj, struct bin_attribute *bin_attr,
 533                    char *buf, loff_t off, size_t count)
 534 {
 535         struct pci_bus *bus = to_pci_bus(container_of(kobj,
 536                                                       struct device,
 537                                                       kobj));
 538
 539         /* Only support 1, 2 or 4 byte accesses */
 540         if (count != 1 && count != 2 && count != 4)
 541                 return -EINVAL;
 542
 543         return pci_legacy_read(bus, off, (u32 *)buf, count);
 544 }
 545
 546 /**
 547  * pci_write_legacy_io - write byte(s) to legacy I/O port space
 548  * @kobj: kobject corresponding to file to read from
 549  * @bin_attr: struct bin_attribute for this file
 550  * @buf: buffer containing value to be written
 551  * @off: offset into legacy I/O port space
 552  * @count: number of bytes to write
 553  *
 554  * Writes 1, 2, or 4 bytes from legacy I/O port space using an arch specific
 555  * callback routine (pci_legacy_write).
 556  */
 557 static ssize_t
 558 pci_write_legacy_io(struct kobject *kobj, struct bin_attribute *bin_attr,
 559                     char *buf, loff_t off, size_t count)
 560 {
 561         struct pci_bus *bus = to_pci_bus(container_of(kobj,
 562                                                       struct device,
 563                                                       kobj));
 564         /* Only support 1, 2 or 4 byte accesses */
 565         if (count != 1 && count != 2 && count != 4)
 566                 return -EINVAL;
 567
 568         return pci_legacy_write(bus, off, *(u32 *)buf, count);
 569 }
 570
 571 /**
 572  * pci_mmap_legacy_mem - map legacy PCI memory into user memory space
 573  * @kobj: kobject corresponding to device to be mapped
 574  * @attr: struct bin_attribute for this file
 575  * @vma: struct vm_area_struct passed to mmap
 576  *
 577  * Uses an arch specific callback, pci_mmap_legacy_mem_page_range, to mmap
 578  * legacy memory space (first meg of bus space) into application virtual
 579  * memory space.
 580  */
 581 static int
 582 pci_mmap_legacy_mem(struct kobject *kobj, struct bin_attribute *attr,
 583                     struct vm_area_struct *vma)
 584 {
 585         struct pci_bus *bus = to_pci_bus(container_of(kobj,
 586                                                       struct device,
 587                                                       kobj));
 588
 589         return pci_mmap_legacy_page_range(bus, vma, pci_mmap_mem);
 590 }
 591
 592 /**
 593  * pci_mmap_legacy_io - map legacy PCI IO into user memory space
 594  * @kobj: kobject corresponding to device to be mapped
 595  * @attr: struct bin_attribute for this file
 596  * @vma: struct vm_area_struct passed to mmap
 597  *
 598  * Uses an arch specific callback, pci_mmap_legacy_io_page_range, to mmap
 599  * legacy IO space (first meg of bus space) into application virtual
 600  * memory space. Returns -ENOSYS if the operation isn't supported
 601  */
 602 static int
 603 pci_mmap_legacy_io(struct kobject *kobj, struct bin_attribute *attr,
 604                    struct vm_area_struct *vma)
 605 {
 606         struct pci_bus *bus = to_pci_bus(container_of(kobj,
 607                                                       struct device,
 608                                                       kobj));
 609
 610         return pci_mmap_legacy_page_range(bus, vma, pci_mmap_io);
 611 }
 612
 613 /**
 614  * pci_adjust_legacy_attr - adjustment of legacy file attributes
 615  * @b: bus to create files under
 616  * @mmap_type: I/O port or memory
 617  *
 618  * Stub implementation. Can be overridden by arch if necessary.
 619  */
 620 void __weak
 621 pci_adjust_legacy_attr(struct pci_bus *b, enum pci_mmap_state mmap_type)
 622 {
 623         return;
 624 }
 625
 626 /**
 627  * pci_create_legacy_files - create legacy I/O port and memory files
 628  * @b: bus to create files under
 629  *
 630  * Some platforms allow access to legacy I/O port and ISA memory space on
 631  * a per-bus basis.  This routine creates the files and ties them into
 632  * their associated read, write and mmap files from pci-sysfs.c
 633  *
 634  * On error unwind, but don't propogate the error to the caller
 635  * as it is ok to set up the PCI bus without these files.
 636  */
 637 void pci_create_legacy_files(struct pci_bus *b)
 638 {
 639         int error;
 640
 641         b->legacy_io = kzalloc(sizeof(struct bin_attribute) * 2,
 642                                GFP_ATOMIC);
 643         if (!b->legacy_io)
 644                 goto kzalloc_err;
 645
 646         sysfs_bin_attr_init(b->legacy_io);
 647         b->legacy_io->attr.name = "legacy_io";
 648         b->legacy_io->size = 0xffff;
 649         b->legacy_io->attr.mode = S_IRUSR | S_IWUSR;
 650         b->legacy_io->read = pci_read_legacy_io;
 651         b->legacy_io->write = pci_write_legacy_io;
 652         b->legacy_io->mmap = pci_mmap_legacy_io;
 653         pci_adjust_legacy_attr(b, pci_mmap_io);
 654         error = device_create_bin_file(&b->dev, b->legacy_io);
 655         if (error)
 656                 goto legacy_io_err;
 657
 658         /* Allocated above after the legacy_io struct */
 659         b->legacy_mem = b->legacy_io + 1;
 660         sysfs_bin_attr_init(b->legacy_mem);
 661         b->legacy_mem->attr.name = "legacy_mem";
 662         b->legacy_mem->size = 1024*1024;
 663         b->legacy_mem->attr.mode = S_IRUSR | S_IWUSR;
 664         b->legacy_mem->mmap = pci_mmap_legacy_mem;
 665         pci_adjust_legacy_attr(b, pci_mmap_mem);
 666         error = device_create_bin_file(&b->dev, b->legacy_mem);
 667         if (error)
 668                 goto legacy_mem_err;
 669
 670         return;
 671
 672 legacy_mem_err:
 673         device_remove_bin_file(&b->dev, b->legacy_io);
 674 legacy_io_err:
 675         kfree(b->legacy_io);
 676         b->legacy_io = NULL;
 677 kzalloc_err:
 678         printk(KERN_WARNING "pci: warning: could not create legacy I/O port "
 679                "and ISA memory resources to sysfs\n");
 680         return;
 681 }
 682
 683 void pci_remove_legacy_files(struct pci_bus *b)
 684 {
 685         if (b->legacy_io) {
 686                 device_remove_bin_file(&b->dev, b->legacy_io);
 687                 device_remove_bin_file(&b->dev, b->legacy_mem);
 688                 kfree(b->legacy_io); /* both are allocated here */
 689         }
 690 }
 691 #endif /* HAVE_PCI_LEGACY */
 692
 693 #ifdef HAVE_PCI_MMAP
 694
 695 int pci_mmap_fits(struct pci_dev *pdev, int resno, struct vm_area_struct *vma)
 696 {
 697         unsigned long nr, start, size;
 698
 699         nr = (vma->vm_end - vma->vm_start) >> PAGE_SHIFT;
 700         start = vma->vm_pgoff;
 701         size = ((pci_resource_len(pdev, resno) - 1) >> PAGE_SHIFT) + 1;
 702         if (start < size && size - start >= nr)
 703                 return 1;
 704         WARN(1, "process \"%s\" tried to map 0x%08lx-0x%08lx on %s BAR %d (size 0x%08lx)\n",
 705                 current->comm, start, start+nr, pci_name(pdev), resno, size);
 706         return 0;
 707 }
 708
 709 /**
 710  * pci_mmap_resource - map a PCI resource into user memory space
 711  * @kobj: kobject for mapping
 712  * @attr: struct bin_attribute for the file being mapped
 713  * @vma: struct vm_area_struct passed into the mmap
 714  * @write_combine: 1 for write_combine mapping
 715  *
 716  * Use the regular PCI mapping routines to map a PCI resource into userspace.
 717  */
 718 static int
 719 pci_mmap_resource(struct kobject *kobj, struct bin_attribute *attr,
 720                   struct vm_area_struct *vma, int write_combine)
 721 {
 722         struct pci_dev *pdev = to_pci_dev(container_of(kobj,
 723                                                        struct device, kobj));
 724         struct resource *res = (struct resource *)attr->private;
 725         enum pci_mmap_state mmap_type;
 726         resource_size_t start, end;
 727         int i;
 728
 729         for (i = 0; i < PCI_ROM_RESOURCE; i++)
 730                 if (res == &pdev->resource[i])
 731                         break;
 732         if (i >= PCI_ROM_RESOURCE)
 733                 return -ENODEV;
 734
 735         if (!pci_mmap_fits(pdev, i, vma))
 736                 return -EINVAL;
 737
 738         /* pci_mmap_page_range() expects the same kind of entry as coming
 739          * from /proc/bus/pci/ which is a "user visible" value. If this is
 740          * different from the resource itself, arch will do necessary fixup.
 741          */
 742         pci_resource_to_user(pdev, i, res, &start, &end);
 743         vma->vm_pgoff += start >> PAGE_SHIFT;
 744         mmap_type = res->flags & IORESOURCE_MEM ? pci_mmap_mem : pci_mmap_io;
 745
 746         if (res->flags & IORESOURCE_MEM && iomem_is_exclusive(start))
 747                 return -EINVAL;
 748
 749         return pci_mmap_page_range(pdev, vma, mmap_type, write_combine);
 750 }
 751
 752 static int
 753 pci_mmap_resource_uc(struct kobject *kobj, struct bin_attribute *attr,
 754                      struct vm_area_struct *vma)
 755 {
 756         return pci_mmap_resource(kobj, attr, vma, 0);
 757 }
 758
 759 static int
 760 pci_mmap_resource_wc(struct kobject *kobj, struct bin_attribute *attr,
 761                      struct vm_area_struct *vma)
 762 {
 763         return pci_mmap_resource(kobj, attr, vma, 1);
 764 }
 765
 766 /**
 767  * pci_remove_resource_files - cleanup resource files
 768  * @pdev: dev to cleanup
 769  *
 770  * If we created resource files for @pdev, remove them from sysfs and
 771  * free their resources.
 772  */
 773 static void
 774 pci_remove_resource_files(struct pci_dev *pdev)
 775 {
 776         int i;
 777
 778         for (i = 0; i < PCI_ROM_RESOURCE; i++) {
 779                 struct bin_attribute *res_attr;
 780
 781                 res_attr = pdev->res_attr[i];
 782                 if (res_attr) {
 783                         sysfs_remove_bin_file(&pdev->dev.kobj, res_attr);
 784                         kfree(res_attr);
 785                 }
 786
 787                 res_attr = pdev->res_attr_wc[i];
 788                 if (res_attr) {
 789                         sysfs_remove_bin_file(&pdev->dev.kobj, res_attr);
 790                         kfree(res_attr);
 791                 }
 792         }
 793 }
 794
 795 static int pci_create_attr(struct pci_dev *pdev, int num, int write_combine)
 796 {
 797         /* allocate attribute structure, piggyback attribute name */
 798         int name_len = write_combine ? 13 : 10;
 799         struct bin_attribute *res_attr;
 800         int retval;
 801
 802         res_attr = kzalloc(sizeof(*res_attr) + name_len, GFP_ATOMIC);
 803         if (res_attr) {
 804                 char *res_attr_name = (char *)(res_attr + 1);
 805
 806                 sysfs_bin_attr_init(res_attr);
 807                 if (write_combine) {
 808                         pdev->res_attr_wc[num] = res_attr;
 809                         sprintf(res_attr_name, "resource%d_wc", num);
 810                         res_attr->mmap = pci_mmap_resource_wc;
 811                 } else {
 812                         pdev->res_attr[num] = res_attr;
 813                         sprintf(res_attr_name, "resource%d", num);
 814                         res_attr->mmap = pci_mmap_resource_uc;
 815                 }
 816                 res_attr->attr.name = res_attr_name;
 817                 res_attr->attr.mode = S_IRUSR | S_IWUSR;
 818                 res_attr->size = pci_resource_len(pdev, num);
 819                 res_attr->private = &pdev->resource[num];
 820                 retval = sysfs_create_bin_file(&pdev->dev.kobj, res_attr);
 821         } else
 822                 retval = -ENOMEM;
 823
 824         return retval;
 825 }
 826
 827 /**
 828  * pci_create_resource_files - create resource files in sysfs for @dev
 829  * @pdev: dev in question
 830  *
 831  * Walk the resources in @pdev creating files for each resource available.
 832  */
 833 static int pci_create_resource_files(struct pci_dev *pdev)
 834 {
 835         int i;
 836         int retval;
 837
 838         /* Expose the PCI resources from this device as files */
 839         for (i = 0; i < PCI_ROM_RESOURCE; i++) {
 840
 841                 /* skip empty resources */
 842                 if (!pci_resource_len(pdev, i))
 843                         continue;
 844
 845                 retval = pci_create_attr(pdev, i, 0);
 846                 /* for prefetchable resources, create a WC mappable file */
 847                 if (!retval && pdev->resource[i].flags & IORESOURCE_PREFETCH)
 848                         retval = pci_create_attr(pdev, i, 1);
 849
 850                 if (retval) {
 851                         pci_remove_resource_files(pdev);
 852                         return retval;
 853                 }
 854         }
 855         return 0;
 856 }
 857 #else /* !HAVE_PCI_MMAP */
 858 int __weak pci_create_resource_files(struct pci_dev *dev) { return 0; }
 859 void __weak pci_remove_resource_files(struct pci_dev *dev) { return; }
 860 #endif /* HAVE_PCI_MMAP */
 861
 862 /**
 863  * pci_write_rom - used to enable access to the PCI ROM display
 864  * @kobj: kernel object handle
 865  * @bin_attr: struct bin_attribute for this file
 866  * @buf: user input
 867  * @off: file offset
 868  * @count: number of byte in input
 869  *
 870  * writing anything except 0 enables it
 871  */
 872 static ssize_t
 873 pci_write_rom(struct kobject *kobj, struct bin_attribute *bin_attr,
 874               char *buf, loff_t off, size_t count)
 875 {
 876         struct pci_dev *pdev = to_pci_dev(container_of(kobj, struct device, kobj));
 877
 878         if ((off ==  0) && (*buf == '0') && (count == 2))
 879                 pdev->rom_attr_enabled = 0;
 880         else
 881                 pdev->rom_attr_enabled = 1;
 882
 883         return count;
 884 }
 885
 886 /**
 887  * pci_read_rom - read a PCI ROM
 888  * @kobj: kernel object handle
 889  * @bin_attr: struct bin_attribute for this file
 890  * @buf: where to put the data we read from the ROM
 891  * @off: file offset
 892  * @count: number of bytes to read
 893  *
 894  * Put @count bytes starting at @off into @buf from the ROM in the PCI
 895  * device corresponding to @kobj.
 896  */
 897 static ssize_t
 898 pci_read_rom(struct kobject *kobj, struct bin_attribute *bin_attr,
 899              char *buf, loff_t off, size_t count)
 900 {
 901         struct pci_dev *pdev = to_pci_dev(container_of(kobj, struct device, kobj));
 902         void __iomem *rom;
 903         size_t size;
 904
 905         if (!pdev->rom_attr_enabled)
 906                 return -EINVAL;
 907
 908         rom = pci_map_rom(pdev, &size); /* size starts out as PCI window size */
 909         if (!rom || !size)
 910                 return -EIO;
 911
 912         if (off >= size)
 913                 count = 0;
 914         else {
 915                 if (off + count > size)
 916                         count = size - off;
 917
 918                 memcpy_fromio(buf, rom + off, count);
 919         }
 920         pci_unmap_rom(pdev, rom);
 921
 922         return count;
 923 }
 924
 925 static struct bin_attribute pci_config_attr = {
 926         .attr = {
 927                 .name = "config",
 928                 .mode = S_IRUGO | S_IWUSR,
 929         },
 930         .size = PCI_CFG_SPACE_SIZE,
 931         .read = pci_read_config,
 932         .write = pci_write_config,
 933 };
 934
 935 static struct bin_attribute pcie_config_attr = {
 936         .attr = {
 937                 .name = "config",
 938                 .mode = S_IRUGO | S_IWUSR,
 939         },
 940         .size = PCI_CFG_SPACE_EXP_SIZE,
 941         .read = pci_read_config,
 942         .write = pci_write_config,
 943 };
 944
 945 int __attribute__ ((weak)) pcibios_add_platform_entries(struct pci_dev *dev)
 946 {
 947         return 0;
 948 }
 949
 950 static ssize_t reset_store(struct device *dev,
 951                            struct device_attribute *attr, const char *buf,
 952                            size_t count)
 953 {
 954         struct pci_dev *pdev = to_pci_dev(dev);
 955         unsigned long val;
 956         ssize_t result = strict_strtoul(buf, 0, &val);
 957
 958         if (result < 0)
 959                 return result;
 960
 961         if (val != 1)
 962                 return -EINVAL;
 963
 964         result = pci_reset_function(pdev);
 965         if (result < 0)
 966                 return result;
 967
 968         return count;
 969 }
 970
 971 static struct device_attribute reset_attr = __ATTR(reset, 0200, NULL, reset_store);
 972
 973 static int pci_create_capabilities_sysfs(struct pci_dev *dev)
 974 {
 975         int retval;
 976         struct bin_attribute *attr;
 977
 978         /* If the device has VPD, try to expose it in sysfs. */
 979         if (dev->vpd) {
 980                 attr = kzalloc(sizeof(*attr), GFP_ATOMIC);
 981                 if (!attr)
 982                         return -ENOMEM;
 983
 984                 sysfs_bin_attr_init(attr);
 985                 attr->size = dev->vpd->len;
 986                 attr->attr.name = "vpd";
 987                 attr->attr.mode = S_IRUSR | S_IWUSR;
 988                 attr->read = read_vpd_attr;
 989                 attr->write = write_vpd_attr;
 990                 retval = sysfs_create_bin_file(&dev->dev.kobj, attr);
 991                 if (retval) {
 992                         kfree(dev->vpd->attr);
 993                         return retval;
 994                 }
 995                 dev->vpd->attr = attr;
 996         }
 997
 998         /* Active State Power Management */
 999         pcie_aspm_create_sysfs_dev_files(dev);
1000
1001         if (!pci_probe_reset_function(dev)) {
1002                 retval = device_create_file(&dev->dev, &reset_attr);
1003                 if (retval)
1004                         goto error;
1005                 dev->reset_fn = 1;
1006         }
1007         return 0;
1008
1009 error:
1010         pcie_aspm_remove_sysfs_dev_files(dev);
1011         if (dev->vpd && dev->vpd->attr) {
1012                 sysfs_remove_bin_file(&dev->dev.kobj, dev->vpd->attr);
1013                 kfree(dev->vpd->attr);
1014         }
1015
1016         return retval;
1017 }
1018
1019 static void pci_remove_slot_links(struct pci_dev *dev)
1020 {
1021         char func[10];
1022         struct pci_slot *slot;
1023
1024         sysfs_remove_link(&dev->dev.kobj, "slot");
1025         list_for_each_entry(slot, &dev->bus->slots, list) {
1026                 if (slot->number != PCI_SLOT(dev->devfn))
1027                         continue;
1028                 snprintf(func, 10, "function%d", PCI_FUNC(dev->devfn));
1029                 sysfs_remove_link(&slot->kobj, func);
1030         }
1031 }
1032
1033 static int pci_create_slot_links(struct pci_dev *dev)
1034 {
1035         int result = 0;
1036         char func[10];
1037         struct pci_slot *slot;
1038
1039         list_for_each_entry(slot, &dev->bus->slots, list) {
1040                 if (slot->number != PCI_SLOT(dev->devfn))
1041                         continue;
1042                 result = sysfs_create_link(&dev->dev.kobj, &slot->kobj, "slot");
1043                 if (result)
1044                         goto out;
1045                 snprintf(func, 10, "function%d", PCI_FUNC(dev->devfn));
1046                 result = sysfs_create_link(&slot->kobj, &dev->dev.kobj, func);
1047         }
1048 out:
1049         return result;
1050 }
1051
1052 int __must_check pci_create_sysfs_dev_files (struct pci_dev *pdev)
1053 {
1054         int retval;
1055         int rom_size = 0;
1056         struct bin_attribute *attr;
1057
1058         if (!sysfs_initialized)
1059                 return -EACCES;
1060
1061         if (pdev->cfg_size < PCI_CFG_SPACE_EXP_SIZE)
1062                 retval = sysfs_create_bin_file(&pdev->dev.kobj, &pci_config_attr);
1063         else
1064                 retval = sysfs_create_bin_file(&pdev->dev.kobj, &pcie_config_attr);
1065         if (retval)
1066                 goto err;
1067
1068         retval = pci_create_resource_files(pdev);
1069         if (retval)
1070                 goto err_config_file;
1071
1072         if (pci_resource_len(pdev, PCI_ROM_RESOURCE))
1073                 rom_size = pci_resource_len(pdev, PCI_ROM_RESOURCE);
1074         else if (pdev->resource[PCI_ROM_RESOURCE].flags & IORESOURCE_ROM_SHADOW)
1075                 rom_size = 0x20000;
1076
1077         /* If the device has a ROM, try to expose it in sysfs. */
1078         if (rom_size) {
1079                 attr = kzalloc(sizeof(*attr), GFP_ATOMIC);
1080                 if (!attr) {
1081                         retval = -ENOMEM;
1082                         goto err_resource_files;
1083                 }
1084                 sysfs_bin_attr_init(attr);
1085                 attr->size = rom_size;
1086                 attr->attr.name = "rom";
1087                 attr->attr.mode = S_IRUSR;
1088                 attr->read = pci_read_rom;
1089                 attr->write = pci_write_rom;
1090                 retval = sysfs_create_bin_file(&pdev->dev.kobj, attr);
1091                 if (retval) {
1092                         kfree(attr);
1093                         goto err_resource_files;
1094                 }
1095                 pdev->rom_attr = attr;
1096         }
1097
1098         if ((pdev->class >> 8) == PCI_CLASS_DISPLAY_VGA) {
1099                 retval = device_create_file(&pdev->dev, &vga_attr);
1100                 if (retval)
1101                         goto err_rom_file;
1102         }
1103
1104         /* add platform-specific attributes */
1105         retval = pcibios_add_platform_entries(pdev);
1106         if (retval)
1107                 goto err_vga_file;
1108
1109         /* add sysfs entries for various capabilities */
1110         retval = pci_create_capabilities_sysfs(pdev);
1111         if (retval)
1112                 goto err_vga_file;
1113
1114         pci_create_slot_links(pdev);
1115
1116         return 0;
1117
1118 err_vga_file:
1119         if ((pdev->class >> 8) == PCI_CLASS_DISPLAY_VGA)
1120                 device_remove_file(&pdev->dev, &vga_attr);
1121 err_rom_file:
1122         if (rom_size) {
1123                 sysfs_remove_bin_file(&pdev->dev.kobj, pdev->rom_attr);
1124                 kfree(pdev->rom_attr);
1125                 pdev->rom_attr = NULL;
1126         }
1127 err_resource_files:
1128         pci_remove_resource_files(pdev);
1129 err_config_file:
1130         if (pdev->cfg_size < PCI_CFG_SPACE_EXP_SIZE)
1131                 sysfs_remove_bin_file(&pdev->dev.kobj, &pci_config_attr);
1132         else
1133                 sysfs_remove_bin_file(&pdev->dev.kobj, &pcie_config_attr);
1134 err:
1135         return retval;
1136 }
1137
1138 static void pci_remove_capabilities_sysfs(struct pci_dev *dev)
1139 {
1140         if (dev->vpd && dev->vpd->attr) {
1141                 sysfs_remove_bin_file(&dev->dev.kobj, dev->vpd->attr);
1142                 kfree(dev->vpd->attr);
1143         }
1144
1145         pcie_aspm_remove_sysfs_dev_files(dev);
1146         if (dev->reset_fn) {
1147                 device_remove_file(&dev->dev, &reset_attr);
1148                 dev->reset_fn = 0;
1149         }
1150 }
1151
1152 /**
1153  * pci_remove_sysfs_dev_files - cleanup PCI specific sysfs files
1154  * @pdev: device whose entries we should free
1155  *
1156  * Cleanup when @pdev is removed from sysfs.
1157  */
1158 void pci_remove_sysfs_dev_files(struct pci_dev *pdev)
1159 {
1160         int rom_size = 0;
1161
1162         if (!sysfs_initialized)
1163                 return;
1164
1165         pci_remove_slot_links(pdev);
1166
1167         pci_remove_capabilities_sysfs(pdev);
1168
1169         if (pdev->cfg_size < PCI_CFG_SPACE_EXP_SIZE)
1170                 sysfs_remove_bin_file(&pdev->dev.kobj, &pci_config_attr);
1171         else
1172                 sysfs_remove_bin_file(&pdev->dev.kobj, &pcie_config_attr);
1173
1174         pci_remove_resource_files(pdev);
1175
1176         if (pci_resource_len(pdev, PCI_ROM_RESOURCE))
1177                 rom_size = pci_resource_len(pdev, PCI_ROM_RESOURCE);
1178         else if (pdev->resource[PCI_ROM_RESOURCE].flags & IORESOURCE_ROM_SHADOW)
1179                 rom_size = 0x20000;
1180
1181         if (rom_size && pdev->rom_attr) {
1182                 sysfs_remove_bin_file(&pdev->dev.kobj, pdev->rom_attr);
1183                 kfree(pdev->rom_attr);
1184         }
1185 }
1186
1187 static int __init pci_sysfs_init(void)
1188 {
1189         struct pci_dev *pdev = NULL;
1190         int retval;
1191
1192         sysfs_initialized = 1;
1193         for_each_pci_dev(pdev) {
1194                 retval = pci_create_sysfs_dev_files(pdev);
1195                 if (retval) {
1196                         pci_dev_put(pdev);
1197                         return retval;
1198                 }
1199         }
1200
1201         return 0;
1202 }
1203
1204 late_initcall(pci_sysfs_init);