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
|
/** @file
Copyright (c) 2018, 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.
**/
#include "UsraAccessLib.h"
/**
This API get the CSR address from the given USRA Address.
@param[in] Global Global pointer
@param[in] Virtual Virtual address
@param[in] Address A pointer of the address of the USRA Address Structure
@param[out] AlignedAddress A pointer of aligned address converted from USRA address
@retval NONE
**/
VOID
GetCsrAccessAddress (
IN VOID *Global,
IN BOOLEAN Virtual,
IN USRA_ADDRESS *Address,
OUT UINTN *AlignedAddress
)
{
CsrGetPcieAlignAddress (Global, Virtual, Address, AlignedAddress);
}
/**
This API performs 8-bit, 16-bit, 32-bit or 64-bit CSR silicon register read operations.
It transfers data from a register into a naturally aligned data buffer.
@param[in] Address A pointer of the address of the USRA Address Structure to be read out
@param[in] Buffer A pointer of buffer for the value read from the register
@retval RETURN_SUCCESS The function completed successfully.
**/
RETURN_STATUS
CsrRegisterRead (
IN USRA_ADDRESS *Address,
IN VOID *Buffer
)
{
UINTN AlignedAddress = 0;
GetCsrAccessAddress (NULL, 0, Address, &AlignedAddress);
UsraRegAlignedRead((UINT32)Address->Attribute.AccessWidth, AlignedAddress, Buffer);
return RETURN_SUCCESS;
}
/**
This API performs 8-bit, 16-bit, 32-bit or 64-bit CSR silicon register write operations.
It transfers data from a naturally aligned data buffer into a register.
@param[in] Address A pointer of the address of the USRA Address Structure to be written
@param[in] Buffer A pointer of buffer for the value write to the register
@retval RETURN_SUCCESS The function completed successfully.
**/
RETURN_STATUS
CsrRegisterWrite (
IN USRA_ADDRESS *Address,
OUT VOID *Buffer
)
{
UINTN AlignedAddress = 0;
GetCsrAccessAddress (NULL, 0, Address, &AlignedAddress);
UsraRegAlignedWrite((UINT32)Address->Attribute.AccessWidth, AlignedAddress, Buffer);
if (FeaturePcdGet (PcdUsraSupportS3))
{
if(Address->Attribute.S3Enable)
{
S3BootScriptSaveMemWrite ((S3_BOOT_SCRIPT_LIB_WIDTH)Address->Attribute.AccessWidth, (UINT64)AlignedAddress, 1, Buffer);
}
}
return RETURN_SUCCESS;
}
/**
This API performs 8-bit, 16-bit, 32-bit or 64-bit CSR silicon register AND then OR operations. It read data from a
register, And it with the AndBuffer, then Or it with the OrBuffer, and write the result back to the register
@param[in] Address A pointer of the address of the silicon register to be written
@param[in] AndBuffer A pointer of buffer for the value used for AND operation
A NULL pointer means no AND operation. RegisterModify() equivalents to RegisterOr()
@param[in] OrBuffer A pointer of buffer for the value used for OR operation
A NULL pointer means no OR operation. RegisterModify() equivalents to RegisterAnd()
@retval RETURN_SUCCESS The function completed successfully.
**/
RETURN_STATUS
CsrRegisterModify (
IN USRA_ADDRESS *Address,
IN VOID *AndBuffer,
IN VOID *OrBuffer
)
{
UINT64 Data;
UINT8 WidthTable[] = {1,2,4,8};
UINTN AlignedAddress = 0;
GetCsrAccessAddress (NULL, 0, Address, &AlignedAddress);
UsraRegAlignedRead((UINT32)Address->Attribute.AccessWidth, AlignedAddress, &Data);
DataAndOr (&Data, AndBuffer, OrBuffer, WidthTable[(UINT8)Address->Attribute.AccessWidth]);
UsraRegAlignedWrite((UINT32)Address->Attribute.AccessWidth, AlignedAddress, &Data);
return RETURN_SUCCESS;
}
|
