1 files changed, 111 insertions, 0 deletions
diff --git a/BraswellPlatformPkg/Common/Silicon/IntelSiliconBasic/PiSmmCpuDxeSmm/SyncTimer.c b/BraswellPlatformPkg/Common/Silicon/IntelSiliconBasic/PiSmmCpuDxeSmm/SyncTimer.c
new file mode 100644
index 0000000000..a2c2f1e75b
--- /dev/null
+++ b/BraswellPlatformPkg/Common/Silicon/IntelSiliconBasic/PiSmmCpuDxeSmm/SyncTimer.c
@@ -0,0 +1,111 @@
+/** @file
+
+  Copyright (c) 2012 - 2015, 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
+  which 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.
+
+**/
+
+#include "PiSmmCpuDxeSmm.h"
+
+UINT64   mTimeoutTicker = 0;
+//
+//  Number of counts in a roll-over cycle of the performance counter.
+//
+UINT64   mCycle = 0;
+//
+// Flag to indicate the performance counter is count-up or count-down.
+//
+BOOLEAN  mCountDown;
+
+/**
+  Initialize Timer for Smm AP Sync.
+
+**/
+VOID
+InitializeSmmTimer (
+  VOID
+  )
+{
+  UINT64  TimerFrequency;
+  UINT64  Start;
+  UINT64  End;
+
+  TimerFrequency = GetPerformanceCounterProperties (&Start, &End);
+  mTimeoutTicker = DivU64x32 (
+                     MultU64x64(TimerFrequency, PcdGet64 (PcdCpuSmmApSyncTimeout)),
+                     1000 * 1000
+                     );
+  if (End < Start) {
+    mCountDown = TRUE;
+    mCycle = Start - End;
+  } else {
+    mCountDown = FALSE;
+    mCycle = End - Start;
+  }
+}
+
+/**
+  Start Timer for Smm AP Sync.
+
+**/
+UINT64
+EFIAPI
+StartSyncTimer (
+  VOID
+  )
+{
+  return GetPerformanceCounter ();
+}
+
+/**
+  Check if the Smm AP Sync timer is timeout.
+
+  @param Timer  The start timer from the begin.
+
+**/
+BOOLEAN
+EFIAPI
+IsSyncTimerTimeout (
+  IN      UINT64                    Timer
+  )
+{
+  UINT64  CurrentTimer;
+  UINT64  Delta;
+
+  CurrentTimer = GetPerformanceCounter ();
+
+  if (mCountDown) {
+    //
+    // The performance counter counts down.  Check for roll over condition.
+    //
+    if (CurrentTimer < Timer) {
+      Delta = Timer - CurrentTimer;
+    } else {
+      //
+      // Handle one roll-over.
+      //
+      Delta = mCycle - (CurrentTimer - Timer);
+    }
+  } else {
+    //
+    // The performance counter counts up.  Check for roll over condition.
+    //
+    if (CurrentTimer > Timer) {
+      Delta = CurrentTimer - Timer;
+    } else {
+      //
+      // Handle one roll-over.
+      //
+      Delta = mCycle - (Timer - CurrentTimer);
+    }
+  }
+
+  return (BOOLEAN) (Delta >= mTimeoutTicker);
+}