Add in the 1st version of ECP.
git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@2832 6f19259b-4bc3-4df7-8a09-765794883524
This commit is contained in:
qwang12
648
EdkCompatibilityPkg/Foundation/Library/Pei/PeiLib/PeiLib.c
Normal file
648
EdkCompatibilityPkg/Foundation/Library/Pei/PeiLib/PeiLib.c
Normal file
@@ -0,0 +1,648 @@
|
||||
/*++
|
||||
|
||||
Copyright (c) 2004 - 2007, Intel Corporation
|
||||
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.
|
||||
|
||||
Module Name:
|
||||
|
||||
PeiLib.c
|
||||
|
||||
Abstract:
|
||||
|
||||
PEI Library Functions
|
||||
|
||||
--*/
|
||||
|
||||
#include "TianoCommon.h"
|
||||
#include "PeiHob.h"
|
||||
#include "Pei.h"
|
||||
#include "PeiLib.h"
|
||||
|
||||
|
||||
VOID
|
||||
PeiCopyMem (
|
||||
IN VOID *Destination,
|
||||
IN VOID *Source,
|
||||
IN UINTN Length
|
||||
);
|
||||
|
||||
VOID
|
||||
ZeroMem (
|
||||
IN VOID *Buffer,
|
||||
IN UINTN Size
|
||||
)
|
||||
/*++
|
||||
|
||||
Routine Description:
|
||||
|
||||
Set Buffer to zero for Size bytes.
|
||||
|
||||
Arguments:
|
||||
|
||||
Buffer - Memory to set.
|
||||
|
||||
Size - Number of bytes to set
|
||||
|
||||
Returns:
|
||||
|
||||
None
|
||||
|
||||
--*/
|
||||
{
|
||||
INT8 *Ptr;
|
||||
|
||||
Ptr = Buffer;
|
||||
while (Size--) {
|
||||
*(Ptr++) = 0;
|
||||
}
|
||||
}
|
||||
|
||||
VOID
|
||||
PeiCopyMem (
|
||||
IN VOID *Destination,
|
||||
IN VOID *Source,
|
||||
IN UINTN Length
|
||||
)
|
||||
/*++
|
||||
|
||||
Routine Description:
|
||||
|
||||
Copy Length bytes from Source to Destination.
|
||||
|
||||
Arguments:
|
||||
|
||||
Destination - Target of copy
|
||||
|
||||
Source - Place to copy from
|
||||
|
||||
Length - Number of bytes to copy
|
||||
|
||||
Returns:
|
||||
|
||||
None
|
||||
|
||||
--*/
|
||||
{
|
||||
CHAR8 *Destination8;
|
||||
CHAR8 *Source8;
|
||||
|
||||
Destination8 = Destination;
|
||||
Source8 = Source;
|
||||
if (((Source8 + Length) <= Destination8) || (Source8 >= Destination8)) {
|
||||
while (Length--) {
|
||||
*(Destination8++) = *(Source8++);
|
||||
}
|
||||
} else {
|
||||
while (Length--) {
|
||||
*(Destination8 + Length) = *(Source8 + Length);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
VOID
|
||||
CopyMem (
|
||||
IN VOID *Destination,
|
||||
IN VOID *Source,
|
||||
IN UINTN Length
|
||||
)
|
||||
/*++
|
||||
|
||||
Routine Description:
|
||||
|
||||
Copy Length bytes from Source to Destination.
|
||||
|
||||
Arguments:
|
||||
|
||||
Destination - Target of copy
|
||||
|
||||
Source - Place to copy from
|
||||
|
||||
Length - Number of bytes to copy
|
||||
|
||||
Returns:
|
||||
|
||||
None
|
||||
|
||||
--*/
|
||||
{
|
||||
CHAR8 *Destination8;
|
||||
CHAR8 *Source8;
|
||||
|
||||
Destination8 = Destination;
|
||||
Source8 = Source;
|
||||
if (((Source8 + Length) <= Destination8) || (Source8 >= Destination8)) {
|
||||
while (Length--) {
|
||||
*(Destination8++) = *(Source8++);
|
||||
}
|
||||
} else {
|
||||
while (Length--) {
|
||||
*(Destination8 + Length) = *(Source8 + Length);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
BOOLEAN
|
||||
CompareGuid (
|
||||
IN EFI_GUID *Guid1,
|
||||
IN EFI_GUID *Guid2
|
||||
)
|
||||
/*++
|
||||
|
||||
Routine Description:
|
||||
|
||||
Compares two GUIDs
|
||||
|
||||
Arguments:
|
||||
|
||||
Guid1 - guid to compare
|
||||
Guid2 - guid to compare
|
||||
|
||||
Returns:
|
||||
= TRUE if Guid1 == Guid2
|
||||
= FALSE if Guid1 != Guid2
|
||||
|
||||
--*/
|
||||
{
|
||||
if ((((INT32 *) Guid1)[0] - ((INT32 *) Guid2)[0]) == 0) {
|
||||
if ((((INT32 *) Guid1)[1] - ((INT32 *) Guid2)[1]) == 0) {
|
||||
if ((((INT32 *) Guid1)[2] - ((INT32 *) Guid2)[2]) == 0) {
|
||||
if ((((INT32 *) Guid1)[3] - ((INT32 *) Guid2)[3]) == 0) {
|
||||
return TRUE;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return FALSE;
|
||||
}
|
||||
|
||||
|
||||
#if (PI_SPECIFICATION_VERSION >= 0x00010000)
|
||||
|
||||
VOID *
|
||||
EFIAPI
|
||||
ScanGuid (
|
||||
IN VOID *Buffer,
|
||||
IN UINTN Length,
|
||||
IN EFI_GUID *Guid
|
||||
)
|
||||
/*++
|
||||
|
||||
Routine Description:
|
||||
|
||||
Scans a target buffer for a GUID, and returns a pointer to the matching GUID
|
||||
in the target buffer.
|
||||
|
||||
This function searches target the buffer specified by Buffer and Length from
|
||||
the lowest address to the highest address at 128-bit increments for the 128-bit
|
||||
GUID value that matches Guid. If a match is found, then a pointer to the matching
|
||||
GUID in the target buffer is returned. If no match is found, then NULL is returned.
|
||||
If Length is 0, then NULL is returned.
|
||||
If Length > 0 and Buffer is NULL, then ASSERT().
|
||||
If Buffer is not aligned on a 32-bit boundary, then ASSERT().
|
||||
If Length is not aligned on a 128-bit boundary, then ASSERT().
|
||||
If Length is greater than (EFI_MAX_ADDRESS ?Buffer + 1), then ASSERT().
|
||||
|
||||
Arguments:
|
||||
|
||||
Buffer - Pointer to the target buffer to scan.
|
||||
Length - Number of bytes in Buffer to scan.
|
||||
Guid - Value to search for in the target buffer.
|
||||
|
||||
Returns:
|
||||
A pointer to the matching Guid in the target buffer or NULL otherwise.
|
||||
|
||||
--*/
|
||||
{
|
||||
EFI_GUID *GuidPtr;
|
||||
EFI_PEI_SERVICES **PeiServices;
|
||||
|
||||
PeiServices = GetPeiServicesTablePointer();
|
||||
PEI_ASSERT(PeiServices, (((UINTN)Buffer & (sizeof (Guid->Data1) - 1)) == 0));
|
||||
PEI_ASSERT(PeiServices, (Length <= (EFI_MAX_ADDRESS - (UINTN)Buffer + 1)));
|
||||
PEI_ASSERT(PeiServices, ((Length & (sizeof (*GuidPtr) - 1)) == 0));
|
||||
|
||||
GuidPtr = (EFI_GUID*)Buffer;
|
||||
Buffer = GuidPtr + Length / sizeof (*GuidPtr);
|
||||
while (GuidPtr < (EFI_GUID*)Buffer) {
|
||||
if (CompareGuid (GuidPtr, Guid)) {
|
||||
return (VOID*)GuidPtr;
|
||||
}
|
||||
GuidPtr++;
|
||||
}
|
||||
return NULL;
|
||||
}
|
||||
|
||||
|
||||
VOID *
|
||||
EFIAPI
|
||||
InvalidateInstructionCacheRange (
|
||||
IN VOID *Address,
|
||||
IN UINTN Length
|
||||
)
|
||||
/*++
|
||||
|
||||
Routine Description:
|
||||
|
||||
Invalidates a range of instruction cache lines in the cache coherency domain
|
||||
of the calling CPU.
|
||||
|
||||
Invalidates the instruction cache lines specified by Address and Length. If
|
||||
Address is not aligned on a cache line boundary, then entire instruction
|
||||
cache line containing Address is invalidated. If Address + Length is not
|
||||
aligned on a cache line boundary, then the entire instruction cache line
|
||||
containing Address + Length -1 is invalidated. This function may choose to
|
||||
invalidate the entire instruction cache if that is more efficient than
|
||||
invalidating the specified range. If Length is 0, the no instruction cache
|
||||
lines are invalidated. Address is returned.
|
||||
|
||||
If Length is greater than (EFI_MAX_ADDRESS - Address + 1), then ASSERT().
|
||||
|
||||
Arguments:
|
||||
|
||||
Address - The base address of the instruction cache lines to
|
||||
invalidate. If the CPU is in a physical addressing mode, then
|
||||
Address is a physical address. If the CPU is in a virtual
|
||||
addressing mode, then Address is a virtual address.
|
||||
|
||||
Length - The number of bytes to invalidate from the instruction cache.
|
||||
|
||||
Returns:
|
||||
Address
|
||||
|
||||
**/
|
||||
{
|
||||
PEI_ASSERT(GetPeiServicesTablePointer() , (Length <= EFI_MAX_ADDRESS - (UINTN)Address + 1));
|
||||
return Address;
|
||||
}
|
||||
|
||||
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
PeiLibFfsFindNextVolume (
|
||||
IN UINTN Instance,
|
||||
IN OUT EFI_PEI_FV_HANDLE *VolumeHandle
|
||||
)
|
||||
/*++
|
||||
|
||||
Routine Description:
|
||||
|
||||
The wrapper of Pei Core Service function FfsFindNextVolume.
|
||||
|
||||
Arguments:
|
||||
|
||||
Instance - The Fv Volume Instance.
|
||||
VolumeHandle - Pointer to the current Fv Volume to search.
|
||||
|
||||
Returns:
|
||||
EFI_STATUS
|
||||
|
||||
--*/
|
||||
|
||||
{
|
||||
EFI_PEI_SERVICES **PeiServices;
|
||||
|
||||
PeiServices = GetPeiServicesTablePointer();
|
||||
return (*PeiServices)->FfsFindNextVolume (PeiServices, Instance, VolumeHandle);
|
||||
}
|
||||
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
PeiLibFfsFindNextFile (
|
||||
IN EFI_FV_FILETYPE SearchType,
|
||||
IN EFI_PEI_FV_HANDLE FwVolHeader,
|
||||
IN OUT EFI_PEI_FILE_HANDLE *FileHeader
|
||||
)
|
||||
/*++
|
||||
|
||||
Routine Description:
|
||||
|
||||
The wrapper of Pei Core Service function FfsFindNextFile.
|
||||
|
||||
Arguments:
|
||||
|
||||
SearchType - Filter to find only file of this type.
|
||||
FwVolHeader - Pointer to the current FV to search.
|
||||
FileHandle - Pointer to the file matching SearchType in FwVolHeader.
|
||||
- NULL if file not found
|
||||
|
||||
Returns:
|
||||
EFI_STATUS
|
||||
|
||||
--*/
|
||||
{
|
||||
EFI_PEI_SERVICES **PeiServices;
|
||||
|
||||
PeiServices = GetPeiServicesTablePointer();
|
||||
return (*PeiServices)->FfsFindNextFile (PeiServices, SearchType, &FwVolHeader, &FileHeader);
|
||||
}
|
||||
|
||||
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
PeiLibFfsFindFileByName (
|
||||
IN EFI_GUID *FileName,
|
||||
IN EFI_PEI_FV_HANDLE VolumeHandle,
|
||||
OUT EFI_PEI_FILE_HANDLE *FileHandle
|
||||
)
|
||||
/*++
|
||||
|
||||
Routine Description:
|
||||
|
||||
The wrapper of Pei Core Service function FfsFindFileByName.
|
||||
|
||||
Arguments:
|
||||
|
||||
FileName - File name to search.
|
||||
VolumeHandle - The current FV to search.
|
||||
FileHandle - Pointer to the file matching name in VolumeHandle.
|
||||
- NULL if file not found
|
||||
|
||||
Returns:
|
||||
EFI_STATUS
|
||||
|
||||
--*/
|
||||
{
|
||||
EFI_PEI_SERVICES **PeiServices;
|
||||
|
||||
PeiServices = GetPeiServicesTablePointer();
|
||||
return (*PeiServices)->FfsFindFileByName (FileName, VolumeHandle, FileHandle);
|
||||
}
|
||||
|
||||
|
||||
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
PeiLibFfsFindSectionData (
|
||||
IN EFI_SECTION_TYPE SectionType,
|
||||
IN EFI_FFS_FILE_HEADER *FfsFileHeader,
|
||||
IN OUT VOID **SectionData
|
||||
)
|
||||
/*++
|
||||
|
||||
Routine Description:
|
||||
|
||||
The wrapper of Pei Core Service function FfsFindSectionData.
|
||||
|
||||
Arguments:
|
||||
|
||||
SearchType - Filter to find only sections of this type.
|
||||
FileHandle - Pointer to the current file to search.
|
||||
SectionData - Pointer to the Section matching SectionType in FfsFileHeader.
|
||||
- NULL if section not found
|
||||
|
||||
Returns:
|
||||
EFI_STATUS
|
||||
--*/
|
||||
{
|
||||
EFI_PEI_SERVICES **PeiServices;
|
||||
|
||||
PeiServices = GetPeiServicesTablePointer();
|
||||
return (*PeiServices)->FfsFindSectionData (PeiServices, SectionType, &FfsFileHeader, SectionData);
|
||||
}
|
||||
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
PeiLibFfsGetVolumeInfo (
|
||||
IN EFI_PEI_FV_HANDLE *VolumeHandle,
|
||||
OUT EFI_FV_INFO *VolumeInfo
|
||||
)
|
||||
/*++
|
||||
|
||||
Routine Description:
|
||||
|
||||
The wrapper of Pei Core Service function FfsGetVolumeInfo.
|
||||
|
||||
Arguments:
|
||||
|
||||
VolumeHandle - The handle to Fv Volume.
|
||||
VolumeInfo - The pointer to volume information.
|
||||
|
||||
Returns:
|
||||
EFI_STATUS
|
||||
--*/
|
||||
{
|
||||
EFI_PEI_SERVICES **PeiServices;
|
||||
|
||||
PeiServices = GetPeiServicesTablePointer();
|
||||
return (*PeiServices)->FfsGetVolumeInfo (VolumeHandle, VolumeInfo);
|
||||
}
|
||||
|
||||
|
||||
|
||||
VOID
|
||||
EFIAPI
|
||||
BuildFvHob (
|
||||
IN EFI_PHYSICAL_ADDRESS BaseAddress,
|
||||
IN UINT64 Length
|
||||
)
|
||||
/*++
|
||||
|
||||
Routine Description:
|
||||
|
||||
Build FvHob.
|
||||
|
||||
Arguments:
|
||||
|
||||
BaseAddress - Fv base address.
|
||||
Length - Fv Length.
|
||||
|
||||
Returns:
|
||||
NONE.
|
||||
--*/
|
||||
{
|
||||
|
||||
EFI_STATUS Status;
|
||||
EFI_HOB_FIRMWARE_VOLUME *Hob;
|
||||
EFI_PEI_SERVICES **PeiServices;
|
||||
|
||||
PeiServices = GetPeiServicesTablePointer();
|
||||
|
||||
//
|
||||
// Check FV Signature
|
||||
//
|
||||
PEI_ASSERT (PeiServices, ((EFI_FIRMWARE_VOLUME_HEADER*)((UINTN)BaseAddress))->Signature == EFI_FVH_SIGNATURE);
|
||||
|
||||
|
||||
Status = (*PeiServices)->CreateHob (
|
||||
PeiServices,
|
||||
EFI_HOB_TYPE_FV,
|
||||
sizeof (EFI_HOB_FIRMWARE_VOLUME),
|
||||
&Hob
|
||||
);
|
||||
Hob->BaseAddress = BaseAddress;
|
||||
Hob->Length = Length;
|
||||
}
|
||||
|
||||
VOID
|
||||
EFIAPI
|
||||
BuildFvHob2 (
|
||||
IN EFI_PHYSICAL_ADDRESS BaseAddress,
|
||||
IN UINT64 Length,
|
||||
IN EFI_GUID *FvNameGuid,
|
||||
IN EFI_GUID *FileNameGuid
|
||||
)
|
||||
/*++
|
||||
|
||||
Routine Description:
|
||||
|
||||
Build FvHob2.
|
||||
|
||||
Arguments:
|
||||
|
||||
BaseAddress - Fv base address.
|
||||
Length - Fv length.
|
||||
FvNameGuid - Fv name.
|
||||
FileNameGuid - File name which contians encapsulated Fv.
|
||||
|
||||
Returns:
|
||||
NONE.
|
||||
--*/
|
||||
{
|
||||
|
||||
EFI_STATUS Status;
|
||||
EFI_HOB_FIRMWARE_VOLUME2 *Hob;
|
||||
EFI_PEI_SERVICES **PeiServices;
|
||||
|
||||
PeiServices = GetPeiServicesTablePointer();
|
||||
|
||||
//
|
||||
// Check FV Signature
|
||||
//
|
||||
PEI_ASSERT (PeiServices, ((EFI_FIRMWARE_VOLUME_HEADER*)((UINTN)BaseAddress))->Signature == EFI_FVH_SIGNATURE);
|
||||
|
||||
Status = (*PeiServices)->CreateHob (
|
||||
PeiServices,
|
||||
EFI_HOB_TYPE_FV2,
|
||||
sizeof (EFI_HOB_FIRMWARE_VOLUME2),
|
||||
&Hob
|
||||
);
|
||||
Hob->BaseAddress = BaseAddress;
|
||||
Hob->Length = Length;
|
||||
CopyMem ((VOID*)&Hob->FvName, FvNameGuid, sizeof(EFI_GUID));
|
||||
CopyMem ((VOID*)&Hob->FileName, FileNameGuid, sizeof(EFI_GUID));
|
||||
}
|
||||
|
||||
EFI_STATUS
|
||||
EFIAPI
|
||||
PeiServicesLocatePpi (
|
||||
IN EFI_GUID *Guid,
|
||||
IN UINTN Instance,
|
||||
IN OUT EFI_PEI_PPI_DESCRIPTOR **PpiDescriptor,
|
||||
IN OUT VOID **Ppi
|
||||
)
|
||||
/*++
|
||||
|
||||
Routine Description:
|
||||
|
||||
The wrapper of Pei Core Service function LocatePpi.
|
||||
|
||||
Arguments:
|
||||
|
||||
Guid - Pointer to GUID of the PPI.
|
||||
Instance - Instance Number to discover.
|
||||
PpiDescriptor - Pointer to reference the found descriptor. If not NULL,
|
||||
returns a pointer to the descriptor (includes flags, etc)
|
||||
Ppi - Pointer to reference the found PPI
|
||||
|
||||
Returns:
|
||||
|
||||
Status - EFI_SUCCESS if the PPI is in the database
|
||||
EFI_NOT_FOUND if the PPI is not in the database
|
||||
--*/
|
||||
{
|
||||
EFI_PEI_SERVICES **PeiServices;
|
||||
|
||||
PeiServices = GetPeiServicesTablePointer();
|
||||
return (*PeiServices)->LocatePpi (PeiServices, Guid, Instance, PpiDescriptor, Ppi);
|
||||
}
|
||||
|
||||
|
||||
VOID
|
||||
EFIAPI
|
||||
BuildGuidDataHob (
|
||||
IN EFI_GUID *Guid,
|
||||
IN VOID *Data,
|
||||
IN UINTN DataLength
|
||||
)
|
||||
/*++
|
||||
|
||||
Routine Description:
|
||||
|
||||
Build Guid data Hob.
|
||||
|
||||
Arguments:
|
||||
|
||||
Guid - guid to build data hob.
|
||||
Data - data to build data hob.
|
||||
DataLength - the length of data.
|
||||
|
||||
Returns:
|
||||
NONE
|
||||
--*/
|
||||
{
|
||||
VOID *HobData;
|
||||
EFI_HOB_GUID_TYPE *Hob;
|
||||
EFI_PEI_SERVICES **PeiServices;
|
||||
|
||||
PeiServices = GetPeiServicesTablePointer();
|
||||
(*PeiServices)->CreateHob (
|
||||
PeiServices,
|
||||
EFI_HOB_TYPE_GUID_EXTENSION,
|
||||
(UINT16) (sizeof (EFI_HOB_GUID_TYPE) + DataLength),
|
||||
&Hob
|
||||
);
|
||||
CopyMem ((VOID*)&Hob->Name, (VOID*)Guid, sizeof(EFI_GUID));
|
||||
|
||||
HobData = Hob + 1;
|
||||
|
||||
CopyMem (HobData, Data, DataLength);
|
||||
}
|
||||
|
||||
|
||||
VOID *
|
||||
EFIAPI
|
||||
AllocatePages (
|
||||
IN UINTN Pages
|
||||
)
|
||||
/*++
|
||||
|
||||
Routine Description:
|
||||
|
||||
Allocate Memory.
|
||||
|
||||
Arguments:
|
||||
|
||||
Pages - Pages to allocate.
|
||||
|
||||
Returns:
|
||||
= Address if successful to allocate memory.
|
||||
= NULL if fail to allocate memory.
|
||||
|
||||
--*/
|
||||
{
|
||||
EFI_STATUS Status;
|
||||
EFI_PHYSICAL_ADDRESS Memory;
|
||||
EFI_PEI_SERVICES **PeiServices;
|
||||
|
||||
if (Pages == 0) {
|
||||
return NULL;
|
||||
}
|
||||
|
||||
PeiServices = GetPeiServicesTablePointer();
|
||||
Status = (*PeiServices)->AllocatePages (PeiServices, EfiBootServicesData, Pages, &Memory);
|
||||
if (EFI_ERROR (Status)) {
|
||||
Memory = 0;
|
||||
}
|
||||
return (VOID *) (UINTN) Memory;
|
||||
|
||||
}
|
||||
|
||||
#endif
|
||||
Reference in New Issue
Block a user