int
kern_setup_image(void)
{
unsigned long i, j;
paddr_t kern_pa_start, kern_pa_end;
printk("\tSetting up initial page directory.\n");
kern_pa_start = round_to_pgd_page(chal_va2pa(mem_kern_start())); /* likely 0 */
kern_pa_end = chal_va2pa(mem_kmem_end());
/* ASSUMPTION: The static layout of boot_comp_pgd is identical to a pgd post-pgtbl_alloc */
/* FIXME: should use pgtbl_extend instead of directly accessing the pgd array... */
for (i = kern_pa_start, j = COS_MEM_KERN_START_VA/PGD_RANGE ;
i < (unsigned long)round_up_to_pgd_page(kern_pa_end) ;
i += PGD_RANGE, j++) {
assert(j != KERN_INIT_PGD_IDX ||
((boot_comp_pgd[j] | PGTBL_GLOBAL) & ~(PGTBL_MODIFIED | PGTBL_ACCESSED)) ==
(i | PGTBL_PRESENT | PGTBL_WRITABLE | PGTBL_SUPER | PGTBL_GLOBAL));
boot_comp_pgd[j] = i | PGTBL_PRESENT | PGTBL_WRITABLE | PGTBL_SUPER | PGTBL_GLOBAL;
boot_comp_pgd[i/PGD_RANGE] = 0; /* unmap lower addresses */
}
/* FIXME: Ugly hack to get the physical page with the ACPI RSDT mapped */
printk("ACPI initialization\n");
void *rsdt = acpi_find_rsdt();
if (rsdt) {
u32_t page = round_up_to_pgd_page(rsdt) - (1 << 22);
boot_comp_pgd[j] = page | PGTBL_PRESENT | PGTBL_WRITABLE | PGTBL_SUPER | PGTBL_GLOBAL;
acpi_set_rsdt_page(j);
j++;
u64_t hpet = timer_find_hpet(acpi_find_timer());
if (hpet) {
page = round_up_to_pgd_page(hpet & 0xffffffff) - (1 << 22);
boot_comp_pgd[j] = page | PGTBL_PRESENT | PGTBL_WRITABLE | PGTBL_SUPER | PGTBL_GLOBAL;
timer_set_hpet_page(j);
j++;
}
}
for ( ; j < PAGE_SIZE/sizeof(unsigned int) ; i += PGD_RANGE, j++) {
boot_comp_pgd[j] = boot_comp_pgd[i/PGD_RANGE] = 0;
}
chal_cpu_init();
chal_cpu_pgtbl_activate((pgtbl_t)chal_va2pa(boot_comp_pgd));
kern_retype_initial();
return 0;
}
void
kern_retype_initial(void)
{
u8_t *k;
assert((int)mem_bootc_start() % RETYPE_MEM_NPAGES == 0);
assert((int)mem_bootc_end() % RETYPE_MEM_NPAGES == 0);
for (k = mem_bootc_start() ; k < mem_bootc_end() ; k += PAGE_SIZE * RETYPE_MEM_NPAGES) {
if (retypetbl_retype2user((void*)(chal_va2pa(k)))) assert(0);
}
}
/* allocate and link in a page middle directory */
int
chal_pgtbl_add_middledir(paddr_t pt, unsigned long vaddr)
{
pgd_t *pgd = ((pgd_t *)chal_pa2va((void*)pt)) + pgd_index(vaddr);
unsigned long *page;
page = chal_alloc_page(); /* zeroed */
if (!page) return -1;
pgd->pgd = (unsigned long)chal_va2pa(page) | _PAGE_PRESENT | _PAGE_RW | _PAGE_USER | _PAGE_ACCESSED;
return 0;
}
u8_t *
mem_boot_alloc(int npages) /* boot-time, bump-ptr heap */
{
u8_t *r = glb_memlayout.kern_boot_heap;
unsigned long i;
assert(glb_memlayout.allocs_avail);
glb_memlayout.kern_boot_heap += npages * (PAGE_SIZE/sizeof(u8_t));
assert(glb_memlayout.kern_boot_heap <= mem_kmem_end());
for (i = (unsigned long)r ; i < (unsigned long)glb_memlayout.kern_boot_heap ; i += PAGE_SIZE) {
if ((unsigned long)i % RETYPE_MEM_NPAGES == 0) {
if (retypetbl_retype2kern((void*)chal_va2pa((void*)i))) {
die("Retyping to kernel on boot-time heap allocation failed @ 0x%x.\n", i);
}
}
}
memset((void *)r, 0, npages * (PAGE_SIZE/sizeof(u8_t)));
return r;
}
unsigned int *
pgtbl_module_to_vaddr(unsigned long addr)
{
return (unsigned int *)chal_pgtbl_vaddr2kaddr((paddr_t)chal_va2pa(current->mm->pgd), addr);
}
