hc
2024-12-19 9370bb92b2d16684ee45cf24e879c93c509162da
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
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
// SPDX-License-Identifier: GPL-2.0
#include <linux/init.h>
#include <linux/mm.h>
 
#include <asm/mtrr.h>
#include <asm/msr.h>
 
#include "mtrr.h"
 
static struct {
   unsigned long high;
   unsigned long low;
} centaur_mcr[8];
 
static u8 centaur_mcr_reserved;
static u8 centaur_mcr_type;    /* 0 for winchip, 1 for winchip2 */
 
/**
 * centaur_get_free_region - Get a free MTRR.
 *
 * @base: The starting (base) address of the region.
 * @size: The size (in bytes) of the region.
 *
 * Returns: the index of the region on success, else -1 on error.
 */
static int
centaur_get_free_region(unsigned long base, unsigned long size, int replace_reg)
{
   unsigned long lbase, lsize;
   mtrr_type ltype;
   int i, max;
 
   max = num_var_ranges;
   if (replace_reg >= 0 && replace_reg < max)
       return replace_reg;
 
   for (i = 0; i < max; ++i) {
       if (centaur_mcr_reserved & (1 << i))
           continue;
       mtrr_if->get(i, &lbase, &lsize, &ltype);
       if (lsize == 0)
           return i;
   }
 
   return -ENOSPC;
}
 
/*
 * Report boot time MCR setups
 */
void mtrr_centaur_report_mcr(int mcr, u32 lo, u32 hi)
{
   centaur_mcr[mcr].low = lo;
   centaur_mcr[mcr].high = hi;
}
 
static void
centaur_get_mcr(unsigned int reg, unsigned long *base,
       unsigned long *size, mtrr_type * type)
{
   *base = centaur_mcr[reg].high >> PAGE_SHIFT;
   *size = -(centaur_mcr[reg].low & 0xfffff000) >> PAGE_SHIFT;
   *type = MTRR_TYPE_WRCOMB;        /* write-combining  */
 
   if (centaur_mcr_type == 1 && ((centaur_mcr[reg].low & 31) & 2))
       *type = MTRR_TYPE_UNCACHABLE;
   if (centaur_mcr_type == 1 && (centaur_mcr[reg].low & 31) == 25)
       *type = MTRR_TYPE_WRBACK;
   if (centaur_mcr_type == 0 && (centaur_mcr[reg].low & 31) == 31)
       *type = MTRR_TYPE_WRBACK;
}
 
static void
centaur_set_mcr(unsigned int reg, unsigned long base,
       unsigned long size, mtrr_type type)
{
   unsigned long low, high;
 
   if (size == 0) {
       /* Disable */
       high = low = 0;
   } else {
       high = base << PAGE_SHIFT;
       if (centaur_mcr_type == 0) {
           /* Only support write-combining... */
           low = -size << PAGE_SHIFT | 0x1f;
       } else {
           if (type == MTRR_TYPE_UNCACHABLE)
               low = -size << PAGE_SHIFT | 0x02; /* NC */
           else
               low = -size << PAGE_SHIFT | 0x09; /* WWO, WC */
       }
   }
   centaur_mcr[reg].high = high;
   centaur_mcr[reg].low = low;
   wrmsr(MSR_IDT_MCR0 + reg, low, high);
}
 
static int
centaur_validate_add_page(unsigned long base, unsigned long size, unsigned int type)
{
   /*
    * FIXME: Winchip2 supports uncached
    */
   if (type != MTRR_TYPE_WRCOMB &&
       (centaur_mcr_type == 0 || type != MTRR_TYPE_UNCACHABLE)) {
       pr_warn("mtrr: only write-combining%s supported\n",
              centaur_mcr_type ? " and uncacheable are" : " is");
       return -EINVAL;
   }
   return 0;
}
 
static const struct mtrr_ops centaur_mtrr_ops = {
   .vendor            = X86_VENDOR_CENTAUR,
   .set               = centaur_set_mcr,
   .get               = centaur_get_mcr,
   .get_free_region   = centaur_get_free_region,
   .validate_add_page = centaur_validate_add_page,
   .have_wrcomb       = positive_have_wrcomb,
};
 
int __init centaur_init_mtrr(void)
{
   set_mtrr_ops(&centaur_mtrr_ops);
   return 0;
}