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