Changeset 236 for trunk/hal/x86_64/core/hal_init.c

Timestamp:

Jul 19, 2017, 2:30:15 PM (7 years ago)

Author:

max@…

Message:

Launch the secondary CPUs. For now, they all say hello and enter
an infinite loop.

File:

• trunk/hal/x86_64/core/hal_init.c (modified) (4 diffs)

trunk/hal/x86_64/core/hal_init.c

@@ -58 +58 @@
 uint8_t mb_mmap[PAGE_SIZE] __in_kdata;
 
+/* x86-specific per-cluster structures */
+uint8_t gdtstore[PAGE_SIZE] __in_kdata;
+uint8_t idtstore[PAGE_SIZE] __in_kdata;
+
+/* x86-specific per-cpu structures */
+typedef struct {
+        bool_t valid;
+        struct tss tss;
+        struct tls tls;
+        uint8_t boot_stack[STKSIZE];
+        uint8_t intr_stack[STKSIZE];
+        uint8_t dbfl_stack[STKSIZE];
+        uint8_t nmfl_stack[STKSIZE];
+} percpu_archdata_t;
+percpu_archdata_t cpudata[CONFIG_MAX_LOCAL_CORES] __in_kdata;
+
 /* -------------------------------------------------------------------------- */
 
@@ -245 +261 @@
 /* -------------------------------------------------------------------------- */
 
+static uint32_t cpuN_booted __in_kdata;
+
+void start_secondary_cpus()
+{
+        pt_entry_t flags = PG_V | PG_KW;
+        extern vaddr_t cpuN_boot_trampoline;
+        extern vaddr_t cpuN_boot_trampoline_end;
+        extern paddr_t smp_L4pa;
+        extern vaddr_t smp_stkva;
+        extern paddr_t L4paddr;
+        size_t i, sz;
+
+        smp_L4pa = L4paddr;
+
+        /* map the SMP trampoline (identity) */
+        vaddr_t trampva = (vaddr_t)SMP_TRAMPOLINE_PA;
+        hal_gpt_maptree_area(trampva, trampva + PAGE_SIZE);
+        hal_gpt_enter(trampva, SMP_TRAMPOLINE_PA, flags);
+
+        /* copy it */
+        sz = (size_t)&cpuN_boot_trampoline_end - (size_t)&cpuN_boot_trampoline;
+        memcpy((void *)trampva, (void *)&cpuN_boot_trampoline, sz);
+
+        for (i = 0; i < CONFIG_MAX_LOCAL_CORES; i++) {
+                if (i == 0 || !cpudata[i].valid) {
+                        continue;
+                }
+
+                smp_stkva = (vaddr_t)cpudata[i].boot_stack + STKSIZE;
+
+                cpuN_booted = 0;
+                boot_cpuN(i, SMP_TRAMPOLINE_PA);
+                while (!hal_atomic_cas(&cpuN_booted, 1, 0)) {
+                        /* wait */
+                }
+        }
+
+        // XXX: unmap the trampoline
+}
+
+void init_x86_64_cpuN()
+{
+        cpuN_booted = 1;
+        x86_printf("-> cpu%z is alive!\n", hal_lapic_gid());
+        while (1);
+}
+
+/* -------------------------------------------------------------------------- */
+
 static void apic_map()
 {
@@ -310 +375 @@
         init_bootinfo(&btinfo);
 
+        start_secondary_cpus();
+
         reg_t dummy;
         hal_enable_irq(&dummy);
@@ -342 +409 @@
 
 /* -------------------------------------------------------------------------- */
-
-/* x86-specific per-cluster structures */
-uint8_t gdtstore[PAGE_SIZE] __in_kdata;
-uint8_t idtstore[PAGE_SIZE] __in_kdata;
-
-/* x86-specific per-cpu structures */
-typedef struct {
-        bool_t valid;
-        struct tss tss;
-        struct tls tls;
-        uint8_t intr_stack[STKSIZE];
-        uint8_t dbfl_stack[STKSIZE];
-        uint8_t nmfl_stack[STKSIZE];
-} percpu_archdata_t;
-percpu_archdata_t cpudata[CONFIG_MAX_LOCAL_CORES] __in_kdata;
 
 void cpu_activate(uint32_t gid)