fix: start frame allocator after kernel code
This commit is contained in:
@ -30,7 +30,8 @@ void *alloc_frame(void)
|
||||
int free_frame(void *frame_ptr)
|
||||
{
|
||||
struct frame_zone *it = head;
|
||||
while (it && (frame_ptr < it->addr || frame_ptr >= it->addr + it->len))
|
||||
while (it && (frame_ptr < it->addr ||
|
||||
frame_ptr >= it->addr + it->total_frames * PAGE_SIZE))
|
||||
it = it->next;
|
||||
|
||||
uint32_t index = ((frame_ptr - it->addr) / PAGE_SIZE);
|
||||
|
@ -45,11 +45,37 @@ static void init_multiboot(multiboot_info_t *mbd, uint32_t magic)
|
||||
mmap_length = mbd_virt->mmap_length / sizeof(multiboot_memory_map_t);
|
||||
}
|
||||
|
||||
static void lst_add_back(struct frame_zone **root, struct frame_zone *element)
|
||||
{
|
||||
if (!*root) {
|
||||
*root = element;
|
||||
return;
|
||||
}
|
||||
struct frame_zone *it = *root;
|
||||
while (it->next)
|
||||
it = it->next;
|
||||
it->next = element;
|
||||
}
|
||||
|
||||
static void add_frame_node(multiboot_memory_map_t *mmmt)
|
||||
{
|
||||
static uint32_t index;
|
||||
void *zone = (void *)mmmt->addr;
|
||||
|
||||
// Kernel code on the block
|
||||
if (HEAP_START >= zone + mmmt->len)
|
||||
return;
|
||||
|
||||
// KERNEL code partially on the block
|
||||
if (HEAP_START >= zone) {
|
||||
const uint32_t len = mmmt->len -
|
||||
((uint64_t)&_kernel_end - HEAP_END) -
|
||||
(uint64_t)zone;
|
||||
mmmt->len = CEIL(len, PAGE_SIZE) * PAGE_SIZE;
|
||||
zone =
|
||||
(void *)((uint32_t)CEIL(HEAP_START, PAGE_SIZE) * PAGE_SIZE);
|
||||
}
|
||||
|
||||
init_page_table(frame_zones_page_table, 0);
|
||||
page_directory[1022] =
|
||||
((uint32_t)frame_zones_page_table - HEAP_END) | 0x03;
|
||||
@ -59,32 +85,29 @@ static void add_frame_node(multiboot_memory_map_t *mmmt)
|
||||
struct frame_zone *current =
|
||||
(struct frame_zone *)GET_PAGE_ADDR(1022, index++);
|
||||
|
||||
current->frame_table = (uint32_t *)current + sizeof(struct frame_zone);
|
||||
current->len = mmmt->len;
|
||||
// 32 is cause we are using uint32_t
|
||||
current->size = (mmmt->len - (sizeof(struct frame_zone) +
|
||||
(mmmt->len / PAGE_SIZE) / 32));
|
||||
current->remaining_frames = current->size / PAGE_SIZE;
|
||||
current->frame_table = (uint8_t *)current + sizeof(struct frame_zone);
|
||||
|
||||
/** 8 is cause we are using uint8_t
|
||||
nb_frame = size / (PAGE_SIZE + 1 / 8)
|
||||
cause we are using non decimal number
|
||||
nb_frame = ((size * 8) / (PAGE_SIZE * 8 + 1)) / 8
|
||||
*/
|
||||
const uint32_t nb_frame = ((mmmt->len * 8) / (PAGE_SIZE * 8 + 1)) - 1;
|
||||
|
||||
current->first_free_frame = 0;
|
||||
current->next = NULL;
|
||||
current->remaining_frames = nb_frame;
|
||||
current->total_frames = nb_frame;
|
||||
|
||||
const size_t frame_table_size = current->size / (PAGE_SIZE * 32);
|
||||
memset(current->frame_table, 0, frame_table_size * 4);
|
||||
memset(current->frame_table, 0, nb_frame * 4);
|
||||
|
||||
uint32_t i = index;
|
||||
for (; index - i < CEIL(frame_table_size, PAGE_SIZE); index++)
|
||||
frame_zones_page_table[index] =
|
||||
((uint32_t)zone + PAGE_SIZE & PAGE_MASK) | INIT_FLAGS;
|
||||
current->addr = (void *)mmmt->addr + index * PAGE_SIZE;
|
||||
|
||||
if (!head) {
|
||||
head = current;
|
||||
return;
|
||||
}
|
||||
struct frame_zone *it = head;
|
||||
while (it->next)
|
||||
it = it->next;
|
||||
it->next = current;
|
||||
uint32_t i = 1;
|
||||
for (; i < CEIL(nb_frame, PAGE_SIZE); i++)
|
||||
frame_zones_page_table[index + i] =
|
||||
((uint32_t)zone + i * PAGE_SIZE & PAGE_MASK) | INIT_FLAGS;
|
||||
current->addr = zone + i * PAGE_SIZE;
|
||||
index += i - 1;
|
||||
lst_add_back(&head, current);
|
||||
}
|
||||
|
||||
static void init_frame_zones(void)
|
||||
|
Reference in New Issue
Block a user