Merge branch 'tracing-fixes-for-linus' of git://git.kernel.org/pub/scm/linux/kernel...
[linux-2.6] / arch / x86 / pci / early.c
1 #include <linux/kernel.h>
2 #include <linux/pci.h>
3 #include <asm/pci-direct.h>
4 #include <asm/io.h>
5 #include "pci.h"
6
7 /* Direct PCI access. This is used for PCI accesses in early boot before
8    the PCI subsystem works. */
9
10 #define PDprintk(x...)
11
12 u32 read_pci_config(u8 bus, u8 slot, u8 func, u8 offset)
13 {
14         u32 v;
15         outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8);
16         v = inl(0xcfc);
17         if (v != 0xffffffff)
18                 PDprintk("%x reading 4 from %x: %x\n", slot, offset, v);
19         return v;
20 }
21
22 u8 read_pci_config_byte(u8 bus, u8 slot, u8 func, u8 offset)
23 {
24         u8 v;
25         outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8);
26         v = inb(0xcfc + (offset&3));
27         PDprintk("%x reading 1 from %x: %x\n", slot, offset, v);
28         return v;
29 }
30
31 u16 read_pci_config_16(u8 bus, u8 slot, u8 func, u8 offset)
32 {
33         u16 v;
34         outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8);
35         v = inw(0xcfc + (offset&2));
36         PDprintk("%x reading 2 from %x: %x\n", slot, offset, v);
37         return v;
38 }
39
40 void write_pci_config(u8 bus, u8 slot, u8 func, u8 offset,
41                                     u32 val)
42 {
43         PDprintk("%x writing to %x: %x\n", slot, offset, val);
44         outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8);
45         outl(val, 0xcfc);
46 }
47
48 void write_pci_config_byte(u8 bus, u8 slot, u8 func, u8 offset, u8 val)
49 {
50         PDprintk("%x writing to %x: %x\n", slot, offset, val);
51         outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8);
52         outb(val, 0xcfc + (offset&3));
53 }
54
55 void write_pci_config_16(u8 bus, u8 slot, u8 func, u8 offset, u16 val)
56 {
57         PDprintk("%x writing to %x: %x\n", slot, offset, val);
58         outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8);
59         outw(val, 0xcfc + (offset&2));
60 }
61
62 int early_pci_allowed(void)
63 {
64         return (pci_probe & (PCI_PROBE_CONF1|PCI_PROBE_NOEARLY)) ==
65                         PCI_PROBE_CONF1;
66 }
67
68 void early_dump_pci_device(u8 bus, u8 slot, u8 func)
69 {
70         int i;
71         int j;
72         u32 val;
73
74         printk("PCI: %02x:%02x:%02x", bus, slot, func);
75
76         for (i = 0; i < 256; i += 4) {
77                 if (!(i & 0x0f))
78                         printk("\n%04x:",i);
79
80                 val = read_pci_config(bus, slot, func, i);
81                 for (j = 0; j < 4; j++) {
82                         printk(" %02x", val & 0xff);
83                         val >>= 8;
84                 }
85         }
86         printk("\n");
87 }
88
89 void early_dump_pci_devices(void)
90 {
91         unsigned bus, slot, func;
92
93         if (!early_pci_allowed())
94                 return;
95
96         for (bus = 0; bus < 256; bus++) {
97                 for (slot = 0; slot < 32; slot++) {
98                         for (func = 0; func < 8; func++) {
99                                 u32 class;
100                                 u8 type;
101                                 class = read_pci_config(bus, slot, func,
102                                                         PCI_CLASS_REVISION);
103                                 if (class == 0xffffffff)
104                                         break;
105
106                                 early_dump_pci_device(bus, slot, func);
107
108                                 /* No multi-function device? */
109                                 type = read_pci_config_byte(bus, slot, func,
110                                                                PCI_HEADER_TYPE);
111                                 if (!(type & 0x80))
112                                         break;
113                         }
114                 }
115         }
116 }
117