mirror of
https://github.com/reactos/reactos.git
synced 2024-11-18 13:01:40 +00:00
119 lines
3.2 KiB
C
119 lines
3.2 KiB
C
/*
|
|
* COPYRIGHT: See COPYING.ARM in the top level directory
|
|
* PROJECT: ReactOS UEFI Boot Library
|
|
* FILE: boot/environ/lib/platform/time.c
|
|
* PURPOSE: Boot Library Time Management Routines
|
|
* PROGRAMMER: Alex Ionescu (alex.ionescu@reactos.org)
|
|
*/
|
|
|
|
/* INCLUDES ******************************************************************/
|
|
|
|
#include "bl.h"
|
|
|
|
/* DATA VARIABLES ************************************************************/
|
|
|
|
ULONGLONG BlpTimePerformanceFrequency;
|
|
|
|
/* FUNCTIONS *****************************************************************/
|
|
|
|
NTSTATUS
|
|
BlpTimeMeasureTscFrequency (
|
|
VOID
|
|
)
|
|
{
|
|
#if defined(_M_IX86) || defined(_M_X64)
|
|
ULONG Count;
|
|
INT CpuInfo[4];
|
|
ULONGLONG TimeStamp1, TimeStamp2, Delta;
|
|
|
|
/* Check if the ISVM bit it set, meaning we're in a hypervisor */
|
|
__cpuid(CpuInfo, 1);
|
|
Count = CpuInfo[2] & 0x80000000 ? 10 : 1;
|
|
|
|
/* Loop trying to get an accurate TSC */
|
|
do
|
|
{
|
|
/* Stall for 1us and get count 1 */
|
|
EfiStall(1);
|
|
TimeStamp1 = __rdtsc();
|
|
|
|
/* Stall for 1000us and get count 2*/
|
|
EfiStall(1000);
|
|
TimeStamp2 = __rdtsc();
|
|
|
|
/* Stall for 9000us and get the difference */
|
|
EfiStall(9000);
|
|
Delta = __rdtsc() - TimeStamp2;
|
|
|
|
/* Keep going as long as the TSC is fluctuating */
|
|
--Count;
|
|
} while (((TimeStamp2 - TimeStamp1) > Delta) && (Count));
|
|
|
|
/* Set the frequency based on the two measurements we took */
|
|
BlpTimePerformanceFrequency = 125 * (Delta - (TimeStamp2 - TimeStamp1)) & 0x1FFFFFFFFFFFFFF;
|
|
return STATUS_SUCCESS;
|
|
#else
|
|
EfiPrintf(L"BlpTimeMeasureTscFrequency not implemented for this platform.\r\n");
|
|
return STATUS_NOT_IMPLEMENTED;
|
|
#endif
|
|
}
|
|
|
|
NTSTATUS
|
|
BlpTimeCalibratePerformanceCounter (
|
|
VOID
|
|
)
|
|
{
|
|
#if defined(_M_IX86) || defined(_M_X64)
|
|
INT CpuInfo[4];
|
|
|
|
/* Check if the ISVM bit it set, meaning we're in a hypervisor */
|
|
__cpuid(CpuInfo, 1);
|
|
if (CpuInfo[2] & 0x80000000)
|
|
{
|
|
/* Get the Hypervisor Identification Leaf */
|
|
__cpuid(CpuInfo, 0x40000001);
|
|
|
|
/* Is this Hyper-V? */
|
|
if (CpuInfo[0] == '1#vH')
|
|
{
|
|
/* Get the Hypervisor Feature Identification Leaf */
|
|
__cpuid(CpuInfo, 0x40000003);
|
|
|
|
/* Check if HV_X64_MSR_REFERENCE_TSC is present */
|
|
if (CpuInfo[3] & 0x100)
|
|
{
|
|
/* Read the TSC frequency from the MSR */
|
|
BlpTimePerformanceFrequency = __readmsr(0x40000022);
|
|
return STATUS_SUCCESS;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* On other systems, compute it */
|
|
return BlpTimeMeasureTscFrequency();
|
|
#else
|
|
EfiPrintf(L"BlpTimeCalibratePerformanceCounter not implemented for this platform.\r\n");
|
|
return STATUS_NOT_IMPLEMENTED;
|
|
#endif
|
|
}
|
|
|
|
ULONGLONG
|
|
BlTimeQueryPerformanceCounter (
|
|
_Out_opt_ PLARGE_INTEGER Frequency
|
|
)
|
|
{
|
|
#if defined(_M_IX86) || defined(_M_X64)
|
|
/* Check if caller wants frequency */
|
|
if (Frequency)
|
|
{
|
|
/* Return it */
|
|
Frequency->QuadPart = BlpTimePerformanceFrequency;
|
|
}
|
|
|
|
/* Return the TSC value */
|
|
return __rdtsc();
|
|
#else
|
|
EfiPrintf(L"BlTimeQueryPerformanceCounter not implemented for this platform.\r\n");
|
|
return 0;
|
|
#endif
|
|
};
|