18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci// Copyright (C) 2019 Andes Technology Corporation
38c2ecf20Sopenharmony_ci
48c2ecf20Sopenharmony_ci#include <linux/pfn.h>
58c2ecf20Sopenharmony_ci#include <linux/init_task.h>
68c2ecf20Sopenharmony_ci#include <linux/kasan.h>
78c2ecf20Sopenharmony_ci#include <linux/kernel.h>
88c2ecf20Sopenharmony_ci#include <linux/memblock.h>
98c2ecf20Sopenharmony_ci#include <linux/pgtable.h>
108c2ecf20Sopenharmony_ci#include <asm/tlbflush.h>
118c2ecf20Sopenharmony_ci#include <asm/fixmap.h>
128c2ecf20Sopenharmony_ci
138c2ecf20Sopenharmony_ciextern pgd_t early_pg_dir[PTRS_PER_PGD];
148c2ecf20Sopenharmony_ciasmlinkage void __init kasan_early_init(void)
158c2ecf20Sopenharmony_ci{
168c2ecf20Sopenharmony_ci	uintptr_t i;
178c2ecf20Sopenharmony_ci	pgd_t *pgd = early_pg_dir + pgd_index(KASAN_SHADOW_START);
188c2ecf20Sopenharmony_ci
198c2ecf20Sopenharmony_ci	BUILD_BUG_ON(KASAN_SHADOW_OFFSET !=
208c2ecf20Sopenharmony_ci		KASAN_SHADOW_END - (1UL << (64 - KASAN_SHADOW_SCALE_SHIFT)));
218c2ecf20Sopenharmony_ci
228c2ecf20Sopenharmony_ci	for (i = 0; i < PTRS_PER_PTE; ++i)
238c2ecf20Sopenharmony_ci		set_pte(kasan_early_shadow_pte + i,
248c2ecf20Sopenharmony_ci			pfn_pte(virt_to_pfn(kasan_early_shadow_page), PAGE_KERNEL));
258c2ecf20Sopenharmony_ci
268c2ecf20Sopenharmony_ci	for (i = 0; i < PTRS_PER_PMD; ++i)
278c2ecf20Sopenharmony_ci		set_pmd(kasan_early_shadow_pmd + i,
288c2ecf20Sopenharmony_ci			pfn_pmd(PFN_DOWN
298c2ecf20Sopenharmony_ci				(__pa((uintptr_t) kasan_early_shadow_pte)),
308c2ecf20Sopenharmony_ci				__pgprot(_PAGE_TABLE)));
318c2ecf20Sopenharmony_ci
328c2ecf20Sopenharmony_ci	for (i = KASAN_SHADOW_START; i < KASAN_SHADOW_END;
338c2ecf20Sopenharmony_ci	     i += PGDIR_SIZE, ++pgd)
348c2ecf20Sopenharmony_ci		set_pgd(pgd,
358c2ecf20Sopenharmony_ci			pfn_pgd(PFN_DOWN
368c2ecf20Sopenharmony_ci				(__pa(((uintptr_t) kasan_early_shadow_pmd))),
378c2ecf20Sopenharmony_ci				__pgprot(_PAGE_TABLE)));
388c2ecf20Sopenharmony_ci
398c2ecf20Sopenharmony_ci	/* init for swapper_pg_dir */
408c2ecf20Sopenharmony_ci	pgd = pgd_offset_k(KASAN_SHADOW_START);
418c2ecf20Sopenharmony_ci
428c2ecf20Sopenharmony_ci	for (i = KASAN_SHADOW_START; i < KASAN_SHADOW_END;
438c2ecf20Sopenharmony_ci	     i += PGDIR_SIZE, ++pgd)
448c2ecf20Sopenharmony_ci		set_pgd(pgd,
458c2ecf20Sopenharmony_ci			pfn_pgd(PFN_DOWN
468c2ecf20Sopenharmony_ci				(__pa(((uintptr_t) kasan_early_shadow_pmd))),
478c2ecf20Sopenharmony_ci				__pgprot(_PAGE_TABLE)));
488c2ecf20Sopenharmony_ci
498c2ecf20Sopenharmony_ci	local_flush_tlb_all();
508c2ecf20Sopenharmony_ci}
518c2ecf20Sopenharmony_ci
528c2ecf20Sopenharmony_cistatic void __init populate(void *start, void *end)
538c2ecf20Sopenharmony_ci{
548c2ecf20Sopenharmony_ci	unsigned long i, offset;
558c2ecf20Sopenharmony_ci	unsigned long vaddr = (unsigned long)start & PAGE_MASK;
568c2ecf20Sopenharmony_ci	unsigned long vend = PAGE_ALIGN((unsigned long)end);
578c2ecf20Sopenharmony_ci	unsigned long n_pages = (vend - vaddr) / PAGE_SIZE;
588c2ecf20Sopenharmony_ci	unsigned long n_ptes =
598c2ecf20Sopenharmony_ci	    ((n_pages + PTRS_PER_PTE) & -PTRS_PER_PTE) / PTRS_PER_PTE;
608c2ecf20Sopenharmony_ci	unsigned long n_pmds =
618c2ecf20Sopenharmony_ci	    ((n_ptes + PTRS_PER_PMD) & -PTRS_PER_PMD) / PTRS_PER_PMD;
628c2ecf20Sopenharmony_ci
638c2ecf20Sopenharmony_ci	pte_t *pte =
648c2ecf20Sopenharmony_ci	    memblock_alloc(n_ptes * PTRS_PER_PTE * sizeof(pte_t), PAGE_SIZE);
658c2ecf20Sopenharmony_ci	pmd_t *pmd =
668c2ecf20Sopenharmony_ci	    memblock_alloc(n_pmds * PTRS_PER_PMD * sizeof(pmd_t), PAGE_SIZE);
678c2ecf20Sopenharmony_ci	pgd_t *pgd = pgd_offset_k(vaddr);
688c2ecf20Sopenharmony_ci
698c2ecf20Sopenharmony_ci	for (i = 0; i < n_pages; i++) {
708c2ecf20Sopenharmony_ci		phys_addr_t phys = memblock_phys_alloc(PAGE_SIZE, PAGE_SIZE);
718c2ecf20Sopenharmony_ci		set_pte(&pte[i], pfn_pte(PHYS_PFN(phys), PAGE_KERNEL));
728c2ecf20Sopenharmony_ci	}
738c2ecf20Sopenharmony_ci
748c2ecf20Sopenharmony_ci	for (i = 0, offset = 0; i < n_ptes; i++, offset += PTRS_PER_PTE)
758c2ecf20Sopenharmony_ci		set_pmd(&pmd[i],
768c2ecf20Sopenharmony_ci			pfn_pmd(PFN_DOWN(__pa(&pte[offset])),
778c2ecf20Sopenharmony_ci				__pgprot(_PAGE_TABLE)));
788c2ecf20Sopenharmony_ci
798c2ecf20Sopenharmony_ci	for (i = 0, offset = 0; i < n_pmds; i++, offset += PTRS_PER_PMD)
808c2ecf20Sopenharmony_ci		set_pgd(&pgd[i],
818c2ecf20Sopenharmony_ci			pfn_pgd(PFN_DOWN(__pa(&pmd[offset])),
828c2ecf20Sopenharmony_ci				__pgprot(_PAGE_TABLE)));
838c2ecf20Sopenharmony_ci
848c2ecf20Sopenharmony_ci	local_flush_tlb_all();
858c2ecf20Sopenharmony_ci	memset(start, 0, end - start);
868c2ecf20Sopenharmony_ci}
878c2ecf20Sopenharmony_ci
888c2ecf20Sopenharmony_civoid __init kasan_init(void)
898c2ecf20Sopenharmony_ci{
908c2ecf20Sopenharmony_ci	phys_addr_t p_start, p_end;
918c2ecf20Sopenharmony_ci	u64 i;
928c2ecf20Sopenharmony_ci
938c2ecf20Sopenharmony_ci	/*
948c2ecf20Sopenharmony_ci	 * Populate all kernel virtual address space with kasan_early_shadow_page
958c2ecf20Sopenharmony_ci	 * except for the linear mapping and the modules/kernel/BPF mapping.
968c2ecf20Sopenharmony_ci	 */
978c2ecf20Sopenharmony_ci	kasan_populate_early_shadow((void *)KASAN_SHADOW_START,
988c2ecf20Sopenharmony_ci				    (void *)kasan_mem_to_shadow((void *)
998c2ecf20Sopenharmony_ci								VMALLOC_END));
1008c2ecf20Sopenharmony_ci
1018c2ecf20Sopenharmony_ci	/* Populate the linear mapping */
1028c2ecf20Sopenharmony_ci	for_each_mem_range(i, &p_start, &p_end) {
1038c2ecf20Sopenharmony_ci		void *start = (void *)__va(p_start);
1048c2ecf20Sopenharmony_ci		void *end = (void *)__va(p_end);
1058c2ecf20Sopenharmony_ci
1068c2ecf20Sopenharmony_ci		if (start >= end)
1078c2ecf20Sopenharmony_ci			break;
1088c2ecf20Sopenharmony_ci
1098c2ecf20Sopenharmony_ci		populate(kasan_mem_to_shadow(start), kasan_mem_to_shadow(end));
1108c2ecf20Sopenharmony_ci	};
1118c2ecf20Sopenharmony_ci
1128c2ecf20Sopenharmony_ci	/* Populate kernel, BPF, modules mapping */
1138c2ecf20Sopenharmony_ci	kasan_populate(kasan_mem_to_shadow((const void *)MODULES_VADDR),
1148c2ecf20Sopenharmony_ci		       kasan_mem_to_shadow((const void *)BPF_JIT_REGION_END));
1158c2ecf20Sopenharmony_ci
1168c2ecf20Sopenharmony_ci	for (i = 0; i < PTRS_PER_PTE; i++)
1178c2ecf20Sopenharmony_ci		set_pte(&kasan_early_shadow_pte[i],
1188c2ecf20Sopenharmony_ci			mk_pte(virt_to_page(kasan_early_shadow_page),
1198c2ecf20Sopenharmony_ci			       __pgprot(_PAGE_PRESENT | _PAGE_READ |
1208c2ecf20Sopenharmony_ci					_PAGE_ACCESSED)));
1218c2ecf20Sopenharmony_ci
1228c2ecf20Sopenharmony_ci	memset(kasan_early_shadow_page, 0, PAGE_SIZE);
1238c2ecf20Sopenharmony_ci	init_task.kasan_depth = 0;
1248c2ecf20Sopenharmony_ci}
125