mm.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671
  1. #include "mm.h"
  2. #include "slab.h"
  3. #include "../common/printk.h"
  4. #include "../common/kprint.h"
  5. #include "../driver/multiboot2/multiboot2.h"
  6. ul Total_Memory = 0;
  7. ul total_2M_pages = 0;
  8. static ul root_page_table_phys_addr = 0; // 内核层根页表的物理地址
  9. void mm_init()
  10. {
  11. kinfo("Initializing memory management unit...");
  12. // 设置内核程序不同部分的起止地址
  13. memory_management_struct.kernel_code_start = (ul)&_text;
  14. memory_management_struct.kernel_code_end = (ul)&_etext;
  15. memory_management_struct.kernel_data_end = (ul)&_edata;
  16. memory_management_struct.kernel_end = (ul)&_end;
  17. struct multiboot_mmap_entry_t mb2_mem_info[512];
  18. int count;
  19. multiboot2_iter(multiboot2_get_memory, mb2_mem_info, &count);
  20. for (int i = 0; i < count; ++i)
  21. {
  22. //可用的内存
  23. if (mb2_mem_info->type == 1)
  24. Total_Memory += mb2_mem_info->len;
  25. // 保存信息到mms
  26. memory_management_struct.e820[i].BaseAddr = mb2_mem_info[i].addr;
  27. memory_management_struct.e820[i].Length = mb2_mem_info[i].len;
  28. memory_management_struct.e820[i].type = mb2_mem_info[i].type;
  29. memory_management_struct.len_e820 = i;
  30. // 脏数据
  31. if (mb2_mem_info[i].type > 4 || mb2_mem_info[i].len == 0 || mb2_mem_info[i].type < 1)
  32. break;
  33. }
  34. printk("[ INFO ] Total amounts of RAM : %ld bytes\n", Total_Memory);
  35. // 计算有效内存页数
  36. for (int i = 0; i < memory_management_struct.len_e820; ++i)
  37. {
  38. if (memory_management_struct.e820[i].type != 1)
  39. continue;
  40. // 将内存段的起始物理地址按照2M进行对齐
  41. ul addr_start = PAGE_2M_ALIGN(memory_management_struct.e820[i].BaseAddr);
  42. // 将内存段的终止物理地址的低2M区域清空,以实现对齐
  43. ul addr_end = ((memory_management_struct.e820[i].BaseAddr + memory_management_struct.e820[i].Length) & PAGE_2M_MASK);
  44. // 内存段不可用
  45. if (addr_end <= addr_start)
  46. continue;
  47. total_2M_pages += ((addr_end - addr_start) >> PAGE_2M_SHIFT);
  48. }
  49. kinfo("Total amounts of 2M pages : %ld.", total_2M_pages);
  50. // 物理地址空间的最大地址(包含了物理内存、内存空洞、ROM等)
  51. ul max_addr = memory_management_struct.e820[memory_management_struct.len_e820].BaseAddr + memory_management_struct.e820[memory_management_struct.len_e820].Length;
  52. // 初始化mms的bitmap
  53. // bmp的指针指向截止位置的4k对齐的上边界(防止修改了别的数据)
  54. memory_management_struct.bmp = (unsigned long *)((memory_management_struct.kernel_end + PAGE_4K_SIZE - 1) & PAGE_4K_MASK);
  55. memory_management_struct.bits_size = max_addr >> PAGE_2M_SHIFT; // 物理地址空间的最大页面数
  56. memory_management_struct.bmp_len = (((unsigned long)(max_addr >> PAGE_2M_SHIFT) + sizeof(unsigned long) * 8 - 1) / 8) & (~(sizeof(unsigned long) - 1)); // bmp由多少个unsigned long变量组成
  57. // 初始化bitmap, 先将整个bmp空间全部置位。稍后再将可用物理内存页复位。
  58. memset(memory_management_struct.bmp, 0xff, memory_management_struct.bmp_len);
  59. // 初始化内存页结构
  60. // 将页结构映射于bmp之后
  61. memory_management_struct.pages_struct = (struct Page *)(((unsigned long)memory_management_struct.bmp + memory_management_struct.bmp_len + PAGE_4K_SIZE - 1) & PAGE_4K_MASK);
  62. memory_management_struct.count_pages = max_addr >> PAGE_2M_SHIFT;
  63. memory_management_struct.pages_struct_len = ((max_addr >> PAGE_2M_SHIFT) * sizeof(struct Page) + sizeof(long) - 1) & (~(sizeof(long) - 1));
  64. // 将pages_struct全部清空,以备后续初始化
  65. memset(memory_management_struct.pages_struct, 0x00, memory_management_struct.pages_struct_len); // init pages memory
  66. // 初始化内存区域
  67. memory_management_struct.zones_struct = (struct Zone *)(((ul)memory_management_struct.pages_struct + memory_management_struct.pages_struct_len + PAGE_4K_SIZE - 1) & PAGE_4K_MASK);
  68. // 由于暂时无法计算zone结构体的数量,因此先将其设为0
  69. memory_management_struct.count_zones = 0;
  70. // zones-struct 成员变量暂时按照5个来计算
  71. memory_management_struct.zones_struct_len = (5 * sizeof(struct Zone) + sizeof(ul) - 1) & (~(sizeof(ul) - 1));
  72. memset(memory_management_struct.zones_struct, 0x00, memory_management_struct.zones_struct_len);
  73. // ==== 遍历e820数组,完成成员变量初始化工作 ===
  74. for (int i = 0; i < memory_management_struct.len_e820; ++i)
  75. {
  76. if (memory_management_struct.e820[i].type != 1) // 不是操作系统可以使用的物理内存
  77. continue;
  78. ul addr_start = PAGE_2M_ALIGN(memory_management_struct.e820[i].BaseAddr);
  79. ul addr_end = (memory_management_struct.e820[i].BaseAddr + memory_management_struct.e820[i].Length) & PAGE_2M_MASK;
  80. if (addr_end <= addr_start)
  81. continue;
  82. // zone init
  83. struct Zone *z = memory_management_struct.zones_struct + memory_management_struct.count_zones;
  84. ++memory_management_struct.count_zones;
  85. z->zone_addr_start = addr_start;
  86. z->zone_addr_end = addr_end;
  87. z->zone_length = addr_end - addr_start;
  88. z->count_pages_using = 0;
  89. z->count_pages_free = (addr_end - addr_start) >> PAGE_2M_SHIFT;
  90. z->total_pages_link = 0;
  91. z->attr = 0;
  92. z->gmd_struct = &memory_management_struct;
  93. z->count_pages = (addr_end - addr_start) >> PAGE_2M_SHIFT;
  94. z->pages_group = (struct Page *)(memory_management_struct.pages_struct + (addr_start >> PAGE_2M_SHIFT));
  95. // 初始化页
  96. struct Page *p = z->pages_group;
  97. for (int j = 0; j < z->count_pages; ++j, ++p)
  98. {
  99. p->zone = z;
  100. p->addr_phys = addr_start + PAGE_2M_SIZE * j;
  101. p->attr = 0;
  102. p->ref_counts = 0;
  103. p->age = 0;
  104. // 将bmp中对应的位 复位
  105. *(memory_management_struct.bmp + ((p->addr_phys >> PAGE_2M_SHIFT) >> 6)) ^= (1UL << ((p->addr_phys >> PAGE_2M_SHIFT) % 64));
  106. }
  107. }
  108. // 初始化0~2MB的物理页
  109. // 由于这个区间的内存由多个内存段组成,因此不会被以上代码初始化,需要我们手动配置page[0]。
  110. memory_management_struct.pages_struct->zone = memory_management_struct.zones_struct;
  111. memory_management_struct.pages_struct->addr_phys = 0UL;
  112. set_page_attr(memory_management_struct.pages_struct, PAGE_PGT_MAPPED | PAGE_KERNEL_INIT | PAGE_KERNEL);
  113. memory_management_struct.pages_struct->ref_counts = 1;
  114. memory_management_struct.pages_struct->age = 0;
  115. // 将第0页的标志位给置上
  116. //*(memory_management_struct.bmp) |= 1UL;
  117. // 计算zone结构体的总长度(按照64位对齐)
  118. memory_management_struct.zones_struct_len = (memory_management_struct.count_zones * sizeof(struct Zone) + sizeof(ul) - 1) & (~(sizeof(ul) - 1));
  119. ZONE_DMA_INDEX = 0;
  120. ZONE_NORMAL_INDEX = 0;
  121. ZONE_UNMAPPED_INDEX = 0;
  122. for (int i = 0; i < memory_management_struct.count_zones; ++i)
  123. {
  124. struct Zone *z = memory_management_struct.zones_struct + i;
  125. // printk_color(ORANGE, BLACK, "zone_addr_start:%#18lx, zone_addr_end:%#18lx, zone_length:%#18lx, pages_group:%#18lx, count_pages:%#18lx\n",
  126. // z->zone_addr_start, z->zone_addr_end, z->zone_length, z->pages_group, z->count_pages);
  127. // 1GB以上的内存空间不做映射
  128. if (z->zone_addr_start >= 0x100000000 && (!ZONE_UNMAPPED_INDEX))
  129. ZONE_UNMAPPED_INDEX = i;
  130. }
  131. // kdebug("ZONE_DMA_INDEX=%d\tZONE_NORMAL_INDEX=%d\tZONE_UNMAPPED_INDEX=%d", ZONE_DMA_INDEX, ZONE_NORMAL_INDEX, ZONE_UNMAPPED_INDEX);
  132. // 设置内存页管理结构的地址,预留了一段空间,防止内存越界。
  133. memory_management_struct.end_of_struct = (ul)((ul)memory_management_struct.zones_struct + memory_management_struct.zones_struct_len + sizeof(long) * 32) & (~(sizeof(long) - 1));
  134. // printk_color(ORANGE, BLACK, "code_start:%#18lx, code_end:%#18lx, data_end:%#18lx, kernel_end:%#18lx, end_of_struct:%#18lx\n",
  135. // memory_management_struct.kernel_code_start, memory_management_struct.kernel_code_end, memory_management_struct.kernel_data_end, memory_management_struct.kernel_end, memory_management_struct.end_of_struct);
  136. // 初始化内存管理单元结构所占的物理页的结构体
  137. ul mms_max_page = (virt_2_phys(memory_management_struct.end_of_struct) >> PAGE_2M_SHIFT); // 内存管理单元所占据的序号最大的物理页
  138. // kdebug("mms_max_page=%ld", mms_max_page);
  139. struct Page *tmp_page = NULL;
  140. ul page_num;
  141. // 第0个page已经在上方配置
  142. for (ul j = 1; j <= mms_max_page; ++j)
  143. {
  144. tmp_page = memory_management_struct.pages_struct + j;
  145. page_init(tmp_page, PAGE_PGT_MAPPED | PAGE_KERNEL | PAGE_KERNEL_INIT);
  146. page_num = tmp_page->addr_phys >> PAGE_2M_SHIFT;
  147. *(memory_management_struct.bmp + (page_num >> 6)) |= (1UL << (page_num % 64));
  148. ++tmp_page->zone->count_pages_using;
  149. --tmp_page->zone->count_pages_free;
  150. }
  151. global_CR3 = get_CR3();
  152. // root_page_table_phys_addr = global_CR3;
  153. // kdebug("global_CR3\t:%#018lx", global_CR3);
  154. // kdebug("*global_CR3\t:%#018lx", *phys_2_virt(global_CR3) & (~0xff));
  155. // kdebug("**global_CR3\t:%#018lx", *phys_2_virt(*phys_2_virt(global_CR3) & (~0xff)) & (~0xff));
  156. // kdebug("1.memory_management_struct.bmp:%#018lx\tzone->count_pages_using:%d\tzone_struct->count_pages_free:%d", *memory_management_struct.bmp, memory_management_struct.zones_struct->count_pages_using, memory_management_struct.zones_struct->count_pages_free);
  157. // kinfo("Cleaning page table remapping at 0x0000");
  158. kinfo("Memory management unit initialize complete!");
  159. flush_tlb();
  160. // 初始化slab内存池
  161. slab_init();
  162. page_table_init();
  163. init_frame_buffer();
  164. }
  165. /**
  166. * @brief 初始化内存页
  167. *
  168. * @param page 内存页结构体
  169. * @param flags 标志位
  170. * 本函数只负责初始化内存页,允许对同一页面进行多次初始化
  171. * 而维护计数器及置位bmp标志位的功能,应当在分配页面的时候手动完成
  172. * @return unsigned long
  173. */
  174. unsigned long page_init(struct Page *page, ul flags)
  175. {
  176. page->attr |= flags;
  177. // 若页面的引用计数为0或是共享页,增加引用计数
  178. if ((!page->ref_counts) || (page->attr & PAGE_SHARED))
  179. {
  180. ++page->ref_counts;
  181. ++page->zone->total_pages_link;
  182. }
  183. return 0;
  184. }
  185. /**
  186. * @brief 从已初始化的页结构中搜索符合申请条件的、连续num个struct page
  187. *
  188. * @param zone_select 选择内存区域, 可选项:dma, mapped in pgt(normal), unmapped in pgt
  189. * @param num 需要申请的连续内存页的数量 num<64
  190. * @param flags 将页面属性设置成flag
  191. * @return struct Page*
  192. */
  193. struct Page *alloc_pages(unsigned int zone_select, int num, ul flags)
  194. {
  195. ul zone_start = 0, zone_end = 0;
  196. if (num >= 64 && num <= 0)
  197. {
  198. kerror("alloc_pages(): num is invalid.");
  199. return NULL;
  200. }
  201. ul attr = flags;
  202. switch (zone_select)
  203. {
  204. case ZONE_DMA:
  205. // DMA区域
  206. zone_start = 0;
  207. zone_end = ZONE_DMA_INDEX;
  208. attr |= PAGE_PGT_MAPPED;
  209. break;
  210. case ZONE_NORMAL:
  211. zone_start = ZONE_DMA_INDEX;
  212. zone_end = ZONE_NORMAL_INDEX;
  213. attr |= PAGE_PGT_MAPPED;
  214. break;
  215. case ZONE_UNMAPPED_IN_PGT:
  216. zone_start = ZONE_NORMAL_INDEX;
  217. zone_end = ZONE_UNMAPPED_INDEX;
  218. attr = 0;
  219. break;
  220. default:
  221. kerror("In alloc_pages: param: zone_select incorrect.");
  222. // 返回空
  223. return NULL;
  224. break;
  225. }
  226. for (int i = zone_start; i <= zone_end; ++i)
  227. {
  228. if ((memory_management_struct.zones_struct + i)->count_pages_free < num)
  229. continue;
  230. struct Zone *z = memory_management_struct.zones_struct + i;
  231. // 区域对应的起止页号
  232. ul page_start = (z->zone_addr_start >> PAGE_2M_SHIFT);
  233. ul page_end = (z->zone_addr_end >> PAGE_2M_SHIFT);
  234. ul tmp = 64 - page_start % 64;
  235. for (ul j = page_start; j < page_end; j += ((j % 64) ? tmp : 64))
  236. {
  237. // 按照bmp中的每一个元素进行查找
  238. // 先将p定位到bmp的起始元素
  239. ul *p = memory_management_struct.bmp + (j >> 6);
  240. ul shift = j % 64;
  241. ul tmp_num = ((1UL << num) - 1);
  242. for (ul k = shift; k < 64; ++k)
  243. {
  244. // 寻找连续num个空页
  245. if (!((k ? ((*p >> k) | (*(p + 1) << (64 - k))) : *p) & tmp_num))
  246. {
  247. ul start_page_num = j + k - shift; // 计算得到要开始获取的内存页的页号
  248. for (ul l = 0; l < num; ++l)
  249. {
  250. struct Page *x = memory_management_struct.pages_struct + start_page_num + l;
  251. // 分配页面,手动配置属性及计数器
  252. // 置位bmp
  253. *(memory_management_struct.bmp + ((x->addr_phys >> PAGE_2M_SHIFT) >> 6)) |= (1UL << (x->addr_phys >> PAGE_2M_SHIFT) % 64);
  254. ++z->count_pages_using;
  255. --z->count_pages_free;
  256. x->attr = attr;
  257. }
  258. // 成功分配了页面,返回第一个页面的指针
  259. // printk("start page num=%d\n",start_page_num);
  260. return (struct Page *)(memory_management_struct.pages_struct + start_page_num);
  261. }
  262. }
  263. }
  264. }
  265. return NULL;
  266. }
  267. /**
  268. * @brief 清除页面的引用计数, 计数为0时清空除页表已映射以外的所有属性
  269. *
  270. * @param p 物理页结构体
  271. * @return unsigned long
  272. */
  273. unsigned long page_clean(struct Page *p)
  274. {
  275. --p->ref_counts;
  276. --p->zone->total_pages_link;
  277. // 若引用计数为空,则清空除PAGE_PGT_MAPPED以外的所有属性
  278. if (!p->ref_counts)
  279. {
  280. p->attr &= PAGE_PGT_MAPPED;
  281. }
  282. return 0;
  283. }
  284. /**
  285. * @brief Get the page's attr
  286. *
  287. * @param page 内存页结构体
  288. * @return ul 属性
  289. */
  290. ul get_page_attr(struct Page *page)
  291. {
  292. if (page == NULL)
  293. {
  294. kBUG("get_page_attr(): page == NULL");
  295. return EPAGE_NULL;
  296. }
  297. else
  298. return page->attr;
  299. }
  300. /**
  301. * @brief Set the page's attr
  302. *
  303. * @param page 内存页结构体
  304. * @param flags 属性
  305. * @return ul 错误码
  306. */
  307. ul set_page_attr(struct Page *page, ul flags)
  308. {
  309. if (page == NULL)
  310. {
  311. kBUG("get_page_attr(): page == NULL");
  312. return EPAGE_NULL;
  313. }
  314. else
  315. {
  316. page->attr = flags;
  317. return 0;
  318. }
  319. }
  320. /**
  321. * @brief 释放连续number个内存页
  322. *
  323. * @param page 第一个要被释放的页面的结构体
  324. * @param number 要释放的内存页数量 number<64
  325. */
  326. void free_pages(struct Page *page, int number)
  327. {
  328. if (page == NULL)
  329. {
  330. kerror("free_pages() page is invalid.");
  331. return;
  332. }
  333. if (number >= 64 || number <= 0)
  334. {
  335. kerror("free_pages(): number %d is invalid.", number);
  336. return;
  337. }
  338. ul page_num;
  339. for (int i = 0; i < number; ++i, ++page)
  340. {
  341. page_num = page->addr_phys >> PAGE_2M_SHIFT;
  342. // 复位bmp
  343. *(memory_management_struct.bmp + (page_num >> 6)) &= ~(1UL << (page_num % 64));
  344. // 更新计数器
  345. --page->zone->count_pages_using;
  346. ++page->zone->count_pages_free;
  347. page->attr = 0;
  348. }
  349. return;
  350. }
  351. /**
  352. * @brief 重新初始化页表的函数
  353. * 将0~4GB的物理页映射到线性地址空间
  354. */
  355. void page_table_init()
  356. {
  357. kinfo("Re-Initializing page table...");
  358. global_CR3 = get_CR3();
  359. /*
  360. // 由于CR3寄存器的[11..0]位是PCID标志位,因此将低12位置0后,就是PML4页表的基地址
  361. ul *pml4_addr = (ul *)((ul)phys_2_virt((ul)global_CR3 & (~0xfffUL)));
  362. kdebug("PML4 addr=%#018lx *pml4=%#018lx", pml4_addr, *pml4_addr);
  363. ul *pdpt_addr = phys_2_virt(*pml4_addr & (~0xfffUL));
  364. kdebug("pdpt addr=%#018lx *pdpt=%#018lx", pdpt_addr, *pdpt_addr);
  365. ul *pd_addr = phys_2_virt(*pdpt_addr & (~0xfffUL));
  366. kdebug("pd addr=%#018lx *pd=%#018lx", pd_addr, *pd_addr);
  367. */
  368. ul *tmp_addr;
  369. for (int i = 0; i < memory_management_struct.count_zones; ++i)
  370. {
  371. struct Zone *z = memory_management_struct.zones_struct + i;
  372. struct Page *p = z->pages_group;
  373. if (i == ZONE_UNMAPPED_INDEX)
  374. break;
  375. for (int j = 0; j < z->count_pages; ++j)
  376. {
  377. mm_map_phys_addr((ul)phys_2_virt(p->addr_phys), p->addr_phys, PAGE_2M_SIZE, PAGE_KERNEL_PAGE);
  378. /*
  379. // 计算出PML4页表中的页表项的地址
  380. tmp_addr = (ul *)((ul)pml4_addr + ((((ul)phys_2_virt(p->addr_phys)) >> PAGE_GDT_SHIFT) & 0x1ff) * 8);
  381. // 说明该页还没有分配pdpt页表,使用kmalloc分配一个
  382. if (*tmp_addr = 0)
  383. {
  384. ul *virt_addr = kmalloc(PAGE_4K_SIZE, 0);
  385. set_pml4t(tmp_addr, mk_pml4t(virt_2_phys(virt_addr), PAGE_KERNEL_PGT));
  386. }
  387. // 计算出pdpt页表的页表项的地址
  388. tmp_addr = (ul *)((ul)(phys_2_virt(*tmp_addr & (~0xfffUL))) + ((((ul)phys_2_virt(p->addr_phys)) >> PAGE_1G_SHIFT) & 0x1ff) * 8);
  389. // 说明该页还没有分配pd页表,使用kmalloc分配一个
  390. if (*tmp_addr = 0)
  391. {
  392. ul *virt_addr = kmalloc(PAGE_4K_SIZE, 0);
  393. set_pdpt(tmp_addr, mk_pdpt(virt_2_phys(virt_addr), PAGE_KERNEL_DIR));
  394. }
  395. // 计算出pd页表的页表项的地址
  396. tmp_addr = (ul *)((ul)(phys_2_virt(*tmp_addr & (~0xfffUL))) + ((((ul)phys_2_virt(p->addr_phys)) >> PAGE_2M_SHIFT) & 0x1ff) * 8);
  397. // 填入pd页表的页表项,映射2MB物理页
  398. set_pdt(tmp_addr, mk_pdt(virt_2_phys(p->addr_phys), PAGE_KERNEL_PAGE));
  399. */
  400. // 测试
  401. if (j % 50 == 0)
  402. kdebug("pd_addr=%#018lx, *pd_addr=%#018lx", tmp_addr, *tmp_addr);
  403. }
  404. }
  405. flush_tlb();
  406. kinfo("Page table Initialized.");
  407. }
  408. /**
  409. * @brief VBE帧缓存区的地址重新映射
  410. * 将帧缓存区映射到地址0xffff800003000000处
  411. */
  412. void init_frame_buffer()
  413. {
  414. kinfo("Re-mapping VBE frame buffer...");
  415. global_CR3 = get_CR3();
  416. ul fb_virt_addr = SPECIAL_MEMOEY_MAPPING_VIRT_ADDR_BASE + FRAME_BUFFER_MAPPING_OFFSET;
  417. ul fb_phys_addr = get_VBE_FB_phys_addr();
  418. // 计算帧缓冲区的线性地址对应的pml4页表项的地址
  419. ul *tmp = phys_2_virt((ul *)((ul)global_CR3 & (~0xfffUL)) + ((fb_virt_addr >> PAGE_GDT_SHIFT) & 0x1ff));
  420. if (*tmp == 0)
  421. {
  422. ul *virt_addr = kmalloc(PAGE_4K_SIZE, 0);
  423. memset(virt_addr, 0, PAGE_4K_SIZE);
  424. set_pml4t(tmp, mk_pml4t(virt_2_phys(virt_addr), PAGE_KERNEL_PGT));
  425. }
  426. tmp = phys_2_virt((ul *)(*tmp & (~0xfffUL)) + ((fb_virt_addr >> PAGE_1G_SHIFT) & 0x1ff));
  427. if (*tmp == 0)
  428. {
  429. ul *virt_addr = kmalloc(PAGE_4K_SIZE, 0);
  430. memset(virt_addr, 0, PAGE_4K_SIZE);
  431. set_pdpt(tmp, mk_pdpt(virt_2_phys(virt_addr), PAGE_KERNEL_DIR));
  432. }
  433. ul vbe_fb_length = get_VBE_FB_length();
  434. ul *tmp1;
  435. // 初始化2M物理页
  436. for (ul i = 0; i < (vbe_fb_length << 2); i += PAGE_2M_SIZE)
  437. {
  438. // 计算当前2M物理页对应的pdt的页表项的物理地址
  439. tmp1 = phys_2_virt((ul *)(*tmp & (~0xfffUL)) + (((ul)(fb_virt_addr + i) >> PAGE_2M_SHIFT) & 0x1ff));
  440. // 页面写穿,禁止缓存
  441. set_pdt(tmp1, mk_pdt((ul)fb_phys_addr + i, PAGE_KERNEL_PAGE | PAGE_PWT | PAGE_PCD));
  442. }
  443. set_pos_VBE_FB_addr((uint *)fb_virt_addr);
  444. flush_tlb();
  445. kinfo("VBE frame buffer successfully Re-mapped!");
  446. }
  447. /**
  448. * @brief 将物理地址映射到页表的函数
  449. *
  450. * @param virt_addr_start 要映射到的虚拟地址的起始位置
  451. * @param phys_addr_start 物理地址的起始位置
  452. * @param length 要映射的区域的长度(字节)
  453. */
  454. void mm_map_phys_addr(ul virt_addr_start, ul phys_addr_start, ul length, ul flags)
  455. {
  456. global_CR3 = get_CR3();
  457. // 计算线性地址对应的pml4页表项的地址
  458. ul *tmp = phys_2_virt((ul *)((ul)global_CR3 & (~0xfffUL)) + ((virt_addr_start >> PAGE_GDT_SHIFT) & 0x1ff));
  459. if (*tmp == 0)
  460. {
  461. ul *virt_addr = kmalloc(PAGE_4K_SIZE, 0);
  462. memset(virt_addr, 0, PAGE_4K_SIZE);
  463. set_pml4t(tmp, mk_pml4t(virt_2_phys(virt_addr), PAGE_KERNEL_PGT));
  464. }
  465. tmp = phys_2_virt((ul *)(*tmp & (~0xfffUL)) + ((virt_addr_start >> PAGE_1G_SHIFT) & 0x1ff));
  466. if (*tmp == 0)
  467. {
  468. ul *virt_addr = kmalloc(PAGE_4K_SIZE, 0);
  469. memset(virt_addr, 0, PAGE_4K_SIZE);
  470. set_pdpt(tmp, mk_pdpt(virt_2_phys(virt_addr), PAGE_KERNEL_DIR));
  471. }
  472. ul *tmp1;
  473. // 初始化2M物理页
  474. for (ul i = 0; i < (length); i += PAGE_2M_SIZE)
  475. {
  476. // 计算当前2M物理页对应的pdt的页表项的物理地址
  477. tmp1 = phys_2_virt((ul *)(*tmp & (~0xfffUL)) + (((ul)(virt_addr_start + i) >> PAGE_2M_SHIFT) & 0x1ff));
  478. // 页面写穿,禁止缓存
  479. set_pdt(tmp1, mk_pdt((ul)phys_addr_start + i, flags));
  480. }
  481. flush_tlb();
  482. }
  483. void mm_map_phys_addr_user(ul virt_addr_start, ul phys_addr_start, ul length, ul flags)
  484. {
  485. global_CR3 = get_CR3();
  486. // 计算线性地址对应的pml4页表项的地址
  487. ul *tmp = phys_2_virt((ul *)((ul)global_CR3 & (~0xfffUL)) + ((virt_addr_start >> PAGE_GDT_SHIFT) & 0x1ff));
  488. if (*tmp == 0)
  489. {
  490. ul *virt_addr = kmalloc(PAGE_4K_SIZE, 0);
  491. memset(virt_addr, 0, PAGE_4K_SIZE);
  492. set_pml4t(tmp, mk_pml4t(virt_2_phys(virt_addr), PAGE_USER_PGT));
  493. }
  494. else
  495. kdebug("*tmp != 0!!! \t tmp = %#018lx\t *tmp = %#018lx", tmp, *tmp);
  496. tmp = phys_2_virt((ul *)(*tmp & (~0xfffUL)) + ((virt_addr_start >> PAGE_1G_SHIFT) & 0x1ff));
  497. if (*tmp == 0)
  498. {
  499. ul *virt_addr = kmalloc(PAGE_4K_SIZE, 0);
  500. memset(virt_addr, 0, PAGE_4K_SIZE);
  501. set_pdpt(tmp, mk_pdpt(virt_2_phys(virt_addr), PAGE_USER_DIR));
  502. }
  503. else
  504. kdebug("*tmp != 0!!! \t tmp = %#018lx\t *tmp = %#018lx", tmp, *tmp);
  505. ul *tmp1;
  506. // 初始化2M物理页
  507. for (ul i = 0; i < (length); i += PAGE_2M_SIZE)
  508. {
  509. // 计算当前2M物理页对应的pdt的页表项的物理地址
  510. tmp1 = phys_2_virt((ul *)(*tmp & (~0xfffUL)) + (((ul)(virt_addr_start + i) >> PAGE_2M_SHIFT) & 0x1ff));
  511. // 页面写穿,禁止缓存
  512. set_pdt(tmp1, mk_pdt((ul)phys_addr_start + i, flags | PAGE_USER_PAGE));
  513. }
  514. flush_tlb();
  515. }
  516. /**
  517. * @brief 将将物理地址填写到进程的页表的函数
  518. *
  519. * @param proc_page_table_addr 页表的基地址
  520. * @param is_phys 页表的基地址是否为物理地址
  521. * @param virt_addr_start 要映射到的虚拟地址的起始位置
  522. * @param phys_addr_start 物理地址的起始位置
  523. * @param length 要映射的区域的长度(字节)
  524. * @param user 用户态是否可访问
  525. */
  526. void mm_map_proc_page_table(ul proc_page_table_addr, bool is_phys, ul virt_addr_start, ul phys_addr_start, ul length, ul flags, bool user)
  527. {
  528. kdebug("proc_page_table_addr=%#018lx",proc_page_table_addr);
  529. // 计算线性地址对应的pml4页表项的地址
  530. ul *tmp;
  531. if (is_phys)
  532. tmp = phys_2_virt((ul *)((ul)proc_page_table_addr & (~0xfffUL)) + ((virt_addr_start >> PAGE_GDT_SHIFT) & 0x1ff));
  533. else
  534. tmp = (ul *)((ul)proc_page_table_addr & (~0xfffUL)) + ((virt_addr_start >> PAGE_GDT_SHIFT) & 0x1ff);
  535. // kdebug("tmp = %#018lx", tmp);
  536. if (*tmp == 0)
  537. {
  538. ul *virt_addr = kmalloc(PAGE_4K_SIZE, 0);
  539. memset(virt_addr, 0, PAGE_4K_SIZE);
  540. set_pml4t(tmp, mk_pml4t(virt_2_phys(virt_addr), (user ? PAGE_USER_PGT : PAGE_KERNEL_PGT)));
  541. }
  542. // kdebug("*tmp = %#018lx", *tmp);
  543. if (is_phys)
  544. tmp = phys_2_virt((ul *)(*tmp & (~0xfffUL)) + ((virt_addr_start >> PAGE_1G_SHIFT) & 0x1ff));
  545. else
  546. tmp = (ul *)(*tmp & (~0xfffUL)) + ((virt_addr_start >> PAGE_1G_SHIFT) & 0x1ff);
  547. if (*tmp == 0)
  548. {
  549. ul *virt_addr = kmalloc(PAGE_4K_SIZE, 0);
  550. memset(virt_addr, 0, PAGE_4K_SIZE);
  551. set_pdpt(tmp, mk_pdpt(virt_2_phys(virt_addr), (user ? PAGE_USER_DIR : PAGE_KERNEL_DIR)));
  552. }
  553. ul *tmp1;
  554. // 初始化2M物理页
  555. for (ul i = 0; i < (length); i += PAGE_2M_SIZE)
  556. {
  557. // 计算当前2M物理页对应的pdt的页表项的物理地址
  558. if (is_phys)
  559. tmp1 = phys_2_virt(((ul *)(*tmp & (~0xfffUL)) + (((ul)(virt_addr_start + i) >> PAGE_2M_SHIFT) & 0x1ff)));
  560. else
  561. tmp1 = ((ul *)(*tmp & (~0xfffUL)) + (((ul)(virt_addr_start + i) >> PAGE_2M_SHIFT) & 0x1ff));
  562. // 页面写穿,禁止缓存
  563. set_pdt(tmp1, mk_pdt((ul)phys_addr_start + i, flags | (user ? PAGE_USER_PAGE : PAGE_KERNEL_PAGE)));
  564. }
  565. flush_tlb();
  566. }