Merge branches 'release' and 'dmi' into release
[linux-2.6] / arch / x86 / kernel / cpu / mtrr / cyrix.c
1 #include <linux/init.h>
2 #include <linux/mm.h>
3 #include <asm/mtrr.h>
4 #include <asm/msr.h>
5 #include <asm/io.h>
6 #include <asm/processor-cyrix.h>
7 #include <asm/processor-flags.h>
8 #include "mtrr.h"
9
10 static void
11 cyrix_get_arr(unsigned int reg, unsigned long *base,
12               unsigned long *size, mtrr_type * type)
13 {
14         unsigned long flags;
15         unsigned char arr, ccr3, rcr, shift;
16
17         arr = CX86_ARR_BASE + (reg << 1) + reg; /* avoid multiplication by 3 */
18
19         /* Save flags and disable interrupts */
20         local_irq_save(flags);
21
22         ccr3 = getCx86(CX86_CCR3);
23         setCx86(CX86_CCR3, (ccr3 & 0x0f) | 0x10);       /* enable MAPEN */
24         ((unsigned char *) base)[3] = getCx86(arr);
25         ((unsigned char *) base)[2] = getCx86(arr + 1);
26         ((unsigned char *) base)[1] = getCx86(arr + 2);
27         rcr = getCx86(CX86_RCR_BASE + reg);
28         setCx86(CX86_CCR3, ccr3);       /* disable MAPEN */
29
30         /* Enable interrupts if it was enabled previously */
31         local_irq_restore(flags);
32         shift = ((unsigned char *) base)[1] & 0x0f;
33         *base >>= PAGE_SHIFT;
34
35         /* Power of two, at least 4K on ARR0-ARR6, 256K on ARR7
36          * Note: shift==0xf means 4G, this is unsupported.
37          */
38         if (shift)
39                 *size = (reg < 7 ? 0x1UL : 0x40UL) << (shift - 1);
40         else
41                 *size = 0;
42
43         /* Bit 0 is Cache Enable on ARR7, Cache Disable on ARR0-ARR6 */
44         if (reg < 7) {
45                 switch (rcr) {
46                 case 1:
47                         *type = MTRR_TYPE_UNCACHABLE;
48                         break;
49                 case 8:
50                         *type = MTRR_TYPE_WRBACK;
51                         break;
52                 case 9:
53                         *type = MTRR_TYPE_WRCOMB;
54                         break;
55                 case 24:
56                 default:
57                         *type = MTRR_TYPE_WRTHROUGH;
58                         break;
59                 }
60         } else {
61                 switch (rcr) {
62                 case 0:
63                         *type = MTRR_TYPE_UNCACHABLE;
64                         break;
65                 case 8:
66                         *type = MTRR_TYPE_WRCOMB;
67                         break;
68                 case 9:
69                         *type = MTRR_TYPE_WRBACK;
70                         break;
71                 case 25:
72                 default:
73                         *type = MTRR_TYPE_WRTHROUGH;
74                         break;
75                 }
76         }
77 }
78
79 static int
80 cyrix_get_free_region(unsigned long base, unsigned long size, int replace_reg)
81 /*  [SUMMARY] Get a free ARR.
82     <base> The starting (base) address of the region.
83     <size> The size (in bytes) of the region.
84     [RETURNS] The index of the region on success, else -1 on error.
85 */
86 {
87         int i;
88         mtrr_type ltype;
89         unsigned long lbase, lsize;
90
91         switch (replace_reg) {
92         case 7:
93                 if (size < 0x40)
94                         break;
95         case 6:
96         case 5:
97         case 4:
98                 return replace_reg;
99         case 3:
100         case 2:
101         case 1:
102         case 0:
103                 return replace_reg;
104         }
105         /* If we are to set up a region >32M then look at ARR7 immediately */
106         if (size > 0x2000) {
107                 cyrix_get_arr(7, &lbase, &lsize, &ltype);
108                 if (lsize == 0)
109                         return 7;
110                 /*  Else try ARR0-ARR6 first  */
111         } else {
112                 for (i = 0; i < 7; i++) {
113                         cyrix_get_arr(i, &lbase, &lsize, &ltype);
114                         if (lsize == 0)
115                                 return i;
116                 }
117                 /* ARR0-ARR6 isn't free, try ARR7 but its size must be at least 256K */
118                 cyrix_get_arr(i, &lbase, &lsize, &ltype);
119                 if ((lsize == 0) && (size >= 0x40))
120                         return i;
121         }
122         return -ENOSPC;
123 }
124
125 static u32 cr4 = 0;
126 static u32 ccr3;
127
128 static void prepare_set(void)
129 {
130         u32 cr0;
131
132         /*  Save value of CR4 and clear Page Global Enable (bit 7)  */
133         if ( cpu_has_pge ) {
134                 cr4 = read_cr4();
135                 write_cr4(cr4 & ~X86_CR4_PGE);
136         }
137
138         /*  Disable and flush caches. Note that wbinvd flushes the TLBs as
139             a side-effect  */
140         cr0 = read_cr0() | X86_CR0_CD;
141         wbinvd();
142         write_cr0(cr0);
143         wbinvd();
144
145         /* Cyrix ARRs - everything else was excluded at the top */
146         ccr3 = getCx86(CX86_CCR3);
147
148         /* Cyrix ARRs - everything else was excluded at the top */
149         setCx86(CX86_CCR3, (ccr3 & 0x0f) | 0x10);
150
151 }
152
153 static void post_set(void)
154 {
155         /*  Flush caches and TLBs  */
156         wbinvd();
157
158         /* Cyrix ARRs - everything else was excluded at the top */
159         setCx86(CX86_CCR3, ccr3);
160                 
161         /*  Enable caches  */
162         write_cr0(read_cr0() & 0xbfffffff);
163
164         /*  Restore value of CR4  */
165         if ( cpu_has_pge )
166                 write_cr4(cr4);
167 }
168
169 static void cyrix_set_arr(unsigned int reg, unsigned long base,
170                           unsigned long size, mtrr_type type)
171 {
172         unsigned char arr, arr_type, arr_size;
173
174         arr = CX86_ARR_BASE + (reg << 1) + reg; /* avoid multiplication by 3 */
175
176         /* count down from 32M (ARR0-ARR6) or from 2G (ARR7) */
177         if (reg >= 7)
178                 size >>= 6;
179
180         size &= 0x7fff;         /* make sure arr_size <= 14 */
181         for (arr_size = 0; size; arr_size++, size >>= 1) ;
182
183         if (reg < 7) {
184                 switch (type) {
185                 case MTRR_TYPE_UNCACHABLE:
186                         arr_type = 1;
187                         break;
188                 case MTRR_TYPE_WRCOMB:
189                         arr_type = 9;
190                         break;
191                 case MTRR_TYPE_WRTHROUGH:
192                         arr_type = 24;
193                         break;
194                 default:
195                         arr_type = 8;
196                         break;
197                 }
198         } else {
199                 switch (type) {
200                 case MTRR_TYPE_UNCACHABLE:
201                         arr_type = 0;
202                         break;
203                 case MTRR_TYPE_WRCOMB:
204                         arr_type = 8;
205                         break;
206                 case MTRR_TYPE_WRTHROUGH:
207                         arr_type = 25;
208                         break;
209                 default:
210                         arr_type = 9;
211                         break;
212                 }
213         }
214
215         prepare_set();
216
217         base <<= PAGE_SHIFT;
218         setCx86(arr, ((unsigned char *) &base)[3]);
219         setCx86(arr + 1, ((unsigned char *) &base)[2]);
220         setCx86(arr + 2, (((unsigned char *) &base)[1]) | arr_size);
221         setCx86(CX86_RCR_BASE + reg, arr_type);
222
223         post_set();
224 }
225
226 typedef struct {
227         unsigned long base;
228         unsigned long size;
229         mtrr_type type;
230 } arr_state_t;
231
232 static arr_state_t arr_state[8] = {
233         {0UL, 0UL, 0UL}, {0UL, 0UL, 0UL}, {0UL, 0UL, 0UL}, {0UL, 0UL, 0UL},
234         {0UL, 0UL, 0UL}, {0UL, 0UL, 0UL}, {0UL, 0UL, 0UL}, {0UL, 0UL, 0UL}
235 };
236
237 static unsigned char ccr_state[7] = { 0, 0, 0, 0, 0, 0, 0 };
238
239 static void cyrix_set_all(void)
240 {
241         int i;
242
243         prepare_set();
244
245         /* the CCRs are not contiguous */
246         for (i = 0; i < 4; i++)
247                 setCx86(CX86_CCR0 + i, ccr_state[i]);
248         for (; i < 7; i++)
249                 setCx86(CX86_CCR4 + i, ccr_state[i]);
250         for (i = 0; i < 8; i++)
251                 cyrix_set_arr(i, arr_state[i].base, 
252                               arr_state[i].size, arr_state[i].type);
253
254         post_set();
255 }
256
257 static struct mtrr_ops cyrix_mtrr_ops = {
258         .vendor            = X86_VENDOR_CYRIX,
259 //      .init              = cyrix_arr_init,
260         .set_all           = cyrix_set_all,
261         .set               = cyrix_set_arr,
262         .get               = cyrix_get_arr,
263         .get_free_region   = cyrix_get_free_region,
264         .validate_add_page = generic_validate_add_page,
265         .have_wrcomb       = positive_have_wrcomb,
266 };
267
268 int __init cyrix_init_mtrr(void)
269 {
270         set_mtrr_ops(&cyrix_mtrr_ops);
271         return 0;
272 }
273
274 //arch_initcall(cyrix_init_mtrr);