arch/x86/pci/early.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 #include <linux/kernel.h>
   3 #include <linux/pci.h>
   4 #include <asm/pci-direct.h>
   5 #include <asm/io.h>
   6 #include <asm/pci_x86.h>
   7
   8 /* Direct PCI access. This is used for PCI accesses in early boot before
   9    the PCI subsystem works. */
  10
  11 u32 read_pci_config(u8 bus, u8 slot, u8 func, u8 offset)
  12 {
  13         u32 v;
  14         outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8);
  15         v = inl(0xcfc);
  16         return v;
  17 }
  18
  19 u8 read_pci_config_byte(u8 bus, u8 slot, u8 func, u8 offset)
  20 {
  21         u8 v;
  22         outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8);
  23         v = inb(0xcfc + (offset&3));
  24         return v;
  25 }
  26
  27 u16 read_pci_config_16(u8 bus, u8 slot, u8 func, u8 offset)
  28 {
  29         u16 v;
  30         outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8);
  31         v = inw(0xcfc + (offset&2));
  32         return v;
  33 }
  34
  35 void write_pci_config(u8 bus, u8 slot, u8 func, u8 offset,
  36                                     u32 val)
  37 {
  38         outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8);
  39         outl(val, 0xcfc);
  40 }
  41
  42 void write_pci_config_byte(u8 bus, u8 slot, u8 func, u8 offset, u8 val)
  43 {
  44         outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8);
  45         outb(val, 0xcfc + (offset&3));
  46 }
  47
  48 void write_pci_config_16(u8 bus, u8 slot, u8 func, u8 offset, u16 val)
  49 {
  50         outl(0x80000000 | (bus<<16) | (slot<<11) | (func<<8) | offset, 0xcf8);
  51         outw(val, 0xcfc + (offset&2));
  52 }
  53
  54 int early_pci_allowed(void)
  55 {
  56         return (pci_probe & (PCI_PROBE_CONF1|PCI_PROBE_NOEARLY)) ==
  57                         PCI_PROBE_CONF1;
  58 }
  59
  60 void early_dump_pci_device(u8 bus, u8 slot, u8 func)
  61 {
  62         u32 value[256 / 4];
  63         int i;
  64
  65         pr_info("pci 0000:%02x:%02x.%d config space:\n", bus, slot, func);
  66
  67         for (i = 0; i < 256; i += 4)
  68                 value[i / 4] = read_pci_config(bus, slot, func, i);
  69
  70         print_hex_dump(KERN_INFO, "", DUMP_PREFIX_OFFSET, 16, 1, value, 256, false);
  71 }
  72
  73 void early_dump_pci_devices(void)
  74 {
  75         unsigned bus, slot, func;
  76
  77         if (!early_pci_allowed())
  78                 return;
  79
  80         for (bus = 0; bus < 256; bus++) {
  81                 for (slot = 0; slot < 32; slot++) {
  82                         for (func = 0; func < 8; func++) {
  83                                 u32 class;
  84                                 u8 type;
  85
  86                                 class = read_pci_config(bus, slot, func,
  87                                                         PCI_CLASS_REVISION);
  88                                 if (class == 0xffffffff)
  89                                         continue;
  90
  91                                 early_dump_pci_device(bus, slot, func);
  92
  93                                 if (func == 0) {
  94                                         type = read_pci_config_byte(bus, slot,
  95                                                                     func,
  96                                                                PCI_HEADER_TYPE);
  97                                         if (!(type & 0x80))
  98                                                 break;
  99                                 }
 100                         }
 101                 }
 102         }
 103 }