git.oblomov.eu Git - linux-2.6/blob - 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