Probe RSDP for PCIe Config

zion/boot/acpi.cpp

@@ -0,0 +1,171 @@
+#include "boot/acpi.h"
+
+#include "boot/boot_info.h"
+#include "debug/debug.h"
+
+#define K_ACPI_DEBUG 0
+
+namespace {
+
+static uint64_t gPcieEcBase = 0x0;
+static uint64_t gPcieEcSize = 0x0;
+
+struct RsdpDescriptor {
+  char signature[8];
+  uint8_t checksum;
+  char oem_id[6];
+  uint8_t revision;
+  uint32_t rsdt_addr;
+  uint32_t length;
+  uint64_t xsdt_addr;
+  uint8_t ext_checksum;
+  uint8_t reserved[3];
+} __attribute__((packed));
+
+struct SdtHeader {
+  char signature[4];
+  uint32_t length;
+  uint8_t revision;
+  uint8_t checksum;
+  char oem_id[6];
+  char oem_table_id[8];
+  uint32_t oem_revision;
+  uint32_t creator_id;
+  uint32_t creator_revision;
+} __attribute__((packed));
+
+bool streq(const char* a, const char* b, uint8_t len) {
+  for (uint8_t i = 0; i < len; i++) {
+    if (a[i] != b[i]) return false;
+  }
+  return true;
+}
+
+bool checksum(uint8_t* addr, uint8_t num_bytes) {
+  uint8_t check_cnt = 0;
+  for (uint8_t i = 0; i < num_bytes; i++) {
+    check_cnt += addr[i];
+  }
+  return check_cnt == 0;
+}
+
+void dbgsz(const char* c, uint8_t cnt) {
+  char cl[cnt + 1];
+
+  for (uint8_t i = 0; i < cnt; i++) {
+    cl[i] = c[i];
+  }
+  cl[cnt] = '\0';
+  dbgln(cl);
+}
+
+uint8_t* SdtDataStart(SdtHeader* sdt) {
+  return reinterpret_cast<uint8_t*>(sdt) + sizeof(SdtHeader);
+}
+
+void ParseMcfg(SdtHeader* rsdt) {
+#if K_ACPI_DEBUG
+  dbgsz(rsdt->signature, 4);
+#endif
+  uint32_t size = (rsdt->length - sizeof(SdtHeader)) / 16;
+  uint64_t* entries = reinterpret_cast<uint64_t*>(SdtDataStart(rsdt));
+  // There are 8 reserved bytes at the end of the table.
+  entries++;
+  for (uint32_t i = 0; i < size; i++) {
+    uint64_t base_ecm_addr = entries[2 * i];
+    uint64_t bus_info = entries[2 * i + 1];
+    if (bus_info != 0xff000000) {
+#if K_ACPI_DEBUG
+      dbgln("WARN: Unexpected bus-info for PCI EC. Mem region will be wrong.")
+#endif
+    }
+    gPcieEcBase = base_ecm_addr;
+    uint64_t num_busses = 0x100;
+    uint64_t dev_per_bus = 0x20;
+    uint64_t fns_per_dev = 0x8;
+    uint64_t bytes_per_fn = 0x1000;
+    gPcieEcSize = num_busses * dev_per_bus * fns_per_dev * bytes_per_fn;
+#if K_ACPI_DEBUG
+    dbgln("PCI Map: %m:%x", gPcieEcBase, gPcieEcSize);
+#endif
+  }
+}
+
+void ParseSdt(SdtHeader* rsdt) {
+  if (!checksum((uint8_t*)rsdt, rsdt->length)) {
+    dbgln("Bad RSDT checksum.");
+    return;
+  }
+  if (streq(rsdt->signature, "MCFG", 4)) {
+    ParseMcfg(rsdt);
+  } else {
+#if K_ACPI_DEBUG
+    dbgln("Unhandled:");
+    dbgsz(rsdt->signature, 4);
+#endif
+  }
+}
+
+void ProbeRsdt(SdtHeader* rsdt) {
+  if (!checksum((uint8_t*)rsdt, rsdt->length)) {
+    dbgln("Bad RSDT checksum.");
+    return;
+  }
+#if K_ACPI_DEBUG
+  dbgsz(rsdt->signature, 4);
+#endif
+  uint32_t size = (rsdt->length - sizeof(SdtHeader)) / 4;
+  uint32_t* entries = reinterpret_cast<uint32_t*>(SdtDataStart(rsdt));
+  for (uint32_t i = 0; i < size; i++) {
+    SdtHeader* table = reinterpret_cast<SdtHeader*>(entries[i]);
+    ParseSdt(table);
+  }
+}
+
+}  // namespace
+
+void ProbeRsdp() {
+  void* rsdp_addr = boot::GetRsdpAddr();
+  RsdpDescriptor* rsdp = static_cast<RsdpDescriptor*>(rsdp_addr);
+  if (!streq(rsdp->signature, "RSD PTR ", 8)) {
+    dbgln("Invalid Rsdp!");
+    return;
+  }
+
+  // Checks V1 up to rsdt_addr.
+  if (!checksum((uint8_t*)rsdp_addr, 20)) {
+    dbgln("Rsdp Check failed");
+    return;
+  }
+
+#if K_ACPI_DEBUG
+  dbgln("ACPI Ver %u", rsdp->revision);
+  dbgln("RSDT Addr: %m", rsdp->rsdt_addr);
+#endif
+
+  ProbeRsdt(reinterpret_cast<SdtHeader*>(rsdp->rsdt_addr));
+
+  if (rsdp->revision == 0) {
+    return;
+  }
+
+  // Checks V2 (entire structure).
+  if (!checksum((uint8_t*)rsdp_addr, rsdp->length)) {
+    dbgln("Rsdp ext checksum failed");
+    return;
+  }
+
+#if K_ACPI_DEBUG
+  dbgln("XSDT Addr: %m", rsdp->xsdt_addr);
+#endif
+}
+
+z_err_t GetPciExtendedConfiguration(uint64_t* base, uint64_t* offset) {
+  if (gPcieEcSize == 0) {
+    return Z_ERR_NOT_FOUND;
+  }
+
+  *base = gPcieEcBase;
+  *offset = gPcieEcSize;
+  return Z_OK;
+}