mirror of https://github.com/acidanthera/audk.git
127 lines
2.4 KiB
C
127 lines
2.4 KiB
C
/** @file
|
|
|
|
Copyright (c) 2004 - 2014, Intel Corporation. All rights reserved.<BR>
|
|
|
|
|
|
SPDX-License-Identifier: BSD-2-Clause-Patent
|
|
|
|
|
|
|
|
|
|
Module Name:
|
|
|
|
Module Name:
|
|
|
|
LpcSio.c
|
|
|
|
Abstract: Sio implementation
|
|
|
|
Revision History
|
|
|
|
--*/
|
|
|
|
#include "LpcDriver.h"
|
|
#include <Library/S3BootScriptLib.h>
|
|
|
|
VOID
|
|
WriteRegister (
|
|
IN UINT8 Index,
|
|
IN UINT8 Data
|
|
);
|
|
|
|
typedef struct {
|
|
UINT8 Register;
|
|
UINT8 Value;
|
|
} EFI_SIO_TABLE;
|
|
|
|
EFI_SIO_TABLE mSioTable[] = {
|
|
//
|
|
// Init keyboard controller
|
|
//
|
|
{ REG_LOGICAL_DEVICE, SIO_KEYBOARD },
|
|
{ BASE_ADDRESS_HIGH, 0x00 },
|
|
{ BASE_ADDRESS_LOW, 0x60 },
|
|
{ BASE_ADDRESS_HIGH2, 0x00 },
|
|
{ BASE_ADDRESS_LOW2, 0x64 },
|
|
{ PRIMARY_INTERRUPT_SELECT, 0x01 },
|
|
{ ACTIVATE, 0x1 },
|
|
|
|
//
|
|
// Init Mouse controller
|
|
//
|
|
{ REG_LOGICAL_DEVICE, SIO_MOUSE },
|
|
{ BASE_ADDRESS_HIGH, 0x00 },
|
|
{ BASE_ADDRESS_LOW, 0x60 },
|
|
{ BASE_ADDRESS_HIGH2, 0x00 },
|
|
{ BASE_ADDRESS_LOW2, 0x64 },
|
|
{ PRIMARY_INTERRUPT_SELECT, 0x0c },
|
|
{ ACTIVATE, 0x1 },
|
|
|
|
{ REG_LOGICAL_DEVICE, SIO_COM },
|
|
{ BASE_ADDRESS_HIGH, 0x03 },
|
|
{ BASE_ADDRESS_LOW, 0xf8 },
|
|
{ PRIMARY_INTERRUPT_SELECT, 0x04 },
|
|
{ ACTIVATE, 0x1 },
|
|
|
|
|
|
};
|
|
|
|
VOID
|
|
LPCWPCE791SetDefault ()
|
|
{
|
|
UINT8 Index;
|
|
|
|
for (Index = 0; Index < sizeof(mSioTable)/sizeof(EFI_SIO_TABLE); Index++) {
|
|
WriteRegisterAndSaveToScript (mSioTable[Index].Register, mSioTable[Index].Value);
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
VOID
|
|
DisableLogicalDevice (
|
|
UINT8 DeviceId
|
|
)
|
|
{
|
|
WriteRegisterAndSaveToScript (REG_LOGICAL_DEVICE, DeviceId);
|
|
WriteRegisterAndSaveToScript (ACTIVATE, 0);
|
|
WriteRegisterAndSaveToScript (BASE_ADDRESS_HIGH, 0);
|
|
WriteRegisterAndSaveToScript (BASE_ADDRESS_LOW, 0);
|
|
|
|
return;
|
|
}
|
|
|
|
VOID
|
|
WriteRegister (
|
|
IN UINT8 Index,
|
|
IN UINT8 Data
|
|
)
|
|
{
|
|
LpcIoWrite8(CONFIG_PORT, Index);
|
|
LpcIoWrite8(DATA_PORT, Data);
|
|
|
|
return;
|
|
}
|
|
|
|
VOID
|
|
WriteRegisterAndSaveToScript (
|
|
IN UINT8 Index,
|
|
IN UINT8 Data
|
|
)
|
|
{
|
|
UINT8 Buffer[2];
|
|
|
|
LpcIoWrite8(CONFIG_PORT, Index);
|
|
LpcIoWrite8(DATA_PORT, Data);
|
|
|
|
Buffer[0] = Index;
|
|
Buffer[1] = Data;
|
|
S3BootScriptSaveIoWrite (
|
|
EfiBootScriptWidthUint8,
|
|
INDEX_PORT,
|
|
2,
|
|
Buffer
|
|
);
|
|
|
|
return;
|
|
}
|
|
|