Commit | Line | Data |
---|---|---|
092bd143 MZ |
1 | /* |
2 | * Copyright (C) 2012,2013 - ARM Ltd | |
3 | * Author: Marc Zyngier <marc.zyngier@arm.com> | |
4 | * | |
5 | * This program is free software; you can redistribute it and/or modify | |
6 | * it under the terms of the GNU General Public License, version 2, as | |
7 | * published by the Free Software Foundation. | |
8 | * | |
9 | * This program is distributed in the hope that it will be useful, | |
10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
12 | * GNU General Public License for more details. | |
13 | * | |
14 | * You should have received a copy of the GNU General Public License | |
15 | * along with this program. If not, see <http://www.gnu.org/licenses/>. | |
16 | */ | |
17 | ||
18 | #include <linux/linkage.h> | |
19 | ||
20 | #include <asm/assembler.h> | |
21 | #include <asm/kvm_arm.h> | |
22 | #include <asm/kvm_mmu.h> | |
23 | ||
24 | .text | |
25 | .pushsection .hyp.idmap.text, "ax" | |
26 | ||
27 | .align 11 | |
28 | ||
29 | ENTRY(__kvm_hyp_init) | |
30 | ventry __invalid // Synchronous EL2t | |
31 | ventry __invalid // IRQ EL2t | |
32 | ventry __invalid // FIQ EL2t | |
33 | ventry __invalid // Error EL2t | |
34 | ||
35 | ventry __invalid // Synchronous EL2h | |
36 | ventry __invalid // IRQ EL2h | |
37 | ventry __invalid // FIQ EL2h | |
38 | ventry __invalid // Error EL2h | |
39 | ||
40 | ventry __do_hyp_init // Synchronous 64-bit EL1 | |
41 | ventry __invalid // IRQ 64-bit EL1 | |
42 | ventry __invalid // FIQ 64-bit EL1 | |
43 | ventry __invalid // Error 64-bit EL1 | |
44 | ||
45 | ventry __invalid // Synchronous 32-bit EL1 | |
46 | ventry __invalid // IRQ 32-bit EL1 | |
47 | ventry __invalid // FIQ 32-bit EL1 | |
48 | ventry __invalid // Error 32-bit EL1 | |
49 | ||
50 | __invalid: | |
51 | b . | |
52 | ||
53 | /* | |
54 | * x0: HYP boot pgd | |
55 | * x1: HYP pgd | |
56 | * x2: HYP stack | |
57 | * x3: HYP vectors | |
58 | */ | |
59 | __do_hyp_init: | |
60 | ||
61 | msr ttbr0_el2, x0 | |
62 | ||
63 | mrs x4, tcr_el1 | |
64 | ldr x5, =TCR_EL2_MASK | |
65 | and x4, x4, x5 | |
66 | ldr x5, =TCR_EL2_FLAGS | |
67 | orr x4, x4, x5 | |
68 | msr tcr_el2, x4 | |
69 | ||
70 | ldr x4, =VTCR_EL2_FLAGS | |
87366d8c RMC |
71 | /* |
72 | * Read the PARange bits from ID_AA64MMFR0_EL1 and set the PS bits in | |
73 | * VTCR_EL2. | |
74 | */ | |
75 | mrs x5, ID_AA64MMFR0_EL1 | |
76 | bfi x4, x5, #16, #3 | |
092bd143 MZ |
77 | msr vtcr_el2, x4 |
78 | ||
79 | mrs x4, mair_el1 | |
80 | msr mair_el2, x4 | |
81 | isb | |
82 | ||
18ea3dbc MZ |
83 | mrs x4, sctlr_el2 |
84 | and x4, x4, #SCTLR_EL2_EE // preserve endianness of EL2 | |
85 | ldr x5, =SCTLR_EL2_FLAGS | |
86 | orr x4, x4, x5 | |
092bd143 MZ |
87 | msr sctlr_el2, x4 |
88 | isb | |
89 | ||
90 | /* MMU is now enabled. Get ready for the trampoline dance */ | |
91 | ldr x4, =TRAMPOLINE_VA | |
92 | adr x5, target | |
93 | bfi x4, x5, #0, #PAGE_SHIFT | |
94 | br x4 | |
95 | ||
96 | target: /* We're now in the trampoline code, switch page tables */ | |
97 | msr ttbr0_el2, x1 | |
98 | isb | |
99 | ||
100 | /* Invalidate the old TLBs */ | |
101 | tlbi alle2 | |
102 | dsb sy | |
103 | ||
104 | /* Set the stack and new vectors */ | |
105 | kern_hyp_va x2 | |
106 | mov sp, x2 | |
107 | kern_hyp_va x3 | |
108 | msr vbar_el2, x3 | |
109 | ||
110 | /* Hello, World! */ | |
111 | eret | |
112 | ENDPROC(__kvm_hyp_init) | |
113 | ||
114 | .ltorg | |
115 | ||
116 | .popsection |