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