]> git.kernelconcepts.de Git - karo-tx-uboot.git/blob - cpu/mpc86xx/cache.S
rename CFG_ macros to CONFIG_SYS
[karo-tx-uboot.git] / cpu / mpc86xx / cache.S
1 #include <config.h>
2 #include <mpc86xx.h>
3 #include <version.h>
4
5 #include <ppc_asm.tmpl>
6 #include <ppc_defs.h>
7
8 #include <asm/cache.h>
9 #include <asm/mmu.h>
10
11 #ifndef CACHE_LINE_SIZE
12 # define CACHE_LINE_SIZE L1_CACHE_BYTES
13 #endif
14
15 #if CACHE_LINE_SIZE == 128
16 #define LG_CACHE_LINE_SIZE 7
17 #elif CACHE_LINE_SIZE == 32
18 #define LG_CACHE_LINE_SIZE 5
19 #elif CACHE_LINE_SIZE == 16
20 #define LG_CACHE_LINE_SIZE 4
21 #elif CACHE_LINE_SIZE == 8
22 #define LG_CACHE_LINE_SIZE 3
23 #else
24 # error "Invalid cache line size!"
25 #endif
26
27 /*
28  * Most of this code is taken from 74xx_7xx/cache.S
29  * and then cleaned up a bit
30  */
31
32 /*
33  * Invalidate L1 instruction cache.
34  */
35 _GLOBAL(invalidate_l1_instruction_cache)
36         /* use invalidate-all bit in HID0 */
37         mfspr   r3,HID0
38         ori     r3,r3,HID0_ICFI
39         mtspr   HID0,r3
40         isync
41         blr
42
43 /*
44  * Invalidate L1 data cache.
45  */
46 _GLOBAL(invalidate_l1_data_cache)
47         mfspr   r3,HID0
48         ori     r3,r3,HID0_DCFI
49         mtspr   HID0,r3
50         isync
51         blr
52
53 /*
54  * Flush data cache.
55  */
56 _GLOBAL(flush_dcache)
57         lis     r3,0
58         lis     r5,CACHE_LINE_SIZE
59 flush:
60         cmp     0,1,r3,r5
61         bge     done
62         lwz     r5,0(r3)
63         lis     r5,CACHE_LINE_SIZE
64         addi    r3,r3,0x4
65         b       flush
66 done:
67         blr
68 /*
69  * Write any modified data cache blocks out to memory
70  * and invalidate the corresponding instruction cache blocks.
71  * This is a no-op on the 601.
72  *
73  * flush_icache_range(unsigned long start, unsigned long stop)
74  */
75 _GLOBAL(flush_icache_range)
76         li      r5,CACHE_LINE_SIZE-1
77         andc    r3,r3,r5
78         subf    r4,r3,r4
79         add     r4,r4,r5
80         srwi.   r4,r4,LG_CACHE_LINE_SIZE
81         beqlr
82         mtctr   r4
83         mr      r6,r3
84 1:      dcbst   0,r3
85         addi    r3,r3,CACHE_LINE_SIZE
86         bdnz    1b
87         sync                            /* wait for dcbst's to get to ram */
88         mtctr   r4
89 2:      icbi    0,r6
90         addi    r6,r6,CACHE_LINE_SIZE
91         bdnz    2b
92         sync                            /* additional sync needed on g4 */
93         isync
94         blr
95 /*
96  * Write any modified data cache blocks out to memory.
97  * Does not invalidate the corresponding cache lines (especially for
98  * any corresponding instruction cache).
99  *
100  * clean_dcache_range(unsigned long start, unsigned long stop)
101  */
102 _GLOBAL(clean_dcache_range)
103         li      r5,CACHE_LINE_SIZE-1
104         andc    r3,r3,r5        /* align r3 down to cache line */
105         subf    r4,r3,r4        /* r4 = offset of stop from start of cache line */
106         add     r4,r4,r5        /* r4 += cache_line_size-1 */
107         srwi.   r4,r4,LG_CACHE_LINE_SIZE  /* r4 = number of cache lines to flush */
108         beqlr                             /* if r4 == 0 return */
109         mtctr   r4                        /* ctr = r4 */
110
111         sync
112 1:      dcbst   0,r3
113         addi    r3,r3,CACHE_LINE_SIZE
114         bdnz    1b
115         sync                            /* wait for dcbst's to get to ram */
116         blr
117
118 /*
119  * Write any modified data cache blocks out to memory
120  * and invalidate the corresponding instruction cache blocks.
121  *
122  * flush_dcache_range(unsigned long start, unsigned long stop)
123  */
124 _GLOBAL(flush_dcache_range)
125         li      r5,CACHE_LINE_SIZE-1
126         andc    r3,r3,r5
127         subf    r4,r3,r4
128         add     r4,r4,r5
129         srwi.   r4,r4,LG_CACHE_LINE_SIZE
130         beqlr
131         mtctr   r4
132
133         sync
134 1:      dcbf    0,r3
135         addi    r3,r3,CACHE_LINE_SIZE
136         bdnz    1b
137         sync                            /* wait for dcbf's to get to ram */
138         blr
139
140 /*
141  * Like above, but invalidate the D-cache.  This is used by the 8xx
142  * to invalidate the cache so the PPC core doesn't get stale data
143  * from the CPM (no cache snooping here :-).
144  *
145  * invalidate_dcache_range(unsigned long start, unsigned long stop)
146  */
147 _GLOBAL(invalidate_dcache_range)
148         li      r5,CACHE_LINE_SIZE-1
149         andc    r3,r3,r5
150         subf    r4,r3,r4
151         add     r4,r4,r5
152         srwi.   r4,r4,LG_CACHE_LINE_SIZE
153         beqlr
154         mtctr   r4
155
156         sync
157 1:      dcbi    0,r3
158         addi    r3,r3,CACHE_LINE_SIZE
159         bdnz    1b
160         sync                            /* wait for dcbi's to get to ram */
161         blr
162
163 /*
164  * Flush a particular page from the data cache to RAM.
165  * Note: this is necessary because the instruction cache does *not*
166  * snoop from the data cache.
167  *
168  *      void __flush_page_to_ram(void *page)
169  */
170 _GLOBAL(__flush_page_to_ram)
171         rlwinm  r3,r3,0,0,19            /* Get page base address */
172         li      r4,4096/CACHE_LINE_SIZE /* Number of lines in a page */
173         mtctr   r4
174         mr      r6,r3
175 0:      dcbst   0,r3                    /* Write line to ram */
176         addi    r3,r3,CACHE_LINE_SIZE
177         bdnz    0b
178         sync
179         mtctr   r4
180 1:      icbi    0,r6
181         addi    r6,r6,CACHE_LINE_SIZE
182         bdnz    1b
183         sync
184         isync
185         blr
186
187 /*
188  * Flush a particular page from the instruction cache.
189  * Note: this is necessary because the instruction cache does *not*
190  * snoop from the data cache.
191  *
192  *      void __flush_icache_page(void *page)
193  */
194 _GLOBAL(__flush_icache_page)
195         li      r4,4096/CACHE_LINE_SIZE /* Number of lines in a page */
196         mtctr   r4
197 1:      icbi    0,r3
198         addi    r3,r3,CACHE_LINE_SIZE
199         bdnz    1b
200         sync
201         isync
202         blr
203
204 /*
205  * Clear a page using the dcbz instruction, which doesn't cause any
206  * memory traffic (except to write out any cache lines which get
207  * displaced).  This only works on cacheable memory.
208  */
209 _GLOBAL(clear_page)
210         li      r0,4096/CACHE_LINE_SIZE
211         mtctr   r0
212 1:      dcbz    0,r3
213         addi    r3,r3,CACHE_LINE_SIZE
214         bdnz    1b
215         blr
216
217 /*
218  * Enable L1 Instruction cache
219  */
220 _GLOBAL(icache_enable)
221         mfspr   r3, HID0
222         li      r5, HID0_ICFI|HID0_ILOCK
223         andc    r3, r3, r5
224         ori     r3, r3, HID0_ICE
225         ori     r5, r3, HID0_ICFI
226         mtspr   HID0, r5
227         mtspr   HID0, r3
228         isync
229         blr
230
231 /*
232  * Disable L1 Instruction cache
233  */
234 _GLOBAL(icache_disable)
235         mflr    r4
236         bl      invalidate_l1_instruction_cache         /* uses r3 */
237         sync
238         mtlr    r4
239         mfspr   r3, HID0
240         li      r5, 0
241         ori     r5, r5, HID0_ICE
242         andc    r3, r3, r5
243         mtspr   HID0, r3
244         isync
245         blr
246
247 /*
248  * Is instruction cache enabled?
249  */
250 _GLOBAL(icache_status)
251         mfspr   r3, HID0
252         andi.   r3, r3, HID0_ICE
253         blr
254
255
256 _GLOBAL(l1dcache_enable)
257         mfspr   r3, HID0
258         li      r5, HID0_DCFI|HID0_DLOCK
259         andc    r3, r3, r5
260         mtspr   HID0, r3                /* no invalidate, unlock */
261         ori     r3, r3, HID0_DCE
262         ori     r5, r3, HID0_DCFI
263         mtspr   HID0, r5                /* enable + invalidate */
264         mtspr   HID0, r3                /* enable */
265         sync
266         blr
267
268 /*
269  * Enable data cache(s) - L1 and optionally L2
270  * Calls l2cache_enable. LR saved in r5
271  */
272 _GLOBAL(dcache_enable)
273         mfspr   r3, HID0
274         li      r5, HID0_DCFI|HID0_DLOCK
275         andc    r3, r3, r5
276         mtspr   HID0, r3                /* no invalidate, unlock */
277         ori     r3, r3, HID0_DCE
278         ori     r5, r3, HID0_DCFI
279         mtspr   HID0, r5                /* enable + invalidate */
280         mtspr   HID0, r3                /* enable */
281         sync
282 #ifdef CONFIG_SYS_L2
283         mflr    r5
284         bl      l2cache_enable          /* uses r3 and r4 */
285         sync
286         mtlr    r5
287 #endif
288         blr
289
290
291 /*
292  * Disable data cache(s) - L1 and optionally L2
293  * Calls flush_dcache and l2cache_disable_no_flush.
294  * LR saved in r4
295  */
296 _GLOBAL(dcache_disable)
297         mflr    r4                      /* save link register */
298         bl      flush_dcache    /* uses r3 and r5 */
299         sync
300         mfspr   r3, HID0
301         li      r5, HID0_DCFI|HID0_DLOCK
302         andc    r3, r3, r5
303         mtspr   HID0, r3                /* no invalidate, unlock */
304         li      r5, HID0_DCE|HID0_DCFI
305         andc    r3, r3, r5              /* no enable, no invalidate */
306         mtspr   HID0, r3
307         sync
308 #ifdef CONFIG_SYS_L2
309         bl      l2cache_disable_no_flush /* uses r3 */
310 #endif
311         mtlr    r4                      /* restore link register */
312         blr
313
314 /*
315  * Is data cache enabled?
316  */
317 _GLOBAL(dcache_status)
318         mfspr   r3, HID0
319         andi.   r3, r3, HID0_DCE
320         blr
321
322 /*
323  * Invalidate L2 cache using L2I, assume L2 is enabled
324  */
325 _GLOBAL(l2cache_invalidate)
326         mfspr   r3, l2cr
327         rlwinm. r3, r3, 0, 0, 0
328         beq     1f
329
330         mfspr   r3, l2cr
331         rlwinm  r3, r3, 0, 1, 31
332
333 #ifdef  CONFIG_ALTIVEC
334         dssall
335 #endif
336         sync
337         mtspr   l2cr, r3
338         sync
339 1:      mfspr   r3, l2cr
340         oris    r3, r3, L2CR_L2I@h
341         mtspr   l2cr, r3
342
343 invl2:
344         mfspr   r3, l2cr
345         andis.  r3, r3, L2CR_L2I@h
346         bne     invl2
347         blr
348
349 /*
350  * Enable L2 cache
351  * Calls l2cache_invalidate. LR is saved in r4
352  */
353 _GLOBAL(l2cache_enable)
354         mflr    r4                      /* save link register */
355         bl      l2cache_invalidate      /* uses r3 */
356         sync
357         lis     r3, L2_ENABLE@h
358         ori     r3, r3, L2_ENABLE@l
359         mtspr   l2cr, r3
360         isync
361         mtlr    r4                      /* restore link register */
362         blr
363
364 /*
365  * Disable L2 cache
366  * Calls flush_dcache. LR is saved in r4
367  */
368 _GLOBAL(l2cache_disable)
369         mflr    r4                      /* save link register */
370         bl      flush_dcache            /* uses r3 and r5 */
371         sync
372         mtlr    r4                      /* restore link register */
373 l2cache_disable_no_flush:               /* provide way to disable L2 w/o flushing */
374         lis     r3, L2_INIT@h
375         ori     r3, r3, L2_INIT@l
376         mtspr   l2cr, r3
377         isync
378         blr