xref: /OK3568_Linux_fs/kernel/arch/arm64/kvm/hyp/nvhe/hyp-smp.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Copyright (C) 2020 - Google LLC
4*4882a593Smuzhiyun  * Author: David Brazdil <dbrazdil@google.com>
5*4882a593Smuzhiyun  */
6*4882a593Smuzhiyun 
7*4882a593Smuzhiyun #include <asm/kvm_asm.h>
8*4882a593Smuzhiyun #include <asm/kvm_hyp.h>
9*4882a593Smuzhiyun #include <asm/kvm_mmu.h>
10*4882a593Smuzhiyun 
11*4882a593Smuzhiyun /*
12*4882a593Smuzhiyun  * nVHE copy of data structures tracking available CPU cores.
13*4882a593Smuzhiyun  * Only entries for CPUs that were online at KVM init are populated.
14*4882a593Smuzhiyun  * Other CPUs should not be allowed to boot because their features were
15*4882a593Smuzhiyun  * not checked against the finalized system capabilities.
16*4882a593Smuzhiyun  */
17*4882a593Smuzhiyun u64 __ro_after_init hyp_cpu_logical_map[NR_CPUS] = { [0 ... NR_CPUS-1] = INVALID_HWID };
18*4882a593Smuzhiyun 
cpu_logical_map(unsigned int cpu)19*4882a593Smuzhiyun u64 cpu_logical_map(unsigned int cpu)
20*4882a593Smuzhiyun {
21*4882a593Smuzhiyun 	if (cpu >= ARRAY_SIZE(hyp_cpu_logical_map))
22*4882a593Smuzhiyun 		hyp_panic();
23*4882a593Smuzhiyun 
24*4882a593Smuzhiyun 	return hyp_cpu_logical_map[cpu];
25*4882a593Smuzhiyun }
26*4882a593Smuzhiyun 
__hyp_per_cpu_offset(unsigned int cpu)27*4882a593Smuzhiyun unsigned long __hyp_per_cpu_offset(unsigned int cpu)
28*4882a593Smuzhiyun {
29*4882a593Smuzhiyun 	unsigned long *cpu_base_array;
30*4882a593Smuzhiyun 	unsigned long this_cpu_base;
31*4882a593Smuzhiyun 	unsigned long elf_base;
32*4882a593Smuzhiyun 
33*4882a593Smuzhiyun 	if (cpu >= ARRAY_SIZE(kvm_arm_hyp_percpu_base))
34*4882a593Smuzhiyun 		hyp_panic();
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun 	cpu_base_array = (unsigned long *)&kvm_arm_hyp_percpu_base;
37*4882a593Smuzhiyun 	this_cpu_base = kern_hyp_va(cpu_base_array[cpu]);
38*4882a593Smuzhiyun 	elf_base = (unsigned long)&__per_cpu_start;
39*4882a593Smuzhiyun 	return this_cpu_base - elf_base;
40*4882a593Smuzhiyun }
41