[1/2] pci: add bar sizing

Commit Message

Michael S. Tsirkin Aug. 27, 2015, 8:52 a.m. UTC

Will be used for pci-testdev.

Signed-off-by: Michael S. Tsirkin <[e-mail]>
---
 lib/x86/pci.c | 23 +++++++++++++++++++++++
 1 file changed, 23 insertions(+)

Patch

diff --git a/lib/x86/pci.c b/lib/x86/pci.c
index 231668a..5116dac 100644
--- a/lib/x86/pci.c
+++ b/lib/x86/pci.c
@@ -19,6 +19,13 @@  static uint32_t pci_config_read(pcidevaddr_t dev, uint8_t reg)
     return inl(0xCFC);
 }
 
+static uint32_t pci_config_write(pcidevaddr_t dev, uint8_t reg, uint32_t val)
+{
+    uint32_t index = reg | (dev << 8) | (0x1 << 31);
+    outl(0xCF8, index);
+    outl(0xCFC, val);
+}
+
 /* Scan bus look for a specific device. Only bus 0 scanned for now. */
 pcidevaddr_t pci_find_dev(uint16_t vendor_id, uint16_t device_id)
 {
@@ -42,6 +49,22 @@  unsigned long pci_bar_addr(pcidevaddr_t dev, int bar_num)
     }
 }
 
+unsigned long pci_bar_size(pcidevaddr_t dev, int bar_num)
+{
+    uint32_t bar = pci_config_read(dev, PCI_BASE_ADDRESS_0 + bar_num * 4);
+    uint32_t mask;
+
+    pci_config_write(dev, PCI_BASE_ADDRESS_0 + bar_num * 4, 0xffffffff);
+    mask = pci_config_read(dev, PCI_BASE_ADDRESS_0 + bar_num * 4);
+    pci_config_write(dev, PCI_BASE_ADDRESS_0 + bar_num * 4, bar);
+
+    if (bar & PCI_BASE_ADDRESS_SPACE_IO) {
+        return ~(mask & PCI_BASE_ADDRESS_IO_MASK) + 1;
+    } else {
+        return ~(mask & PCI_BASE_ADDRESS_MEM_MASK) + 1;
+    }
+}
+
 bool pci_bar_is_memory(pcidevaddr_t dev, int bar_num)
 {
     uint32_t bar = pci_config_read(dev, PCI_BASE_ADDRESS_0 + bar_num * 4);