osfmk/i386/Diagnostics.c

   1 /*
   2  * Copyright (c) 2005-2008 Apple Inc. All rights reserved.
   3  *
   4  * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
   5  *
   6  * This file contains Original Code and/or Modifications of Original Code
   7  * as defined in and that are subject to the Apple Public Source License
   8  * Version 2.0 (the 'License'). You may not use this file except in
   9  * compliance with the License. The rights granted to you under the License
  10  * may not be used to create, or enable the creation or redistribution of,
  11  * unlawful or unlicensed copies of an Apple operating system, or to
  12  * circumvent, violate, or enable the circumvention or violation of, any
  13  * terms of an Apple operating system software license agreement.
  14  *
  15  * Please obtain a copy of the License at
  16  * http://www.opensource.apple.com/apsl/ and read it before using this file.
  17  *
  18  * The Original Code and all software distributed under the License are
  19  * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
  20  * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
  21  * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
  22  * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
  23  * Please see the License for the specific language governing rights and
  24  * limitations under the License.
  25  *
  26  * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
  27  */
  28 /*
  29  * @OSF_FREE_COPYRIGHT@
  30  */
  31 /*
  32  * @APPLE_FREE_COPYRIGHT@
  33  */
  34
  35 /*
  36  *      Author: Bill Angell, Apple
  37  *      Date:   10/auht-five
  38  *
  39  *      Random diagnostics, augmented Derek Kumar 2011
  40  *
  41  *
  42  */
  43
  44
  45 #include <kern/machine.h>
  46 #include <kern/processor.h>
  47 #include <mach/machine.h>
  48 #include <mach/processor_info.h>
  49 #include <mach/mach_types.h>
  50 #include <mach/boolean.h>
  51 #include <kern/thread.h>
  52 #include <kern/task.h>
  53 #include <kern/ipc_kobject.h>
  54 #include <mach/vm_param.h>
  55 #include <ipc/port.h>
  56 #include <ipc/ipc_entry.h>
  57 #include <ipc/ipc_space.h>
  58 #include <ipc/ipc_object.h>
  59 #include <ipc/ipc_port.h>
  60 #include <vm/vm_kern.h>
  61 #include <vm/vm_map.h>
  62 #include <vm/vm_page.h>
  63 #include <vm/pmap.h>
  64 #include <pexpert/pexpert.h>
  65 #include <console/video_console.h>
  66 #include <i386/cpu_data.h>
  67 #include <i386/Diagnostics.h>
  68 #include <i386/mp.h>
  69 #include <i386/pmCPU.h>
  70 #include <i386/tsc.h>
  71 #include <mach/i386/syscall_sw.h>
  72 #include <kern/kalloc.h>
  73 #include <sys/kdebug.h>
  74 #include <i386/machine_cpu.h>
  75 #include <i386/misc_protos.h>
  76 #include <i386/cpuid.h>
  77
  78 #define PERMIT_PERMCHECK (0)
  79
  80 diagWork        dgWork;
  81 uint64_t        lastRuptClear = 0ULL;
  82 boolean_t       diag_pmc_enabled = FALSE;
  83 void cpu_powerstats(void *);
  84
  85 typedef struct {
  86         uint64_t caperf;
  87         uint64_t cmperf;
  88         uint64_t ccres[6];
  89         uint64_t crtimes[CPU_RTIME_BINS];
  90         uint64_t citimes[CPU_ITIME_BINS];
  91         uint64_t crtime_total;
  92         uint64_t citime_total;
  93         uint64_t cpu_idle_exits;
  94         uint64_t cpu_insns;
  95         uint64_t cpu_ucc;
  96         uint64_t cpu_urc;
  97 #if     DIAG_ALL_PMCS
  98         uint64_t gpmcs[4];
  99 #endif /* DIAG_ALL_PMCS */
 100 } core_energy_stat_t;
 101
 102 typedef struct {
 103         uint64_t pkes_version;
 104         uint64_t pkg_cres[2][7];
 105         uint64_t pkg_power_unit;
 106         uint64_t pkg_energy;
 107         uint64_t pp0_energy;
 108         uint64_t pp1_energy;
 109         uint64_t ddr_energy;
 110         uint64_t llc_flushed_cycles;
 111         uint64_t ring_ratio_instantaneous;
 112         uint64_t IA_frequency_clipping_cause;
 113         uint64_t GT_frequency_clipping_cause;
 114         uint64_t pkg_idle_exits;
 115         uint64_t pkg_rtimes[CPU_RTIME_BINS];
 116         uint64_t pkg_itimes[CPU_ITIME_BINS];
 117         uint64_t mbus_delay_time;
 118         uint64_t mint_delay_time;
 119         uint32_t ncpus;
 120         core_energy_stat_t cest[];
 121 } pkg_energy_statistics_t;
 122
 123
 124 int
 125 diagCall64(x86_saved_state_t * state)
 126 {
 127         uint64_t        curpos, i, j;
 128         uint64_t        selector, data;
 129         uint64_t        currNap, durNap;
 130         x86_saved_state64_t     *regs;
 131         boolean_t       diagflag;
 132         uint32_t        rval = 0;
 133
 134         assert(is_saved_state64(state));
 135         regs = saved_state64(state);
 136
 137         diagflag = ((dgWork.dgFlags & enaDiagSCs) != 0);
 138         selector = regs->rdi;
 139
 140         switch (selector) {     /* Select the routine */
 141         case dgRuptStat:        /* Suck Interruption statistics */
 142                 (void) ml_set_interrupts_enabled(TRUE);
 143                 data = regs->rsi; /* Get the number of processors */
 144
 145                 if (data == 0) { /* If no location is specified for data, clear all
 146                                   * counts
 147                                   */
 148                         for (i = 0; i < real_ncpus; i++) {      /* Cycle through
 149                                                                  * processors */
 150                                 for (j = 0; j < 256; j++)
 151                                         cpu_data_ptr[i]->cpu_hwIntCnt[j] = 0;
 152                         }
 153
 154                         lastRuptClear = mach_absolute_time();   /* Get the time of clear */
 155                         rval = 1;       /* Normal return */
 156                         break;
 157                 }
 158
 159                 (void) copyout((char *) &real_ncpus, data, sizeof(real_ncpus)); /* Copy out number of
 160                                                                                  * processors */
 161                 currNap = mach_absolute_time(); /* Get the time now */
 162                 durNap = currNap - lastRuptClear;       /* Get the last interval
 163                                                          * duration */
 164                 if (durNap == 0)
 165                         durNap = 1;     /* This is a very short time, make it
 166                                          * bigger */
 167
 168                 curpos = data + sizeof(real_ncpus);     /* Point to the next
 169                                                          * available spot */
 170
 171                 for (i = 0; i < real_ncpus; i++) {      /* Move 'em all out */
 172                         (void) copyout((char *) &durNap, curpos, 8);    /* Copy out the time
 173                                                                          * since last clear */
 174                         (void) copyout((char *) &cpu_data_ptr[i]->cpu_hwIntCnt, curpos + 8, 256 * sizeof(uint32_t));    /* Copy out interrupt
 175                                                                                                                          * data for this
 176                                                                                                                          * processor */
 177                         curpos = curpos + (256 * sizeof(uint32_t) + 8); /* Point to next out put
 178                                                                          * slot */
 179                 }
 180                 rval = 1;
 181                 break;
 182
 183         case dgPowerStat:
 184         {
 185                 uint32_t c2l = 0, c2h = 0, c3l = 0, c3h = 0, c6l = 0, c6h = 0, c7l = 0, c7h = 0;
 186                 uint32_t pkg_unit_l = 0, pkg_unit_h = 0, pkg_ecl = 0, pkg_ech = 0;
 187
 188                 pkg_energy_statistics_t pkes;
 189                 core_energy_stat_t cest;
 190
 191                 bzero(&pkes, sizeof(pkes));
 192                 bzero(&cest, sizeof(cest));
 193
 194                 pkes.pkes_version = 1ULL;
 195                 rdmsr_carefully(MSR_IA32_PKG_C2_RESIDENCY, &c2l, &c2h);
 196                 rdmsr_carefully(MSR_IA32_PKG_C3_RESIDENCY, &c3l, &c3h);
 197                 rdmsr_carefully(MSR_IA32_PKG_C6_RESIDENCY, &c6l, &c6h);
 198                 rdmsr_carefully(MSR_IA32_PKG_C7_RESIDENCY, &c7l, &c7h);
 199
 200                 pkes.pkg_cres[0][0] = ((uint64_t)c2h << 32) | c2l;
 201                 pkes.pkg_cres[0][1] = ((uint64_t)c3h << 32) | c3l;
 202                 pkes.pkg_cres[0][2] = ((uint64_t)c6h << 32) | c6l;
 203                 pkes.pkg_cres[0][3] = ((uint64_t)c7h << 32) | c7l;
 204
 205                 uint64_t c8r = ~0ULL, c9r = ~0ULL, c10r = ~0ULL;
 206
 207                 rdmsr64_carefully(MSR_IA32_PKG_C8_RESIDENCY, &c8r);
 208                 rdmsr64_carefully(MSR_IA32_PKG_C9_RESIDENCY, &c9r);
 209                 rdmsr64_carefully(MSR_IA32_PKG_C10_RESIDENCY, &c10r);
 210
 211                 pkes.pkg_cres[0][4] = c8r;
 212                 pkes.pkg_cres[0][5] = c9r;
 213                 pkes.pkg_cres[0][6] = c10r;
 214
 215                 pkes.ddr_energy = ~0ULL;
 216                 rdmsr64_carefully(MSR_IA32_DDR_ENERGY_STATUS, &pkes.ddr_energy);
 217                 pkes.llc_flushed_cycles = ~0ULL;
 218                 rdmsr64_carefully(MSR_IA32_LLC_FLUSHED_RESIDENCY_TIMER, &pkes.llc_flushed_cycles);
 219
 220                 pkes.ring_ratio_instantaneous = ~0ULL;
 221                 rdmsr64_carefully(MSR_IA32_RING_PERF_STATUS, &pkes.ring_ratio_instantaneous);
 222
 223                 pkes.IA_frequency_clipping_cause = ~0ULL;
 224                 rdmsr64_carefully(MSR_IA32_IA_PERF_LIMIT_REASONS, &pkes.IA_frequency_clipping_cause);
 225
 226                 pkes.GT_frequency_clipping_cause = ~0ULL;
 227                 rdmsr64_carefully(MSR_IA32_GT_PERF_LIMIT_REASONS, &pkes.GT_frequency_clipping_cause);
 228
 229                 rdmsr_carefully(MSR_IA32_PKG_POWER_SKU_UNIT, &pkg_unit_l, &pkg_unit_h);
 230                 rdmsr_carefully(MSR_IA32_PKG_ENERGY_STATUS, &pkg_ecl, &pkg_ech);
 231                 pkes.pkg_power_unit = ((uint64_t)pkg_unit_h << 32) | pkg_unit_l;
 232                 pkes.pkg_energy = ((uint64_t)pkg_ech << 32) | pkg_ecl;
 233
 234                 rdmsr_carefully(MSR_IA32_PP0_ENERGY_STATUS, &pkg_ecl, &pkg_ech);
 235                 pkes.pp0_energy = ((uint64_t)pkg_ech << 32) | pkg_ecl;
 236
 237                 rdmsr_carefully(MSR_IA32_PP1_ENERGY_STATUS, &pkg_ecl, &pkg_ech);
 238                 pkes.pp1_energy = ((uint64_t)pkg_ech << 32) | pkg_ecl;
 239
 240                 pkes.pkg_idle_exits = current_cpu_datap()->lcpu.package->package_idle_exits;
 241                 pkes.ncpus = real_ncpus;
 242
 243                 (void) ml_set_interrupts_enabled(TRUE);
 244
 245                 copyout(&pkes, regs->rsi, sizeof(pkes));
 246                 curpos = regs->rsi + sizeof(pkes);
 247
 248                 mp_cpus_call(CPUMASK_ALL, ASYNC, cpu_powerstats, NULL);
 249
 250                 for (i = 0; i < real_ncpus; i++) {
 251                         (void) ml_set_interrupts_enabled(FALSE);
 252
 253                         cest.caperf = cpu_data_ptr[i]->cpu_aperf;
 254                         cest.cmperf = cpu_data_ptr[i]->cpu_mperf;
 255                         cest.ccres[0] = cpu_data_ptr[i]->cpu_c3res;
 256                         cest.ccres[1] = cpu_data_ptr[i]->cpu_c6res;
 257                         cest.ccres[2] = cpu_data_ptr[i]->cpu_c7res;
 258
 259                         bcopy(&cpu_data_ptr[i]->cpu_rtimes[0], &cest.crtimes[0], sizeof(cest.crtimes));
 260                         bcopy(&cpu_data_ptr[i]->cpu_itimes[0], &cest.citimes[0], sizeof(cest.citimes));
 261
 262                         cest.citime_total = cpu_data_ptr[i]->cpu_itime_total;
 263                         cest.crtime_total = cpu_data_ptr[i]->cpu_rtime_total;
 264                         cest.cpu_idle_exits = cpu_data_ptr[i]->cpu_idle_exits;
 265                         cest.cpu_insns = cpu_data_ptr[i]->cpu_cur_insns;
 266                         cest.cpu_ucc = cpu_data_ptr[i]->cpu_cur_ucc;
 267                         cest.cpu_urc = cpu_data_ptr[i]->cpu_cur_urc;
 268 #if DIAG_ALL_PMCS
 269                         bcopy(&cpu_data_ptr[i]->cpu_gpmcs[0], &cest.gpmcs[0], sizeof(cest.gpmcs));
 270 #endif /* DIAG_ALL_PMCS */
 271                         (void) ml_set_interrupts_enabled(TRUE);
 272
 273                         copyout(&cest, curpos, sizeof(cest));
 274                         curpos += sizeof(cest);
 275                 }
 276                 rval = 1;
 277         }
 278                 break;
 279         case dgEnaPMC:
 280         {
 281                 boolean_t enable = TRUE;
 282                 uint32_t cpuinfo[4];
 283                 /* Require architectural PMC v2 or higher, corresponding to
 284                  * Merom+, or equivalent virtualised facility.
 285                  */
 286                 do_cpuid(0xA, &cpuinfo[0]);
 287                 if ((cpuinfo[0] & 0xFF) >= 2) {
 288                         mp_cpus_call(CPUMASK_ALL, ASYNC, cpu_pmc_control, &enable);
 289                         diag_pmc_enabled = TRUE;
 290                 }
 291                 rval = 1;
 292         }
 293         break;
 294 #if     DEBUG
 295         case dgGzallocTest:
 296         {
 297                 (void) ml_set_interrupts_enabled(TRUE);
 298                 if (diagflag) {
 299                         unsigned *ptr = (unsigned *)kalloc(1024);
 300                         kfree(ptr, 1024);
 301                         *ptr = 0x42;
 302                 }
 303         }
 304         break;
 305 #endif
 306
 307 #if PERMIT_PERMCHECK
 308         case    dgPermCheck:
 309         {
 310                 (void) ml_set_interrupts_enabled(TRUE);
 311                 if (diagflag)
 312                         rval = pmap_permissions_verify(kernel_pmap, kernel_map, 0, ~0ULL);
 313         }
 314                 break;
 315 #endif /* PERMIT_PERMCHECK */
 316         default:                /* Handle invalid ones */
 317                 rval = 0;       /* Return an exception */
 318         }
 319
 320         regs->rax = rval;
 321
 322         return rval;
 323 }
 324
 325 void cpu_powerstats(__unused void *arg) {
 326         cpu_data_t *cdp = current_cpu_datap();
 327         __unused int cnum = cdp->cpu_number;
 328         uint32_t cl = 0, ch = 0, mpl = 0, mph = 0, apl = 0, aph = 0;
 329
 330         rdmsr_carefully(MSR_IA32_MPERF, &mpl, &mph);
 331         rdmsr_carefully(MSR_IA32_APERF, &apl, &aph);
 332
 333         cdp->cpu_mperf = ((uint64_t)mph << 32) | mpl;
 334         cdp->cpu_aperf = ((uint64_t)aph << 32) | apl;
 335
 336         uint64_t ctime = mach_absolute_time();
 337         cdp->cpu_rtime_total += ctime - cdp->cpu_ixtime;
 338         cdp->cpu_ixtime = ctime;
 339
 340         rdmsr_carefully(MSR_IA32_CORE_C3_RESIDENCY, &cl, &ch);
 341         cdp->cpu_c3res = ((uint64_t)ch << 32) | cl;
 342
 343         rdmsr_carefully(MSR_IA32_CORE_C6_RESIDENCY, &cl, &ch);
 344         cdp->cpu_c6res = ((uint64_t)ch << 32) | cl;
 345
 346         rdmsr_carefully(MSR_IA32_CORE_C7_RESIDENCY, &cl, &ch);
 347         cdp->cpu_c7res = ((uint64_t)ch << 32) | cl;
 348
 349         if (diag_pmc_enabled) {
 350                 uint64_t insns = read_pmc(FIXED_PMC0);
 351                 uint64_t ucc = read_pmc(FIXED_PMC1);
 352                 uint64_t urc = read_pmc(FIXED_PMC2);
 353 #if DIAG_ALL_PMCS
 354                 int i;
 355
 356                 for (i = 0; i < 4; i++) {
 357                         cdp->cpu_gpmcs[i] = read_pmc(i);
 358                 }
 359 #endif /* DIAG_ALL_PMCS */
 360                 cdp->cpu_cur_insns = insns;
 361                 cdp->cpu_cur_ucc = ucc;
 362                 cdp->cpu_cur_urc = urc;
 363         }
 364 }
 365
 366 void cpu_pmc_control(void *enablep) {
 367         boolean_t enable = *(boolean_t *)enablep;
 368         cpu_data_t      *cdp = current_cpu_datap();
 369
 370         if (enable) {
 371                 wrmsr64(0x38F, 0x70000000FULL);
 372                 wrmsr64(0x38D, 0x333);
 373                 set_cr4(get_cr4() | CR4_PCE);
 374
 375         } else {
 376                 wrmsr64(0x38F, 0);
 377                 wrmsr64(0x38D, 0);
 378                 set_cr4((get_cr4() & ~CR4_PCE));
 379         }
 380         cdp->cpu_fixed_pmcs_enabled = enable;
 381 }