Changeset a26ddd1 in mainline for arch/ia32/src/smp/smp.c

Timestamp:

2005-07-18T12:37:11Z (20 years ago)

Author:

Jakub Jermar <jakub@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

232e3ec7

Parents:

6b7c36f

Message:

Create IA-32 interface for bringing SMP up.
This interface hides differences between ACPI MADT and MPS configuration tables.
Provide MPS implementation thereof.

File:

• arch/ia32/src/smp/smp.c (modified) (2 diffs)

arch/ia32/src/smp/smp.c

@@ -28 +28 @@
 
 #include <smp/smp.h>
+#include <arch/smp/smp.h>
+#include <arch/smp/mps.h>
+#include <arch/smp/ap.h>
 #include <arch/acpi/acpi.h>
 #include <arch/acpi/madt.h>
-#include <arch/smp/mps.h>
 #include <config.h>
+#include <synch/waitq.h>
+#include <arch/pm.h>
+#include <func.h>
+#include <panic.h>
+#include <debug.h>
+#include <arch/asm.h>
+#include <mm/frame.h>
+#include <mm/page.h>
+#include <mm/heap.h>
 
 #ifdef __SMP__
+
+static struct smp_config_operations *ops = NULL;
 
 void smp_init(void)
@@ -40 +53 @@
                 acpi_madt_parse();
         }
-        if (config.cpu_count == 1)
+        if (config.cpu_count == 1) {
                 mps_init();
+                ops = &mps_config_operations;
+        }
 }
 
+/*
+ * Kernel thread for bringing up application processors. It becomes clear
+ * that we need an arrangement like this (AP's being initialized by a kernel
+ * thread), for a thread has its dedicated stack. (The stack used during the
+ * BSP initialization (prior the very first call to scheduler()) will be used
+ * as an initialization stack for each AP.)
+ */
+void kmp(void *arg)
+{
+        __address src, dst;
+        int i;
+
+        ASSERT(ops != NULL);
+
+        waitq_initialize(&ap_completion_wq);
+
+        /*
+         * We need to access data in frame 0.
+         * We boldly make use of kernel address space mapping.
+         */
+
+        /*
+         * Set the warm-reset vector to the real-mode address of 4K-aligned ap_boot()
+         */
+        *((__u16 *) (PA2KA(0x467+0))) =  ((__address) ap_boot) >> 4;    /* segment */
+        *((__u16 *) (PA2KA(0x467+2))) =  0;                             /* offset */
+        
+        /*
+         * Save 0xa to address 0xf of the CMOS RAM.
+         * BIOS will not do the POST after the INIT signal.
+         */
+        outb(0x70,0xf);
+        outb(0x71,0xa);
+
+        cpu_priority_high();
+
+        pic_disable_irqs(0xffff);
+        apic_init();
+
+        for (i = 0; i < ops->cpu_count(); i++) {
+                struct descriptor *gdt_new;
+        
+                /*
+                 * Skip processors marked unusable.
+                 */
+                if (!ops->cpu_enabled(i))
+                        continue;
+
+                /*
+                 * The bootstrap processor is already up.
+                 */
+                if (ops->cpu_bootstrap(i))
+                        continue;
+
+                if (ops->cpu_apic_id(i) == l_apic_id()) {
+                        printf("kmp: bad processor entry #%d, will not send IPI to myself\n", i);
+                        continue;
+                }
+                
+                /*
+                 * Prepare new GDT for CPU in question.
+                 */
+                if (!(gdt_new = (struct descriptor *) malloc(GDT_ITEMS*sizeof(struct descriptor))))
+                        panic("couldn't allocate memory for GDT\n");
+
+                memcopy(gdt, gdt_new, GDT_ITEMS*sizeof(struct descriptor));
+                memsetb(&gdt_new[TSS_DES], sizeof(struct descriptor), 0);
+                gdtr.base = KA2PA((__address) gdt_new);
+
+                if (l_apic_send_init_ipi(ops->cpu_apic_id(i))) {
+                        /*
+                         * There may be just one AP being initialized at
+                         * the time. After it comes completely up, it is
+                         * supposed to wake us up.
+                         */
+                        waitq_sleep(&ap_completion_wq);
+                        cpu_priority_high();
+                }
+                else {
+                        printf("INIT IPI for l_apic%d failed\n", ops->cpu_apic_id(i));
+                }
+        }
+
+        /*
+         * Wakeup the kinit thread so that
+         * system initialization can go on.
+         */
+        waitq_wakeup(&kmp_completion_wq, WAKEUP_FIRST);
+}
 
 #endif /* __SMP__ */