Upload BSD-licensed Vlv2TbltDevicePkg and Vlv2DeviceRefCodePkg to
https://svn.code.sf.net/p/edk2/code/trunk/edk2/, which are for MinnowBoard MAX open source project. Contributed-under: TianoCore Contribution Agreement 1.0 Signed-off-by: David Wei <david.wei@intel.com> Reviewed-by: Mike Wu <mike.wu@intel.com> Reviewed-by: Hot Tian <hot.tian@intel.com> git-svn-id: https://svn.code.sf.net/p/edk2/code/trunk/edk2@16599 6f19259b-4bc3-4df7-8a09-765794883524
This commit is contained in:
96
Vlv2TbltDevicePkg/PlatformInitPei/Stall.c
Normal file
96
Vlv2TbltDevicePkg/PlatformInitPei/Stall.c
Normal file
@@ -0,0 +1,96 @@
|
||||
/** @file
|
||||
|
||||
Copyright (c) 2004 - 2014, Intel Corporation. All rights reserved.<BR>
|
||||
|
||||
|
||||
This program and the accompanying materials are licensed and made available under
|
||||
|
||||
the terms and conditions of the BSD License that accompanies this distribution.
|
||||
|
||||
The full text of the license may be found at
|
||||
|
||||
http://opensource.org/licenses/bsd-license.php.
|
||||
|
||||
|
||||
|
||||
THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
|
||||
|
||||
WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
Module Name:
|
||||
|
||||
Stall.c
|
||||
|
||||
Abstract:
|
||||
|
||||
Produce Stall Ppi.
|
||||
|
||||
--*/
|
||||
|
||||
|
||||
#include "PlatformEarlyInit.h"
|
||||
|
||||
|
||||
/**
|
||||
|
||||
Waits for at least the given number of microseconds.
|
||||
|
||||
@param PeiServices General purpose services available to every PEIM.
|
||||
@param This PPI instance structure.
|
||||
@param Microseconds Desired length of time to wait.
|
||||
|
||||
@retval EFI_SUCCESS If the desired amount of time was passed.
|
||||
|
||||
*/
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
Stall (
|
||||
IN CONST EFI_PEI_SERVICES **PeiServices,
|
||||
IN CONST EFI_PEI_STALL_PPI *This,
|
||||
IN UINTN Microseconds
|
||||
)
|
||||
{
|
||||
UINTN Ticks;
|
||||
UINTN Counts;
|
||||
UINT32 CurrentTick;
|
||||
UINT32 OriginalTick;
|
||||
UINT32 RemainingTick;
|
||||
|
||||
if (Microseconds == 0) {
|
||||
return EFI_SUCCESS;
|
||||
}
|
||||
|
||||
OriginalTick = IoRead32 (ACPI_BASE_ADDRESS + R_PCH_ACPI_PM1_TMR);
|
||||
OriginalTick &= (V_PCH_ACPI_PM1_TMR_MAX_VAL - 1);
|
||||
CurrentTick = OriginalTick;
|
||||
|
||||
//
|
||||
// The timer frequency is 3.579545MHz, so 1 ms corresponds to 3.58 clocks
|
||||
//
|
||||
Ticks = Microseconds * 358 / 100 + OriginalTick + 1;
|
||||
|
||||
//
|
||||
// The loops needed for timer overflow
|
||||
//
|
||||
Counts = (UINTN)RShiftU64((UINT64)Ticks, 24);
|
||||
|
||||
//
|
||||
// Remaining clocks within one loop
|
||||
//
|
||||
RemainingTick = Ticks & 0xFFFFFF;
|
||||
|
||||
//
|
||||
// Do not intend to use TMROF_STS bit of register PM1_STS, because this add extra
|
||||
// one I/O operation, and may generate SMI
|
||||
//
|
||||
while (Counts != 0) {
|
||||
CurrentTick = IoRead32 (ACPI_BASE_ADDRESS + R_PCH_ACPI_PM1_TMR) & B_PCH_ACPI_PM1_TMR_VAL;
|
||||
if (CurrentTick <= OriginalTick) {
|
||||
Counts--;
|
||||
}
|
||||
OriginalTick = CurrentTick;
|
Reference in New Issue
Block a user