Vlv2TbltDevicePkg: Replace BSD License with BSD+Patent License

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

/** @file\r
\r
  Copyright (c) 2004  - 2014, Intel Corporation. All rights reserved.<BR>\r
                                                                                   \r\r
  SPDX-License-Identifier: BSD-2-Clause-Patent\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