#include "arch/MMU.h"
#include "memory/MemoryManager.h"
#include <luna/CString.h>
#include <luna/Result.h>
#include <luna/SystemError.h>

#pragma GCC push_options
#pragma GCC diagnostic ignored "-Wconversion"

void PageTableEntry::set_address(u64 addr)
{
    this->address = (addr >> 12);
}

u64 PageTableEntry::get_address() const
{
    return (u64)this->address << 12;
}

#pragma GCC pop_options

void PageTableEntry::clear()
{
    raw = 0;
}

static bool has_flag(int flags, MMU::Flags flag)
{
    return flags & flag;
}

namespace MMU
{

    constexpr PageDirectory* l4_table()
    {
        constexpr u64 l4 = sign | (rindex << 39) | (rindex << 30) | (rindex << 21) | (rindex << 12);
        return (PageDirectory*)l4;
    }

    constexpr u64 l4_index(u64 addr)
    {
        return (addr >> 39) & 0777;
    }

    PageTableEntry& l4_entry(u64 addr)
    {
        return l4_table()->entries[l4_index(addr)];
    }

    constexpr PageDirectory* l3_table(u64 addr)
    {
        const u64 l4 = l4_index(addr);
        const u64 l3 = sign | (rindex << 39) | (rindex << 30) | (rindex << 21) | (l4 << 12);
        return (PageDirectory*)l3;
    }

    constexpr u64 l3_index(u64 addr)
    {
        return (addr >> 30) & 0777;
    }

    PageTableEntry& l3_entry(u64 addr)
    {
        return l3_table(addr)->entries[l3_index(addr)];
    }

    constexpr PageDirectory* l2_table(u64 addr)
    {
        const u64 l4 = l4_index(addr);
        const u64 l3 = l3_index(addr);
        const u64 l2 = sign | (rindex << 39) | (rindex << 30) | (l4 << 21) | (l3 << 12);
        return (PageDirectory*)l2;
    }

    constexpr u64 l2_index(u64 addr)
    {
        return (addr >> 21) & 0777;
    }

    PageTableEntry& l2_entry(u64 addr)
    {
        return l2_table(addr)->entries[l2_index(addr)];
    }

    constexpr PageDirectory* l1_table(u64 addr)
    {
        const u64 l4 = l4_index(addr);
        const u64 l3 = l3_index(addr);
        const u64 l2 = l2_index(addr);
        const u64 l1 = sign | (rindex << 39) | (l4 << 30) | (l3 << 21) | (l2 << 12);
        return (PageDirectory*)l1;
    }

    constexpr u64 l1_index(u64 addr)
    {
        return (addr >> 12) & 0777;
    }

    PageTableEntry& l1_entry(u64 addr)
    {
        return l1_table(addr)->entries[l1_index(addr)];
    }

    void switch_page_directory(PageDirectory* dir)
    {
        asm volatile("mov %0, %%cr3" : : "r"(dir));
    }

    PageDirectory* get_page_directory()
    {
        PageDirectory* value;
        asm volatile("mov %%cr3, %0" : "=r"(value));
        return value;
    }

    void flush_all()
    {
        switch_page_directory(get_page_directory());
    }

    void flush_page(u64 page)
    {
        asm volatile("invlpg (%0)" : : "r"(page) : "memory");
    }

    int arch_flags_to_mmu(const PageTableEntry& entry)
    {
        int result = Flags::None;
        if (entry.read_write) result |= Flags::ReadWrite;
        if (entry.user) result |= Flags::User;
        if (entry.no_execute) result |= Flags::NoExecute;
        if (entry.write_through) result |= Flags::WriteThrough;
        if (entry.cache_disabled) result |= Flags::CacheDisable;
        return result;
    }

    Result<PageTableEntry*> find_entry(u64 virt)
    {
        const auto& l4 = l4_entry(virt);
        if (!l4.present) return err(EFAULT);
        auto& l3 = l3_entry(virt);
        if (!l3.present) return err(EFAULT);
        if (l3.larger_pages) return &l3;
        auto& l2 = l2_entry(virt);
        if (!l2.present) return err(EFAULT);
        if (l2.larger_pages) return &l2;
        return &l1_entry(virt);
    }

