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