Changeset 275 for trunk/hal/x86_64/core/hal_acpi.c

Timestamp:

Jul 26, 2017, 1:20:36 PM (7 years ago)

Author:

max@…

Message:

Add a SRAT parser. For some reason, QEMU does not want to enable the
memory ranges...

File:

• trunk/hal/x86_64/core/hal_acpi.c (modified) (3 diffs)

trunk/hal/x86_64/core/hal_acpi.c

@@ -173 +173 @@
 /* -------------------------------------------------------------------------- */
 
+static void hal_acpi_parse_srat(srat_t *srat)
+{
+        srat_cpu_affinity_t *cpu;
+        srat_mem_affinity_t *mem;
+        void *ptr, *end;
+        subheader_t *sub;
+        uint32_t dom;
+
+        ptr = (void *)(srat + 1);
+        end = (void *)srat + srat->Header.Length;
+
+        while (ptr < end) {
+                sub = (subheader_t *)ptr;
+                if (sub->Type == ACPI_SRAT_TYPE_CPU_AFFINITY) {
+                        cpu = (srat_cpu_affinity_t *)sub;
+                        if (cpu->Flags & ACPI_SRAT_CPU_USE_AFFINITY) {
+                                dom = ((uint32_t)cpu->ProximityDomainHi[2] << 24) |
+                                      ((uint32_t)cpu->ProximityDomainHi[1] << 16) |
+                                      ((uint32_t)cpu->ProximityDomainHi[0] << 8) |
+                                       (uint32_t)cpu->ProximityDomainLo;
+                                x86_printf("-> found CPU affinity: %z->%z\n",
+                                    (uint64_t)cpu->ApicId, (uint64_t)dom);
+                        }
+                } else if (sub->Type == ACPI_SRAT_TYPE_MEMORY_AFFINITY) {
+                        mem = (srat_mem_affinity_t *)sub;
+//                      if (mem->Flags & ACPI_SRAT_MEM_ENABLED)
+                                x86_printf("-> found MEM affinity: %z->[%Z,%Z,%Z]\n",
+                                    mem->ProximityDomain,
+                                    mem->BaseAddress, mem->Length,(uint64_t)mem->Flags);
+                } 
+
+                ptr += sub->Length;
+        }
+
+}
+
+static srat_t *hal_acpi_map_srat(rsdt_t *rsdt)
+{
+        vaddr_t va;
+        paddr_t pa;
+        uint32_t *ent;
+        size_t i, n;
+
+        n = RSDT_NENTRIES(rsdt);
+        ent = RSDT_ENTRIES(rsdt);
+
+        for (i = 0; i < n; i++) {
+                pa = (paddr_t)ent[i];
+                va = hal_acpi_map_table(pa, "SRAT");
+                if (va == 0)
+                        continue;
+
+                return (srat_t *)va;
+        }
+
+        return NULL;
+}
+
+/* -------------------------------------------------------------------------- */
+
 static rsdt_t *hal_acpi_map_rsdt(rsdp_t *rsdp)
 {
@@ -242 +302 @@
         rsdt_t *rsdt;
         madt_t *madt;
+        srat_t *srat;
         paddr_t bios_min = 0x0E0000;
         paddr_t bios_max = 0x100000;
@@ -262 +323 @@
                 x86_panic("RSDT not found");
 
-        /* Now, map MADT */
+        /* Map MADT and parse it */
         madt = hal_acpi_map_madt(rsdt);
         if (madt == NULL)
                 x86_panic("MADT not found");
-
-        /* Parse it */
         hal_acpi_parse_madt(madt);
-}
-
+
+        /* Map SRAT and parse it */
+        srat = hal_acpi_map_srat(rsdt);
+        if (srat != NULL)
+                hal_acpi_parse_srat(srat);
+        else
+                x86_printf("-> SRAT not found, single cluster\n");
+}
+