This source file includes following definitions.
- i686_mtrr2mrt
- i686_mtrrconflict
- mem_range_match
- i686_mrfetch
- i686_mtrrtype
- i686_mrt2mtrr
- i686_mrstore
- i686_mrstoreone
- i686_mtrrfixsearch
- i686_mrsetlow
- i686_mrsetvariable
- i686_mrset
- i686_mrinit
- i686_mrAPinit
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
30 #include <sys/param.h>
31 #include <sys/kernel.h>
32 #include <sys/systm.h>
33 #include <sys/malloc.h>
34 #include <sys/memrange.h>
35
36 #include <machine/cpufunc.h>
37 #include <machine/specialreg.h>
38
39
40
41
42
43
44
45
46 char *mem_owner_bios = "BIOS";
47
48 #define MR686_FIXMTRR (1<<0)
49
50 #define mrwithin(mr, a) \
51 (((a) >= (mr)->mr_base) && ((a) < ((mr)->mr_base + (mr)->mr_len)))
52 #define mroverlap(mra, mrb) \
53 (mrwithin(mra, mrb->mr_base) || mrwithin(mrb, mra->mr_base))
54
55 #define mrvalid(base, len) \
56 ((!(base & ((1 << 12) - 1))) && \
57 ((len) >= (1 << 12)) && \
58 powerof2((len)) && \
59 !((base) & ((len) - 1)))
60
61 #define mrcopyflags(curr, new) (((curr) & ~MDF_ATTRMASK) | ((new) & MDF_ATTRMASK))
62
63 void i686_mrinit(struct mem_range_softc *sc);
64 int i686_mrset(struct mem_range_softc *sc,
65 struct mem_range_desc *mrd,
66 int *arg);
67 void i686_mrAPinit(struct mem_range_softc *sc);
68
69 struct mem_range_ops i686_mrops = {
70 i686_mrinit,
71 i686_mrset,
72 i686_mrAPinit
73 };
74
75
76 u_int64_t mtrrcap, mtrrdef;
77
78 struct mem_range_desc *mem_range_match(struct mem_range_softc *sc,
79 struct mem_range_desc *mrd);
80 void i686_mrfetch(struct mem_range_softc *sc);
81 int i686_mtrrtype(int flags);
82 int i686_mrt2mtrr(int flags, int oldval);
83 int i686_mtrr2mrt(int val);
84 int i686_mtrrconflict(int flag1, int flag2);
85 void i686_mrstore(struct mem_range_softc *sc);
86 void i686_mrstoreone(void *arg);
87 struct mem_range_desc *i686_mtrrfixsearch(struct mem_range_softc *sc,
88 u_int64_t addr);
89 int i686_mrsetlow(struct mem_range_softc *sc,
90 struct mem_range_desc *mrd,
91 int *arg);
92 int i686_mrsetvariable(struct mem_range_softc *sc,
93 struct mem_range_desc *mrd,
94 int *arg);
95
96
97 int i686_mtrrtomrt[] = {
98 MDF_UNCACHEABLE,
99 MDF_WRITECOMBINE,
100 MDF_UNKNOWN,
101 MDF_UNKNOWN,
102 MDF_WRITETHROUGH,
103 MDF_WRITEPROTECT,
104 MDF_WRITEBACK
105 };
106
107 #define MTRRTOMRTLEN (sizeof(i686_mtrrtomrt) / sizeof(i686_mtrrtomrt[0]))
108
109 int
110 i686_mtrr2mrt(int val)
111 {
112 if (val < 0 || val >= MTRRTOMRTLEN)
113 return MDF_UNKNOWN;
114 return i686_mtrrtomrt[val];
115 }
116
117
118
119
120 int
121 i686_mtrrconflict(int flag1, int flag2)
122 {
123
124 flag1 &= MDF_ATTRMASK;
125 flag2 &= MDF_ATTRMASK;
126 if (flag1 == flag2 ||
127 (flag1 == MDF_WRITEBACK && flag2 == MDF_UNCACHEABLE) ||
128 (flag2 == MDF_WRITEBACK && flag1 == MDF_UNCACHEABLE))
129 return 0;
130 return 1;
131 }
132
133
134
135
136 struct mem_range_desc *
137 mem_range_match(struct mem_range_softc *sc, struct mem_range_desc *mrd)
138 {
139 struct mem_range_desc *cand;
140 int i;
141
142 for (i = 0, cand = sc->mr_desc; i < sc->mr_ndesc; i++, cand++)
143 if ((cand->mr_base == mrd->mr_base) &&
144 (cand->mr_len == mrd->mr_len))
145 return(cand);
146 return(NULL);
147 }
148
149
150
151
152
153
154 void
155 i686_mrfetch(struct mem_range_softc *sc)
156 {
157 struct mem_range_desc *mrd;
158 u_int64_t msrv;
159 int i, j, msr;
160
161 mrd = sc->mr_desc;
162
163
164 if (sc->mr_cap & MR686_FIXMTRR) {
165 msr = MSR_MTRR64kBase;
166 for (i = 0; i < (MTRR_N64K / 8); i++, msr++) {
167 msrv = rdmsr(msr);
168 for (j = 0; j < 8; j++, mrd++) {
169 mrd->mr_flags = (mrd->mr_flags & ~MDF_ATTRMASK) |
170 i686_mtrr2mrt(msrv & 0xff) |
171 MDF_ACTIVE;
172 if (mrd->mr_owner[0] == 0)
173 strlcpy(mrd->mr_owner, mem_owner_bios,
174 sizeof(mrd->mr_owner));
175 msrv = msrv >> 8;
176 }
177 }
178 msr = MSR_MTRR16kBase;
179 for (i = 0; i < (MTRR_N16K / 8); i++, msr++) {
180 msrv = rdmsr(msr);
181 for (j = 0; j < 8; j++, mrd++) {
182 mrd->mr_flags = (mrd->mr_flags & ~MDF_ATTRMASK) |
183 i686_mtrr2mrt(msrv & 0xff) |
184 MDF_ACTIVE;
185 if (mrd->mr_owner[0] == 0)
186 strlcpy(mrd->mr_owner, mem_owner_bios,
187 sizeof(mrd->mr_owner));
188 msrv = msrv >> 8;
189 }
190 }
191 msr = MSR_MTRR4kBase;
192 for (i = 0; i < (MTRR_N4K / 8); i++, msr++) {
193 msrv = rdmsr(msr);
194 for (j = 0; j < 8; j++, mrd++) {
195 mrd->mr_flags = (mrd->mr_flags & ~MDF_ATTRMASK) |
196 i686_mtrr2mrt(msrv & 0xff) |
197 MDF_ACTIVE;
198 if (mrd->mr_owner[0] == 0)
199 strlcpy(mrd->mr_owner, mem_owner_bios,
200 sizeof(mrd->mr_owner));
201 msrv = msrv >> 8;
202 }
203 }
204 }
205
206
207 msr = MSR_MTRRVarBase;
208 for (; (mrd - sc->mr_desc) < sc->mr_ndesc; msr += 2, mrd++) {
209 msrv = rdmsr(msr);
210 mrd->mr_flags = (mrd->mr_flags & ~MDF_ATTRMASK) |
211 i686_mtrr2mrt(msrv & 0xff);
212 mrd->mr_base = msrv & 0x0000000ffffff000LL;
213 msrv = rdmsr(msr + 1);
214 mrd->mr_flags = (msrv & 0x800) ?
215 (mrd->mr_flags | MDF_ACTIVE) :
216 (mrd->mr_flags & ~MDF_ACTIVE);
217
218 mrd->mr_len = (~(msrv & 0x0000000ffffff000LL) & 0x0000000fffffffffLL) + 1;
219 if (!mrvalid(mrd->mr_base, mrd->mr_len))
220 mrd->mr_flags |= MDF_BOGUS;
221
222 if ((mrd->mr_flags & MDF_ACTIVE) && (mrd->mr_owner[0] == 0))
223 strlcpy(mrd->mr_owner, mem_owner_bios,
224 sizeof(mrd->mr_owner));
225 }
226 }
227
228
229
230
231 int
232 i686_mtrrtype(int flags)
233 {
234 int i;
235
236 flags &= MDF_ATTRMASK;
237
238 for (i = 0; i < MTRRTOMRTLEN; i++) {
239 if (i686_mtrrtomrt[i] == MDF_UNKNOWN)
240 continue;
241 if (flags == i686_mtrrtomrt[i])
242 return(i);
243 }
244 return(-1);
245 }
246
247 int
248 i686_mrt2mtrr(int flags, int oldval)
249 {
250 int val;
251
252 if ((val = i686_mtrrtype(flags)) == -1)
253 return oldval & 0xff;
254 return val & 0xff;
255 }
256
257
258
259
260
261
262
263 void
264 i686_mrstore(struct mem_range_softc *sc)
265 {
266 disable_intr();
267 i686_mrstoreone((void *)sc);
268 enable_intr();
269 }
270
271
272
273
274
275
276 void
277 i686_mrstoreone(void *arg)
278 {
279 struct mem_range_softc *sc = (struct mem_range_softc *)arg;
280 struct mem_range_desc *mrd;
281 u_int64_t omsrv, msrv;
282 int i, j, msr;
283 u_int cr4save;
284
285 mrd = sc->mr_desc;
286
287 cr4save = rcr4();
288 if (cr4save & CR4_PGE)
289 lcr4(cr4save & ~CR4_PGE);
290 lcr0((rcr0() & ~CR0_NW) | CR0_CD);
291 wbinvd();
292 wrmsr(MSR_MTRRdefType, rdmsr(MSR_MTRRdefType) & ~0x800);
293
294
295 if (sc->mr_cap & MR686_FIXMTRR) {
296 msr = MSR_MTRR64kBase;
297 for (i = 0; i < (MTRR_N64K / 8); i++, msr++) {
298 msrv = 0;
299 omsrv = rdmsr(msr);
300 for (j = 7; j >= 0; j--) {
301 msrv = msrv << 8;
302 msrv |= i686_mrt2mtrr((mrd + j)->mr_flags,
303 omsrv >> (j*8));
304 }
305 wrmsr(msr, msrv);
306 mrd += 8;
307 }
308 msr = MSR_MTRR16kBase;
309 for (i = 0; i < (MTRR_N16K / 8); i++, msr++) {
310 msrv = 0;
311 omsrv = rdmsr(msr);
312 for (j = 7; j >= 0; j--) {
313 msrv = msrv << 8;
314 msrv |= i686_mrt2mtrr((mrd + j)->mr_flags,
315 omsrv >> (j*8));
316 }
317 wrmsr(msr, msrv);
318 mrd += 8;
319 }
320 msr = MSR_MTRR4kBase;
321 for (i = 0; i < (MTRR_N4K / 8); i++, msr++) {
322 msrv = 0;
323 omsrv = rdmsr(msr);
324 for (j = 7; j >= 0; j--) {
325 msrv = msrv << 8;
326 msrv |= i686_mrt2mtrr((mrd + j)->mr_flags,
327 omsrv >> (j*8));
328 }
329 wrmsr(msr, msrv);
330 mrd += 8;
331 }
332 }
333
334
335 msr = MSR_MTRRVarBase;
336 for (; (mrd - sc->mr_desc) < sc->mr_ndesc; msr += 2, mrd++) {
337
338 omsrv = rdmsr(msr);
339 if (mrd->mr_flags & MDF_ACTIVE) {
340 msrv = mrd->mr_base & 0x0000000ffffff000LL;
341 msrv |= i686_mrt2mtrr(mrd->mr_flags, omsrv);
342 } else {
343 msrv = 0;
344 }
345 wrmsr(msr, msrv);
346
347
348 if (mrd->mr_flags & MDF_ACTIVE) {
349 msrv = 0x800 | (~(mrd->mr_len - 1) & 0x0000000ffffff000LL);
350 } else {
351 msrv = 0;
352 }
353 wrmsr(msr + 1, msrv);
354 }
355 wbinvd();
356 wrmsr(MSR_MTRRdefType, rdmsr(MSR_MTRRdefType) | 0x800);
357 lcr0(rcr0() & ~(CR0_CD | CR0_NW));
358 lcr4(cr4save);
359 }
360
361
362
363
364 struct mem_range_desc *
365 i686_mtrrfixsearch(struct mem_range_softc *sc, u_int64_t addr)
366 {
367 struct mem_range_desc *mrd;
368 int i;
369
370 for (i = 0, mrd = sc->mr_desc; i < (MTRR_N64K + MTRR_N16K + MTRR_N4K); i++, mrd++)
371 if ((addr >= mrd->mr_base) && (addr < (mrd->mr_base + mrd->mr_len)))
372 return(mrd);
373 return(NULL);
374 }
375
376
377
378
379
380
381
382
383
384
385
386 int
387 i686_mrsetlow(struct mem_range_softc *sc, struct mem_range_desc *mrd, int *arg)
388 {
389 struct mem_range_desc *first_md, *last_md, *curr_md;
390
391
392 if (((first_md = i686_mtrrfixsearch(sc, mrd->mr_base)) == NULL) ||
393 ((last_md = i686_mtrrfixsearch(sc, mrd->mr_base + mrd->mr_len - 1)) == NULL))
394 return(EINVAL);
395
396
397 if (!(mrd->mr_flags & MDF_FORCE))
398 for (curr_md = first_md; curr_md <= last_md; curr_md++) {
399 if ((curr_md->mr_flags & MDF_ATTRMASK) == MDF_UNKNOWN)
400 return (EACCES);
401 }
402
403
404 for (curr_md = first_md; curr_md <= last_md; curr_md++) {
405 curr_md->mr_flags = mrcopyflags(curr_md->mr_flags & ~MDF_FIRMWARE, mrd->mr_flags);
406 bcopy(mrd->mr_owner, curr_md->mr_owner, sizeof(mrd->mr_owner));
407 }
408
409 return(0);
410 }
411
412
413
414
415
416
417
418 int
419 i686_mrsetvariable(struct mem_range_softc *sc, struct mem_range_desc *mrd,
420 int *arg)
421 {
422 struct mem_range_desc *curr_md, *free_md;
423 int i;
424
425
426
427
428
429
430
431
432 i = (sc->mr_cap & MR686_FIXMTRR) ? MTRR_N64K + MTRR_N16K + MTRR_N4K : 0;
433 curr_md = sc->mr_desc + i;
434 free_md = NULL;
435 for (; i < sc->mr_ndesc; i++, curr_md++) {
436 if (curr_md->mr_flags & MDF_ACTIVE) {
437
438 if ((curr_md->mr_base == mrd->mr_base) &&
439 (curr_md->mr_len == mrd->mr_len)) {
440
441 if (curr_md->mr_flags & MDF_BUSY)
442 return(EBUSY);
443
444 if (!(mrd->mr_flags & MDF_FORCE) &&
445 ((curr_md->mr_flags & MDF_ATTRMASK)
446 == MDF_UNKNOWN))
447 return (EACCES);
448
449 free_md = curr_md;
450 break;
451 }
452
453 if (mroverlap(curr_md, mrd)) {
454
455 if (i686_mtrrconflict(curr_md->mr_flags,
456 mrd->mr_flags))
457 return(EINVAL);
458 }
459 } else if (free_md == NULL) {
460 free_md = curr_md;
461 }
462 }
463
464 if (free_md == NULL)
465 return(ENOSPC);
466
467
468 free_md->mr_base = mrd->mr_base;
469 free_md->mr_len = mrd->mr_len;
470 free_md->mr_flags = mrcopyflags(MDF_ACTIVE, mrd->mr_flags);
471 bcopy(mrd->mr_owner, free_md->mr_owner, sizeof(mrd->mr_owner));
472 return(0);
473 }
474
475
476
477
478
479 int
480 i686_mrset(struct mem_range_softc *sc, struct mem_range_desc *mrd, int *arg)
481 {
482 struct mem_range_desc *targ;
483 int error = 0;
484
485 switch(*arg) {
486 case MEMRANGE_SET_UPDATE:
487
488 if (!mrvalid(mrd->mr_base, mrd->mr_len) ||
489 i686_mtrrtype(mrd->mr_flags) == -1)
490 return(EINVAL);
491
492 #define FIXTOP ((MTRR_N64K * 0x10000) + (MTRR_N16K * 0x4000) + (MTRR_N4K * 0x1000))
493
494
495 if ((sc->mr_cap & MR686_FIXMTRR) &&
496 ((mrd->mr_base + mrd->mr_len) <= FIXTOP)) {
497 if ((error = i686_mrsetlow(sc, mrd, arg)) != 0)
498 return(error);
499 } else {
500
501 if ((error = i686_mrsetvariable(sc, mrd, arg)) != 0)
502 return(error);
503 }
504 break;
505
506 case MEMRANGE_SET_REMOVE:
507 if ((targ = mem_range_match(sc, mrd)) == NULL)
508 return(ENOENT);
509 if (targ->mr_flags & MDF_FIXACTIVE)
510 return(EPERM);
511 if (targ->mr_flags & MDF_BUSY)
512 return(EBUSY);
513 targ->mr_flags &= ~MDF_ACTIVE;
514 targ->mr_owner[0] = 0;
515 break;
516
517 default:
518 return(EOPNOTSUPP);
519 }
520
521
522 i686_mrstore(sc);
523 i686_mrfetch(sc);
524 return(0);
525 }
526
527
528
529
530
531 void
532 i686_mrinit(struct mem_range_softc *sc)
533 {
534 struct mem_range_desc *mrd;
535 int nmdesc = 0;
536 int i;
537
538 mtrrcap = rdmsr(MSR_MTRRcap);
539 mtrrdef = rdmsr(MSR_MTRRdefType);
540
541
542 if (!(mtrrdef & 0x800)) {
543 printf("mtrr: CPU supports MTRRs but not enabled\n");
544 return;
545 }
546 nmdesc = mtrrcap & 0xff;
547 printf("mtrr: Pentium Pro MTRR support\n");
548
549
550 if ((mtrrcap & 0x100) && (mtrrdef & 0x400)) {
551 sc->mr_cap = MR686_FIXMTRR;
552 nmdesc += MTRR_N64K + MTRR_N16K + MTRR_N4K;
553 }
554
555 sc->mr_desc = malloc(nmdesc * sizeof(struct mem_range_desc),
556 M_MEMDESC, M_WAITOK);
557 bzero(sc->mr_desc, nmdesc * sizeof(struct mem_range_desc));
558 sc->mr_ndesc = nmdesc;
559
560 mrd = sc->mr_desc;
561
562
563 if (sc->mr_cap & MR686_FIXMTRR) {
564 for (i = 0; i < MTRR_N64K; i++, mrd++) {
565 mrd->mr_base = i * 0x10000;
566 mrd->mr_len = 0x10000;
567 mrd->mr_flags = MDF_FIXBASE | MDF_FIXLEN | MDF_FIXACTIVE;
568 }
569 for (i = 0; i < MTRR_N16K; i++, mrd++) {
570 mrd->mr_base = i * 0x4000 + 0x80000;
571 mrd->mr_len = 0x4000;
572 mrd->mr_flags = MDF_FIXBASE | MDF_FIXLEN | MDF_FIXACTIVE;
573 }
574 for (i = 0; i < MTRR_N4K; i++, mrd++) {
575 mrd->mr_base = i * 0x1000 + 0xc0000;
576 mrd->mr_len = 0x1000;
577 mrd->mr_flags = MDF_FIXBASE | MDF_FIXLEN | MDF_FIXACTIVE;
578 }
579 }
580
581
582
583
584
585 i686_mrfetch(sc);
586 mrd = sc->mr_desc;
587 for (i = 0; i < sc->mr_ndesc; i++, mrd++) {
588 if (mrd->mr_flags & MDF_ACTIVE)
589 mrd->mr_flags |= MDF_FIRMWARE;
590 }
591 }
592
593
594
595
596 void
597 i686_mrAPinit(struct mem_range_softc *sc)
598 {
599 i686_mrstoreone((void *)sc);
600 wrmsr(MSR_MTRRdefType, mtrrdef);
601 }
602