summaryrefslogtreecommitdiff
path: root/Vlv2TbltDevicePkg/Wpce791/LpcSio.c
blob: 8446d381f7156244e80aceca447d0458d6c553bd (plain)
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
127
128
129
130
131
/** @file

  Copyright (c) 2004  - 2014, Intel Corporation. All rights reserved.<BR>
                                                                                   

  This program and the accompanying materials are licensed and made available under

  the terms and conditions of the BSD License that accompanies this distribution.  

  The full text of the license may be found at                                     

  http://opensource.org/licenses/bsd-license.php.                                  

                                                                                   

  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,            

  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.    

                                                                                   


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;
}