    Result<PageTableEntry*> apply_cascading_flags(u64 virt, int flags)
    {
        auto& l4 = l4_entry(virt);
        if (!l4.present) return err(EFAULT);
        if (flags & Flags::ReadWrite) l4.read_write = true;
        if (flags & Flags::User) l4.user = true;
        auto& l3 = l3_entry(virt);
        if (!l3.present) return err(EFAULT);
        if (l3.larger_pages) return &l3;
        if (flags & Flags::ReadWrite) l3.read_write = true;
        if (flags & Flags::User) l3.user = true;
        auto& l2 = l2_entry(virt);
        if (!l2.present) return err(EFAULT);
        if (l2.larger_pages) return &l2;
        if (flags & Flags::ReadWrite) l2.read_write = true;
        if (flags & Flags::User) l2.user = true;
        auto& l1 = l1_entry(virt);
        return &l1;
    }

    Result<void> map(u64 virt, u64 phys, int flags)
    {
        auto& l4 = l4_entry(virt);
        if (!l4.present)
        {
            u64 addr = TRY(MemoryManager::alloc_frame());
            l4.present = true;
            l4.set_address(addr);
            memset(l3_table(virt), 0, ARCH_PAGE_SIZE);
        }
        if (flags & Flags::ReadWrite) l4.read_write = true;
        if (flags & Flags::User) l4.user = true;

        auto& l3 = l3_entry(virt);
        if (!l3.present)
        {
            u64 addr = TRY(MemoryManager::alloc_frame());
            l3.present = true;
            l3.set_address(addr);
            memset(l2_table(virt), 0, ARCH_PAGE_SIZE);
        }
        if (flags & Flags::ReadWrite) l3.read_write = true;
        if (flags & Flags::User) l3.user = true;

        if (l3.larger_pages) return err(EFIXME); // FIXME: Replacing larger pages is not supported ATM

        auto& l2 = l2_entry(virt);
        if (!l2.present)
        {
            u64 addr = TRY(MemoryManager::alloc_frame());
            l2.present = true;
            l2.set_address(addr);
            memset(l1_table(virt), 0, ARCH_PAGE_SIZE);
        }
        if (flags & Flags::ReadWrite) l2.read_write = true;
        if (flags & Flags::User) l2.user = true;

        if (l2.larger_pages) return err(EFIXME); // FIXME: Replacing larger pages is not supported ATM

        auto& l1 = l1_entry(virt);
        if (l1.present) return err(EEXIST); // Please explicitly unmap the page before mapping it again.
        l1.present = true;
        l1.read_write = has_flag(flags, Flags::ReadWrite);
        l1.user = has_flag(flags, Flags::User);
        l1.write_through = has_flag(flags, Flags::WriteThrough);
        l1.cache_disabled = has_flag(flags, Flags::CacheDisable);
        l1.no_execute = has_flag(flags, Flags::NoExecute);
        l1.set_address(phys);
        return {};
    }

    Result<void> remap(u64 virt, int flags)
    {
        auto& l1 = *TRY(apply_cascading_flags(virt, flags));
        if (!l1.present) return err(EFAULT);
        l1.read_write = has_flag(flags, Flags::ReadWrite);
        l1.user = has_flag(flags, Flags::User);
        l1.write_through = has_flag(flags, Flags::WriteThrough);
        l1.cache_disabled = has_flag(flags, Flags::CacheDisable);
        l1.no_execute = has_flag(flags, Flags::NoExecute);
        flush_page(virt);
        return {};
    }

    Result<u64> unmap(u64 virt)
    {
        auto& l1 = *TRY(find_entry(virt));
        if (!l1.present) return err(EFAULT);
        const u64 address = l1.get_address();
        l1.clear();
        flush_page(virt);
        return address;
    }

    Result<u64> get_physical(u64 virt)
    {
        const auto& l1 = *TRY(find_entry(virt));
        if (!l1.present) return err(EFAULT);
        return l1.get_address();
    }

    Result<int> get_flags(u64 virt)
    {
        const auto& l1 = *TRY(find_entry(virt));
        if (!l1.present) return err(EFAULT);
        return arch_flags_to_mmu(l1);
    }

    void setup_initial_page_directory()
    {
        PageDirectory* const dir = get_page_directory();
        const u64 paddr = (u64)dir;
        PageTableEntry& recursive_entry = dir->entries[rindex];
        recursive_entry.read_write = true;
        recursive_entry.present = true;
        recursive_entry.set_address(paddr);
        flush_all();
    }
}