Fennix/Kernel/Core/InterruptsManager.cpp

#include <ints.hpp>

#include <syscalls.hpp>
#include <vector.hpp>
#include <smp.hpp>
#include <io.h>

#if defined(a64)
#include "../Architecture/amd64/cpu/gdt.hpp"
#include "../Architecture/amd64/cpu/idt.hpp"
#include "../Architecture/amd64/acpi.hpp"
#include "../Architecture/amd64/cpu/apic.hpp"
#elif defined(a32)
#include "../Architecture/i686/cpu/gdt.hpp"
#include "../Architecture/i686/cpu/idt.hpp"
#elif defined(aa64)
#endif

#include "crashhandler.hpp"
#include "../kernel.h"

extern "C" SafeFunction void ExceptionHandler(void *Data) { CrashHandler::Handle(Data); }

namespace Interrupts
{
    struct Event
    {
        int ID;
        void *Data;
    };
    Vector<Event> RegisteredEvents;

#if defined(a64)
    /* APIC::APIC */ void *apic[MAX_CPU];
    /* APIC::Timer */ void *apicTimer[MAX_CPU];
#elif defined(a32)
    /* APIC::APIC */ void *apic[MAX_CPU];
#elif defined(aa64)
#endif
    void *InterruptFrames[INT_FRAMES_MAX];

    void Initialize(int Core)
    {
#if defined(a64)
        GlobalDescriptorTable::Init(Core);
        InterruptDescriptorTable::Init(Core);
        CPUData *CoreData = GetCPU(Core);
        CoreData->Checksum = CPU_DATA_CHECKSUM;
        CPU::x64::wrmsr(CPU::x64::MSR_GS_BASE, (uint64_t)CoreData);
        CPU::x64::wrmsr(CPU::x64::MSR_SHADOW_GS_BASE, (uint64_t)CoreData);
        CoreData->ID = Core;
        CoreData->IsActive = true;
        CoreData->SystemCallStack = (uint8_t *)((uintptr_t)KernelAllocator.RequestPages(TO_PAGES(STACK_SIZE)) + STACK_SIZE);
        CoreData->Stack = (uintptr_t)KernelAllocator.RequestPages(TO_PAGES(STACK_SIZE)) + STACK_SIZE;
        if (CoreData->Checksum != CPU_DATA_CHECKSUM)
        {
            KPrint("CPU %d checksum mismatch! %x != %x", Core, CoreData->Checksum, CPU_DATA_CHECKSUM);
            CPU::Stop();
        }
        debug("Stack for core %d is %#lx (Address: %#lx)", Core, CoreData->Stack, CoreData->Stack - STACK_SIZE);
        asmv("movq %0, %%rsp" ::"r"(CoreData->Stack));
        InitializeSystemCalls();
#elif defined(a32)
        warn("i386 is not supported yet");
#elif defined(aa64)
        warn("aarch64 is not supported yet");
#endif
    }

    void Enable(int Core)
    {
#if defined(a64)
        if (((ACPI::MADT *)PowerManager->GetMADT())->LAPICAddress != nullptr)
        {
            // TODO: This function is called by SMP too. Do not initialize timers that doesn't support multiple cores.
            apic[Core] = new APIC::APIC(Core);
            if (Core == Config.IOAPICInterruptCore) // Redirect IRQs to the specified core.
                ((APIC::APIC *)apic[Core])->RedirectIRQs(Core);
        }
        else
        {
            error("LAPIC not found");
            // TODO: PIC
        }
#elif defined(a32)
        warn("i386 is not supported yet");
#elif defined(aa64)
        warn("aarch64 is not supported yet");
#endif
    }

    void InitializeTimer(int Core)
    {
        // TODO: This function is called by SMP too. Do not initialize timers that doesn't support multiple cores.
#if defined(a64)
        if (apic[Core] != nullptr)
            apicTimer[Core] = new APIC::Timer((APIC::APIC *)apic[Core]);
        else
        {
            fixme("apic not found");
        }
#elif defined(a32)
        warn("i386 is not supported yet");
#elif defined(aa64)
        warn("aarch64 is not supported yet");
#endif
    }

    SafeFunction void RemoveAll()
    {
        RegisteredEvents.clear();
    }

    extern "C" SafeFunction void MainInterruptHandler(void *Data)
    {
#if defined(a64)
        CPU::x64::TrapFrame *Frame = (CPU::x64::TrapFrame *)Data;

        memmove(InterruptFrames + 1, InterruptFrames, sizeof(InterruptFrames) - sizeof(InterruptFrames[0]));
        InterruptFrames[0] = (void *)Frame->rip;

        CPUData *CoreData = GetCurrentCPU();
        int Core = 0;
        if (likely(CoreData != nullptr))
            Core = CoreData->ID;

        /* If this is false, we have a big problem. */
        if (likely(Frame->InterruptNumber < CPU::x86::IRQ223 && Frame->InterruptNumber > CPU::x86::ISR0))
        {
            /* Halt core interrupt */
            if (unlikely(Frame->InterruptNumber == CPU::x86::IRQ29))
                CPU::Stop();

            bool InterruptHandled = false;
            foreach (auto ev in RegisteredEvents)
            {
                if (ev.ID == static_cast<int>(Frame->InterruptNumber))
                {
                    ((Handler *)ev.Data)->OnInterruptReceived(Frame);
                    InterruptHandled = true;
                }
            }

            if (!InterruptHandled)
            {
                error("IRQ%ld is unhandled on CPU %d.", Frame->InterruptNumber - 32, Core);
                if (Frame->InterruptNumber == CPU::x86::IRQ1)
                {
                    uint8_t scancode = inb(0x60);
                    warn("IRQ1 is the keyboard interrupt. Scancode: %#x", scancode);
                }
            }

            if (likely(apic[Core]))
            {
                ((APIC::APIC *)Interrupts::apic[Core])->EOI();
                // TODO: Handle PIC too
                return;
            }
            // TODO: PIC
        }
#elif defined(a32)
        void *Frame = Data;
#elif defined(aa64)
        void *Frame = Data;
#endif
        error("HALT HALT HALT HALT HALT HALT HALT HALT HALT");
        CPU::Stop();
    }

    Handler::Handler(int InterruptNumber)
    {
        foreach (auto ev in RegisteredEvents)
        {
            if (ev.ID == InterruptNumber)
            {
                warn("IRQ%d is already registered.", InterruptNumber - 32);
            }
        }

        debug("Registering interrupt handler for IRQ%d.", InterruptNumber - 32);
        this->InterruptNumber = InterruptNumber;
        RegisteredEvents.push_back({InterruptNumber, this});
    }

    Handler::~Handler()
    {
        debug("Unregistering interrupt handler for IRQ%d.", InterruptNumber - 32);
        for (size_t i = 0; i < RegisteredEvents.size(); i++)
        {
            if (RegisteredEvents[i].ID == InterruptNumber)
            {
                RegisteredEvents.remove(i);
                return;
            }
        }
        warn("Event %d not found.", InterruptNumber);
    }

#if defined(a64)
    void Handler::OnInterruptReceived(CPU::x64::TrapFrame *Frame)
    {
        trace("Unhandled interrupt IRQ%d", Frame->InterruptNumber - 32);
#elif defined(a32)
    void Handler::OnInterruptReceived(CPU::x32::TrapFrame *Frame)
    {
        trace("Unhandled interrupt received");
#elif defined(aa64)
    void Handler::OnInterruptReceived(void *Frame)
    {
        trace("Unhandled interrupt received");
#endif
    }
}