[mirror_edk2.git] / BaseTools / Source / C / FCE / MonotonicBasedVariable.c

/** @file\r
\r
 Read and edit the authenticated variables.\r
\r
 Copyright (c) 2011-2019, Intel Corporation. All rights reserved.<BR>\r
 SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
\r
#include "Fce.h"\r
#include "MonotonicBasedVariable.h"\r
\r
extern LIST_ENTRY                  mAllVarListEntry;\r
extern MULTI_PLATFORM_PARAMETERS   mMultiPlatformParam;\r
extern G_EFI_FD_INFO               gEfiFdInfo;\r
EFI_GUID  gEfiAuthenticatedVariableGuid     = EFI_AUTHENTICATED_VARIABLE_GUID;\r
/**\r
\r
  Gets the pointer to the first variable header in given variable store area.\r
\r
  @param VarStoreHeader  Pointer to the Variable Store Header.\r
\r
  @return Pointer to the first variable header.\r
\r
**/\r
static\r
VARIABLE_HEADER *\r
GetStartPointer (\r
  IN VARIABLE_STORE_HEADER       *VarStoreHeader\r
  )\r
{\r
  //\r
  // The end of variable store.\r
  //\r
  return (VARIABLE_HEADER *) HEADER_ALIGN (VarStoreHeader + 1);\r
}\r
\r
/**\r
\r
  Gets the pointer to the end of the variable storage area.\r
\r
  This function gets pointer to the end of the variable storage\r
  area, according to the input variable store header.\r
\r
  @param VarStoreHeader  Pointer to the Variable Store Header.\r
\r
  @return Pointer to the end of the variable storage area.\r
\r
**/\r
static\r
VARIABLE_HEADER *\r
GetEndPointer (\r
  IN VARIABLE_STORE_HEADER       *VarStoreHeader\r
  )\r
{\r
  //\r
  // The end of variable store\r
  //\r
  return (VARIABLE_HEADER *) HEADER_ALIGN ((UINTN) VarStoreHeader + VarStoreHeader->Size);\r
}\r
\r
\r
/**\r
\r
  This code checks if variable header is valid or not.\r
\r
  @param Variable        Pointer to the Variable Header.\r
\r
  @retval TRUE           Variable header is valid.\r
  @retval FALSE          Variable header is not valid.\r
\r
**/\r
static\r
BOOLEAN\r
IsValidVariableHeader (\r
  IN  VARIABLE_HEADER   *Variable\r
  )\r
{\r
  if ((Variable == NULL) || (Variable->StartId != VARIABLE_DATA)) {\r
    return FALSE;\r
  }\r
\r
  return TRUE;\r
}\r
\r
/**\r
\r
  This code gets the size of name of variable.\r
\r
  @param Variable        Pointer to the Variable Header.\r
\r
  @return UINTN          Size of variable in bytes.\r
\r
**/\r
static\r
UINTN\r
NameSizeOfVariable (\r
  IN  VARIABLE_HEADER   *Variable\r
  )\r
{\r
  if ((Variable->State    == (UINT8) (-1)) ||\r
      (Variable->DataSize == (UINT32) (-1)) ||\r
      (Variable->NameSize == (UINT32) (-1)) ||\r
      (Variable->Attributes == (UINT32) (-1))\r
      ) {\r
    return 0;\r
  }\r
  return (UINTN) Variable->NameSize;\r
}\r
\r
/**\r
\r
  This code gets the size of variable data.\r
\r
  @param Variable        Pointer to the Variable Header.\r
\r
  @return Size of variable in bytes.\r
\r
**/\r
static\r
UINTN\r
DataSizeOfVariable (\r
  IN  VARIABLE_HEADER   *Variable\r
  )\r
{\r
  if ((Variable->State    == (UINT8)  (-1)) ||\r
      (Variable->DataSize == (UINT32) (-1)) ||\r
      (Variable->NameSize == (UINT32) (-1)) ||\r
      (Variable->Attributes == (UINT32) (-1))\r
      ) {\r
    return 0;\r
  }\r
  return (UINTN) Variable->DataSize;\r
}\r
\r
/**\r
\r
  This code gets the pointer to the variable name.\r
\r
  @param Variable        Pointer to the Variable Header.\r
\r
  @return Pointer to Variable Name which is Unicode encoding.\r
\r
**/\r
static\r
CHAR16 *\r
GetVariableNamePtr (\r
  IN  VARIABLE_HEADER   *Variable\r
  )\r
{\r
  return (CHAR16 *) (Variable + 1);\r
}\r
\r
/**\r
\r
  This code gets the pointer to the variable data.\r
\r
  @param Variable        Pointer to the Variable Header.\r
\r
  @return Pointer to Variable Data.\r
\r
**/\r
static\r
UINT8 *\r
GetVariableDataPtr (\r
  IN  VARIABLE_HEADER   *Variable\r
  )\r
{\r
  UINTN Value;\r
\r
  //\r
  // Be careful about pad size for alignment.\r
  //\r
  Value =  (UINTN) GetVariableNamePtr (Variable);\r
  Value += NameSizeOfVariable (Variable);\r
  Value += GET_PAD_SIZE (NameSizeOfVariable (Variable));\r
\r
  return (UINT8 *) Value;\r
}\r
\r
/**\r
\r
  This code gets the pointer to the next variable header.\r
\r
  @param Variable        Pointer to the Variable Header.\r
\r
  @return Pointer to next variable header.\r
\r
**/\r
static\r
VARIABLE_HEADER *\r
GetNextVariablePtr (\r
  IN  VARIABLE_HEADER   *Variable\r
  )\r
{\r
  UINTN Value;\r
\r
  if (!IsValidVariableHeader (Variable)) {\r
    return NULL;\r
  }\r
\r
  Value =  (UINTN) GetVariableDataPtr (Variable);\r
  Value += DataSizeOfVariable (Variable);\r
  Value += GET_PAD_SIZE (DataSizeOfVariable (Variable));\r
\r
  //\r
  // Be careful about pad size for alignment.\r
  //\r
  return (VARIABLE_HEADER *) HEADER_ALIGN (Value);\r
}\r
\r
/**\r
  Search and get a free space in the EFI variable zone\r
\r
  @param VariableStoreHeader       The start of a EFI variable zone.\r
  @param VarListSize               The size of a variables needs to be allocated.\r
  @param FreeBeginVar              The dual pointer to the free NV space.\r
\r
  @retval EFI_SUCCESS              Return the beginning of a free variable space.\r
  @retval RETURN_BUFFER_TOO_SMALL  Failed.\r
**/\r
static\r
EFI_STATUS\r
GetVariableVar (\r
  IN      VARIABLE_STORE_HEADER  *VariableStoreHeader,\r
  IN      UINT32                 VarListSize,\r
  IN OUT  CHAR8                  **FreeBeginVar\r
)\r
{\r
  BOOLEAN          Flag;\r
  VARIABLE_HEADER  *Variable;\r
  VARIABLE_HEADER  *EndOfVariable;\r
  CHAR8            *BeginVar;\r
\r
  BeginVar      = NULL;\r
  Flag          = FALSE;\r
  Variable      = NULL;\r
  EndOfVariable = NULL;\r
  *FreeBeginVar = NULL;\r
\r
  if (VariableStoreHeader == NULL) {\r
    *FreeBeginVar = NULL;\r
    return RETURN_INVALID_PARAMETER;\r
  }\r
  Variable      = GetStartPointer (VariableStoreHeader);\r
  EndOfVariable = GetEndPointer(VariableStoreHeader);\r
  //\r
  //Search the beginning of free NV\r
  //\r
  while (Variable != EndOfVariable) {\r
    BeginVar = (CHAR8 *)Variable;\r
    Variable = GetNextVariablePtr (Variable);\r
    if (Variable == NULL) {\r
      Flag = TRUE;\r
      break;\r
    }\r
  }\r
  //\r
  // Check whether the free space is more than what we want\r
  //\r
  if ((CHAR8 *)BeginVar + VarListSize > (CHAR8 *)EndOfVariable) {\r
    return RETURN_BUFFER_TOO_SMALL;\r
  }\r
  //\r
  // If not find the available space, return NULL\r
  //\r
  if (!Flag) {\r
    return RETURN_BUFFER_TOO_SMALL;\r
  }\r
  *FreeBeginVar = BeginVar;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Search whether the variable in VarList has existed in current NV.\r
\r
  Parse the FFS or Fd image, and find the valid variable pointer.\r
\r
  @param VariableStoreHeader    The start of a EFI variable zone.\r
  @param VarList                The pointer to the VarList\r
\r
  @retval address               If the variable existed in current NV, return address\r
  @return NULL                  Otherwise, return NULL\r
**/\r
static\r
VARIABLE_HEADER  *\r
FindVariableInNv (\r
  IN     VARIABLE_STORE_HEADER  *VariableStoreHeader,\r
  IN     FORMSET_STORAGE        *Storage\r
  )\r
{\r
  BOOLEAN          Flag;\r
  VARIABLE_HEADER  *Variable;\r
  VARIABLE_HEADER  *EndOfVariable;\r
  CHAR16           *VariableName;\r
\r
  Flag            = FALSE;\r
  Variable        = NULL;\r
  EndOfVariable   = NULL;\r
  VariableName    = NULL;\r
\r
  if ((VariableStoreHeader == NULL) || (Storage == NULL) || (Storage->Name == NULL)) {\r
    return NULL;\r
  }\r
  Variable      = GetStartPointer (VariableStoreHeader);\r
  EndOfVariable = GetEndPointer(VariableStoreHeader);\r
  //\r
  // Parse and compare the variable in the NV space one by one\r
  //\r
  while ((Variable != EndOfVariable) && (Variable != NULL)) {\r
    VariableName = (CHAR16 *)((CHAR8 *)Variable + sizeof (VARIABLE_HEADER));\r
    if (!CompareGuid (&Variable->VendorGuid, &Storage->Guid) \\r
      && !FceStrCmp (Storage->Name, VariableName) \\r
      && (Variable->State == VAR_ADDED)) {\r
      Flag = TRUE;\r
      break;\r
    }\r
    Variable = GetNextVariablePtr (Variable);\r
  }\r
  if (!Flag) {\r
    return NULL;\r
  }\r
  return Variable;\r
}\r
\r
/**\r
  Exchange the data between Efi variable and the data of VarList when the\r
  variable use the authenticated variable header\r
\r
  If VarToList is TRUE, copy the efi variable data to the VarList; Otherwise,\r
  update the data from varlist to efi variable.\r
\r
  @param VarToList          The flag to control the direction of exchange.\r
  @param StorageListHead    Decide which variale list be updated\r
\r
  @retval EFI_SUCCESS           Get the address successfully.\r
  @retval EFI_OUT_OF_RESOURCES  No available in the EFI variable zone.\r
  @retval EFI_INVALID_PARAMETER Invalid variable name.\r
**/\r
EFI_STATUS\r
SynAuthEfiVariable (\r
  IN  BOOLEAN     VarToList,\r
  IN  LIST_ENTRY  *StorageListHead\r
  )\r
{\r
  EFI_FIRMWARE_VOLUME_HEADER    *VarAddr;\r
  LIST_ENTRY                    *StorageLink;\r
  FORMSET_STORAGE               *Storage;\r
  EFI_STATUS                    Status;\r
  CHAR8                         *NewAvailableAddr;\r
  CHAR8                         *DataBase;\r
  VARIABLE_HEADER               *VariableHeader;\r
  VARIABLE_STORE_HEADER         *VariableStoreHeader;\r
  UINTN                         VarNameSize;\r
\r
  Status              = EFI_SUCCESS;\r
  DataBase            = NULL;\r
  NewAvailableAddr    = NULL;\r
  VarNameSize         = 0;\r
  VariableHeader      = NULL;\r
  VarAddr             = (EFI_FIRMWARE_VOLUME_HEADER   *) gEfiFdInfo.EfiVariableAddr;\r
  VariableStoreHeader = (VARIABLE_STORE_HEADER *)((CHAR8 *)VarAddr + VarAddr->HeaderLength);\r
  //\r
  //Parse the variable range, and check whether there is some existed ones.\r
  //\r
  StorageLink = GetFirstNode (StorageListHead);\r
  while (!IsNull (StorageListHead, StorageLink)) {\r
    Storage = FORMSET_STORAGE_FROM_LINK (StorageLink);\r
     //\r
     // Ignore the invalid varlist node\r
     //\r
     if (Storage->Buffer == NULL) {\r
      StorageLink = GetNextNode (StorageListHead, StorageLink);\r
      continue;\r
     }\r
     //\r
     // Report error, if the variable name is invalid.\r
     //\r
     if ((Storage->Name == NULL) || (FceStrLen(Storage->Name) == 0)) {\r
       printf ("Error. One variable name is NULL. Its GUID is: ");\r
       PrintGuid(&(Storage->Guid));\r
       return EFI_INVALID_PARAMETER;\r
     }\r
     VariableHeader = FindVariableInNv (\r
                        VariableStoreHeader,\r
                        Storage\r
                        );\r
\r
   if (VarToList) {\r
     //\r
     //Copy the data from NV to the VarList.\r
     //\r
     if (VariableHeader != NULL) {\r
       if (Storage->Buffer == NULL) {\r
         Storage->Buffer = calloc (Storage->Size, sizeof (CHAR8));\r
         ASSERT (Storage->Buffer != NULL);\r
       }\r
       //\r
       // The variable in VarList is CHAR8, but in the EFI variable is CHAR16.\r
       //\r
       DataBase    = (CHAR8 *)GetVariableDataPtr (VariableHeader);\r
       memcpy (\r
         Storage->Buffer,\r
         (VOID *) DataBase,\r
         Storage->Size\r
        );\r
      }\r
    } else {\r
       //\r
       //If existed, copy the List data to the variable in NV directly. If not found, create a new one.\r
       //\r
       VarNameSize = 2 * (FceStrLen (Storage->Name) + 1);\r
       //\r
       //If this variable has existed in current FD, the data in VarList has\r
       // been updated, and this variable is not authenticated type, then\r
       // update it from VarList to the FD.\r
       //\r
       if ((VariableHeader != NULL)    \\r
         && (Storage->Buffer != NULL)\r
         ) {\r
         if (!(VariableHeader->Attributes & EFI_VARIABLE_AUTHENTICATED_WRITE_ACCESS)) {\r
           DataBase = (CHAR8 *)GetVariableDataPtr (VariableHeader);\r
           memcpy (\r
             (VOID *) DataBase,\r
             Storage->Buffer,\r
             Storage->Size\r
           );\r
         } else {\r
           printf ("Error. Not support to update authenticated variables.\n");\r
           return EFI_INVALID_PARAMETER;\r
         }\r
       } else if ((VariableHeader == NULL) && (Storage->Buffer != NULL)){\r
       //\r
         //If EfiVarstore is not EFI_VARIABLE_NON_VOLATILE, only skip it.\r
         //\r
         if (Storage->NewEfiVarstore\r
           && ((Storage->Attributes & EFI_VARIABLE_NON_VOLATILE) == 0)\r
         ) {\r
          StorageLink = GetNextNode (StorageListHead, StorageLink);\r
          continue;\r
         }\r
         //\r
         // Try to get the available zone from the efi variables\r
         //\r
         Status = GetVariableVar (\r
                    VariableStoreHeader,\r
                    Storage->Size + sizeof (VARIABLE_HEADER),\r
                    &NewAvailableAddr\r
                    );\r
\r
         if (!EFI_ERROR (Status)) {\r
           //\r
           // Create the authenticated variable header\r
           //\r
           VariableHeader                  = (VARIABLE_HEADER *) NewAvailableAddr;\r
           VariableHeader->StartId         = VARIABLE_DATA;\r
           VariableHeader->State           = VAR_ADDED;\r
           VariableHeader->Reserved        = 0x0;\r
           VariableHeader->MonotonicCount  = 0x0;\r
           VariableHeader->PubKeyIndex     = 0x0;\r
           if (Storage->NewEfiVarstore) {\r
             VariableHeader->Attributes = Storage->Attributes;\r
           } else {\r
             VariableHeader->Attributes      = EFI_VARIABLE_NON_VOLATILE|EFI_VARIABLE_BOOTSERVICE_ACCESS|EFI_VARIABLE_RUNTIME_ACCESS;\r
           }\r
           VariableHeader->NameSize        = VarNameSize;\r
           VariableHeader->DataSize   = Storage->Size;\r
           //\r
           //Copy the Guid, variable name, and data in sequence.\r
           //\r
           memcpy (\r
             (VOID *)&(VariableHeader->VendorGuid),\r
             &(Storage->Guid),\r
             sizeof (EFI_GUID)\r
             );\r
           NewAvailableAddr = NewAvailableAddr + sizeof (VARIABLE_HEADER);\r
           memcpy (\r
             (VOID *) NewAvailableAddr,\r
              Storage->Name,\r
              VarNameSize\r
              );\r
\r
           NewAvailableAddr = NewAvailableAddr + VarNameSize + GET_PAD_SIZE (VarNameSize);\r
           memcpy (\r
             (VOID *) NewAvailableAddr,\r
             Storage->Buffer,\r
             Storage->Size * sizeof (CHAR8)\r
             );\r
         } else {\r
           printf ("Error. No available space in NV ram.\n");\r
           return EFI_OUT_OF_RESOURCES;\r
         }\r
       }\r
    }\r
    StorageLink = GetNextNode (StorageListHead, StorageLink);\r
  }\r
  return Status;\r
}\r
\r
/**\r
  Remove the variable from Efi variable\r
\r
  Found the variable with the same name in StorageListHead and remove it.\r
\r
  @param StorageListHead   Decide which variale list be removed.\r
\r
  @retval EFI_SUCCESS      Remove the variables successfully.\r
**/\r
EFI_STATUS\r
RemoveAuthEfiVariable (\r
  IN  LIST_ENTRY  *StorageListHead\r
  )\r
{\r
  EFI_FIRMWARE_VOLUME_HEADER    *VarAddr;\r
  LIST_ENTRY                    *StorageLink;\r
  FORMSET_STORAGE               *Storage;\r
  VARIABLE_HEADER               *VariableHeader;\r
  VARIABLE_STORE_HEADER         *VariableStoreHeader;\r
\r
  VariableHeader      = NULL;\r
  VarAddr             = (EFI_FIRMWARE_VOLUME_HEADER   *) gEfiFdInfo.EfiVariableAddr;\r
  VariableStoreHeader = (VARIABLE_STORE_HEADER *)((CHAR8 *)VarAddr + VarAddr->HeaderLength);\r
  //\r
  //Parse the variable range, and check whether there is some existed ones.\r
  //\r
  StorageLink = GetFirstNode (StorageListHead);\r
  while (!IsNull (StorageListHead, StorageLink)) {\r
    Storage = FORMSET_STORAGE_FROM_LINK (StorageLink);\r
    //\r
    // Ignore the invalid varlist node\r
    //\r
    if (Storage->Buffer == NULL) {\r
      StorageLink = GetNextNode (StorageListHead, StorageLink);\r
      continue;\r
    }\r
    //\r
    // Report error, if the variable name is invalid.\r
    //\r
    if ((Storage->Name == NULL) || (FceStrLen(Storage->Name) == 0)) {\r
      printf ("Error. One variable name is NULL. Its GUID is: ");\r
      PrintGuid(&(Storage->Guid));\r
      return EFI_INVALID_PARAMETER;\r
    }\r
    VariableHeader = FindVariableInNv (\r
                       VariableStoreHeader,\r
                       Storage\r
                       );\r
    if (VariableHeader != NULL) {\r
      VariableHeader->State = VAR_DELETED;\r
    }\r
    StorageLink = GetNextNode (StorageListHead, StorageLink);\r
  }\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Check the store variable is Monotonic based authenticated or not\r
\r
  @param VarToList     The pointer to the header of Variable Store.\r
\r
  @retval TRUE         If authenticated, return TRUE.\r
  @retval FALSE        Otherwise, return FALSE.\r
**/\r
\r
BOOLEAN\r
CheckMonotonicBasedVarStore (\r
  IN VOID  *VariableStoreHeader\r
  )\r
{\r
  if (!CompareGuid (\r
    &gEfiAuthenticatedVariableGuid,\r
    &((VARIABLE_STORE_HEADER *)VariableStoreHeader)->Signature)\r
    ) {\r
    return TRUE;\r
  } else {\r
    return FALSE;\r
  }\r
}\r
\r
/**\r
  Copy Monotonic-Based authenticated variable to binary in multi-platform mode\r
\r
  @param  Storage           The pointer to a storage in storage list.\r
  @param  StorageBeginning  The pointer to the beginning of storage under specifed platformId and defaultId\r
  @param  Index             The number of the storage. If the Index is 0, record the variable header to\r
                            the binary. Or else, only record the storage.\r
\r
  @return length          The length of storage\r
**/\r
UINT32\r
CopyMonotonicBasedVariableToBinary (\r
  IN      FORMSET_STORAGE   *Storage,\r
  IN OUT  UINT8             *StorageBeginning,\r
  IN      UINT32            Index\r
  )\r
{\r
  EFI_STATUS                    Status;\r
  CHAR8                         *NewAvailableAddr;\r
  VARIABLE_HEADER               *VariableHeader;\r
  VARIABLE_STORE_HEADER         *VariableStoreHeader;\r
  UINTN                         VarNameSize;\r
  UINT32                        HeaderLength;\r
\r
  Status              = EFI_SUCCESS;\r
  NewAvailableAddr    = NULL;\r
  VarNameSize         = 0;\r
  HeaderLength        = 0;\r
  VariableHeader      = NULL;\r
  VariableStoreHeader = NULL;\r
\r
  if ((Storage->Name == NULL) || (FceStrLen(Storage->Name) == 0)) {\r
    printf ("Error. One variable name is NULL. Its GUID is: ");\r
    PrintGuid(&(Storage->Guid));\r
    return 0;\r
  }\r
  //\r
  // If the first storage under one specified platformId and defaultId, create the variable header\r
  //\r
  if (Index == 0) {\r
    HeaderLength = WriteDefaultAndPlatformId (StorageBeginning, Storage);\r
    VariableStoreHeader = (VARIABLE_STORE_HEADER *) (StorageBeginning + HeaderLength);\r
    //\r
    //Create the Variable Storage header\r
    //\r
    memcpy (&(VariableStoreHeader->Signature), &gEfiAuthenticatedVariableGuid, sizeof (EFI_GUID));\r
    VariableStoreHeader->Format = 0x5A;\r
    VariableStoreHeader->State  = 0xFE;\r
    //\r
    //Assign a big size here. It will be fixed after the storage under a specifed platformId and defaultId are all written.\r
    //\r
    VariableStoreHeader->Size   = gEfiFdInfo.FdSize;\r
  }\r
  VariableStoreHeader = (VARIABLE_STORE_HEADER *) (StorageBeginning + *(UINT16 *)StorageBeginning);\r
\r
  Status = GetVariableVar (\r
             VariableStoreHeader,\r
             Storage->Size + sizeof (VARIABLE_HEADER),\r
             &NewAvailableAddr\r
           );\r
  if (EFI_ERROR (Status)) {\r
    return FAIL;\r
  }\r
  //\r
  // Create the variable header\r
  //\r
  VarNameSize                = 2 * (FceStrLen (Storage->Name) + 1);\r
  VariableHeader             = (VARIABLE_HEADER *) NewAvailableAddr;\r
  VariableHeader->StartId    = VARIABLE_DATA;\r
  VariableHeader->State      = VAR_ADDED;\r
  VariableHeader->Reserved   = 0x0;\r
  VariableHeader->MonotonicCount  = 0x0;\r
  VariableHeader->PubKeyIndex     = 0x0;\r
\r
  if (Storage->NewEfiVarstore) {\r
    VariableHeader->Attributes = Storage->Attributes;\r
  } else {\r
    VariableHeader->Attributes = EFI_VARIABLE_NON_VOLATILE|EFI_VARIABLE_BOOTSERVICE_ACCESS|EFI_VARIABLE_RUNTIME_ACCESS;\r
  }\r
  VariableHeader->NameSize   = VarNameSize;\r
  VariableHeader->DataSize   = Storage->Size;\r
  //\r
  //Copy the Guid, variable name, and data in sequence.\r
  //\r
  memcpy (\r
    (VOID *)&(VariableHeader->VendorGuid),\r
    &(Storage->Guid),\r
    sizeof (EFI_GUID)\r
  );\r
  NewAvailableAddr = NewAvailableAddr + sizeof (VARIABLE_HEADER);\r
  memcpy (\r
    (VOID *) NewAvailableAddr,\r
    Storage->Name,\r
    VarNameSize\r
  );\r
\r
  NewAvailableAddr = NewAvailableAddr + VarNameSize + GET_PAD_SIZE (VarNameSize);\r
  memcpy (\r
    (VOID *) NewAvailableAddr,\r
    Storage->Buffer,\r
    Storage->Size * sizeof (CHAR8)\r
  );\r
\r
\r
  //\r
  // Return the length which is from the beginning of Binary\r
  //\r
  return ((UINT32) ((UINT8*)NewAvailableAddr - StorageBeginning) + Storage->Size);\r
}\r
\r
\r
/**\r
  Read Monotonic-based authenticated variable to storage list in multi-platform mode\r
\r
  @param  Binary            The pointer to the header of storage under specifed platformId and defaultId\r
  @param  StorageListEntry  The pointer to the storage list.\r
\r
  @return length          The length of storage\r
**/\r
UINT32\r
ReadMonotonicBasedVariableToList (\r
  IN      UINT8             *Binary,\r
  IN      LIST_ENTRY        *StorageListEntry\r
  )\r
{\r
  VARIABLE_HEADER               *EndOfVariable;\r
  VARIABLE_HEADER               *Variable;\r
  VARIABLE_STORE_HEADER         *VariableStoreHeader;\r
  FORMSET_STORAGE               *Storage;\r
  BOOLEAN                       ReadIdHeaderFlag;\r
  UINT32                        Length;\r
  EFI_COMMON_SECTION_HEADER     *SectionHeader;\r
  UINT8                         *DataBase;\r
  static UINT16                 PreDefaultId[MAX_PLATFORM_DEFAULT_ID_NUM];\r
  static UINT64                 PrePlatformId[MAX_PLATFORM_DEFAULT_ID_NUM];\r
\r
  VariableStoreHeader = NULL;\r
  Variable            = NULL;\r
  ReadIdHeaderFlag    = TRUE;\r
  Length              = 0;\r
  SectionHeader       = (EFI_COMMON_SECTION_HEADER *)Binary;\r
  DataBase            = Binary + sizeof (EFI_COMMON_SECTION_HEADER);\r
  VariableStoreHeader = (VARIABLE_STORE_HEADER *) (DataBase + *(UINT16 *)DataBase);\r
  EndOfVariable       = GetEndPointer(VariableStoreHeader);\r
\r
  for (Variable = GetStartPointer (VariableStoreHeader);\r
    Length < VariableStoreHeader->Size;\r
    Length += sizeof (VARIABLE_HEADER) + Variable->NameSize + Variable->DataSize\r
  ) {\r
    //\r
    // Create the storage\r
    //\r
    Storage = NULL;\r
    Storage = calloc (sizeof (FORMSET_STORAGE), sizeof (CHAR8));\r
    if (Storage == NULL) {\r
      printf ("Allocate memory failed.\n");\r
      return FAIL;\r
    }\r
    //\r
    // If access the first storage, read the platformId and defaultId\r
    //\r
    if (ReadIdHeaderFlag) {\r
      ReadDefaultAndPlatformIdFromBfv (DataBase, Storage);\r
      Length += sizeof (VARIABLE_HEADER) + Variable->NameSize + Variable->DataSize;\r
      ReadIdHeaderFlag = FALSE;\r
      memcpy (PreDefaultId, Storage->DefaultId, MAX_PLATFORM_DEFAULT_ID_NUM * sizeof (UINT16));\r
      memcpy (PrePlatformId, Storage->PlatformId, MAX_PLATFORM_DEFAULT_ID_NUM * sizeof (UINT64));\r
    } else {\r
      //\r
      // Store the DefaultId and PlatformId collected from the header to Storage.\r
      //\r
      memcpy (Storage->DefaultId, PreDefaultId, MAX_PLATFORM_DEFAULT_ID_NUM * sizeof (UINT16));\r
      memcpy (Storage->PlatformId, PrePlatformId, MAX_PLATFORM_DEFAULT_ID_NUM * sizeof (UINT64));\r
    }\r
    Storage->Attributes     = Variable->Attributes;\r
    Storage->Size           = (UINT16)Variable->DataSize;\r
    Storage->Name           = calloc (Variable->NameSize, sizeof (UINT8));\r
    ASSERT (Storage->Name != NULL);\r
    Storage->Buffer         = calloc (Variable->DataSize, sizeof (UINT8));\r
    ASSERT (Storage->Buffer != NULL);\r
    memcpy (\r
      &(Storage->Guid),\r
      &(Variable->VendorGuid),\r
      sizeof (EFI_GUID)\r
    );\r
    memcpy (\r
      Storage->Name,\r
      (UINT8 *)Variable + sizeof (VARIABLE_HEADER),\r
      Variable->NameSize\r
    );\r
    memcpy (\r
      Storage->Buffer,\r
      (UINT8 *)Variable + sizeof (VARIABLE_HEADER) + Variable->NameSize + GET_PAD_SIZE (Variable->NameSize),\r
      Storage->Size * sizeof (CHAR8)\r
    );\r
    //\r
    // Assigned the value for comparison in verify mode\r
    //\r
    Storage->Type           = EFI_IFR_VARSTORE_EFI_OP;\r
    Storage->NewEfiVarstore = TRUE;\r
    InitializeListHead (&Storage->NameValueListHead);\r
\r
    InsertTailList(StorageListEntry, &Storage->Link);\r
    //\r
    // If the last variable, exit.\r
    //\r
    if (Variable == EndOfVariable) {\r
      break;\r
    }\r
\r
    Variable = GetNextVariablePtr (Variable);\r
    assert (Variable != NULL);\r
  }\r
  //\r
  // Return the length which is from the beginning of Binary\r
  //\r
  Length = FvBufExpand3ByteSize (SectionHeader->Size);\r
\r
  return Length;\r
}\r
\r
/**\r
  Check whether exists the valid MonotonicBased variables in NvStorage or not.\r
\r
  @retval TRUE      If existed, return TRUE.\r
  @retval FALSE     Others\r
**/\r
BOOLEAN\r
ExistMonotonicBasedEfiVarOrNot (\r
  IN  LIST_ENTRY  *StorageListHead\r
  )\r
{\r
  EFI_FIRMWARE_VOLUME_HEADER    *VarAddr;\r
  LIST_ENTRY                    *StorageLink;\r
  FORMSET_STORAGE               *Storage;\r
  VARIABLE_HEADER               *VariableHeader;\r
  VARIABLE_STORE_HEADER         *VariableStoreHeader;\r
\r
  VariableHeader      = NULL;\r
  VarAddr             = (EFI_FIRMWARE_VOLUME_HEADER   *) gEfiFdInfo.EfiVariableAddr;\r
  VariableStoreHeader = (VARIABLE_STORE_HEADER *)((CHAR8 *)VarAddr + VarAddr->HeaderLength);\r
  //\r
  //Parse the variable range, and check whether there is some existed ones.\r
  //\r
  StorageLink = GetFirstNode (StorageListHead);\r
  while (!IsNull (StorageListHead, StorageLink)) {\r
    Storage = FORMSET_STORAGE_FROM_LINK (StorageLink);\r
    //\r
    // Ignore the invalid varlist node\r
    //\r
    if ((Storage->Buffer == NULL)\r
      || (Storage->Name == NULL)\r
      || (FceStrLen(Storage->Name) == 0)\r
      ) {\r
     StorageLink = GetNextNode (StorageListHead, StorageLink);\r
     continue;\r
    }\r
    //\r
    // Report error, if the variable name is invalid.\r
    //\r
    if ((Storage->Name == NULL) || (FceStrLen(Storage->Name) == 0)) {\r
      StorageLink = GetNextNode (StorageListHead, StorageLink);\r
     continue;\r
    }\r
    VariableHeader = FindVariableInNv (\r
                       VariableStoreHeader,\r
                       Storage\r
                     );\r
\r
    if ((VariableHeader != NULL)) {\r
       return TRUE;\r
    }\r
    StorageLink = GetNextNode (StorageListHead, StorageLink);\r
  }\r
  return FALSE;\r
}\r
/**\r
  Fix the size of montonic variable header.\r
\r
  @param  Binary            The pointer to the header of storage under specifed platformId and defaultId\r
  @param  Length            The length of binary.\r
\r
**/\r
VOID\r
FixMontonicVariableHeaderSize (\r
  IN  UINT8   *BinaryBeginning,\r
  IN  UINT32  Length\r
  )\r
{\r
  VARIABLE_STORE_HEADER         *VariableStoreHeader;\r
\r
  VariableStoreHeader       = (VARIABLE_STORE_HEADER *) (BinaryBeginning + *(UINT16 *)BinaryBeginning);\r
  VariableStoreHeader->Size =  Length -  *(UINT16 *)BinaryBeginning;\r
}\r