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
|
/** @file
*
* Copyright (c) 2016, Hisilicon Limited. All rights reserved.
* Copyright (c) 2016, Linaro Limited. All rights reserved.
*
* This program and the accompanying materials
* are licensed and made available under the terms and conditions of the BSD License
* which 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.
*
**/
#include <PiDxe.h>
#include <Library/DebugLib.h>
#include <Library/UefiBootServicesTableLib.h>
#include <Guid/EventGroup.h>
#include <Library/UefiRuntimeLib.h>
#include <Library/DxeServicesTableLib.h>
#include <Library/PcdLib.h>
#include <Library/IoLib.h>
#include <Library/CpldIoLib.h>
UINTN mCpldRegAddr;
EFI_EVENT mCpldVirtualAddressChangeEvent;
VOID
EFIAPI
CpldVirtualAddressChange (
IN EFI_EVENT Event,
IN VOID *Context
)
{
EfiConvertPointer (0, (VOID **) &mCpldRegAddr);
return;
}
RETURN_STATUS
EFIAPI
CpldRuntimeLibConstructor (
VOID
)
{
EFI_STATUS Status;
EFI_GCD_MEMORY_SPACE_DESCRIPTOR desp = {0};
mCpldRegAddr = PcdGet64(PcdCpldBaseAddress);
Status = gDS->GetMemorySpaceDescriptor(mCpldRegAddr,&desp);
if(EFI_ERROR(Status)){
DEBUG ((EFI_D_ERROR, "[%a]:[%dL] GetMemorySpaceDescriptor failed: %r\n", __FUNCTION__, __LINE__, Status));
return Status;
}
desp.Attributes |= EFI_MEMORY_RUNTIME;
Status = gDS->SetMemorySpaceAttributes(mCpldRegAddr,0x10000, desp.Attributes);
if(EFI_ERROR(Status)){
DEBUG ((EFI_D_ERROR, "[%a]:[%dL] SetMemorySpaceAttributes failed: %r\n", __FUNCTION__, __LINE__, Status));
return Status;
}
//
// Register notify function for EVT_SIGNAL_VIRTUAL_ADDRESS_CHANGE
//
Status = gBS->CreateEventEx (
EVT_NOTIFY_SIGNAL,
TPL_NOTIFY,
CpldVirtualAddressChange,
NULL,
&gEfiEventVirtualAddressChangeGuid,
&mCpldVirtualAddressChangeEvent
);
ASSERT_EFI_ERROR (Status);
return Status;
}
EFI_STATUS
EFIAPI
CpldRuntimeLibDestructor (
VOID
)
{
EFI_STATUS Status = EFI_SUCCESS;
if(!mCpldVirtualAddressChangeEvent ){
return Status;
}
Status = gBS->CloseEvent(mCpldVirtualAddressChangeEvent);
return Status;
}
VOID WriteCpldReg(UINTN ulRegAddr, UINT8 ulValue)
{
MmioWrite8 (ulRegAddr + mCpldRegAddr, ulValue);
}
UINT8 ReadCpldReg(UINTN ulRegAddr)
{
return MmioRead8 (ulRegAddr + mCpldRegAddr);
}
|
