1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#include <linux/interrupt.h>
17#include <linux/notifier.h>
18#include <linux/jiffies.h>
19#include <linux/kernel.h>
20#include <linux/percpu.h>
21#include <linux/export.h>
22#include <linux/sysdev.h>
23#include <linux/types.h>
24#include <linux/init.h>
25#include <linux/smp.h>
26#include <linux/cpu.h>
27
28#include <asm/processor.h>
29#include <asm/system.h>
30#include <asm/apic.h>
31#include <asm/idle.h>
32#include <asm/mce.h>
33#include <asm/msr.h>
34
35
36#define CHECK_INTERVAL (300 * HZ)
37
38#define THERMAL_THROTTLING_EVENT 0
39#define POWER_LIMIT_EVENT 1
40
41
42
43
44struct _thermal_state {
45 bool new_event;
46 int event;
47 u64 next_check;
48 unsigned long count;
49 unsigned long last_count;
50};
51
52struct thermal_state {
53 struct _thermal_state core_throttle;
54 struct _thermal_state core_power_limit;
55 struct _thermal_state package_throttle;
56 struct _thermal_state package_power_limit;
57 struct _thermal_state core_thresh0;
58 struct _thermal_state core_thresh1;
59};
60
61
62int (*platform_thermal_notify)(__u64 msr_val);
63EXPORT_SYMBOL(platform_thermal_notify);
64
65static DEFINE_PER_CPU(struct thermal_state, thermal_state);
66
67static atomic_t therm_throt_en = ATOMIC_INIT(0);
68
69static u32 lvtthmr_init __read_mostly;
70
71#ifdef CONFIG_SYSFS
72#define define_therm_throt_sysdev_one_ro(_name) \
73 static SYSDEV_ATTR(_name, 0444, \
74 therm_throt_sysdev_show_##_name, \
75 NULL) \
76
77#define define_therm_throt_sysdev_show_func(event, name) \
78 \
79static ssize_t therm_throt_sysdev_show_##event##_##name( \
80 struct sys_device *dev, \
81 struct sysdev_attribute *attr, \
82 char *buf) \
83{ \
84 unsigned int cpu = dev->id; \
85 ssize_t ret; \
86 \
87 preempt_disable(); \
88 if (cpu_online(cpu)) { \
89 ret = sprintf(buf, "%lu\n", \
90 per_cpu(thermal_state, cpu).event.name); \
91 } else \
92 ret = 0; \
93 preempt_enable(); \
94 \
95 return ret; \
96}
97
98define_therm_throt_sysdev_show_func(core_throttle, count);
99define_therm_throt_sysdev_one_ro(core_throttle_count);
100
101define_therm_throt_sysdev_show_func(core_power_limit, count);
102define_therm_throt_sysdev_one_ro(core_power_limit_count);
103
104define_therm_throt_sysdev_show_func(package_throttle, count);
105define_therm_throt_sysdev_one_ro(package_throttle_count);
106
107define_therm_throt_sysdev_show_func(package_power_limit, count);
108define_therm_throt_sysdev_one_ro(package_power_limit_count);
109
110static struct attribute *thermal_throttle_attrs[] = {
111 &attr_core_throttle_count.attr,
112 NULL
113};
114
115static struct attribute_group thermal_attr_group = {
116 .attrs = thermal_throttle_attrs,
117 .name = "thermal_throttle"
118};
119#endif
120
121#define CORE_LEVEL 0
122#define PACKAGE_LEVEL 1
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140static int therm_throt_process(bool new_event, int event, int level)
141{
142 struct _thermal_state *state;
143 unsigned int this_cpu = smp_processor_id();
144 bool old_event;
145 u64 now;
146 struct thermal_state *pstate = &per_cpu(thermal_state, this_cpu);
147
148 now = get_jiffies_64();
149 if (level == CORE_LEVEL) {
150 if (event == THERMAL_THROTTLING_EVENT)
151 state = &pstate->core_throttle;
152 else if (event == POWER_LIMIT_EVENT)
153 state = &pstate->core_power_limit;
154 else
155 return 0;
156 } else if (level == PACKAGE_LEVEL) {
157 if (event == THERMAL_THROTTLING_EVENT)
158 state = &pstate->package_throttle;
159 else if (event == POWER_LIMIT_EVENT)
160 state = &pstate->package_power_limit;
161 else
162 return 0;
163 } else
164 return 0;
165
166 old_event = state->new_event;
167 state->new_event = new_event;
168
169 if (new_event)
170 state->count++;
171
172 if (time_before64(now, state->next_check) &&
173 state->count != state->last_count)
174 return 0;
175
176 state->next_check = now + CHECK_INTERVAL;
177 state->last_count = state->count;
178
179
180 if (new_event) {
181 if (event == THERMAL_THROTTLING_EVENT)
182 printk(KERN_CRIT "CPU%d: %s temperature above threshold, cpu clock throttled (total events = %lu)\n",
183 this_cpu,
184 level == CORE_LEVEL ? "Core" : "Package",
185 state->count);
186 else
187 printk(KERN_CRIT "CPU%d: %s power limit notification (total events = %lu)\n",
188 this_cpu,
189 level == CORE_LEVEL ? "Core" : "Package",
190 state->count);
191 return 1;
192 }
193 if (old_event) {
194 if (event == THERMAL_THROTTLING_EVENT)
195 printk(KERN_INFO "CPU%d: %s temperature/speed normal\n",
196 this_cpu,
197 level == CORE_LEVEL ? "Core" : "Package");
198 else
199 printk(KERN_INFO "CPU%d: %s power limit normal\n",
200 this_cpu,
201 level == CORE_LEVEL ? "Core" : "Package");
202 return 1;
203 }
204
205 return 0;
206}
207
208static int thresh_event_valid(int event)
209{
210 struct _thermal_state *state;
211 unsigned int this_cpu = smp_processor_id();
212 struct thermal_state *pstate = &per_cpu(thermal_state, this_cpu);
213 u64 now = get_jiffies_64();
214
215 state = (event == 0) ? &pstate->core_thresh0 : &pstate->core_thresh1;
216
217 if (time_before64(now, state->next_check))
218 return 0;
219
220 state->next_check = now + CHECK_INTERVAL;
221 return 1;
222}
223
224#ifdef CONFIG_SYSFS
225
226static __cpuinit int thermal_throttle_add_dev(struct sys_device *sys_dev,
227 unsigned int cpu)
228{
229 int err;
230 struct cpuinfo_x86 *c = &cpu_data(cpu);
231
232 err = sysfs_create_group(&sys_dev->kobj, &thermal_attr_group);
233 if (err)
234 return err;
235
236 if (cpu_has(c, X86_FEATURE_PLN))
237 err = sysfs_add_file_to_group(&sys_dev->kobj,
238 &attr_core_power_limit_count.attr,
239 thermal_attr_group.name);
240 if (cpu_has(c, X86_FEATURE_PTS)) {
241 err = sysfs_add_file_to_group(&sys_dev->kobj,
242 &attr_package_throttle_count.attr,
243 thermal_attr_group.name);
244 if (cpu_has(c, X86_FEATURE_PLN))
245 err = sysfs_add_file_to_group(&sys_dev->kobj,
246 &attr_package_power_limit_count.attr,
247 thermal_attr_group.name);
248 }
249
250 return err;
251}
252
253static __cpuinit void thermal_throttle_remove_dev(struct sys_device *sys_dev)
254{
255 sysfs_remove_group(&sys_dev->kobj, &thermal_attr_group);
256}
257
258
259static DEFINE_MUTEX(therm_cpu_lock);
260
261
262static __cpuinit int
263thermal_throttle_cpu_callback(struct notifier_block *nfb,
264 unsigned long action,
265 void *hcpu)
266{
267 unsigned int cpu = (unsigned long)hcpu;
268 struct sys_device *sys_dev;
269 int err = 0;
270
271 sys_dev = get_cpu_sysdev(cpu);
272
273 switch (action) {
274 case CPU_UP_PREPARE:
275 case CPU_UP_PREPARE_FROZEN:
276 mutex_lock(&therm_cpu_lock);
277 err = thermal_throttle_add_dev(sys_dev, cpu);
278 mutex_unlock(&therm_cpu_lock);
279 WARN_ON(err);
280 break;
281 case CPU_UP_CANCELED:
282 case CPU_UP_CANCELED_FROZEN:
283 case CPU_DEAD:
284 case CPU_DEAD_FROZEN:
285 mutex_lock(&therm_cpu_lock);
286 thermal_throttle_remove_dev(sys_dev);
287 mutex_unlock(&therm_cpu_lock);
288 break;
289 }
290 return notifier_from_errno(err);
291}
292
293static struct notifier_block thermal_throttle_cpu_notifier __cpuinitdata =
294{
295 .notifier_call = thermal_throttle_cpu_callback,
296};
297
298static __init int thermal_throttle_init_device(void)
299{
300 unsigned int cpu = 0;
301 int err;
302
303 if (!atomic_read(&therm_throt_en))
304 return 0;
305
306 register_hotcpu_notifier(&thermal_throttle_cpu_notifier);
307
308#ifdef CONFIG_HOTPLUG_CPU
309 mutex_lock(&therm_cpu_lock);
310#endif
311
312 for_each_online_cpu(cpu) {
313 err = thermal_throttle_add_dev(get_cpu_sysdev(cpu), cpu);
314 WARN_ON(err);
315 }
316#ifdef CONFIG_HOTPLUG_CPU
317 mutex_unlock(&therm_cpu_lock);
318#endif
319
320 return 0;
321}
322device_initcall(thermal_throttle_init_device);
323
324#endif
325
326
327
328
329
330
331
332#define CORE_THROTTLED (0)
333#define CORE_POWER_LIMIT ((__u64)1 << 62)
334#define PACKAGE_THROTTLED ((__u64)2 << 62)
335#define PACKAGE_POWER_LIMIT ((__u64)3 << 62)
336
337static void notify_thresholds(__u64 msr_val)
338{
339
340
341
342 if (!platform_thermal_notify)
343 return;
344
345
346 if ((msr_val & THERM_LOG_THRESHOLD0) && thresh_event_valid(0))
347 platform_thermal_notify(msr_val);
348
349 if ((msr_val & THERM_LOG_THRESHOLD1) && thresh_event_valid(1))
350 platform_thermal_notify(msr_val);
351}
352
353
354static void intel_thermal_interrupt(void)
355{
356 __u64 msr_val;
357
358 rdmsrl(MSR_IA32_THERM_STATUS, msr_val);
359
360
361 notify_thresholds(msr_val);
362
363 if (therm_throt_process(msr_val & THERM_STATUS_PROCHOT,
364 THERMAL_THROTTLING_EVENT,
365 CORE_LEVEL) != 0)
366 mce_log_therm_throt_event(CORE_THROTTLED | msr_val);
367
368 if (this_cpu_has(X86_FEATURE_PLN))
369 if (therm_throt_process(msr_val & THERM_STATUS_POWER_LIMIT,
370 POWER_LIMIT_EVENT,
371 CORE_LEVEL) != 0)
372 mce_log_therm_throt_event(CORE_POWER_LIMIT | msr_val);
373
374 if (this_cpu_has(X86_FEATURE_PTS)) {
375 rdmsrl(MSR_IA32_PACKAGE_THERM_STATUS, msr_val);
376 if (therm_throt_process(msr_val & PACKAGE_THERM_STATUS_PROCHOT,
377 THERMAL_THROTTLING_EVENT,
378 PACKAGE_LEVEL) != 0)
379 mce_log_therm_throt_event(PACKAGE_THROTTLED | msr_val);
380 if (this_cpu_has(X86_FEATURE_PLN))
381 if (therm_throt_process(msr_val &
382 PACKAGE_THERM_STATUS_POWER_LIMIT,
383 POWER_LIMIT_EVENT,
384 PACKAGE_LEVEL) != 0)
385 mce_log_therm_throt_event(PACKAGE_POWER_LIMIT
386 | msr_val);
387 }
388}
389
390static void unexpected_thermal_interrupt(void)
391{
392 printk(KERN_ERR "CPU%d: Unexpected LVT thermal interrupt!\n",
393 smp_processor_id());
394}
395
396static void (*smp_thermal_vector)(void) = unexpected_thermal_interrupt;
397
398asmlinkage void smp_thermal_interrupt(struct pt_regs *regs)
399{
400 exit_idle();
401 irq_enter();
402 inc_irq_stat(irq_thermal_count);
403 smp_thermal_vector();
404 irq_exit();
405
406 ack_APIC_irq();
407}
408
409
410static int intel_thermal_supported(struct cpuinfo_x86 *c)
411{
412 if (!cpu_has_apic)
413 return 0;
414 if (!cpu_has(c, X86_FEATURE_ACPI) || !cpu_has(c, X86_FEATURE_ACC))
415 return 0;
416 return 1;
417}
418
419void __init mcheck_intel_therm_init(void)
420{
421
422
423
424
425
426 if (intel_thermal_supported(&boot_cpu_data))
427 lvtthmr_init = apic_read(APIC_LVTTHMR);
428}
429
430void intel_init_thermal(struct cpuinfo_x86 *c)
431{
432 unsigned int cpu = smp_processor_id();
433 int tm2 = 0;
434 u32 l, h;
435
436 if (!intel_thermal_supported(c))
437 return;
438
439
440
441
442
443
444 rdmsr(MSR_IA32_MISC_ENABLE, l, h);
445
446 h = lvtthmr_init;
447
448
449
450
451
452
453
454
455
456
457 if ((h & APIC_DM_FIXED_MASK) != APIC_DM_FIXED)
458 apic_write(APIC_LVTTHMR, lvtthmr_init);
459
460
461 if ((l & MSR_IA32_MISC_ENABLE_TM1) && (h & APIC_DM_SMI)) {
462 printk(KERN_DEBUG
463 "CPU%d: Thermal monitoring handled by SMI\n", cpu);
464 return;
465 }
466
467
468 if (h & APIC_VECTOR_MASK) {
469 printk(KERN_DEBUG
470 "CPU%d: Thermal LVT vector (%#x) already installed\n",
471 cpu, (h & APIC_VECTOR_MASK));
472 return;
473 }
474
475
476 if (cpu_has(c, X86_FEATURE_TM2)) {
477 if (c->x86 == 6 && (c->x86_model == 9 || c->x86_model == 13)) {
478 rdmsr(MSR_THERM2_CTL, l, h);
479 if (l & MSR_THERM2_CTL_TM_SELECT)
480 tm2 = 1;
481 } else if (l & MSR_IA32_MISC_ENABLE_TM2)
482 tm2 = 1;
483 }
484
485
486 h = THERMAL_APIC_VECTOR | APIC_DM_FIXED | APIC_LVT_MASKED;
487 apic_write(APIC_LVTTHMR, h);
488
489 rdmsr(MSR_IA32_THERM_INTERRUPT, l, h);
490 if (cpu_has(c, X86_FEATURE_PLN))
491 wrmsr(MSR_IA32_THERM_INTERRUPT,
492 l | (THERM_INT_LOW_ENABLE
493 | THERM_INT_HIGH_ENABLE | THERM_INT_PLN_ENABLE), h);
494 else
495 wrmsr(MSR_IA32_THERM_INTERRUPT,
496 l | (THERM_INT_LOW_ENABLE | THERM_INT_HIGH_ENABLE), h);
497
498 if (cpu_has(c, X86_FEATURE_PTS)) {
499 rdmsr(MSR_IA32_PACKAGE_THERM_INTERRUPT, l, h);
500 if (cpu_has(c, X86_FEATURE_PLN))
501 wrmsr(MSR_IA32_PACKAGE_THERM_INTERRUPT,
502 l | (PACKAGE_THERM_INT_LOW_ENABLE
503 | PACKAGE_THERM_INT_HIGH_ENABLE
504 | PACKAGE_THERM_INT_PLN_ENABLE), h);
505 else
506 wrmsr(MSR_IA32_PACKAGE_THERM_INTERRUPT,
507 l | (PACKAGE_THERM_INT_LOW_ENABLE
508 | PACKAGE_THERM_INT_HIGH_ENABLE), h);
509 }
510
511 smp_thermal_vector = intel_thermal_interrupt;
512
513 rdmsr(MSR_IA32_MISC_ENABLE, l, h);
514 wrmsr(MSR_IA32_MISC_ENABLE, l | MSR_IA32_MISC_ENABLE_TM1, h);
515
516
517 l = apic_read(APIC_LVTTHMR);
518 apic_write(APIC_LVTTHMR, l & ~APIC_LVT_MASKED);
519
520 printk_once(KERN_INFO "CPU0: Thermal monitoring enabled (%s)\n",
521 tm2 ? "TM2" : "TM1");
522
523
524 atomic_set(&therm_throt_en, 1);
525}
526