banan-os/kernel/arch/i386/Paging.cpp

95 lines
2.1 KiB
C++
Raw Normal View History

#include <kernel/CPUID.h>
2022-12-28 04:17:06 +02:00
#include <kernel/Paging.h>
#include <kernel/panic.h>
#include <string.h>
#define PRESENT (1 << 0)
#define READ_WRITE (1 << 1)
#define PAGE_SIZE (1 << 7)
2022-12-28 04:17:06 +02:00
namespace Paging
{
static uint64_t s_page_directory_pointer_table[4] __attribute__((aligned(0x20)));
static uint64_t s_page_directory[4 * 512] __attribute__((aligned(4096)));
static bool HasRequirements()
{
uint32_t ecx, edx;
CPUID::GetFeatures(ecx, edx);
if (!(edx & CPUID::Features::EDX_PAE))
{
derrorln("PAE not supported, halting");
return false;
}
return true;
}
2022-12-28 04:17:06 +02:00
void Initialize()
{
if (!HasRequirements())
asm volatile("hlt");
// Identity map first 2 (2 MiB) pages
memset(s_page_directory, 0x00, sizeof(s_page_directory));
s_page_directory[0] = (0x00 << 21) | PAGE_SIZE | READ_WRITE | PRESENT;
s_page_directory[1] = (0x01 << 21) | PAGE_SIZE | READ_WRITE | PRESENT;
2022-12-28 04:17:06 +02:00
// Initialize PDPTEs
for (int i = 0; i < 4; i++)
s_page_directory_pointer_table[i] = (uint64_t)(&s_page_directory[512 * i]) | PRESENT;
2022-12-28 04:17:06 +02:00
asm volatile(
// Enable PAE
"movl %%cr4, %%eax;"
"orl $0x20, %%eax;"
"movl %%eax, %%cr4;"
// Load PDPT address to cr3
"movl %0, %%cr3;"
// Enable paging
2022-12-28 04:17:06 +02:00
"movl %%cr0, %%eax;"
"orl $0x80000000, %%eax;"
2022-12-28 04:17:06 +02:00
"movl %%eax, %%cr0;"
:: "r" (s_page_directory_pointer_table)
: "eax"
2022-12-28 04:17:06 +02:00
);
dprintln("Paging enabled");
2022-12-28 04:17:06 +02:00
}
void MapPage(uintptr_t address)
2022-12-28 04:17:06 +02:00
{
if (address != ((address >> 21) << 21))
2022-12-28 04:17:06 +02:00
{
dprintln("aligning 0x{8H} to 2 MiB boundary -> 0x{8H}", address, (address >> 21) << 21);
address = (address >> 21) << 21;
2022-12-28 04:17:06 +02:00
}
uint32_t pde = address >> 21;
2022-12-28 04:17:06 +02:00
dprintln("mapping pde {} (0x{8H} - 0x{8H})", pde, pde << 21, ((pde + 1) << 21) - 1);
2022-12-28 04:17:06 +02:00
if (s_page_directory[pde] & PRESENT)
{
dprintln("page already mapped");
return;
}
// Map and flush the given address
s_page_directory[pde] = address | PAGE_SIZE | READ_WRITE | PRESENT;
asm volatile("invlpg (%0)" :: "r"(address) : "memory");
2022-12-28 04:17:06 +02:00
}
void MapPages(uintptr_t address, size_t size)
{
address = (address >> 21) << 21;
for (size_t offset = 0; offset < size; offset += 1 << 21)
MapPage(address + offset);
}
2022-12-28 04:17:06 +02:00
}