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 u32 read_pci_config(u8 bus, u8 slot, u8 func, u8 offset) 11 { 12 u32 v; 13 outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8); 14 v = inl(0xcfc); 15 if (v != 0xffffffff) 16 pr_debug("%x reading 4 from %x: %x\n", slot, offset, v); 17 return v; 18 } 19 20 u8 read_pci_config_byte(u8 bus, u8 slot, u8 func, u8 offset) 21 { 22 u8 v; 23 outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8); 24 v = inb(0xcfc + (offset&3)); 25 pr_debug("%x reading 1 from %x: %x\n", slot, offset, v); 26 return v; 27 } 28 29 u16 read_pci_config_16(u8 bus, u8 slot, u8 func, u8 offset) 30 { 31 u16 v; 32 outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8); 33 v = inw(0xcfc + (offset&2)); 34 pr_debug("%x reading 2 from %x: %x\n", slot, offset, v); 35 return v; 36 } 37 38 void write_pci_config(u8 bus, u8 slot, u8 func, u8 offset, 39 u32 val) 40 { 41 pr_debug("%x writing to %x: %x\n", slot, offset, val); 42 outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8); 43 outl(val, 0xcfc); 44 } 45 46 void write_pci_config_byte(u8 bus, u8 slot, u8 func, u8 offset, u8 val) 47 { 48 pr_debug("%x writing to %x: %x\n", slot, offset, val); 49 outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8); 50 outb(val, 0xcfc + (offset&3)); 51 } 52 53 void write_pci_config_16(u8 bus, u8 slot, u8 func, u8 offset, u16 val) 54 { 55 pr_debug("%x writing to %x: %x\n", slot, offset, val); 56 outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8); 57 outw(val, 0xcfc + (offset&2)); 58 } 59 60 int early_pci_allowed(void) 61 { 62 return (pci_probe & (PCI_PROBE_CONF1|PCI_PROBE_NOEARLY)) == 63 PCI_PROBE_CONF1; 64 } 65 66 void early_dump_pci_device(u8 bus, u8 slot, u8 func) 67 { 68 int i; 69 int j; 70 u32 val; 71 72 printk(KERN_INFO "PCI: %02x:%02x:%02x", bus, slot, func); 73 74 for (i = 0; i < 256; i += 4) { 75 if (!(i & 0x0f)) 76 printk("\n%04x:",i); 77 78 val = read_pci_config(bus, slot, func, i); 79 for (j = 0; j < 4; j++) { 80 printk(" %02x", val & 0xff); 81 val >>= 8; 82 } 83 } 84 printk("\n"); 85 } 86 87 void early_dump_pci_devices(void) 88 { 89 unsigned bus, slot, func; 90 91 if (!early_pci_allowed()) 92 return; 93 94 for (bus = 0; bus < 256; bus++) { 95 for (slot = 0; slot < 32; slot++) { 96 for (func = 0; func < 8; func++) { 97 u32 class; 98 u8 type; 99 class = read_pci_config(bus, slot, func, 100 PCI_CLASS_REVISION); 101 if (class == 0xffffffff) 102 break; 103 104 early_dump_pci_device(bus, slot, func); 105 106 /* No multi-function device? */ 107 type = read_pci_config_byte(bus, slot, func, 108 PCI_HEADER_TYPE); 109 if (!(type & 0x80)) 110 break; 111 } 112 } 113 } 114 } 115 116