From 7166c7c72530156cf249068b95776e2cc190e464 Mon Sep 17 00:00:00 2001
From: Sergiusz Bazanski <sergiusz@q3k.org>
Date: Sun, 28 Aug 2011 04:30:57 +0200
Subject: [PATCH] Kernel: MP processor listing.

---
 Kernel/Makefile           |  2 +-
 Kernel/include/Tier0/mp.h | 30 +++++++++++++++++++
 Kernel/src/Tier0/mp.c     | 63 +++++++++++++++++++++++++++++++++++++--
 3 files changed, 92 insertions(+), 3 deletions(-)

diff --git a/Kernel/Makefile b/Kernel/Makefile
index be95d37..5abfead 100644
--- a/Kernel/Makefile
+++ b/Kernel/Makefile
@@ -92,7 +92,7 @@ emulate-nohdd: kernel.bin
 	@echo "[i] Building loader..."
 	@pushd ../Loader > /dev/null && $(MAKE) -f Makefile loader.bin && popd > /dev/null
 	@echo "[i] Starting QEMU..."
-	@qemu-system-x86_64 -kernel ../Loader/loader.bin -initrd kernel.bin
+	@qemu-system-x86_64 -smp 4 -kernel ../Loader/loader.bin -initrd kernel.bin
 
 emulate: hdd.img
 	@echo "[i] Starting QEmu..."
diff --git a/Kernel/include/Tier0/mp.h b/Kernel/include/Tier0/mp.h
index a2f0c2b..da0d12d 100755
--- a/Kernel/include/Tier0/mp.h
+++ b/Kernel/include/Tier0/mp.h
@@ -11,7 +11,37 @@ typedef struct {
     u8 Checksum;
 } __attribute__((packed)) T_MP_POINTER;
 
+typedef struct {
+    u8 Signature[4];
+    u16 BaseTableLength;
+    u8 Specification;
+    u8 Checksum;
+    u8 OEMName[8];
+    u8 ProductName[12];
+    u32 OEMTablePointer;
+    u16 OEMTableSize;
+    u16 NumEntries;
+    u32 LAPICAddress;
+    u16 ExtendedTableLength;
+    u8 ExtendedTableChecksum;
+    u8 Reserved;
+} __attribute__((packed)) T_MP_CONFIGURATION_HEADER;
+
+typedef struct {
+    u8 EntryType;
+    u8 LAPICID;
+    u8 LAPICVersion;
+    u8 FlagAvailable : 1;
+    u8 FlagBootstrap : 1;
+    u8 FlagReserved  : 6;
+    u32 Signature;
+    u32 CPUID;
+    u32 Reserved1;
+    u32 Reserved2;
+} __attribute__((packed)) T_MP_ENTRY_CPU;
+
 u64 mp_find_pointer(u64 Start, u64 End);
 void mp_initialize(void);
+void mp_parse_configuration_table(u32 TableAddress);
 
 #endif
diff --git a/Kernel/src/Tier0/mp.c b/Kernel/src/Tier0/mp.c
index e35ddee..b9fdcd7 100755
--- a/Kernel/src/Tier0/mp.c
+++ b/Kernel/src/Tier0/mp.c
@@ -2,8 +2,12 @@
 #include "Tier0/paging.h"
 #include "Tier0/physmem.h"
 #include "Tier0/kstdio.h"
+#include "Tier0/kstdlib.h"
 #include "Tier0/panic.h"
 
+#define MP_TEMP_BUFFER_LENGTH 1024
+u8 g_EntriesBuffer[MP_TEMP_BUFFER_LENGTH];
+
 u64 mp_find_pointer(u64 Start, u64 End)
 {
     for (u64 i = Start & ~((u64)0x10); i < End; i += 16)
@@ -80,11 +84,66 @@ void mp_initialize(void)
     if (PointerTable.TablePhysical)
     {
         kprintf("[i] MP Configuration Table present.\n");
-        // do something.
+        mp_parse_configuration_table(PointerTable.TablePhysical);
     }
     else
     {
         kprintf("[i] MP Configuration Type present.\n");
-        // do something else
+        // do something else... like panic.
+        PANIC("MP types not implemented!");
+    }
+}
+
+u8 mp_parse_cpu(u32 EntryAddress, u8 CPUNum)
+{
+    T_MP_ENTRY_CPU *CPU = (T_MP_ENTRY_CPU *)&g_EntriesBuffer[EntryAddress];
+    
+    if (CPU->FlagBootstrap)
+        kprintf("    CPU #%i, LAPIC sig %x, cpuid %x (bootstrap)\n", CPUNum, CPU->LAPICID, CPU->CPUID);
+    else if (!CPU->FlagAvailable)
+        kprintf("    CPU #%i, LAPIC sig %x, cpuid %x, (UNAVAILABLE!!!)", CPUNum, CPU->LAPICID, CPU->CPUID);
+    else
+        kprintf("    CPU #%i, LAPIC sig %x, cpuid %x (halted)\n", CPUNum, CPU->LAPICID, CPU->CPUID);
+    
+    return sizeof(T_MP_ENTRY_CPU);
+}
+
+void mp_parse_configuration_table(u32 TableAddress)
+{
+    T_MP_CONFIGURATION_HEADER Header;
+    physmem_read(TableAddress, 44, &Header);
+    
+    s8 OEMName[9];
+    kmemcpy(OEMName, Header.OEMName, 8);
+    OEMName[8] = 0x00;
+    
+    s8 ProductName[13];
+    kmemcpy(ProductName, Header.ProductName, 12);
+    ProductName[12] = 0x00;
+    
+    kprintf("[i] MP OEM: %s\n", OEMName);
+    kprintf("[i] MP Product: %s\n", ProductName);
+    
+    kprintf("[i] MP Base Configuration Table length: %i bytes.\n", Header.BaseTableLength);
+    
+    if (Header.BaseTableLength > MP_TEMP_BUFFER_LENGTH)
+        PANIC("MP BCT too big!");
+    
+    physmem_read(TableAddress + 44, Header.BaseTableLength - 44, g_EntriesBuffer);
+    
+    u32 EntryAddress = 0;
+    u8 CPUNum = 0;
+    while (1)
+    {
+        u8 EntryType = g_EntriesBuffer[EntryAddress];
+        switch (EntryType)
+        {
+            case 0x00:
+                EntryAddress += mp_parse_cpu(EntryAddress, CPUNum);
+                CPUNum++;
+                break;
+            default:
+                for (;;) {}
+        }
     }
 }