Rev 3770 | Go to most recent revision | Details | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
3743 | rimsky | 1 | # |
2 | # Copyright (c) 2005 Jakub Jermar |
||
3 | # Copyright (c) 2008 Pavel Rimsky |
||
4 | # All rights reserved. |
||
5 | # |
||
6 | # Redistribution and use in source and binary forms, with or without |
||
7 | # modification, are permitted provided that the following conditions |
||
8 | # are met: |
||
9 | # |
||
10 | # - Redistributions of source code must retain the above copyright |
||
11 | # notice, this list of conditions and the following disclaimer. |
||
12 | # - Redistributions in binary form must reproduce the above copyright |
||
13 | # notice, this list of conditions and the following disclaimer in the |
||
14 | # documentation and/or other materials provided with the distribution. |
||
15 | # - The name of the author may not be used to endorse or promote products |
||
16 | # derived from this software without specific prior written permission. |
||
17 | # |
||
18 | # THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
||
19 | # IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
||
20 | # OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
||
21 | # IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
||
22 | # INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
||
23 | # NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
||
24 | # DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
||
25 | # THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
||
26 | # (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
||
27 | # THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
||
28 | # |
||
29 | |||
30 | #include <arch/arch.h> |
||
31 | #include <arch/stack.h> |
||
32 | #include <arch/sun4v/regdef.h> |
||
33 | #include <arch/sun4v/hypercall.h> |
||
34 | #include <arch/mm/sun4v/tte.h> |
||
35 | #include <arch/mm/sun4v/mmu.h> |
||
36 | #include <arch/mm/tlb.h> |
||
37 | |||
38 | .register %g2, #scratch |
||
39 | .register %g3, #scratch |
||
40 | |||
41 | .section K_TEXT_START, "ax" |
||
42 | |||
43 | #define BSP_FLAG 1 |
||
44 | #define PHYSMEM_ADDR_SIZE 56 |
||
45 | |||
46 | /* |
||
47 | * SILO for an unknown reason loads the image to MAPPING_OFFSET + 0x4000 bytes |
||
48 | * from the start of the physical memory. We pretend that the physical memory |
||
49 | * starts MAPPING_OFFSET bytes further than it actually does. |
||
50 | */ |
||
51 | #define MAPPING_OFFSET 0x400000 |
||
52 | |||
53 | /* |
||
54 | * Flags set in the TTE data entry mapping the kernel. |
||
55 | */ |
||
56 | #ifdef CONFIG_VIRT_IDX_DCACHE |
||
57 | #define TTE_FLAGS \ |
||
58 | (1 << TTE_V_SHIFT) \ |
||
59 | | (1 << TTE_EP_SHIFT) \ |
||
60 | | (1 << TTE_CP_SHIFT) \ |
||
61 | | (1 << TTE_CV_SHIFT) \ |
||
62 | | (1 << TTE_P_SHIFT) \ |
||
63 | | (1 << TTE_W_SHIFT) |
||
64 | #else |
||
65 | #define TTE_FLAGS \ |
||
66 | (1 << TTE_V_SHIFT) \ |
||
67 | | (1 << TTE_EP_SHIFT) \ |
||
68 | | (1 << TTE_CP_SHIFT) \ |
||
69 | | (1 << TTE_P_SHIFT) \ |
||
70 | | (1 << TTE_W_SHIFT) |
||
71 | #endif |
||
72 | |||
73 | |||
74 | /* |
||
75 | * Fills a register with a TTE Data item. The item will map the given virtual |
||
76 | * address to a real address which will be computed by adding the starting |
||
77 | * address of the physical memory to the virtual address. |
||
78 | * |
||
79 | * parameters: |
||
80 | * addr: virtual address to be mapped |
||
81 | * rphysmem_start: register containing the starting address of the |
||
82 | * physical memory |
||
83 | * rtmp1: a register to be used as temporary |
||
84 | * rtmp2: a register to be used as temporary |
||
85 | * rd: register where the result will be saved |
||
86 | */ |
||
87 | #define TTE_DATA(addr, rphysmem_start, rtmp1, rtmp2, rd) \ |
||
88 | setx TTE_FLAGS | PAGESIZE_4M, rtmp1, rd; \ |
||
89 | add rd, rphysmem_start, rd; \ |
||
90 | setx (addr), rtmp1, rtmp2; \ |
||
91 | add rd, rtmp2, rd; |
||
92 | |||
93 | /* |
||
94 | * Here is where the kernel is passed control from the boot loader. |
||
95 | * |
||
96 | * The registers are expected to be in this state: |
||
97 | * - %o0 starting address of physical memory + bootstrap processor flag |
||
98 | * bits 63...1: physical memory starting address / 2 |
||
99 | * bit 0: non-zero on BSP processor, zero on AP processors |
||
100 | * - %o1 bootinfo structure address (BSP only) |
||
101 | * - %o2 bootinfo structure size (BSP only) |
||
102 | * |
||
103 | * Moreover, we depend on boot having established the following environment: |
||
104 | * - TLBs are on |
||
105 | * - identity mapping for the kernel image |
||
106 | */ |
||
107 | .global kernel_image_start |
||
108 | kernel_image_start: |
||
109 | mov BSP_FLAG, %l0 |
||
110 | and %o0, %l0, %l7 ! l7 <= bootstrap processor? |
||
111 | andn %o0, %l0, %l6 ! l6 <= start of physical memory |
||
112 | or %o1, %g0, %l1 |
||
113 | or %o2, %g0, %l2 |
||
114 | |||
115 | ! Get bits (PHYSMEM_ADDR_SIZE - 1):13 of physmem_base. |
||
116 | srlx %l6, 13, %l5 |
||
117 | |||
118 | ! l5 <= physmem_base[(PHYSMEM_ADDR_SIZE - 1):13] |
||
119 | sllx %l5, 13 + (63 - (PHYSMEM_ADDR_SIZE - 1)), %l5 |
||
120 | srlx %l5, 63 - (PHYSMEM_ADDR_SIZE - 1), %l5 |
||
121 | |||
122 | ! pretend the physical memory starts further |
||
123 | set MAPPING_OFFSET, %g2 |
||
124 | add %l5, %g2, %l5 |
||
125 | |||
126 | /* |
||
127 | * Setup basic runtime environment. |
||
128 | */ |
||
129 | wrpr %g0, NWINDOWS - 2, %cansave ! set maximum saveable windows |
||
130 | wrpr %g0, 0, %canrestore ! get rid of windows we will |
||
131 | ! never need again |
||
132 | wrpr %g0, 0, %otherwin ! make sure the window state is |
||
133 | ! consistent |
||
134 | wrpr %g0, NWINDOWS - 1, %cleanwin ! prevent needless clean_window |
||
135 | ! traps for kernel |
||
136 | |||
137 | wrpr %g0, 0, %wstate ! use default spill/fill trap |
||
138 | |||
139 | wrpr %g0, 0, %tl ! TL = 0, primary context |
||
140 | ! register is used |
||
141 | |||
142 | wrpr %g0, PSTATE_PRIV_BIT, %pstate ! disable interrupts and disable |
||
143 | ! 32-bit address masking |
||
144 | |||
145 | wrpr %g0, 0, %pil ! intialize %pil |
||
146 | |||
147 | /* |
||
148 | * Switch to kernel trap table. |
||
149 | */ |
||
150 | sethi %hi(trap_table), %g1 |
||
151 | wrpr %g1, %lo(trap_table), %tba |
||
152 | |||
153 | |||
154 | /* |
||
155 | * Take over the MMU. |
||
156 | */ |
||
157 | |||
158 | ! map kernel in context 1 |
||
159 | set kernel_image_start, %o0 ! virt. address |
||
160 | set 1, %o1 ! context |
||
161 | TTE_DATA(kernel_image_start, %l5, %g2, %g3, %o2) ! TTE data |
||
162 | set MMU_FLAG_DTLB | MMU_FLAG_ITLB, %o3 ! MMU flags |
||
163 | __HYPERCALL_HYPERFAST(MMU_MAP_ADDR) |
||
164 | |||
165 | ! switch to context 1 |
||
166 | set 1, %o0 |
||
167 | set VA_PRIMARY_CONTEXT_REG, %o1 |
||
168 | stxa %o0, [%o1] ASI_PRIMARY_CONTEXT_REG |
||
169 | |||
170 | ! demap all in context 0 |
||
171 | set 0, %o0 ! reserved |
||
172 | set 0, %o1 ! reserved |
||
173 | set 0, %o2 ! context |
||
174 | set MMU_FLAG_DTLB | MMU_FLAG_ITLB, %o3 ! MMU flags |
||
175 | __HYPERCALL_FAST(MMU_DEMAP_CTX) |
||
176 | |||
177 | ! install permanent mapping for kernel in context 0 |
||
178 | set kernel_image_start, %o0 ! virtual address |
||
179 | set 0, %o1 ! context |
||
180 | TTE_DATA(kernel_image_start, %l5, %g2, %g3, %o2) ! TTE data |
||
181 | set MMU_FLAG_DTLB | MMU_FLAG_ITLB, %o3 ! MMU flags |
||
182 | __HYPERCALL_FAST(MMU_MAP_PERM_ADDR) |
||
183 | |||
184 | ! switch to context 0 |
||
185 | mov 0, %o0 |
||
186 | set VA_PRIMARY_CONTEXT_REG, %o1 |
||
187 | stxa %o0, [%o1] ASI_PRIMARY_CONTEXT_REG |
||
188 | |||
189 | ! demap all in context 1 (cleanup) |
||
190 | set 0, %o0 ! reserved |
||
191 | set 0, %o1 ! reserved |
||
192 | set 1, %o2 ! context |
||
193 | set MMU_FLAG_DTLB | MMU_FLAG_ITLB, %o3 ! MMU flags |
||
194 | __HYPERCALL_FAST(MMU_DEMAP_CTX) |
||
195 | |||
196 | /* |
||
197 | * Save physmem_base for use by the mm subsystem. |
||
198 | * %l6 contains starting physical address |
||
199 | */ |
||
200 | sethi %hi(physmem_base), %l4 |
||
201 | stx %l6, [%l4 + %lo(physmem_base)] |
||
202 | |||
203 | /* |
||
204 | * So far, we have not touched the stack. |
||
205 | * It is a good idea to set the kernel stack to a known state now. |
||
206 | */ |
||
207 | sethi %hi(temporary_boot_stack), %sp |
||
208 | or %sp, %lo(temporary_boot_stack), %sp |
||
209 | sub %sp, STACK_BIAS, %sp |
||
210 | |||
211 | or %l1, %g0, %o1 |
||
212 | or %l2, %g0, %o2 |
||
213 | sethi %hi(bootinfo), %o0 |
||
214 | call memcpy ! copy bootinfo |
||
215 | or %o0, %lo(bootinfo), %o0 |
||
216 | |||
217 | call arch_pre_main |
||
218 | nop |
||
219 | |||
220 | call main_bsp |
||
221 | nop |
||
222 | |||
223 | /* Not reached. */ |
||
224 | |||
225 | 0: |
||
226 | ba 0b |
||
227 | nop |
||
228 | |||
229 | .section K_DATA_START, "aw", @progbits |
||
230 | |||
231 | #define INITIAL_STACK_SIZE 1024 |
||
232 | |||
233 | .align STACK_ALIGNMENT |
||
234 | .space INITIAL_STACK_SIZE |
||
235 | .align STACK_ALIGNMENT |
||
236 | temporary_boot_stack: |
||
237 | .space STACK_WINDOW_SAVE_AREA_SIZE |
||
238 | |||
239 | |||
240 | .data |
||
241 | |||
242 | .align 8 |
||
243 | .global physmem_base ! copy of the physical memory base address |
||
244 | physmem_base: |
||
245 | .quad 0 |