code refactoring

1 files changed, 5 insertions, 136 deletions

diff --git a/kernel/src/apic/madt.c b/kernel/src/apic/madt.c
index 3929cd8..f69887d 100644
--- a/kernel/src/apic/madt.c
+++ b/kernel/src/apic/madt.c
@@ -1,80 +1,8 @@
 #include <madt.h>
+#include <apic.h>
 #include <heap.h>
-#include <paging.h>
 #include <libk/string.h>
 #include <libk/stdio.h>
-#include <apic.h>
-#include <timer.h>
-#include <atomic.h>
-
-mutex_t cnt_lock;
-uint64_t cnt;
-
-uint8_t curr_cpu_apic_id(void);
-uint8_t curr_cpu_apic_id()
-{
-	uint8_t apic_id = 0;
-	__asm__ __volatile__ ("movl $1, %%eax; cpuid; shrl $24, %%ebx;": "=b"(apic_id));
-	return apic_id;
-}
-
-uint32_t ioapic_addr = 0;
-uint64_t lapic_addr = 0;
-uint32_t numcores = 0;
-uint8_t cpu_apic_ids[256];
-
-uint32_t ioapic_read(const uint8_t offset);
-uint32_t ioapic_read(const uint8_t offset)
-{
-    /* tell IOREGSEL where we want to read from */
-    *(volatile uint32_t*)(uint64_t)ioapic_addr = offset;
-    /* return the data from IOWIN */
-    return *(volatile uint32_t*)((uint64_t)ioapic_addr + 0x10);
-}
-
-void ioapic_write(const uint8_t offset, const uint32_t val);
-void ioapic_write(const uint8_t offset, const uint32_t val)
-{
-    /* tell IOREGSEL where we want to write to */
-    *(volatile uint32_t*)(uint64_t)ioapic_addr = offset;
-    /* write the value to IOWIN */
-    *(volatile uint32_t*)((uint64_t)ioapic_addr + 0x10) = val;
-}
-
-void apic_eoi()
-{
-	*((volatile uint32_t*)((uint64_t)0xFEE00000 + 0xB0)) = 0;
-}
-
-void ioapic_set_irq(uint8_t irq, uint64_t apic_id, uint8_t vector);
-void ioapic_set_irq(uint8_t irq, uint64_t apic_id, uint8_t vector)
-{
-	const uint32_t low_index = (uint32_t)0x10 + irq*2;
-	const uint32_t high_index = (uint32_t)0x10 + irq*2 + 1;
-
-	uint32_t high = ioapic_read((uint8_t)high_index);
-	// set APIC ID
-	high &= (uint32_t)~0xff000000;
-	high |= (uint32_t)apic_id << 24;
-	ioapic_write((uint8_t)high_index, high);
-
-	uint32_t low = ioapic_read((uint8_t)low_index);
-
-	// unmask the IRQ
-	low &= (uint32_t)~(1<<16);
-
-	// set to physical delivery mode
-	low &= (uint32_t)~(1<<11);
-
-	// set to fixed delivery mode
-	low &= (uint32_t)~0x700;
-
-	// set delivery vector
-	low &= (uint32_t)~0xff;
-	low |= vector;
-
-	ioapic_write((uint8_t)low_index, low);
-}
 
 void parse_madt()
 {
@@ -101,8 +29,10 @@ void parse_madt()
 			struct MADT_cpu_local_apic* cpu = (struct MADT_cpu_local_apic*)kalloc(sizeof(struct MADT_cpu_local_apic));
 			memcpy(cpu, (uint64_t*)((uint64_t)madt_addr + (uint64_t)curr_size), sizeof(struct MADT_cpu_local_apic));
 
-			cpu_apic_ids[numcores] = cpu->apic_id;
-			numcores++;
+			if (cpu->flags & 0x1) {
+				cpu_apic_ids[numcores] = cpu->apic_id;
+				numcores++;
+			}
 
 			// printf("found cpu: acpi_id: 0x%x, apic_id: 0x%x, flags: 0x%x\n", cpu->acpi_id, cpu->apic_id, cpu->flags);
 			kfree(cpu);
@@ -149,65 +79,4 @@ void parse_madt()
 		curr_size += len;
 	}
 	kfree(madt);
