| /* | |
| * intel_powerclamp.c - package c-state idle injection | |
| * | |
| * Copyright (c) 2012, Intel Corporation. | |
| * | |
| * Authors: | |
| * Arjan van de Ven <arjan@linux.intel.com> | |
| * Jacob Pan <jacob.jun.pan@linux.intel.com> | |
| * | |
| * This program is free software; you can redistribute it and/or modify it | |
| * under the terms and conditions of the GNU General Public License, | |
| * version 2, as published by the Free Software Foundation. | |
| * | |
| * This program is distributed in the hope it will be useful, but WITHOUT | |
| * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
| * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
| * more details. | |
| * | |
| * You should have received a copy of the GNU General Public License along with | |
| * this program; if not, write to the Free Software Foundation, Inc., | |
| * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. | |
| * | |
| * | |
| * TODO: | |
| * 1. better handle wakeup from external interrupts, currently a fixed | |
| * compensation is added to clamping duration when excessive amount | |
| * of wakeups are observed during idle time. the reason is that in | |
| * case of external interrupts without need for ack, clamping down | |
| * cpu in non-irq context does not reduce irq. for majority of the | |
| * cases, clamping down cpu does help reduce irq as well, we should | |
| * be able to differenciate the two cases and give a quantitative | |
| * solution for the irqs that we can control. perhaps based on | |
| * get_cpu_iowait_time_us() | |
| * | |
| * 2. synchronization with other hw blocks | |
| * | |
| * | |
| */ | |
| #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt | |
| #include <linux/module.h> | |
| #include <linux/kernel.h> | |
| #include <linux/delay.h> | |
| #include <linux/kthread.h> | |
| #include <linux/cpu.h> | |
| #include <linux/thermal.h> | |
| #include <linux/slab.h> | |
| #include <linux/tick.h> | |
| #include <linux/debugfs.h> | |
| #include <linux/seq_file.h> | |
| #include <linux/sched/rt.h> | |
| #include <uapi/linux/sched/types.h> | |
| #include <asm/nmi.h> | |
| #include <asm/msr.h> | |
| #include <asm/mwait.h> | |
| #include <asm/cpu_device_id.h> | |
| #include <asm/hardirq.h> | |
| #define MAX_TARGET_RATIO (50U) | |
| /* For each undisturbed clamping period (no extra wake ups during idle time), | |
| * we increment the confidence counter for the given target ratio. | |
| * CONFIDENCE_OK defines the level where runtime calibration results are | |
| * valid. | |
| */ | |
| #define CONFIDENCE_OK (3) | |
| /* Default idle injection duration, driver adjust sleep time to meet target | |
| * idle ratio. Similar to frequency modulation. | |
| */ | |
| #define DEFAULT_DURATION_JIFFIES (6) | |
| static unsigned int target_mwait; | |
| static struct dentry *debug_dir; | |
| /* user selected target */ | |
| static unsigned int set_target_ratio; | |
| static unsigned int current_ratio; | |
| static bool should_skip; | |
| static bool reduce_irq; | |
| static atomic_t idle_wakeup_counter; | |
| static unsigned int control_cpu; /* The cpu assigned to collect stat and update | |
| * control parameters. default to BSP but BSP | |
| * can be offlined. | |
| */ | |
| static bool clamping; | |
| static const struct sched_param sparam = { | |
| .sched_priority = MAX_USER_RT_PRIO / 2, | |
| }; | |
| struct powerclamp_worker_data { | |
| struct kthread_worker *worker; | |
| struct kthread_work balancing_work; | |
| struct kthread_delayed_work idle_injection_work; | |
| unsigned int cpu; | |
| unsigned int count; | |
| unsigned int guard; | |
| unsigned int window_size_now; | |
| unsigned int target_ratio; | |
| unsigned int duration_jiffies; | |
| bool clamping; | |
| }; | |
| static struct powerclamp_worker_data __percpu *worker_data; | |
| static struct thermal_cooling_device *cooling_dev; | |
| static unsigned long *cpu_clamping_mask; /* bit map for tracking per cpu | |
| * clamping kthread worker | |
| */ | |
| static unsigned int duration; | |
| static unsigned int pkg_cstate_ratio_cur; | |
| static unsigned int window_size; | |
| static int duration_set(const char *arg, const struct kernel_param *kp) | |
| { | |
| int ret = 0; | |
| unsigned long new_duration; | |
| ret = kstrtoul(arg, 10, &new_duration); | |
| if (ret) | |
| goto exit; | |
| if (new_duration > 25 || new_duration < 6) { | |
| pr_err("Out of recommended range %lu, between 6-25ms\n", | |
| new_duration); | |
| ret = -EINVAL; | |
| } | |
| duration = clamp(new_duration, 6ul, 25ul); | |
| smp_mb(); | |
| exit: | |
| return ret; | |
| } | |
| static const struct kernel_param_ops duration_ops = { | |
| .set = duration_set, | |
| .get = param_get_int, | |
| }; | |
| module_param_cb(duration, &duration_ops, &duration, 0644); | |
| MODULE_PARM_DESC(duration, "forced idle time for each attempt in msec."); | |
| struct powerclamp_calibration_data { | |
| unsigned long confidence; /* used for calibration, basically a counter | |
| * gets incremented each time a clamping | |
| * period is completed without extra wakeups | |
| * once that counter is reached given level, | |
| * compensation is deemed usable. | |
| */ | |
| unsigned long steady_comp; /* steady state compensation used when | |
| * no extra wakeups occurred. | |
| */ | |
| unsigned long dynamic_comp; /* compensate excessive wakeup from idle | |
| * mostly from external interrupts. | |
| */ | |
| }; | |
| static struct powerclamp_calibration_data cal_data[MAX_TARGET_RATIO]; | |
| static int window_size_set(const char *arg, const struct kernel_param *kp) | |
| { | |
| int ret = 0; | |
| unsigned long new_window_size; | |
| ret = kstrtoul(arg, 10, &new_window_size); | |
| if (ret) | |
| goto exit_win; | |
| if (new_window_size > 10 || new_window_size < 2) { | |
| pr_err("Out of recommended window size %lu, between 2-10\n", | |
| new_window_size); | |
| ret = -EINVAL; | |
| } | |
| window_size = clamp(new_window_size, 2ul, 10ul); | |
| smp_mb(); | |
| exit_win: | |
| return ret; | |
| } | |
| static const struct kernel_param_ops window_size_ops = { | |
| .set = window_size_set, | |
| .get = param_get_int, | |
| }; | |
| module_param_cb(window_size, &window_size_ops, &window_size, 0644); | |
| MODULE_PARM_DESC(window_size, "sliding window in number of clamping cycles\n" | |
| "\tpowerclamp controls idle ratio within this window. larger\n" | |
| "\twindow size results in slower response time but more smooth\n" | |
| "\tclamping results. default to 2."); | |
| static void find_target_mwait(void) | |
| { | |
| unsigned int eax, ebx, ecx, edx; | |
| unsigned int highest_cstate = 0; | |
| unsigned int highest_subcstate = 0; | |
| int i; | |
| if (boot_cpu_data.cpuid_level < CPUID_MWAIT_LEAF) | |
| return; | |
| cpuid(CPUID_MWAIT_LEAF, &eax, &ebx, &ecx, &edx); | |
| if (!(ecx & CPUID5_ECX_EXTENSIONS_SUPPORTED) || | |
| !(ecx & CPUID5_ECX_INTERRUPT_BREAK)) | |
| return; | |
| edx >>= MWAIT_SUBSTATE_SIZE; | |
| for (i = 0; i < 7 && edx; i++, edx >>= MWAIT_SUBSTATE_SIZE) { | |
| if (edx & MWAIT_SUBSTATE_MASK) { | |
| highest_cstate = i; | |
| highest_subcstate = edx & MWAIT_SUBSTATE_MASK; | |
| } | |
| } | |
| target_mwait = (highest_cstate << MWAIT_SUBSTATE_SIZE) | | |
| (highest_subcstate - 1); | |
| } | |
| struct pkg_cstate_info { | |
| bool skip; | |
| int msr_index; | |
| int cstate_id; | |
| }; | |
| #define PKG_CSTATE_INIT(id) { \ | |
| .msr_index = MSR_PKG_C##id##_RESIDENCY, \ | |
| .cstate_id = id \ | |
| } | |
| static struct pkg_cstate_info pkg_cstates[] = { | |
| PKG_CSTATE_INIT(2), | |
| PKG_CSTATE_INIT(3), | |
| PKG_CSTATE_INIT(6), | |
| PKG_CSTATE_INIT(7), | |
| PKG_CSTATE_INIT(8), | |
| PKG_CSTATE_INIT(9), | |
| PKG_CSTATE_INIT(10), | |
| {NULL}, | |
| }; | |
| static bool has_pkg_state_counter(void) | |
| { | |
| u64 val; | |
| struct pkg_cstate_info *info = pkg_cstates; | |
| /* check if any one of the counter msrs exists */ | |
| while (info->msr_index) { | |
| if (!rdmsrl_safe(info->msr_index, &val)) | |
| return true; | |
| info++; | |
| } | |
| return false; | |
| } | |
| static u64 pkg_state_counter(void) | |
| { | |
| u64 val; | |
| u64 count = 0; | |
| struct pkg_cstate_info *info = pkg_cstates; | |
| while (info->msr_index) { | |
| if (!info->skip) { | |
| if (!rdmsrl_safe(info->msr_index, &val)) | |
| count += val; | |
| else | |
| info->skip = true; | |
| } | |
| info++; | |
| } | |
| return count; | |
| } | |
| static unsigned int get_compensation(int ratio) | |
| { | |
| unsigned int comp = 0; | |
| /* we only use compensation if all adjacent ones are good */ | |
| if (ratio == 1 && | |
| cal_data[ratio].confidence >= CONFIDENCE_OK && | |
| cal_data[ratio + 1].confidence >= CONFIDENCE_OK && | |
| cal_data[ratio + 2].confidence >= CONFIDENCE_OK) { | |
| comp = (cal_data[ratio].steady_comp + | |
| cal_data[ratio + 1].steady_comp + | |
| cal_data[ratio + 2].steady_comp) / 3; | |
| } else if (ratio == MAX_TARGET_RATIO - 1 && | |
| cal_data[ratio].confidence >= CONFIDENCE_OK && | |
| cal_data[ratio - 1].confidence >= CONFIDENCE_OK && | |
| cal_data[ratio - 2].confidence >= CONFIDENCE_OK) { | |
| comp = (cal_data[ratio].steady_comp + | |
| cal_data[ratio - 1].steady_comp + | |
| cal_data[ratio - 2].steady_comp) / 3; | |
| } else if (cal_data[ratio].confidence >= CONFIDENCE_OK && | |
| cal_data[ratio - 1].confidence >= CONFIDENCE_OK && | |
| cal_data[ratio + 1].confidence >= CONFIDENCE_OK) { | |
| comp = (cal_data[ratio].steady_comp + | |
| cal_data[ratio - 1].steady_comp + | |
| cal_data[ratio + 1].steady_comp) / 3; | |
| } | |
| /* REVISIT: simple penalty of double idle injection */ | |
| if (reduce_irq) | |
| comp = ratio; | |
| /* do not exceed limit */ | |
| if (comp + ratio >= MAX_TARGET_RATIO) | |
| comp = MAX_TARGET_RATIO - ratio - 1; | |
| return comp; | |
| } | |
| static void adjust_compensation(int target_ratio, unsigned int win) | |
| { | |
| int delta; | |
| struct powerclamp_calibration_data *d = &cal_data[target_ratio]; | |
| /* | |
| * adjust compensations if confidence level has not been reached or | |
| * there are too many wakeups during the last idle injection period, we | |
| * cannot trust the data for compensation. | |
| */ | |
| if (d->confidence >= CONFIDENCE_OK || | |
| atomic_read(&idle_wakeup_counter) > | |
| win * num_online_cpus()) | |
| return; | |
| delta = set_target_ratio - current_ratio; | |
| /* filter out bad data */ | |
| if (delta >= 0 && delta <= (1+target_ratio/10)) { | |
| if (d->steady_comp) | |
| d->steady_comp = | |
| roundup(delta+d->steady_comp, 2)/2; | |
| else | |
| d->steady_comp = delta; | |
| d->confidence++; | |
| } | |
| } | |
| static bool powerclamp_adjust_controls(unsigned int target_ratio, | |
| unsigned int guard, unsigned int win) | |
| { | |
| static u64 msr_last, tsc_last; | |
| u64 msr_now, tsc_now; | |
| u64 val64; | |
| /* check result for the last window */ | |
| msr_now = pkg_state_counter(); | |
| tsc_now = rdtsc(); | |
| /* calculate pkg cstate vs tsc ratio */ | |
| if (!msr_last || !tsc_last) | |
| current_ratio = 1; | |
| else if (tsc_now-tsc_last) { | |
| val64 = 100*(msr_now-msr_last); | |
| do_div(val64, (tsc_now-tsc_last)); | |
| current_ratio = val64; | |
| } | |
| /* update record */ | |
| msr_last = msr_now; | |
| tsc_last = tsc_now; | |
| adjust_compensation(target_ratio, win); | |
| /* | |
| * too many external interrupts, set flag such | |
| * that we can take measure later. | |
| */ | |
| reduce_irq = atomic_read(&idle_wakeup_counter) >= | |
| 2 * win * num_online_cpus(); | |
| atomic_set(&idle_wakeup_counter, 0); | |
| /* if we are above target+guard, skip */ | |
| return set_target_ratio + guard <= current_ratio; | |
| } | |
| static void clamp_balancing_func(struct kthread_work *work) | |
| { | |
| struct powerclamp_worker_data *w_data; | |
| int sleeptime; | |
| unsigned long target_jiffies; | |
| unsigned int compensated_ratio; | |
| int interval; /* jiffies to sleep for each attempt */ | |
| w_data = container_of(work, struct powerclamp_worker_data, | |
| balancing_work); | |
| /* | |
| * make sure user selected ratio does not take effect until | |
| * the next round. adjust target_ratio if user has changed | |
| * target such that we can converge quickly. | |
| */ | |
| w_data->target_ratio = READ_ONCE(set_target_ratio); | |
| w_data->guard = 1 + w_data->target_ratio / 20; | |
| w_data->window_size_now = window_size; | |
| w_data->duration_jiffies = msecs_to_jiffies(duration); | |
| w_data->count++; | |
| /* | |
| * systems may have different ability to enter package level | |
| * c-states, thus we need to compensate the injected idle ratio | |
| * to achieve the actual target reported by the HW. | |
| */ | |
| compensated_ratio = w_data->target_ratio + | |
| get_compensation(w_data->target_ratio); | |
| if (compensated_ratio <= 0) | |
| compensated_ratio = 1; | |
| interval = w_data->duration_jiffies * 100 / compensated_ratio; | |
| /* align idle time */ | |
| target_jiffies = roundup(jiffies, interval); | |
| sleeptime = target_jiffies - jiffies; | |
| if (sleeptime <= 0) | |
| sleeptime = 1; | |
| if (clamping && w_data->clamping && cpu_online(w_data->cpu)) | |
| kthread_queue_delayed_work(w_data->worker, | |
| &w_data->idle_injection_work, | |
| sleeptime); | |
| } | |
| static void clamp_idle_injection_func(struct kthread_work *work) | |
| { | |
| struct powerclamp_worker_data *w_data; | |
| w_data = container_of(work, struct powerclamp_worker_data, | |
| idle_injection_work.work); | |
| /* | |
| * only elected controlling cpu can collect stats and update | |
| * control parameters. | |
| */ | |
| if (w_data->cpu == control_cpu && | |
| !(w_data->count % w_data->window_size_now)) { | |
| should_skip = | |
| powerclamp_adjust_controls(w_data->target_ratio, | |
| w_data->guard, | |
| w_data->window_size_now); | |
| smp_mb(); | |
| } | |
| if (should_skip) | |
| goto balance; | |
| play_idle(jiffies_to_msecs(w_data->duration_jiffies)); | |
| balance: | |
| if (clamping && w_data->clamping && cpu_online(w_data->cpu)) | |
| kthread_queue_work(w_data->worker, &w_data->balancing_work); | |
| } | |
| /* | |
| * 1 HZ polling while clamping is active, useful for userspace | |
| * to monitor actual idle ratio. | |
| */ | |
| static void poll_pkg_cstate(struct work_struct *dummy); | |
| static DECLARE_DELAYED_WORK(poll_pkg_cstate_work, poll_pkg_cstate); | |
| static void poll_pkg_cstate(struct work_struct *dummy) | |
| { | |
| static u64 msr_last; | |
| static u64 tsc_last; | |
| u64 msr_now; | |
| u64 tsc_now; | |
| u64 val64; | |
| msr_now = pkg_state_counter(); | |
| tsc_now = rdtsc(); | |
| /* calculate pkg cstate vs tsc ratio */ | |
| if (!msr_last || !tsc_last) | |
| pkg_cstate_ratio_cur = 1; | |
| else { | |
| if (tsc_now - tsc_last) { | |
| val64 = 100 * (msr_now - msr_last); | |
| do_div(val64, (tsc_now - tsc_last)); | |
| pkg_cstate_ratio_cur = val64; | |
| } | |
| } | |
| /* update record */ | |
| msr_last = msr_now; | |
| tsc_last = tsc_now; | |
| if (true == clamping) | |
| schedule_delayed_work(&poll_pkg_cstate_work, HZ); | |
| } | |
| static void start_power_clamp_worker(unsigned long cpu) | |
| { | |
| struct powerclamp_worker_data *w_data = per_cpu_ptr(worker_data, cpu); | |
| struct kthread_worker *worker; | |
| worker = kthread_create_worker_on_cpu(cpu, 0, "kidle_inj/%ld", cpu); | |
| if (IS_ERR(worker)) | |
| return; | |
| w_data->worker = worker; | |
| w_data->count = 0; | |
| w_data->cpu = cpu; | |
| w_data->clamping = true; | |
| set_bit(cpu, cpu_clamping_mask); | |
| sched_setscheduler(worker->task, SCHED_FIFO, &sparam); | |
| kthread_init_work(&w_data->balancing_work, clamp_balancing_func); | |
| kthread_init_delayed_work(&w_data->idle_injection_work, | |
| clamp_idle_injection_func); | |
| kthread_queue_work(w_data->worker, &w_data->balancing_work); | |
| } | |
| static void stop_power_clamp_worker(unsigned long cpu) | |
| { | |
| struct powerclamp_worker_data *w_data = per_cpu_ptr(worker_data, cpu); | |
| if (!w_data->worker) | |
| return; | |
| w_data->clamping = false; | |
| /* | |
| * Make sure that all works that get queued after this point see | |
| * the clamping disabled. The counter part is not needed because | |
| * there is an implicit memory barrier when the queued work | |
| * is proceed. | |
| */ | |
| smp_wmb(); | |
| kthread_cancel_work_sync(&w_data->balancing_work); | |
| kthread_cancel_delayed_work_sync(&w_data->idle_injection_work); | |
| /* | |
| * The balancing work still might be queued here because | |
| * the handling of the "clapming" variable, cancel, and queue | |
| * operations are not synchronized via a lock. But it is not | |
| * a big deal. The balancing work is fast and destroy kthread | |
| * will wait for it. | |
| */ | |
| clear_bit(w_data->cpu, cpu_clamping_mask); | |
| kthread_destroy_worker(w_data->worker); | |
| w_data->worker = NULL; | |
| } | |
| static int start_power_clamp(void) | |
| { | |
| unsigned long cpu; | |
| set_target_ratio = clamp(set_target_ratio, 0U, MAX_TARGET_RATIO - 1); | |
| /* prevent cpu hotplug */ | |
| get_online_cpus(); | |
| /* prefer BSP */ | |
| control_cpu = 0; | |
| if (!cpu_online(control_cpu)) | |
| control_cpu = smp_processor_id(); | |
| clamping = true; | |
| schedule_delayed_work(&poll_pkg_cstate_work, 0); | |
| /* start one kthread worker per online cpu */ | |
| for_each_online_cpu(cpu) { | |
| start_power_clamp_worker(cpu); | |
| } | |
| put_online_cpus(); | |
| return 0; | |
| } | |
| static void end_power_clamp(void) | |
| { | |
| int i; | |
| /* | |
| * Block requeuing in all the kthread workers. They will flush and | |
| * stop faster. | |
| */ | |
| clamping = false; | |
| if (bitmap_weight(cpu_clamping_mask, num_possible_cpus())) { | |
| for_each_set_bit(i, cpu_clamping_mask, num_possible_cpus()) { | |
| pr_debug("clamping worker for cpu %d alive, destroy\n", | |
| i); | |
| stop_power_clamp_worker(i); | |
| } | |
| } | |
| } | |
| static int powerclamp_cpu_online(unsigned int cpu) | |
| { | |
| if (clamping == false) | |
| return 0; | |
| start_power_clamp_worker(cpu); | |
| /* prefer BSP as controlling CPU */ | |
| if (cpu == 0) { | |
| control_cpu = 0; | |
| smp_mb(); | |
| } | |
| return 0; | |
| } | |
| static int powerclamp_cpu_predown(unsigned int cpu) | |
| { | |
| if (clamping == false) | |
| return 0; | |
| stop_power_clamp_worker(cpu); | |
| if (cpu != control_cpu) | |
| return 0; | |
| control_cpu = cpumask_first(cpu_online_mask); | |
| if (control_cpu == cpu) | |
| control_cpu = cpumask_next(cpu, cpu_online_mask); | |
| smp_mb(); | |
| return 0; | |
| } | |
| static int powerclamp_get_max_state(struct thermal_cooling_device *cdev, | |
| unsigned long *state) | |
| { | |
| *state = MAX_TARGET_RATIO; | |
| return 0; | |
| } | |
| static int powerclamp_get_cur_state(struct thermal_cooling_device *cdev, | |
| unsigned long *state) | |
| { | |
| if (true == clamping) | |
| *state = pkg_cstate_ratio_cur; | |
| else | |
| /* to save power, do not poll idle ratio while not clamping */ | |
| *state = -1; /* indicates invalid state */ | |
| return 0; | |
| } | |
| static int powerclamp_set_cur_state(struct thermal_cooling_device *cdev, | |
| unsigned long new_target_ratio) | |
| { | |
| int ret = 0; | |
| new_target_ratio = clamp(new_target_ratio, 0UL, | |
| (unsigned long) (MAX_TARGET_RATIO-1)); | |
| if (set_target_ratio == 0 && new_target_ratio > 0) { | |
| pr_info("Start idle injection to reduce power\n"); | |
| set_target_ratio = new_target_ratio; | |
| ret = start_power_clamp(); | |
| goto exit_set; | |
| } else if (set_target_ratio > 0 && new_target_ratio == 0) { | |
| pr_info("Stop forced idle injection\n"); | |
| end_power_clamp(); | |
| set_target_ratio = 0; | |
| } else /* adjust currently running */ { | |
| set_target_ratio = new_target_ratio; | |
| /* make new set_target_ratio visible to other cpus */ | |
| smp_mb(); | |
| } | |
| exit_set: | |
| return ret; | |
| } | |
| /* bind to generic thermal layer as cooling device*/ | |
| static struct thermal_cooling_device_ops powerclamp_cooling_ops = { | |
| .get_max_state = powerclamp_get_max_state, | |
| .get_cur_state = powerclamp_get_cur_state, | |
| .set_cur_state = powerclamp_set_cur_state, | |
| }; | |
| static const struct x86_cpu_id __initconst intel_powerclamp_ids[] = { | |
| { X86_VENDOR_INTEL, X86_FAMILY_ANY, X86_MODEL_ANY, X86_FEATURE_MWAIT }, | |
| {} | |
| }; | |
| MODULE_DEVICE_TABLE(x86cpu, intel_powerclamp_ids); | |
| static int __init powerclamp_probe(void) | |
| { | |
| if (!x86_match_cpu(intel_powerclamp_ids)) { | |
| pr_err("CPU does not support MWAIT"); | |
| return -ENODEV; | |
| } | |
| /* The goal for idle time alignment is to achieve package cstate. */ | |
| if (!has_pkg_state_counter()) { | |
| pr_info("No package C-state available"); | |
| return -ENODEV; | |
| } | |
| /* find the deepest mwait value */ | |
| find_target_mwait(); | |
| return 0; | |
| } | |
| static int powerclamp_debug_show(struct seq_file *m, void *unused) | |
| { | |
| int i = 0; | |
| seq_printf(m, "controlling cpu: %d\n", control_cpu); | |
| seq_printf(m, "pct confidence steady dynamic (compensation)\n"); | |
| for (i = 0; i < MAX_TARGET_RATIO; i++) { | |
| seq_printf(m, "%d\t%lu\t%lu\t%lu\n", | |
| i, | |
| cal_data[i].confidence, | |
| cal_data[i].steady_comp, | |
| cal_data[i].dynamic_comp); | |
| } | |
| return 0; | |
| } | |
| static int powerclamp_debug_open(struct inode *inode, | |
| struct file *file) | |
| { | |
| return single_open(file, powerclamp_debug_show, inode->i_private); | |
| } | |
| static const struct file_operations powerclamp_debug_fops = { | |
| .open = powerclamp_debug_open, | |
| .read = seq_read, | |
| .llseek = seq_lseek, | |
| .release = single_release, | |
| .owner = THIS_MODULE, | |
| }; | |
| static inline void powerclamp_create_debug_files(void) | |
| { | |
| debug_dir = debugfs_create_dir("intel_powerclamp", NULL); | |
| if (!debug_dir) | |
| return; | |
| if (!debugfs_create_file("powerclamp_calib", S_IRUGO, debug_dir, | |
| cal_data, &powerclamp_debug_fops)) | |
| goto file_error; | |
| return; | |
| file_error: | |
| debugfs_remove_recursive(debug_dir); | |
| } | |
| static enum cpuhp_state hp_state; | |
| static int __init powerclamp_init(void) | |
| { | |
| int retval; | |
| int bitmap_size; | |
| bitmap_size = BITS_TO_LONGS(num_possible_cpus()) * sizeof(long); | |
| cpu_clamping_mask = kzalloc(bitmap_size, GFP_KERNEL); | |
| if (!cpu_clamping_mask) | |
| return -ENOMEM; | |
| /* probe cpu features and ids here */ | |
| retval = powerclamp_probe(); | |
| if (retval) | |
| goto exit_free; | |
| /* set default limit, maybe adjusted during runtime based on feedback */ | |
| window_size = 2; | |
| retval = cpuhp_setup_state_nocalls(CPUHP_AP_ONLINE_DYN, | |
| "thermal/intel_powerclamp:online", | |
| powerclamp_cpu_online, | |
| powerclamp_cpu_predown); | |
| if (retval < 0) | |
| goto exit_free; | |
| hp_state = retval; | |
| worker_data = alloc_percpu(struct powerclamp_worker_data); | |
| if (!worker_data) { | |
| retval = -ENOMEM; | |
| goto exit_unregister; | |
| } | |
| cooling_dev = thermal_cooling_device_register("intel_powerclamp", NULL, | |
| &powerclamp_cooling_ops); | |
| if (IS_ERR(cooling_dev)) { | |
| retval = -ENODEV; | |
| goto exit_free_thread; | |
| } | |
| if (!duration) | |
| duration = jiffies_to_msecs(DEFAULT_DURATION_JIFFIES); | |
| powerclamp_create_debug_files(); | |
| return 0; | |
| exit_free_thread: | |
| free_percpu(worker_data); | |
| exit_unregister: | |
| cpuhp_remove_state_nocalls(hp_state); | |
| exit_free: | |
| kfree(cpu_clamping_mask); | |
| return retval; | |
| } | |
| module_init(powerclamp_init); | |
| static void __exit powerclamp_exit(void) | |
| { | |
| end_power_clamp(); | |
| cpuhp_remove_state_nocalls(hp_state); | |
| free_percpu(worker_data); | |
| thermal_cooling_device_unregister(cooling_dev); | |
| kfree(cpu_clamping_mask); | |
| cancel_delayed_work_sync(&poll_pkg_cstate_work); | |
| debugfs_remove_recursive(debug_dir); | |
| } | |
| module_exit(powerclamp_exit); | |
| MODULE_LICENSE("GPL"); | |
| MODULE_AUTHOR("Arjan van de Ven <arjan@linux.intel.com>"); | |
| MODULE_AUTHOR("Jacob Pan <jacob.jun.pan@linux.intel.com>"); | |
| MODULE_DESCRIPTION("Package Level C-state Idle Injection for Intel CPUs"); |