arch/x86/events/intel/rapl.c

   1 /*
   2  * perf_event_intel_rapl.c: support Intel RAPL energy consumption counters
   3  * Copyright (C) 2013 Google, Inc., Stephane Eranian
   4  *
   5  * Intel RAPL interface is specified in the IA-32 Manual Vol3b
   6  * section 14.7.1 (September 2013)
   7  *
   8  * RAPL provides more controls than just reporting energy consumption
   9  * however here we only expose the 3 energy consumption free running
  10  * counters (pp0, pkg, dram).
  11  *
  12  * Each of those counters increments in a power unit defined by the
  13  * RAPL_POWER_UNIT MSR. On SandyBridge, this unit is 1/(2^16) Joules
  14  * but it can vary.
  15  *
  16  * Counter to rapl events mappings:
  17  *
  18  *  pp0 counter: consumption of all physical cores (power plane 0)
  19  *        event: rapl_energy_cores
  20  *    perf code: 0x1
  21  *
  22  *  pkg counter: consumption of the whole processor package
  23  *        event: rapl_energy_pkg
  24  *    perf code: 0x2
  25  *
  26  * dram counter: consumption of the dram domain (servers only)
  27  *        event: rapl_energy_dram
  28  *    perf code: 0x3
  29  *
  30  * gpu counter: consumption of the builtin-gpu domain (client only)
  31  *        event: rapl_energy_gpu
  32  *    perf code: 0x4
  33  *
  34  *  psys counter: consumption of the builtin-psys domain (client only)
  35  *        event: rapl_energy_psys
  36  *    perf code: 0x5
  37  *
  38  * We manage those counters as free running (read-only). They may be
  39  * use simultaneously by other tools, such as turbostat.
  40  *
  41  * The events only support system-wide mode counting. There is no
  42  * sampling support because it does not make sense and is not
  43  * supported by the RAPL hardware.
  44  *
  45  * Because we want to avoid floating-point operations in the kernel,
  46  * the events are all reported in fixed point arithmetic (32.32).
  47  * Tools must adjust the counts to convert them to Watts using
  48  * the duration of the measurement. Tools may use a function such as
  49  * ldexp(raw_count, -32);
  50  */
  51
  52 #define pr_fmt(fmt) "RAPL PMU: " fmt
  53
  54 #include <linux/module.h>
  55 #include <linux/slab.h>
  56 #include <linux/perf_event.h>
  57 #include <asm/cpu_device_id.h>
  58 #include "../perf_event.h"
  59
  60 MODULE_LICENSE("GPL");
  61
  62 /*
  63  * RAPL energy status counters
  64  */
  65 #define RAPL_IDX_PP0_NRG_STAT   0       /* all cores */
  66 #define INTEL_RAPL_PP0          0x1     /* pseudo-encoding */
  67 #define RAPL_IDX_PKG_NRG_STAT   1       /* entire package */
  68 #define INTEL_RAPL_PKG          0x2     /* pseudo-encoding */
  69 #define RAPL_IDX_RAM_NRG_STAT   2       /* DRAM */
  70 #define INTEL_RAPL_RAM          0x3     /* pseudo-encoding */
  71 #define RAPL_IDX_PP1_NRG_STAT   3       /* gpu */
  72 #define INTEL_RAPL_PP1          0x4     /* pseudo-encoding */
  73 #define RAPL_IDX_PSYS_NRG_STAT  4       /* psys */
  74 #define INTEL_RAPL_PSYS         0x5     /* pseudo-encoding */
  75
  76 #define NR_RAPL_DOMAINS         0x5
  77 static const char *const rapl_domain_names[NR_RAPL_DOMAINS] __initconst = {
  78         "pp0-core",
  79         "package",
  80         "dram",
  81         "pp1-gpu",
  82         "psys",
  83 };
  84
  85 /* Clients have PP0, PKG */
  86 #define RAPL_IDX_CLN    (1<<RAPL_IDX_PP0_NRG_STAT|\
  87                          1<<RAPL_IDX_PKG_NRG_STAT|\
  88                          1<<RAPL_IDX_PP1_NRG_STAT)
  89
  90 /* Servers have PP0, PKG, RAM */
  91 #define RAPL_IDX_SRV    (1<<RAPL_IDX_PP0_NRG_STAT|\
  92                          1<<RAPL_IDX_PKG_NRG_STAT|\
  93                          1<<RAPL_IDX_RAM_NRG_STAT)
  94
  95 /* Servers have PP0, PKG, RAM, PP1 */
  96 #define RAPL_IDX_HSW    (1<<RAPL_IDX_PP0_NRG_STAT|\
  97                          1<<RAPL_IDX_PKG_NRG_STAT|\
  98                          1<<RAPL_IDX_RAM_NRG_STAT|\
  99                          1<<RAPL_IDX_PP1_NRG_STAT)
 100
 101 /* SKL clients have PP0, PKG, RAM, PP1, PSYS */
 102 #define RAPL_IDX_SKL_CLN (1<<RAPL_IDX_PP0_NRG_STAT|\
 103                           1<<RAPL_IDX_PKG_NRG_STAT|\
 104                           1<<RAPL_IDX_RAM_NRG_STAT|\
 105                           1<<RAPL_IDX_PP1_NRG_STAT|\
 106                           1<<RAPL_IDX_PSYS_NRG_STAT)
 107
 108 /* Knights Landing has PKG, RAM */
 109 #define RAPL_IDX_KNL    (1<<RAPL_IDX_PKG_NRG_STAT|\
 110                          1<<RAPL_IDX_RAM_NRG_STAT)
 111
 112 /*
 113  * event code: LSB 8 bits, passed in attr->config
 114  * any other bit is reserved
 115  */
 116 #define RAPL_EVENT_MASK 0xFFULL
 117
 118 #define DEFINE_RAPL_FORMAT_ATTR(_var, _name, _format)           \
 119 static ssize_t __rapl_##_var##_show(struct kobject *kobj,       \
 120                                 struct kobj_attribute *attr,    \
 121                                 char *page)                     \
 122 {                                                               \
 123         BUILD_BUG_ON(sizeof(_format) >= PAGE_SIZE);             \
 124         return sprintf(page, _format "\n");                     \
 125 }                                                               \
 126 static struct kobj_attribute format_attr_##_var =               \
 127         __ATTR(_name, 0444, __rapl_##_var##_show, NULL)
 128
 129 #define RAPL_CNTR_WIDTH 32
 130
 131 #define RAPL_EVENT_ATTR_STR(_name, v, str)                                      \
 132 static struct perf_pmu_events_attr event_attr_##v = {                           \
 133         .attr           = __ATTR(_name, 0444, perf_event_sysfs_show, NULL),     \
 134         .id             = 0,                                                    \
 135         .event_str      = str,                                                  \
 136 };
 137
 138 struct rapl_pmu {
 139         raw_spinlock_t          lock;
 140         int                     n_active;
 141         int                     cpu;
 142         struct list_head        active_list;
 143         struct pmu              *pmu;
 144         ktime_t                 timer_interval;
 145         struct hrtimer          hrtimer;
 146 };
 147
 148 struct rapl_pmus {
 149         struct pmu              pmu;
 150         unsigned int            maxpkg;
 151         struct rapl_pmu         *pmus[];
 152 };
 153
 154  /* 1/2^hw_unit Joule */
 155 static int rapl_hw_unit[NR_RAPL_DOMAINS] __read_mostly;
 156 static struct rapl_pmus *rapl_pmus;
 157 static cpumask_t rapl_cpu_mask;
 158 static unsigned int rapl_cntr_mask;
 159 static u64 rapl_timer_ms;
 160
 161 static inline struct rapl_pmu *cpu_to_rapl_pmu(unsigned int cpu)
 162 {
 163         return rapl_pmus->pmus[topology_logical_package_id(cpu)];
 164 }
 165
 166 static inline u64 rapl_read_counter(struct perf_event *event)
 167 {
 168         u64 raw;
 169         rdmsrl(event->hw.event_base, raw);
 170         return raw;
 171 }
 172
 173 static inline u64 rapl_scale(u64 v, int cfg)
 174 {
 175         if (cfg > NR_RAPL_DOMAINS) {
 176                 pr_warn("Invalid domain %d, failed to scale data\n", cfg);
 177                 return v;
 178         }
 179         /*
 180          * scale delta to smallest unit (1/2^32)
 181          * users must then scale back: count * 1/(1e9*2^32) to get Joules
 182          * or use ldexp(count, -32).
 183          * Watts = Joules/Time delta
 184          */
 185         return v << (32 - rapl_hw_unit[cfg - 1]);
 186 }
 187
 188 static u64 rapl_event_update(struct perf_event *event)
 189 {
 190         struct hw_perf_event *hwc = &event->hw;
 191         u64 prev_raw_count, new_raw_count;
 192         s64 delta, sdelta;
 193         int shift = RAPL_CNTR_WIDTH;
 194
 195 again:
 196         prev_raw_count = local64_read(&hwc->prev_count);
 197         rdmsrl(event->hw.event_base, new_raw_count);
 198
 199         if (local64_cmpxchg(&hwc->prev_count, prev_raw_count,
 200                             new_raw_count) != prev_raw_count) {
 201                 cpu_relax();
 202                 goto again;
 203         }
 204
 205         /*
 206          * Now we have the new raw value and have updated the prev
 207          * timestamp already. We can now calculate the elapsed delta
 208          * (event-)time and add that to the generic event.
 209          *
 210          * Careful, not all hw sign-extends above the physical width
 211          * of the count.
 212          */
 213         delta = (new_raw_count << shift) - (prev_raw_count << shift);
 214         delta >>= shift;
 215
 216         sdelta = rapl_scale(delta, event->hw.config);
 217
 218         local64_add(sdelta, &event->count);
 219
 220         return new_raw_count;
 221 }
 222
 223 static void rapl_start_hrtimer(struct rapl_pmu *pmu)
 224 {
 225        hrtimer_start(&pmu->hrtimer, pmu->timer_interval,
 226                      HRTIMER_MODE_REL_PINNED);
 227 }
 228
 229 static enum hrtimer_restart rapl_hrtimer_handle(struct hrtimer *hrtimer)
 230 {
 231         struct rapl_pmu *pmu = container_of(hrtimer, struct rapl_pmu, hrtimer);
 232         struct perf_event *event;
 233         unsigned long flags;
 234
 235         if (!pmu->n_active)
 236                 return HRTIMER_NORESTART;
 237
 238         raw_spin_lock_irqsave(&pmu->lock, flags);
 239
 240         list_for_each_entry(event, &pmu->active_list, active_entry)
 241                 rapl_event_update(event);
 242
 243         raw_spin_unlock_irqrestore(&pmu->lock, flags);
 244
 245         hrtimer_forward_now(hrtimer, pmu->timer_interval);
 246
 247         return HRTIMER_RESTART;
 248 }
 249
 250 static void rapl_hrtimer_init(struct rapl_pmu *pmu)
 251 {
 252         struct hrtimer *hr = &pmu->hrtimer;
 253
 254         hrtimer_init(hr, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
 255         hr->function = rapl_hrtimer_handle;
 256 }
 257
 258 static void __rapl_pmu_event_start(struct rapl_pmu *pmu,
 259                                    struct perf_event *event)
 260 {
 261         if (WARN_ON_ONCE(!(event->hw.state & PERF_HES_STOPPED)))
 262                 return;
 263
 264         event->hw.state = 0;
 265
 266         list_add_tail(&event->active_entry, &pmu->active_list);
 267
 268         local64_set(&event->hw.prev_count, rapl_read_counter(event));
 269
 270         pmu->n_active++;
 271         if (pmu->n_active == 1)
 272                 rapl_start_hrtimer(pmu);
 273 }
 274
 275 static void rapl_pmu_event_start(struct perf_event *event, int mode)
 276 {
 277         struct rapl_pmu *pmu = event->pmu_private;
 278         unsigned long flags;
 279
 280         raw_spin_lock_irqsave(&pmu->lock, flags);
 281         __rapl_pmu_event_start(pmu, event);
 282         raw_spin_unlock_irqrestore(&pmu->lock, flags);
 283 }
 284
 285 static void rapl_pmu_event_stop(struct perf_event *event, int mode)
 286 {
 287         struct rapl_pmu *pmu = event->pmu_private;
 288         struct hw_perf_event *hwc = &event->hw;
 289         unsigned long flags;
 290
 291         raw_spin_lock_irqsave(&pmu->lock, flags);
 292
 293         /* mark event as deactivated and stopped */
 294         if (!(hwc->state & PERF_HES_STOPPED)) {
 295                 WARN_ON_ONCE(pmu->n_active <= 0);
 296                 pmu->n_active--;
 297                 if (pmu->n_active == 0)
 298                         hrtimer_cancel(&pmu->hrtimer);
 299
 300                 list_del(&event->active_entry);
 301
 302                 WARN_ON_ONCE(hwc->state & PERF_HES_STOPPED);
 303                 hwc->state |= PERF_HES_STOPPED;
 304         }
 305
 306         /* check if update of sw counter is necessary */
 307         if ((mode & PERF_EF_UPDATE) && !(hwc->state & PERF_HES_UPTODATE)) {
 308                 /*
 309                  * Drain the remaining delta count out of a event
 310                  * that we are disabling:
 311                  */
 312                 rapl_event_update(event);
 313                 hwc->state |= PERF_HES_UPTODATE;
 314         }
 315
 316         raw_spin_unlock_irqrestore(&pmu->lock, flags);
 317 }
 318
 319 static int rapl_pmu_event_add(struct perf_event *event, int mode)
 320 {
 321         struct rapl_pmu *pmu = event->pmu_private;
 322         struct hw_perf_event *hwc = &event->hw;
 323         unsigned long flags;
 324
 325         raw_spin_lock_irqsave(&pmu->lock, flags);
 326
 327         hwc->state = PERF_HES_UPTODATE | PERF_HES_STOPPED;
 328
 329         if (mode & PERF_EF_START)
 330                 __rapl_pmu_event_start(pmu, event);
 331
 332         raw_spin_unlock_irqrestore(&pmu->lock, flags);
 333
 334         return 0;
 335 }
 336
 337 static void rapl_pmu_event_del(struct perf_event *event, int flags)
 338 {
 339         rapl_pmu_event_stop(event, PERF_EF_UPDATE);
 340 }
 341
 342 static int rapl_pmu_event_init(struct perf_event *event)
 343 {
 344         u64 cfg = event->attr.config & RAPL_EVENT_MASK;
 345         int bit, msr, ret = 0;
 346         struct rapl_pmu *pmu;
 347
 348         /* only look at RAPL events */
 349         if (event->attr.type != rapl_pmus->pmu.type)
 350                 return -ENOENT;
 351
 352         /* check only supported bits are set */
 353         if (event->attr.config & ~RAPL_EVENT_MASK)
 354                 return -EINVAL;
 355
 356         if (event->cpu < 0)
 357                 return -EINVAL;
 358
 359         /*
 360          * check event is known (determines counter)
 361          */
 362         switch (cfg) {
 363         case INTEL_RAPL_PP0:
 364                 bit = RAPL_IDX_PP0_NRG_STAT;
 365                 msr = MSR_PP0_ENERGY_STATUS;
 366                 break;
 367         case INTEL_RAPL_PKG:
 368                 bit = RAPL_IDX_PKG_NRG_STAT;
 369                 msr = MSR_PKG_ENERGY_STATUS;
 370                 break;
 371         case INTEL_RAPL_RAM:
 372                 bit = RAPL_IDX_RAM_NRG_STAT;
 373                 msr = MSR_DRAM_ENERGY_STATUS;
 374                 break;
 375         case INTEL_RAPL_PP1:
 376                 bit = RAPL_IDX_PP1_NRG_STAT;
 377                 msr = MSR_PP1_ENERGY_STATUS;
 378                 break;
 379         case INTEL_RAPL_PSYS:
 380                 bit = RAPL_IDX_PSYS_NRG_STAT;
 381                 msr = MSR_PLATFORM_ENERGY_STATUS;
 382                 break;
 383         default:
 384                 return -EINVAL;
 385         }
 386         /* check event supported */
 387         if (!(rapl_cntr_mask & (1 << bit)))
 388                 return -EINVAL;
 389
 390         /* unsupported modes and filters */
 391         if (event->attr.exclude_user   ||
 392             event->attr.exclude_kernel ||
 393             event->attr.exclude_hv     ||
 394             event->attr.exclude_idle   ||
 395             event->attr.exclude_host   ||
 396             event->attr.exclude_guest  ||
 397             event->attr.sample_period) /* no sampling */
 398                 return -EINVAL;
 399
 400         /* must be done before validate_group */
 401         pmu = cpu_to_rapl_pmu(event->cpu);
 402         event->cpu = pmu->cpu;
 403         event->pmu_private = pmu;
 404         event->hw.event_base = msr;
 405         event->hw.config = cfg;
 406         event->hw.idx = bit;
 407
 408         return ret;
 409 }
 410
 411 static void rapl_pmu_event_read(struct perf_event *event)
 412 {
 413         rapl_event_update(event);
 414 }
 415
 416 static ssize_t rapl_get_attr_cpumask(struct device *dev,
 417                                 struct device_attribute *attr, char *buf)
 418 {
 419         return cpumap_print_to_pagebuf(true, buf, &rapl_cpu_mask);
 420 }
 421
 422 static DEVICE_ATTR(cpumask, S_IRUGO, rapl_get_attr_cpumask, NULL);
 423
 424 static struct attribute *rapl_pmu_attrs[] = {
 425         &dev_attr_cpumask.attr,
 426         NULL,
 427 };
 428
 429 static struct attribute_group rapl_pmu_attr_group = {
 430         .attrs = rapl_pmu_attrs,
 431 };
 432
 433 RAPL_EVENT_ATTR_STR(energy-cores, rapl_cores, "event=0x01");
 434 RAPL_EVENT_ATTR_STR(energy-pkg  ,   rapl_pkg, "event=0x02");
 435 RAPL_EVENT_ATTR_STR(energy-ram  ,   rapl_ram, "event=0x03");
 436 RAPL_EVENT_ATTR_STR(energy-gpu  ,   rapl_gpu, "event=0x04");
 437 RAPL_EVENT_ATTR_STR(energy-psys,   rapl_psys, "event=0x05");
 438
 439 RAPL_EVENT_ATTR_STR(energy-cores.unit, rapl_cores_unit, "Joules");
 440 RAPL_EVENT_ATTR_STR(energy-pkg.unit  ,   rapl_pkg_unit, "Joules");
 441 RAPL_EVENT_ATTR_STR(energy-ram.unit  ,   rapl_ram_unit, "Joules");
 442 RAPL_EVENT_ATTR_STR(energy-gpu.unit  ,   rapl_gpu_unit, "Joules");
 443 RAPL_EVENT_ATTR_STR(energy-psys.unit,   rapl_psys_unit, "Joules");
 444
 445 /*
 446  * we compute in 0.23 nJ increments regardless of MSR
 447  */
 448 RAPL_EVENT_ATTR_STR(energy-cores.scale, rapl_cores_scale, "2.3283064365386962890625e-10");
 449 RAPL_EVENT_ATTR_STR(energy-pkg.scale,     rapl_pkg_scale, "2.3283064365386962890625e-10");
 450 RAPL_EVENT_ATTR_STR(energy-ram.scale,     rapl_ram_scale, "2.3283064365386962890625e-10");
 451 RAPL_EVENT_ATTR_STR(energy-gpu.scale,     rapl_gpu_scale, "2.3283064365386962890625e-10");
 452 RAPL_EVENT_ATTR_STR(energy-psys.scale,   rapl_psys_scale, "2.3283064365386962890625e-10");
 453
 454 static struct attribute *rapl_events_srv_attr[] = {
 455         EVENT_PTR(rapl_cores),
 456         EVENT_PTR(rapl_pkg),
 457         EVENT_PTR(rapl_ram),
 458
 459         EVENT_PTR(rapl_cores_unit),
 460         EVENT_PTR(rapl_pkg_unit),
 461         EVENT_PTR(rapl_ram_unit),
 462
 463         EVENT_PTR(rapl_cores_scale),
 464         EVENT_PTR(rapl_pkg_scale),
 465         EVENT_PTR(rapl_ram_scale),
 466         NULL,
 467 };
 468
 469 static struct attribute *rapl_events_cln_attr[] = {
 470         EVENT_PTR(rapl_cores),
 471         EVENT_PTR(rapl_pkg),
 472         EVENT_PTR(rapl_gpu),
 473
 474         EVENT_PTR(rapl_cores_unit),
 475         EVENT_PTR(rapl_pkg_unit),
 476         EVENT_PTR(rapl_gpu_unit),
 477
 478         EVENT_PTR(rapl_cores_scale),
 479         EVENT_PTR(rapl_pkg_scale),
 480         EVENT_PTR(rapl_gpu_scale),
 481         NULL,
 482 };
 483
 484 static struct attribute *rapl_events_hsw_attr[] = {
 485         EVENT_PTR(rapl_cores),
 486         EVENT_PTR(rapl_pkg),
 487         EVENT_PTR(rapl_gpu),
 488         EVENT_PTR(rapl_ram),
 489
 490         EVENT_PTR(rapl_cores_unit),
 491         EVENT_PTR(rapl_pkg_unit),
 492         EVENT_PTR(rapl_gpu_unit),
 493         EVENT_PTR(rapl_ram_unit),
 494
 495         EVENT_PTR(rapl_cores_scale),
 496         EVENT_PTR(rapl_pkg_scale),
 497         EVENT_PTR(rapl_gpu_scale),
 498         EVENT_PTR(rapl_ram_scale),
 499         NULL,
 500 };
 501
 502 static struct attribute *rapl_events_skl_attr[] = {
 503         EVENT_PTR(rapl_cores),
 504         EVENT_PTR(rapl_pkg),
 505         EVENT_PTR(rapl_gpu),
 506         EVENT_PTR(rapl_ram),
 507         EVENT_PTR(rapl_psys),
 508
 509         EVENT_PTR(rapl_cores_unit),
 510         EVENT_PTR(rapl_pkg_unit),
 511         EVENT_PTR(rapl_gpu_unit),
 512         EVENT_PTR(rapl_ram_unit),
 513         EVENT_PTR(rapl_psys_unit),
 514
 515         EVENT_PTR(rapl_cores_scale),
 516         EVENT_PTR(rapl_pkg_scale),
 517         EVENT_PTR(rapl_gpu_scale),
 518         EVENT_PTR(rapl_ram_scale),
 519         EVENT_PTR(rapl_psys_scale),
 520         NULL,
 521 };
 522
 523 static struct attribute *rapl_events_knl_attr[] = {
 524         EVENT_PTR(rapl_pkg),
 525         EVENT_PTR(rapl_ram),
 526
 527         EVENT_PTR(rapl_pkg_unit),
 528         EVENT_PTR(rapl_ram_unit),
 529
 530         EVENT_PTR(rapl_pkg_scale),
 531         EVENT_PTR(rapl_ram_scale),
 532         NULL,
 533 };
 534
 535 static struct attribute_group rapl_pmu_events_group = {
 536         .name = "events",
 537         .attrs = NULL, /* patched at runtime */
 538 };
 539
 540 DEFINE_RAPL_FORMAT_ATTR(event, event, "config:0-7");
 541 static struct attribute *rapl_formats_attr[] = {
 542         &format_attr_event.attr,
 543         NULL,
 544 };
 545
 546 static struct attribute_group rapl_pmu_format_group = {
 547         .name = "format",
 548         .attrs = rapl_formats_attr,
 549 };
 550
 551 const struct attribute_group *rapl_attr_groups[] = {
 552         &rapl_pmu_attr_group,
 553         &rapl_pmu_format_group,
 554         &rapl_pmu_events_group,
 555         NULL,
 556 };
 557
 558 static void rapl_cpu_exit(int cpu)
 559 {
 560         struct rapl_pmu *pmu = cpu_to_rapl_pmu(cpu);
 561         int target;
 562
 563         /* Check if exiting cpu is used for collecting rapl events */
 564         if (!cpumask_test_and_clear_cpu(cpu, &rapl_cpu_mask))
 565                 return;
 566
 567         pmu->cpu = -1;
 568         /* Find a new cpu to collect rapl events */
 569         target = cpumask_any_but(topology_core_cpumask(cpu), cpu);
 570
 571         /* Migrate rapl events to the new target */
 572         if (target < nr_cpu_ids) {
 573                 cpumask_set_cpu(target, &rapl_cpu_mask);
 574                 pmu->cpu = target;
 575                 perf_pmu_migrate_context(pmu->pmu, cpu, target);
 576         }
 577 }
 578
 579 static void rapl_cpu_init(int cpu)
 580 {
 581         struct rapl_pmu *pmu = cpu_to_rapl_pmu(cpu);
 582         int target;
 583
 584         /*
 585          * Check if there is an online cpu in the package which collects rapl
 586          * events already.
 587          */
 588         target = cpumask_any_and(&rapl_cpu_mask, topology_core_cpumask(cpu));
 589         if (target < nr_cpu_ids)
 590                 return;
 591
 592         cpumask_set_cpu(cpu, &rapl_cpu_mask);
 593         pmu->cpu = cpu;
 594 }
 595
 596 static int rapl_cpu_prepare(int cpu)
 597 {
 598         struct rapl_pmu *pmu = cpu_to_rapl_pmu(cpu);
 599
 600         if (pmu)
 601                 return 0;
 602
 603         pmu = kzalloc_node(sizeof(*pmu), GFP_KERNEL, cpu_to_node(cpu));
 604         if (!pmu)
 605                 return -ENOMEM;
 606
 607         raw_spin_lock_init(&pmu->lock);
 608         INIT_LIST_HEAD(&pmu->active_list);
 609         pmu->pmu = &rapl_pmus->pmu;
 610         pmu->timer_interval = ms_to_ktime(rapl_timer_ms);
 611         pmu->cpu = -1;
 612         rapl_hrtimer_init(pmu);
 613         rapl_pmus->pmus[topology_logical_package_id(cpu)] = pmu;
 614         return 0;
 615 }
 616
 617 static int rapl_cpu_notifier(struct notifier_block *self,
 618                              unsigned long action, void *hcpu)
 619 {
 620         unsigned int cpu = (long)hcpu;
 621
 622         switch (action & ~CPU_TASKS_FROZEN) {
 623         case CPU_UP_PREPARE:
 624                 rapl_cpu_prepare(cpu);
 625                 break;
 626
 627         case CPU_DOWN_FAILED:
 628         case CPU_ONLINE:
 629                 rapl_cpu_init(cpu);
 630                 break;
 631
 632         case CPU_DOWN_PREPARE:
 633                 rapl_cpu_exit(cpu);
 634                 break;
 635         }
 636         return NOTIFY_OK;
 637 }
 638
 639 static struct notifier_block rapl_cpu_nb = {
 640         .notifier_call  = rapl_cpu_notifier,
 641         .priority       = CPU_PRI_PERF + 1,
 642 };
 643
 644 static int rapl_check_hw_unit(bool apply_quirk)
 645 {
 646         u64 msr_rapl_power_unit_bits;
 647         int i;
 648
 649         /* protect rdmsrl() to handle virtualization */
 650         if (rdmsrl_safe(MSR_RAPL_POWER_UNIT, &msr_rapl_power_unit_bits))
 651                 return -1;
 652         for (i = 0; i < NR_RAPL_DOMAINS; i++)
 653                 rapl_hw_unit[i] = (msr_rapl_power_unit_bits >> 8) & 0x1FULL;
 654
 655         /*
 656          * DRAM domain on HSW server and KNL has fixed energy unit which can be
 657          * different than the unit from power unit MSR. See
 658          * "Intel Xeon Processor E5-1600 and E5-2600 v3 Product Families, V2
 659          * of 2. Datasheet, September 2014, Reference Number: 330784-001 "
 660          */
 661         if (apply_quirk)
 662                 rapl_hw_unit[RAPL_IDX_RAM_NRG_STAT] = 16;
 663
 664         /*
 665          * Calculate the timer rate:
 666          * Use reference of 200W for scaling the timeout to avoid counter
 667          * overflows. 200W = 200 Joules/sec
 668          * Divide interval by 2 to avoid lockstep (2 * 100)
 669          * if hw unit is 32, then we use 2 ms 1/200/2
 670          */
 671         rapl_timer_ms = 2;
 672         if (rapl_hw_unit[0] < 32) {
 673                 rapl_timer_ms = (1000 / (2 * 100));
 674                 rapl_timer_ms *= (1ULL << (32 - rapl_hw_unit[0] - 1));
 675         }
 676         return 0;
 677 }
 678
 679 static void __init rapl_advertise(void)
 680 {
 681         int i;
 682
 683         pr_info("API unit is 2^-32 Joules, %d fixed counters, %llu ms ovfl timer\n",
 684                 hweight32(rapl_cntr_mask), rapl_timer_ms);
 685
 686         for (i = 0; i < NR_RAPL_DOMAINS; i++) {
 687                 if (rapl_cntr_mask & (1 << i)) {
 688                         pr_info("hw unit of domain %s 2^-%d Joules\n",
 689                                 rapl_domain_names[i], rapl_hw_unit[i]);
 690                 }
 691         }
 692 }
 693
 694 static int __init rapl_prepare_cpus(void)
 695 {
 696         unsigned int cpu, pkg;
 697         int ret;
 698
 699         for_each_online_cpu(cpu) {
 700                 pkg = topology_logical_package_id(cpu);
 701                 if (rapl_pmus->pmus[pkg])
 702                         continue;
 703
 704                 ret = rapl_cpu_prepare(cpu);
 705                 if (ret)
 706                         return ret;
 707                 rapl_cpu_init(cpu);
 708         }
 709         return 0;
 710 }
 711
 712 static void cleanup_rapl_pmus(void)
 713 {
 714         int i;
 715
 716         for (i = 0; i < rapl_pmus->maxpkg; i++)
 717                 kfree(rapl_pmus->pmus[i]);
 718         kfree(rapl_pmus);
 719 }
 720
 721 static int __init init_rapl_pmus(void)
 722 {
 723         int maxpkg = topology_max_packages();
 724         size_t size;
 725
 726         size = sizeof(*rapl_pmus) + maxpkg * sizeof(struct rapl_pmu *);
 727         rapl_pmus = kzalloc(size, GFP_KERNEL);
 728         if (!rapl_pmus)
 729                 return -ENOMEM;
 730
 731         rapl_pmus->maxpkg               = maxpkg;
 732         rapl_pmus->pmu.attr_groups      = rapl_attr_groups;
 733         rapl_pmus->pmu.task_ctx_nr      = perf_invalid_context;
 734         rapl_pmus->pmu.event_init       = rapl_pmu_event_init;
 735         rapl_pmus->pmu.add              = rapl_pmu_event_add;
 736         rapl_pmus->pmu.del              = rapl_pmu_event_del;
 737         rapl_pmus->pmu.start            = rapl_pmu_event_start;
 738         rapl_pmus->pmu.stop             = rapl_pmu_event_stop;
 739         rapl_pmus->pmu.read             = rapl_pmu_event_read;
 740         return 0;
 741 }
 742
 743 #define X86_RAPL_MODEL_MATCH(model, init)       \
 744         { X86_VENDOR_INTEL, 6, model, X86_FEATURE_ANY, (unsigned long)&init }
 745
 746 struct intel_rapl_init_fun {
 747         bool apply_quirk;
 748         int cntr_mask;
 749         struct attribute **attrs;
 750 };
 751
 752 static const struct intel_rapl_init_fun snb_rapl_init __initconst = {
 753         .apply_quirk = false,
 754         .cntr_mask = RAPL_IDX_CLN,
 755         .attrs = rapl_events_cln_attr,
 756 };
 757
 758 static const struct intel_rapl_init_fun hsx_rapl_init __initconst = {
 759         .apply_quirk = true,
 760         .cntr_mask = RAPL_IDX_SRV,
 761         .attrs = rapl_events_srv_attr,
 762 };
 763
 764 static const struct intel_rapl_init_fun hsw_rapl_init __initconst = {
 765         .apply_quirk = false,
 766         .cntr_mask = RAPL_IDX_HSW,
 767         .attrs = rapl_events_hsw_attr,
 768 };
 769
 770 static const struct intel_rapl_init_fun snbep_rapl_init __initconst = {
 771         .apply_quirk = false,
 772         .cntr_mask = RAPL_IDX_SRV,
 773         .attrs = rapl_events_srv_attr,
 774 };
 775
 776 static const struct intel_rapl_init_fun knl_rapl_init __initconst = {
 777         .apply_quirk = true,
 778         .cntr_mask = RAPL_IDX_KNL,
 779         .attrs = rapl_events_knl_attr,
 780 };
 781
 782 static const struct intel_rapl_init_fun skl_rapl_init __initconst = {
 783         .apply_quirk = false,
 784         .cntr_mask = RAPL_IDX_SKL_CLN,
 785         .attrs = rapl_events_skl_attr,
 786 };
 787
 788 static const struct x86_cpu_id rapl_cpu_match[] __initconst = {
 789         X86_RAPL_MODEL_MATCH(42, snb_rapl_init),        /* Sandy Bridge */
 790         X86_RAPL_MODEL_MATCH(45, snbep_rapl_init),      /* Sandy Bridge-EP */
 791
 792         X86_RAPL_MODEL_MATCH(58, snb_rapl_init),        /* Ivy Bridge */
 793         X86_RAPL_MODEL_MATCH(62, snbep_rapl_init),      /* IvyTown */
 794
 795         X86_RAPL_MODEL_MATCH(60, hsw_rapl_init),        /* Haswell */
 796         X86_RAPL_MODEL_MATCH(63, hsx_rapl_init),        /* Haswell-Server */
 797         X86_RAPL_MODEL_MATCH(69, hsw_rapl_init),        /* Haswell-Celeron */
 798         X86_RAPL_MODEL_MATCH(70, hsw_rapl_init),        /* Haswell GT3e */
 799
 800         X86_RAPL_MODEL_MATCH(61, hsw_rapl_init),        /* Broadwell */
 801         X86_RAPL_MODEL_MATCH(71, hsw_rapl_init),        /* Broadwell-H */
 802         X86_RAPL_MODEL_MATCH(79, hsx_rapl_init),        /* Broadwell-Server */
 803         X86_RAPL_MODEL_MATCH(86, hsx_rapl_init),        /* Broadwell Xeon D */
 804
 805         X86_RAPL_MODEL_MATCH(87, knl_rapl_init),        /* Knights Landing */
 806
 807         X86_RAPL_MODEL_MATCH(78, skl_rapl_init),        /* Skylake */
 808         X86_RAPL_MODEL_MATCH(94, skl_rapl_init),        /* Skylake H/S */
 809         {},
 810 };
 811
 812 MODULE_DEVICE_TABLE(x86cpu, rapl_cpu_match);
 813
 814 static int __init rapl_pmu_init(void)
 815 {
 816         const struct x86_cpu_id *id;
 817         struct intel_rapl_init_fun *rapl_init;
 818         bool apply_quirk;
 819         int ret;
 820
 821         id = x86_match_cpu(rapl_cpu_match);
 822         if (!id)
 823                 return -ENODEV;
 824
 825         rapl_init = (struct intel_rapl_init_fun *)id->driver_data;
 826         apply_quirk = rapl_init->apply_quirk;
 827         rapl_cntr_mask = rapl_init->cntr_mask;
 828         rapl_pmu_events_group.attrs = rapl_init->attrs;
 829
 830         ret = rapl_check_hw_unit(apply_quirk);
 831         if (ret)
 832                 return ret;
 833
 834         ret = init_rapl_pmus();
 835         if (ret)
 836                 return ret;
 837
 838         cpu_notifier_register_begin();
 839
 840         ret = rapl_prepare_cpus();
 841         if (ret)
 842                 goto out;
 843
 844         ret = perf_pmu_register(&rapl_pmus->pmu, "power", -1);
 845         if (ret)
 846                 goto out;
 847
 848         __register_cpu_notifier(&rapl_cpu_nb);
 849         cpu_notifier_register_done();
 850         rapl_advertise();
 851         return 0;
 852
 853 out:
 854         pr_warn("Initialization failed (%d), disabled\n", ret);
 855         cleanup_rapl_pmus();
 856         cpu_notifier_register_done();
 857         return ret;
 858 }
 859 module_init(rapl_pmu_init);
 860
 861 static void __exit intel_rapl_exit(void)
 862 {
 863         cpu_notifier_register_begin();
 864         __unregister_cpu_notifier(&rapl_cpu_nb);
 865         perf_pmu_unregister(&rapl_pmus->pmu);
 866         cleanup_rapl_pmus();
 867         cpu_notifier_register_done();
 868 }
 869 module_exit(intel_rapl_exit);