-
-	init_mutex(&cnt_lock);
-
-	uint8_t bspid = curr_cpu_apic_id();
-	uint8_t* bspdone = (uint8_t*)0x3000100;
-	uint8_t* aprunning = (uint8_t*)0x3000200;
-	*bspdone = 0;
-	*aprunning = 0;
-
-
-	map_addr(lapic_addr, lapic_addr, FLAG_PRESENT);
-	map_addr(ioapic_addr, ioapic_addr, FLAG_PRESENT);
-	// irq is 2 because of gsi remap
-	ioapic_set_irq(0x2, bspid, 0x20); // timer
-	ioapic_set_irq(0x1, bspid, 0x21); // keyboard
-	__asm__ volatile ("sti;");
-
-	for(size_t i = 0; i < numcores; i++) {
-		// do not start BSP, that's already running this code
-		if(cpu_apic_ids[i] == bspid)
-			continue;
-
-		printf("initializing cpu with apic id 0x%x\n", cpu_apic_ids[i]);
-		// send INIT IPI
-
-		// clear APIC errors
-		*((volatile uint32_t*)(lapic_addr + 0x280)) = 0;
-		// select AP
-		*((volatile uint32_t*)(lapic_addr + 0x310)) = (*((volatile uint32_t*)(lapic_addr + 0x310)) & 0x00ffffff) | ((uint32_t)cpu_apic_ids[i] << 24);
-		// trigger INIT IPI
-		*((volatile uint32_t*)(lapic_addr + 0x300)) = (*((volatile uint32_t*)(lapic_addr + 0x300)) & 0xfff00000) | 0x00C500;
-		// wait for delivery
-		do { __asm__ __volatile__ ("pause" : : : "memory"); }while(*((volatile uint32_t*)(uint64_t)(lapic_addr + 0x300)) & (1 << 12));
-		// select AP
-		*((volatile uint32_t*)(lapic_addr + 0x310)) = (*((volatile uint32_t*)(lapic_addr + 0x310)) & 0x00ffffff) | ((uint32_t)cpu_apic_ids[i] << 24);
-		// deassert
-		*((volatile uint32_t*)(lapic_addr + 0x300)) = (*((volatile uint32_t*)(lapic_addr + 0x300)) & 0xfff00000) | 0x008500;
-		// wait for delivery
-		do { __asm__ __volatile__ ("pause" : : : "memory"); }while(*((volatile uint32_t*)(uint64_t)(lapic_addr + 0x300)) & (1 << 12));
-		// wait 10 msec
-		wait(10);
-
-		// send STARTUP IPI (twice)
-
-		for(size_t j = 0; j < 2; j++) {
-			// clear APIC errors
-			*((volatile uint32_t*)(lapic_addr + 0x280)) = 0;
-			// select AP
-			*((volatile uint32_t*)(lapic_addr + 0x310)) = (*((volatile uint32_t*)(lapic_addr + 0x310)) & 0x00ffffff) | ((uint32_t)cpu_apic_ids[i] << 24);
-			// trigger STARTUP IPI for 0800:0000
-			*((volatile uint32_t*)(lapic_addr + 0x300)) = (*((volatile uint32_t*)(lapic_addr + 0x300)) & 0xfff0f800) | 0x000608;
-			// wait 200 usec
-			wait(1);
-			// wait for delivery
-			do { __asm__ __volatile__ ("pause" : : : "memory"); }while(*((volatile uint32_t*)(uint64_t)(lapic_addr + 0x300)) & (1 << 12));
-		}
-	}
-	*bspdone = 1;
-	wait(100);
-	printf("aprunning: %d\n", *aprunning);
-	printf("cnt: %d\n", cnt);
 }