#include <platforms.h>
#include <mach_kdb.h>
#include <mach/mach_types.h>
#include <kern/cpu_data.h>
#include <kern/cpu_number.h>
#include <kern/clock.h>
#include <kern/host_notify.h>
#include <kern/macro_help.h>
#include <kern/misc_protos.h>
#include <kern/spl.h>
#include <kern/assert.h>
#include <mach/vm_prot.h>
#include <vm/pmap.h>
#include <vm/vm_kern.h>
#include <i386/ipl.h>
#include <architecture/i386/pio.h>
#include <i386/machine_cpu.h>
#include <i386/cpuid.h>
#include <i386/mp.h>
#include <i386/machine_routines.h>
#include <i386/proc_reg.h>
#include <i386/tsc.h>
#include <i386/misc_protos.h>
#include <pexpert/pexpert.h>
#include <machine/limits.h>
#include <machine/commpage.h>
#include <sys/kdebug.h>
#include <pexpert/device_tree.h>
uint64_t busFCvtt2n = 0;
uint64_t busFCvtn2t = 0;
uint64_t tscFreq = 0;
uint64_t tscFCvtt2n = 0;
uint64_t tscFCvtn2t = 0;
uint64_t tscGranularity = 0;
uint64_t bus2tsc = 0;
uint64_t busFreq = 0;
uint32_t flex_ratio = 0;
uint32_t flex_ratio_min = 0;
uint32_t flex_ratio_max = 0;
#define bit(n) (1ULL << (n))
#define bitmask(h,l) ((bit(h)|(bit(h)-1)) & ~(bit(l)-1))
#define bitfield(x,h,l) (((x) & bitmask(h,l)) >> l)
#define kilo (1000ULL)
#define Mega (kilo * kilo)
#define Giga (kilo * Mega)
#define Tera (kilo * Giga)
#define Peta (kilo * Tera)
#define CPU_FAMILY_PENTIUM_M (0x6)
static const char FSB_Frequency_prop[] = "FSBFrequency";
static uint64_t
EFI_FSB_frequency(void)
{
uint64_t frequency = 0;
DTEntry entry;
void *value;
unsigned int size;
if (DTLookupEntry(0, "/efi/platform", &entry) != kSuccess) {
kprintf("EFI_FSB_frequency: didn't find /efi/platform\n");
return 0;
}
if (DTGetProperty(entry,FSB_Frequency_prop,&value,&size) != kSuccess) {
kprintf("EFI_FSB_frequency: property %s not found\n",
FSB_Frequency_prop);
return 0;
}
if (size == sizeof(uint64_t)) {
frequency = *(uint64_t *) value;
kprintf("EFI_FSB_frequency: read %s value: %llu\n",
FSB_Frequency_prop, frequency);
if (!(90*Mega < frequency && frequency < 10*Giga)) {
kprintf("EFI_FSB_frequency: value out of range\n");
frequency = 0;
}
} else {
kprintf("EFI_FSB_frequency: unexpected size %d\n", size);
}
return frequency;
}
void
tsc_init(void)
{
uint64_t busFCvtInt = 0;
boolean_t N_by_2_bus_ratio = FALSE;
busFreq = EFI_FSB_frequency();
switch (cpuid_cpufamily()) {
case CPUFAMILY_INTEL_NEHALEM: {
uint64_t cpu_mhz;
uint64_t msr_flex_ratio;
uint64_t msr_platform_info;
msr_flex_ratio = rdmsr64(MSR_FLEX_RATIO);
msr_platform_info = rdmsr64(MSR_PLATFORM_INFO);
flex_ratio_min = (uint32_t)bitfield(msr_platform_info, 47, 40);
flex_ratio_max = (uint32_t)bitfield(msr_platform_info, 15, 8);
tscGranularity = flex_ratio_max;
if (msr_flex_ratio & bit(16)) {
flex_ratio = (uint32_t)bitfield(msr_flex_ratio, 15, 8);
if (flex_ratio < flex_ratio_max)
tscGranularity = flex_ratio;
}
if (busFreq == 0)
busFreq = BASE_NHM_CLOCK_SOURCE;
cpu_mhz = tscGranularity * BASE_NHM_CLOCK_SOURCE;
break;
}
default: {
uint64_t prfsts;
prfsts = rdmsr64(IA32_PERF_STS);
tscGranularity = (uint32_t)bitfield(prfsts, 44, 40);
N_by_2_bus_ratio = (prfsts & bit(46)) != 0;
}
}
if (busFreq != 0) {
busFCvtt2n = ((1 * Giga) << 32) / busFreq;
busFCvtn2t = 0xFFFFFFFFFFFFFFFFULL / busFCvtt2n;
busFCvtInt = tmrCvt(1 * Peta, 0xFFFFFFFFFFFFFFFFULL / busFreq);
} else {
panic("tsc_init: EFI not supported!\n");
}
kprintf(" BUS: Frequency = %6d.%04dMHz, "
"cvtt2n = %08X.%08X, cvtn2t = %08X.%08X, "
"cvtInt = %08X.%08X\n",
(uint32_t)(busFreq / Mega),
(uint32_t)(busFreq % Mega),
(uint32_t)(busFCvtt2n >> 32), (uint32_t)busFCvtt2n,
(uint32_t)(busFCvtn2t >> 32), (uint32_t)busFCvtn2t,
(uint32_t)(busFCvtInt >> 32), (uint32_t)busFCvtInt);
if (N_by_2_bus_ratio)
tscFCvtt2n = busFCvtt2n * 2 / (1 + 2*tscGranularity);
else
tscFCvtt2n = busFCvtt2n / tscGranularity;
tscFreq = ((1 * Giga) << 32) / tscFCvtt2n;
tscFCvtn2t = 0xFFFFFFFFFFFFFFFFULL / tscFCvtt2n;
kprintf(" TSC: Frequency = %6d.%04dMHz, "
"cvtt2n = %08X.%08X, cvtn2t = %08X.%08X, gran = %lld%s\n",
(uint32_t)(tscFreq / Mega),
(uint32_t)(tscFreq % Mega),
(uint32_t)(tscFCvtt2n >> 32), (uint32_t)tscFCvtt2n,
(uint32_t)(tscFCvtn2t >> 32), (uint32_t)tscFCvtn2t,
tscGranularity, N_by_2_bus_ratio ? " (N/2)" : "");
bus2tsc = tmrCvt(busFCvtt2n, tscFCvtn2t);
}
void
tsc_get_info(tscInfo_t *info)
{
info->busFCvtt2n = busFCvtt2n;
info->busFCvtn2t = busFCvtn2t;
info->tscFreq = tscFreq;
info->tscFCvtt2n = tscFCvtt2n;
info->tscFCvtn2t = tscFCvtn2t;
info->tscGranularity = tscGranularity;
info->bus2tsc = bus2tsc;
info->busFreq = busFreq;
info->flex_ratio = flex_ratio;
info->flex_ratio_min = flex_ratio_min;
info->flex_ratio_max = flex_ratio_max;
}