?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
allow coexistance of N build and AC build.
[tomato.git] / release / src-rt-6.x / linux / linux-2.6 / arch / i386 / kernel / cpu / mtrr / if.c
blobc7d8f175674525543baa11f712b1241eeb364d67
1 #include <linux/init.h>
2 #include <linux/proc_fs.h>
3 #include <linux/capability.h>
4 #include <linux/ctype.h>
5 #include <linux/module.h>
6 #include <linux/seq_file.h>
7 #include <asm/uaccess.h>
8
9 #define LINE_SIZE 80
10
11 #include <asm/mtrr.h>
12 #include "mtrr.h"
13
14 /* RED-PEN: this is accessed without any locking */
15 extern unsigned int *usage_table;
16
17
18 #define FILE_FCOUNT(f) (((struct seq_file *)((f)->private_data))->private)
19
20 static const char *const mtrr_strings[MTRR_NUM_TYPES] =
21 {
22 "uncachable", /* 0 */
23 "write-combining", /* 1 */
24 "?", /* 2 */
25 "?", /* 3 */
26 "write-through", /* 4 */
27 "write-protect", /* 5 */
28 "write-back", /* 6 */
29 };
30
31 const char *mtrr_attrib_to_str(int x)
32 {
33 return (x <= 6) ? mtrr_strings[x] : "?";
34 }
35
36 #ifdef CONFIG_PROC_FS
37
38 static int
39 mtrr_file_add(unsigned long base, unsigned long size,
40 unsigned int type, char increment, struct file *file, int page)
41 {
42 int reg, max;
43 unsigned int *fcount = FILE_FCOUNT(file);
44
45 max = num_var_ranges;
46 if (fcount == NULL) {
47 fcount = kzalloc(max * sizeof *fcount, GFP_KERNEL);
48 if (!fcount)
49 return -ENOMEM;
50 FILE_FCOUNT(file) = fcount;
51 }
52 if (!page) {
53 if ((base & (PAGE_SIZE - 1)) || (size & (PAGE_SIZE - 1)))
54 return -EINVAL;
55 base >>= PAGE_SHIFT;
56 size >>= PAGE_SHIFT;
57 }
58 reg = mtrr_add_page(base, size, type, 1);
59 if (reg >= 0)
60 ++fcount[reg];
61 return reg;
62 }
63
64 static int
65 mtrr_file_del(unsigned long base, unsigned long size,
66 struct file *file, int page)
67 {
68 int reg;
69 unsigned int *fcount = FILE_FCOUNT(file);
70
71 if (!page) {
72 if ((base & (PAGE_SIZE - 1)) || (size & (PAGE_SIZE - 1)))
73 return -EINVAL;
74 base >>= PAGE_SHIFT;
75 size >>= PAGE_SHIFT;
76 }
77 reg = mtrr_del_page(-1, base, size);
78 if (reg < 0)
79 return reg;
80 if (fcount == NULL)
81 return reg;
82 if (fcount[reg] < 1)
83 return -EINVAL;
84 --fcount[reg];
85 return reg;
86 }
87
88 /* RED-PEN: seq_file can seek now. this is ignored. */
89 static ssize_t
90 mtrr_write(struct file *file, const char __user *buf, size_t len, loff_t * ppos)
91 /* Format of control line:
92 "base=%Lx size=%Lx type=%s" OR:
93 "disable=%d"
94 */
95 {
96 int i, err;
97 unsigned long reg;
98 unsigned long long base, size;
99 char *ptr;
100 char line[LINE_SIZE];
101 size_t linelen;
102
103 if (!capable(CAP_SYS_ADMIN))
104 return -EPERM;
105 if (!len)
106 return -EINVAL;
107 memset(line, 0, LINE_SIZE);
108 if (len > LINE_SIZE)
109 len = LINE_SIZE;
110 if (copy_from_user(line, buf, len - 1))
111 return -EFAULT;
112 linelen = strlen(line);
113 ptr = line + linelen - 1;
114 if (linelen && *ptr == '\n')
115 *ptr = '\0';
116 if (!strncmp(line, "disable=", 8)) {
117 reg = simple_strtoul(line + 8, &ptr, 0);
118 err = mtrr_del_page(reg, 0, 0);
119 if (err < 0)
120 return err;
121 return len;
122 }
123 if (strncmp(line, "base=", 5))
124 return -EINVAL;
125 base = simple_strtoull(line + 5, &ptr, 0);
126 for (; isspace(*ptr); ++ptr) ;
127 if (strncmp(ptr, "size=", 5))
128 return -EINVAL;
129 size = simple_strtoull(ptr + 5, &ptr, 0);
130 if ((base & 0xfff) || (size & 0xfff))
131 return -EINVAL;
132 for (; isspace(*ptr); ++ptr) ;
133 if (strncmp(ptr, "type=", 5))
134 return -EINVAL;
135 ptr += 5;
136 for (; isspace(*ptr); ++ptr) ;
137 for (i = 0; i < MTRR_NUM_TYPES; ++i) {
138 if (strcmp(ptr, mtrr_strings[i]))
139 continue;
140 base >>= PAGE_SHIFT;
141 size >>= PAGE_SHIFT;
142 err =
143 mtrr_add_page((unsigned long) base, (unsigned long) size, i,
144 1);
145 if (err < 0)
146 return err;
147 return len;
148 }
149 return -EINVAL;
150 }
151
152 static long
153 mtrr_ioctl(struct file *file, unsigned int cmd, unsigned long __arg)
154 {
155 int err = 0;
156 mtrr_type type;
157 unsigned long size;
158 struct mtrr_sentry sentry;
159 struct mtrr_gentry gentry;
160 void __user *arg = (void __user *) __arg;
161
162 switch (cmd) {
163 case MTRRIOC_ADD_ENTRY:
164 case MTRRIOC_SET_ENTRY:
165 case MTRRIOC_DEL_ENTRY:
166 case MTRRIOC_KILL_ENTRY:
167 case MTRRIOC_ADD_PAGE_ENTRY:
168 case MTRRIOC_SET_PAGE_ENTRY:
169 case MTRRIOC_DEL_PAGE_ENTRY:
170 case MTRRIOC_KILL_PAGE_ENTRY:
171 if (copy_from_user(&sentry, arg, sizeof sentry))
172 return -EFAULT;
173 break;
174 case MTRRIOC_GET_ENTRY:
175 case MTRRIOC_GET_PAGE_ENTRY:
176 if (copy_from_user(&gentry, arg, sizeof gentry))
177 return -EFAULT;
178 break;
179 #ifdef CONFIG_COMPAT
180 case MTRRIOC32_ADD_ENTRY:
181 case MTRRIOC32_SET_ENTRY:
182 case MTRRIOC32_DEL_ENTRY:
183 case MTRRIOC32_KILL_ENTRY:
184 case MTRRIOC32_ADD_PAGE_ENTRY:
185 case MTRRIOC32_SET_PAGE_ENTRY:
186 case MTRRIOC32_DEL_PAGE_ENTRY:
187 case MTRRIOC32_KILL_PAGE_ENTRY: {
188 struct mtrr_sentry32 __user *s32 = (struct mtrr_sentry32 __user *)__arg;
189 err = get_user(sentry.base, &s32->base);
190 err |= get_user(sentry.size, &s32->size);
191 err |= get_user(sentry.type, &s32->type);
192 if (err)
193 return err;
194 break;
195 }
196 case MTRRIOC32_GET_ENTRY:
197 case MTRRIOC32_GET_PAGE_ENTRY: {
198 struct mtrr_gentry32 __user *g32 = (struct mtrr_gentry32 __user *)__arg;
199 err = get_user(gentry.regnum, &g32->regnum);
200 err |= get_user(gentry.base, &g32->base);
201 err |= get_user(gentry.size, &g32->size);
202 err |= get_user(gentry.type, &g32->type);
203 if (err)
204 return err;
205 break;
206 }
207 #endif
208 }
209
210 switch (cmd) {
211 default:
212 return -ENOTTY;
213 case MTRRIOC_ADD_ENTRY:
214 #ifdef CONFIG_COMPAT
215 case MTRRIOC32_ADD_ENTRY:
216 #endif
217 if (!capable(CAP_SYS_ADMIN))
218 return -EPERM;
219 err =
220 mtrr_file_add(sentry.base, sentry.size, sentry.type, 1,
221 file, 0);
222 break;
223 case MTRRIOC_SET_ENTRY:
224 #ifdef CONFIG_COMPAT
225 case MTRRIOC32_SET_ENTRY:
226 #endif
227 if (!capable(CAP_SYS_ADMIN))
228 return -EPERM;
229 err = mtrr_add(sentry.base, sentry.size, sentry.type, 0);
230 break;
231 case MTRRIOC_DEL_ENTRY:
232 #ifdef CONFIG_COMPAT
233 case MTRRIOC32_DEL_ENTRY:
234 #endif
235 if (!capable(CAP_SYS_ADMIN))
236 return -EPERM;
237 err = mtrr_file_del(sentry.base, sentry.size, file, 0);
238 break;
239 case MTRRIOC_KILL_ENTRY:
240 #ifdef CONFIG_COMPAT
241 case MTRRIOC32_KILL_ENTRY:
242 #endif
243 if (!capable(CAP_SYS_ADMIN))
244 return -EPERM;
245 err = mtrr_del(-1, sentry.base, sentry.size);
246 break;
247 case MTRRIOC_GET_ENTRY:
248 #ifdef CONFIG_COMPAT
249 case MTRRIOC32_GET_ENTRY:
250 #endif
251 if (gentry.regnum >= num_var_ranges)
252 return -EINVAL;
253 mtrr_if->get(gentry.regnum, &gentry.base, &size, &type);
254
255 /* Hide entries that go above 4GB */
256 if (gentry.base + size - 1 >= (1UL << (8 * sizeof(gentry.size) - PAGE_SHIFT))
257 || size >= (1UL << (8 * sizeof(gentry.size) - PAGE_SHIFT)))
258 gentry.base = gentry.size = gentry.type = 0;
259 else {
260 gentry.base <<= PAGE_SHIFT;
261 gentry.size = size << PAGE_SHIFT;
262 gentry.type = type;
263 }
264
265 break;
266 case MTRRIOC_ADD_PAGE_ENTRY:
267 #ifdef CONFIG_COMPAT
268 case MTRRIOC32_ADD_PAGE_ENTRY:
269 #endif
270 if (!capable(CAP_SYS_ADMIN))
271 return -EPERM;
272 err =
273 mtrr_file_add(sentry.base, sentry.size, sentry.type, 1,
274 file, 1);
275 break;
276 case MTRRIOC_SET_PAGE_ENTRY:
277 #ifdef CONFIG_COMPAT
278 case MTRRIOC32_SET_PAGE_ENTRY:
279 #endif
280 if (!capable(CAP_SYS_ADMIN))
281 return -EPERM;
282 err = mtrr_add_page(sentry.base, sentry.size, sentry.type, 0);
283 break;
284 case MTRRIOC_DEL_PAGE_ENTRY:
285 #ifdef CONFIG_COMPAT
286 case MTRRIOC32_DEL_PAGE_ENTRY:
287 #endif
288 if (!capable(CAP_SYS_ADMIN))
289 return -EPERM;
290 err = mtrr_file_del(sentry.base, sentry.size, file, 1);
291 break;
292 case MTRRIOC_KILL_PAGE_ENTRY:
293 #ifdef CONFIG_COMPAT
294 case MTRRIOC32_KILL_PAGE_ENTRY:
295 #endif
296 if (!capable(CAP_SYS_ADMIN))
297 return -EPERM;
298 err = mtrr_del_page(-1, sentry.base, sentry.size);
299 break;
300 case MTRRIOC_GET_PAGE_ENTRY:
301 #ifdef CONFIG_COMPAT
302 case MTRRIOC32_GET_PAGE_ENTRY:
303 #endif
304 if (gentry.regnum >= num_var_ranges)
305 return -EINVAL;
306 mtrr_if->get(gentry.regnum, &gentry.base, &size, &type);
307 /* Hide entries that would overflow */
308 if (size != (__typeof__(gentry.size))size)
309 gentry.base = gentry.size = gentry.type = 0;
310 else {
311 gentry.size = size;
312 gentry.type = type;
313 }
314 break;
315 }
316
317 if (err)
318 return err;
319
320 switch(cmd) {
321 case MTRRIOC_GET_ENTRY:
322 case MTRRIOC_GET_PAGE_ENTRY:
323 if (copy_to_user(arg, &gentry, sizeof gentry))
324 err = -EFAULT;
325 break;
326 #ifdef CONFIG_COMPAT
327 case MTRRIOC32_GET_ENTRY:
328 case MTRRIOC32_GET_PAGE_ENTRY: {
329 struct mtrr_gentry32 __user *g32 = (struct mtrr_gentry32 __user *)__arg;
330 err = put_user(gentry.base, &g32->base);
331 err |= put_user(gentry.size, &g32->size);
332 err |= put_user(gentry.regnum, &g32->regnum);
333 err |= put_user(gentry.type, &g32->type);
334 break;
335 }
336 #endif
337 }
338 return err;
339 }
340
341 static int
342 mtrr_close(struct inode *ino, struct file *file)
343 {
344 int i, max;
345 unsigned int *fcount = FILE_FCOUNT(file);
346
347 if (fcount != NULL) {
348 max = num_var_ranges;
349 for (i = 0; i < max; ++i) {
350 while (fcount[i] > 0) {
351 mtrr_del(i, 0, 0);
352 --fcount[i];
353 }
354 }
355 kfree(fcount);
356 FILE_FCOUNT(file) = NULL;
357 }
358 return single_release(ino, file);
359 }
360
361 static int mtrr_seq_show(struct seq_file *seq, void *offset);
362
363 static int mtrr_open(struct inode *inode, struct file *file)
364 {
365 if (!mtrr_if)
366 return -EIO;
367 if (!mtrr_if->get)
368 return -ENXIO;
369 return single_open(file, mtrr_seq_show, NULL);
370 }
371
372 static const struct file_operations mtrr_fops = {
373 .owner = THIS_MODULE,
374 .open = mtrr_open,
375 .read = seq_read,
376 .llseek = seq_lseek,
377 .write = mtrr_write,
378 .unlocked_ioctl = mtrr_ioctl,
379 .compat_ioctl = mtrr_ioctl,
380 .release = mtrr_close,
381 };
382
383
384 static struct proc_dir_entry *proc_root_mtrr;
385
386
387 static int mtrr_seq_show(struct seq_file *seq, void *offset)
388 {
389 char factor;
390 int i, max, len;
391 mtrr_type type;
392 unsigned long base, size;
393
394 len = 0;
395 max = num_var_ranges;
396 for (i = 0; i < max; i++) {
397 mtrr_if->get(i, &base, &size, &type);
398 if (size == 0)
399 usage_table[i] = 0;
400 else {
401 if (size < (0x100000 >> PAGE_SHIFT)) {
402 /* less than 1MB */
403 factor = 'K';
404 size <<= PAGE_SHIFT - 10;
405 } else {
406 factor = 'M';
407 size >>= 20 - PAGE_SHIFT;
408 }
409 /* RED-PEN: base can be > 32bit */
410 len += seq_printf(seq,
411 "reg%02i: base=0x%05lx000 (%4luMB), size=%4lu%cB: %s, count=%d\n",
412 i, base, base >> (20 - PAGE_SHIFT), size, factor,
413 mtrr_attrib_to_str(type), usage_table[i]);
414 }
415 }
416 return 0;
417 }
418
419 static int __init mtrr_if_init(void)
420 {
421 struct cpuinfo_x86 *c = &boot_cpu_data;
422
423 if ((!cpu_has(c, X86_FEATURE_MTRR)) &&
424 (!cpu_has(c, X86_FEATURE_K6_MTRR)) &&
425 (!cpu_has(c, X86_FEATURE_CYRIX_ARR)) &&
426 (!cpu_has(c, X86_FEATURE_CENTAUR_MCR)))
427 return -ENODEV;
428
429 proc_root_mtrr =
430 create_proc_entry("mtrr", S_IWUSR | S_IRUGO, &proc_root);
431 if (proc_root_mtrr) {
432 proc_root_mtrr->owner = THIS_MODULE;
433 proc_root_mtrr->proc_fops = &mtrr_fops;
434 }
435 return 0;
436 }
437
438 arch_initcall(mtrr_if_init);
439 #endif /* CONFIG_PROC_FS */
Tomato firmware and modifications.