diff options
Diffstat (limited to 'include/asm-mips/mach-pnx8550/kernel-entry-init.h')
-rw-r--r-- | include/asm-mips/mach-pnx8550/kernel-entry-init.h | 262 |
1 files changed, 0 insertions, 262 deletions
diff --git a/include/asm-mips/mach-pnx8550/kernel-entry-init.h b/include/asm-mips/mach-pnx8550/kernel-entry-init.h deleted file mode 100644 index bdde00c9199b..000000000000 --- a/include/asm-mips/mach-pnx8550/kernel-entry-init.h +++ /dev/null | |||
@@ -1,262 +0,0 @@ | |||
1 | /* | ||
2 | * This file is subject to the terms and conditions of the GNU General Public | ||
3 | * License. See the file "COPYING" in the main directory of this archive | ||
4 | * for more details. | ||
5 | * | ||
6 | * Copyright (C) 2005 Embedded Alley Solutions, Inc | ||
7 | */ | ||
8 | #ifndef __ASM_MACH_KERNEL_ENTRY_INIT_H | ||
9 | #define __ASM_MACH_KERNEL_ENTRY_INIT_H | ||
10 | |||
11 | #include <asm/cacheops.h> | ||
12 | #include <asm/addrspace.h> | ||
13 | |||
14 | #define CO_CONFIGPR_VALID 0x3F1F41FF /* valid bits to write to ConfigPR */ | ||
15 | #define HAZARD_CP0 nop; nop; nop; nop; nop; nop; nop; nop; nop; nop; nop; nop; | ||
16 | #define CACHE_OPC 0xBC000000 /* MIPS cache instruction opcode */ | ||
17 | #define ICACHE_LINE_SIZE 32 /* Instruction cache line size bytes */ | ||
18 | #define DCACHE_LINE_SIZE 32 /* Data cache line size in bytes */ | ||
19 | |||
20 | #define ICACHE_SET_COUNT 256 /* Instruction cache set count */ | ||
21 | #define DCACHE_SET_COUNT 128 /* Data cache set count */ | ||
22 | |||
23 | #define ICACHE_SET_SIZE (ICACHE_SET_COUNT * ICACHE_LINE_SIZE) | ||
24 | #define DCACHE_SET_SIZE (DCACHE_SET_COUNT * DCACHE_LINE_SIZE) | ||
25 | |||
26 | .macro kernel_entry_setup | ||
27 | .set push | ||
28 | .set noreorder | ||
29 | /* | ||
30 | * PNX8550 entry point, when running a non compressed | ||
31 | * kernel. When loading a zImage, the head.S code in | ||
32 | * arch/mips/zboot/pnx8550 will init the caches and, | ||
33 | * decompress the kernel, and branch to kernel_entry. | ||
34 | */ | ||
35 | cache_begin: li t0, (1<<28) | ||
36 | mtc0 t0, CP0_STATUS /* cp0 usable */ | ||
37 | HAZARD_CP0 | ||
38 | |||
39 | mtc0 zero, CP0_CAUSE | ||
40 | HAZARD_CP0 | ||
41 | |||
42 | |||
43 | /* Set static virtual to phys address translation and TLB disabled */ | ||
44 | mfc0 t0, CP0_CONFIG, 7 | ||
45 | HAZARD_CP0 | ||
46 | |||
47 | and t0, ~((1<<19) | (1<<20)) /* TLB/MAP cleared */ | ||
48 | mtc0 t0, CP0_CONFIG, 7 | ||
49 | HAZARD_CP0 | ||
50 | |||
51 | /* CPU boots with kseg0 cache algo set to 0x2 -- uncached */ | ||
52 | |||
53 | init_icache | ||
54 | nop | ||
55 | init_dcache | ||
56 | nop | ||
57 | |||
58 | cachePr4450ICReset | ||
59 | nop | ||
60 | |||
61 | cachePr4450DCReset | ||
62 | nop | ||
63 | |||
64 | /* read ConfigPR into t0 */ | ||
65 | mfc0 t0, CP0_CONFIG, 7 | ||
66 | HAZARD_CP0 | ||
67 | |||
68 | /* enable the TLB */ | ||
69 | or t0, (1<<19) | ||
70 | |||
71 | /* disable the ICACHE: at least 10x slower */ | ||
72 | /* or t0, (1<<26) */ | ||
73 | |||
74 | /* disable the DCACHE; CONFIG_CPU_HAS_LLSC should not be set */ | ||
75 | /* or t0, (1<<27) */ | ||
76 | |||
77 | and t0, CO_CONFIGPR_VALID | ||
78 | |||
79 | /* enable TLB. */ | ||
80 | mtc0 t0, CP0_CONFIG, 7 | ||
81 | HAZARD_CP0 | ||
82 | cache_end: | ||
83 | /* Setup CMEM_0 to MMIO address space, 2MB */ | ||
84 | lui t0, 0x1BE0 | ||
85 | addi t0, t0, 0x3 | ||
86 | mtc0 $8, $22, 4 | ||
87 | nop | ||
88 | |||
89 | /* Setup CMEM_1, 128MB */ | ||
90 | lui t0, 0x1000 | ||
91 | addi t0, t0, 0xf | ||
92 | mtc0 $8, $22, 5 | ||
93 | nop | ||
94 | |||
95 | |||
96 | /* Setup CMEM_2, 32MB */ | ||
97 | lui t0, 0x1C00 | ||
98 | addi t0, t0, 0xb | ||
99 | mtc0 $8, $22, 6 | ||
100 | nop | ||
101 | |||
102 | /* Setup CMEM_3, 0MB */ | ||
103 | lui t0, 0x0 | ||
104 | addi t0, t0, 0x0 | ||
105 | mtc0 $8, $22, 7 | ||
106 | nop | ||
107 | |||
108 | /* Enable cache */ | ||
109 | mfc0 t0, CP0_CONFIG | ||
110 | HAZARD_CP0 | ||
111 | and t0, t0, 0xFFFFFFF8 | ||
112 | or t0, t0, 3 | ||
113 | mtc0 t0, CP0_CONFIG | ||
114 | HAZARD_CP0 | ||
115 | .set pop | ||
116 | .endm | ||
117 | |||
118 | .macro init_icache | ||
119 | .set push | ||
120 | .set noreorder | ||
121 | |||
122 | /* Get Cache Configuration */ | ||
123 | mfc0 t3, CP0_CONFIG, 1 | ||
124 | HAZARD_CP0 | ||
125 | |||
126 | /* get cache Line size */ | ||
127 | |||
128 | srl t1, t3, 19 /* C0_CONFIGPR_IL_SHIFT */ | ||
129 | andi t1, t1, 0x7 /* C0_CONFIGPR_IL_MASK */ | ||
130 | beq t1, zero, pr4450_instr_cache_invalidated /* if zero instruction cache is absent */ | ||
131 | nop | ||
132 | addiu t0, t1, 1 | ||
133 | ori t1, zero, 1 | ||
134 | sllv t1, t1, t0 | ||
135 | |||
136 | /* get max cache Index */ | ||
137 | srl t2, t3, 22 /* C0_CONFIGPR_IS_SHIFT */ | ||
138 | andi t2, t2, 0x7 /* C0_CONFIGPR_IS_MASK */ | ||
139 | addiu t0, t2, 6 | ||
140 | ori t2, zero, 1 | ||
141 | sllv t2, t2, t0 | ||
142 | |||
143 | /* get max cache way */ | ||
144 | srl t3, t3, 16 /* C0_CONFIGPR_IA_SHIFT */ | ||
145 | andi t3, t3, 0x7 /* C0_CONFIGPR_IA_MASK */ | ||
146 | addiu t3, t3, 1 | ||
147 | |||
148 | /* total no of cache lines */ | ||
149 | multu t2, t3 /* max index * max way */ | ||
150 | mflo t2 | ||
151 | addiu t2, t2, -1 | ||
152 | |||
153 | move t0, zero | ||
154 | pr4450_next_instruction_cache_set: | ||
155 | cache Index_Invalidate_I, 0(t0) | ||
156 | addu t0, t0, t1 /* add bytes in a line */ | ||
157 | bne t2, zero, pr4450_next_instruction_cache_set | ||
158 | addiu t2, t2, -1 /* reduce no of lines to invalidate by one */ | ||
159 | pr4450_instr_cache_invalidated: | ||
160 | .set pop | ||
161 | .endm | ||
162 | |||
163 | .macro init_dcache | ||
164 | .set push | ||
165 | .set noreorder | ||
166 | move t1, zero | ||
167 | |||
168 | /* Store Tag Information */ | ||
169 | mtc0 zero, CP0_TAGLO, 0 | ||
170 | HAZARD_CP0 | ||
171 | |||
172 | mtc0 zero, CP0_TAGHI, 0 | ||
173 | HAZARD_CP0 | ||
174 | |||
175 | /* Cache size is 16384 = 512 lines x 32 bytes per line */ | ||
176 | or t2, zero, (128*4)-1 /* 512 lines */ | ||
177 | /* Invalidate all lines */ | ||
178 | 2: | ||
179 | cache Index_Store_Tag_D, 0(t1) | ||
180 | addiu t2, t2, -1 | ||
181 | bne t2, zero, 2b | ||
182 | addiu t1, t1, 32 /* 32 bytes in a line */ | ||
183 | .set pop | ||
184 | .endm | ||
185 | |||
186 | .macro cachePr4450ICReset | ||
187 | .set push | ||
188 | .set noreorder | ||
189 | |||
190 | /* Save CP0 status reg on entry; */ | ||
191 | /* disable interrupts during cache reset */ | ||
192 | mfc0 t0, CP0_STATUS /* T0 = interrupt status on entry */ | ||
193 | HAZARD_CP0 | ||
194 | |||
195 | mtc0 zero, CP0_STATUS /* disable CPU interrupts */ | ||
196 | HAZARD_CP0 | ||
197 | |||
198 | or t1, zero, zero /* T1 = starting cache index (0) */ | ||
199 | ori t2, zero, (256 - 1) /* T2 = inst cache set cnt - 1 */ | ||
200 | |||
201 | icache_invd_loop: | ||
202 | /* 9 == register t1 */ | ||
203 | .word CACHE_OPC | (9 << 21) | (Index_Invalidate_I << 16) | \ | ||
204 | (0 * ICACHE_SET_SIZE) /* invalidate inst cache WAY0 */ | ||
205 | .word CACHE_OPC | (9 << 21) | (Index_Invalidate_I << 16) | \ | ||
206 | (1 * ICACHE_SET_SIZE) /* invalidate inst cache WAY1 */ | ||
207 | |||
208 | addiu t1, t1, ICACHE_LINE_SIZE /* T1 = next cache line index */ | ||
209 | bne t2, zero, icache_invd_loop /* T2 = 0 if all sets invalidated */ | ||
210 | addiu t2, t2, -1 /* decrement T2 set cnt (delay slot) */ | ||
211 | |||
212 | /* Initialize the latches in the instruction cache tag */ | ||
213 | /* that drive the way selection tri-state bus drivers, by doing a */ | ||
214 | /* dummy load while the instruction cache is still disabled. */ | ||
215 | /* TODO: Is this needed ? */ | ||
216 | la t1, KSEG0 /* T1 = cached memory base address */ | ||
217 | lw zero, 0x0000(t1) /* (dummy read of first memory word) */ | ||
218 | |||
219 | mtc0 t0, CP0_STATUS /* restore interrupt status on entry */ | ||
220 | HAZARD_CP0 | ||
221 | .set pop | ||
222 | .endm | ||
223 | |||
224 | .macro cachePr4450DCReset | ||
225 | .set push | ||
226 | .set noreorder | ||
227 | mfc0 t0, CP0_STATUS /* T0 = interrupt status on entry */ | ||
228 | HAZARD_CP0 | ||
229 | mtc0 zero, CP0_STATUS /* disable CPU interrupts */ | ||
230 | HAZARD_CP0 | ||
231 | |||
232 | /* Writeback/invalidate entire data cache sets/ways/lines */ | ||
233 | or t1, zero, zero /* T1 = starting cache index (0) */ | ||
234 | ori t2, zero, (DCACHE_SET_COUNT - 1) /* T2 = data cache set cnt - 1 */ | ||
235 | |||
236 | dcache_wbinvd_loop: | ||
237 | /* 9 == register t1 */ | ||
238 | .word CACHE_OPC | (9 << 21) | (Index_Writeback_Inv_D << 16) | \ | ||
239 | (0 * DCACHE_SET_SIZE) /* writeback/invalidate WAY0 */ | ||
240 | .word CACHE_OPC | (9 << 21) | (Index_Writeback_Inv_D << 16) | \ | ||
241 | (1 * DCACHE_SET_SIZE) /* writeback/invalidate WAY1 */ | ||
242 | .word CACHE_OPC | (9 << 21) | (Index_Writeback_Inv_D << 16) | \ | ||
243 | (2 * DCACHE_SET_SIZE) /* writeback/invalidate WAY2 */ | ||
244 | .word CACHE_OPC | (9 << 21) | (Index_Writeback_Inv_D << 16) | \ | ||
245 | (3 * DCACHE_SET_SIZE) /* writeback/invalidate WAY3 */ | ||
246 | |||
247 | addiu t1, t1, DCACHE_LINE_SIZE /* T1 = next data cache line index */ | ||
248 | bne t2, zero, dcache_wbinvd_loop /* T2 = 0 when wbinvd entire cache */ | ||
249 | addiu t2, t2, -1 /* decrement T2 set cnt (delay slot) */ | ||
250 | |||
251 | /* Initialize the latches in the data cache tag that drive the way | ||
252 | selection tri-state bus drivers, by doing a dummy load while the | ||
253 | data cache is still in the disabled mode. TODO: Is this needed ? */ | ||
254 | la t1, KSEG0 /* T1 = cached memory base address */ | ||
255 | lw zero, 0x0000(t1) /* (dummy read of first memory word) */ | ||
256 | |||
257 | mtc0 t0, CP0_STATUS /* restore interrupt status on entry */ | ||
258 | HAZARD_CP0 | ||
259 | .set pop | ||
260 | .endm | ||
261 | |||
262 | #endif /* __ASM_MACH_KERNEL_ENTRY_INIT_H */ | ||