1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
|
/** @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;
}
|
