blob: c568226bbcdfc0e01a105acfc24e457c034c9efd [file] [log] [blame]
Dirk Brandewie93f08222013-02-06 09:02:13 -08001/*
Srinivas Pandruvadad1b68482013-04-09 22:38:18 +00002 * intel_pstate.c: Native P state management for Intel processors
Dirk Brandewie93f08222013-02-06 09:02:13 -08003 *
4 * (C) Copyright 2012 Intel Corporation
5 * Author: Dirk Brandewie <dirk.j.brandewie@intel.com>
6 *
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License
9 * as published by the Free Software Foundation; version 2
10 * of the License.
11 */
12
13#include <linux/kernel.h>
14#include <linux/kernel_stat.h>
15#include <linux/module.h>
16#include <linux/ktime.h>
17#include <linux/hrtimer.h>
18#include <linux/tick.h>
19#include <linux/slab.h>
20#include <linux/sched.h>
21#include <linux/list.h>
22#include <linux/cpu.h>
23#include <linux/cpufreq.h>
24#include <linux/sysfs.h>
25#include <linux/types.h>
26#include <linux/fs.h>
27#include <linux/debugfs.h>
Adrian Huangfbbcdc02013-10-31 23:24:05 +080028#include <linux/acpi.h>
Stephen Rothwelld6472302015-06-02 19:01:38 +100029#include <linux/vmalloc.h>
Dirk Brandewie93f08222013-02-06 09:02:13 -080030#include <trace/events/power.h>
31
32#include <asm/div64.h>
33#include <asm/msr.h>
34#include <asm/cpu_device_id.h>
Borislav Petkov64df1fd2015-04-03 15:19:53 +020035#include <asm/cpufeature.h>
Dirk Brandewie93f08222013-02-06 09:02:13 -080036
Srinivas Pandruvada37afb002015-10-14 16:12:01 -070037#if IS_ENABLED(CONFIG_ACPI)
38#include <acpi/processor.h>
39#endif
40
Dirk Brandewie61d8d2a2014-02-12 10:01:07 -080041#define BYT_RATIOS 0x66a
42#define BYT_VIDS 0x66b
43#define BYT_TURBO_RATIOS 0x66c
Dirk Brandewie21855ff2014-05-08 12:57:23 -070044#define BYT_TURBO_VIDS 0x66d
Dirk Brandewie61d8d2a2014-02-12 10:01:07 -080045
Dirk Brandewief0fe3cd2014-05-29 09:32:23 -070046#define FRAC_BITS 8
Dirk Brandewie93f08222013-02-06 09:02:13 -080047#define int_tofp(X) ((int64_t)(X) << FRAC_BITS)
48#define fp_toint(X) ((X) >> FRAC_BITS)
Dirk Brandewief0fe3cd2014-05-29 09:32:23 -070049
Dirk Brandewie93f08222013-02-06 09:02:13 -080050static inline int32_t mul_fp(int32_t x, int32_t y)
51{
52 return ((int64_t)x * (int64_t)y) >> FRAC_BITS;
53}
54
Prarit Bhargava7180ddd2015-06-15 13:43:29 -040055static inline int32_t div_fp(s64 x, s64 y)
Dirk Brandewie93f08222013-02-06 09:02:13 -080056{
Prarit Bhargava7180ddd2015-06-15 13:43:29 -040057 return div64_s64((int64_t)x << FRAC_BITS, y);
Dirk Brandewie93f08222013-02-06 09:02:13 -080058}
59
Dirk Brandewied022a652014-10-13 08:37:44 -070060static inline int ceiling_fp(int32_t x)
61{
62 int mask, ret;
63
64 ret = fp_toint(x);
65 mask = (1 << FRAC_BITS) - 1;
66 if (x & mask)
67 ret += 1;
68 return ret;
69}
70
Dirk Brandewie93f08222013-02-06 09:02:13 -080071struct sample {
Brennan Shacklettd253d2a2013-10-21 09:20:32 -070072 int32_t core_pct_busy;
Dirk Brandewie93f08222013-02-06 09:02:13 -080073 u64 aperf;
74 u64 mperf;
Doug Smythies4055fad2015-04-11 21:10:26 -070075 u64 tsc;
Dirk Brandewie93f08222013-02-06 09:02:13 -080076 int freq;
Dirk Brandewiec4ee8412014-05-29 09:32:24 -070077 ktime_t time;
Dirk Brandewie93f08222013-02-06 09:02:13 -080078};
79
80struct pstate_data {
81 int current_pstate;
82 int min_pstate;
83 int max_pstate;
Srinivas Pandruvada3bcc6fa2015-10-14 16:12:00 -070084 int max_pstate_physical;
Dirk Brandewieb27580b2014-10-13 08:37:43 -070085 int scaling;
Dirk Brandewie93f08222013-02-06 09:02:13 -080086 int turbo_pstate;
87};
88
Dirk Brandewie007bea02013-12-18 10:32:39 -080089struct vid_data {
Dirk Brandewie21855ff2014-05-08 12:57:23 -070090 int min;
91 int max;
92 int turbo;
Dirk Brandewie007bea02013-12-18 10:32:39 -080093 int32_t ratio;
94};
95
Dirk Brandewie93f08222013-02-06 09:02:13 -080096struct _pid {
97 int setpoint;
98 int32_t integral;
99 int32_t p_gain;
100 int32_t i_gain;
101 int32_t d_gain;
102 int deadband;
Brennan Shacklettd253d2a2013-10-21 09:20:32 -0700103 int32_t last_err;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800104};
105
106struct cpudata {
107 int cpu;
108
Dirk Brandewie93f08222013-02-06 09:02:13 -0800109 struct timer_list timer;
110
Dirk Brandewie93f08222013-02-06 09:02:13 -0800111 struct pstate_data pstate;
Dirk Brandewie007bea02013-12-18 10:32:39 -0800112 struct vid_data vid;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800113 struct _pid pid;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800114
Dirk Brandewiec4ee8412014-05-29 09:32:24 -0700115 ktime_t last_sample_time;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800116 u64 prev_aperf;
117 u64 prev_mperf;
Doug Smythies4055fad2015-04-11 21:10:26 -0700118 u64 prev_tsc;
Dirk Brandewied37e2b72014-02-12 10:01:04 -0800119 struct sample sample;
Srinivas Pandruvada37afb002015-10-14 16:12:01 -0700120#if IS_ENABLED(CONFIG_ACPI)
121 struct acpi_processor_performance acpi_perf_data;
122#endif
Dirk Brandewie93f08222013-02-06 09:02:13 -0800123};
124
125static struct cpudata **all_cpu_data;
126struct pstate_adjust_policy {
127 int sample_rate_ms;
128 int deadband;
129 int setpoint;
130 int p_gain_pct;
131 int d_gain_pct;
132 int i_gain_pct;
133};
134
Dirk Brandewie016c8152013-10-21 09:20:34 -0700135struct pstate_funcs {
136 int (*get_max)(void);
Srinivas Pandruvada3bcc6fa2015-10-14 16:12:00 -0700137 int (*get_max_physical)(void);
Dirk Brandewie016c8152013-10-21 09:20:34 -0700138 int (*get_min)(void);
139 int (*get_turbo)(void);
Dirk Brandewieb27580b2014-10-13 08:37:43 -0700140 int (*get_scaling)(void);
Dirk Brandewie007bea02013-12-18 10:32:39 -0800141 void (*set)(struct cpudata*, int pstate);
142 void (*get_vid)(struct cpudata *);
Dirk Brandewie93f08222013-02-06 09:02:13 -0800143};
144
Dirk Brandewie016c8152013-10-21 09:20:34 -0700145struct cpu_defaults {
146 struct pstate_adjust_policy pid_policy;
147 struct pstate_funcs funcs;
148};
149
150static struct pstate_adjust_policy pid_params;
151static struct pstate_funcs pstate_funcs;
Dirk Brandewie2f86dc42014-11-06 09:40:47 -0800152static int hwp_active;
Srinivas Pandruvada37afb002015-10-14 16:12:01 -0700153static int no_acpi_perf;
Dirk Brandewie016c8152013-10-21 09:20:34 -0700154
Dirk Brandewie93f08222013-02-06 09:02:13 -0800155struct perf_limits {
156 int no_turbo;
Dirk Brandewiedd5fbf72014-06-20 07:27:59 -0700157 int turbo_disabled;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800158 int max_perf_pct;
159 int min_perf_pct;
160 int32_t max_perf;
161 int32_t min_perf;
Dirk Brandewied8f469e2013-05-07 08:20:26 -0700162 int max_policy_pct;
163 int max_sysfs_pct;
Kristen Carlson Accardia0475992015-01-29 13:03:52 -0800164 int min_policy_pct;
165 int min_sysfs_pct;
Srinivas Pandruvada4ef45142015-10-14 16:12:03 -0700166 int max_perf_ctl;
167 int min_perf_ctl;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800168};
169
170static struct perf_limits limits = {
171 .no_turbo = 0,
Gabriele Mazzotta4521e1a02014-10-13 08:37:41 -0700172 .turbo_disabled = 0,
Dirk Brandewie93f08222013-02-06 09:02:13 -0800173 .max_perf_pct = 100,
174 .max_perf = int_tofp(1),
175 .min_perf_pct = 0,
176 .min_perf = 0,
Dirk Brandewied8f469e2013-05-07 08:20:26 -0700177 .max_policy_pct = 100,
178 .max_sysfs_pct = 100,
Kristen Carlson Accardia0475992015-01-29 13:03:52 -0800179 .min_policy_pct = 0,
180 .min_sysfs_pct = 0,
Srinivas Pandruvada4ef45142015-10-14 16:12:03 -0700181 .max_perf_ctl = 0,
182 .min_perf_ctl = 0,
Dirk Brandewie93f08222013-02-06 09:02:13 -0800183};
184
Srinivas Pandruvada37afb002015-10-14 16:12:01 -0700185#if IS_ENABLED(CONFIG_ACPI)
186/*
187 * The max target pstate ratio is a 8 bit value in both PLATFORM_INFO MSR and
188 * in TURBO_RATIO_LIMIT MSR, which pstate driver stores in max_pstate and
189 * max_turbo_pstate fields. The PERF_CTL MSR contains 16 bit value for P state
190 * ratio, out of it only high 8 bits are used. For example 0x1700 is setting
191 * target ratio 0x17. The _PSS control value stores in a format which can be
192 * directly written to PERF_CTL MSR. But in intel_pstate driver this shift
193 * occurs during write to PERF_CTL (E.g. for cores core_set_pstate()).
194 * This function converts the _PSS control value to intel pstate driver format
195 * for comparison and assignment.
196 */
197static int convert_to_native_pstate_format(struct cpudata *cpu, int index)
198{
199 return cpu->acpi_perf_data.states[index].control >> 8;
200}
201
202static int intel_pstate_init_perf_limits(struct cpufreq_policy *policy)
203{
204 struct cpudata *cpu;
205 int ret;
206 bool turbo_absent = false;
207 int max_pstate_index;
208 int min_pss_ctl, max_pss_ctl, turbo_pss_ctl;
209 int i;
210
211 cpu = all_cpu_data[policy->cpu];
212
213 pr_debug("intel_pstate: default limits 0x%x 0x%x 0x%x\n",
214 cpu->pstate.min_pstate, cpu->pstate.max_pstate,
215 cpu->pstate.turbo_pstate);
216
217 if (!cpu->acpi_perf_data.shared_cpu_map &&
218 zalloc_cpumask_var_node(&cpu->acpi_perf_data.shared_cpu_map,
219 GFP_KERNEL, cpu_to_node(policy->cpu))) {
220 return -ENOMEM;
221 }
222
223 ret = acpi_processor_register_performance(&cpu->acpi_perf_data,
224 policy->cpu);
225 if (ret)
226 return ret;
227
228 /*
229 * Check if the control value in _PSS is for PERF_CTL MSR, which should
230 * guarantee that the states returned by it map to the states in our
231 * list directly.
232 */
233 if (cpu->acpi_perf_data.control_register.space_id !=
234 ACPI_ADR_SPACE_FIXED_HARDWARE)
235 return -EIO;
236
237 pr_debug("intel_pstate: CPU%u - ACPI _PSS perf data\n", policy->cpu);
238 for (i = 0; i < cpu->acpi_perf_data.state_count; i++)
239 pr_debug(" %cP%d: %u MHz, %u mW, 0x%x\n",
240 (i == cpu->acpi_perf_data.state ? '*' : ' '), i,
241 (u32) cpu->acpi_perf_data.states[i].core_frequency,
242 (u32) cpu->acpi_perf_data.states[i].power,
243 (u32) cpu->acpi_perf_data.states[i].control);
244
245 /*
246 * If there is only one entry _PSS, simply ignore _PSS and continue as
247 * usual without taking _PSS into account
248 */
249 if (cpu->acpi_perf_data.state_count < 2)
250 return 0;
251
252 turbo_pss_ctl = convert_to_native_pstate_format(cpu, 0);
253 min_pss_ctl = convert_to_native_pstate_format(cpu,
254 cpu->acpi_perf_data.state_count - 1);
255 /* Check if there is a turbo freq in _PSS */
256 if (turbo_pss_ctl <= cpu->pstate.max_pstate &&
257 turbo_pss_ctl > cpu->pstate.min_pstate) {
258 pr_debug("intel_pstate: no turbo range exists in _PSS\n");
259 limits.no_turbo = limits.turbo_disabled = 1;
260 cpu->pstate.turbo_pstate = cpu->pstate.max_pstate;
261 turbo_absent = true;
262 }
263
264 /* Check if the max non turbo p state < Intel P state max */
265 max_pstate_index = turbo_absent ? 0 : 1;
266 max_pss_ctl = convert_to_native_pstate_format(cpu, max_pstate_index);
267 if (max_pss_ctl < cpu->pstate.max_pstate &&
268 max_pss_ctl > cpu->pstate.min_pstate)
269 cpu->pstate.max_pstate = max_pss_ctl;
270
271 /* check If min perf > Intel P State min */
272 if (min_pss_ctl > cpu->pstate.min_pstate &&
273 min_pss_ctl < cpu->pstate.max_pstate) {
274 cpu->pstate.min_pstate = min_pss_ctl;
275 policy->cpuinfo.min_freq = min_pss_ctl * cpu->pstate.scaling;
276 }
277
278 if (turbo_absent)
279 policy->cpuinfo.max_freq = cpu->pstate.max_pstate *
280 cpu->pstate.scaling;
281 else {
282 policy->cpuinfo.max_freq = cpu->pstate.turbo_pstate *
283 cpu->pstate.scaling;
284 /*
285 * The _PSS table doesn't contain whole turbo frequency range.
286 * This just contains +1 MHZ above the max non turbo frequency,
287 * with control value corresponding to max turbo ratio. But
288 * when cpufreq set policy is called, it will call with this
289 * max frequency, which will cause a reduced performance as
290 * this driver uses real max turbo frequency as the max
291 * frequeny. So correct this frequency in _PSS table to
292 * correct max turbo frequency based on the turbo ratio.
293 * Also need to convert to MHz as _PSS freq is in MHz.
294 */
295 cpu->acpi_perf_data.states[0].core_frequency =
296 turbo_pss_ctl * 100;
297 }
298
299 pr_debug("intel_pstate: Updated limits using _PSS 0x%x 0x%x 0x%x\n",
300 cpu->pstate.min_pstate, cpu->pstate.max_pstate,
301 cpu->pstate.turbo_pstate);
302 pr_debug("intel_pstate: policy max_freq=%d Khz min_freq = %d KHz\n",
303 policy->cpuinfo.max_freq, policy->cpuinfo.min_freq);
304
305 return 0;
306}
307
308static int intel_pstate_exit_perf_limits(struct cpufreq_policy *policy)
309{
310 struct cpudata *cpu;
311
312 if (!no_acpi_perf)
313 return 0;
314
315 cpu = all_cpu_data[policy->cpu];
316 acpi_processor_unregister_performance(policy->cpu);
317 return 0;
318}
319
320#else
321static int intel_pstate_init_perf_limits(struct cpufreq_policy *policy)
322{
323 return 0;
324}
325
326static int intel_pstate_exit_perf_limits(struct cpufreq_policy *policy)
327{
328 return 0;
329}
330#endif
331
Dirk Brandewie93f08222013-02-06 09:02:13 -0800332static inline void pid_reset(struct _pid *pid, int setpoint, int busy,
Stratos Karafotisc4108332014-07-18 08:37:23 -0700333 int deadband, int integral) {
Dirk Brandewie93f08222013-02-06 09:02:13 -0800334 pid->setpoint = setpoint;
335 pid->deadband = deadband;
336 pid->integral = int_tofp(integral);
Dirk Brandewied98d0992014-02-12 10:01:05 -0800337 pid->last_err = int_tofp(setpoint) - int_tofp(busy);
Dirk Brandewie93f08222013-02-06 09:02:13 -0800338}
339
340static inline void pid_p_gain_set(struct _pid *pid, int percent)
341{
342 pid->p_gain = div_fp(int_tofp(percent), int_tofp(100));
343}
344
345static inline void pid_i_gain_set(struct _pid *pid, int percent)
346{
347 pid->i_gain = div_fp(int_tofp(percent), int_tofp(100));
348}
349
350static inline void pid_d_gain_set(struct _pid *pid, int percent)
351{
Dirk Brandewie93f08222013-02-06 09:02:13 -0800352 pid->d_gain = div_fp(int_tofp(percent), int_tofp(100));
353}
354
Brennan Shacklettd253d2a2013-10-21 09:20:32 -0700355static signed int pid_calc(struct _pid *pid, int32_t busy)
Dirk Brandewie93f08222013-02-06 09:02:13 -0800356{
Brennan Shacklettd253d2a2013-10-21 09:20:32 -0700357 signed int result;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800358 int32_t pterm, dterm, fp_error;
359 int32_t integral_limit;
360
Brennan Shacklettd253d2a2013-10-21 09:20:32 -0700361 fp_error = int_tofp(pid->setpoint) - busy;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800362
Brennan Shacklettd253d2a2013-10-21 09:20:32 -0700363 if (abs(fp_error) <= int_tofp(pid->deadband))
Dirk Brandewie93f08222013-02-06 09:02:13 -0800364 return 0;
365
366 pterm = mul_fp(pid->p_gain, fp_error);
367
368 pid->integral += fp_error;
369
Kristen Carlson Accardie0d4c8f2014-12-10 12:39:38 -0800370 /*
371 * We limit the integral here so that it will never
372 * get higher than 30. This prevents it from becoming
373 * too large an input over long periods of time and allows
374 * it to get factored out sooner.
375 *
376 * The value of 30 was chosen through experimentation.
377 */
Dirk Brandewie93f08222013-02-06 09:02:13 -0800378 integral_limit = int_tofp(30);
379 if (pid->integral > integral_limit)
380 pid->integral = integral_limit;
381 if (pid->integral < -integral_limit)
382 pid->integral = -integral_limit;
383
Brennan Shacklettd253d2a2013-10-21 09:20:32 -0700384 dterm = mul_fp(pid->d_gain, fp_error - pid->last_err);
385 pid->last_err = fp_error;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800386
387 result = pterm + mul_fp(pid->integral, pid->i_gain) + dterm;
Doug Smythies51d211e2014-06-17 13:36:10 -0700388 result = result + (1 << (FRAC_BITS-1));
Dirk Brandewie93f08222013-02-06 09:02:13 -0800389 return (signed int)fp_toint(result);
390}
391
392static inline void intel_pstate_busy_pid_reset(struct cpudata *cpu)
393{
Dirk Brandewie016c8152013-10-21 09:20:34 -0700394 pid_p_gain_set(&cpu->pid, pid_params.p_gain_pct);
395 pid_d_gain_set(&cpu->pid, pid_params.d_gain_pct);
396 pid_i_gain_set(&cpu->pid, pid_params.i_gain_pct);
Dirk Brandewie93f08222013-02-06 09:02:13 -0800397
Stratos Karafotis2d8d1f12014-07-18 08:37:20 -0700398 pid_reset(&cpu->pid, pid_params.setpoint, 100, pid_params.deadband, 0);
Dirk Brandewie93f08222013-02-06 09:02:13 -0800399}
400
Dirk Brandewie93f08222013-02-06 09:02:13 -0800401static inline void intel_pstate_reset_all_pid(void)
402{
403 unsigned int cpu;
Stratos Karafotis845c1cb2014-07-18 08:37:19 -0700404
Dirk Brandewie93f08222013-02-06 09:02:13 -0800405 for_each_online_cpu(cpu) {
406 if (all_cpu_data[cpu])
407 intel_pstate_busy_pid_reset(all_cpu_data[cpu]);
408 }
409}
410
Gabriele Mazzotta4521e1a02014-10-13 08:37:41 -0700411static inline void update_turbo_state(void)
412{
413 u64 misc_en;
414 struct cpudata *cpu;
415
416 cpu = all_cpu_data[0];
417 rdmsrl(MSR_IA32_MISC_ENABLE, misc_en);
418 limits.turbo_disabled =
419 (misc_en & MSR_IA32_MISC_ENABLE_TURBO_DISABLE ||
420 cpu->pstate.max_pstate == cpu->pstate.turbo_pstate);
421}
422
Dirk Brandewie2f86dc42014-11-06 09:40:47 -0800423static void intel_pstate_hwp_set(void)
424{
Kristen Carlson Accardi74da56c2015-09-09 11:41:22 -0700425 int min, hw_min, max, hw_max, cpu, range, adj_range;
426 u64 value, cap;
427
428 rdmsrl(MSR_HWP_CAPABILITIES, cap);
429 hw_min = HWP_LOWEST_PERF(cap);
430 hw_max = HWP_HIGHEST_PERF(cap);
431 range = hw_max - hw_min;
Dirk Brandewie2f86dc42014-11-06 09:40:47 -0800432
433 get_online_cpus();
434
435 for_each_online_cpu(cpu) {
436 rdmsrl_on_cpu(cpu, MSR_HWP_REQUEST, &value);
Kristen Carlson Accardi74da56c2015-09-09 11:41:22 -0700437 adj_range = limits.min_perf_pct * range / 100;
438 min = hw_min + adj_range;
Dirk Brandewie2f86dc42014-11-06 09:40:47 -0800439 value &= ~HWP_MIN_PERF(~0L);
440 value |= HWP_MIN_PERF(min);
441
Kristen Carlson Accardi74da56c2015-09-09 11:41:22 -0700442 adj_range = limits.max_perf_pct * range / 100;
443 max = hw_min + adj_range;
Dirk Brandewie2f86dc42014-11-06 09:40:47 -0800444 if (limits.no_turbo) {
Kristen Carlson Accardi74da56c2015-09-09 11:41:22 -0700445 hw_max = HWP_GUARANTEED_PERF(cap);
446 if (hw_max < max)
447 max = hw_max;
Dirk Brandewie2f86dc42014-11-06 09:40:47 -0800448 }
449
450 value &= ~HWP_MAX_PERF(~0L);
451 value |= HWP_MAX_PERF(max);
452 wrmsrl_on_cpu(cpu, MSR_HWP_REQUEST, value);
453 }
454
455 put_online_cpus();
456}
457
Dirk Brandewie93f08222013-02-06 09:02:13 -0800458/************************** debugfs begin ************************/
459static int pid_param_set(void *data, u64 val)
460{
461 *(u32 *)data = val;
462 intel_pstate_reset_all_pid();
463 return 0;
464}
Stratos Karafotis845c1cb2014-07-18 08:37:19 -0700465
Dirk Brandewie93f08222013-02-06 09:02:13 -0800466static int pid_param_get(void *data, u64 *val)
467{
468 *val = *(u32 *)data;
469 return 0;
470}
Stratos Karafotis2d8d1f12014-07-18 08:37:20 -0700471DEFINE_SIMPLE_ATTRIBUTE(fops_pid_param, pid_param_get, pid_param_set, "%llu\n");
Dirk Brandewie93f08222013-02-06 09:02:13 -0800472
473struct pid_param {
474 char *name;
475 void *value;
476};
477
478static struct pid_param pid_files[] = {
Dirk Brandewie016c8152013-10-21 09:20:34 -0700479 {"sample_rate_ms", &pid_params.sample_rate_ms},
480 {"d_gain_pct", &pid_params.d_gain_pct},
481 {"i_gain_pct", &pid_params.i_gain_pct},
482 {"deadband", &pid_params.deadband},
483 {"setpoint", &pid_params.setpoint},
484 {"p_gain_pct", &pid_params.p_gain_pct},
Dirk Brandewie93f08222013-02-06 09:02:13 -0800485 {NULL, NULL}
486};
487
Stratos Karafotis317dd502014-07-18 08:37:17 -0700488static void __init intel_pstate_debug_expose_params(void)
Dirk Brandewie93f08222013-02-06 09:02:13 -0800489{
Stratos Karafotis317dd502014-07-18 08:37:17 -0700490 struct dentry *debugfs_parent;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800491 int i = 0;
492
Dirk Brandewie2f86dc42014-11-06 09:40:47 -0800493 if (hwp_active)
494 return;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800495 debugfs_parent = debugfs_create_dir("pstate_snb", NULL);
496 if (IS_ERR_OR_NULL(debugfs_parent))
497 return;
498 while (pid_files[i].name) {
499 debugfs_create_file(pid_files[i].name, 0660,
Stratos Karafotisc4108332014-07-18 08:37:23 -0700500 debugfs_parent, pid_files[i].value,
501 &fops_pid_param);
Dirk Brandewie93f08222013-02-06 09:02:13 -0800502 i++;
503 }
504}
505
506/************************** debugfs end ************************/
507
508/************************** sysfs begin ************************/
509#define show_one(file_name, object) \
510 static ssize_t show_##file_name \
511 (struct kobject *kobj, struct attribute *attr, char *buf) \
512 { \
513 return sprintf(buf, "%u\n", limits.object); \
514 }
515
Kristen Carlson Accardid01b1f42015-01-28 15:03:27 -0800516static ssize_t show_turbo_pct(struct kobject *kobj,
517 struct attribute *attr, char *buf)
518{
519 struct cpudata *cpu;
520 int total, no_turbo, turbo_pct;
521 uint32_t turbo_fp;
522
523 cpu = all_cpu_data[0];
524
525 total = cpu->pstate.turbo_pstate - cpu->pstate.min_pstate + 1;
526 no_turbo = cpu->pstate.max_pstate - cpu->pstate.min_pstate + 1;
527 turbo_fp = div_fp(int_tofp(no_turbo), int_tofp(total));
528 turbo_pct = 100 - fp_toint(mul_fp(turbo_fp, int_tofp(100)));
529 return sprintf(buf, "%u\n", turbo_pct);
530}
531
Kristen Carlson Accardi05224242015-01-28 15:03:28 -0800532static ssize_t show_num_pstates(struct kobject *kobj,
533 struct attribute *attr, char *buf)
534{
535 struct cpudata *cpu;
536 int total;
537
538 cpu = all_cpu_data[0];
539 total = cpu->pstate.turbo_pstate - cpu->pstate.min_pstate + 1;
540 return sprintf(buf, "%u\n", total);
541}
542
Gabriele Mazzotta4521e1a02014-10-13 08:37:41 -0700543static ssize_t show_no_turbo(struct kobject *kobj,
544 struct attribute *attr, char *buf)
545{
546 ssize_t ret;
547
548 update_turbo_state();
549 if (limits.turbo_disabled)
550 ret = sprintf(buf, "%u\n", limits.turbo_disabled);
551 else
552 ret = sprintf(buf, "%u\n", limits.no_turbo);
553
554 return ret;
555}
556
Dirk Brandewie93f08222013-02-06 09:02:13 -0800557static ssize_t store_no_turbo(struct kobject *a, struct attribute *b,
Stratos Karafotisc4108332014-07-18 08:37:23 -0700558 const char *buf, size_t count)
Dirk Brandewie93f08222013-02-06 09:02:13 -0800559{
560 unsigned int input;
561 int ret;
Stratos Karafotis845c1cb2014-07-18 08:37:19 -0700562
Dirk Brandewie93f08222013-02-06 09:02:13 -0800563 ret = sscanf(buf, "%u", &input);
564 if (ret != 1)
565 return -EINVAL;
Gabriele Mazzotta4521e1a02014-10-13 08:37:41 -0700566
567 update_turbo_state();
Dirk Brandewiedd5fbf72014-06-20 07:27:59 -0700568 if (limits.turbo_disabled) {
Doug Smythiesf16255e2015-05-31 07:46:47 -0700569 pr_warn("intel_pstate: Turbo disabled by BIOS or unavailable on processor\n");
Gabriele Mazzotta4521e1a02014-10-13 08:37:41 -0700570 return -EPERM;
Dirk Brandewiedd5fbf72014-06-20 07:27:59 -0700571 }
Dirk Brandewie2f86dc42014-11-06 09:40:47 -0800572
Gabriele Mazzotta4521e1a02014-10-13 08:37:41 -0700573 limits.no_turbo = clamp_t(int, input, 0, 1);
574
Dirk Brandewie2f86dc42014-11-06 09:40:47 -0800575 if (hwp_active)
576 intel_pstate_hwp_set();
577
Dirk Brandewie93f08222013-02-06 09:02:13 -0800578 return count;
579}
580
581static ssize_t store_max_perf_pct(struct kobject *a, struct attribute *b,
Stratos Karafotisc4108332014-07-18 08:37:23 -0700582 const char *buf, size_t count)
Dirk Brandewie93f08222013-02-06 09:02:13 -0800583{
584 unsigned int input;
585 int ret;
Stratos Karafotis845c1cb2014-07-18 08:37:19 -0700586
Dirk Brandewie93f08222013-02-06 09:02:13 -0800587 ret = sscanf(buf, "%u", &input);
588 if (ret != 1)
589 return -EINVAL;
590
Dirk Brandewied8f469e2013-05-07 08:20:26 -0700591 limits.max_sysfs_pct = clamp_t(int, input, 0 , 100);
592 limits.max_perf_pct = min(limits.max_policy_pct, limits.max_sysfs_pct);
Chen Yu43717aa2015-09-09 18:27:31 +0800593 limits.max_perf_pct = max(limits.min_policy_pct, limits.max_perf_pct);
594 limits.max_perf_pct = max(limits.min_perf_pct, limits.max_perf_pct);
Dirk Brandewie93f08222013-02-06 09:02:13 -0800595 limits.max_perf = div_fp(int_tofp(limits.max_perf_pct), int_tofp(100));
Stratos Karafotis845c1cb2014-07-18 08:37:19 -0700596
Dirk Brandewie2f86dc42014-11-06 09:40:47 -0800597 if (hwp_active)
598 intel_pstate_hwp_set();
Dirk Brandewie93f08222013-02-06 09:02:13 -0800599 return count;
600}
601
602static ssize_t store_min_perf_pct(struct kobject *a, struct attribute *b,
Stratos Karafotisc4108332014-07-18 08:37:23 -0700603 const char *buf, size_t count)
Dirk Brandewie93f08222013-02-06 09:02:13 -0800604{
605 unsigned int input;
606 int ret;
Stratos Karafotis845c1cb2014-07-18 08:37:19 -0700607
Dirk Brandewie93f08222013-02-06 09:02:13 -0800608 ret = sscanf(buf, "%u", &input);
609 if (ret != 1)
610 return -EINVAL;
Kristen Carlson Accardia0475992015-01-29 13:03:52 -0800611
612 limits.min_sysfs_pct = clamp_t(int, input, 0 , 100);
613 limits.min_perf_pct = max(limits.min_policy_pct, limits.min_sysfs_pct);
Chen Yu43717aa2015-09-09 18:27:31 +0800614 limits.min_perf_pct = min(limits.max_policy_pct, limits.min_perf_pct);
615 limits.min_perf_pct = min(limits.max_perf_pct, limits.min_perf_pct);
Dirk Brandewie93f08222013-02-06 09:02:13 -0800616 limits.min_perf = div_fp(int_tofp(limits.min_perf_pct), int_tofp(100));
617
Dirk Brandewie2f86dc42014-11-06 09:40:47 -0800618 if (hwp_active)
619 intel_pstate_hwp_set();
Dirk Brandewie93f08222013-02-06 09:02:13 -0800620 return count;
621}
622
Dirk Brandewie93f08222013-02-06 09:02:13 -0800623show_one(max_perf_pct, max_perf_pct);
624show_one(min_perf_pct, min_perf_pct);
625
626define_one_global_rw(no_turbo);
627define_one_global_rw(max_perf_pct);
628define_one_global_rw(min_perf_pct);
Kristen Carlson Accardid01b1f42015-01-28 15:03:27 -0800629define_one_global_ro(turbo_pct);
Kristen Carlson Accardi05224242015-01-28 15:03:28 -0800630define_one_global_ro(num_pstates);
Dirk Brandewie93f08222013-02-06 09:02:13 -0800631
632static struct attribute *intel_pstate_attributes[] = {
633 &no_turbo.attr,
634 &max_perf_pct.attr,
635 &min_perf_pct.attr,
Kristen Carlson Accardid01b1f42015-01-28 15:03:27 -0800636 &turbo_pct.attr,
Kristen Carlson Accardi05224242015-01-28 15:03:28 -0800637 &num_pstates.attr,
Dirk Brandewie93f08222013-02-06 09:02:13 -0800638 NULL
639};
640
641static struct attribute_group intel_pstate_attr_group = {
642 .attrs = intel_pstate_attributes,
643};
Dirk Brandewie93f08222013-02-06 09:02:13 -0800644
Stratos Karafotis317dd502014-07-18 08:37:17 -0700645static void __init intel_pstate_sysfs_expose_params(void)
Dirk Brandewie93f08222013-02-06 09:02:13 -0800646{
Stratos Karafotis317dd502014-07-18 08:37:17 -0700647 struct kobject *intel_pstate_kobject;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800648 int rc;
649
650 intel_pstate_kobject = kobject_create_and_add("intel_pstate",
651 &cpu_subsys.dev_root->kobj);
652 BUG_ON(!intel_pstate_kobject);
Stratos Karafotis2d8d1f12014-07-18 08:37:20 -0700653 rc = sysfs_create_group(intel_pstate_kobject, &intel_pstate_attr_group);
Dirk Brandewie93f08222013-02-06 09:02:13 -0800654 BUG_ON(rc);
655}
Dirk Brandewie93f08222013-02-06 09:02:13 -0800656/************************** sysfs end ************************/
Dirk Brandewie2f86dc42014-11-06 09:40:47 -0800657
Kristen Carlson Accardiba88d432015-07-14 09:46:23 -0700658static void intel_pstate_hwp_enable(struct cpudata *cpudata)
Dirk Brandewie2f86dc42014-11-06 09:40:47 -0800659{
Doug Smythiesf16255e2015-05-31 07:46:47 -0700660 pr_info("intel_pstate: HWP enabled\n");
Dirk Brandewie2f86dc42014-11-06 09:40:47 -0800661
Kristen Carlson Accardiba88d432015-07-14 09:46:23 -0700662 wrmsrl_on_cpu(cpudata->cpu, MSR_PM_ENABLE, 0x1);
Dirk Brandewie2f86dc42014-11-06 09:40:47 -0800663}
664
Dirk Brandewie19e77c22013-10-21 09:20:35 -0700665static int byt_get_min_pstate(void)
666{
667 u64 value;
Stratos Karafotis845c1cb2014-07-18 08:37:19 -0700668
Dirk Brandewie19e77c22013-10-21 09:20:35 -0700669 rdmsrl(BYT_RATIOS, value);
Dirk Brandewiec16ed062014-06-20 07:27:58 -0700670 return (value >> 8) & 0x7F;
Dirk Brandewie19e77c22013-10-21 09:20:35 -0700671}
Dirk Brandewie93f08222013-02-06 09:02:13 -0800672
Dirk Brandewie19e77c22013-10-21 09:20:35 -0700673static int byt_get_max_pstate(void)
674{
675 u64 value;
Stratos Karafotis845c1cb2014-07-18 08:37:19 -0700676
Dirk Brandewie19e77c22013-10-21 09:20:35 -0700677 rdmsrl(BYT_RATIOS, value);
Dirk Brandewiec16ed062014-06-20 07:27:58 -0700678 return (value >> 16) & 0x7F;
Dirk Brandewie19e77c22013-10-21 09:20:35 -0700679}
680
Dirk Brandewie61d8d2a2014-02-12 10:01:07 -0800681static int byt_get_turbo_pstate(void)
682{
683 u64 value;
Stratos Karafotis845c1cb2014-07-18 08:37:19 -0700684
Dirk Brandewie61d8d2a2014-02-12 10:01:07 -0800685 rdmsrl(BYT_TURBO_RATIOS, value);
Dirk Brandewiec16ed062014-06-20 07:27:58 -0700686 return value & 0x7F;
Dirk Brandewie61d8d2a2014-02-12 10:01:07 -0800687}
688
Dirk Brandewie007bea02013-12-18 10:32:39 -0800689static void byt_set_pstate(struct cpudata *cpudata, int pstate)
690{
691 u64 val;
692 int32_t vid_fp;
693 u32 vid;
694
Chen Yu144c8e12015-07-29 23:53:10 +0800695 val = (u64)pstate << 8;
Dirk Brandewiedd5fbf72014-06-20 07:27:59 -0700696 if (limits.no_turbo && !limits.turbo_disabled)
Dirk Brandewie007bea02013-12-18 10:32:39 -0800697 val |= (u64)1 << 32;
698
699 vid_fp = cpudata->vid.min + mul_fp(
700 int_tofp(pstate - cpudata->pstate.min_pstate),
701 cpudata->vid.ratio);
702
703 vid_fp = clamp_t(int32_t, vid_fp, cpudata->vid.min, cpudata->vid.max);
Dirk Brandewied022a652014-10-13 08:37:44 -0700704 vid = ceiling_fp(vid_fp);
Dirk Brandewie007bea02013-12-18 10:32:39 -0800705
Dirk Brandewie21855ff2014-05-08 12:57:23 -0700706 if (pstate > cpudata->pstate.max_pstate)
707 vid = cpudata->vid.turbo;
708
Dirk Brandewie007bea02013-12-18 10:32:39 -0800709 val |= vid;
710
Joe Konno0dd23f92015-05-12 07:59:42 -0700711 wrmsrl_on_cpu(cpudata->cpu, MSR_IA32_PERF_CTL, val);
Dirk Brandewie007bea02013-12-18 10:32:39 -0800712}
713
Dirk Brandewieb27580b2014-10-13 08:37:43 -0700714#define BYT_BCLK_FREQS 5
715static int byt_freq_table[BYT_BCLK_FREQS] = { 833, 1000, 1333, 1167, 800};
716
717static int byt_get_scaling(void)
718{
719 u64 value;
720 int i;
721
722 rdmsrl(MSR_FSB_FREQ, value);
723 i = value & 0x3;
724
725 BUG_ON(i > BYT_BCLK_FREQS);
726
727 return byt_freq_table[i] * 100;
728}
729
Dirk Brandewie007bea02013-12-18 10:32:39 -0800730static void byt_get_vid(struct cpudata *cpudata)
731{
732 u64 value;
733
734 rdmsrl(BYT_VIDS, value);
Dirk Brandewiec16ed062014-06-20 07:27:58 -0700735 cpudata->vid.min = int_tofp((value >> 8) & 0x7f);
736 cpudata->vid.max = int_tofp((value >> 16) & 0x7f);
Dirk Brandewie007bea02013-12-18 10:32:39 -0800737 cpudata->vid.ratio = div_fp(
738 cpudata->vid.max - cpudata->vid.min,
739 int_tofp(cpudata->pstate.max_pstate -
740 cpudata->pstate.min_pstate));
Dirk Brandewie21855ff2014-05-08 12:57:23 -0700741
742 rdmsrl(BYT_TURBO_VIDS, value);
743 cpudata->vid.turbo = value & 0x7f;
Dirk Brandewie007bea02013-12-18 10:32:39 -0800744}
745
Dirk Brandewie016c8152013-10-21 09:20:34 -0700746static int core_get_min_pstate(void)
Dirk Brandewie93f08222013-02-06 09:02:13 -0800747{
748 u64 value;
Stratos Karafotis845c1cb2014-07-18 08:37:19 -0700749
Konrad Rzeszutek Wilk05e99c8cf2013-03-20 14:21:10 +0000750 rdmsrl(MSR_PLATFORM_INFO, value);
Dirk Brandewie93f08222013-02-06 09:02:13 -0800751 return (value >> 40) & 0xFF;
752}
753
Srinivas Pandruvada3bcc6fa2015-10-14 16:12:00 -0700754static int core_get_max_pstate_physical(void)
755{
756 u64 value;
757
758 rdmsrl(MSR_PLATFORM_INFO, value);
759 return (value >> 8) & 0xFF;
760}
761
Dirk Brandewie016c8152013-10-21 09:20:34 -0700762static int core_get_max_pstate(void)
Dirk Brandewie93f08222013-02-06 09:02:13 -0800763{
Srinivas Pandruvada6a35fc22015-10-14 16:11:59 -0700764 u64 tar;
765 u64 plat_info;
766 int max_pstate;
767 int err;
Stratos Karafotis845c1cb2014-07-18 08:37:19 -0700768
Srinivas Pandruvada6a35fc22015-10-14 16:11:59 -0700769 rdmsrl(MSR_PLATFORM_INFO, plat_info);
770 max_pstate = (plat_info >> 8) & 0xFF;
771
772 err = rdmsrl_safe(MSR_TURBO_ACTIVATION_RATIO, &tar);
773 if (!err) {
774 /* Do some sanity checking for safety */
775 if (plat_info & 0x600000000) {
776 u64 tdp_ctrl;
777 u64 tdp_ratio;
778 int tdp_msr;
779
780 err = rdmsrl_safe(MSR_CONFIG_TDP_CONTROL, &tdp_ctrl);
781 if (err)
782 goto skip_tar;
783
784 tdp_msr = MSR_CONFIG_TDP_NOMINAL + tdp_ctrl;
785 err = rdmsrl_safe(tdp_msr, &tdp_ratio);
786 if (err)
787 goto skip_tar;
788
789 if (tdp_ratio - 1 == tar) {
790 max_pstate = tar;
791 pr_debug("max_pstate=TAC %x\n", max_pstate);
792 } else {
793 goto skip_tar;
794 }
795 }
796 }
797
798skip_tar:
799 return max_pstate;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800800}
801
Dirk Brandewie016c8152013-10-21 09:20:34 -0700802static int core_get_turbo_pstate(void)
Dirk Brandewie93f08222013-02-06 09:02:13 -0800803{
804 u64 value;
805 int nont, ret;
Stratos Karafotis845c1cb2014-07-18 08:37:19 -0700806
Konrad Rzeszutek Wilk05e99c8cf2013-03-20 14:21:10 +0000807 rdmsrl(MSR_NHM_TURBO_RATIO_LIMIT, value);
Dirk Brandewie016c8152013-10-21 09:20:34 -0700808 nont = core_get_max_pstate();
Stratos Karafotis285cb992014-07-18 08:37:21 -0700809 ret = (value) & 255;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800810 if (ret <= nont)
811 ret = nont;
812 return ret;
813}
814
Dirk Brandewieb27580b2014-10-13 08:37:43 -0700815static inline int core_get_scaling(void)
816{
817 return 100000;
818}
819
Dirk Brandewie007bea02013-12-18 10:32:39 -0800820static void core_set_pstate(struct cpudata *cpudata, int pstate)
Dirk Brandewie016c8152013-10-21 09:20:34 -0700821{
822 u64 val;
823
Chen Yu144c8e12015-07-29 23:53:10 +0800824 val = (u64)pstate << 8;
Dirk Brandewiedd5fbf72014-06-20 07:27:59 -0700825 if (limits.no_turbo && !limits.turbo_disabled)
Dirk Brandewie016c8152013-10-21 09:20:34 -0700826 val |= (u64)1 << 32;
827
Dirk Brandewiebb180082014-03-19 08:45:54 -0700828 wrmsrl_on_cpu(cpudata->cpu, MSR_IA32_PERF_CTL, val);
Dirk Brandewie016c8152013-10-21 09:20:34 -0700829}
830
Dasaratharaman Chandramoulib34ef932015-04-10 10:22:18 -0700831static int knl_get_turbo_pstate(void)
832{
833 u64 value;
834 int nont, ret;
835
836 rdmsrl(MSR_NHM_TURBO_RATIO_LIMIT, value);
837 nont = core_get_max_pstate();
838 ret = (((value) >> 8) & 0xFF);
839 if (ret <= nont)
840 ret = nont;
841 return ret;
842}
843
Dirk Brandewie016c8152013-10-21 09:20:34 -0700844static struct cpu_defaults core_params = {
845 .pid_policy = {
846 .sample_rate_ms = 10,
847 .deadband = 0,
848 .setpoint = 97,
849 .p_gain_pct = 20,
850 .d_gain_pct = 0,
851 .i_gain_pct = 0,
852 },
853 .funcs = {
854 .get_max = core_get_max_pstate,
Srinivas Pandruvada3bcc6fa2015-10-14 16:12:00 -0700855 .get_max_physical = core_get_max_pstate_physical,
Dirk Brandewie016c8152013-10-21 09:20:34 -0700856 .get_min = core_get_min_pstate,
857 .get_turbo = core_get_turbo_pstate,
Dirk Brandewieb27580b2014-10-13 08:37:43 -0700858 .get_scaling = core_get_scaling,
Dirk Brandewie016c8152013-10-21 09:20:34 -0700859 .set = core_set_pstate,
860 },
861};
862
Dirk Brandewie19e77c22013-10-21 09:20:35 -0700863static struct cpu_defaults byt_params = {
864 .pid_policy = {
865 .sample_rate_ms = 10,
866 .deadband = 0,
Kristen Carlson Accardi6a82ba62015-04-10 11:06:43 -0700867 .setpoint = 60,
Dirk Brandewie19e77c22013-10-21 09:20:35 -0700868 .p_gain_pct = 14,
869 .d_gain_pct = 0,
870 .i_gain_pct = 4,
871 },
872 .funcs = {
873 .get_max = byt_get_max_pstate,
Srinivas Pandruvada3bcc6fa2015-10-14 16:12:00 -0700874 .get_max_physical = byt_get_max_pstate,
Dirk Brandewie19e77c22013-10-21 09:20:35 -0700875 .get_min = byt_get_min_pstate,
Dirk Brandewie61d8d2a2014-02-12 10:01:07 -0800876 .get_turbo = byt_get_turbo_pstate,
Dirk Brandewie007bea02013-12-18 10:32:39 -0800877 .set = byt_set_pstate,
Dirk Brandewieb27580b2014-10-13 08:37:43 -0700878 .get_scaling = byt_get_scaling,
Dirk Brandewie007bea02013-12-18 10:32:39 -0800879 .get_vid = byt_get_vid,
Dirk Brandewie19e77c22013-10-21 09:20:35 -0700880 },
881};
882
Dasaratharaman Chandramoulib34ef932015-04-10 10:22:18 -0700883static struct cpu_defaults knl_params = {
884 .pid_policy = {
885 .sample_rate_ms = 10,
886 .deadband = 0,
887 .setpoint = 97,
888 .p_gain_pct = 20,
889 .d_gain_pct = 0,
890 .i_gain_pct = 0,
891 },
892 .funcs = {
893 .get_max = core_get_max_pstate,
Srinivas Pandruvada3bcc6fa2015-10-14 16:12:00 -0700894 .get_max_physical = core_get_max_pstate_physical,
Dasaratharaman Chandramoulib34ef932015-04-10 10:22:18 -0700895 .get_min = core_get_min_pstate,
896 .get_turbo = knl_get_turbo_pstate,
Lukasz Anaczkowski69cefc22015-07-21 10:41:13 +0200897 .get_scaling = core_get_scaling,
Dasaratharaman Chandramoulib34ef932015-04-10 10:22:18 -0700898 .set = core_set_pstate,
899 },
900};
901
Dirk Brandewie93f08222013-02-06 09:02:13 -0800902static void intel_pstate_get_min_max(struct cpudata *cpu, int *min, int *max)
903{
904 int max_perf = cpu->pstate.turbo_pstate;
Dirk Brandewie7244cb62013-10-21 09:20:33 -0700905 int max_perf_adj;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800906 int min_perf;
Stratos Karafotis845c1cb2014-07-18 08:37:19 -0700907
Gabriele Mazzotta4521e1a02014-10-13 08:37:41 -0700908 if (limits.no_turbo || limits.turbo_disabled)
Dirk Brandewie93f08222013-02-06 09:02:13 -0800909 max_perf = cpu->pstate.max_pstate;
910
Kristen Carlson Accardie0d4c8f2014-12-10 12:39:38 -0800911 /*
912 * performance can be limited by user through sysfs, by cpufreq
913 * policy, or by cpu specific default values determined through
914 * experimentation.
915 */
Srinivas Pandruvada4ef45142015-10-14 16:12:03 -0700916 if (limits.max_perf_ctl && limits.max_sysfs_pct >=
917 limits.max_policy_pct) {
918 *max = limits.max_perf_ctl;
919 } else {
920 max_perf_adj = fp_toint(mul_fp(int_tofp(max_perf),
921 limits.max_perf));
922 *max = clamp_t(int, max_perf_adj, cpu->pstate.min_pstate,
923 cpu->pstate.turbo_pstate);
924 }
Dirk Brandewie93f08222013-02-06 09:02:13 -0800925
Srinivas Pandruvada4ef45142015-10-14 16:12:03 -0700926 if (limits.min_perf_ctl) {
927 *min = limits.min_perf_ctl;
928 } else {
929 min_perf = fp_toint(mul_fp(int_tofp(max_perf),
930 limits.min_perf));
931 *min = clamp_t(int, min_perf, cpu->pstate.min_pstate, max_perf);
932 }
Dirk Brandewie93f08222013-02-06 09:02:13 -0800933}
934
Doug Smythies6c1e4592015-06-01 21:12:34 -0700935static void intel_pstate_set_pstate(struct cpudata *cpu, int pstate, bool force)
Dirk Brandewie93f08222013-02-06 09:02:13 -0800936{
937 int max_perf, min_perf;
938
Doug Smythies6c1e4592015-06-01 21:12:34 -0700939 if (force) {
940 update_turbo_state();
Gabriele Mazzotta4521e1a02014-10-13 08:37:41 -0700941
Doug Smythies6c1e4592015-06-01 21:12:34 -0700942 intel_pstate_get_min_max(cpu, &min_perf, &max_perf);
Dirk Brandewie93f08222013-02-06 09:02:13 -0800943
Doug Smythies6c1e4592015-06-01 21:12:34 -0700944 pstate = clamp_t(int, pstate, min_perf, max_perf);
Dirk Brandewie93f08222013-02-06 09:02:13 -0800945
Doug Smythies6c1e4592015-06-01 21:12:34 -0700946 if (pstate == cpu->pstate.current_pstate)
947 return;
948 }
Dirk Brandewieb27580b2014-10-13 08:37:43 -0700949 trace_cpu_frequency(pstate * cpu->pstate.scaling, cpu->cpu);
Dirk Brandewie35363e92013-05-07 08:20:30 -0700950
Dirk Brandewie93f08222013-02-06 09:02:13 -0800951 cpu->pstate.current_pstate = pstate;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800952
Dirk Brandewie007bea02013-12-18 10:32:39 -0800953 pstate_funcs.set(cpu, pstate);
Dirk Brandewie93f08222013-02-06 09:02:13 -0800954}
955
Dirk Brandewie93f08222013-02-06 09:02:13 -0800956static void intel_pstate_get_cpu_pstates(struct cpudata *cpu)
957{
Dirk Brandewie016c8152013-10-21 09:20:34 -0700958 cpu->pstate.min_pstate = pstate_funcs.get_min();
959 cpu->pstate.max_pstate = pstate_funcs.get_max();
Srinivas Pandruvada3bcc6fa2015-10-14 16:12:00 -0700960 cpu->pstate.max_pstate_physical = pstate_funcs.get_max_physical();
Dirk Brandewie016c8152013-10-21 09:20:34 -0700961 cpu->pstate.turbo_pstate = pstate_funcs.get_turbo();
Dirk Brandewieb27580b2014-10-13 08:37:43 -0700962 cpu->pstate.scaling = pstate_funcs.get_scaling();
Dirk Brandewie93f08222013-02-06 09:02:13 -0800963
Dirk Brandewie007bea02013-12-18 10:32:39 -0800964 if (pstate_funcs.get_vid)
965 pstate_funcs.get_vid(cpu);
Doug Smythies6c1e4592015-06-01 21:12:34 -0700966 intel_pstate_set_pstate(cpu, cpu->pstate.min_pstate, false);
Dirk Brandewie93f08222013-02-06 09:02:13 -0800967}
968
Stratos Karafotis6b17ddb2014-04-29 20:53:49 +0300969static inline void intel_pstate_calc_busy(struct cpudata *cpu)
Dirk Brandewie93f08222013-02-06 09:02:13 -0800970{
Stratos Karafotis6b17ddb2014-04-29 20:53:49 +0300971 struct sample *sample = &cpu->sample;
Doug Smythiesbf810222014-05-30 10:10:57 -0700972 int64_t core_pct;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800973
Doug Smythiesbf810222014-05-30 10:10:57 -0700974 core_pct = int_tofp(sample->aperf) * int_tofp(100);
Stratos Karafotis78e27082014-07-18 08:37:27 -0700975 core_pct = div64_u64(core_pct, int_tofp(sample->mperf));
Dirk Brandewiefcb6a152014-02-03 08:55:31 -0800976
Dirk Brandewiefcb6a152014-02-03 08:55:31 -0800977 sample->freq = fp_toint(
Dirk Brandewieb27580b2014-10-13 08:37:43 -0700978 mul_fp(int_tofp(
Srinivas Pandruvada3bcc6fa2015-10-14 16:12:00 -0700979 cpu->pstate.max_pstate_physical *
980 cpu->pstate.scaling / 100),
Dirk Brandewieb27580b2014-10-13 08:37:43 -0700981 core_pct));
Dirk Brandewiefcb6a152014-02-03 08:55:31 -0800982
Doug Smythiesbf810222014-05-30 10:10:57 -0700983 sample->core_pct_busy = (int32_t)core_pct;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800984}
985
986static inline void intel_pstate_sample(struct cpudata *cpu)
987{
Dirk Brandewie93f08222013-02-06 09:02:13 -0800988 u64 aperf, mperf;
Stratos Karafotis4ab60c32014-07-18 08:37:24 -0700989 unsigned long flags;
Doug Smythies4055fad2015-04-11 21:10:26 -0700990 u64 tsc;
Dirk Brandewie93f08222013-02-06 09:02:13 -0800991
Stratos Karafotis4ab60c32014-07-18 08:37:24 -0700992 local_irq_save(flags);
Dirk Brandewie93f08222013-02-06 09:02:13 -0800993 rdmsrl(MSR_IA32_APERF, aperf);
994 rdmsrl(MSR_IA32_MPERF, mperf);
Andy Lutomirski4ea16362015-06-25 18:44:07 +0200995 tsc = rdtsc();
Stratos Karafotis4ab60c32014-07-18 08:37:24 -0700996 local_irq_restore(flags);
Dirk Brandewieb69880f2014-01-16 10:32:25 -0800997
Dirk Brandewiec4ee8412014-05-29 09:32:24 -0700998 cpu->last_sample_time = cpu->sample.time;
999 cpu->sample.time = ktime_get();
Dirk Brandewied37e2b72014-02-12 10:01:04 -08001000 cpu->sample.aperf = aperf;
1001 cpu->sample.mperf = mperf;
Doug Smythies4055fad2015-04-11 21:10:26 -07001002 cpu->sample.tsc = tsc;
Dirk Brandewied37e2b72014-02-12 10:01:04 -08001003 cpu->sample.aperf -= cpu->prev_aperf;
1004 cpu->sample.mperf -= cpu->prev_mperf;
Doug Smythies4055fad2015-04-11 21:10:26 -07001005 cpu->sample.tsc -= cpu->prev_tsc;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001006
Stratos Karafotis6b17ddb2014-04-29 20:53:49 +03001007 intel_pstate_calc_busy(cpu);
Dirk Brandewie93f08222013-02-06 09:02:13 -08001008
Dirk Brandewie93f08222013-02-06 09:02:13 -08001009 cpu->prev_aperf = aperf;
1010 cpu->prev_mperf = mperf;
Doug Smythies4055fad2015-04-11 21:10:26 -07001011 cpu->prev_tsc = tsc;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001012}
1013
Dirk Brandewie2f86dc42014-11-06 09:40:47 -08001014static inline void intel_hwp_set_sample_time(struct cpudata *cpu)
1015{
1016 int delay;
1017
1018 delay = msecs_to_jiffies(50);
1019 mod_timer_pinned(&cpu->timer, jiffies + delay);
1020}
1021
Dirk Brandewie93f08222013-02-06 09:02:13 -08001022static inline void intel_pstate_set_sample_time(struct cpudata *cpu)
1023{
Stratos Karafotisabf013b2014-07-18 08:37:22 -07001024 int delay;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001025
Stratos Karafotisabf013b2014-07-18 08:37:22 -07001026 delay = msecs_to_jiffies(pid_params.sample_rate_ms);
Dirk Brandewie93f08222013-02-06 09:02:13 -08001027 mod_timer_pinned(&cpu->timer, jiffies + delay);
1028}
1029
Brennan Shacklettd253d2a2013-10-21 09:20:32 -07001030static inline int32_t intel_pstate_get_scaled_busy(struct cpudata *cpu)
Dirk Brandewie93f08222013-02-06 09:02:13 -08001031{
Dirk Brandewiec4ee8412014-05-29 09:32:24 -07001032 int32_t core_busy, max_pstate, current_pstate, sample_ratio;
Prarit Bhargava7180ddd2015-06-15 13:43:29 -04001033 s64 duration_us;
Dirk Brandewiec4ee8412014-05-29 09:32:24 -07001034 u32 sample_time;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001035
Kristen Carlson Accardie0d4c8f2014-12-10 12:39:38 -08001036 /*
1037 * core_busy is the ratio of actual performance to max
1038 * max_pstate is the max non turbo pstate available
1039 * current_pstate was the pstate that was requested during
1040 * the last sample period.
1041 *
1042 * We normalize core_busy, which was our actual percent
1043 * performance to what we requested during the last sample
1044 * period. The result will be a percentage of busy at a
1045 * specified pstate.
1046 */
Dirk Brandewied37e2b72014-02-12 10:01:04 -08001047 core_busy = cpu->sample.core_pct_busy;
Srinivas Pandruvada3bcc6fa2015-10-14 16:12:00 -07001048 max_pstate = int_tofp(cpu->pstate.max_pstate_physical);
Dirk Brandewie93f08222013-02-06 09:02:13 -08001049 current_pstate = int_tofp(cpu->pstate.current_pstate);
Dirk Brandewiee66c1762014-02-25 10:35:37 -08001050 core_busy = mul_fp(core_busy, div_fp(max_pstate, current_pstate));
Dirk Brandewiec4ee8412014-05-29 09:32:24 -07001051
Kristen Carlson Accardie0d4c8f2014-12-10 12:39:38 -08001052 /*
1053 * Since we have a deferred timer, it will not fire unless
1054 * we are in C0. So, determine if the actual elapsed time
1055 * is significantly greater (3x) than our sample interval. If it
1056 * is, then we were idle for a long enough period of time
1057 * to adjust our busyness.
1058 */
Stratos Karafotis285cb992014-07-18 08:37:21 -07001059 sample_time = pid_params.sample_rate_ms * USEC_PER_MSEC;
Prarit Bhargava7180ddd2015-06-15 13:43:29 -04001060 duration_us = ktime_us_delta(cpu->sample.time,
1061 cpu->last_sample_time);
Dirk Brandewiec4ee8412014-05-29 09:32:24 -07001062 if (duration_us > sample_time * 3) {
1063 sample_ratio = div_fp(int_tofp(sample_time),
Stratos Karafotisc4108332014-07-18 08:37:23 -07001064 int_tofp(duration_us));
Dirk Brandewiec4ee8412014-05-29 09:32:24 -07001065 core_busy = mul_fp(core_busy, sample_ratio);
1066 }
1067
Dirk Brandewief0fe3cd2014-05-29 09:32:23 -07001068 return core_busy;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001069}
1070
1071static inline void intel_pstate_adjust_busy_pstate(struct cpudata *cpu)
1072{
Brennan Shacklettd253d2a2013-10-21 09:20:32 -07001073 int32_t busy_scaled;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001074 struct _pid *pid;
Stratos Karafotis4b707c82014-07-18 08:37:26 -07001075 signed int ctl;
Doug Smythies4055fad2015-04-11 21:10:26 -07001076 int from;
1077 struct sample *sample;
1078
1079 from = cpu->pstate.current_pstate;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001080
1081 pid = &cpu->pid;
1082 busy_scaled = intel_pstate_get_scaled_busy(cpu);
1083
1084 ctl = pid_calc(pid, busy_scaled);
1085
Stratos Karafotis4b707c82014-07-18 08:37:26 -07001086 /* Negative values of ctl increase the pstate and vice versa */
Doug Smythies6c1e4592015-06-01 21:12:34 -07001087 intel_pstate_set_pstate(cpu, cpu->pstate.current_pstate - ctl, true);
Doug Smythies4055fad2015-04-11 21:10:26 -07001088
1089 sample = &cpu->sample;
1090 trace_pstate_sample(fp_toint(sample->core_pct_busy),
1091 fp_toint(busy_scaled),
1092 from,
1093 cpu->pstate.current_pstate,
1094 sample->mperf,
1095 sample->aperf,
1096 sample->tsc,
1097 sample->freq);
Dirk Brandewie93f08222013-02-06 09:02:13 -08001098}
1099
Dirk Brandewie2f86dc42014-11-06 09:40:47 -08001100static void intel_hwp_timer_func(unsigned long __data)
1101{
1102 struct cpudata *cpu = (struct cpudata *) __data;
1103
1104 intel_pstate_sample(cpu);
1105 intel_hwp_set_sample_time(cpu);
1106}
1107
Dirk Brandewie93f08222013-02-06 09:02:13 -08001108static void intel_pstate_timer_func(unsigned long __data)
1109{
1110 struct cpudata *cpu = (struct cpudata *) __data;
1111
1112 intel_pstate_sample(cpu);
Dirk Brandewieb69880f2014-01-16 10:32:25 -08001113
Dirk Brandewieca182ae2013-05-07 08:20:27 -07001114 intel_pstate_adjust_busy_pstate(cpu);
Dirk Brandewieb69880f2014-01-16 10:32:25 -08001115
Dirk Brandewie93f08222013-02-06 09:02:13 -08001116 intel_pstate_set_sample_time(cpu);
1117}
1118
1119#define ICPU(model, policy) \
Dirk Brandewie6cbd7ee2014-01-06 10:59:16 -08001120 { X86_VENDOR_INTEL, 6, model, X86_FEATURE_APERFMPERF,\
1121 (unsigned long)&policy }
Dirk Brandewie93f08222013-02-06 09:02:13 -08001122
1123static const struct x86_cpu_id intel_pstate_cpu_ids[] = {
Dirk Brandewie016c8152013-10-21 09:20:34 -07001124 ICPU(0x2a, core_params),
1125 ICPU(0x2d, core_params),
Dirk Brandewie19e77c22013-10-21 09:20:35 -07001126 ICPU(0x37, byt_params),
Dirk Brandewie016c8152013-10-21 09:20:34 -07001127 ICPU(0x3a, core_params),
1128 ICPU(0x3c, core_params),
Dirk Brandewiec7e241d2014-05-08 12:57:27 -07001129 ICPU(0x3d, core_params),
Dirk Brandewie016c8152013-10-21 09:20:34 -07001130 ICPU(0x3e, core_params),
1131 ICPU(0x3f, core_params),
1132 ICPU(0x45, core_params),
1133 ICPU(0x46, core_params),
Dirk Brandewie43f8a962014-11-06 09:50:45 -08001134 ICPU(0x47, core_params),
Mika Westerberg16405f92014-08-22 13:05:44 +03001135 ICPU(0x4c, byt_params),
Kristen Carlson Accardi7ab02562015-01-28 13:53:28 -08001136 ICPU(0x4e, core_params),
Dirk Brandewiec7e241d2014-05-08 12:57:27 -07001137 ICPU(0x4f, core_params),
Kristen Carlson Accardi1c939122015-08-05 12:47:14 -07001138 ICPU(0x5e, core_params),
Dirk Brandewiec7e241d2014-05-08 12:57:27 -07001139 ICPU(0x56, core_params),
Dasaratharaman Chandramoulib34ef932015-04-10 10:22:18 -07001140 ICPU(0x57, knl_params),
Dirk Brandewie93f08222013-02-06 09:02:13 -08001141 {}
1142};
1143MODULE_DEVICE_TABLE(x86cpu, intel_pstate_cpu_ids);
1144
Dirk Brandewie2f86dc42014-11-06 09:40:47 -08001145static const struct x86_cpu_id intel_pstate_cpu_oob_ids[] = {
1146 ICPU(0x56, core_params),
1147 {}
1148};
1149
Dirk Brandewie93f08222013-02-06 09:02:13 -08001150static int intel_pstate_init_cpu(unsigned int cpunum)
1151{
Dirk Brandewie93f08222013-02-06 09:02:13 -08001152 struct cpudata *cpu;
1153
Dirk Brandewiec0348712014-10-13 08:37:42 -07001154 if (!all_cpu_data[cpunum])
1155 all_cpu_data[cpunum] = kzalloc(sizeof(struct cpudata),
1156 GFP_KERNEL);
Dirk Brandewie93f08222013-02-06 09:02:13 -08001157 if (!all_cpu_data[cpunum])
1158 return -ENOMEM;
1159
1160 cpu = all_cpu_data[cpunum];
1161
Dirk Brandewie93f08222013-02-06 09:02:13 -08001162 cpu->cpu = cpunum;
Kristen Carlson Accardiba88d432015-07-14 09:46:23 -07001163
1164 if (hwp_active)
1165 intel_pstate_hwp_enable(cpu);
1166
Vincent Minet179e8472014-07-05 01:51:33 +02001167 intel_pstate_get_cpu_pstates(cpu);
Dirk Brandewie016c8152013-10-21 09:20:34 -07001168
Dirk Brandewie93f08222013-02-06 09:02:13 -08001169 init_timer_deferrable(&cpu->timer);
Stratos Karafotis2d8d1f12014-07-18 08:37:20 -07001170 cpu->timer.data = (unsigned long)cpu;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001171 cpu->timer.expires = jiffies + HZ/100;
Dirk Brandewie2f86dc42014-11-06 09:40:47 -08001172
1173 if (!hwp_active)
1174 cpu->timer.function = intel_pstate_timer_func;
1175 else
1176 cpu->timer.function = intel_hwp_timer_func;
1177
Dirk Brandewie93f08222013-02-06 09:02:13 -08001178 intel_pstate_busy_pid_reset(cpu);
Dirk Brandewie93f08222013-02-06 09:02:13 -08001179 intel_pstate_sample(cpu);
Dirk Brandewie93f08222013-02-06 09:02:13 -08001180
1181 add_timer_on(&cpu->timer, cpunum);
1182
Doug Smythiesf16255e2015-05-31 07:46:47 -07001183 pr_debug("intel_pstate: controlling: cpu %d\n", cpunum);
Dirk Brandewie93f08222013-02-06 09:02:13 -08001184
1185 return 0;
1186}
1187
1188static unsigned int intel_pstate_get(unsigned int cpu_num)
1189{
1190 struct sample *sample;
1191 struct cpudata *cpu;
1192
1193 cpu = all_cpu_data[cpu_num];
1194 if (!cpu)
1195 return 0;
Dirk Brandewied37e2b72014-02-12 10:01:04 -08001196 sample = &cpu->sample;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001197 return sample->freq;
1198}
1199
1200static int intel_pstate_set_policy(struct cpufreq_policy *policy)
1201{
Srinivas Pandruvada4ef45142015-10-14 16:12:03 -07001202#if IS_ENABLED(CONFIG_ACPI)
1203 struct cpudata *cpu;
1204 int i;
1205#endif
1206 pr_debug("intel_pstate: %s max %u policy->max %u\n", __func__,
1207 policy->cpuinfo.max_freq, policy->max);
Dirk Brandewied3929b82013-03-05 14:15:26 -08001208 if (!policy->cpuinfo.max_freq)
1209 return -ENODEV;
1210
Srinivas Pandruvada630ec282015-01-29 12:17:13 -08001211 if (policy->policy == CPUFREQ_POLICY_PERFORMANCE &&
1212 policy->max >= policy->cpuinfo.max_freq) {
Kristen Carlson Accardia0475992015-01-29 13:03:52 -08001213 limits.min_policy_pct = 100;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001214 limits.min_perf_pct = 100;
1215 limits.min_perf = int_tofp(1);
Pali Rohár36b4bed2014-10-16 01:16:51 +02001216 limits.max_policy_pct = 100;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001217 limits.max_perf_pct = 100;
1218 limits.max_perf = int_tofp(1);
Gabriele Mazzotta4521e1a02014-10-13 08:37:41 -07001219 limits.no_turbo = 0;
Srinivas Pandruvada4ef45142015-10-14 16:12:03 -07001220 limits.max_perf_ctl = 0;
1221 limits.min_perf_ctl = 0;
Srinivas Pandruvadad1b68482013-04-09 22:38:18 +00001222 return 0;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001223 }
Dirk Brandewie2f86dc42014-11-06 09:40:47 -08001224
Kristen Carlson Accardia0475992015-01-29 13:03:52 -08001225 limits.min_policy_pct = (policy->min * 100) / policy->cpuinfo.max_freq;
1226 limits.min_policy_pct = clamp_t(int, limits.min_policy_pct, 0 , 100);
Stratos Karafotis285cb992014-07-18 08:37:21 -07001227 limits.max_policy_pct = (policy->max * 100) / policy->cpuinfo.max_freq;
Dirk Brandewied8f469e2013-05-07 08:20:26 -07001228 limits.max_policy_pct = clamp_t(int, limits.max_policy_pct, 0 , 100);
Chen Yu43717aa2015-09-09 18:27:31 +08001229
1230 /* Normalize user input to [min_policy_pct, max_policy_pct] */
1231 limits.min_perf_pct = max(limits.min_policy_pct, limits.min_sysfs_pct);
1232 limits.min_perf_pct = min(limits.max_policy_pct, limits.min_perf_pct);
Dirk Brandewied8f469e2013-05-07 08:20:26 -07001233 limits.max_perf_pct = min(limits.max_policy_pct, limits.max_sysfs_pct);
Chen Yu43717aa2015-09-09 18:27:31 +08001234 limits.max_perf_pct = max(limits.min_policy_pct, limits.max_perf_pct);
1235
1236 /* Make sure min_perf_pct <= max_perf_pct */
1237 limits.min_perf_pct = min(limits.max_perf_pct, limits.min_perf_pct);
1238
1239 limits.min_perf = div_fp(int_tofp(limits.min_perf_pct), int_tofp(100));
Srinivas Pandruvadad1b68482013-04-09 22:38:18 +00001240 limits.max_perf = div_fp(int_tofp(limits.max_perf_pct), int_tofp(100));
Dirk Brandewie93f08222013-02-06 09:02:13 -08001241
Srinivas Pandruvada4ef45142015-10-14 16:12:03 -07001242#if IS_ENABLED(CONFIG_ACPI)
1243 cpu = all_cpu_data[policy->cpu];
1244 for (i = 0; i < cpu->acpi_perf_data.state_count; i++) {
1245 int control;
1246
1247 control = convert_to_native_pstate_format(cpu, i);
1248 if (control * cpu->pstate.scaling == policy->max)
1249 limits.max_perf_ctl = control;
1250 if (control * cpu->pstate.scaling == policy->min)
1251 limits.min_perf_ctl = control;
1252 }
1253
1254 pr_debug("intel_pstate: max %u policy_max %u perf_ctl [0x%x-0x%x]\n",
1255 policy->cpuinfo.max_freq, policy->max, limits.min_perf_ctl,
1256 limits.max_perf_ctl);
1257#endif
1258
Dirk Brandewie2f86dc42014-11-06 09:40:47 -08001259 if (hwp_active)
1260 intel_pstate_hwp_set();
1261
Dirk Brandewie93f08222013-02-06 09:02:13 -08001262 return 0;
1263}
1264
1265static int intel_pstate_verify_policy(struct cpufreq_policy *policy)
1266{
Viresh Kumarbe49e342013-10-02 14:13:19 +05301267 cpufreq_verify_within_cpu_limits(policy);
Dirk Brandewie93f08222013-02-06 09:02:13 -08001268
Stratos Karafotis285cb992014-07-18 08:37:21 -07001269 if (policy->policy != CPUFREQ_POLICY_POWERSAVE &&
Stratos Karafotisc4108332014-07-18 08:37:23 -07001270 policy->policy != CPUFREQ_POLICY_PERFORMANCE)
Dirk Brandewie93f08222013-02-06 09:02:13 -08001271 return -EINVAL;
1272
1273 return 0;
1274}
1275
Dirk Brandewiebb180082014-03-19 08:45:54 -07001276static void intel_pstate_stop_cpu(struct cpufreq_policy *policy)
Dirk Brandewie93f08222013-02-06 09:02:13 -08001277{
Dirk Brandewiebb180082014-03-19 08:45:54 -07001278 int cpu_num = policy->cpu;
1279 struct cpudata *cpu = all_cpu_data[cpu_num];
Dirk Brandewie93f08222013-02-06 09:02:13 -08001280
Doug Smythiesf16255e2015-05-31 07:46:47 -07001281 pr_debug("intel_pstate: CPU %d exiting\n", cpu_num);
Dirk Brandewiebb180082014-03-19 08:45:54 -07001282
Dirk Brandewiec2294a22014-03-24 07:41:29 -07001283 del_timer_sync(&all_cpu_data[cpu_num]->timer);
Dirk Brandewie2f86dc42014-11-06 09:40:47 -08001284 if (hwp_active)
1285 return;
1286
Doug Smythies6c1e4592015-06-01 21:12:34 -07001287 intel_pstate_set_pstate(cpu, cpu->pstate.min_pstate, false);
Dirk Brandewie93f08222013-02-06 09:02:13 -08001288}
1289
Paul Gortmaker27609842013-06-19 13:54:04 -04001290static int intel_pstate_cpu_init(struct cpufreq_policy *policy)
Dirk Brandewie93f08222013-02-06 09:02:13 -08001291{
Dirk Brandewie93f08222013-02-06 09:02:13 -08001292 struct cpudata *cpu;
Dirk Brandewie52e0a502013-10-15 11:06:14 -07001293 int rc;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001294
1295 rc = intel_pstate_init_cpu(policy->cpu);
1296 if (rc)
1297 return rc;
1298
1299 cpu = all_cpu_data[policy->cpu];
1300
Dirk Brandewiedd5fbf72014-06-20 07:27:59 -07001301 if (limits.min_perf_pct == 100 && limits.max_perf_pct == 100)
Dirk Brandewie93f08222013-02-06 09:02:13 -08001302 policy->policy = CPUFREQ_POLICY_PERFORMANCE;
1303 else
1304 policy->policy = CPUFREQ_POLICY_POWERSAVE;
1305
Dirk Brandewieb27580b2014-10-13 08:37:43 -07001306 policy->min = cpu->pstate.min_pstate * cpu->pstate.scaling;
1307 policy->max = cpu->pstate.turbo_pstate * cpu->pstate.scaling;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001308
1309 /* cpuinfo and default policy values */
Dirk Brandewieb27580b2014-10-13 08:37:43 -07001310 policy->cpuinfo.min_freq = cpu->pstate.min_pstate * cpu->pstate.scaling;
1311 policy->cpuinfo.max_freq =
1312 cpu->pstate.turbo_pstate * cpu->pstate.scaling;
Srinivas Pandruvada37afb002015-10-14 16:12:01 -07001313 if (!no_acpi_perf)
1314 intel_pstate_init_perf_limits(policy);
1315 /*
1316 * If there is no acpi perf data or error, we ignore and use Intel P
1317 * state calculated limits, So this is not fatal error.
1318 */
Dirk Brandewie93f08222013-02-06 09:02:13 -08001319 policy->cpuinfo.transition_latency = CPUFREQ_ETERNAL;
1320 cpumask_set_cpu(policy->cpu, policy->cpus);
1321
1322 return 0;
1323}
1324
Srinivas Pandruvada37afb002015-10-14 16:12:01 -07001325static int intel_pstate_cpu_exit(struct cpufreq_policy *policy)
1326{
1327 return intel_pstate_exit_perf_limits(policy);
1328}
1329
Dirk Brandewie93f08222013-02-06 09:02:13 -08001330static struct cpufreq_driver intel_pstate_driver = {
1331 .flags = CPUFREQ_CONST_LOOPS,
1332 .verify = intel_pstate_verify_policy,
1333 .setpolicy = intel_pstate_set_policy,
1334 .get = intel_pstate_get,
1335 .init = intel_pstate_cpu_init,
Srinivas Pandruvada37afb002015-10-14 16:12:01 -07001336 .exit = intel_pstate_cpu_exit,
Dirk Brandewiebb180082014-03-19 08:45:54 -07001337 .stop_cpu = intel_pstate_stop_cpu,
Dirk Brandewie93f08222013-02-06 09:02:13 -08001338 .name = "intel_pstate",
Dirk Brandewie93f08222013-02-06 09:02:13 -08001339};
1340
Dirk Brandewie6be26492013-02-15 22:55:10 +01001341static int __initdata no_load;
Dirk Brandewie2f86dc42014-11-06 09:40:47 -08001342static int __initdata no_hwp;
Kristen Carlson Accardid64c3b02015-02-06 13:41:55 -08001343static int __initdata hwp_only;
Ethan Zhaoaa4ea342014-12-09 10:43:19 +09001344static unsigned int force_load;
Dirk Brandewie6be26492013-02-15 22:55:10 +01001345
Dirk Brandewieb563b4e2013-03-22 01:29:28 +01001346static int intel_pstate_msrs_not_valid(void)
1347{
Dirk Brandewie016c8152013-10-21 09:20:34 -07001348 if (!pstate_funcs.get_max() ||
Stratos Karafotisc4108332014-07-18 08:37:23 -07001349 !pstate_funcs.get_min() ||
1350 !pstate_funcs.get_turbo())
Dirk Brandewieb563b4e2013-03-22 01:29:28 +01001351 return -ENODEV;
1352
Dirk Brandewieb563b4e2013-03-22 01:29:28 +01001353 return 0;
1354}
Dirk Brandewie016c8152013-10-21 09:20:34 -07001355
Dirk Brandewiee0a261a2013-10-30 08:38:32 -07001356static void copy_pid_params(struct pstate_adjust_policy *policy)
Dirk Brandewie016c8152013-10-21 09:20:34 -07001357{
1358 pid_params.sample_rate_ms = policy->sample_rate_ms;
1359 pid_params.p_gain_pct = policy->p_gain_pct;
1360 pid_params.i_gain_pct = policy->i_gain_pct;
1361 pid_params.d_gain_pct = policy->d_gain_pct;
1362 pid_params.deadband = policy->deadband;
1363 pid_params.setpoint = policy->setpoint;
1364}
1365
Dirk Brandewiee0a261a2013-10-30 08:38:32 -07001366static void copy_cpu_funcs(struct pstate_funcs *funcs)
Dirk Brandewie016c8152013-10-21 09:20:34 -07001367{
1368 pstate_funcs.get_max = funcs->get_max;
Srinivas Pandruvada3bcc6fa2015-10-14 16:12:00 -07001369 pstate_funcs.get_max_physical = funcs->get_max_physical;
Dirk Brandewie016c8152013-10-21 09:20:34 -07001370 pstate_funcs.get_min = funcs->get_min;
1371 pstate_funcs.get_turbo = funcs->get_turbo;
Dirk Brandewieb27580b2014-10-13 08:37:43 -07001372 pstate_funcs.get_scaling = funcs->get_scaling;
Dirk Brandewie016c8152013-10-21 09:20:34 -07001373 pstate_funcs.set = funcs->set;
Dirk Brandewie007bea02013-12-18 10:32:39 -08001374 pstate_funcs.get_vid = funcs->get_vid;
Dirk Brandewie016c8152013-10-21 09:20:34 -07001375}
1376
Adrian Huangfbbcdc02013-10-31 23:24:05 +08001377#if IS_ENABLED(CONFIG_ACPI)
Adrian Huangfbbcdc02013-10-31 23:24:05 +08001378
1379static bool intel_pstate_no_acpi_pss(void)
1380{
1381 int i;
1382
1383 for_each_possible_cpu(i) {
1384 acpi_status status;
1385 union acpi_object *pss;
1386 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
1387 struct acpi_processor *pr = per_cpu(processors, i);
1388
1389 if (!pr)
1390 continue;
1391
1392 status = acpi_evaluate_object(pr->handle, "_PSS", NULL, &buffer);
1393 if (ACPI_FAILURE(status))
1394 continue;
1395
1396 pss = buffer.pointer;
1397 if (pss && pss->type == ACPI_TYPE_PACKAGE) {
1398 kfree(pss);
1399 return false;
1400 }
1401
1402 kfree(pss);
1403 }
1404
1405 return true;
1406}
1407
ethan zhao966916e2014-12-01 11:32:08 +09001408static bool intel_pstate_has_acpi_ppc(void)
1409{
1410 int i;
1411
1412 for_each_possible_cpu(i) {
1413 struct acpi_processor *pr = per_cpu(processors, i);
1414
1415 if (!pr)
1416 continue;
1417 if (acpi_has_method(pr->handle, "_PPC"))
1418 return true;
1419 }
1420 return false;
1421}
1422
1423enum {
1424 PSS,
1425 PPC,
1426};
1427
Adrian Huangfbbcdc02013-10-31 23:24:05 +08001428struct hw_vendor_info {
1429 u16 valid;
1430 char oem_id[ACPI_OEM_ID_SIZE];
1431 char oem_table_id[ACPI_OEM_TABLE_ID_SIZE];
ethan zhao966916e2014-12-01 11:32:08 +09001432 int oem_pwr_table;
Adrian Huangfbbcdc02013-10-31 23:24:05 +08001433};
1434
1435/* Hardware vendor-specific info that has its own power management modes */
1436static struct hw_vendor_info vendor_info[] = {
ethan zhao966916e2014-12-01 11:32:08 +09001437 {1, "HP ", "ProLiant", PSS},
1438 {1, "ORACLE", "X4-2 ", PPC},
1439 {1, "ORACLE", "X4-2L ", PPC},
1440 {1, "ORACLE", "X4-2B ", PPC},
1441 {1, "ORACLE", "X3-2 ", PPC},
1442 {1, "ORACLE", "X3-2L ", PPC},
1443 {1, "ORACLE", "X3-2B ", PPC},
1444 {1, "ORACLE", "X4470M2 ", PPC},
1445 {1, "ORACLE", "X4270M3 ", PPC},
1446 {1, "ORACLE", "X4270M2 ", PPC},
1447 {1, "ORACLE", "X4170M2 ", PPC},
Ethan Zhao5aecc3c2015-08-05 09:28:50 +09001448 {1, "ORACLE", "X4170 M3", PPC},
1449 {1, "ORACLE", "X4275 M3", PPC},
1450 {1, "ORACLE", "X6-2 ", PPC},
1451 {1, "ORACLE", "Sudbury ", PPC},
Adrian Huangfbbcdc02013-10-31 23:24:05 +08001452 {0, "", ""},
1453};
1454
1455static bool intel_pstate_platform_pwr_mgmt_exists(void)
1456{
1457 struct acpi_table_header hdr;
1458 struct hw_vendor_info *v_info;
Dirk Brandewie2f86dc42014-11-06 09:40:47 -08001459 const struct x86_cpu_id *id;
1460 u64 misc_pwr;
1461
1462 id = x86_match_cpu(intel_pstate_cpu_oob_ids);
1463 if (id) {
1464 rdmsrl(MSR_MISC_PWR_MGMT, misc_pwr);
1465 if ( misc_pwr & (1 << 8))
1466 return true;
1467 }
Adrian Huangfbbcdc02013-10-31 23:24:05 +08001468
Stratos Karafotisc4108332014-07-18 08:37:23 -07001469 if (acpi_disabled ||
1470 ACPI_FAILURE(acpi_get_table_header(ACPI_SIG_FADT, 0, &hdr)))
Adrian Huangfbbcdc02013-10-31 23:24:05 +08001471 return false;
1472
1473 for (v_info = vendor_info; v_info->valid; v_info++) {
Stratos Karafotisc4108332014-07-18 08:37:23 -07001474 if (!strncmp(hdr.oem_id, v_info->oem_id, ACPI_OEM_ID_SIZE) &&
ethan zhao966916e2014-12-01 11:32:08 +09001475 !strncmp(hdr.oem_table_id, v_info->oem_table_id,
1476 ACPI_OEM_TABLE_ID_SIZE))
1477 switch (v_info->oem_pwr_table) {
1478 case PSS:
1479 return intel_pstate_no_acpi_pss();
1480 case PPC:
Ethan Zhaoaa4ea342014-12-09 10:43:19 +09001481 return intel_pstate_has_acpi_ppc() &&
1482 (!force_load);
ethan zhao966916e2014-12-01 11:32:08 +09001483 }
Adrian Huangfbbcdc02013-10-31 23:24:05 +08001484 }
1485
1486 return false;
1487}
1488#else /* CONFIG_ACPI not enabled */
1489static inline bool intel_pstate_platform_pwr_mgmt_exists(void) { return false; }
ethan zhao966916e2014-12-01 11:32:08 +09001490static inline bool intel_pstate_has_acpi_ppc(void) { return false; }
Adrian Huangfbbcdc02013-10-31 23:24:05 +08001491#endif /* CONFIG_ACPI */
1492
Dirk Brandewie93f08222013-02-06 09:02:13 -08001493static int __init intel_pstate_init(void)
1494{
Dirk Brandewie907cc902013-03-05 14:15:27 -08001495 int cpu, rc = 0;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001496 const struct x86_cpu_id *id;
Borislav Petkov64df1fd2015-04-03 15:19:53 +02001497 struct cpu_defaults *cpu_def;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001498
Dirk Brandewie6be26492013-02-15 22:55:10 +01001499 if (no_load)
1500 return -ENODEV;
1501
Dirk Brandewie93f08222013-02-06 09:02:13 -08001502 id = x86_match_cpu(intel_pstate_cpu_ids);
1503 if (!id)
1504 return -ENODEV;
1505
Adrian Huangfbbcdc02013-10-31 23:24:05 +08001506 /*
1507 * The Intel pstate driver will be ignored if the platform
1508 * firmware has its own power management modes.
1509 */
1510 if (intel_pstate_platform_pwr_mgmt_exists())
1511 return -ENODEV;
1512
Borislav Petkov64df1fd2015-04-03 15:19:53 +02001513 cpu_def = (struct cpu_defaults *)id->driver_data;
Dirk Brandewie016c8152013-10-21 09:20:34 -07001514
Borislav Petkov64df1fd2015-04-03 15:19:53 +02001515 copy_pid_params(&cpu_def->pid_policy);
1516 copy_cpu_funcs(&cpu_def->funcs);
Dirk Brandewie016c8152013-10-21 09:20:34 -07001517
Dirk Brandewieb563b4e2013-03-22 01:29:28 +01001518 if (intel_pstate_msrs_not_valid())
1519 return -ENODEV;
1520
Dirk Brandewie93f08222013-02-06 09:02:13 -08001521 pr_info("Intel P-state driver initializing.\n");
1522
Wei Yongjunb57ffac2013-05-13 08:03:43 +00001523 all_cpu_data = vzalloc(sizeof(void *) * num_possible_cpus());
Dirk Brandewie93f08222013-02-06 09:02:13 -08001524 if (!all_cpu_data)
1525 return -ENOMEM;
Dirk Brandewie93f08222013-02-06 09:02:13 -08001526
Borislav Petkov64df1fd2015-04-03 15:19:53 +02001527 if (static_cpu_has_safe(X86_FEATURE_HWP) && !no_hwp)
Kristen Carlson Accardiba88d432015-07-14 09:46:23 -07001528 hwp_active++;
Dirk Brandewie2f86dc42014-11-06 09:40:47 -08001529
Kristen Carlson Accardid64c3b02015-02-06 13:41:55 -08001530 if (!hwp_active && hwp_only)
1531 goto out;
1532
Dirk Brandewie93f08222013-02-06 09:02:13 -08001533 rc = cpufreq_register_driver(&intel_pstate_driver);
1534 if (rc)
1535 goto out;
1536
1537 intel_pstate_debug_expose_params();
1538 intel_pstate_sysfs_expose_params();
Dirk Brandewieb69880f2014-01-16 10:32:25 -08001539
Dirk Brandewie93f08222013-02-06 09:02:13 -08001540 return rc;
1541out:
Dirk Brandewie907cc902013-03-05 14:15:27 -08001542 get_online_cpus();
1543 for_each_online_cpu(cpu) {
1544 if (all_cpu_data[cpu]) {
1545 del_timer_sync(&all_cpu_data[cpu]->timer);
1546 kfree(all_cpu_data[cpu]);
1547 }
1548 }
1549
1550 put_online_cpus();
1551 vfree(all_cpu_data);
Dirk Brandewie93f08222013-02-06 09:02:13 -08001552 return -ENODEV;
1553}
1554device_initcall(intel_pstate_init);
1555
Dirk Brandewie6be26492013-02-15 22:55:10 +01001556static int __init intel_pstate_setup(char *str)
1557{
1558 if (!str)
1559 return -EINVAL;
1560
1561 if (!strcmp(str, "disable"))
1562 no_load = 1;
Dirk Brandewie2f86dc42014-11-06 09:40:47 -08001563 if (!strcmp(str, "no_hwp"))
1564 no_hwp = 1;
Ethan Zhaoaa4ea342014-12-09 10:43:19 +09001565 if (!strcmp(str, "force"))
1566 force_load = 1;
Kristen Carlson Accardid64c3b02015-02-06 13:41:55 -08001567 if (!strcmp(str, "hwp_only"))
1568 hwp_only = 1;
Srinivas Pandruvada37afb002015-10-14 16:12:01 -07001569 if (!strcmp(str, "no_acpi"))
1570 no_acpi_perf = 1;
1571
Dirk Brandewie6be26492013-02-15 22:55:10 +01001572 return 0;
1573}
1574early_param("intel_pstate", intel_pstate_setup);
1575
Dirk Brandewie93f08222013-02-06 09:02:13 -08001576MODULE_AUTHOR("Dirk Brandewie <dirk.j.brandewie@intel.com>");
1577MODULE_DESCRIPTION("'intel_pstate' - P state driver Intel Core processors");
1578MODULE_LICENSE("GPL");