1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
|
#include "paging.h"
#include <bitset.h>
#include <stdlib.h>
#include <core/monitor.h>
#include "mem.h"
#include <core/sys.h>
static struct bitset frames;
struct page_directory *kernel_pagedir, *current_pagedir;
/* ACCESSOR FUNCTIONS FOR STATIC BITSET */
uint32_t frame_alloc() {
uint32_t free = bitset_firstFree(&frames);
bitset_set(&frames, free);
return free;
}
void frame_free(uint32_t id) {
bitset_clear(&frames, id);
}
void paging_init(size_t totalRam) {
uint32_t i;
frames.size = totalRam / 0x1000;
frames.bits = kmalloc(INDEX_FROM_BIT(frames.size));
kernel_pagedir = kmalloc(sizeof(struct page_directory));
kernel_pagedir->tablesPhysical = kmalloc_page(&kernel_pagedir->physicalAddr);
for (i = 0; i < 1024; i++) {
kernel_pagedir->tables[i] = 0;
kernel_pagedir->tablesPhysical[i] = 0;
}
for (i = 0xE0000000; i < mem_placementAddr; i += 0x1000) {
page_map(pagedir_getPage(kernel_pagedir, i, 1), frame_alloc(), 0, 0);
}
for (i = 0; i < (mem_placementAddr - 0xE0000000) / 0x100000; i++) {
kernel_pagedir->tablesPhysical[i] = kernel_pagedir->tablesPhysical[i + 896];
kernel_pagedir->tables[i] = kernel_pagedir->tables[i + 896];
}
monitor_write("Page dir is at: ");
monitor_writeHex(kernel_pagedir->physicalAddr);
pagedir_switch(kernel_pagedir);
monitor_write("\nPaging started\n");
}
void paging_cleanup() {
uint32_t i;
for (i = 0; i < (mem_placementAddr - 0xE0000000) / 0x100000; i++) {
kernel_pagedir->tablesPhysical[i] = 9;
kernel_pagedir->tables[i] = 0;
}
monitor_write("Pages cleaned up\n");
}
void pagedir_switch(struct page_directory *pd) {
current_pagedir = pd;
asm volatile("mov %0, %%cr3" : : "r"(pd->physicalAddr));
uint32_t cr0;
asm volatile("mov %%cr0, %0" : "=r"(cr0));
cr0 |= 0x80000000;
asm volatile("mov %0, %%cr0" : : "r"(cr0));
}
uint32_t paging_fault(struct registers *regs) {
size_t addr;
asm volatile("mov %%cr2, %0" : "=r"(addr));
monitor_write("PageFault ");
if (regs->err_code & 0x1) monitor_write("present ");
if (regs->err_code & 0x2) monitor_write("write ");
if (regs->err_code & 0x4) monitor_write("user ");
if (regs->err_code & 0x8) monitor_write("rsvd ");
if (regs->err_code & 0x10) monitor_write("instructionfetch ");
monitor_write("@"); monitor_writeHex(addr); monitor_write("\n");
PANIC("Page fault");
return 0;
}
struct page *pagedir_getPage(struct page_directory *pd, uint32_t address, int make) {
address /= 0x1000;
uint32_t table_idx = address / 1024;
if (pd->tables[table_idx]) {
return &pd->tables[table_idx]->pages[address % 1024];
} else if (make) {
pd->tables[table_idx] = kmalloc_page(pd->tablesPhysical + table_idx);
memset((uint8_t*)pd->tables[table_idx], 0, 0x1000);
pd->tablesPhysical[table_idx] |= 0x07;
return &pd->tables[table_idx]->pages[address % 1024];
} else {
return 0;
}
}
void page_map(struct page *page, uint32_t frame, uint32_t user, uint32_t rw) {
if (page != 0 && page->frame == 0 && page->present == 0) {
page->present = 1;
page->rw = (rw ? 1 : 0);
page->user = (user ? 1 : 0);
page->frame = frame;
}
}
void page_unmap(struct page *page) {
if (page != 0) {
page->frame = 0;
page->present = 0;
}
}
void page_unmapFree(struct page *page) {
if (page != 0) {
if (page->frame != 0) frame_free(page->frame);
page->frame = 0;
page->present = 0;
}
}
|
