2018-04-23 16:55:18 +02:00
|
|
|
/** @file
|
|
|
|
|
|
|
|
Copyright (c) 2011 - 2014, ARM Ltd. All rights reserved.<BR>
|
|
|
|
Copyright (c) 2014 - 2018, Linaro Ltd. All rights reserved.<BR>
|
|
|
|
|
2019-04-04 01:03:23 +02:00
|
|
|
SPDX-License-Identifier: BSD-2-Clause-Patent
|
2018-04-23 16:55:18 +02:00
|
|
|
|
|
|
|
**/
|
|
|
|
|
|
|
|
#include <Library/ArmGenericTimerCounterLib.h>
|
|
|
|
#include <Library/ArmLib.h>
|
|
|
|
|
|
|
|
VOID
|
|
|
|
EFIAPI
|
|
|
|
ArmGenericTimerEnableTimer (
|
|
|
|
VOID
|
|
|
|
)
|
|
|
|
{
|
|
|
|
UINTN TimerCtrlReg;
|
|
|
|
|
|
|
|
TimerCtrlReg = ArmReadCntvCtl ();
|
|
|
|
TimerCtrlReg |= ARM_ARCH_TIMER_ENABLE;
|
|
|
|
ArmWriteCntvCtl (TimerCtrlReg);
|
|
|
|
}
|
|
|
|
|
|
|
|
VOID
|
|
|
|
EFIAPI
|
|
|
|
ArmGenericTimerReenableTimer (
|
|
|
|
VOID
|
|
|
|
)
|
|
|
|
{
|
|
|
|
UINTN TimerCtrlReg;
|
|
|
|
|
|
|
|
TimerCtrlReg = ArmReadCntvCtl ();
|
|
|
|
TimerCtrlReg |= ARM_ARCH_TIMER_ENABLE;
|
|
|
|
|
|
|
|
//
|
|
|
|
// When running under Xen, we need to unmask the interrupt on the timer side
|
|
|
|
// as Xen will mask it when servicing the interrupt at the hypervisor level
|
|
|
|
// and delivering the virtual timer interrupt to the guest. Otherwise, the
|
|
|
|
// interrupt will fire again, trapping into the hypervisor again, etc. etc.
|
|
|
|
//
|
|
|
|
TimerCtrlReg &= ~ARM_ARCH_TIMER_IMASK;
|
|
|
|
ArmWriteCntvCtl (TimerCtrlReg);
|
|
|
|
}
|
|
|
|
|
|
|
|
VOID
|
|
|
|
EFIAPI
|
|
|
|
ArmGenericTimerDisableTimer (
|
|
|
|
VOID
|
|
|
|
)
|
|
|
|
{
|
|
|
|
UINTN TimerCtrlReg;
|
|
|
|
|
|
|
|
TimerCtrlReg = ArmReadCntvCtl ();
|
|
|
|
TimerCtrlReg &= ~ARM_ARCH_TIMER_ENABLE;
|
|
|
|
ArmWriteCntvCtl (TimerCtrlReg);
|
|
|
|
}
|
|
|
|
|
|
|
|
VOID
|
|
|
|
EFIAPI
|
|
|
|
ArmGenericTimerSetTimerFreq (
|
|
|
|
IN UINTN FreqInHz
|
|
|
|
)
|
|
|
|
{
|
|
|
|
ArmWriteCntFrq (FreqInHz);
|
|
|
|
}
|
|
|
|
|
|
|
|
UINTN
|
|
|
|
EFIAPI
|
|
|
|
ArmGenericTimerGetTimerFreq (
|
|
|
|
VOID
|
|
|
|
)
|
|
|
|
{
|
|
|
|
return ArmReadCntFrq ();
|
|
|
|
}
|
|
|
|
|
|
|
|
UINTN
|
|
|
|
EFIAPI
|
|
|
|
ArmGenericTimerGetTimerVal (
|
|
|
|
VOID
|
|
|
|
)
|
|
|
|
{
|
|
|
|
return ArmReadCntvTval ();
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
VOID
|
|
|
|
EFIAPI
|
|
|
|
ArmGenericTimerSetTimerVal (
|
|
|
|
IN UINTN Value
|
|
|
|
)
|
|
|
|
{
|
|
|
|
ArmWriteCntvTval (Value);
|
|
|
|
}
|
|
|
|
|
|
|
|
UINT64
|
|
|
|
EFIAPI
|
|
|
|
ArmGenericTimerGetSystemCount (
|
|
|
|
VOID
|
|
|
|
)
|
|
|
|
{
|
|
|
|
return ArmReadCntvCt ();
|
|
|
|
}
|
|
|
|
|
|
|
|
UINTN
|
|
|
|
EFIAPI
|
|
|
|
ArmGenericTimerGetTimerCtrlReg (
|
|
|
|
VOID
|
|
|
|
)
|
|
|
|
{
|
|
|
|
return ArmReadCntvCtl ();
|
|
|
|
}
|
|
|
|
|
|
|
|
VOID
|
|
|
|
EFIAPI
|
|
|
|
ArmGenericTimerSetTimerCtrlReg (
|
|
|
|
UINTN Value
|
|
|
|
)
|
|
|
|
{
|
|
|
|
ArmWriteCntvCtl (Value);
|
|
|
|
}
|
|
|
|
|
|
|
|
UINT64
|
|
|
|
EFIAPI
|
|
|
|
ArmGenericTimerGetCompareVal (
|
|
|
|
VOID
|
|
|
|
)
|
|
|
|
{
|
|
|
|
return ArmReadCntvCval ();
|
|
|
|
}
|
|
|
|
|
|
|
|
VOID
|
|
|
|
EFIAPI
|
|
|
|
ArmGenericTimerSetCompareVal (
|
|
|
|
IN UINT64 Value
|
|
|
|
)
|
|
|
|
{
|
|
|
|
ArmWriteCntvCval (Value);
|
|
|
|
}
|