Mark
52 lines
1.6 KiB
C
52 lines
1.6 KiB
C
#include "arch/amd64/multiboot2.h"
|
|
#include "arch/amd64/cpu.h"
|
|
#include "arch/amd64/hw/vesa.h"
|
|
#include "sys/display.h"
|
|
#include "sys/debug.h"
|
|
#include "sys/mm.h"
|
|
|
|
static struct display display_vesa_fb = {0};
|
|
|
|
#define MSR_IA32_PAT 0x277
|
|
|
|
struct display *vesa_get_display(void) {
|
|
if (!display_vesa_fb.flags) {
|
|
// VESA framebuffer isn't found
|
|
return NULL;
|
|
} else {
|
|
return &display_vesa_fb;
|
|
}
|
|
}
|
|
|
|
void vesa_early_init(struct boot_video_info *info) {
|
|
if (info->width && info->height) {
|
|
// If these fields are set, framebuffer is available
|
|
display_vesa_fb.flags = DISP_GRAPHIC | DISP_LFB;
|
|
display_vesa_fb.width_pixels = info->width;
|
|
display_vesa_fb.height_pixels = info->height;
|
|
display_vesa_fb.pitch = info->pitch;
|
|
display_vesa_fb.bpp = info->bpp;
|
|
display_vesa_fb.framebuffer = MM_VIRTUALIZE(info->framebuffer_phys);
|
|
|
|
list_head_init(&display_vesa_fb.list);
|
|
}
|
|
}
|
|
|
|
// Initialize early (pre-PCI) framebuffer
|
|
void vesa_add_display(void) {
|
|
// XXX: This is ugly and needs to be rewritten
|
|
wrmsr(MSR_IA32_PAT, (1UL << 32) | 6);
|
|
|
|
uintptr_t base = display_vesa_fb.framebuffer;
|
|
uint64_t *pml4 = mm_kernel;
|
|
size_t pml4i = (base >> MM_PML4I_SHIFT) & MM_PTE_INDEX_MASK;
|
|
size_t pdpti = (base >> MM_PDPTI_SHIFT) & MM_PTE_INDEX_MASK;
|
|
size_t pdi = (base >> MM_PDI_SHIFT) & MM_PTE_INDEX_MASK;
|
|
uint64_t *pdpt = (void *) MM_VIRTUALIZE(pml4[pml4i] & ~0xFFF);
|
|
uint64_t *pd = (void *) MM_VIRTUALIZE(pdpt[pdpti] & ~0xFFF);
|
|
_assert((pd[pdi] & ~0xFFF) == MM_PHYS(base));
|
|
pd[pdi] |= 1 << 12;
|
|
|
|
display_add(&display_vesa_fb);
|
|
}
|