lunaix-os/arch/i386/boot/hhk.c

   1 #include <arch/i386/boot/multiboot.h>
   2 #include <arch/i386/idt.h>
   3 #include <lunaix/common.h>
   4 #include <lunaix/mm/page.h>
   5
   6 #define PT_ADDR(ptd, pt_index) ((ptd_t*)ptd + (pt_index + 1) * 1024)
   7 #define SET_PDE(ptd, pde_index, pde) *((ptd_t*)ptd + pde_index) = pde;
   8 #define SET_PTE(ptd, pt_index, pte_index, pte)                                 \
   9     *(PT_ADDR(ptd, pt_index) + pte_index) = pte;
  10 #define sym_val(sym) (ptr_t)(&sym)
  11
  12 #define KERNEL_PAGE_COUNT                                                      \
  13     ((sym_val(__kernel_end) - sym_val(__kernel_start) + 0x1000 - 1) >> 12);
  14 #define HHK_PAGE_COUNT ((sym_val(__init_hhk_end) - 0x100000 + 0x1000 - 1) >> 12)
  15
  16 // use table #1
  17 #define PG_TABLE_IDENTITY 0
  18
  19 // use table #2-8
  20 // hence the max size of kernel is 8MiB
  21 #define PG_TABLE_KERNEL 1
  22
  23 // use table #9
  24 #define PG_TABLE_STACK 8
  25
  26 // Provided by linker (see linker.ld)
  27 extern u8_t __kernel_start;
  28 extern u8_t __kernel_end;
  29 extern u8_t __ktext_start;
  30 extern u8_t __ktext_end;
  31
  32 extern u8_t __init_hhk_end;
  33 extern u8_t _k_stack;
  34
  35 #define boot_text __attribute__((section(".hhk_init_text")))
  36 #define boot_data __attribute__((section(".hhk_init_data")))
  37
  38 void boot_text
  39 _init_page(x86_page_table* ptd)
  40 {
  41     ptd->entry[0] = NEW_L1_ENTRY(PG_PREM_RW, (ptd_t*)ptd + PG_MAX_ENTRIES);
  42
  43     // 对低1MiB空间进行对等映射（Identity
  44     // mapping），也包括了我们的VGA，方便内核操作。
  45     x86_page_table* id_pt =
  46       (x86_page_table*)GET_PG_ADDR(ptd->entry[PG_TABLE_IDENTITY]);
  47
  48     for (u32_t i = 0; i < 256; i++) {
  49         id_pt->entry[i] = NEW_L2_ENTRY(PG_PREM_RW, (i << PG_SIZE_BITS));
  50     }
  51
  52     // 对等映射我们的hhk_init，这样一来，当分页与地址转换开启后，我们依然能够照常执行最终的
  53     // jmp 指令来跳转至
  54     //  内核的入口点
  55     for (u32_t i = 0; i < HHK_PAGE_COUNT; i++) {
  56         id_pt->entry[256 + i] =
  57           NEW_L2_ENTRY(PG_PREM_RW, 0x100000 + (i << PG_SIZE_BITS));
  58     }
  59
  60     // --- 将内核重映射至高半区 ---
  61
  62     // 这里是一些计算，主要是计算应当映射进的 页目录 与 页表 的条目索引（Entry
  63     // Index）
  64     u32_t kernel_pde_index = L1_INDEX(sym_val(__kernel_start));
  65     u32_t kernel_pte_index = L2_INDEX(sym_val(__kernel_start));
  66     u32_t kernel_pg_counts = KERNEL_PAGE_COUNT;
  67
  68     // 将内核所需要的页表注册进页目录
  69     //  当然，就现在而言，我们的内核只占用不到50个页（每个页表包含1024个页）
  70     //  这里分配了3个页表（12MiB），未雨绸缪。
  71     for (u32_t i = 0; i < PG_TABLE_STACK - PG_TABLE_KERNEL; i++) {
  72         ptd->entry[kernel_pde_index + i] =
  73           NEW_L1_ENTRY(PG_PREM_RW, PT_ADDR(ptd, PG_TABLE_KERNEL + i));
  74     }
  75
  76     // 首先，检查内核的大小是否可以fit进我们这几个表（12MiB）
  77     if (kernel_pg_counts >
  78         (PG_TABLE_STACK - PG_TABLE_KERNEL) * PG_MAX_ENTRIES) {
  79         // ERROR: require more pages
  80         //  here should do something else other than head into blocking
  81         asm("ud2");
  82     }
  83
  84     // 计算内核.text段的物理地址
  85     ptr_t kernel_pm = V2P(&__kernel_start);
  86     ptr_t ktext_start = V2P(&__ktext_start);
  87     ptr_t ktext_end = V2P(&ktext_end);
  88
  89     // 重映射内核至高半区地址（>=0xC0000000）
  90     for (u32_t i = 0; i < kernel_pg_counts; i++) {
  91         ptr_t paddr = kernel_pm + (i << PG_SIZE_BITS);
  92         u32_t flags = PG_PREM_RW;
  93
  94         if (paddr >= ktext_start && paddr <= ktext_end) {
  95             flags = PG_PREM_R;
  96         }
  97
  98         SET_PTE(ptd,
  99                 PG_TABLE_KERNEL,
 100                 kernel_pte_index + i,
 101                 NEW_L2_ENTRY(flags, paddr))
 102     }
 103
 104     // 最后一个entry用于循环映射
 105     ptd->entry[PG_MAX_ENTRIES - 1] = NEW_L1_ENTRY(T_SELF_REF_PERM, ptd);
 106 }
 107
 108 u32_t boot_text
 109 __save_subset(u8_t* destination, u8_t* base, unsigned int size)
 110 {
 111     unsigned int i = 0;
 112     for (; i < size; i++) {
 113         *(destination + i) = *(base + i);
 114     }
 115     return i;
 116 }
 117
 118 void boot_text
 119 _save_multiboot_info(multiboot_info_t* info, u8_t* destination)
 120 {
 121     u32_t current = 0;
 122     u8_t* info_b = (u8_t*)info;
 123     for (; current < sizeof(multiboot_info_t); current++) {
 124         *(destination + current) = *(info_b + current);
 125     }
 126
 127     ((multiboot_info_t*)destination)->mmap_addr = (ptr_t)destination + current;
 128     current += __save_subset(
 129       destination + current, (u8_t*)info->mmap_addr, info->mmap_length);
 130
 131     if (present(info->flags, MULTIBOOT_INFO_DRIVE_INFO)) {
 132         ((multiboot_info_t*)destination)->drives_addr =
 133           (ptr_t)destination + current;
 134         current += __save_subset(
 135           destination + current, (u8_t*)info->drives_addr, info->drives_length);
 136     }
 137 }
 138
 139 void boot_text
 140 _hhk_init(x86_page_table* ptd, u32_t kpg_size)
 141 {
 142
 143     // 初始化 kpg 全为0
 144     //      P.s. 真没想到GRUB会在这里留下一堆垃圾！ 老子的页表全乱套了！
 145     u8_t* kpg = (u8_t*)ptd;
 146     for (u32_t i = 0; i < kpg_size; i++) {
 147         *(kpg + i) = 0;
 148     }
 149
 150     _init_page(ptd);
 151 }