18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 28c2ecf20Sopenharmony_ci 38c2ecf20Sopenharmony_ci#define DISABLE_BRANCH_PROFILING 48c2ecf20Sopenharmony_ci 58c2ecf20Sopenharmony_ci#include <linux/kasan.h> 68c2ecf20Sopenharmony_ci#include <linux/printk.h> 78c2ecf20Sopenharmony_ci#include <linux/memblock.h> 88c2ecf20Sopenharmony_ci#include <linux/sched/task.h> 98c2ecf20Sopenharmony_ci#include <asm/pgalloc.h> 108c2ecf20Sopenharmony_ci#include <asm/code-patching.h> 118c2ecf20Sopenharmony_ci#include <mm/mmu_decl.h> 128c2ecf20Sopenharmony_ci 138c2ecf20Sopenharmony_cistatic pgprot_t __init kasan_prot_ro(void) 148c2ecf20Sopenharmony_ci{ 158c2ecf20Sopenharmony_ci if (early_mmu_has_feature(MMU_FTR_HPTE_TABLE)) 168c2ecf20Sopenharmony_ci return PAGE_READONLY; 178c2ecf20Sopenharmony_ci 188c2ecf20Sopenharmony_ci return PAGE_KERNEL_RO; 198c2ecf20Sopenharmony_ci} 208c2ecf20Sopenharmony_ci 218c2ecf20Sopenharmony_cistatic void __init kasan_populate_pte(pte_t *ptep, pgprot_t prot) 228c2ecf20Sopenharmony_ci{ 238c2ecf20Sopenharmony_ci unsigned long va = (unsigned long)kasan_early_shadow_page; 248c2ecf20Sopenharmony_ci phys_addr_t pa = __pa(kasan_early_shadow_page); 258c2ecf20Sopenharmony_ci int i; 268c2ecf20Sopenharmony_ci 278c2ecf20Sopenharmony_ci for (i = 0; i < PTRS_PER_PTE; i++, ptep++) 288c2ecf20Sopenharmony_ci __set_pte_at(&init_mm, va, ptep, pfn_pte(PHYS_PFN(pa), prot), 0); 298c2ecf20Sopenharmony_ci} 308c2ecf20Sopenharmony_ci 318c2ecf20Sopenharmony_ciint __init kasan_init_shadow_page_tables(unsigned long k_start, unsigned long k_end) 328c2ecf20Sopenharmony_ci{ 338c2ecf20Sopenharmony_ci pmd_t *pmd; 348c2ecf20Sopenharmony_ci unsigned long k_cur, k_next; 358c2ecf20Sopenharmony_ci 368c2ecf20Sopenharmony_ci pmd = pmd_off_k(k_start); 378c2ecf20Sopenharmony_ci 388c2ecf20Sopenharmony_ci for (k_cur = k_start; k_cur != k_end; k_cur = k_next, pmd++) { 398c2ecf20Sopenharmony_ci pte_t *new; 408c2ecf20Sopenharmony_ci 418c2ecf20Sopenharmony_ci k_next = pgd_addr_end(k_cur, k_end); 428c2ecf20Sopenharmony_ci if ((void *)pmd_page_vaddr(*pmd) != kasan_early_shadow_pte) 438c2ecf20Sopenharmony_ci continue; 448c2ecf20Sopenharmony_ci 458c2ecf20Sopenharmony_ci new = memblock_alloc(PTE_FRAG_SIZE, PTE_FRAG_SIZE); 468c2ecf20Sopenharmony_ci 478c2ecf20Sopenharmony_ci if (!new) 488c2ecf20Sopenharmony_ci return -ENOMEM; 498c2ecf20Sopenharmony_ci kasan_populate_pte(new, PAGE_KERNEL); 508c2ecf20Sopenharmony_ci pmd_populate_kernel(&init_mm, pmd, new); 518c2ecf20Sopenharmony_ci } 528c2ecf20Sopenharmony_ci return 0; 538c2ecf20Sopenharmony_ci} 548c2ecf20Sopenharmony_ci 558c2ecf20Sopenharmony_ciint __init __weak kasan_init_region(void *start, size_t size) 568c2ecf20Sopenharmony_ci{ 578c2ecf20Sopenharmony_ci unsigned long k_start = (unsigned long)kasan_mem_to_shadow(start); 588c2ecf20Sopenharmony_ci unsigned long k_end = (unsigned long)kasan_mem_to_shadow(start + size); 598c2ecf20Sopenharmony_ci unsigned long k_cur; 608c2ecf20Sopenharmony_ci int ret; 618c2ecf20Sopenharmony_ci void *block; 628c2ecf20Sopenharmony_ci 638c2ecf20Sopenharmony_ci ret = kasan_init_shadow_page_tables(k_start, k_end); 648c2ecf20Sopenharmony_ci if (ret) 658c2ecf20Sopenharmony_ci return ret; 668c2ecf20Sopenharmony_ci 678c2ecf20Sopenharmony_ci k_start = k_start & PAGE_MASK; 688c2ecf20Sopenharmony_ci block = memblock_alloc(k_end - k_start, PAGE_SIZE); 698c2ecf20Sopenharmony_ci if (!block) 708c2ecf20Sopenharmony_ci return -ENOMEM; 718c2ecf20Sopenharmony_ci 728c2ecf20Sopenharmony_ci for (k_cur = k_start & PAGE_MASK; k_cur < k_end; k_cur += PAGE_SIZE) { 738c2ecf20Sopenharmony_ci pmd_t *pmd = pmd_off_k(k_cur); 748c2ecf20Sopenharmony_ci void *va = block + k_cur - k_start; 758c2ecf20Sopenharmony_ci pte_t pte = pfn_pte(PHYS_PFN(__pa(va)), PAGE_KERNEL); 768c2ecf20Sopenharmony_ci 778c2ecf20Sopenharmony_ci __set_pte_at(&init_mm, k_cur, pte_offset_kernel(pmd, k_cur), pte, 0); 788c2ecf20Sopenharmony_ci } 798c2ecf20Sopenharmony_ci flush_tlb_kernel_range(k_start, k_end); 808c2ecf20Sopenharmony_ci return 0; 818c2ecf20Sopenharmony_ci} 828c2ecf20Sopenharmony_ci 838c2ecf20Sopenharmony_civoid __init 848c2ecf20Sopenharmony_cikasan_update_early_region(unsigned long k_start, unsigned long k_end, pte_t pte) 858c2ecf20Sopenharmony_ci{ 868c2ecf20Sopenharmony_ci unsigned long k_cur; 878c2ecf20Sopenharmony_ci 888c2ecf20Sopenharmony_ci for (k_cur = k_start; k_cur != k_end; k_cur += PAGE_SIZE) { 898c2ecf20Sopenharmony_ci pmd_t *pmd = pmd_off_k(k_cur); 908c2ecf20Sopenharmony_ci pte_t *ptep = pte_offset_kernel(pmd, k_cur); 918c2ecf20Sopenharmony_ci 928c2ecf20Sopenharmony_ci if (pte_page(*ptep) != virt_to_page(lm_alias(kasan_early_shadow_page))) 938c2ecf20Sopenharmony_ci continue; 948c2ecf20Sopenharmony_ci 958c2ecf20Sopenharmony_ci __set_pte_at(&init_mm, k_cur, ptep, pte, 0); 968c2ecf20Sopenharmony_ci } 978c2ecf20Sopenharmony_ci 988c2ecf20Sopenharmony_ci flush_tlb_kernel_range(k_start, k_end); 998c2ecf20Sopenharmony_ci} 1008c2ecf20Sopenharmony_ci 1018c2ecf20Sopenharmony_cistatic void __init kasan_remap_early_shadow_ro(void) 1028c2ecf20Sopenharmony_ci{ 1038c2ecf20Sopenharmony_ci pgprot_t prot = kasan_prot_ro(); 1048c2ecf20Sopenharmony_ci phys_addr_t pa = __pa(kasan_early_shadow_page); 1058c2ecf20Sopenharmony_ci 1068c2ecf20Sopenharmony_ci kasan_populate_pte(kasan_early_shadow_pte, prot); 1078c2ecf20Sopenharmony_ci 1088c2ecf20Sopenharmony_ci kasan_update_early_region(KASAN_SHADOW_START, KASAN_SHADOW_END, 1098c2ecf20Sopenharmony_ci pfn_pte(PHYS_PFN(pa), prot)); 1108c2ecf20Sopenharmony_ci} 1118c2ecf20Sopenharmony_ci 1128c2ecf20Sopenharmony_cistatic void __init kasan_unmap_early_shadow_vmalloc(void) 1138c2ecf20Sopenharmony_ci{ 1148c2ecf20Sopenharmony_ci unsigned long k_start = (unsigned long)kasan_mem_to_shadow((void *)VMALLOC_START); 1158c2ecf20Sopenharmony_ci unsigned long k_end = (unsigned long)kasan_mem_to_shadow((void *)VMALLOC_END); 1168c2ecf20Sopenharmony_ci 1178c2ecf20Sopenharmony_ci kasan_update_early_region(k_start, k_end, __pte(0)); 1188c2ecf20Sopenharmony_ci 1198c2ecf20Sopenharmony_ci#ifdef MODULES_VADDR 1208c2ecf20Sopenharmony_ci k_start = (unsigned long)kasan_mem_to_shadow((void *)MODULES_VADDR); 1218c2ecf20Sopenharmony_ci k_end = (unsigned long)kasan_mem_to_shadow((void *)MODULES_END); 1228c2ecf20Sopenharmony_ci kasan_update_early_region(k_start, k_end, __pte(0)); 1238c2ecf20Sopenharmony_ci#endif 1248c2ecf20Sopenharmony_ci} 1258c2ecf20Sopenharmony_ci 1268c2ecf20Sopenharmony_civoid __init kasan_mmu_init(void) 1278c2ecf20Sopenharmony_ci{ 1288c2ecf20Sopenharmony_ci int ret; 1298c2ecf20Sopenharmony_ci 1308c2ecf20Sopenharmony_ci if (early_mmu_has_feature(MMU_FTR_HPTE_TABLE)) { 1318c2ecf20Sopenharmony_ci ret = kasan_init_shadow_page_tables(KASAN_SHADOW_START, KASAN_SHADOW_END); 1328c2ecf20Sopenharmony_ci 1338c2ecf20Sopenharmony_ci if (ret) 1348c2ecf20Sopenharmony_ci panic("kasan: kasan_init_shadow_page_tables() failed"); 1358c2ecf20Sopenharmony_ci } 1368c2ecf20Sopenharmony_ci} 1378c2ecf20Sopenharmony_ci 1388c2ecf20Sopenharmony_civoid __init kasan_init(void) 1398c2ecf20Sopenharmony_ci{ 1408c2ecf20Sopenharmony_ci phys_addr_t base, end; 1418c2ecf20Sopenharmony_ci u64 i; 1428c2ecf20Sopenharmony_ci int ret; 1438c2ecf20Sopenharmony_ci 1448c2ecf20Sopenharmony_ci for_each_mem_range(i, &base, &end) { 1458c2ecf20Sopenharmony_ci phys_addr_t top = min(end, total_lowmem); 1468c2ecf20Sopenharmony_ci 1478c2ecf20Sopenharmony_ci if (base >= top) 1488c2ecf20Sopenharmony_ci continue; 1498c2ecf20Sopenharmony_ci 1508c2ecf20Sopenharmony_ci ret = kasan_init_region(__va(base), top - base); 1518c2ecf20Sopenharmony_ci if (ret) 1528c2ecf20Sopenharmony_ci panic("kasan: kasan_init_region() failed"); 1538c2ecf20Sopenharmony_ci } 1548c2ecf20Sopenharmony_ci 1558c2ecf20Sopenharmony_ci if (IS_ENABLED(CONFIG_KASAN_VMALLOC)) { 1568c2ecf20Sopenharmony_ci ret = kasan_init_shadow_page_tables(KASAN_SHADOW_START, KASAN_SHADOW_END); 1578c2ecf20Sopenharmony_ci 1588c2ecf20Sopenharmony_ci if (ret) 1598c2ecf20Sopenharmony_ci panic("kasan: kasan_init_shadow_page_tables() failed"); 1608c2ecf20Sopenharmony_ci } 1618c2ecf20Sopenharmony_ci 1628c2ecf20Sopenharmony_ci kasan_remap_early_shadow_ro(); 1638c2ecf20Sopenharmony_ci 1648c2ecf20Sopenharmony_ci clear_page(kasan_early_shadow_page); 1658c2ecf20Sopenharmony_ci 1668c2ecf20Sopenharmony_ci /* At this point kasan is fully initialized. Enable error messages */ 1678c2ecf20Sopenharmony_ci init_task.kasan_depth = 0; 1688c2ecf20Sopenharmony_ci pr_info("KASAN init done\n"); 1698c2ecf20Sopenharmony_ci} 1708c2ecf20Sopenharmony_ci 1718c2ecf20Sopenharmony_civoid __init kasan_late_init(void) 1728c2ecf20Sopenharmony_ci{ 1738c2ecf20Sopenharmony_ci if (IS_ENABLED(CONFIG_KASAN_VMALLOC)) 1748c2ecf20Sopenharmony_ci kasan_unmap_early_shadow_vmalloc(); 1758c2ecf20Sopenharmony_ci} 1768c2ecf20Sopenharmony_ci 1778c2ecf20Sopenharmony_civoid __init kasan_early_init(void) 1788c2ecf20Sopenharmony_ci{ 1798c2ecf20Sopenharmony_ci unsigned long addr = KASAN_SHADOW_START; 1808c2ecf20Sopenharmony_ci unsigned long end = KASAN_SHADOW_END; 1818c2ecf20Sopenharmony_ci unsigned long next; 1828c2ecf20Sopenharmony_ci pmd_t *pmd = pmd_off_k(addr); 1838c2ecf20Sopenharmony_ci 1848c2ecf20Sopenharmony_ci BUILD_BUG_ON(KASAN_SHADOW_START & ~PGDIR_MASK); 1858c2ecf20Sopenharmony_ci 1868c2ecf20Sopenharmony_ci kasan_populate_pte(kasan_early_shadow_pte, PAGE_KERNEL); 1878c2ecf20Sopenharmony_ci 1888c2ecf20Sopenharmony_ci do { 1898c2ecf20Sopenharmony_ci next = pgd_addr_end(addr, end); 1908c2ecf20Sopenharmony_ci pmd_populate_kernel(&init_mm, pmd, kasan_early_shadow_pte); 1918c2ecf20Sopenharmony_ci } while (pmd++, addr = next, addr != end); 1928c2ecf20Sopenharmony_ci} 193