]>
Commit | Line | Data |
---|---|---|
b02bad12 NI |
1 | /* |
2 | * (C) Copyright 2007 | |
3 | * Nobuhiro Iwamatsu <iwamatsu@nigauri.org> | |
4 | * | |
5 | * See file CREDITS for list of people who contributed to this | |
6 | * project. | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or | |
9 | * modify it under the terms of the GNU General Public License as | |
10 | * published by the Free Software Foundation; either version 2 of | |
11 | * the License, or (at your option) any later version. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, | |
14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
16 | * GNU General Public License for more details. | |
17 | * | |
18 | * You should have received a copy of the GNU General Public License | |
19 | * along with this program; if not, write to the Free Software | |
20 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, | |
21 | * MA 02111-1307 USA | |
22 | */ | |
23 | ||
24 | #include <common.h> | |
25 | #include <command.h> | |
26 | #include <asm/processor.h> | |
27 | #include <asm/io.h> | |
28 | ||
29 | /* | |
30 | * Jump to P2 area. | |
31 | * When handling TLB or caches, we need to do it from P2 area. | |
32 | */ | |
61fb15c5 WD |
33 | #define jump_to_P2() \ |
34 | do { \ | |
b02bad12 | 35 | unsigned long __dummy; \ |
61fb15c5 WD |
36 | __asm__ __volatile__( \ |
37 | "mov.l 1f, %0\n\t" \ | |
38 | "or %1, %0\n\t" \ | |
39 | "jmp @%0\n\t" \ | |
40 | " nop\n\t" \ | |
41 | ".balign 4\n" \ | |
42 | "1: .long 2f\n" \ | |
43 | "2:" \ | |
44 | : "=&r" (__dummy) \ | |
45 | : "r" (0x20000000)); \ | |
b02bad12 NI |
46 | } while (0) |
47 | ||
48 | /* | |
49 | * Back to P1 area. | |
50 | */ | |
61fb15c5 WD |
51 | #define back_to_P1() \ |
52 | do { \ | |
53 | unsigned long __dummy; \ | |
54 | __asm__ __volatile__( \ | |
55 | "nop;nop;nop;nop;nop;nop;nop\n\t" \ | |
56 | "mov.l 1f, %0\n\t" \ | |
57 | "jmp @%0\n\t" \ | |
58 | " nop\n\t" \ | |
59 | ".balign 4\n" \ | |
60 | "1: .long 2f\n" \ | |
61 | "2:" \ | |
62 | : "=&r" (__dummy)); \ | |
b02bad12 NI |
63 | } while (0) |
64 | ||
65 | #define CACHE_VALID 1 | |
66 | #define CACHE_UPDATED 2 | |
67 | ||
68 | static inline void cache_wback_all(void) | |
69 | { | |
70 | unsigned long addr, data, i, j; | |
71 | ||
72 | jump_to_P2(); | |
73 | for (i = 0; i < CACHE_OC_NUM_ENTRIES; i++){ | |
74 | for (j = 0; j < CACHE_OC_NUM_WAYS; j++) { | |
53677ef1 | 75 | addr = CACHE_OC_ADDRESS_ARRAY | (j << CACHE_OC_WAY_SHIFT) |
b02bad12 | 76 | | (i << CACHE_OC_ENTRY_SHIFT); |
53677ef1 | 77 | data = inl(addr); |
b02bad12 NI |
78 | if (data & CACHE_UPDATED) { |
79 | data &= ~CACHE_UPDATED; | |
80 | outl(data, addr); | |
81 | } | |
82 | } | |
83 | } | |
84 | back_to_P1(); | |
85 | } | |
86 | ||
87 | ||
88 | #define CACHE_ENABLE 0 | |
89 | #define CACHE_DISABLE 1 | |
90 | ||
91 | int cache_control(unsigned int cmd) | |
92 | { | |
93 | unsigned long ccr; | |
94 | ||
95 | jump_to_P2(); | |
96 | ccr = inl(CCR); | |
97 | ||
98 | if (ccr & CCR_CACHE_ENABLE) | |
99 | cache_wback_all(); | |
100 | ||
101 | if (cmd == CACHE_DISABLE) | |
102 | outl(CCR_CACHE_STOP, CCR); | |
103 | else | |
104 | outl(CCR_CACHE_INIT, CCR); | |
105 | back_to_P1(); | |
106 | ||
107 | return 0; | |
108 | } |