arch/x86/kernel/cpu/perf_event.c

   1 /*
   2  * Performance events x86 architecture code
   3  *
   4  *  Copyright (C) 2008 Thomas Gleixner <tglx@linutronix.de>
   5  *  Copyright (C) 2008-2009 Red Hat, Inc., Ingo Molnar
   6  *  Copyright (C) 2009 Jaswinder Singh Rajput
   7  *  Copyright (C) 2009 Advanced Micro Devices, Inc., Robert Richter
   8  *  Copyright (C) 2008-2009 Red Hat, Inc., Peter Zijlstra <pzijlstr@redhat.com>
   9  *  Copyright (C) 2009 Intel Corporation, <markus.t.metzger@intel.com>
  10  *  Copyright (C) 2009 Google, Inc., Stephane Eranian
  11  *
  12  *  For licencing details see kernel-base/COPYING
  13  */
  14
  15 #include <linux/perf_event.h>
  16 #include <linux/capability.h>
  17 #include <linux/notifier.h>
  18 #include <linux/hardirq.h>
  19 #include <linux/kprobes.h>
  20 #include <linux/module.h>
  21 #include <linux/kdebug.h>
  22 #include <linux/sched.h>
  23 #include <linux/uaccess.h>
  24 #include <linux/highmem.h>
  25 #include <linux/cpu.h>
  26 #include <linux/bitops.h>
  27
  28 #include <asm/apic.h>
  29 #include <asm/stacktrace.h>
  30 #include <asm/nmi.h>
  31
  32 static u64 perf_event_mask __read_mostly;
  33
  34 /* The maximal number of PEBS events: */
  35 #define MAX_PEBS_EVENTS 4
  36
  37 /* The size of a BTS record in bytes: */
  38 #define BTS_RECORD_SIZE         24
  39
  40 /* The size of a per-cpu BTS buffer in bytes: */
  41 #define BTS_BUFFER_SIZE         (BTS_RECORD_SIZE * 2048)
  42
  43 /* The BTS overflow threshold in bytes from the end of the buffer: */
  44 #define BTS_OVFL_TH             (BTS_RECORD_SIZE * 128)
  45
  46
  47 /*
  48  * Bits in the debugctlmsr controlling branch tracing.
  49  */
  50 #define X86_DEBUGCTL_TR                 (1 << 6)
  51 #define X86_DEBUGCTL_BTS                (1 << 7)
  52 #define X86_DEBUGCTL_BTINT              (1 << 8)
  53 #define X86_DEBUGCTL_BTS_OFF_OS         (1 << 9)
  54 #define X86_DEBUGCTL_BTS_OFF_USR        (1 << 10)
  55
  56 /*
  57  * A debug store configuration.
  58  *
  59  * We only support architectures that use 64bit fields.
  60  */
  61 struct debug_store {
  62         u64     bts_buffer_base;
  63         u64     bts_index;
  64         u64     bts_absolute_maximum;
  65         u64     bts_interrupt_threshold;
  66         u64     pebs_buffer_base;
  67         u64     pebs_index;
  68         u64     pebs_absolute_maximum;
  69         u64     pebs_interrupt_threshold;
  70         u64     pebs_event_reset[MAX_PEBS_EVENTS];
  71 };
  72
  73 struct event_constraint {
  74         union {
  75                 unsigned long   idxmsk[BITS_TO_LONGS(X86_PMC_IDX_MAX)];
  76                 u64             idxmsk64;
  77         };
  78         u64     code;
  79         u64     cmask;
  80         int     weight;
  81 };
  82
  83 struct amd_nb {
  84         int nb_id;  /* NorthBridge id */
  85         int refcnt; /* reference count */
  86         struct perf_event *owners[X86_PMC_IDX_MAX];
  87         struct event_constraint event_constraints[X86_PMC_IDX_MAX];
  88 };
  89
  90 struct cpu_hw_events {
  91         struct perf_event       *events[X86_PMC_IDX_MAX]; /* in counter order */
  92         unsigned long           active_mask[BITS_TO_LONGS(X86_PMC_IDX_MAX)];
  93         unsigned long           interrupts;
  94         int                     enabled;
  95         struct debug_store      *ds;
  96
  97         int                     n_events;
  98         int                     n_added;
  99         int                     assign[X86_PMC_IDX_MAX]; /* event to counter assignment */
 100         u64                     tags[X86_PMC_IDX_MAX];
 101         struct perf_event       *event_list[X86_PMC_IDX_MAX]; /* in enabled order */
 102         struct amd_nb           *amd_nb;
 103 };
 104
 105 #define __EVENT_CONSTRAINT(c, n, m, w) {\
 106         { .idxmsk64 = (n) },            \
 107         .code = (c),                    \
 108         .cmask = (m),                   \
 109         .weight = (w),                  \
 110 }
 111
 112 #define EVENT_CONSTRAINT(c, n, m)       \
 113         __EVENT_CONSTRAINT(c, n, m, HWEIGHT(n))
 114
 115 #define INTEL_EVENT_CONSTRAINT(c, n)    \
 116         EVENT_CONSTRAINT(c, n, INTEL_ARCH_EVTSEL_MASK)
 117
 118 #define FIXED_EVENT_CONSTRAINT(c, n)    \
 119         EVENT_CONSTRAINT(c, (1ULL << (32+n)), INTEL_ARCH_FIXED_MASK)
 120
 121 #define EVENT_CONSTRAINT_END            \
 122         EVENT_CONSTRAINT(0, 0, 0)
 123
 124 #define for_each_event_constraint(e, c) \
 125         for ((e) = (c); (e)->cmask; (e)++)
 126
 127 /*
 128  * struct x86_pmu - generic x86 pmu
 129  */
 130 struct x86_pmu {
 131         const char      *name;
 132         int             version;
 133         int             (*handle_irq)(struct pt_regs *);
 134         void            (*disable_all)(void);
 135         void            (*enable_all)(void);
 136         void            (*enable)(struct hw_perf_event *, int);
 137         void            (*disable)(struct hw_perf_event *, int);
 138         unsigned        eventsel;
 139         unsigned        perfctr;
 140         u64             (*event_map)(int);
 141         u64             (*raw_event)(u64);
 142         int             max_events;
 143         int             num_events;
 144         int             num_events_fixed;
 145         int             event_bits;
 146         u64             event_mask;
 147         int             apic;
 148         u64             max_period;
 149         u64             intel_ctrl;
 150         void            (*enable_bts)(u64 config);
 151         void            (*disable_bts)(void);
 152
 153         struct event_constraint *
 154                         (*get_event_constraints)(struct cpu_hw_events *cpuc,
 155                                                  struct perf_event *event);
 156
 157         void            (*put_event_constraints)(struct cpu_hw_events *cpuc,
 158                                                  struct perf_event *event);
 159         struct event_constraint *event_constraints;
 160
 161         void            (*cpu_prepare)(int cpu);
 162         void            (*cpu_starting)(int cpu);
 163         void            (*cpu_dying)(int cpu);
 164         void            (*cpu_dead)(int cpu);
 165 };
 166
 167 static struct x86_pmu x86_pmu __read_mostly;
 168
 169 static DEFINE_PER_CPU(struct cpu_hw_events, cpu_hw_events) = {
 170         .enabled = 1,
 171 };
 172
 173 static int x86_perf_event_set_period(struct perf_event *event);
 174
 175 /*
 176  * Generalized hw caching related hw_event table, filled
 177  * in on a per model basis. A value of 0 means
 178  * 'not supported', -1 means 'hw_event makes no sense on
 179  * this CPU', any other value means the raw hw_event
 180  * ID.
 181  */
 182
 183 #define C(x) PERF_COUNT_HW_CACHE_##x
 184
 185 static u64 __read_mostly hw_cache_event_ids
 186                                 [PERF_COUNT_HW_CACHE_MAX]
 187                                 [PERF_COUNT_HW_CACHE_OP_MAX]
 188                                 [PERF_COUNT_HW_CACHE_RESULT_MAX];
 189
 190 /*
 191  * Propagate event elapsed time into the generic event.
 192  * Can only be executed on the CPU where the event is active.
 193  * Returns the delta events processed.
 194  */
 195 static u64
 196 x86_perf_event_update(struct perf_event *event,
 197                         struct hw_perf_event *hwc, int idx)
 198 {
 199         int shift = 64 - x86_pmu.event_bits;
 200         u64 prev_raw_count, new_raw_count;
 201         s64 delta;
 202
 203         if (idx == X86_PMC_IDX_FIXED_BTS)
 204                 return 0;
 205
 206         /*
 207          * Careful: an NMI might modify the previous event value.
 208          *
 209          * Our tactic to handle this is to first atomically read and
 210          * exchange a new raw count - then add that new-prev delta
 211          * count to the generic event atomically:
 212          */
 213 again:
 214         prev_raw_count = atomic64_read(&hwc->prev_count);
 215         rdmsrl(hwc->event_base + idx, new_raw_count);
 216
 217         if (atomic64_cmpxchg(&hwc->prev_count, prev_raw_count,
 218                                         new_raw_count) != prev_raw_count)
 219                 goto again;
 220
 221         /*
 222          * Now we have the new raw value and have updated the prev
 223          * timestamp already. We can now calculate the elapsed delta
 224          * (event-)time and add that to the generic event.
 225          *
 226          * Careful, not all hw sign-extends above the physical width
 227          * of the count.
 228          */
 229         delta = (new_raw_count << shift) - (prev_raw_count << shift);
 230         delta >>= shift;
 231
 232         atomic64_add(delta, &event->count);
 233         atomic64_sub(delta, &hwc->period_left);
 234
 235         return new_raw_count;
 236 }
 237
 238 static atomic_t active_events;
 239 static DEFINE_MUTEX(pmc_reserve_mutex);
 240
 241 static bool reserve_pmc_hardware(void)
 242 {
 243 #ifdef CONFIG_X86_LOCAL_APIC
 244         int i;
 245
 246         if (nmi_watchdog == NMI_LOCAL_APIC)
 247                 disable_lapic_nmi_watchdog();
 248
 249         for (i = 0; i < x86_pmu.num_events; i++) {
 250                 if (!reserve_perfctr_nmi(x86_pmu.perfctr + i))
 251                         goto perfctr_fail;
 252         }
 253
 254         for (i = 0; i < x86_pmu.num_events; i++) {
 255                 if (!reserve_evntsel_nmi(x86_pmu.eventsel + i))
 256                         goto eventsel_fail;
 257         }
 258 #endif
 259
 260         return true;
 261
 262 #ifdef CONFIG_X86_LOCAL_APIC
 263 eventsel_fail:
 264         for (i--; i >= 0; i--)
 265                 release_evntsel_nmi(x86_pmu.eventsel + i);
 266
 267         i = x86_pmu.num_events;
 268
 269 perfctr_fail:
 270         for (i--; i >= 0; i--)
 271                 release_perfctr_nmi(x86_pmu.perfctr + i);
 272
 273         if (nmi_watchdog == NMI_LOCAL_APIC)
 274                 enable_lapic_nmi_watchdog();
 275
 276         return false;
 277 #endif
 278 }
 279
 280 static void release_pmc_hardware(void)
 281 {
 282 #ifdef CONFIG_X86_LOCAL_APIC
 283         int i;
 284
 285         for (i = 0; i < x86_pmu.num_events; i++) {
 286                 release_perfctr_nmi(x86_pmu.perfctr + i);
 287                 release_evntsel_nmi(x86_pmu.eventsel + i);
 288         }
 289
 290         if (nmi_watchdog == NMI_LOCAL_APIC)
 291                 enable_lapic_nmi_watchdog();
 292 #endif
 293 }
 294
 295 static inline bool bts_available(void)
 296 {
 297         return x86_pmu.enable_bts != NULL;
 298 }
 299
 300 static void init_debug_store_on_cpu(int cpu)
 301 {
 302         struct debug_store *ds = per_cpu(cpu_hw_events, cpu).ds;
 303
 304         if (!ds)
 305                 return;
 306
 307         wrmsr_on_cpu(cpu, MSR_IA32_DS_AREA,
 308                      (u32)((u64)(unsigned long)ds),
 309                      (u32)((u64)(unsigned long)ds >> 32));
 310 }
 311
 312 static void fini_debug_store_on_cpu(int cpu)
 313 {
 314         if (!per_cpu(cpu_hw_events, cpu).ds)
 315                 return;
 316
 317         wrmsr_on_cpu(cpu, MSR_IA32_DS_AREA, 0, 0);
 318 }
 319
 320 static void release_bts_hardware(void)
 321 {
 322         int cpu;
 323
 324         if (!bts_available())
 325                 return;
 326
 327         get_online_cpus();
 328
 329         for_each_online_cpu(cpu)
 330                 fini_debug_store_on_cpu(cpu);
 331
 332         for_each_possible_cpu(cpu) {
 333                 struct debug_store *ds = per_cpu(cpu_hw_events, cpu).ds;
 334
 335                 if (!ds)
 336                         continue;
 337
 338                 per_cpu(cpu_hw_events, cpu).ds = NULL;
 339
 340                 kfree((void *)(unsigned long)ds->bts_buffer_base);
 341                 kfree(ds);
 342         }
 343
 344         put_online_cpus();
 345 }
 346
 347 static int reserve_bts_hardware(void)
 348 {
 349         int cpu, err = 0;
 350
 351         if (!bts_available())
 352                 return 0;
 353
 354         get_online_cpus();
 355
 356         for_each_possible_cpu(cpu) {
 357                 struct debug_store *ds;
 358                 void *buffer;
 359
 360                 err = -ENOMEM;
 361                 buffer = kzalloc(BTS_BUFFER_SIZE, GFP_KERNEL);
 362                 if (unlikely(!buffer))
 363                         break;
 364
 365                 ds = kzalloc(sizeof(*ds), GFP_KERNEL);
 366                 if (unlikely(!ds)) {
 367                         kfree(buffer);
 368                         break;
 369                 }
 370
 371                 ds->bts_buffer_base = (u64)(unsigned long)buffer;
 372                 ds->bts_index = ds->bts_buffer_base;
 373                 ds->bts_absolute_maximum =
 374                         ds->bts_buffer_base + BTS_BUFFER_SIZE;
 375                 ds->bts_interrupt_threshold =
 376                         ds->bts_absolute_maximum - BTS_OVFL_TH;
 377
 378                 per_cpu(cpu_hw_events, cpu).ds = ds;
 379                 err = 0;
 380         }
 381
 382         if (err)
 383                 release_bts_hardware();
 384         else {
 385                 for_each_online_cpu(cpu)
 386                         init_debug_store_on_cpu(cpu);
 387         }
 388
 389         put_online_cpus();
 390
 391         return err;
 392 }
 393
 394 static void hw_perf_event_destroy(struct perf_event *event)
 395 {
 396         if (atomic_dec_and_mutex_lock(&active_events, &pmc_reserve_mutex)) {
 397                 release_pmc_hardware();
 398                 release_bts_hardware();
 399                 mutex_unlock(&pmc_reserve_mutex);
 400         }
 401 }
 402
 403 static inline int x86_pmu_initialized(void)
 404 {
 405         return x86_pmu.handle_irq != NULL;
 406 }
 407
 408 static inline int
 409 set_ext_hw_attr(struct hw_perf_event *hwc, struct perf_event_attr *attr)
 410 {
 411         unsigned int cache_type, cache_op, cache_result;
 412         u64 config, val;
 413
 414         config = attr->config;
 415
 416         cache_type = (config >>  0) & 0xff;
 417         if (cache_type >= PERF_COUNT_HW_CACHE_MAX)
 418                 return -EINVAL;
 419
 420         cache_op = (config >>  8) & 0xff;
 421         if (cache_op >= PERF_COUNT_HW_CACHE_OP_MAX)
 422                 return -EINVAL;
 423
 424         cache_result = (config >> 16) & 0xff;
 425         if (cache_result >= PERF_COUNT_HW_CACHE_RESULT_MAX)
 426                 return -EINVAL;
 427
 428         val = hw_cache_event_ids[cache_type][cache_op][cache_result];
 429
 430         if (val == 0)
 431                 return -ENOENT;
 432
 433         if (val == -1)
 434                 return -EINVAL;
 435
 436         hwc->config |= val;
 437
 438         return 0;
 439 }
 440
 441 /*
 442  * Setup the hardware configuration for a given attr_type
 443  */
 444 static int __hw_perf_event_init(struct perf_event *event)
 445 {
 446         struct perf_event_attr *attr = &event->attr;
 447         struct hw_perf_event *hwc = &event->hw;
 448         u64 config;
 449         int err;
 450
 451         if (!x86_pmu_initialized())
 452                 return -ENODEV;
 453
 454         err = 0;
 455         if (!atomic_inc_not_zero(&active_events)) {
 456                 mutex_lock(&pmc_reserve_mutex);
 457                 if (atomic_read(&active_events) == 0) {
 458                         if (!reserve_pmc_hardware())
 459                                 err = -EBUSY;
 460                         else
 461                                 err = reserve_bts_hardware();
 462                 }
 463                 if (!err)
 464                         atomic_inc(&active_events);
 465                 mutex_unlock(&pmc_reserve_mutex);
 466         }
 467         if (err)
 468                 return err;
 469
 470         event->destroy = hw_perf_event_destroy;
 471
 472         /*
 473          * Generate PMC IRQs:
 474          * (keep 'enabled' bit clear for now)
 475          */
 476         hwc->config = ARCH_PERFMON_EVENTSEL_INT;
 477
 478         hwc->idx = -1;
 479         hwc->last_cpu = -1;
 480         hwc->last_tag = ~0ULL;
 481
 482         /*
 483          * Count user and OS events unless requested not to.
 484          */
 485         if (!attr->exclude_user)
 486                 hwc->config |= ARCH_PERFMON_EVENTSEL_USR;
 487         if (!attr->exclude_kernel)
 488                 hwc->config |= ARCH_PERFMON_EVENTSEL_OS;
 489
 490         if (!hwc->sample_period) {
 491                 hwc->sample_period = x86_pmu.max_period;
 492                 hwc->last_period = hwc->sample_period;
 493                 atomic64_set(&hwc->period_left, hwc->sample_period);
 494         } else {
 495                 /*
 496                  * If we have a PMU initialized but no APIC
 497                  * interrupts, we cannot sample hardware
 498                  * events (user-space has to fall back and
 499                  * sample via a hrtimer based software event):
 500                  */
 501                 if (!x86_pmu.apic)
 502                         return -EOPNOTSUPP;
 503         }
 504
 505         /*
 506          * Raw hw_event type provide the config in the hw_event structure
 507          */
 508         if (attr->type == PERF_TYPE_RAW) {
 509                 hwc->config |= x86_pmu.raw_event(attr->config);
 510                 if ((hwc->config & ARCH_PERFMON_EVENTSEL_ANY) &&
 511                     perf_paranoid_cpu() && !capable(CAP_SYS_ADMIN))
 512                         return -EACCES;
 513                 return 0;
 514         }
 515
 516         if (attr->type == PERF_TYPE_HW_CACHE)
 517                 return set_ext_hw_attr(hwc, attr);
 518
 519         if (attr->config >= x86_pmu.max_events)
 520                 return -EINVAL;
 521
 522         /*
 523          * The generic map:
 524          */
 525         config = x86_pmu.event_map(attr->config);
 526
 527         if (config == 0)
 528                 return -ENOENT;
 529
 530         if (config == -1LL)
 531                 return -EINVAL;
 532
 533         /*
 534          * Branch tracing:
 535          */
 536         if ((attr->config == PERF_COUNT_HW_BRANCH_INSTRUCTIONS) &&
 537             (hwc->sample_period == 1)) {
 538                 /* BTS is not supported by this architecture. */
 539                 if (!bts_available())
 540                         return -EOPNOTSUPP;
 541
 542                 /* BTS is currently only allowed for user-mode. */
 543                 if (hwc->config & ARCH_PERFMON_EVENTSEL_OS)
 544                         return -EOPNOTSUPP;
 545         }
 546
 547         hwc->config |= config;
 548
 549         return 0;
 550 }
 551
 552 static void x86_pmu_disable_all(void)
 553 {
 554         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
 555         int idx;
 556
 557         for (idx = 0; idx < x86_pmu.num_events; idx++) {
 558                 u64 val;
 559
 560                 if (!test_bit(idx, cpuc->active_mask))
 561                         continue;
 562                 rdmsrl(x86_pmu.eventsel + idx, val);
 563                 if (!(val & ARCH_PERFMON_EVENTSEL_ENABLE))
 564                         continue;
 565                 val &= ~ARCH_PERFMON_EVENTSEL_ENABLE;
 566                 wrmsrl(x86_pmu.eventsel + idx, val);
 567         }
 568 }
 569
 570 void hw_perf_disable(void)
 571 {
 572         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
 573
 574         if (!x86_pmu_initialized())
 575                 return;
 576
 577         if (!cpuc->enabled)
 578                 return;
 579
 580         cpuc->n_added = 0;
 581         cpuc->enabled = 0;
 582         barrier();
 583
 584         x86_pmu.disable_all();
 585 }
 586
 587 static void x86_pmu_enable_all(void)
 588 {
 589         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
 590         int idx;
 591
 592         for (idx = 0; idx < x86_pmu.num_events; idx++) {
 593                 struct perf_event *event = cpuc->events[idx];
 594                 u64 val;
 595
 596                 if (!test_bit(idx, cpuc->active_mask))
 597                         continue;
 598
 599                 val = event->hw.config;
 600                 val |= ARCH_PERFMON_EVENTSEL_ENABLE;
 601                 wrmsrl(x86_pmu.eventsel + idx, val);
 602         }
 603 }
 604
 605 static const struct pmu pmu;
 606
 607 static inline int is_x86_event(struct perf_event *event)
 608 {
 609         return event->pmu == &pmu;
 610 }
 611
 612 static int x86_schedule_events(struct cpu_hw_events *cpuc, int n, int *assign)
 613 {
 614         struct event_constraint *c, *constraints[X86_PMC_IDX_MAX];
 615         unsigned long used_mask[BITS_TO_LONGS(X86_PMC_IDX_MAX)];
 616         int i, j, w, wmax, num = 0;
 617         struct hw_perf_event *hwc;
 618
 619         bitmap_zero(used_mask, X86_PMC_IDX_MAX);
 620
 621         for (i = 0; i < n; i++) {
 622                 c = x86_pmu.get_event_constraints(cpuc, cpuc->event_list[i]);
 623                 constraints[i] = c;
 624         }
 625
 626         /*
 627          * fastpath, try to reuse previous register
 628          */
 629         for (i = 0; i < n; i++) {
 630                 hwc = &cpuc->event_list[i]->hw;
 631                 c = constraints[i];
 632
 633                 /* never assigned */
 634                 if (hwc->idx == -1)
 635                         break;
 636
 637                 /* constraint still honored */
 638                 if (!test_bit(hwc->idx, c->idxmsk))
 639                         break;
 640
 641                 /* not already used */
 642                 if (test_bit(hwc->idx, used_mask))
 643                         break;
 644
 645                 set_bit(hwc->idx, used_mask);
 646                 if (assign)
 647                         assign[i] = hwc->idx;
 648         }
 649         if (i == n)
 650                 goto done;
 651
 652         /*
 653          * begin slow path
 654          */
 655
 656         bitmap_zero(used_mask, X86_PMC_IDX_MAX);
 657
 658         /*
 659          * weight = number of possible counters
 660          *
 661          * 1    = most constrained, only works on one counter
 662          * wmax = least constrained, works on any counter
 663          *
 664          * assign events to counters starting with most
 665          * constrained events.
 666          */
 667         wmax = x86_pmu.num_events;
 668
 669         /*
 670          * when fixed event counters are present,
 671          * wmax is incremented by 1 to account
 672          * for one more choice
 673          */
 674         if (x86_pmu.num_events_fixed)
 675                 wmax++;
 676
 677         for (w = 1, num = n; num && w <= wmax; w++) {
 678                 /* for each event */
 679                 for (i = 0; num && i < n; i++) {
 680                         c = constraints[i];
 681                         hwc = &cpuc->event_list[i]->hw;
 682
 683                         if (c->weight != w)
 684                                 continue;
 685
 686                         for_each_set_bit(j, c->idxmsk, X86_PMC_IDX_MAX) {
 687                                 if (!test_bit(j, used_mask))
 688                                         break;
 689                         }
 690
 691                         if (j == X86_PMC_IDX_MAX)
 692                                 break;
 693
 694                         set_bit(j, used_mask);
 695
 696                         if (assign)
 697                                 assign[i] = j;
 698                         num--;
 699                 }
 700         }
 701 done:
 702         /*
 703          * scheduling failed or is just a simulation,
 704          * free resources if necessary
 705          */
 706         if (!assign || num) {
 707                 for (i = 0; i < n; i++) {
 708                         if (x86_pmu.put_event_constraints)
 709                                 x86_pmu.put_event_constraints(cpuc, cpuc->event_list[i]);
 710                 }
 711         }
 712         return num ? -ENOSPC : 0;
 713 }
 714
 715 /*
 716  * dogrp: true if must collect siblings events (group)
 717  * returns total number of events and error code
 718  */
 719 static int collect_events(struct cpu_hw_events *cpuc, struct perf_event *leader, bool dogrp)
 720 {
 721         struct perf_event *event;
 722         int n, max_count;
 723
 724         max_count = x86_pmu.num_events + x86_pmu.num_events_fixed;
 725
 726         /* current number of events already accepted */
 727         n = cpuc->n_events;
 728
 729         if (is_x86_event(leader)) {
 730                 if (n >= max_count)
 731                         return -ENOSPC;
 732                 cpuc->event_list[n] = leader;
 733                 n++;
 734         }
 735         if (!dogrp)
 736                 return n;
 737
 738         list_for_each_entry(event, &leader->sibling_list, group_entry) {
 739                 if (!is_x86_event(event) ||
 740                     event->state <= PERF_EVENT_STATE_OFF)
 741                         continue;
 742
 743                 if (n >= max_count)
 744                         return -ENOSPC;
 745
 746                 cpuc->event_list[n] = event;
 747                 n++;
 748         }
 749         return n;
 750 }
 751
 752 static inline void x86_assign_hw_event(struct perf_event *event,
 753                                 struct cpu_hw_events *cpuc, int i)
 754 {
 755         struct hw_perf_event *hwc = &event->hw;
 756
 757         hwc->idx = cpuc->assign[i];
 758         hwc->last_cpu = smp_processor_id();
 759         hwc->last_tag = ++cpuc->tags[i];
 760
 761         if (hwc->idx == X86_PMC_IDX_FIXED_BTS) {
 762                 hwc->config_base = 0;
 763                 hwc->event_base = 0;
 764         } else if (hwc->idx >= X86_PMC_IDX_FIXED) {
 765                 hwc->config_base = MSR_ARCH_PERFMON_FIXED_CTR_CTRL;
 766                 /*
 767                  * We set it so that event_base + idx in wrmsr/rdmsr maps to
 768                  * MSR_ARCH_PERFMON_FIXED_CTR0 ... CTR2:
 769                  */
 770                 hwc->event_base =
 771                         MSR_ARCH_PERFMON_FIXED_CTR0 - X86_PMC_IDX_FIXED;
 772         } else {
 773                 hwc->config_base = x86_pmu.eventsel;
 774                 hwc->event_base  = x86_pmu.perfctr;
 775         }
 776 }
 777
 778 static inline int match_prev_assignment(struct hw_perf_event *hwc,
 779                                         struct cpu_hw_events *cpuc,
 780                                         int i)
 781 {
 782         return hwc->idx == cpuc->assign[i] &&
 783                 hwc->last_cpu == smp_processor_id() &&
 784                 hwc->last_tag == cpuc->tags[i];
 785 }
 786
 787 static void x86_pmu_stop(struct perf_event *event);
 788
 789 void hw_perf_enable(void)
 790 {
 791         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
 792         struct perf_event *event;
 793         struct hw_perf_event *hwc;
 794         int i;
 795
 796         if (!x86_pmu_initialized())
 797                 return;
 798
 799         if (cpuc->enabled)
 800                 return;
 801
 802         if (cpuc->n_added) {
 803                 /*
 804                  * apply assignment obtained either from
 805                  * hw_perf_group_sched_in() or x86_pmu_enable()
 806                  *
 807                  * step1: save events moving to new counters
 808                  * step2: reprogram moved events into new counters
 809                  */
 810                 for (i = 0; i < cpuc->n_events; i++) {
 811
 812                         event = cpuc->event_list[i];
 813                         hwc = &event->hw;
 814
 815                         /*
 816                          * we can avoid reprogramming counter if:
 817                          * - assigned same counter as last time
 818                          * - running on same CPU as last time
 819                          * - no other event has used the counter since
 820                          */
 821                         if (hwc->idx == -1 ||
 822                             match_prev_assignment(hwc, cpuc, i))
 823                                 continue;
 824
 825                         x86_pmu_stop(event);
 826
 827                         hwc->idx = -1;
 828                 }
 829
 830                 for (i = 0; i < cpuc->n_events; i++) {
 831
 832                         event = cpuc->event_list[i];
 833                         hwc = &event->hw;
 834
 835                         if (hwc->idx == -1) {
 836                                 x86_assign_hw_event(event, cpuc, i);
 837                                 x86_perf_event_set_period(event);
 838                         }
 839                         /*
 840                          * need to mark as active because x86_pmu_disable()
 841                          * clear active_mask and events[] yet it preserves
 842                          * idx
 843                          */
 844                         set_bit(hwc->idx, cpuc->active_mask);
 845                         cpuc->events[hwc->idx] = event;
 846
 847                         x86_pmu.enable(hwc, hwc->idx);
 848                         perf_event_update_userpage(event);
 849                 }
 850                 cpuc->n_added = 0;
 851                 perf_events_lapic_init();
 852         }
 853
 854         cpuc->enabled = 1;
 855         barrier();
 856
 857         x86_pmu.enable_all();
 858 }
 859
 860 static inline void __x86_pmu_enable_event(struct hw_perf_event *hwc, int idx)
 861 {
 862         (void)checking_wrmsrl(hwc->config_base + idx,
 863                               hwc->config | ARCH_PERFMON_EVENTSEL_ENABLE);
 864 }
 865
 866 static inline void x86_pmu_disable_event(struct hw_perf_event *hwc, int idx)
 867 {
 868         (void)checking_wrmsrl(hwc->config_base + idx, hwc->config);
 869 }
 870
 871 static DEFINE_PER_CPU(u64 [X86_PMC_IDX_MAX], pmc_prev_left);
 872
 873 /*
 874  * Set the next IRQ period, based on the hwc->period_left value.
 875  * To be called with the event disabled in hw:
 876  */
 877 static int
 878 x86_perf_event_set_period(struct perf_event *event)
 879 {
 880         struct hw_perf_event *hwc = &event->hw;
 881         s64 left = atomic64_read(&hwc->period_left);
 882         s64 period = hwc->sample_period;
 883         int err, ret = 0, idx = hwc->idx;
 884
 885         if (idx == X86_PMC_IDX_FIXED_BTS)
 886                 return 0;
 887
 888         /*
 889          * If we are way outside a reasonable range then just skip forward:
 890          */
 891         if (unlikely(left <= -period)) {
 892                 left = period;
 893                 atomic64_set(&hwc->period_left, left);
 894                 hwc->last_period = period;
 895                 ret = 1;
 896         }
 897
 898         if (unlikely(left <= 0)) {
 899                 left += period;
 900                 atomic64_set(&hwc->period_left, left);
 901                 hwc->last_period = period;
 902                 ret = 1;
 903         }
 904         /*
 905          * Quirk: certain CPUs dont like it if just 1 hw_event is left:
 906          */
 907         if (unlikely(left < 2))
 908                 left = 2;
 909
 910         if (left > x86_pmu.max_period)
 911                 left = x86_pmu.max_period;
 912
 913         per_cpu(pmc_prev_left[idx], smp_processor_id()) = left;
 914
 915         /*
 916          * The hw event starts counting from this event offset,
 917          * mark it to be able to extra future deltas:
 918          */
 919         atomic64_set(&hwc->prev_count, (u64)-left);
 920
 921         err = checking_wrmsrl(hwc->event_base + idx,
 922                              (u64)(-left) & x86_pmu.event_mask);
 923
 924         perf_event_update_userpage(event);
 925
 926         return ret;
 927 }
 928
 929 static void x86_pmu_enable_event(struct hw_perf_event *hwc, int idx)
 930 {
 931         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
 932         if (cpuc->enabled)
 933                 __x86_pmu_enable_event(hwc, idx);
 934 }
 935
 936 /*
 937  * activate a single event
 938  *
 939  * The event is added to the group of enabled events
 940  * but only if it can be scehduled with existing events.
 941  *
 942  * Called with PMU disabled. If successful and return value 1,
 943  * then guaranteed to call perf_enable() and hw_perf_enable()
 944  */
 945 static int x86_pmu_enable(struct perf_event *event)
 946 {
 947         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
 948         struct hw_perf_event *hwc;
 949         int assign[X86_PMC_IDX_MAX];
 950         int n, n0, ret;
 951
 952         hwc = &event->hw;
 953
 954         n0 = cpuc->n_events;
 955         n = collect_events(cpuc, event, false);
 956         if (n < 0)
 957                 return n;
 958
 959         ret = x86_schedule_events(cpuc, n, assign);
 960         if (ret)
 961                 return ret;
 962         /*
 963          * copy new assignment, now we know it is possible
 964          * will be used by hw_perf_enable()
 965          */
 966         memcpy(cpuc->assign, assign, n*sizeof(int));
 967
 968         cpuc->n_events = n;
 969         cpuc->n_added  = n - n0;
 970
 971         return 0;
 972 }
 973
 974 static int x86_pmu_start(struct perf_event *event)
 975 {
 976         struct hw_perf_event *hwc = &event->hw;
 977
 978         if (hwc->idx == -1)
 979                 return -EAGAIN;
 980
 981         x86_perf_event_set_period(event);
 982         x86_pmu.enable(hwc, hwc->idx);
 983
 984         return 0;
 985 }
 986
 987 static void x86_pmu_unthrottle(struct perf_event *event)
 988 {
 989         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
 990         struct hw_perf_event *hwc = &event->hw;
 991
 992         if (WARN_ON_ONCE(hwc->idx >= X86_PMC_IDX_MAX ||
 993                                 cpuc->events[hwc->idx] != event))
 994                 return;
 995
 996         x86_pmu.enable(hwc, hwc->idx);
 997 }
 998
 999 void perf_event_print_debug(void)
