MdeModulePkg: Fix use-after-free error in InstallConfigurationTable()

[mirror_edk2.git] / Vlv2TbltDevicePkg / Wpce791 / LpcSio.c

/** @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
Module Name:\r
\r
    LpcSio.c\r
\r
Abstract: Sio implementation\r
\r
Revision History\r
\r
--*/\r
\r
#include "LpcDriver.h"\r
#include <Library/S3BootScriptLib.h>\r
\r
VOID\r
WriteRegister (\r
  IN  UINT8   Index,\r
  IN  UINT8   Data\r
  );\r
\r
typedef struct {\r
  UINT8 Register;\r
  UINT8 Value;\r
} EFI_SIO_TABLE;\r
\r
EFI_SIO_TABLE mSioTable[] = {\r
  //\r
  // Init keyboard controller\r
  //\r
  { REG_LOGICAL_DEVICE, SIO_KEYBOARD },\r
  { BASE_ADDRESS_HIGH, 0x00 },\r
  { BASE_ADDRESS_LOW, 0x60 },\r
  { BASE_ADDRESS_HIGH2, 0x00 },\r
  { BASE_ADDRESS_LOW2, 0x64 },\r
  { PRIMARY_INTERRUPT_SELECT, 0x01 },\r
  { ACTIVATE, 0x1 },\r
\r
  //\r
  // Init Mouse controller\r
  //\r
  { REG_LOGICAL_DEVICE, SIO_MOUSE },\r
  { BASE_ADDRESS_HIGH, 0x00 },\r
  { BASE_ADDRESS_LOW, 0x60 },\r
  { BASE_ADDRESS_HIGH2, 0x00 },\r
  { BASE_ADDRESS_LOW2, 0x64 },\r
  { PRIMARY_INTERRUPT_SELECT, 0x0c },\r
  { ACTIVATE, 0x1 },\r
\r
  { REG_LOGICAL_DEVICE, SIO_COM },\r
  { BASE_ADDRESS_HIGH, 0x03 },\r
  { BASE_ADDRESS_LOW, 0xf8 },\r
  { PRIMARY_INTERRUPT_SELECT, 0x04 },\r
  { ACTIVATE, 0x1 },\r
\r
\r
};\r
\r
VOID\r
LPCWPCE791SetDefault ()\r
{\r
  UINT8           Index;\r
\r
  for (Index = 0; Index < sizeof(mSioTable)/sizeof(EFI_SIO_TABLE); Index++) {\r
    WriteRegisterAndSaveToScript (mSioTable[Index].Register, mSioTable[Index].Value);\r
  }\r
\r
  return;\r
}\r
\r
VOID\r
DisableLogicalDevice (\r
  UINT8       DeviceId\r
  )\r
{\r
  WriteRegisterAndSaveToScript (REG_LOGICAL_DEVICE, DeviceId);\r
  WriteRegisterAndSaveToScript (ACTIVATE, 0);\r
  WriteRegisterAndSaveToScript (BASE_ADDRESS_HIGH, 0);\r
  WriteRegisterAndSaveToScript (BASE_ADDRESS_LOW, 0);\r
\r
  return;\r
}\r
\r
VOID\r
WriteRegister (\r
  IN  UINT8   Index,\r
  IN  UINT8   Data\r
  )\r
{\r
  LpcIoWrite8(CONFIG_PORT, Index);\r
  LpcIoWrite8(DATA_PORT, Data);\r
\r
  return;\r
}\r
\r
VOID\r
WriteRegisterAndSaveToScript (\r
  IN  UINT8   Index,\r
  IN  UINT8   Data\r
  )\r
{\r
  UINT8  Buffer[2];\r
\r
  LpcIoWrite8(CONFIG_PORT, Index);\r
  LpcIoWrite8(DATA_PORT, Data);\r
\r
  Buffer[0] = Index;\r
  Buffer[1] = Data;\r
  S3BootScriptSaveIoWrite (\r
    EfiBootScriptWidthUint8,\r
    INDEX_PORT,\r
    2,\r
    Buffer\r
    );\r
\r
  return;\r
}\r
\r