arch/x86/kernel/cpu/aperfmperf.c

   1 /*
   2  * x86 APERF/MPERF KHz calculation for
   3  * /sys/.../cpufreq/scaling_cur_freq
   4  *
   5  * Copyright (C) 2017 Intel Corp.
   6  * Author: Len Brown <len.brown@intel.com>
   7  *
   8  * This file is licensed under GPLv2.
   9  */
  10
  11 #include <linux/delay.h>
  12 #include <linux/ktime.h>
  13 #include <linux/math64.h>
  14 #include <linux/percpu.h>
  15 #include <linux/smp.h>
  16
  17 struct aperfmperf_sample {
  18         unsigned int    khz;
  19         ktime_t time;
  20         u64     aperf;
  21         u64     mperf;
  22 };
  23
  24 static DEFINE_PER_CPU(struct aperfmperf_sample, samples);
  25
  26 #define APERFMPERF_CACHE_THRESHOLD_MS   10
  27 #define APERFMPERF_REFRESH_DELAY_MS     20
  28 #define APERFMPERF_STALE_THRESHOLD_MS   1000
  29
  30 /*
  31  * aperfmperf_snapshot_khz()
  32  * On the current CPU, snapshot APERF, MPERF, and jiffies
  33  * unless we already did it within 10ms
  34  * calculate kHz, save snapshot
  35  */
  36 static void aperfmperf_snapshot_khz(void *dummy)
  37 {
  38         u64 aperf, aperf_delta;
  39         u64 mperf, mperf_delta;
  40         struct aperfmperf_sample *s = this_cpu_ptr(&samples);
  41         ktime_t now = ktime_get();
  42         s64 time_delta = ktime_ms_delta(now, s->time);
  43         unsigned long flags;
  44
  45         /* Don't bother re-computing within the cache threshold time. */
  46         if (time_delta < APERFMPERF_CACHE_THRESHOLD_MS)
  47                 return;
  48
  49         local_irq_save(flags);
  50         rdmsrl(MSR_IA32_APERF, aperf);
  51         rdmsrl(MSR_IA32_MPERF, mperf);
  52         local_irq_restore(flags);
  53
  54         aperf_delta = aperf - s->aperf;
  55         mperf_delta = mperf - s->mperf;
  56
  57         /*
  58          * There is no architectural guarantee that MPERF
  59          * increments faster than we can read it.
  60          */
  61         if (mperf_delta == 0)
  62                 return;
  63
  64         s->time = now;
  65         s->aperf = aperf;
  66         s->mperf = mperf;
  67
  68         /* If the previous iteration was too long ago, discard it. */
  69         if (time_delta > APERFMPERF_STALE_THRESHOLD_MS)
  70                 s->khz = 0;
  71         else
  72                 s->khz = div64_u64((cpu_khz * aperf_delta), mperf_delta);
  73 }
  74
  75 unsigned int arch_freq_get_on_cpu(int cpu)
  76 {
  77         unsigned int khz;
  78
  79         if (!cpu_khz)
  80                 return 0;
  81
  82         if (!static_cpu_has(X86_FEATURE_APERFMPERF))
  83                 return 0;
  84
  85         smp_call_function_single(cpu, aperfmperf_snapshot_khz, NULL, 1);
  86         khz = per_cpu(samples.khz, cpu);
  87         if (khz)
  88                 return khz;
  89
  90         msleep(APERFMPERF_REFRESH_DELAY_MS);
  91         smp_call_function_single(cpu, aperfmperf_snapshot_khz, NULL, 1);
  92
  93         return per_cpu(samples.khz, cpu);
  94 }