brintos

brintos / linux-shallow public Read only

0
0
Text · 23.0 KiB · e69868e Raw
816 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * Thermal throttle event support code (such as syslog messaging and rate4 * limiting) that was factored out from x86_64 (mce_intel.c) and i386 (p4.c).5 *6 * This allows consistent reporting of CPU thermal throttle events.7 *8 * Maintains a counter in /sys that keeps track of the number of thermal9 * events, such that the user knows how bad the thermal problem might be10 * (since the logging to syslog is rate limited).11 *12 * Author: Dmitriy Zavin (dmitriyz@google.com)13 *14 * Credits: Adapted from Zwane Mwaikambo's original code in mce_intel.c.15 *          Inspired by Ross Biro's and Al Borchers' counter code.16 */17#include <linux/interrupt.h>18#include <linux/notifier.h>19#include <linux/jiffies.h>20#include <linux/kernel.h>21#include <linux/percpu.h>22#include <linux/export.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/thermal.h>30#include <asm/traps.h>31#include <asm/apic.h>32#include <asm/irq.h>33#include <asm/msr.h>34 35#include "intel_hfi.h"36#include "thermal_interrupt.h"37 38/* How long to wait between reporting thermal events */39#define CHECK_INTERVAL		(300 * HZ)40 41#define THERMAL_THROTTLING_EVENT	042#define POWER_LIMIT_EVENT		143 44/**45 * struct _thermal_state - Represent the current thermal event state46 * @next_check:			Stores the next timestamp, when it is allowed47 *				to log the next warning message.48 * @last_interrupt_time:	Stores the timestamp for the last threshold49 *				high event.50 * @therm_work:			Delayed workqueue structure51 * @count:			Stores the current running count for thermal52 *				or power threshold interrupts.53 * @last_count:			Stores the previous running count for thermal54 *				or power threshold interrupts.55 * @max_time_ms:		This shows the maximum amount of time CPU was56 *				in throttled state for a single thermal57 *				threshold high to low state.58 * @total_time_ms:		This is a cumulative time during which CPU was59 *				in the throttled state.60 * @rate_control_active:	Set when a throttling message is logged.61 *				This is used for the purpose of rate-control.62 * @new_event:			Stores the last high/low status of the63 *				THERM_STATUS_PROCHOT or64 *				THERM_STATUS_POWER_LIMIT.65 * @level:			Stores whether this _thermal_state instance is66 *				for a CORE level or for PACKAGE level.67 * @sample_index:		Index for storing the next sample in the buffer68 *				temp_samples[].69 * @sample_count:		Total number of samples collected in the buffer70 *				temp_samples[].71 * @average:			The last moving average of temperature samples72 * @baseline_temp:		Temperature at which thermal threshold high73 *				interrupt was generated.74 * @temp_samples:		Storage for temperature samples to calculate75 *				moving average.76 *77 * This structure is used to represent data related to thermal state for a CPU.78 * There is a separate storage for core and package level for each CPU.79 */80struct _thermal_state {81	u64			next_check;82	u64			last_interrupt_time;83	struct delayed_work	therm_work;84	unsigned long		count;85	unsigned long		last_count;86	unsigned long		max_time_ms;87	unsigned long		total_time_ms;88	bool			rate_control_active;89	bool			new_event;90	u8			level;91	u8			sample_index;92	u8			sample_count;93	u8			average;94	u8			baseline_temp;95	u8			temp_samples[3];96};97 98struct thermal_state {99	struct _thermal_state core_throttle;100	struct _thermal_state core_power_limit;101	struct _thermal_state package_throttle;102	struct _thermal_state package_power_limit;103	struct _thermal_state core_thresh0;104	struct _thermal_state core_thresh1;105	struct _thermal_state pkg_thresh0;106	struct _thermal_state pkg_thresh1;107};108 109/* Callback to handle core threshold interrupts */110int (*platform_thermal_notify)(__u64 msr_val);111EXPORT_SYMBOL(platform_thermal_notify);112 113/* Callback to handle core package threshold_interrupts */114int (*platform_thermal_package_notify)(__u64 msr_val);115EXPORT_SYMBOL_GPL(platform_thermal_package_notify);116 117/* Callback support of rate control, return true, if118 * callback has rate control */119bool (*platform_thermal_package_rate_control)(void);120EXPORT_SYMBOL_GPL(platform_thermal_package_rate_control);121 122 123static DEFINE_PER_CPU(struct thermal_state, thermal_state);124 125static atomic_t therm_throt_en	= ATOMIC_INIT(0);126 127static u32 lvtthmr_init __read_mostly;128 129#ifdef CONFIG_SYSFS130#define define_therm_throt_device_one_ro(_name)				\131	static DEVICE_ATTR(_name, 0444,					\132			   therm_throt_device_show_##_name,		\133				   NULL)				\134 135#define define_therm_throt_device_show_func(event, name)		\136									\137static ssize_t therm_throt_device_show_##event##_##name(		\138			struct device *dev,				\139			struct device_attribute *attr,			\140			char *buf)					\141{									\142	unsigned int cpu = dev->id;					\143	ssize_t ret;							\144									\145	preempt_disable();	/* CPU hotplug */			\146	if (cpu_online(cpu)) {						\147		ret = sprintf(buf, "%lu\n",				\148			      per_cpu(thermal_state, cpu).event.name);	\149	} else								\150		ret = 0;						\151	preempt_enable();						\152									\153	return ret;							\154}155 156define_therm_throt_device_show_func(core_throttle, count);157define_therm_throt_device_one_ro(core_throttle_count);158 159define_therm_throt_device_show_func(core_power_limit, count);160define_therm_throt_device_one_ro(core_power_limit_count);161 162define_therm_throt_device_show_func(package_throttle, count);163define_therm_throt_device_one_ro(package_throttle_count);164 165define_therm_throt_device_show_func(package_power_limit, count);166define_therm_throt_device_one_ro(package_power_limit_count);167 168define_therm_throt_device_show_func(core_throttle, max_time_ms);169define_therm_throt_device_one_ro(core_throttle_max_time_ms);170 171define_therm_throt_device_show_func(package_throttle, max_time_ms);172define_therm_throt_device_one_ro(package_throttle_max_time_ms);173 174define_therm_throt_device_show_func(core_throttle, total_time_ms);175define_therm_throt_device_one_ro(core_throttle_total_time_ms);176 177define_therm_throt_device_show_func(package_throttle, total_time_ms);178define_therm_throt_device_one_ro(package_throttle_total_time_ms);179 180static struct attribute *thermal_throttle_attrs[] = {181	&dev_attr_core_throttle_count.attr,182	&dev_attr_core_throttle_max_time_ms.attr,183	&dev_attr_core_throttle_total_time_ms.attr,184	NULL185};186 187static const struct attribute_group thermal_attr_group = {188	.attrs	= thermal_throttle_attrs,189	.name	= "thermal_throttle"190};191#endif /* CONFIG_SYSFS */192 193#define THERM_THROT_POLL_INTERVAL	HZ194#define THERM_STATUS_PROCHOT_LOG	BIT(1)195 196static u64 therm_intr_core_clear_mask;197static u64 therm_intr_pkg_clear_mask;198 199static void thermal_intr_init_core_clear_mask(void)200{201	if (therm_intr_core_clear_mask)202		return;203 204	/*205	 * Reference: Intel SDM  Volume 4206	 * "Table 2-2. IA-32 Architectural MSRs", MSR 0x19C207	 * IA32_THERM_STATUS.208	 */209 210	/*211	 * Bit 1, 3, 5: CPUID.01H:EDX[22] = 1. This driver will not212	 * enable interrupts, when 0 as it checks for X86_FEATURE_ACPI.213	 */214	therm_intr_core_clear_mask = (BIT(1) | BIT(3) | BIT(5));215 216	/*217	 * Bit 7 and 9: Thermal Threshold #1 and #2 log218	 * If CPUID.01H:ECX[8] = 1219	 */220	if (boot_cpu_has(X86_FEATURE_TM2))221		therm_intr_core_clear_mask |= (BIT(7) | BIT(9));222 223	/* Bit 11: Power Limitation log (R/WC0) If CPUID.06H:EAX[4] = 1 */224	if (boot_cpu_has(X86_FEATURE_PLN))225		therm_intr_core_clear_mask |= BIT(11);226 227	/*228	 * Bit 13: Current Limit log (R/WC0) If CPUID.06H:EAX[7] = 1229	 * Bit 15: Cross Domain Limit log (R/WC0) If CPUID.06H:EAX[7] = 1230	 */231	if (boot_cpu_has(X86_FEATURE_HWP))232		therm_intr_core_clear_mask |= (BIT(13) | BIT(15));233}234 235static void thermal_intr_init_pkg_clear_mask(void)236{237	if (therm_intr_pkg_clear_mask)238		return;239 240	/*241	 * Reference: Intel SDM  Volume 4242	 * "Table 2-2. IA-32 Architectural MSRs", MSR 0x1B1243	 * IA32_PACKAGE_THERM_STATUS.244	 */245 246	/* All bits except BIT 26 depend on CPUID.06H: EAX[6] = 1 */247	if (boot_cpu_has(X86_FEATURE_PTS))248		therm_intr_pkg_clear_mask = (BIT(1) | BIT(3) | BIT(5) | BIT(7) | BIT(9) | BIT(11));249 250	/*251	 * Intel SDM Volume 2A: Thermal and Power Management Leaf252	 * Bit 26: CPUID.06H: EAX[19] = 1253	 */254	if (boot_cpu_has(X86_FEATURE_HFI))255		therm_intr_pkg_clear_mask |= BIT(26);256}257 258/*259 * Clear the bits in package thermal status register for bit = 1260 * in bitmask261 */262void thermal_clear_package_intr_status(int level, u64 bit_mask)263{264	u64 msr_val;265	int msr;266 267	if (level == CORE_LEVEL) {268		msr  = MSR_IA32_THERM_STATUS;269		msr_val = therm_intr_core_clear_mask;270	} else {271		msr  = MSR_IA32_PACKAGE_THERM_STATUS;272		msr_val = therm_intr_pkg_clear_mask;273	}274 275	msr_val &= ~bit_mask;276	wrmsrl(msr, msr_val);277}278EXPORT_SYMBOL_GPL(thermal_clear_package_intr_status);279 280static void get_therm_status(int level, bool *proc_hot, u8 *temp)281{282	int msr;283	u64 msr_val;284 285	if (level == CORE_LEVEL)286		msr = MSR_IA32_THERM_STATUS;287	else288		msr = MSR_IA32_PACKAGE_THERM_STATUS;289 290	rdmsrl(msr, msr_val);291	if (msr_val & THERM_STATUS_PROCHOT_LOG)292		*proc_hot = true;293	else294		*proc_hot = false;295 296	*temp = (msr_val >> 16) & 0x7F;297}298 299static void __maybe_unused throttle_active_work(struct work_struct *work)300{301	struct _thermal_state *state = container_of(to_delayed_work(work),302						struct _thermal_state, therm_work);303	unsigned int i, avg, this_cpu = smp_processor_id();304	u64 now = get_jiffies_64();305	bool hot;306	u8 temp;307 308	get_therm_status(state->level, &hot, &temp);309	/* temperature value is offset from the max so lesser means hotter */310	if (!hot && temp > state->baseline_temp) {311		if (state->rate_control_active)312			pr_info("CPU%d: %s temperature/speed normal (total events = %lu)\n",313				this_cpu,314				state->level == CORE_LEVEL ? "Core" : "Package",315				state->count);316 317		state->rate_control_active = false;318		return;319	}320 321	if (time_before64(now, state->next_check) &&322			  state->rate_control_active)323		goto re_arm;324 325	state->next_check = now + CHECK_INTERVAL;326 327	if (state->count != state->last_count) {328		/* There was one new thermal interrupt */329		state->last_count = state->count;330		state->average = 0;331		state->sample_count = 0;332		state->sample_index = 0;333	}334 335	state->temp_samples[state->sample_index] = temp;336	state->sample_count++;337	state->sample_index = (state->sample_index + 1) % ARRAY_SIZE(state->temp_samples);338	if (state->sample_count < ARRAY_SIZE(state->temp_samples))339		goto re_arm;340 341	avg = 0;342	for (i = 0; i < ARRAY_SIZE(state->temp_samples); ++i)343		avg += state->temp_samples[i];344 345	avg /= ARRAY_SIZE(state->temp_samples);346 347	if (state->average > avg) {348		pr_warn("CPU%d: %s temperature is above threshold, cpu clock is throttled (total events = %lu)\n",349			this_cpu,350			state->level == CORE_LEVEL ? "Core" : "Package",351			state->count);352		state->rate_control_active = true;353	}354 355	state->average = avg;356 357re_arm:358	thermal_clear_package_intr_status(state->level, THERM_STATUS_PROCHOT_LOG);359	schedule_delayed_work_on(this_cpu, &state->therm_work, THERM_THROT_POLL_INTERVAL);360}361 362/***363 * therm_throt_process - Process thermal throttling event from interrupt364 * @curr: Whether the condition is current or not (boolean), since the365 *        thermal interrupt normally gets called both when the thermal366 *        event begins and once the event has ended.367 *368 * This function is called by the thermal interrupt after the369 * IRQ has been acknowledged.370 *371 * It will take care of rate limiting and printing messages to the syslog.372 */373static void therm_throt_process(bool new_event, int event, int level)374{375	struct _thermal_state *state;376	unsigned int this_cpu = smp_processor_id();377	bool old_event;378	u64 now;379	struct thermal_state *pstate = &per_cpu(thermal_state, this_cpu);380 381	now = get_jiffies_64();382	if (level == CORE_LEVEL) {383		if (event == THERMAL_THROTTLING_EVENT)384			state = &pstate->core_throttle;385		else if (event == POWER_LIMIT_EVENT)386			state = &pstate->core_power_limit;387		else388			return;389	} else if (level == PACKAGE_LEVEL) {390		if (event == THERMAL_THROTTLING_EVENT)391			state = &pstate->package_throttle;392		else if (event == POWER_LIMIT_EVENT)393			state = &pstate->package_power_limit;394		else395			return;396	} else397		return;398 399	old_event = state->new_event;400	state->new_event = new_event;401 402	if (new_event)403		state->count++;404 405	if (event != THERMAL_THROTTLING_EVENT)406		return;407 408	if (new_event && !state->last_interrupt_time) {409		bool hot;410		u8 temp;411 412		get_therm_status(state->level, &hot, &temp);413		/*414		 * Ignore short temperature spike as the system is not close415		 * to PROCHOT. 10C offset is large enough to ignore. It is416		 * already dropped from the high threshold temperature.417		 */418		if (temp > 10)419			return;420 421		state->baseline_temp = temp;422		state->last_interrupt_time = now;423		schedule_delayed_work_on(this_cpu, &state->therm_work, THERM_THROT_POLL_INTERVAL);424	} else if (old_event && state->last_interrupt_time) {425		unsigned long throttle_time;426 427		throttle_time = jiffies_delta_to_msecs(now - state->last_interrupt_time);428		if (throttle_time > state->max_time_ms)429			state->max_time_ms = throttle_time;430		state->total_time_ms += throttle_time;431		state->last_interrupt_time = 0;432	}433}434 435static int thresh_event_valid(int level, int event)436{437	struct _thermal_state *state;438	unsigned int this_cpu = smp_processor_id();439	struct thermal_state *pstate = &per_cpu(thermal_state, this_cpu);440	u64 now = get_jiffies_64();441 442	if (level == PACKAGE_LEVEL)443		state = (event == 0) ? &pstate->pkg_thresh0 :444						&pstate->pkg_thresh1;445	else446		state = (event == 0) ? &pstate->core_thresh0 :447						&pstate->core_thresh1;448 449	if (time_before64(now, state->next_check))450		return 0;451 452	state->next_check = now + CHECK_INTERVAL;453 454	return 1;455}456 457static bool int_pln_enable;458static int __init int_pln_enable_setup(char *s)459{460	int_pln_enable = true;461 462	return 1;463}464__setup("int_pln_enable", int_pln_enable_setup);465 466#ifdef CONFIG_SYSFS467/* Add/Remove thermal_throttle interface for CPU device: */468static int thermal_throttle_add_dev(struct device *dev, unsigned int cpu)469{470	int err;471	struct cpuinfo_x86 *c = &cpu_data(cpu);472 473	err = sysfs_create_group(&dev->kobj, &thermal_attr_group);474	if (err)475		return err;476 477	if (cpu_has(c, X86_FEATURE_PLN) && int_pln_enable) {478		err = sysfs_add_file_to_group(&dev->kobj,479					      &dev_attr_core_power_limit_count.attr,480					      thermal_attr_group.name);481		if (err)482			goto del_group;483	}484 485	if (cpu_has(c, X86_FEATURE_PTS)) {486		err = sysfs_add_file_to_group(&dev->kobj,487					      &dev_attr_package_throttle_count.attr,488					      thermal_attr_group.name);489		if (err)490			goto del_group;491 492		err = sysfs_add_file_to_group(&dev->kobj,493					      &dev_attr_package_throttle_max_time_ms.attr,494					      thermal_attr_group.name);495		if (err)496			goto del_group;497 498		err = sysfs_add_file_to_group(&dev->kobj,499					      &dev_attr_package_throttle_total_time_ms.attr,500					      thermal_attr_group.name);501		if (err)502			goto del_group;503 504		if (cpu_has(c, X86_FEATURE_PLN) && int_pln_enable) {505			err = sysfs_add_file_to_group(&dev->kobj,506					&dev_attr_package_power_limit_count.attr,507					thermal_attr_group.name);508			if (err)509				goto del_group;510		}511	}512 513	return 0;514 515del_group:516	sysfs_remove_group(&dev->kobj, &thermal_attr_group);517 518	return err;519}520 521static void thermal_throttle_remove_dev(struct device *dev)522{523	sysfs_remove_group(&dev->kobj, &thermal_attr_group);524}525 526/* Get notified when a cpu comes on/off. Be hotplug friendly. */527static int thermal_throttle_online(unsigned int cpu)528{529	struct thermal_state *state = &per_cpu(thermal_state, cpu);530	struct device *dev = get_cpu_device(cpu);531	u32 l;532 533	state->package_throttle.level = PACKAGE_LEVEL;534	state->core_throttle.level = CORE_LEVEL;535 536	INIT_DELAYED_WORK(&state->package_throttle.therm_work, throttle_active_work);537	INIT_DELAYED_WORK(&state->core_throttle.therm_work, throttle_active_work);538 539	/*540	 * The first CPU coming online will enable the HFI. Usually this causes541	 * hardware to issue an HFI thermal interrupt. Such interrupt will reach542	 * the CPU once we enable the thermal vector in the local APIC.543	 */544	intel_hfi_online(cpu);545 546	/* Unmask the thermal vector after the above workqueues are initialized. */547	l = apic_read(APIC_LVTTHMR);548	apic_write(APIC_LVTTHMR, l & ~APIC_LVT_MASKED);549 550	return thermal_throttle_add_dev(dev, cpu);551}552 553static int thermal_throttle_offline(unsigned int cpu)554{555	struct thermal_state *state = &per_cpu(thermal_state, cpu);556	struct device *dev = get_cpu_device(cpu);557	u32 l;558 559	/* Mask the thermal vector before draining evtl. pending work */560	l = apic_read(APIC_LVTTHMR);561	apic_write(APIC_LVTTHMR, l | APIC_LVT_MASKED);562 563	intel_hfi_offline(cpu);564 565	cancel_delayed_work_sync(&state->package_throttle.therm_work);566	cancel_delayed_work_sync(&state->core_throttle.therm_work);567 568	state->package_throttle.rate_control_active = false;569	state->core_throttle.rate_control_active = false;570 571	thermal_throttle_remove_dev(dev);572	return 0;573}574 575static __init int thermal_throttle_init_device(void)576{577	int ret;578 579	if (!atomic_read(&therm_throt_en))580		return 0;581 582	intel_hfi_init();583 584	ret = cpuhp_setup_state(CPUHP_AP_ONLINE_DYN, "x86/therm:online",585				thermal_throttle_online,586				thermal_throttle_offline);587	return ret < 0 ? ret : 0;588}589device_initcall(thermal_throttle_init_device);590 591#endif /* CONFIG_SYSFS */592 593static void notify_package_thresholds(__u64 msr_val)594{595	bool notify_thres_0 = false;596	bool notify_thres_1 = false;597 598	if (!platform_thermal_package_notify)599		return;600 601	/* lower threshold check */602	if (msr_val & THERM_LOG_THRESHOLD0)603		notify_thres_0 = true;604	/* higher threshold check */605	if (msr_val & THERM_LOG_THRESHOLD1)606		notify_thres_1 = true;607 608	if (!notify_thres_0 && !notify_thres_1)609		return;610 611	if (platform_thermal_package_rate_control &&612		platform_thermal_package_rate_control()) {613		/* Rate control is implemented in callback */614		platform_thermal_package_notify(msr_val);615		return;616	}617 618	/* lower threshold reached */619	if (notify_thres_0 && thresh_event_valid(PACKAGE_LEVEL, 0))620		platform_thermal_package_notify(msr_val);621	/* higher threshold reached */622	if (notify_thres_1 && thresh_event_valid(PACKAGE_LEVEL, 1))623		platform_thermal_package_notify(msr_val);624}625 626static void notify_thresholds(__u64 msr_val)627{628	/* check whether the interrupt handler is defined;629	 * otherwise simply return630	 */631	if (!platform_thermal_notify)632		return;633 634	/* lower threshold reached */635	if ((msr_val & THERM_LOG_THRESHOLD0) &&636			thresh_event_valid(CORE_LEVEL, 0))637		platform_thermal_notify(msr_val);638	/* higher threshold reached */639	if ((msr_val & THERM_LOG_THRESHOLD1) &&640			thresh_event_valid(CORE_LEVEL, 1))641		platform_thermal_notify(msr_val);642}643 644void __weak notify_hwp_interrupt(void)645{646	wrmsrl_safe(MSR_HWP_STATUS, 0);647}648 649/* Thermal transition interrupt handler */650void intel_thermal_interrupt(void)651{652	__u64 msr_val;653 654	if (static_cpu_has(X86_FEATURE_HWP))655		notify_hwp_interrupt();656 657	rdmsrl(MSR_IA32_THERM_STATUS, msr_val);658 659	/* Check for violation of core thermal thresholds*/660	notify_thresholds(msr_val);661 662	therm_throt_process(msr_val & THERM_STATUS_PROCHOT,663			    THERMAL_THROTTLING_EVENT,664			    CORE_LEVEL);665 666	if (this_cpu_has(X86_FEATURE_PLN) && int_pln_enable)667		therm_throt_process(msr_val & THERM_STATUS_POWER_LIMIT,668					POWER_LIMIT_EVENT,669					CORE_LEVEL);670 671	if (this_cpu_has(X86_FEATURE_PTS)) {672		rdmsrl(MSR_IA32_PACKAGE_THERM_STATUS, msr_val);673		/* check violations of package thermal thresholds */674		notify_package_thresholds(msr_val);675		therm_throt_process(msr_val & PACKAGE_THERM_STATUS_PROCHOT,676					THERMAL_THROTTLING_EVENT,677					PACKAGE_LEVEL);678		if (this_cpu_has(X86_FEATURE_PLN) && int_pln_enable)679			therm_throt_process(msr_val &680					PACKAGE_THERM_STATUS_POWER_LIMIT,681					POWER_LIMIT_EVENT,682					PACKAGE_LEVEL);683 684		if (this_cpu_has(X86_FEATURE_HFI))685			intel_hfi_process_event(msr_val &686						PACKAGE_THERM_STATUS_HFI_UPDATED);687	}688}689 690/* Thermal monitoring depends on APIC, ACPI and clock modulation */691static int intel_thermal_supported(struct cpuinfo_x86 *c)692{693	if (!boot_cpu_has(X86_FEATURE_APIC))694		return 0;695	if (!cpu_has(c, X86_FEATURE_ACPI) || !cpu_has(c, X86_FEATURE_ACC))696		return 0;697	return 1;698}699 700bool x86_thermal_enabled(void)701{702	return atomic_read(&therm_throt_en);703}704 705void __init therm_lvt_init(void)706{707	/*708	 * This function is only called on boot CPU. Save the init thermal709	 * LVT value on BSP and use that value to restore APs' thermal LVT710	 * entry BIOS programmed later711	 */712	if (intel_thermal_supported(&boot_cpu_data))713		lvtthmr_init = apic_read(APIC_LVTTHMR);714}715 716void intel_init_thermal(struct cpuinfo_x86 *c)717{718	unsigned int cpu = smp_processor_id();719	int tm2 = 0;720	u32 l, h;721 722	if (!intel_thermal_supported(c))723		return;724 725	/*726	 * First check if its enabled already, in which case there might727	 * be some SMM goo which handles it, so we can't even put a handler728	 * since it might be delivered via SMI already:729	 */730	rdmsr(MSR_IA32_MISC_ENABLE, l, h);731 732	h = lvtthmr_init;733	/*734	 * The initial value of thermal LVT entries on all APs always reads735	 * 0x10000 because APs are woken up by BSP issuing INIT-SIPI-SIPI736	 * sequence to them and LVT registers are reset to 0s except for737	 * the mask bits which are set to 1s when APs receive INIT IPI.738	 * If BIOS takes over the thermal interrupt and sets its interrupt739	 * delivery mode to SMI (not fixed), it restores the value that the740	 * BIOS has programmed on AP based on BSP's info we saved since BIOS741	 * is always setting the same value for all threads/cores.742	 */743	if ((h & APIC_DM_FIXED_MASK) != APIC_DM_FIXED)744		apic_write(APIC_LVTTHMR, lvtthmr_init);745 746 747	if ((l & MSR_IA32_MISC_ENABLE_TM1) && (h & APIC_DM_SMI)) {748		if (system_state == SYSTEM_BOOTING)749			pr_debug("CPU%d: Thermal monitoring handled by SMI\n", cpu);750		return;751	}752 753	/* early Pentium M models use different method for enabling TM2 */754	if (cpu_has(c, X86_FEATURE_TM2)) {755		if (c->x86 == 6 && (c->x86_model == 9 || c->x86_model == 13)) {756			rdmsr(MSR_THERM2_CTL, l, h);757			if (l & MSR_THERM2_CTL_TM_SELECT)758				tm2 = 1;759		} else if (l & MSR_IA32_MISC_ENABLE_TM2)760			tm2 = 1;761	}762 763	/* We'll mask the thermal vector in the lapic till we're ready: */764	h = THERMAL_APIC_VECTOR | APIC_DM_FIXED | APIC_LVT_MASKED;765	apic_write(APIC_LVTTHMR, h);766 767	thermal_intr_init_core_clear_mask();768	thermal_intr_init_pkg_clear_mask();769 770	rdmsr(MSR_IA32_THERM_INTERRUPT, l, h);771	if (cpu_has(c, X86_FEATURE_PLN) && !int_pln_enable)772		wrmsr(MSR_IA32_THERM_INTERRUPT,773			(l | (THERM_INT_LOW_ENABLE774			| THERM_INT_HIGH_ENABLE)) & ~THERM_INT_PLN_ENABLE, h);775	else if (cpu_has(c, X86_FEATURE_PLN) && int_pln_enable)776		wrmsr(MSR_IA32_THERM_INTERRUPT,777			l | (THERM_INT_LOW_ENABLE778			| THERM_INT_HIGH_ENABLE | THERM_INT_PLN_ENABLE), h);779	else780		wrmsr(MSR_IA32_THERM_INTERRUPT,781		      l | (THERM_INT_LOW_ENABLE | THERM_INT_HIGH_ENABLE), h);782 783	if (cpu_has(c, X86_FEATURE_PTS)) {784		rdmsr(MSR_IA32_PACKAGE_THERM_INTERRUPT, l, h);785		if (cpu_has(c, X86_FEATURE_PLN) && !int_pln_enable)786			wrmsr(MSR_IA32_PACKAGE_THERM_INTERRUPT,787				(l | (PACKAGE_THERM_INT_LOW_ENABLE788				| PACKAGE_THERM_INT_HIGH_ENABLE))789				& ~PACKAGE_THERM_INT_PLN_ENABLE, h);790		else if (cpu_has(c, X86_FEATURE_PLN) && int_pln_enable)791			wrmsr(MSR_IA32_PACKAGE_THERM_INTERRUPT,792				l | (PACKAGE_THERM_INT_LOW_ENABLE793				| PACKAGE_THERM_INT_HIGH_ENABLE794				| PACKAGE_THERM_INT_PLN_ENABLE), h);795		else796			wrmsr(MSR_IA32_PACKAGE_THERM_INTERRUPT,797			      l | (PACKAGE_THERM_INT_LOW_ENABLE798				| PACKAGE_THERM_INT_HIGH_ENABLE), h);799 800		if (cpu_has(c, X86_FEATURE_HFI)) {801			rdmsr(MSR_IA32_PACKAGE_THERM_INTERRUPT, l, h);802			wrmsr(MSR_IA32_PACKAGE_THERM_INTERRUPT,803			      l | PACKAGE_THERM_INT_HFI_ENABLE, h);804		}805	}806 807	rdmsr(MSR_IA32_MISC_ENABLE, l, h);808	wrmsr(MSR_IA32_MISC_ENABLE, l | MSR_IA32_MISC_ENABLE_TM1, h);809 810	pr_info_once("CPU0: Thermal monitoring enabled (%s)\n",811		      tm2 ? "TM2" : "TM1");812 813	/* enable thermal throttle processing */814	atomic_set(&therm_throt_en, 1);815}816