1 files changed, 30 insertions, 0 deletions

diff --git a/drivers/cpufreq/intel_pstate.c b/drivers/cpufreq/intel_pstate.c
index a54d65aa776d..50bd6d987fc3 100644
--- a/drivers/cpufreq/intel_pstate.c
+++ b/drivers/cpufreq/intel_pstate.c
@@ -1235,6 +1235,25 @@ static void intel_pstate_hwp_enable(struct cpudata *cpudata)
                 cpudata->epp_default = intel_pstate_get_epp(cpudata, 0);
 }
 
+#define MSR_IA32_POWER_CTL_BIT_EE       19
+
+/* Disable energy efficiency optimization */
+static void intel_pstate_disable_ee(int cpu)
+{
+        u64 power_ctl;
+        int ret;
+
+        ret = rdmsrl_on_cpu(cpu, MSR_IA32_POWER_CTL, &power_ctl);
+        if (ret)
+                return;
+
+        if (!(power_ctl & BIT(MSR_IA32_POWER_CTL_BIT_EE))) {
+                pr_info("Disabling energy efficiency optimization\n");
+                power_ctl |= BIT(MSR_IA32_POWER_CTL_BIT_EE);
+                wrmsrl_on_cpu(cpu, MSR_IA32_POWER_CTL, power_ctl);
+        }
+}
+
 static int atom_get_min_pstate(void)
 {
         u64 value;
@@ -1845,6 +1864,11 @@ static const struct x86_cpu_id intel_pstate_cpu_oob_ids[] __initconst = {
         {}
 };
 
+static const struct x86_cpu_id intel_pstate_cpu_ee_disable_ids[] = {
+        ICPU(INTEL_FAM6_KABYLAKE_DESKTOP, core_params),
+        {}
+};
+
 static int intel_pstate_init_cpu(unsigned int cpunum)
 {
         struct cpudata *cpu;
@@ -1875,6 +1899,12 @@ static int intel_pstate_init_cpu(unsigned int cpunum)
         cpu->cpu = cpunum;
 
         if (hwp_active) {
+                const struct x86_cpu_id *id;
+
+                id = x86_match_cpu(intel_pstate_cpu_ee_disable_ids);
+                if (id)
+                        intel_pstate_disable_ee(cpunum);
+
                 intel_pstate_hwp_enable(cpu);
                 pid_params.sample_rate_ms = 50;
                 pid_params.sample_rate_ns = 50 * NSEC_PER_MSEC;