Upload BSD-licensed Vlv2TbltDevicePkg and Vlv2DeviceRefCodePkg to

[mirror_edk2.git] / Vlv2TbltDevicePkg / PlatformInitPei / LegacySpeaker.c

diff --git a/Vlv2TbltDevicePkg/PlatformInitPei/LegacySpeaker.c b/Vlv2TbltDevicePkg/PlatformInitPei/LegacySpeaker.c
new file mode 100644 (file)
index 0000000..7ec276b
--- /dev/null
+++ b/Vlv2TbltDevicePkg/PlatformInitPei/LegacySpeaker.c
@@ -0,0 +1,173 @@
+/** @file\r
+\r
+  Copyright (c) 2004  - 2014, Intel Corporation. All rights reserved.<BR>\r
+                                                                                   \r\r
+  This program and the accompanying materials are licensed and made available under\r\r
+  the terms and conditions of the BSD License that accompanies this distribution.  \r\r
+  The full text of the license may be found at                                     \r\r
+  http://opensource.org/licenses/bsd-license.php.                                  \r\r
+                                                                                   \r\r
+  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,            \r\r
+  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.    \r\r
+                                                                                   \r\r
+\r
+Module Name:\r
+\r
+\r
+ LegacySpeaker.c\r
+\r
+Abstract:\r
+\r
+  This file implements PEIM for Legacy Speaker. This file is valid for platforms both\r
+  on IA32 and Itanium Product Family\r
+\r
+--*/\r
+\r
+#include "PlatformEarlyInit.h"\r
+\r
+EFI_STATUS\r
+OutputBeep (\r
+  IN  CONST EFI_PEI_SERVICES  **PeiServices,\r
+  IN  UINTN             NumberOfBeep,\r
+  IN  UINTN             BeepDuration,\r
+  IN  UINTN             TimerInterval\r
+  );\r
+\r
+/**\r
+  This function will enable the speaker to generate beep\r
+\r
+  @param PeiServices     PeiServices to locate PPI\r
+\r
+  @retval EFI_STATUS\r
+\r
+**/\r
+EFI_STATUS\r
+TurnOnSpeaker (\r
+  IN  CONST EFI_PEI_SERVICES    **PeiServices\r
+  )\r
+{\r
+  UINT8                   Data;\r
+  Data = IoRead8 (EFI_SPEAKER_CONTROL_PORT);\r
+  Data |= 0x03;\r
+  IoWrite8(EFI_SPEAKER_CONTROL_PORT, Data);\r
+  return EFI_SUCCESS;\r
+}\r
+\r
+/**\r
+  This function will stop beep from speaker.\r
+\r
+  @param  PeiServices     PeiServices to locate PPI\r
+\r
+  @retval Status\r
+\r
+**/\r
+EFI_STATUS\r
+TurnOffSpeaker (\r
+  IN  CONST EFI_PEI_SERVICES    **PeiServices\r
+  )\r
+{\r
+  UINT8                   Data;\r
+\r
+  Data = IoRead8 (EFI_SPEAKER_CONTROL_PORT);\r
+  Data &= 0xFC;\r
+  IoWrite8(EFI_SPEAKER_CONTROL_PORT, Data);\r
+  return EFI_SUCCESS;\r
+}\r
+\r
+\r
+EFI_STATUS\r
+OutputBeep (\r
+  IN  CONST EFI_PEI_SERVICES  **PeiServices,\r
+  IN  UINTN             NumberOfBeep,\r
+  IN  UINTN             BeepDuration,\r
+  IN  UINTN             TimeInterval\r
+  )\r
+{\r
+  UINTN           Num;\r
+  EFI_PEI_STALL_PPI*  StallPpi;\r
+\r
+  (**PeiServices).LocatePpi (PeiServices, &gEfiPeiStallPpiGuid, 0, NULL, (void **)&StallPpi);\r
+\r
+  for (Num=0; Num < NumberOfBeep; Num++) {\r
+    TurnOnSpeaker (PeiServices);\r
+    StallPpi->Stall(PeiServices, StallPpi, BeepDuration);\r
+    TurnOffSpeaker(PeiServices);\r
+    StallPpi->Stall(PeiServices, StallPpi, TimeInterval);\r
+  }\r
+\r
+  return EFI_SUCCESS;\r
+}\r
+\r
+/**\r
+  This function will program the speaker tone frequency. The value should be with 64k\r
+  boundary since it takes only 16 bit value which gets programmed in two step IO opearattion\r
+\r
+  Frequency     - A value which should be 16 bit only.\r
+\r
+  EFI_SUCESS\r
+\r
+**/\r
+EFI_STATUS\r
+EFIAPI\r
+ProgramToneFrequency (\r
+  IN  CONST EFI_PEI_SERVICES                  **PeiServices,\r
+  IN  UINT16                            Frequency\r
+  )\r
+{\r
+  UINT8                   Data;\r
+\r
+  Data = 0xB6;\r
+  IoWrite8(EFI_TIMER_CONTROL_PORT, Data);\r
+\r
+  Data = (UINT8)(Frequency & 0x00FF);\r
+  IoWrite8(EFI_TIMER_2_PORT, Data);\r
+  Data = (UINT8)((Frequency & 0xFF00) >> 8);\r
+  IoWrite8(EFI_TIMER_2_PORT, Data);\r
+  return EFI_SUCCESS;\r
+}\r
+\r
+/**\r
+  This function will generate the beep for specified duration.\r
+\r
+  @param  PeiServices       PeiServices to locate various PPIs\r
+  @param  NumberOfBeeps     Number of beeps which user want to produce\r
+  @param  BeepDuration      Duration for speaker gate need to be enabled\r
+  @param  TimeInterval      Interval between each beep\r
+\r
+  @retval EFI_STATUS\r
+\r
+**/\r
+EFI_STATUS\r
+EFIAPI\r
+GenerateBeepTone (\r
+  IN  CONST EFI_PEI_SERVICES                  **PeiServices,\r
+  IN  UINTN                             NumberOfBeeps,\r
+  IN  UINTN                             BeepDuration,\r
+  IN  UINTN                             TimeInterval\r
+  )\r
+{\r
+\r
+  if ((NumberOfBeeps == 1) && (BeepDuration == 0) && (TimeInterval == 0)) {\r
+    TurnOnSpeaker (PeiServices);\r
+    return EFI_SUCCESS;\r
+  }\r
+\r
+  if ((NumberOfBeeps == 0) && (BeepDuration == 0) && (TimeInterval == 0)) {\r
+    TurnOffSpeaker (PeiServices);\r
+    return EFI_SUCCESS;\r
+  }\r
+\r
+  if (BeepDuration == 0) {\r
+    BeepDuration = EFI_DEFAULT_SHORT_BEEP_DURATION;\r
+  }\r
+\r
+  if (TimeInterval == 0) {\r
+    TimeInterval = EFI_DEFAULT_BEEP_TIME_INTERVAL;\r
+  }\r
+\r
+  OutputBeep (PeiServices, NumberOfBeeps, BeepDuration, TimeInterval);\r
+  return EFI_SUCCESS;\r
+\r
+\r
+}\r
+\r