arch/x86/kernel/tsc_msr.c

   1 /*
   2  * tsc_msr.c - TSC frequency enumeration via MSR
   3  *
   4  * Copyright (C) 2013 Intel Corporation
   5  * Author: Bin Gao <bin.gao@intel.com>
   6  *
   7  * This file is released under the GPLv2.
   8  */
   9
  10 #include <linux/kernel.h>
  11 #include <asm/processor.h>
  12 #include <asm/setup.h>
  13 #include <asm/apic.h>
  14 #include <asm/param.h>
  15
  16 #define MAX_NUM_FREQS   8
  17
  18 /*
  19  * If MSR_PERF_STAT[31] is set, the maximum resolved bus ratio can be
  20  * read in MSR_PLATFORM_ID[12:8], otherwise in MSR_PERF_STAT[44:40].
  21  * Unfortunately some Intel Atom SoCs aren't quite compliant to this,
  22  * so we need manually differentiate SoC families. This is what the
  23  * field msr_plat does.
  24  */
  25 struct freq_desc {
  26         u8 x86_family;  /* CPU family */
  27         u8 x86_model;   /* model */
  28         u8 msr_plat;    /* 1: use MSR_PLATFORM_INFO, 0: MSR_IA32_PERF_STATUS */
  29         u32 freqs[MAX_NUM_FREQS];
  30 };
  31
  32 static struct freq_desc freq_desc_tables[] = {
  33         /* PNW */
  34         { 6, 0x27, 0, { 0, 0, 0, 0, 0, 99840, 0, 83200 } },
  35         /* CLV+ */
  36         { 6, 0x35, 0, { 0, 133200, 0, 0, 0, 99840, 0, 83200 } },
  37         /* TNG - Intel Atom processor Z3400 series */
  38         { 6, 0x4a, 1, { 0, 100000, 133300, 0, 0, 0, 0, 0 } },
  39         /* VLV2 - Intel Atom processor E3000, Z3600, Z3700 series */
  40         { 6, 0x37, 1, { 83300, 100000, 133300, 116700, 80000, 0, 0, 0 } },
  41         /* ANN - Intel Atom processor Z3500 series */
  42         { 6, 0x5a, 1, { 83300, 100000, 133300, 100000, 0, 0, 0, 0 } },
  43 };
  44
  45 static int match_cpu(u8 family, u8 model)
  46 {
  47         int i;
  48
  49         for (i = 0; i < ARRAY_SIZE(freq_desc_tables); i++) {
  50                 if ((family == freq_desc_tables[i].x86_family) &&
  51                         (model == freq_desc_tables[i].x86_model))
  52                         return i;
  53         }
  54
  55         return -1;
  56 }
  57
  58 /* Map CPU reference clock freq ID(0-7) to CPU reference clock freq(KHz) */
  59 #define id_to_freq(cpu_index, freq_id) \
  60         (freq_desc_tables[cpu_index].freqs[freq_id])
  61
  62 /*
  63  * MSR-based CPU/TSC frequency discovery for certain CPUs.
  64  *
  65  * Set global "lapic_timer_frequency" to bus_clock_cycles/jiffy
  66  * Return processor base frequency in KHz, or 0 on failure.
  67  */
  68 unsigned long try_msr_calibrate_tsc(void)
  69 {
  70         u32 lo, hi, ratio, freq_id, freq;
  71         unsigned long res;
  72         int cpu_index;
  73
  74         if (boot_cpu_data.x86_vendor != X86_VENDOR_INTEL)
  75                 return 0;
  76
  77         cpu_index = match_cpu(boot_cpu_data.x86, boot_cpu_data.x86_model);
  78         if (cpu_index < 0)
  79                 return 0;
  80
  81         if (freq_desc_tables[cpu_index].msr_plat) {
  82                 rdmsr(MSR_PLATFORM_INFO, lo, hi);
  83                 ratio = (lo >> 8) & 0xff;
  84         } else {
  85                 rdmsr(MSR_IA32_PERF_STATUS, lo, hi);
  86                 ratio = (hi >> 8) & 0x1f;
  87         }
  88
  89         /* Get FSB FREQ ID */
  90         rdmsr(MSR_FSB_FREQ, lo, hi);
  91         freq_id = lo & 0x7;
  92         freq = id_to_freq(cpu_index, freq_id);
  93
  94         /* TSC frequency = maximum resolved freq * maximum resolved bus ratio */
  95         res = freq * ratio;
  96
  97 #ifdef CONFIG_X86_LOCAL_APIC
  98         lapic_timer_frequency = (freq * 1000) / HZ;
  99 #endif
 100         return res;
 101 }