mirror of https://github.com/acidanthera/audk.git
95 lines
2.5 KiB
C
95 lines
2.5 KiB
C
/*++
|
|
|
|
Copyright (c) 1999 - 2014, Intel Corporation. All rights reserved
|
|
|
|
|
|
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:
|
|
|
|
SmmIo.c
|
|
|
|
Abstract:
|
|
|
|
SMM I/O access utility implementation file, for Ia32
|
|
|
|
--*/
|
|
|
|
//
|
|
// Include files
|
|
//
|
|
#include "Library/StallSmmLib.h"
|
|
#include "Pi/PiSmmCis.h"
|
|
#include "PiDxe.h"
|
|
#include <Library/IoLib.h>
|
|
#include <Library/PcdLib.h>
|
|
#include "PchAccess.h"
|
|
|
|
/**
|
|
Delay for at least the request number of microseconds.
|
|
Timer used is ACPI time counter, which has 1us granularity.
|
|
|
|
@param Microseconds Number of microseconds to delay.
|
|
|
|
@retval None
|
|
|
|
**/
|
|
VOID
|
|
SmmStall (
|
|
IN UINTN Microseconds
|
|
)
|
|
{
|
|
UINTN Ticks;
|
|
UINTN Counts;
|
|
UINTN CurrentTick;
|
|
UINTN OriginalTick;
|
|
UINTN RemainingTick;
|
|
UINT16 AcpiBaseAddr;
|
|
|
|
if (Microseconds == 0) {
|
|
return;
|
|
}
|
|
|
|
AcpiBaseAddr = PchLpcPciCfg16 (R_PCH_LPC_ACPI_BASE) & B_PCH_LPC_ACPI_BASE_BAR;
|
|
|
|
OriginalTick = IoRead32 (AcpiBaseAddr + R_PCH_ACPI_PM1_TMR);
|
|
CurrentTick = OriginalTick;
|
|
|
|
//
|
|
// The timer frequency is 3.579545 MHz, so 1 ms corresponds 3.58 clocks
|
|
//
|
|
Ticks = Microseconds * 358 / 100 + OriginalTick + 1;
|
|
|
|
//
|
|
// The loops needed by timer overflow
|
|
//
|
|
Counts = Ticks / V_PCH_ACPI_PM1_TMR_MAX_VAL;
|
|
|
|
//
|
|
// Remaining clocks within one loop
|
|
//
|
|
RemainingTick = Ticks % V_PCH_ACPI_PM1_TMR_MAX_VAL;
|
|
|
|
//
|
|
// not intend to use TMROF_STS bit of register PM1_STS, because this adds extra
|
|
// one I/O operation, and maybe generate SMI
|
|
//
|
|
while ((Counts != 0) || (RemainingTick > CurrentTick)) {
|
|
CurrentTick = IoRead32 (AcpiBaseAddr + R_PCH_ACPI_PM1_TMR);
|
|
//
|
|
// Check if timer overflow
|
|
//
|
|
if (CurrentTick < OriginalTick) {
|
|
Counts--;
|
|
}
|
|
OriginalTick = CurrentTick;
|
|
}
|
|
}
|