1000 {
1001         u64 ctrl, status, overflow, pmc_ctrl, pmc_count, prev_left, fixed;
1002         struct cpu_hw_events *cpuc;
1003         unsigned long flags;
1004         int cpu, idx;
1005
1006         if (!x86_pmu.num_events)
1007                 return;
1008
1009         local_irq_save(flags);
1010
1011         cpu = smp_processor_id();
1012         cpuc = &per_cpu(cpu_hw_events, cpu);
1013
1014         if (x86_pmu.version >= 2) {
1015                 rdmsrl(MSR_CORE_PERF_GLOBAL_CTRL, ctrl);
1016                 rdmsrl(MSR_CORE_PERF_GLOBAL_STATUS, status);
1017                 rdmsrl(MSR_CORE_PERF_GLOBAL_OVF_CTRL, overflow);
1018                 rdmsrl(MSR_ARCH_PERFMON_FIXED_CTR_CTRL, fixed);
1019
1020                 pr_info("\n");
1021                 pr_info("CPU#%d: ctrl:       %016llx\n", cpu, ctrl);
1022                 pr_info("CPU#%d: status:     %016llx\n", cpu, status);
1023                 pr_info("CPU#%d: overflow:   %016llx\n", cpu, overflow);
1024                 pr_info("CPU#%d: fixed:      %016llx\n", cpu, fixed);
1025         }
1026         pr_info("CPU#%d: active:       %016llx\n", cpu, *(u64 *)cpuc->active_mask);
1027
1028         for (idx = 0; idx < x86_pmu.num_events; idx++) {
1029                 rdmsrl(x86_pmu.eventsel + idx, pmc_ctrl);
1030                 rdmsrl(x86_pmu.perfctr  + idx, pmc_count);
1031
1032                 prev_left = per_cpu(pmc_prev_left[idx], cpu);
1033
1034                 pr_info("CPU#%d:   gen-PMC%d ctrl:  %016llx\n",
1035                         cpu, idx, pmc_ctrl);
1036                 pr_info("CPU#%d:   gen-PMC%d count: %016llx\n",
1037                         cpu, idx, pmc_count);
1038                 pr_info("CPU#%d:   gen-PMC%d left:  %016llx\n",
1039                         cpu, idx, prev_left);
1040         }
1041         for (idx = 0; idx < x86_pmu.num_events_fixed; idx++) {
1042                 rdmsrl(MSR_ARCH_PERFMON_FIXED_CTR0 + idx, pmc_count);
1043
1044                 pr_info("CPU#%d: fixed-PMC%d count: %016llx\n",
1045                         cpu, idx, pmc_count);
1046         }
1047         local_irq_restore(flags);
1048 }
1049
1050 static void x86_pmu_stop(struct perf_event *event)
1051 {
1052         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
1053         struct hw_perf_event *hwc = &event->hw;
1054         int idx = hwc->idx;
1055
1056         /*
1057          * Must be done before we disable, otherwise the nmi handler
1058          * could reenable again:
1059          */
1060         clear_bit(idx, cpuc->active_mask);
1061         x86_pmu.disable(hwc, idx);
1062
1063         /*
1064          * Drain the remaining delta count out of a event
1065          * that we are disabling:
1066          */
1067         x86_perf_event_update(event, hwc, idx);
1068
1069         cpuc->events[idx] = NULL;
1070 }
1071
1072 static void x86_pmu_disable(struct perf_event *event)
1073 {
1074         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
1075         int i;
1076
1077         x86_pmu_stop(event);
1078
1079         for (i = 0; i < cpuc->n_events; i++) {
1080                 if (event == cpuc->event_list[i]) {
1081
1082                         if (x86_pmu.put_event_constraints)
1083                                 x86_pmu.put_event_constraints(cpuc, event);
1084
1085                         while (++i < cpuc->n_events)
1086                                 cpuc->event_list[i-1] = cpuc->event_list[i];
1087
1088                         --cpuc->n_events;
1089                         break;
1090                 }
1091         }
1092         perf_event_update_userpage(event);
1093 }
1094
1095 static int x86_pmu_handle_irq(struct pt_regs *regs)
1096 {
1097         struct perf_sample_data data;
1098         struct cpu_hw_events *cpuc;
1099         struct perf_event *event;
1100         struct hw_perf_event *hwc;
1101         int idx, handled = 0;
1102         u64 val;
1103
1104         perf_sample_data_init(&data, 0);
1105
1106         cpuc = &__get_cpu_var(cpu_hw_events);
1107
1108         for (idx = 0; idx < x86_pmu.num_events; idx++) {
1109                 if (!test_bit(idx, cpuc->active_mask))
1110                         continue;
1111
1112                 event = cpuc->events[idx];
1113                 hwc = &event->hw;
1114
1115                 val = x86_perf_event_update(event, hwc, idx);
1116                 if (val & (1ULL << (x86_pmu.event_bits - 1)))
1117                         continue;
1118
1119                 /*
1120                  * event overflow
1121                  */
1122                 handled         = 1;
1123                 data.period     = event->hw.last_period;
1124
1125                 if (!x86_perf_event_set_period(event))
1126                         continue;
1127
1128                 if (perf_event_overflow(event, 1, &data, regs))
1129                         x86_pmu.disable(hwc, idx);
1130         }
1131
1132         if (handled)
1133                 inc_irq_stat(apic_perf_irqs);
1134
1135         return handled;
1136 }
1137
1138 void smp_perf_pending_interrupt(struct pt_regs *regs)
1139 {
1140         irq_enter();
1141         ack_APIC_irq();
1142         inc_irq_stat(apic_pending_irqs);
1143         perf_event_do_pending();
1144         irq_exit();
1145 }
1146
1147 void set_perf_event_pending(void)
1148 {
1149 #ifdef CONFIG_X86_LOCAL_APIC
1150         if (!x86_pmu.apic || !x86_pmu_initialized())
1151                 return;
1152
1153         apic->send_IPI_self(LOCAL_PENDING_VECTOR);
1154 #endif
1155 }
1156
1157 void perf_events_lapic_init(void)
1158 {
1159 #ifdef CONFIG_X86_LOCAL_APIC
1160         if (!x86_pmu.apic || !x86_pmu_initialized())
1161                 return;
1162
1163         /*
1164          * Always use NMI for PMU
1165          */
1166         apic_write(APIC_LVTPC, APIC_DM_NMI);
1167 #endif
1168 }
1169
1170 static int __kprobes
1171 perf_event_nmi_handler(struct notifier_block *self,
1172                          unsigned long cmd, void *__args)
1173 {
1174         struct die_args *args = __args;
1175         struct pt_regs *regs;
1176
1177         if (!atomic_read(&active_events))
1178                 return NOTIFY_DONE;
1179
1180         switch (cmd) {
1181         case DIE_NMI:
1182         case DIE_NMI_IPI:
1183                 break;
1184
1185         default:
1186                 return NOTIFY_DONE;
1187         }
1188
1189         regs = args->regs;
1190
1191 #ifdef CONFIG_X86_LOCAL_APIC
1192         apic_write(APIC_LVTPC, APIC_DM_NMI);
1193 #endif
1194         /*
1195          * Can't rely on the handled return value to say it was our NMI, two
1196          * events could trigger 'simultaneously' raising two back-to-back NMIs.
1197          *
1198          * If the first NMI handles both, the latter will be empty and daze
1199          * the CPU.
1200          */
1201         x86_pmu.handle_irq(regs);
1202
1203         return NOTIFY_STOP;
1204 }
1205
1206 static __read_mostly struct notifier_block perf_event_nmi_notifier = {
1207         .notifier_call          = perf_event_nmi_handler,
1208         .next                   = NULL,
1209         .priority               = 1
1210 };
1211
1212 static struct event_constraint unconstrained;
1213 static struct event_constraint emptyconstraint;
1214
1215 static struct event_constraint *
1216 x86_get_event_constraints(struct cpu_hw_events *cpuc, struct perf_event *event)
1217 {
1218         struct event_constraint *c;
1219
1220         if (x86_pmu.event_constraints) {
1221                 for_each_event_constraint(c, x86_pmu.event_constraints) {
1222                         if ((event->hw.config & c->cmask) == c->code)
1223                                 return c;
1224                 }
1225         }
1226
1227         return &unconstrained;
1228 }
1229
1230 static int x86_event_sched_in(struct perf_event *event,
1231                           struct perf_cpu_context *cpuctx)
1232 {
1233         int ret = 0;
1234
1235         event->state = PERF_EVENT_STATE_ACTIVE;
1236         event->oncpu = smp_processor_id();
1237         event->tstamp_running += event->ctx->time - event->tstamp_stopped;
1238
1239         if (!is_x86_event(event))
1240                 ret = event->pmu->enable(event);
1241
1242         if (!ret && !is_software_event(event))
1243                 cpuctx->active_oncpu++;
1244
1245         if (!ret && event->attr.exclusive)
1246                 cpuctx->exclusive = 1;
1247
1248         return ret;
1249 }
1250
1251 static void x86_event_sched_out(struct perf_event *event,
1252                             struct perf_cpu_context *cpuctx)
1253 {
1254         event->state = PERF_EVENT_STATE_INACTIVE;
1255         event->oncpu = -1;
1256
1257         if (!is_x86_event(event))
1258                 event->pmu->disable(event);
1259
1260         event->tstamp_running -= event->ctx->time - event->tstamp_stopped;
1261
1262         if (!is_software_event(event))
1263                 cpuctx->active_oncpu--;
1264
1265         if (event->attr.exclusive || !cpuctx->active_oncpu)
1266                 cpuctx->exclusive = 0;
1267 }
1268
1269 /*
1270  * Called to enable a whole group of events.
1271  * Returns 1 if the group was enabled, or -EAGAIN if it could not be.
1272  * Assumes the caller has disabled interrupts and has
1273  * frozen the PMU with hw_perf_save_disable.
1274  *
1275  * called with PMU disabled. If successful and return value 1,
1276  * then guaranteed to call perf_enable() and hw_perf_enable()
1277  */
1278 int hw_perf_group_sched_in(struct perf_event *leader,
1279                struct perf_cpu_context *cpuctx,
1280                struct perf_event_context *ctx)
1281 {
1282         struct cpu_hw_events *cpuc = &__get_cpu_var(cpu_hw_events);
1283         struct perf_event *sub;
1284         int assign[X86_PMC_IDX_MAX];
1285         int n0, n1, ret;
1286
1287         /* n0 = total number of events */
1288         n0 = collect_events(cpuc, leader, true);
1289         if (n0 < 0)
1290                 return n0;
1291
1292         ret = x86_schedule_events(cpuc, n0, assign);
1293         if (ret)
1294                 return ret;
1295
1296         ret = x86_event_sched_in(leader, cpuctx);
1297         if (ret)
1298                 return ret;
1299
1300         n1 = 1;
1301         list_for_each_entry(sub, &leader->sibling_list, group_entry) {
1302                 if (sub->state > PERF_EVENT_STATE_OFF) {
1303                         ret = x86_event_sched_in(sub, cpuctx);
1304                         if (ret)
1305                                 goto undo;
1306                         ++n1;
1307                 }
1308         }
1309         /*
1310          * copy new assignment, now we know it is possible
1311          * will be used by hw_perf_enable()
1312          */
1313         memcpy(cpuc->assign, assign, n0*sizeof(int));
1314
1315         cpuc->n_events  = n0;
1316         cpuc->n_added   = n1;
1317         ctx->nr_active += n1;
1318
1319         /*
1320          * 1 means successful and events are active
1321          * This is not quite true because we defer
1322          * actual activation until hw_perf_enable() but
1323          * this way we* ensure caller won't try to enable
1324          * individual events
1325          */
1326         return 1;
1327 undo:
1328         x86_event_sched_out(leader, cpuctx);
1329         n0  = 1;
1330         list_for_each_entry(sub, &leader->sibling_list, group_entry) {
1331                 if (sub->state == PERF_EVENT_STATE_ACTIVE) {
1332                         x86_event_sched_out(sub, cpuctx);
1333                         if (++n0 == n1)
1334                                 break;
1335                 }
1336         }
1337         return ret;
1338 }
1339
1340 #include "perf_event_amd.c"
1341 #include "perf_event_p6.c"
1342 #include "perf_event_intel.c"
1343
1344 static int __cpuinit
1345 x86_pmu_notifier(struct notifier_block *self, unsigned long action, void *hcpu)
1346 {
1347         unsigned int cpu = (long)hcpu;
1348
1349         switch (action & ~CPU_TASKS_FROZEN) {
1350         case CPU_UP_PREPARE:
1351                 if (x86_pmu.cpu_prepare)
1352                         x86_pmu.cpu_prepare(cpu);
1353                 break;
1354
1355         case CPU_STARTING:
1356                 if (x86_pmu.cpu_starting)
1357                         x86_pmu.cpu_starting(cpu);
1358                 break;
1359
1360         case CPU_DYING:
1361                 if (x86_pmu.cpu_dying)
1362                         x86_pmu.cpu_dying(cpu);
1363                 break;
1364
1365         case CPU_DEAD:
1366                 if (x86_pmu.cpu_dead)
1367                         x86_pmu.cpu_dead(cpu);
1368                 break;
1369
1370         default:
1371                 break;
1372         }
1373
1374         return NOTIFY_OK;
1375 }
1376
1377 static void __init pmu_check_apic(void)
1378 {
1379         if (cpu_has_apic)
1380                 return;
1381
1382         x86_pmu.apic = 0;
1383         pr_info("no APIC, boot with the \"lapic\" boot parameter to force-enable it.\n");
1384         pr_info("no hardware sampling interrupt available.\n");
1385 }
1386
1387 void __init init_hw_perf_events(void)
1388 {
1389         struct event_constraint *c;
1390         int err;
1391
1392         pr_info("Performance Events: ");
1393
1394         switch (boot_cpu_data.x86_vendor) {
1395         case X86_VENDOR_INTEL:
1396                 err = intel_pmu_init();
1397                 break;
1398         case X86_VENDOR_AMD:
1399                 err = amd_pmu_init();
1400                 break;
1401         default:
1402                 return;
1403         }
1404         if (err != 0) {
1405                 pr_cont("no PMU driver, software events only.\n");
1406                 return;
1407         }
1408
1409         pmu_check_apic();
1410
1411         pr_cont("%s PMU driver.\n", x86_pmu.name);
1412
1413         if (x86_pmu.num_events > X86_PMC_MAX_GENERIC) {
1414                 WARN(1, KERN_ERR "hw perf events %d > max(%d), clipping!",
1415                      x86_pmu.num_events, X86_PMC_MAX_GENERIC);
1416                 x86_pmu.num_events = X86_PMC_MAX_GENERIC;
1417         }
1418         perf_event_mask = (1 << x86_pmu.num_events) - 1;
1419         perf_max_events = x86_pmu.num_events;
1420
1421         if (x86_pmu.num_events_fixed > X86_PMC_MAX_FIXED) {
1422                 WARN(1, KERN_ERR "hw perf events fixed %d > max(%d), clipping!",
1423                      x86_pmu.num_events_fixed, X86_PMC_MAX_FIXED);
1424                 x86_pmu.num_events_fixed = X86_PMC_MAX_FIXED;
1425         }
1426
1427         perf_event_mask |=
1428                 ((1LL << x86_pmu.num_events_fixed)-1) << X86_PMC_IDX_FIXED;
1429         x86_pmu.intel_ctrl = perf_event_mask;
1430
1431         perf_events_lapic_init();
1432         register_die_notifier(&perf_event_nmi_notifier);
1433
1434         unconstrained = (struct event_constraint)
1435                 __EVENT_CONSTRAINT(0, (1ULL << x86_pmu.num_events) - 1,
1436                                    0, x86_pmu.num_events);
1437
1438         if (x86_pmu.event_constraints) {
1439                 for_each_event_constraint(c, x86_pmu.event_constraints) {
1440                         if (c->cmask != INTEL_ARCH_FIXED_MASK)
1441                                 continue;
1442
1443                         c->idxmsk64 |= (1ULL << x86_pmu.num_events) - 1;
1444                         c->weight += x86_pmu.num_events;
1445                 }
1446         }
1447
1448         pr_info("... version:                %d\n",     x86_pmu.version);
1449         pr_info("... bit width:              %d\n",     x86_pmu.event_bits);
1450         pr_info("... generic registers:      %d\n",     x86_pmu.num_events);
1451         pr_info("... value mask:             %016Lx\n", x86_pmu.event_mask);
1452         pr_info("... max period:             %016Lx\n", x86_pmu.max_period);
1453         pr_info("... fixed-purpose events:   %d\n",     x86_pmu.num_events_fixed);
1454         pr_info("... event mask:             %016Lx\n", perf_event_mask);
1455
1456         perf_cpu_notifier(x86_pmu_notifier);
1457 }
1458
1459 static inline void x86_pmu_read(struct perf_event *event)
1460 {
1461         x86_perf_event_update(event, &event->hw, event->hw.idx);
1462 }
1463
1464 static const struct pmu pmu = {
1465         .enable         = x86_pmu_enable,
1466         .disable        = x86_pmu_disable,
1467         .start          = x86_pmu_start,
1468         .stop           = x86_pmu_stop,
1469         .read           = x86_pmu_read,
1470         .unthrottle     = x86_pmu_unthrottle,
1471 };
1472
1473 /*
1474  * validate a single event group
1475  *
1476  * validation include:
1477  *      - check events are compatible which each other
1478  *      - events do not compete for the same counter
1479  *      - number of events <= number of counters
1480  *
1481  * validation ensures the group can be loaded onto the
1482  * PMU if it was the only group available.
1483  */
1484 static int validate_group(struct perf_event *event)
1485 {
1486         struct perf_event *leader = event->group_leader;
1487         struct cpu_hw_events *fake_cpuc;
1488         int ret, n;
1489
1490         ret = -ENOMEM;
1491         fake_cpuc = kmalloc(sizeof(*fake_cpuc), GFP_KERNEL | __GFP_ZERO);
1492         if (!fake_cpuc)
1493                 goto out;
1494
1495         /*
1496          * the event is not yet connected with its
1497          * siblings therefore we must first collect
1498          * existing siblings, then add the new event
1499          * before we can simulate the scheduling
1500          */
1501         ret = -ENOSPC;
1502         n = collect_events(fake_cpuc, leader, true);
1503         if (n < 0)
1504                 goto out_free;
1505
1506         fake_cpuc->n_events = n;
1507         n = collect_events(fake_cpuc, event, false);
1508         if (n < 0)
1509                 goto out_free;
1510
1511         fake_cpuc->n_events = n;
1512
1513         ret = x86_schedule_events(fake_cpuc, n, NULL);
1514
1515 out_free:
1516         kfree(fake_cpuc);
1517 out:
1518         return ret;
1519 }
1520
1521 const struct pmu *hw_perf_event_init(struct perf_event *event)
1522 {
1523         const struct pmu *tmp;
1524         int err;
1525
1526         err = __hw_perf_event_init(event);
1527         if (!err) {
1528                 /*
1529                  * we temporarily connect event to its pmu
1530                  * such that validate_group() can classify
1531                  * it as an x86 event using is_x86_event()
1532                  */
1533                 tmp = event->pmu;
1534                 event->pmu = &pmu;
1535
1536                 if (event->group_leader != event)
1537                         err = validate_group(event);
1538
1539                 event->pmu = tmp;
1540         }
1541         if (err) {
1542                 if (event->destroy)
1543                         event->destroy(event);
1544                 return ERR_PTR(err);
1545         }
1546
1547         return &pmu;
1548 }
1549
1550 /*
1551  * callchain support
1552  */
1553
1554 static inline
1555 void callchain_store(struct perf_callchain_entry *entry, u64 ip)
1556 {
1557         if (entry->nr < PERF_MAX_STACK_DEPTH)
1558                 entry->ip[entry->nr++] = ip;
1559 }
1560
1561 static DEFINE_PER_CPU(struct perf_callchain_entry, pmc_irq_entry);
1562 static DEFINE_PER_CPU(struct perf_callchain_entry, pmc_nmi_entry);
1563
1564
1565 static void
1566 backtrace_warning_symbol(void *data, char *msg, unsigned long symbol)
1567 {
1568         /* Ignore warnings */
1569 }
1570
1571 static void backtrace_warning(void *data, char *msg)
1572 {
1573         /* Ignore warnings */
1574 }
1575
1576 static int backtrace_stack(void *data, char *name)
1577 {
1578         return 0;
1579 }
1580
1581 static void backtrace_address(void *data, unsigned long addr, int reliable)
1582 {
1583         struct perf_callchain_entry *entry = data;
1584
1585         if (reliable)
1586                 callchain_store(entry, addr);
1587 }
1588
1589 static const struct stacktrace_ops backtrace_ops = {
1590         .warning                = backtrace_warning,
1591         .warning_symbol         = backtrace_warning_symbol,
1592         .stack                  = backtrace_stack,
1593         .address                = backtrace_address,
1594         .walk_stack             = print_context_stack_bp,
1595 };
1596
1597 #include "../dumpstack.h"
1598
1599 static void
1600 perf_callchain_kernel(struct pt_regs *regs, struct perf_callchain_entry *entry)
1601 {
1602         callchain_store(entry, PERF_CONTEXT_KERNEL);
1603         callchain_store(entry, regs->ip);
1604
1605         dump_trace(NULL, regs, NULL, regs->bp, &backtrace_ops, entry);
1606 }
1607
1608 /*
1609  * best effort, GUP based copy_from_user() that assumes IRQ or NMI context
1610  */
1611 static unsigned long
1612 copy_from_user_nmi(void *to, const void __user *from, unsigned long n)
1613 {
1614         unsigned long offset, addr = (unsigned long)from;
1615         int type = in_nmi() ? KM_NMI : KM_IRQ0;
1616         unsigned long size, len = 0;
1617         struct page *page;
1618         void *map;
1619         int ret;
1620
1621         do {
1622                 ret = __get_user_pages_fast(addr, 1, 0, &page);
1623                 if (!ret)
1624                         break;
1625
1626                 offset = addr & (PAGE_SIZE - 1);
1627                 size = min(PAGE_SIZE - offset, n - len);
1628
1629                 map = kmap_atomic(page, type);
1630                 memcpy(to, map+offset, size);
1631                 kunmap_atomic(map, type);
1632                 put_page(page);
1633
1634                 len  += size;
1635                 to   += size;
1636                 addr += size;
1637
1638         } while (len < n);
1639
1640         return len;
1641 }
1642
1643 static int copy_stack_frame(const void __user *fp, struct stack_frame *frame)
1644 {
1645         unsigned long bytes;
1646
1647         bytes = copy_from_user_nmi(frame, fp, sizeof(*frame));
1648
1649         return bytes == sizeof(*frame);
1650 }
1651
1652 static void
1653 perf_callchain_user(struct pt_regs *regs, struct perf_callchain_entry *entry)
1654 {
1655         struct stack_frame frame;
1656         const void __user *fp;
1657
1658         if (!user_mode(regs))
1659                 regs = task_pt_regs(current);
1660
1661         fp = (void __user *)regs->bp;
1662
1663         callchain_store(entry, PERF_CONTEXT_USER);
1664         callchain_store(entry, regs->ip);
1665
1666         while (entry->nr < PERF_MAX_STACK_DEPTH) {
1667                 frame.next_frame             = NULL;
1668                 frame.return_address = 0;
1669
1670                 if (!copy_stack_frame(fp, &frame))
1671                         break;
1672
1673                 if ((unsigned long)fp < regs->sp)
1674                         break;
1675
1676                 callchain_store(entry, frame.return_address);
1677                 fp = frame.next_frame;
1678         }
1679 }
1680
1681 static void
1682 perf_do_callchain(struct pt_regs *regs, struct perf_callchain_entry *entry)
1683 {
1684         int is_user;
1685
1686         if (!regs)
1687                 return;
1688
1689         is_user = user_mode(regs);
1690
1691         if (is_user && current->state != TASK_RUNNING)
1692                 return;
1693
1694         if (!is_user)
1695                 perf_callchain_kernel(regs, entry);
1696
1697         if (current->mm)
1698                 perf_callchain_user(regs, entry);
1699 }
1700
1701 struct perf_callchain_entry *perf_callchain(struct pt_regs *regs)
1702 {
1703         struct perf_callchain_entry *entry;
1704
1705         if (in_nmi())
1706                 entry = &__get_cpu_var(pmc_nmi_entry);
1707         else
1708                 entry = &__get_cpu_var(pmc_irq_entry);
1709
1710         entry->nr = 0;
1711
1712         perf_do_callchain(regs, entry);
1713
1714         return entry;
1715 }