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
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
|
/** @file
Library functions for Config Block management.
Copyright (c) 2017, 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 <ConfigBlock.h>
#include <Library/ConfigBlockLib.h>
#include <Library/BaseMemoryLib.h>
#include <Library/MemoryAllocationLib.h>
#include <Library/DebugLib.h>
/**
Create config block table
@param[in] TotalSize - Max size to be allocated for the Config Block Table
@param[out] ConfigBlockTableAddress - On return, points to a pointer to the beginning of Config Block Table Address
@retval EFI_INVALID_PARAMETER - Invalid Parameter
@retval EFI_OUT_OF_RESOURCES - Out of resources
@retval EFI_SUCCESS - Successfully created Config Block Table at ConfigBlockTableAddress
**/
EFI_STATUS
EFIAPI
CreateConfigBlockTable (
IN UINT16 TotalSize,
OUT VOID **ConfigBlockTableAddress
)
{
CONFIG_BLOCK_TABLE_HEADER *ConfigBlkTblAddrPtr;
UINT32 ConfigBlkTblHdrSize;
ConfigBlkTblHdrSize = (UINT32)(sizeof (CONFIG_BLOCK_TABLE_HEADER));
if (TotalSize <= (ConfigBlkTblHdrSize + sizeof (CONFIG_BLOCK_HEADER))) {
DEBUG ((DEBUG_ERROR, "Invalid Parameter\n"));
return EFI_INVALID_PARAMETER;
}
ConfigBlkTblAddrPtr = (CONFIG_BLOCK_TABLE_HEADER *)AllocateZeroPool (TotalSize);
if (ConfigBlkTblAddrPtr == NULL) {
DEBUG ((DEBUG_ERROR, "Could not allocate memory.\n"));
return EFI_OUT_OF_RESOURCES;
}
ConfigBlkTblAddrPtr->NumberOfBlocks = 0;
ConfigBlkTblAddrPtr->Header.GuidHob.Header.HobLength = TotalSize;
ConfigBlkTblAddrPtr->AvailableSize = TotalSize - ConfigBlkTblHdrSize;
*ConfigBlockTableAddress = (VOID *)ConfigBlkTblAddrPtr;
return EFI_SUCCESS;
}
/**
Add config block into config block table structure
@param[in] ConfigBlockTableAddress - A pointer to the beginning of Config Block Table Address
@param[out] ConfigBlockAddress - On return, points to a pointer to the beginning of Config Block Address
@retval EFI_OUT_OF_RESOURCES - Config Block Table is full and cannot add new Config Block or
Config Block Offset Table is full and cannot add new Config Block.
@retval EFI_SUCCESS - Successfully added Config Block
**/
EFI_STATUS
EFIAPI
AddConfigBlock (
IN VOID *ConfigBlockTableAddress,
OUT VOID **ConfigBlockAddress
)
{
CONFIG_BLOCK *TempConfigBlk;
CONFIG_BLOCK_TABLE_HEADER *ConfigBlkTblAddrPtr;
CONFIG_BLOCK *ConfigBlkAddrPtr;
UINT16 ConfigBlkSize;
ConfigBlkTblAddrPtr = (CONFIG_BLOCK_TABLE_HEADER *)ConfigBlockTableAddress;
ConfigBlkAddrPtr = (CONFIG_BLOCK *)(*ConfigBlockAddress);
ConfigBlkSize = ConfigBlkAddrPtr->Header.GuidHob.Header.HobLength;
DEBUG ((DEBUG_INFO, "Config Block GUID: %g / Config Block Size: 0x%x bytes\n", &(ConfigBlkAddrPtr->Header.GuidHob.Name), ConfigBlkSize));
if ((ConfigBlkSize % 4) != 0) {
DEBUG ((DEBUG_ERROR, "Config Block must be multiples of 4 bytes\n"));
return EFI_INVALID_PARAMETER;
}
if (ConfigBlkTblAddrPtr->AvailableSize < ConfigBlkSize) {
DEBUG ((DEBUG_ERROR, "Config Block Table is full and cannot add new Config Block.\n"));
DEBUG ((DEBUG_ERROR, "Available Config Block Size: 0x%x bytes / Requested Config Block Size: 0x%x bytes\n", ConfigBlkTblAddrPtr->AvailableSize, ConfigBlkSize));
return EFI_OUT_OF_RESOURCES;
}
TempConfigBlk = (CONFIG_BLOCK *)((UINTN)ConfigBlkTblAddrPtr + (UINTN)(ConfigBlkTblAddrPtr->Header.GuidHob.Header.HobLength - ConfigBlkTblAddrPtr->AvailableSize));
CopyMem (&TempConfigBlk->Header, &ConfigBlkAddrPtr->Header, sizeof(CONFIG_BLOCK_HEADER));
ConfigBlkTblAddrPtr->NumberOfBlocks++;
ConfigBlkTblAddrPtr->AvailableSize = ConfigBlkTblAddrPtr->AvailableSize - ConfigBlkSize;
*ConfigBlockAddress = (VOID *) TempConfigBlk;
DEBUG ((DEBUG_INFO, "Config Block Address: 0x%x / Available Config Block Size: 0x%x bytes\n", (UINT32)(UINTN)*ConfigBlockAddress, ConfigBlkTblAddrPtr->AvailableSize));
return EFI_SUCCESS;
}
/**
Retrieve a specific Config Block data by GUID
@param[in] ConfigBlockTableAddress - A pointer to the beginning of Config Block Table Address
@param[in] ConfigBlockGuid - A pointer to the GUID uses to search specific Config Block
@param[out] ConfigBlockAddress - On return, points to a pointer to the beginning of Config Block Address
@retval EFI_NOT_FOUND - Could not find the Config Block
@retval EFI_SUCCESS - Config Block found and return
**/
EFI_STATUS
EFIAPI
GetConfigBlock (
IN VOID *ConfigBlockTableAddress,
IN EFI_GUID *ConfigBlockGuid,
OUT VOID **ConfigBlockAddress
)
{
UINT16 OffsetIndex;
CONFIG_BLOCK *TempConfigBlk;
CONFIG_BLOCK_TABLE_HEADER *ConfigBlkTblAddrPtr;
UINT32 ConfigBlkTblHdrSize;
UINT32 ConfigBlkOffset;
UINT16 NumOfBlocks;
ConfigBlkTblHdrSize = (UINT32)(sizeof (CONFIG_BLOCK_TABLE_HEADER));
ConfigBlkTblAddrPtr = (CONFIG_BLOCK_TABLE_HEADER *)ConfigBlockTableAddress;
NumOfBlocks = ConfigBlkTblAddrPtr->NumberOfBlocks;
ConfigBlkOffset = 0;
for (OffsetIndex = 0; OffsetIndex < NumOfBlocks; OffsetIndex++) {
if ((ConfigBlkTblHdrSize + ConfigBlkOffset) > (ConfigBlkTblAddrPtr->Header.GuidHob.Header.HobLength)) {
break;
}
TempConfigBlk = (CONFIG_BLOCK *)((UINTN)ConfigBlkTblAddrPtr + (UINTN)ConfigBlkTblHdrSize + (UINTN)ConfigBlkOffset);
if (CompareGuid (&(TempConfigBlk->Header.GuidHob.Name), ConfigBlockGuid)) {
*ConfigBlockAddress = (VOID *)TempConfigBlk;
return EFI_SUCCESS;
}
ConfigBlkOffset = ConfigBlkOffset + TempConfigBlk->Header.GuidHob.Header.HobLength;
}
DEBUG ((DEBUG_ERROR, "Could not find the config block.\n"));
return EFI_NOT_FOUND;
}
|
