|
| 1 | +// paging.c |
| 2 | +#include "paging.h" |
| 3 | +#include "../kklibc/kklibc.h" |
| 4 | +#include "isr.h" |
| 5 | +#include "../drivers/screen.h" |
| 6 | + |
| 7 | +// Текущий каталог страниц |
| 8 | +page_directory_t *current_directory = NULL; |
| 9 | + |
| 10 | +// Внешние функции из assembly |
| 11 | +extern void load_page_directory(u32); |
| 12 | +extern void enable_paging(); |
| 13 | + |
| 14 | +// Инициализация paging |
| 15 | +void paging_init() { |
| 16 | + kprint("Initializing paging...\n"); |
| 17 | + |
| 18 | + // Создаем каталог страниц |
| 19 | + current_directory = (page_directory_t*)kmalloc_a(sizeof(page_directory_t)); |
| 20 | + memory_set((u8*)current_directory, 0, sizeof(page_directory_t)); |
| 21 | + |
| 22 | + // Создаем таблицы страниц для идентичного отображения первых 4MB |
| 23 | + for (u32 i = 0; i < 1024; i++) { |
| 24 | + // Каждая запись каталога указывает на таблицу страниц |
| 25 | + page_table_t *table = (page_table_t*)kmalloc_a(sizeof(page_table_t)); |
| 26 | + memory_set((u8*)table, 0, sizeof(page_table_t)); |
| 27 | + |
| 28 | + // Заполняем таблицу страниц |
| 29 | + for (u32 j = 0; j < 1024; j++) { |
| 30 | + u32 frame = (i * 1024 + j) * PAGE_SIZE; |
| 31 | + table->entries[j].present = 1; |
| 32 | + table->entries[j].rw = 1; |
| 33 | + table->entries[j].frame = frame >> 12; |
| 34 | + } |
| 35 | + |
| 36 | + // Устанавливаем запись в каталоге страниц |
| 37 | + current_directory->entries[i].present = 1; |
| 38 | + current_directory->entries[i].rw = 1; |
| 39 | + current_directory->entries[i].frame = ((u32)table) >> 12; |
| 40 | + } |
| 41 | + |
| 42 | + // Переключаемся на новый каталог страниц |
| 43 | + switch_page_directory(current_directory); |
| 44 | + |
| 45 | + // Включаем paging |
| 46 | + enable_paging(); |
| 47 | + |
| 48 | + kprint("Paging enabled\n"); |
| 49 | +} |
| 50 | + |
| 51 | +// Переключение каталога страниц |
| 52 | +void switch_page_directory(page_directory_t *dir) { |
| 53 | + current_directory = dir; |
| 54 | + load_page_directory((u32)dir); |
| 55 | +} |
| 56 | + |
| 57 | +// Получение текущего каталога страниц |
| 58 | +page_directory_t *get_current_page_directory() { |
| 59 | + return current_directory; |
| 60 | +} |
| 61 | + |
| 62 | +// Отображение виртуальной страницы на физическую |
| 63 | +void map_page(void *virtual_addr, void *physical_addr, u32 flags) { |
| 64 | + u32 virtual = (u32)virtual_addr; |
| 65 | + u32 physical = (u32)physical_addr; |
| 66 | + |
| 67 | + u32 pd_index = PAGE_DIRECTORY_INDEX(virtual); |
| 68 | + u32 pt_index = PAGE_TABLE_INDEX(virtual); |
| 69 | + |
| 70 | + // Получаем таблицу страниц |
| 71 | + page_table_t *table = (page_table_t*)(current_directory->entries[pd_index].frame << 12); |
| 72 | + |
| 73 | + // Устанавливаем запись в таблице страниц |
| 74 | + table->entries[pt_index].present = (flags & PAGE_PRESENT) ? 1 : 0; |
| 75 | + table->entries[pt_index].rw = (flags & PAGE_WRITABLE) ? 1 : 0; |
| 76 | + table->entries[pt_index].user = (flags & PAGE_USER) ? 1 : 0; |
| 77 | + table->entries[pt_index].frame = physical >> 12; |
| 78 | + |
| 79 | + // Инвалидируем TLB |
| 80 | + asm volatile("invlpg (%0)" : : "r" (virtual_addr)); |
| 81 | +} |
| 82 | + |
| 83 | +// Удаление отображения страницы |
| 84 | +void unmap_page(void *virtual_addr) { |
| 85 | + u32 virtual = (u32)virtual_addr; |
| 86 | + u32 pd_index = PAGE_DIRECTORY_INDEX(virtual); |
| 87 | + u32 pt_index = PAGE_TABLE_INDEX(virtual); |
| 88 | + |
| 89 | + // Получаем таблицу страниц |
| 90 | + page_table_t *table = (page_table_t*)(current_directory->entries[pd_index].frame << 12); |
| 91 | + |
| 92 | + // Очищаем запись |
| 93 | + table->entries[pt_index].present = 0; |
| 94 | + |
| 95 | + // Инвалидируем TLB |
| 96 | + asm volatile("invlpg (%0)" : : "r" (virtual_addr)); |
| 97 | +} |
| 98 | + |
| 99 | +// Получение физического адреса по виртуальному |
| 100 | +void *get_physical_address(void *virtual_addr) { |
| 101 | + u32 virtual = (u32)virtual_addr; |
| 102 | + u32 pd_index = PAGE_DIRECTORY_INDEX(virtual); |
| 103 | + u32 pt_index = PAGE_TABLE_INDEX(virtual); |
| 104 | + |
| 105 | + // Проверяем наличие страницы |
| 106 | + if (!current_directory->entries[pd_index].present) { |
| 107 | + return NULL; |
| 108 | + } |
| 109 | + |
| 110 | + // Получаем таблицу страниц |
| 111 | + page_table_t *table = (page_table_t*)(current_directory->entries[pd_index].frame << 12); |
| 112 | + |
| 113 | + // Проверяем наличие записи в таблице |
| 114 | + if (!table->entries[pt_index].present) { |
| 115 | + return NULL; |
| 116 | + } |
| 117 | + |
| 118 | + // Вычисляем физический адрес |
| 119 | + u32 physical = (table->entries[pt_index].frame << 12) + (virtual & 0xFFF); |
| 120 | + return (void*)physical; |
| 121 | +} |
| 122 | + |
| 123 | +// Обработчик page fault |
| 124 | +void page_fault_handler(registers_t regs) { |
| 125 | + u32 faulting_address; |
| 126 | + asm volatile("mov %%cr2, %0" : "=r" (faulting_address)); |
| 127 | + |
| 128 | + // Проверяем причину page fault |
| 129 | + int present = regs.err_code & 0x1; |
| 130 | + int rw = regs.err_code & 0x2; |
| 131 | + int user = regs.err_code & 0x4; |
| 132 | + int reserved = regs.err_code & 0x8; |
| 133 | + int id = regs.err_code & 0x10; |
| 134 | + |
| 135 | + kprintf("Page fault at 0x%x, caused by ", faulting_address); |
| 136 | + |
| 137 | + if (present) { |
| 138 | + kprint("page protection violation"); |
| 139 | + } else { |
| 140 | + kprint("non-present page"); |
| 141 | + } |
| 142 | + |
| 143 | + if (rw) { |
| 144 | + kprint(" write attempt"); |
| 145 | + } else { |
| 146 | + kprint(" read attempt"); |
| 147 | + } |
| 148 | + |
| 149 | + if (user) { |
| 150 | + kprint(" in user mode"); |
| 151 | + } else { |
| 152 | + kprint(" in kernel mode"); |
| 153 | + } |
| 154 | + |
| 155 | + kprint("\n"); |
| 156 | + |
| 157 | + // Зависаем систему при page fault в ядре |
| 158 | + asm volatile("hlt"); |
| 159 | +} |
0 commit comments