ubuntu20.04 init

hc

2024-03-25 edb30157bad0c0001c32b854271ace01d3b9a16a

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
/** @file 
  Library functions for Config Block management. 
 
Copyright (c) 2017 - 2019, Intel Corporation. All rights reserved.<BR> 
SPDX-License-Identifier: BSD-2-Clause-Patent 
 
**/ 
#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))) { 
    return EFI_INVALID_PARAMETER; 
  } 
 
  ConfigBlkTblAddrPtr = (CONFIG_BLOCK_TABLE_HEADER *)AllocateZeroPool (TotalSize); 
  if (ConfigBlkTblAddrPtr == NULL) { 
    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; 
 
  if ((ConfigBlkSize % 4) != 0) { 
    return EFI_INVALID_PARAMETER; 
  } 
  if (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; 
  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; 
  } 
 
  return EFI_NOT_FOUND; 
}