ArmPkg/CompilerIntrinsicsLib: Add uread, uwrite GCC assembly sources

[mirror_edk2.git] / Omap35xxPkg / Library / Omap35xxTimerLib / TimerLib.c

diff --git a/Omap35xxPkg/Library/Omap35xxTimerLib/TimerLib.c b/Omap35xxPkg/Library/Omap35xxTimerLib/TimerLib.c
index 1b1f2a9dbe227ba26042174555dfe37b99ae5614..a69cad83a9293a08b7ff134e57794ee4e38ee081 100644 (file)
--- a/Omap35xxPkg/Library/Omap35xxTimerLib/TimerLib.c
+++ b/Omap35xxPkg/Library/Omap35xxTimerLib/TimerLib.c
@@ -1,18 +1,12 @@
 /** @file\r
 \r
-  Copyright (c) 2008-2009, Apple Inc. All rights reserved.\r
-  \r
-  All rights reserved. This program and the accompanying materials\r
-  are licensed and made available under the terms and conditions of the BSD License\r
-  which accompanies this distribution.  The full text of the license may be found at\r
-  http://opensource.org/licenses/bsd-license.php\r
+  Copyright (c) 2008 - 2009, Apple Inc. All rights reserved.<BR>\r
 \r
-  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
-  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
+  SPDX-License-Identifier: BSD-2-Clause-Patent\r
 \r
 **/\r
 \r
-#include <Base.h>\r
+#include <Uefi.h>\r
 \r
 #include <Library/BaseLib.h>\r
 #include <Library/TimerLib.h>\r
@@ -23,6 +17,37 @@
 \r
 #include <Omap3530/Omap3530.h>\r
 \r
+RETURN_STATUS\r
+EFIAPI\r
+TimerConstructor (\r
+  VOID\r
+  )\r
+{\r
+  UINTN  Timer            = PcdGet32(PcdOmap35xxFreeTimer);\r
+  UINT32 TimerBaseAddress = TimerBase(Timer);\r
+\r
+  if ((MmioRead32 (TimerBaseAddress + GPTIMER_TCLR) & TCLR_ST_ON) == 0) {\r
+    // Set source clock for GPT3 & GPT4 to SYS_CLK\r
+    MmioOr32 (CM_CLKSEL_PER, CM_CLKSEL_PER_CLKSEL_GPT3_SYS | CM_CLKSEL_PER_CLKSEL_GPT4_SYS);\r
+\r
+    // Set count & reload registers\r
+    MmioWrite32 (TimerBaseAddress + GPTIMER_TCRR, 0x00000000);\r
+    MmioWrite32 (TimerBaseAddress + GPTIMER_TLDR, 0x00000000);\r
+\r
+    // Disable interrupts\r
+    MmioWrite32 (TimerBaseAddress + GPTIMER_TIER, TIER_TCAR_IT_DISABLE | TIER_OVF_IT_DISABLE | TIER_MAT_IT_DISABLE);\r
+\r
+    // Start Timer\r
+    MmioWrite32 (TimerBaseAddress + GPTIMER_TCLR, TCLR_AR_AUTORELOAD | TCLR_ST_ON);\r
+\r
+    // Disable OMAP Watchdog timer (WDT2)\r
+    MmioWrite32 (WDTIMER2_BASE + WSPR, 0xAAAA);\r
+    DEBUG ((EFI_D_ERROR, "Magic delay to disable watchdog timers properly.\n"));\r
+    MmioWrite32 (WDTIMER2_BASE + WSPR, 0x5555);\r
+  }\r
+  return EFI_SUCCESS;\r
+}\r
+\r
 UINTN\r
 EFIAPI\r
 MicroSecondDelay (\r
@@ -30,10 +55,10 @@ MicroSecondDelay (
   )\r
 {\r
   UINT64  NanoSeconds;\r
-  \r
+\r
   NanoSeconds = MultU64x32(MicroSeconds, 1000);\r
 \r
-  while (NanoSeconds > (UINTN)-1) { \r
+  while (NanoSeconds > (UINTN)-1) {\r
     NanoSecondDelay((UINTN)-1);\r
     NanoSeconds -= (UINTN)-1;\r
   }\r
@@ -55,19 +80,19 @@ NanoSecondDelay (
   UINT32  ElapsedTime;\r
   UINT32  TimerCountRegister;\r
 \r
-  Delay = (NanoSeconds / PcdGet32(PcdEmbeddedFdPerformanceCounterPeriodInNanoseconds)) + 1;\r
-  \r
+  Delay = (NanoSeconds / PcdGet32(PcdEmbeddedPerformanceCounterPeriodInNanoseconds)) + 1;\r
+\r
   TimerCountRegister = TimerBase(PcdGet32(PcdOmap35xxFreeTimer)) + GPTIMER_TCRR;\r
 \r
   StartTime = MmioRead32 (TimerCountRegister);\r
 \r
-  do \r
+  do\r
   {\r
     CurrentTime = MmioRead32 (TimerCountRegister);\r
     ElapsedTime = CurrentTime - StartTime;\r
   } while (ElapsedTime < Delay);\r
 \r
-  NanoSeconds = ElapsedTime * PcdGet32(PcdEmbeddedFdPerformanceCounterPeriodInNanoseconds);\r
+  NanoSeconds = ElapsedTime * PcdGet32(PcdEmbeddedPerformanceCounterPeriodInNanoseconds);\r
 \r
   return NanoSeconds;\r
 }\r
@@ -77,7 +102,7 @@ EFIAPI
 GetPerformanceCounter (\r
   VOID\r
   )\r
-{ \r
+{\r
   return (UINT64)MmioRead32 (TimerBase(PcdGet32(PcdOmap35xxFreeTimer)) + GPTIMER_TCRR);\r
 }\r
 \r
@@ -92,11 +117,35 @@ GetPerformanceCounterProperties (
     // Timer starts with the reload value\r
     *StartValue = (UINT64)MmioRead32 (TimerBase(PcdGet32(PcdOmap35xxFreeTimer)) + GPTIMER_TLDR);\r
   }\r
-  \r
+\r
   if (EndValue != NULL) {\r
     // Timer counts up to 0xFFFFFFFF\r
     *EndValue = 0xFFFFFFFF;\r
   }\r
-  \r
-  return PcdGet64(PcdEmbeddedPerformanceCounterFreqencyInHz);\r
+\r
+  return PcdGet64(PcdEmbeddedPerformanceCounterFrequencyInHz);\r
+}\r
+\r
+/**\r
+  Converts elapsed ticks of performance counter to time in nanoseconds.\r
+\r
+  This function converts the elapsed ticks of running performance counter to\r
+  time value in unit of nanoseconds.\r
+\r
+  @param  Ticks     The number of elapsed ticks of running performance counter.\r
+\r
+  @return The elapsed time in nanoseconds.\r
+\r
+**/\r
+UINT64\r
+EFIAPI\r
+GetTimeInNanoSecond (\r
+  IN      UINT64                     Ticks\r
+  )\r
+{\r
+  UINT32 Period;\r
+\r
+  Period = PcdGet32 (PcdEmbeddedPerformanceCounterPeriodInNanoseconds);\r
+\r
+  return (Ticks * Period);\r
 }\r