Fix a bug for vlan ping failure.

[mirror_edk2.git] / MdeModulePkg / Universal / TimestampDxe / TimestampDxe.c

/** @file\r
  Implementation of Timestamp Protocol using UEFI APIs.\r
  \r
Copyright (c) 2013, Intel Corporation. All rights reserved.<BR>\r
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
\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
\r
**/\r
\r
#include <Uefi.h>\r
#include <Library/DebugLib.h>\r
#include <Library/UefiDriverEntryPoint.h>\r
#include <Library/UefiBootServicesTableLib.h>\r
#include <Library/TimerLib.h>\r
#include <Library/BaseMemoryLib.h>\r
#include <Protocol/Timestamp.h>\r
\r
//\r
// The StartValue in TimerLib\r
//\r
UINT64 mTimerLibStartValue = 0;\r
\r
//\r
// The EndValue in TimerLib\r
//\r
UINT64 mTimerLibEndValue = 0;\r
\r
//\r
// The properties of timestamp\r
//\r
EFI_TIMESTAMP_PROPERTIES mTimestampProperties = {\r
  0,\r
  0\r
};\r
\r
/**\r
  Retrieves the current value of a 64-bit free running timestamp counter.\r
\r
  The counter shall count up in proportion to the amount of time that has passed. The counter value\r
  will always roll over to zero. The properties of the counter can be retrieved from GetProperties().\r
  The caller should be prepared for the function to return the same value twice across successive calls.\r
  The counter value will not go backwards other than when wrapping, as defined by EndValue in GetProperties().\r
  The frequency of the returned timestamp counter value must remain constant. Power management operations that \r
  affect clocking must not change the returned counter frequency. The quantization of counter value updates may \r
  vary as long as the value reflecting time passed remains consistent.           \r
\r
  @retval The current value of the free running timestamp counter.\r
\r
**/\r
UINT64\r
EFIAPI\r
TimestampDriverGetTimestamp (\r
  VOID\r
  )\r
{\r
  //\r
  // The timestamp of Timestamp Protocol\r
  //\r
  UINT64  TimestampValue;\r
  TimestampValue = 0;\r
  \r
  //\r
  // Get the timestamp\r
  //\r
  if (mTimerLibStartValue > mTimerLibEndValue) {\r
    TimestampValue = mTimerLibStartValue - GetPerformanceCounter();\r
  } else {\r
    TimestampValue = GetPerformanceCounter() - mTimerLibStartValue;\r
  }\r
    \r
  return TimestampValue;\r
}\r
\r
/**\r
  Obtains timestamp counter properties including frequency and value limits.\r
\r
  @param[out]  Properties              The properties of the timestamp counter.\r
\r
  @retval      EFI_SUCCESS             The properties were successfully retrieved. \r
  @retval      EFI_DEVICE_ERROR        An error occurred trying to retrieve the properties of the timestamp \r
                                       counter subsystem. Properties is not pedated.                                \r
  @retval      EFI_INVALID_PARAMETER   Properties is NULL.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
TimestampDriverGetProperties(\r
  OUT   EFI_TIMESTAMP_PROPERTIES       *Properties\r
  )\r
{\r
  if (Properties == NULL) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
  \r
  //\r
  // Get timestamp properties\r
  //\r
  CopyMem((VOID *) Properties, (VOID *) &mTimestampProperties, sizeof (mTimestampProperties));\r
  \r
  return EFI_SUCCESS;\r
}\r
\r
//\r
// The Timestamp Protocol instance produced by this driver\r
//\r
EFI_TIMESTAMP_PROTOCOL  mTimestamp = {\r
  TimestampDriverGetTimestamp,\r
  TimestampDriverGetProperties\r
};\r
\r
/**\r
  Entry point of the Timestamp Protocol driver.\r
\r
  @param  ImageHandle   The image handle of this driver.\r
  @param  SystemTable   The pointer of EFI_SYSTEM_TABLE.\r
\r
  @retval EFI_SUCCESS   Watchdog Timer Architectural Protocol successfully installed.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
TimestampDriverInitialize (\r
  IN EFI_HANDLE        ImageHandle,\r
  IN EFI_SYSTEM_TABLE  *SystemTable\r
  )\r
{\r
  EFI_STATUS  Status;\r
  \r
  EFI_HANDLE  TimestampHandle;\r
  TimestampHandle = NULL;\r
  \r
  //\r
  // Get the start value, end value and frequency in Timerlib\r
  //\r
  mTimestampProperties.Frequency = GetPerformanceCounterProperties(&mTimerLibStartValue, &mTimerLibEndValue);\r
  \r
  //\r
  // Set the EndValue \r
  //\r
  if (mTimerLibEndValue > mTimerLibStartValue) {\r
    mTimestampProperties.EndValue = mTimerLibEndValue - mTimerLibStartValue;\r
  } else {\r
    mTimestampProperties.EndValue = mTimerLibStartValue - mTimerLibEndValue;\r
  }\r
  \r
  DEBUG ((EFI_D_INFO, "TimerFrequency:0x%lx, TimerLibStartTime:0x%lx, TimerLibEndtime:0x%lx\n", mTimestampProperties.Frequency, mTimerLibStartValue, mTimerLibEndValue));\r
  \r
  //\r
  // Install the Timestamp Protocol onto a new handle\r
  //\r
  Status = gBS->InstallMultipleProtocolInterfaces (\r
                  &TimestampHandle,\r
                  &gEfiTimestampProtocolGuid,\r
                  &mTimestamp,\r
                  NULL\r
                  );\r
                  \r
  ASSERT_EFI_ERROR (Status);\r
\r
  return EFI_SUCCESS;\r
}\r