pci/pci.c

   1 #include <pci.h>
   2 #include <output.h>
   3
   4 int pci_probe(pci_probe_fn_t probe)
   5 {
   6         int devsfound = 0;
   7         pci_dev_t pdev;
   8         unsigned int bus;
   9         unsigned int dev;
  10         unsigned int fn;
  11
  12         for (bus = 0; bus < 0x100; bus++)
  13                 for (dev = 0; dev < 0x20; dev++)
  14                         if (pci_read32(bus, dev, 0, 0) != 0xFFFFFFFF)
  15                                 for (fn = 0; fn < 8; fn++)
  16                                 {
  17                                         int bar;
  18
  19                                         if (pci_read32(bus, dev, fn, 0) == 0xFFFFFFFF)
  20                                                 continue;
  21
  22                                         if ((fn != 0) && !(pci_read8(bus, dev, 0, 0x0E) & 0x80))
  23                                                 continue;
  24
  25                                         pdev.bus = bus;
  26                                         pdev.dev = dev;
  27                                         pdev.fn = fn;
  28                                         pdev.vid = pci_read16(bus, dev, fn, 0);
  29                                         pdev.did = pci_read16(bus, dev, fn, 2);
  30
  31                                         for (bar = 0; bar < 6; bar++)
  32                                         {
  33                                                 unsigned long bardat = pci_read32(bus, dev, fn, 0x10 + bar*4);
  34                                                 if (bardat == 0)
  35                                                 {
  36                                                         pdev.bars[bar].type = PCI_BAR_NONE;
  37                                                         continue;
  38                                                 }
  39                                                 if (bardat & 1)
  40                                                 {
  41                                                         pdev.bars[bar].type = PCI_BAR_IO;
  42                                                         pdev.bars[bar].addr = bardat & ~0x3;
  43                                                 } else {
  44                                                         pdev.bars[bar].prefetchable = (bardat >> 3) & 1;
  45                                                         switch ((bardat >> 1) & 0x3)
  46                                                         {
  47                                                         case 0:
  48                                                                 pdev.bars[bar].type = PCI_BAR_MEMORY32;
  49                                                                 pdev.bars[bar].addr = bardat & ~0xF;
  50                                                                 break;
  51                                                         case 2:
  52                                                                 pdev.bars[bar].type = PCI_BAR_MEMORY64;
  53                                                                 bar++;
  54                                                                 pdev.bars[bar].type = PCI_BAR_NONE;
  55                                                                 break;
  56                                                         default:
  57                                                                 pdev.bars[bar].type = PCI_BAR_NONE;
  58                                                                 continue;
  59                                                         }
  60                                                 }
  61                                         }
  62
  63                                         devsfound += probe(&pdev);
  64                                 }
  65
  66         return devsfound;
  67 }
  68
  69 static int _enumfn(pci_dev_t *pdev)
  70 {
  71         int bar;
  72
  73         outputf("Found device: %02x:%02x.%1x: %04X:%04X",
  74                 pdev->bus, pdev->dev, pdev->fn,
  75                 pdev->vid, pdev->did);
  76         for (bar = 0; bar < 6; bar++)
  77         {
  78                 switch (pdev->bars[bar].type)
  79                 {
  80                 case PCI_BAR_IO:
  81                         outputf("  BAR %d: I/O, Addr %04x", bar, pdev->bars[bar].addr);
  82                         break;
  83                 case PCI_BAR_MEMORY32:
  84                         outputf("  BAR %d: Mem32, Addr %04x", bar, pdev->bars[bar].addr);
  85                         break;
  86                 case PCI_BAR_MEMORY64:
  87                         outputf("  BAR %d: Mem64, Addr %04x", bar, pdev->bars[bar].addr);
  88                         break;
  89                 default:
  90                         break;
  91                 }
  92         }
  93         return 0;
  94 }
  95
  96 void pci_bus_enum()
  97 {
  98         pci_probe(_enumfn);
  99 }
 100