1 files changed, 179 insertions, 0 deletions
diff --git a/EdkCompatibilityPkg/Foundation/Library/Pei/PeiLib/FindFv.c b/EdkCompatibilityPkg/Foundation/Library/Pei/PeiLib/FindFv.c
new file mode 100644
index 0000000000..fcff7a648d
--- /dev/null
+++ b/EdkCompatibilityPkg/Foundation/Library/Pei/PeiLib/FindFv.c
@@ -0,0 +1,179 @@
+/*++
+
+Copyright (c) 2006, 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:
+  
+    FindFv.c
+   
+Abstract:
+
+  Library function to find fv by hob.
+
+--*/
+
+#include "Tiano.h"
+#include "Pei.h"
+#include "PeiLib.h"
+#include "PeiHobLib.h"
+#include "EfiCommonLib.h"
+#include EFI_GUID_DEFINITION (FirmwareFileSystem)
+
+static
+VOID *
+GetHob (
+  IN UINT16  Type,
+  IN VOID    *HobStart
+  )
+/*++
+
+Routine Description:
+
+  This function returns the first instance of a HOB type in a HOB list.
+  
+Arguments:
+
+  Type          The HOB type to return.
+  HobStart      The first HOB in the HOB list.
+    
+Returns:
+
+  HobStart      There were no HOBs found with the requested type.
+  else          Returns the first HOB with the matching type.
+
+--*/
+{
+  EFI_PEI_HOB_POINTERS  Hob;
+
+  Hob.Raw = HobStart;
+  //
+  // Return input if not found
+  //
+  if (HobStart == NULL) {
+    return HobStart;
+  }
+
+  //
+  // Parse the HOB list, stop if end of list or matching type found.
+  //
+  while (!END_OF_HOB_LIST (Hob)) {
+
+    if (Hob.Header->HobType == Type) {
+      break;
+    }
+
+    Hob.Raw = GET_NEXT_HOB (Hob);
+  }
+  
+  //
+  // Return input if not found
+  //
+  if (END_OF_HOB_LIST (Hob)) {
+    return HobStart;
+  }
+
+  return (VOID *) (Hob.Raw);
+}
+
+EFI_STATUS
+FindFv (
+  IN     EFI_FIND_FV_PPI             *This,
+  IN     EFI_PEI_SERVICES            **PeiServices,
+  IN OUT UINT8                       *FvNumber,
+  IN OUT EFI_FIRMWARE_VOLUME_HEADER  **FvAddress
+  )
+/*++
+
+Routine Description:
+
+  Search Fv which supports FFS.
+
+Arguments:
+  
+  This        - Interface pointer that implement the Find Fv PPI
+  
+  PeiServices - Pointer to the PEI Service Table
+  
+  FvNumber    - On input,  the number of the fireware volume which supports FFS to locate
+                On output, the next FV number which supports FFS.
+  
+  FVAddress   - The address of the volume which supports FFS to discover
+
+Returns:
+
+  EFI_SUCCESS           - An addtional FV which supports FFS found
+  EFI_OUT_OF_RESOURCES  - There are no fireware volume which supports FFS for given fvnumber
+  EFI_INVALID_PARAMETER - FvAddress is NULL
+
+--*/
+{
+  EFI_STATUS              Status;
+  EFI_PEI_HOB_POINTERS    HobStart;
+  EFI_PEI_HOB_POINTERS    Hob;
+  EFI_HOB_FIRMWARE_VOLUME *FvHob;
+  UINT8                   FvIndex;
+
+  if (FvAddress == NULL){
+    return EFI_INVALID_PARAMETER;
+  }
+
+  Hob.Raw = NULL;
+  FvIndex = 0;
+
+  //
+  // Get the Hob table pointer
+  //
+  Status = (*PeiServices)->GetHobList (
+                            PeiServices,
+                            &HobStart.Raw
+                            );
+
+  if (EFI_ERROR (Status)) {
+    return EFI_OUT_OF_RESOURCES;
+  }
+  
+  //
+  // Loop to search the wanted FirmwareVolume which supports FFS
+  //
+  //
+  while (FvIndex <= *FvNumber) {
+    
+    Hob.Raw = GetHob (EFI_HOB_TYPE_FV, HobStart.Raw); 
+    
+    //
+    //  If the Hob is not EFI_HOB_TYPE_FV, it indicates that
+    //  we have finished all FV volumes search, and there is no
+    //  the FFS FV specified by FvNumber.
+    //
+    if (Hob.Header->HobType != EFI_HOB_TYPE_FV) {
+      *FvNumber = 0;
+      return EFI_OUT_OF_RESOURCES;
+    }
+  
+    HobStart.Raw = Hob.Raw + Hob.Header->HobLength;
+    FvHob        = Hob.FirmwareVolume;
+    *FvAddress  = (EFI_FIRMWARE_VOLUME_HEADER *) ((UINTN) FvHob->BaseAddress);
+    //
+    // Check if the FV supports FFS
+    //
+    if (EfiCompareGuid (&((*FvAddress)->FileSystemGuid), &gEfiFirmwareFileSystemGuid)) {
+      FvIndex++;
+    }
+  }
+  
+  //
+  // Return the next FV number which supports FFS.
+  //
+  (*FvNumber)++;
+  
+  return EFI_SUCCESS;
+
+}