Programming Languages Research Group: Git - firefly-linux-kernel-4.4.55.git/blob

   1 /*
   2  * @file op_model_athlon.c
   3  * athlon / K7 / K8 / Family 10h model-specific MSR operations
   4  *
   5  * @remark Copyright 2002-2008 OProfile authors
   6  * @remark Read the file COPYING
   7  *
   8  * @author John Levon
   9  * @author Philippe Elie
  10  * @author Graydon Hoare
  11  * @author Robert Richter <robert.richter@amd.com>
  12  * @author Barry Kasindorf
  13 */
  14
  15 #include <linux/oprofile.h>
  16 #include <linux/device.h>
  17 #include <linux/pci.h>
  18
  19 #include <asm/ptrace.h>
  20 #include <asm/msr.h>
  21 #include <asm/nmi.h>
  22
  23 #include "op_x86_model.h"
  24 #include "op_counter.h"
  25
  26 #define NUM_COUNTERS 4
  27 #define NUM_CONTROLS 4
  28
  29 #define CTR_IS_RESERVED(msrs, c) (msrs->counters[(c)].addr ? 1 : 0)
  30 #define CTR_READ(l, h, msrs, c) do {rdmsr(msrs->counters[(c)].addr, (l), (h)); } while (0)
  31 #define CTR_WRITE(l, msrs, c) do {wrmsr(msrs->counters[(c)].addr, -(unsigned int)(l), -1); } while (0)
  32 #define CTR_OVERFLOWED(n) (!((n) & (1U<<31)))
  33
  34 #define CTRL_IS_RESERVED(msrs, c) (msrs->controls[(c)].addr ? 1 : 0)
  35 #define CTRL_READ(l, h, msrs, c) do {rdmsr(msrs->controls[(c)].addr, (l), (h)); } while (0)
  36 #define CTRL_WRITE(l, h, msrs, c) do {wrmsr(msrs->controls[(c)].addr, (l), (h)); } while (0)
  37 #define CTRL_SET_ACTIVE(n) (n |= (1<<22))
  38 #define CTRL_SET_INACTIVE(n) (n &= ~(1<<22))
  39 #define CTRL_CLEAR_LO(x) (x &= (1<<21))
  40 #define CTRL_CLEAR_HI(x) (x &= 0xfffffcf0)
  41 #define CTRL_SET_ENABLE(val) (val |= 1<<20)
  42 #define CTRL_SET_USR(val, u) (val |= ((u & 1) << 16))
  43 #define CTRL_SET_KERN(val, k) (val |= ((k & 1) << 17))
  44 #define CTRL_SET_UM(val, m) (val |= (m << 8))
  45 #define CTRL_SET_EVENT_LOW(val, e) (val |= (e & 0xff))
  46 #define CTRL_SET_EVENT_HIGH(val, e) (val |= ((e >> 8) & 0xf))
  47 #define CTRL_SET_HOST_ONLY(val, h) (val |= ((h & 1) << 9))
  48 #define CTRL_SET_GUEST_ONLY(val, h) (val |= ((h & 1) << 8))
  49
  50 #define IBS_FETCH_CTL_HIGH_MASK         0xFFFFFFFF
  51 /* high dword bit IbsFetchCtl[bit 49] */
  52 #define IBS_FETCH_VALID_BIT             (1UL << 17)
  53 /* high dword bit IbsFetchCtl[bit 52] */
  54 #define IBS_FETCH_PHY_ADDR_VALID_BIT    (1UL << 20)
  55 /* high dword bit IbsFetchCtl[bit 48] */
  56 #define IBS_FETCH_ENABLE                (1UL << 16)
  57
  58 #define IBS_FETCH_CTL_CNT_MASK          0x00000000FFFF0000UL
  59 #define IBS_FETCH_CTL_MAX_CNT_MASK      0x000000000000FFFFUL
  60
  61 /*IbsOpCtl masks/bits */
  62 #define IBS_OP_VALID_BIT        (1ULL<<18)      /* IbsOpCtl[bit18] */
  63 #define IBS_OP_ENABLE           (1ULL<<17)      /* IBS_OP_ENABLE[bit17]*/
  64
  65 /* Codes used in cpu_buffer.c */
  66 #define IBS_FETCH_BEGIN 3
  67 #define IBS_OP_BEGIN    4
  68
  69 /*IbsOpData3 masks */
  70 #define IBS_CTL_LVT_OFFSET_VALID_BIT            (1ULL<<8)
  71
  72 /*PCI Extended Configuration Constants */
  73 /* MSR to set the IBS control register APIC LVT offset */
  74 #define IBS_LVT_OFFSET_PCI              0x1CC
  75
  76 /* The function interface needs to be fixed, something like add
  77    data. Should then be added to linux/oprofile.h. */
  78 extern void oprofile_add_ibs_sample(struct pt_regs *const regs,
  79                                     unsigned int * const ibs_sample, u8 code);
  80
  81 struct ibs_fetch_sample {
  82         /* MSRC001_1031 IBS Fetch Linear Address Register */
  83         unsigned int ibs_fetch_lin_addr_low;
  84         unsigned int ibs_fetch_lin_addr_high;
  85         /* MSRC001_1030 IBS Fetch Control Register */
  86         unsigned int ibs_fetch_ctl_low;
  87         unsigned int ibs_fetch_ctl_high;
  88         /* MSRC001_1032 IBS Fetch Physical Address Register */
  89         unsigned int ibs_fetch_phys_addr_low;
  90         unsigned int ibs_fetch_phys_addr_high;
  91 };
  92
  93 struct ibs_op_sample {
  94         /* MSRC001_1034 IBS Op Logical Address Register (IbsRIP) */
  95         unsigned int ibs_op_rip_low;
  96         unsigned int ibs_op_rip_high;
  97         /* MSRC001_1035 IBS Op Data Register */
  98         unsigned int ibs_op_data1_low;
  99         unsigned int ibs_op_data1_high;
 100         /* MSRC001_1036 IBS Op Data 2 Register */
 101         unsigned int ibs_op_data2_low;
 102         unsigned int ibs_op_data2_high;
 103         /* MSRC001_1037 IBS Op Data 3 Register */
 104         unsigned int ibs_op_data3_low;
 105         unsigned int ibs_op_data3_high;
 106         /* MSRC001_1038 IBS DC Linear Address Register (IbsDcLinAd) */
 107         unsigned int ibs_dc_linear_low;
 108         unsigned int ibs_dc_linear_high;
 109         /* MSRC001_1039 IBS DC Physical Address Register (IbsDcPhysAd) */
 110         unsigned int ibs_dc_phys_low;
 111         unsigned int ibs_dc_phys_high;
 112 };
 113
 114 /*
 115  * unitialize the APIC for the IBS interrupts if needed on AMD Family10h+
 116 */
 117 static void clear_ibs_nmi(void);
 118
 119 static unsigned long reset_value[NUM_COUNTERS];
 120 static int ibs_allowed; /* AMD Family10h and later */
 121
 122 struct op_ibs_config {
 123         unsigned long op_enabled;
 124         unsigned long fetch_enabled;
 125         unsigned long max_cnt_fetch;
 126         unsigned long max_cnt_op;
 127         unsigned long rand_en;
 128         unsigned long dispatched_ops;
 129 };
 130
 131 static struct op_ibs_config ibs_config;
 132
 133 /* functions for op_amd_spec */
 134
 135 static void op_amd_fill_in_addresses(struct op_msrs * const msrs)
 136 {
 137         int i;
 138
 139         for (i = 0; i < NUM_COUNTERS; i++) {
 140                 if (reserve_perfctr_nmi(MSR_K7_PERFCTR0 + i))
 141                         msrs->counters[i].addr = MSR_K7_PERFCTR0 + i;
 142                 else
 143                         msrs->counters[i].addr = 0;
 144         }
 145
 146         for (i = 0; i < NUM_CONTROLS; i++) {
 147                 if (reserve_evntsel_nmi(MSR_K7_EVNTSEL0 + i))
 148                         msrs->controls[i].addr = MSR_K7_EVNTSEL0 + i;
 149                 else
 150                         msrs->controls[i].addr = 0;
 151         }
 152 }
 153
 154
 155 static void op_amd_setup_ctrs(struct op_msrs const * const msrs)
 156 {
 157         unsigned int low, high;
 158         int i;
 159
 160         /* clear all counters */
 161         for (i = 0 ; i < NUM_CONTROLS; ++i) {
 162                 if (unlikely(!CTRL_IS_RESERVED(msrs, i)))
 163                         continue;
 164                 CTRL_READ(low, high, msrs, i);
 165                 CTRL_CLEAR_LO(low);
 166                 CTRL_CLEAR_HI(high);
 167                 CTRL_WRITE(low, high, msrs, i);
 168         }
 169
 170         /* avoid a false detection of ctr overflows in NMI handler */
 171         for (i = 0; i < NUM_COUNTERS; ++i) {
 172                 if (unlikely(!CTR_IS_RESERVED(msrs, i)))
 173                         continue;
 174                 CTR_WRITE(1, msrs, i);
 175         }
 176
 177         /* enable active counters */
 178         for (i = 0; i < NUM_COUNTERS; ++i) {
 179                 if ((counter_config[i].enabled) && (CTR_IS_RESERVED(msrs, i))) {
 180                         reset_value[i] = counter_config[i].count;
 181
 182                         CTR_WRITE(counter_config[i].count, msrs, i);
 183
 184                         CTRL_READ(low, high, msrs, i);
 185                         CTRL_CLEAR_LO(low);
 186                         CTRL_CLEAR_HI(high);
 187                         CTRL_SET_ENABLE(low);
 188                         CTRL_SET_USR(low, counter_config[i].user);
 189                         CTRL_SET_KERN(low, counter_config[i].kernel);
 190                         CTRL_SET_UM(low, counter_config[i].unit_mask);
 191                         CTRL_SET_EVENT_LOW(low, counter_config[i].event);
 192                         CTRL_SET_EVENT_HIGH(high, counter_config[i].event);
 193                         CTRL_SET_HOST_ONLY(high, 0);
 194                         CTRL_SET_GUEST_ONLY(high, 0);
 195
 196                         CTRL_WRITE(low, high, msrs, i);
 197                 } else {
 198                         reset_value[i] = 0;
 199                 }
 200         }
 201 }
 202
 203 static inline int
 204 op_amd_handle_ibs(struct pt_regs * const regs,
 205                   struct op_msrs const * const msrs)
 206 {
 207         unsigned int low, high;
 208         struct ibs_fetch_sample ibs_fetch;
 209         struct ibs_op_sample ibs_op;
 210
 211         if (!ibs_allowed)
 212                 return 1;
 213
 214         if (ibs_config.fetch_enabled) {
 215                 rdmsr(MSR_AMD64_IBSFETCHCTL, low, high);
 216                 if (high & IBS_FETCH_VALID_BIT) {
 217                         ibs_fetch.ibs_fetch_ctl_high = high;
 218                         ibs_fetch.ibs_fetch_ctl_low = low;
 219                         rdmsr(MSR_AMD64_IBSFETCHLINAD, low, high);
 220                         ibs_fetch.ibs_fetch_lin_addr_high = high;
 221                         ibs_fetch.ibs_fetch_lin_addr_low = low;
 222                         rdmsr(MSR_AMD64_IBSFETCHPHYSAD, low, high);
 223                         ibs_fetch.ibs_fetch_phys_addr_high = high;
 224                         ibs_fetch.ibs_fetch_phys_addr_low = low;
 225
 226                         oprofile_add_ibs_sample(regs,
 227                                                 (unsigned int *)&ibs_fetch,
 228                                                 IBS_FETCH_BEGIN);
 229
 230                         /*reenable the IRQ */
 231                         rdmsr(MSR_AMD64_IBSFETCHCTL, low, high);
 232                         high &= ~(IBS_FETCH_VALID_BIT);
 233                         high |= IBS_FETCH_ENABLE;
 234                         low &= IBS_FETCH_CTL_MAX_CNT_MASK;
 235                         wrmsr(MSR_AMD64_IBSFETCHCTL, low, high);
 236                 }
 237         }
 238
 239         if (ibs_config.op_enabled) {
 240                 rdmsr(MSR_AMD64_IBSOPCTL, low, high);
 241                 if (low & IBS_OP_VALID_BIT) {
 242                         rdmsr(MSR_AMD64_IBSOPRIP, low, high);
 243                         ibs_op.ibs_op_rip_low = low;
 244                         ibs_op.ibs_op_rip_high = high;
 245                         rdmsr(MSR_AMD64_IBSOPDATA, low, high);
 246                         ibs_op.ibs_op_data1_low = low;
 247                         ibs_op.ibs_op_data1_high = high;
 248                         rdmsr(MSR_AMD64_IBSOPDATA2, low, high);
 249                         ibs_op.ibs_op_data2_low = low;
 250                         ibs_op.ibs_op_data2_high = high;
 251                         rdmsr(MSR_AMD64_IBSOPDATA3, low, high);
 252                         ibs_op.ibs_op_data3_low = low;
 253                         ibs_op.ibs_op_data3_high = high;
 254                         rdmsr(MSR_AMD64_IBSDCLINAD, low, high);
 255                         ibs_op.ibs_dc_linear_low = low;
 256                         ibs_op.ibs_dc_linear_high = high;
 257                         rdmsr(MSR_AMD64_IBSDCPHYSAD, low, high);
 258                         ibs_op.ibs_dc_phys_low = low;
 259                         ibs_op.ibs_dc_phys_high = high;
 260
 261                         /* reenable the IRQ */
 262                         oprofile_add_ibs_sample(regs,
 263                                                 (unsigned int *)&ibs_op,
 264                                                 IBS_OP_BEGIN);
 265                         rdmsr(MSR_AMD64_IBSOPCTL, low, high);
 266                         low &= ~(IBS_OP_VALID_BIT);
 267                         low |= IBS_OP_ENABLE;
 268                         wrmsr(MSR_AMD64_IBSOPCTL, low, high);
 269                 }
 270         }
 271
 272         return 1;
 273 }
 274
 275 static int op_amd_check_ctrs(struct pt_regs * const regs,
 276                              struct op_msrs const * const msrs)
 277 {
 278         unsigned int low, high;
 279         int i;
 280
 281         for (i = 0 ; i < NUM_COUNTERS; ++i) {
 282                 if (!reset_value[i])
 283                         continue;
 284                 CTR_READ(low, high, msrs, i);
 285                 if (CTR_OVERFLOWED(low)) {
 286                         oprofile_add_sample(regs, i);
 287                         CTR_WRITE(reset_value[i], msrs, i);
 288                 }
 289         }
 290
 291         op_amd_handle_ibs(regs, msrs);
 292
 293         /* See op_model_ppro.c */
 294         return 1;
 295 }
 296
 297 static void op_amd_start(struct op_msrs const * const msrs)
 298 {
 299         unsigned int low, high;
 300         int i;
 301         for (i = 0 ; i < NUM_COUNTERS ; ++i) {
 302                 if (reset_value[i]) {
 303                         CTRL_READ(low, high, msrs, i);
 304                         CTRL_SET_ACTIVE(low);
 305                         CTRL_WRITE(low, high, msrs, i);
 306                 }
 307         }
 308         if (ibs_allowed && ibs_config.fetch_enabled) {
 309                 low = (ibs_config.max_cnt_fetch >> 4) & 0xFFFF;
 310                 high = IBS_FETCH_ENABLE;
 311                 wrmsr(MSR_AMD64_IBSFETCHCTL, low, high);
 312         }
 313
 314         if (ibs_allowed && ibs_config.op_enabled) {
 315                 low = ((ibs_config.max_cnt_op >> 4) & 0xFFFF) + IBS_OP_ENABLE;
 316                 high = 0;
 317                 wrmsr(MSR_AMD64_IBSOPCTL, low, high);
 318         }
 319 }
 320
 321
 322 static void op_amd_stop(struct op_msrs const * const msrs)
 323 {
 324         unsigned int low, high;
 325         int i;
 326
 327         /* Subtle: stop on all counters to avoid race with
 328          * setting our pm callback */
 329         for (i = 0 ; i < NUM_COUNTERS ; ++i) {
 330                 if (!reset_value[i])
 331                         continue;
 332                 CTRL_READ(low, high, msrs, i);
 333                 CTRL_SET_INACTIVE(low);
 334                 CTRL_WRITE(low, high, msrs, i);
 335         }
 336
 337         if (ibs_allowed && ibs_config.fetch_enabled) {
 338                 low = 0;                /* clear max count and enable */
 339                 high = 0;
 340                 wrmsr(MSR_AMD64_IBSFETCHCTL, low, high);
 341         }
 342
 343         if (ibs_allowed && ibs_config.op_enabled) {
 344                 low = 0;                /* clear max count and enable */
 345                 high = 0;
 346                 wrmsr(MSR_AMD64_IBSOPCTL, low, high);
 347         }
 348 }
 349
 350 static void op_amd_shutdown(struct op_msrs const * const msrs)
 351 {
 352         int i;
 353
 354         for (i = 0 ; i < NUM_COUNTERS ; ++i) {
 355                 if (CTR_IS_RESERVED(msrs, i))
 356                         release_perfctr_nmi(MSR_K7_PERFCTR0 + i);
 357         }
 358         for (i = 0 ; i < NUM_CONTROLS ; ++i) {
 359                 if (CTRL_IS_RESERVED(msrs, i))
 360                         release_evntsel_nmi(MSR_K7_EVNTSEL0 + i);
 361         }
 362 }
 363
 364 #ifndef CONFIG_SMP
 365
 366 /* no IBS support */
 367
 368 static void setup_ibs(void)
 369 {
 370         ibs_allowed = 0;
 371 }
 372
 373 static void clear_ibs_nmi(void) {}
 374
 375 static int op_amd_init(struct oprofile_operations *ops)
 376 {
 377         return 0;
 378 }
 379
 380 static void op_amd_exit(void) {}
 381
 382 #else
 383
 384 static u8 ibs_eilvt_off;
 385
 386 static inline void apic_init_ibs_nmi_per_cpu(void *arg)
 387 {
 388         ibs_eilvt_off = setup_APIC_eilvt_ibs(0, APIC_EILVT_MSG_NMI, 0);
 389 }
 390
 391 static inline void apic_clear_ibs_nmi_per_cpu(void *arg)
 392 {
 393         setup_APIC_eilvt_ibs(0, APIC_EILVT_MSG_FIX, 1);
 394 }
 395
 396 static int pfm_amd64_setup_eilvt(void)
 397 {
 398 #define IBSCTL_LVTOFFSETVAL             (1 << 8)
 399 #define IBSCTL                          0x1cc
 400         struct pci_dev *cpu_cfg;
 401         int nodes;
 402         u32 value = 0;
 403
 404         /* per CPU setup */
 405         on_each_cpu(apic_init_ibs_nmi_per_cpu, NULL, 1);
 406
 407         nodes = 0;
 408         cpu_cfg = NULL;
 409         do {
 410                 cpu_cfg = pci_get_device(PCI_VENDOR_ID_AMD,
 411                                          PCI_DEVICE_ID_AMD_10H_NB_MISC,
 412                                          cpu_cfg);
 413                 if (!cpu_cfg)
 414                         break;
 415                 ++nodes;
 416                 pci_write_config_dword(cpu_cfg, IBSCTL, ibs_eilvt_off
 417                                        | IBSCTL_LVTOFFSETVAL);
 418                 pci_read_config_dword(cpu_cfg, IBSCTL, &value);
 419                 if (value != (ibs_eilvt_off | IBSCTL_LVTOFFSETVAL)) {
 420                         printk(KERN_DEBUG "Failed to setup IBS LVT offset, "
 421                                 "IBSCTL = 0x%08x", value);
 422                         return 1;
 423                 }
 424         } while (1);
 425
 426         if (!nodes) {
 427                 printk(KERN_DEBUG "No CPU node configured for IBS");
 428                 return 1;
 429         }
 430
 431 #ifdef CONFIG_NUMA
 432         /* Sanity check */
 433         /* Works only for 64bit with proper numa implementation. */
 434         if (nodes != num_possible_nodes()) {
 435                 printk(KERN_DEBUG "Failed to setup CPU node(s) for IBS, "
 436                         "found: %d, expected %d",
 437                         nodes, num_possible_nodes());
 438                 return 1;
 439         }
 440 #endif
 441         return 0;
 442 }
 443
 444 /*
 445  * initialize the APIC for the IBS interrupts
 446  * if available (AMD Family10h rev B0 and later)
 447  */
 448 static void setup_ibs(void)
 449 {
 450         ibs_allowed = boot_cpu_has(X86_FEATURE_IBS);
 451
 452         if (!ibs_allowed)
 453                 return;
 454
 455         if (pfm_amd64_setup_eilvt())
 456                 ibs_allowed = 0;
 457 }
 458
 459
 460 /*
 461  * unitialize the APIC for the IBS interrupts if needed on AMD Family10h
 462  * rev B0 and later */
 463 static void clear_ibs_nmi(void)
 464 {
 465         if (ibs_allowed)
 466                 on_each_cpu(apic_clear_ibs_nmi_per_cpu, NULL, 1);
 467 }
 468
 469 static int (*create_arch_files)(struct super_block * sb, struct dentry * root);
 470
 471 static int setup_ibs_files(struct super_block * sb, struct dentry * root)
 472 {
 473         char buf[12];
 474         struct dentry *dir;
 475         int ret = 0;
 476
 477         /* architecture specific files */
 478         if (create_arch_files)
 479                 ret = create_arch_files(sb, root);
 480
 481         if (ret)
 482                 return ret;
 483
 484         if (!ibs_allowed)
 485                 return ret;
 486
 487         /* model specific files */
 488
 489         /* setup some reasonable defaults */
 490         ibs_config.max_cnt_fetch = 250000;
 491         ibs_config.fetch_enabled = 0;
 492         ibs_config.max_cnt_op = 250000;
 493         ibs_config.op_enabled = 0;
 494         ibs_config.dispatched_ops = 1;
 495         snprintf(buf,  sizeof(buf), "ibs_fetch");
 496         dir = oprofilefs_mkdir(sb, root, buf);
 497         oprofilefs_create_ulong(sb, dir, "rand_enable",
 498                                 &ibs_config.rand_en);
 499         oprofilefs_create_ulong(sb, dir, "enable",
 500                 &ibs_config.fetch_enabled);
 501         oprofilefs_create_ulong(sb, dir, "max_count",
 502                 &ibs_config.max_cnt_fetch);
 503         snprintf(buf,  sizeof(buf), "ibs_uops");
 504         dir = oprofilefs_mkdir(sb, root, buf);
 505         oprofilefs_create_ulong(sb, dir, "enable",
 506                 &ibs_config.op_enabled);
 507         oprofilefs_create_ulong(sb, dir, "max_count",
 508                 &ibs_config.max_cnt_op);
 509         oprofilefs_create_ulong(sb, dir, "dispatched_ops",
 510                 &ibs_config.dispatched_ops);
 511
 512         return 0;
 513 }
 514
 515 static int op_amd_init(struct oprofile_operations *ops)
 516 {
 517         setup_ibs();
 518         create_arch_files = ops->create_files;
 519         ops->create_files = setup_ibs_files;
 520         return 0;
 521 }
 522
 523 static void op_amd_exit(void)
 524 {
 525         clear_ibs_nmi();
 526 }
 527
 528 #endif
 529
 530 struct op_x86_model_spec const op_amd_spec = {
 531         .init = op_amd_init,
 532         .exit = op_amd_exit,
 533         .num_counters = NUM_COUNTERS,
 534         .num_controls = NUM_CONTROLS,
 535         .fill_in_addresses = &op_amd_fill_in_addresses,
 536         .setup_ctrs = &op_amd_setup_ctrs,
 537         .check_ctrs = &op_amd_check_ctrs,
 538         .start = &op_amd_start,
 539         .stop = &op_amd_stop,
 540         .shutdown = &op_amd_shutdown
 541 };