8xx.c 1.8 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273
  1. // SPDX-License-Identifier: GPL-2.0
  2. #define DISABLE_BRANCH_PROFILING
  3. #include <linux/kasan.h>
  4. #include <linux/memblock.h>
  5. #include <linux/hugetlb.h>
  6. static int __init
  7. kasan_init_shadow_8M(unsigned long k_start, unsigned long k_end, void *block)
  8. {
  9. pmd_t *pmd = pmd_off_k(k_start);
  10. unsigned long k_cur, k_next;
  11. for (k_cur = k_start; k_cur != k_end; k_cur = k_next, pmd += 2, block += SZ_8M) {
  12. pte_basic_t *new;
  13. k_next = pgd_addr_end(k_cur, k_end);
  14. k_next = pgd_addr_end(k_next, k_end);
  15. if ((void *)pmd_page_vaddr(*pmd) != kasan_early_shadow_pte)
  16. continue;
  17. new = memblock_alloc(sizeof(pte_basic_t), SZ_4K);
  18. if (!new)
  19. return -ENOMEM;
  20. *new = pte_val(pte_mkhuge(pfn_pte(PHYS_PFN(__pa(block)), PAGE_KERNEL)));
  21. hugepd_populate_kernel((hugepd_t *)pmd, (pte_t *)new, PAGE_SHIFT_8M);
  22. hugepd_populate_kernel((hugepd_t *)pmd + 1, (pte_t *)new, PAGE_SHIFT_8M);
  23. }
  24. return 0;
  25. }
  26. int __init kasan_init_region(void *start, size_t size)
  27. {
  28. unsigned long k_start = (unsigned long)kasan_mem_to_shadow(start);
  29. unsigned long k_end = (unsigned long)kasan_mem_to_shadow(start + size);
  30. unsigned long k_cur;
  31. int ret;
  32. void *block;
  33. block = memblock_alloc(k_end - k_start, SZ_8M);
  34. if (!block)
  35. return -ENOMEM;
  36. if (IS_ALIGNED(k_start, SZ_8M)) {
  37. kasan_init_shadow_8M(k_start, ALIGN_DOWN(k_end, SZ_8M), block);
  38. k_cur = ALIGN_DOWN(k_end, SZ_8M);
  39. if (k_cur == k_end)
  40. goto finish;
  41. } else {
  42. k_cur = k_start;
  43. }
  44. ret = kasan_init_shadow_page_tables(k_start, k_end);
  45. if (ret)
  46. return ret;
  47. for (; k_cur < k_end; k_cur += PAGE_SIZE) {
  48. pmd_t *pmd = pmd_off_k(k_cur);
  49. void *va = block + k_cur - k_start;
  50. pte_t pte = pfn_pte(PHYS_PFN(__pa(va)), PAGE_KERNEL);
  51. if (k_cur < ALIGN_DOWN(k_end, SZ_512K))
  52. pte = pte_mkhuge(pte);
  53. __set_pte_at(&init_mm, k_cur, pte_offset_kernel(pmd, k_cur), pte, 0);
  54. }
  55. finish:
  56. flush_tlb_kernel_range(k_start, k_end);
  57. return 0;
  58. }