1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29#include <asm/reg.h>
30#include <asm/page.h>
31#include <asm/cputable.h>
32#include <asm/mmu.h>
33#include <asm/ppc_asm.h>
34#include <asm/asm-offsets.h>
35#include <asm/processor.h>
36#include <asm/bug.h>
37
38
39
40
41
42
43_GLOBAL(__tlbil_va)
44
45
46
47 mfmsr r5
48 mfspr r6,SPRN_PID
49 wrteei 0
50 mtspr SPRN_PID,r4
51 tlbsx. r3, 0, r3
52 mtspr SPRN_PID,r6
53 wrtee r5
54 bne 1f
55 sync
56
57
58
59 tlbwe r3, r3, TLB_TAG
60 isync
611: blr
62
63
64
65
66
67
68
69
70
71
72
73
74
75_GLOBAL(__tlbil_va)
76 mfspr r5,SPRN_MMUCR
77 mfmsr r10
78
79
80
81
82
83 rlwimi r5,r4,0,16,31
84
85
86
87
88
89
90
91
92
93 wrteei 0
94 mtspr SPRN_MMUCR,r5
95 tlbsx. r6,0,r3
96 bne 10f
97 sync
98BEGIN_MMU_FTR_SECTION
99 b 2f
100END_MMU_FTR_SECTION_IFSET(MMU_FTR_TYPE_47x)
101
102
103
104
105 tlbwe r6,r6,PPC44x_TLB_PAGEID
106 isync
10710: wrtee r10
108 blr
1092:
110#ifdef CONFIG_PPC_47x
111 oris r7,r6,0x8000
112 clrrwi r4,r3,12
113 ori r4,r4,PPC47x_TLBE_SIZE
114 tlbwe r4,r7,0
115 isync
116 wrtee r10
117 blr
118#else
1191: trap
120 EMIT_BUG_ENTRY 1b,__FILE__,__LINE__,0;
121#endif
122
123_GLOBAL(_tlbil_all)
124_GLOBAL(_tlbil_pid)
125BEGIN_MMU_FTR_SECTION
126 b 2f
127END_MMU_FTR_SECTION_IFSET(MMU_FTR_TYPE_47x)
128 li r3,0
129 sync
130
131
132 lis r4,tlb_44x_hwater@ha
133 lwz r5,tlb_44x_hwater@l(r4)
134
1351: tlbwe r3,r3,PPC44x_TLB_PAGEID
136 addi r3,r3,1
137 cmpw 0,r3,r5
138 ble 1b
139
140 isync
141 blr
1422:
143#ifdef CONFIG_PPC_47x
144
145
146
147 mfmsr r11
148 wrteei 0
149 li r3,-1
150 lis r10,tlb_47x_boltmap@h
151 ori r10,r10,tlb_47x_boltmap@l
152 lis r7,0x8000
153
154 b 9f
155
1561: li r9,4
157 li r4,0
158 li r6,0
159 andi. r0,r8,1
160 mtctr r9
161 bne- 3f
162
1632:
164 or r5,r3,r4
165 rlwimi r5,r5,16,8,15
166 tlbre r6,r5,0
1673: addis r4,r4,0x2000
168 andi. r0,r6,PPC47x_TLB0_VALID
169 beq 4f
170 rlwimi r7,r5,0,1,2
171 rlwinm r6,r6,0,21,19
172 tlbwe r6,r7,0
1734: bdnz 2b
174 srwi r8,r8,1
1759: cmpwi cr1,r3,255
176 addi r3,r3,1
177 beq cr1,1f
178 andi. r0,r3,0x1f
179 bne 1b
180 lwz r8,0(r10)
181 addi r10,r10,4
182 b 1b
1831: isync
184 wrtee r11
185#else
1861: trap
187 EMIT_BUG_ENTRY 1b,__FILE__,__LINE__,0;
188#endif
189 blr
190
191#ifdef CONFIG_PPC_47x
192
193
194
195
196
197_GLOBAL(_tlbivax_bcast)
198 mfspr r5,SPRN_MMUCR
199 mfmsr r10
200 rlwimi r5,r4,0,16,31
201 wrteei 0
202 mtspr SPRN_MMUCR,r5
203 isync
204
205 .long 0x7c000624 | (r3 << 11)
206 isync
207 eieio
208 tlbsync
209 sync
210 wrtee r10
211 blr
212#endif
213
214
215
216
217
218
219
220
221
222
223
224
225_GLOBAL(_tlbil_all)
226BEGIN_MMU_FTR_SECTION
227 li r3,(MMUCSR0_TLBFI)@l
228 mtspr SPRN_MMUCSR0, r3
2291:
230 mfspr r3,SPRN_MMUCSR0
231 andi. r3,r3,MMUCSR0_TLBFI@l
232 bne 1b
233MMU_FTR_SECTION_ELSE
234 PPC_TLBILX_ALL(0,0)
235ALT_MMU_FTR_SECTION_END_IFCLR(MMU_FTR_USE_TLBILX)
236 msync
237 isync
238 blr
239
240_GLOBAL(_tlbil_pid)
241BEGIN_MMU_FTR_SECTION
242 slwi r3,r3,16
243 mfmsr r10
244 wrteei 0
245 mfspr r4,SPRN_MAS6
246 mtspr SPRN_MAS6,r3
247 PPC_TLBILX_PID(0,0)
248 mtspr SPRN_MAS6,r4
249 wrtee r10
250MMU_FTR_SECTION_ELSE
251 li r3,(MMUCSR0_TLBFI)@l
252 mtspr SPRN_MMUCSR0, r3
2531:
254 mfspr r3,SPRN_MMUCSR0
255 andi. r3,r3,MMUCSR0_TLBFI@l
256 bne 1b
257ALT_MMU_FTR_SECTION_END_IFSET(MMU_FTR_USE_TLBILX)
258 msync
259 isync
260 blr
261
262
263
264
265
266_GLOBAL(__tlbil_va)
267 mfmsr r10
268 wrteei 0
269 slwi r4,r4,16
270 ori r4,r4,(MAS6_ISIZE(BOOK3E_PAGESZ_4K))@l
271 mtspr SPRN_MAS6,r4
272BEGIN_MMU_FTR_SECTION
273 tlbsx 0,r3
274 mfspr r4,SPRN_MAS1
275 andis. r3,r4,MAS1_VALID@h
276 beq 1f
277 rlwinm r4,r4,0,1,31
278 mtspr SPRN_MAS1,r4
279 tlbwe
280MMU_FTR_SECTION_ELSE
281 PPC_TLBILX_VA(0,r3)
282ALT_MMU_FTR_SECTION_END_IFCLR(MMU_FTR_USE_TLBILX)
283 msync
284 isync
2851: wrtee r10
286 blr
287
288
289
290
291
292
293
294_GLOBAL(_tlbil_pid)
295 slwi r4,r3,MAS6_SPID_SHIFT
296 mfmsr r10
297 wrteei 0
298 mtspr SPRN_MAS6,r4
299 PPC_TLBILX_PID(0,0)
300 wrtee r10
301 msync
302 isync
303 blr
304
305_GLOBAL(_tlbil_pid_noind)
306 slwi r4,r3,MAS6_SPID_SHIFT
307 mfmsr r10
308 ori r4,r4,MAS6_SIND
309 wrteei 0
310 mtspr SPRN_MAS6,r4
311 PPC_TLBILX_PID(0,0)
312 wrtee r10
313 msync
314 isync
315 blr
316
317_GLOBAL(_tlbil_all)
318 PPC_TLBILX_ALL(0,0)
319 msync
320 isync
321 blr
322
323_GLOBAL(_tlbil_va)
324 mfmsr r10
325 wrteei 0
326 cmpwi cr0,r6,0
327 slwi r4,r4,MAS6_SPID_SHIFT
328 rlwimi r4,r5,MAS6_ISIZE_SHIFT,MAS6_ISIZE_MASK
329 beq 1f
330 rlwimi r4,r6,MAS6_SIND_SHIFT,MAS6_SIND
3311: mtspr SPRN_MAS6,r4
332 PPC_TLBILX_VA(0,r3)
333 msync
334 isync
335 wrtee r10
336 blr
337
338_GLOBAL(_tlbivax_bcast)
339 mfmsr r10
340 wrteei 0
341 cmpwi cr0,r6,0
342 slwi r4,r4,MAS6_SPID_SHIFT
343 rlwimi r4,r5,MAS6_ISIZE_SHIFT,MAS6_ISIZE_MASK
344 beq 1f
345 rlwimi r4,r6,MAS6_SIND_SHIFT,MAS6_SIND
3461: mtspr SPRN_MAS6,r4
347 PPC_TLBIVAX(0,r3)
348 eieio
349 tlbsync
350 sync
351 wrtee r10
352 blr
353
354_GLOBAL(set_context)
355#ifdef CONFIG_BDI_SWITCH
356
357
358
359 lis r5, abatron_pteptrs@h
360 ori r5, r5, abatron_pteptrs@l
361 stw r4, 0x4(r5)
362#endif
363 mtspr SPRN_PID,r3
364 isync
365 blr
366#else
367
368#endif
369
370
371
372
373
374
375
376_GLOBAL(loadcam_entry)
377 LOAD_REG_ADDR(r4, TLBCAM)
378 mulli r5,r3,TLBCAM_SIZE
379 add r3,r5,r4
380 lwz r4,TLBCAM_MAS0(r3)
381 mtspr SPRN_MAS0,r4
382 lwz r4,TLBCAM_MAS1(r3)
383 mtspr SPRN_MAS1,r4
384 PPC_LL r4,TLBCAM_MAS2(r3)
385 mtspr SPRN_MAS2,r4
386 lwz r4,TLBCAM_MAS3(r3)
387 mtspr SPRN_MAS3,r4
388BEGIN_MMU_FTR_SECTION
389 lwz r4,TLBCAM_MAS7(r3)
390 mtspr SPRN_MAS7,r4
391END_MMU_FTR_SECTION_IFSET(MMU_FTR_BIG_PHYS)
392 isync
393 tlbwe
394 isync
395 blr
396#endif
397