1
2
3
4
5
6
7
8
9#include <linux/kernel.h>
10#include <linux/thread_info.h>
11
12#include <asm/apic.h>
13#include <asm/cpu_device_id.h>
14#include <asm/intel-family.h>
15#include <asm/msr.h>
16#include <asm/param.h>
17#include <asm/tsc.h>
18
19#define MAX_NUM_FREQS 16
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36#define TSC_REFERENCE_KHZ 100000
37
38struct muldiv {
39 u32 multiplier;
40 u32 divider;
41};
42
43
44
45
46
47
48
49
50struct freq_desc {
51 bool use_msr_plat;
52 struct muldiv muldiv[MAX_NUM_FREQS];
53
54
55
56
57 u32 freqs[MAX_NUM_FREQS];
58 u32 mask;
59};
60
61
62
63
64
65
66static const struct freq_desc freq_desc_pnw = {
67 .use_msr_plat = false,
68 .freqs = { 0, 0, 0, 0, 0, 99840, 0, 83200 },
69 .mask = 0x07,
70};
71
72static const struct freq_desc freq_desc_clv = {
73 .use_msr_plat = false,
74 .freqs = { 0, 133200, 0, 0, 0, 99840, 0, 83200 },
75 .mask = 0x07,
76};
77
78
79
80
81
82
83
84
85
86static const struct freq_desc freq_desc_byt = {
87 .use_msr_plat = true,
88 .muldiv = { { 5, 6 }, { 1, 1 }, { 4, 3 }, { 7, 6 },
89 { 4, 5 } },
90 .mask = 0x07,
91};
92
93
94
95
96
97
98
99
100
101
102
103
104
105static const struct freq_desc freq_desc_cht = {
106 .use_msr_plat = true,
107 .muldiv = { { 5, 6 }, { 1, 1 }, { 4, 3 }, { 7, 6 },
108 { 4, 5 }, { 14, 15 }, { 9, 10 }, { 8, 9 },
109 { 7, 8 } },
110 .mask = 0x0f,
111};
112
113
114
115
116
117
118static const struct freq_desc freq_desc_tng = {
119 .use_msr_plat = true,
120 .muldiv = { { 0, 0 }, { 1, 1 }, { 4, 3 } },
121 .mask = 0x07,
122};
123
124
125
126
127
128
129
130
131static const struct freq_desc freq_desc_ann = {
132 .use_msr_plat = true,
133 .muldiv = { { 5, 6 }, { 1, 1 }, { 4, 3 }, { 1, 1 } },
134 .mask = 0x0f,
135};
136
137
138
139
140
141
142static const struct freq_desc freq_desc_lgm = {
143 .use_msr_plat = true,
144 .freqs = { 78000, 78000, 78000, 78000, 78000, 78000, 78000, 78000,
145 78000, 78000, 78000, 78000, 78000, 78000, 78000, 78000 },
146 .mask = 0x0f,
147};
148
149static const struct x86_cpu_id tsc_msr_cpu_ids[] = {
150 X86_MATCH_INTEL_FAM6_MODEL(ATOM_SALTWELL_MID, &freq_desc_pnw),
151 X86_MATCH_INTEL_FAM6_MODEL(ATOM_SALTWELL_TABLET,&freq_desc_clv),
152 X86_MATCH_INTEL_FAM6_MODEL(ATOM_SILVERMONT, &freq_desc_byt),
153 X86_MATCH_INTEL_FAM6_MODEL(ATOM_SILVERMONT_MID, &freq_desc_tng),
154 X86_MATCH_INTEL_FAM6_MODEL(ATOM_AIRMONT, &freq_desc_cht),
155 X86_MATCH_INTEL_FAM6_MODEL(ATOM_AIRMONT_MID, &freq_desc_ann),
156 X86_MATCH_INTEL_FAM6_MODEL(ATOM_AIRMONT_NP, &freq_desc_lgm),
157 {}
158};
159
160
161
162
163
164
165
166unsigned long cpu_khz_from_msr(void)
167{
168 u32 lo, hi, ratio, freq, tscref;
169 const struct freq_desc *freq_desc;
170 const struct x86_cpu_id *id;
171 const struct muldiv *md;
172 unsigned long res;
173 int index;
174
175 id = x86_match_cpu(tsc_msr_cpu_ids);
176 if (!id)
177 return 0;
178
179 freq_desc = (struct freq_desc *)id->driver_data;
180 if (freq_desc->use_msr_plat) {
181 rdmsr(MSR_PLATFORM_INFO, lo, hi);
182 ratio = (lo >> 8) & 0xff;
183 } else {
184 rdmsr(MSR_IA32_PERF_STATUS, lo, hi);
185 ratio = (hi >> 8) & 0x1f;
186 }
187
188
189 rdmsr(MSR_FSB_FREQ, lo, hi);
190 index = lo & freq_desc->mask;
191 md = &freq_desc->muldiv[index];
192
193
194
195
196
197 if (md->divider) {
198 tscref = TSC_REFERENCE_KHZ * md->multiplier;
199 freq = DIV_ROUND_CLOSEST(tscref, md->divider);
200
201
202
203
204 res = DIV_ROUND_CLOSEST(tscref * ratio, md->divider);
205 } else {
206 freq = freq_desc->freqs[index];
207 res = freq * ratio;
208 }
209
210 if (freq == 0)
211 pr_err("Error MSR_FSB_FREQ index %d is unknown\n", index);
212
213#ifdef CONFIG_X86_LOCAL_APIC
214 lapic_timer_period = (freq * 1000) / HZ;
215#endif
216
217
218
219
220
221
222
223 setup_force_cpu_cap(X86_FEATURE_TSC_KNOWN_FREQ);
224
225
226
227
228
229
230
231
232
233 setup_force_cpu_cap(X86_FEATURE_TSC_RELIABLE);
234
235 return res;
236}
237