]> git.proxmox.com Git - mirror_edk2.git/blobdiff - MdeModulePkg/Universal/HiiDatabaseDxe/ConfigRouting.c
MdeModulePkg: Convert HiiDatabaseDxe ConfigRouting ASSERT to return an error
[mirror_edk2.git] / MdeModulePkg / Universal / HiiDatabaseDxe / ConfigRouting.c
index 7cc71e2476e97c0a422518bd1f53864a364b02f3..55ac08cedb29859a7b55858f8bf18e7b2f0c388e 100644 (file)
@@ -1,7 +1,7 @@
 /** @file\r
 Implementation of interfaces function for EFI_HII_CONFIG_ROUTING_PROTOCOL.\r
 \r
-Copyright (c) 2007 - 2011, Intel Corporation. All rights reserved.<BR>\r
+Copyright (c) 2007 - 2015, Intel Corporation. All rights reserved.<BR>\r
 This program and the accompanying materials\r
 are licensed and made available under the terms and conditions of the BSD License\r
 which accompanies this distribution.  The full text of the license may be found at\r
@@ -242,7 +242,7 @@ GenerateSubStr (
   if (Buffer == NULL) {\r
     *SubStr = AllocateCopyPool (StrSize (String), String);\r
     ASSERT (*SubStr != NULL);\r
-    return ;\r
+    return;\r
   }\r
   \r
   //\r
@@ -252,8 +252,7 @@ GenerateSubStr (
   Str    = AllocateZeroPool (Length * sizeof (CHAR16));\r
   ASSERT (Str != NULL);\r
 \r
-  StrCpy (Str, String);\r
-  Length = (BufferLen * 2 + 1) * sizeof (CHAR16);\r
+  StrCpyS (Str, Length, String);\r
 \r
   StringHeader = Str + StrLen (String);\r
   TemString    = (CHAR16 *) StringHeader;\r
@@ -297,7 +296,7 @@ GenerateSubStr (
   //\r
   // Convert the uppercase to lowercase since <HexAf> is defined in lowercase format.\r
   //\r
-  StrCat (Str, L"&");  \r
+  StrCatS (Str, Length, L"&");  \r
   HiiToLower (Str);\r
 \r
   *SubStr = Str;\r
@@ -355,6 +354,9 @@ OutputConfigBody (
   }\r
 \r
   Length = TmpPtr - String;\r
+  if (Length == 0) {\r
+    return EFI_NOT_FOUND;\r
+  }\r
   Result = AllocateCopyPool (Length * sizeof (CHAR16), String);\r
   if (Result == NULL) {\r
     return EFI_OUT_OF_RESOURCES;\r
@@ -389,6 +391,7 @@ AppendToMultiString (
 {\r
   UINTN AppendStringSize;\r
   UINTN MultiStringSize;\r
+  UINTN MaxLen;\r
 \r
   if (MultiString == NULL || *MultiString == NULL || AppendString == NULL) {\r
     return EFI_INVALID_PARAMETER;\r
@@ -396,6 +399,7 @@ AppendToMultiString (
 \r
   AppendStringSize = StrSize (AppendString);\r
   MultiStringSize  = StrSize (*MultiString);\r
+  MaxLen = MAX_STRING_LENGTH / sizeof (CHAR16);\r
 \r
   //\r
   // Enlarge the buffer each time when length exceeds MAX_STRING_LENGTH.\r
@@ -407,12 +411,13 @@ AppendToMultiString (
                                   MultiStringSize + AppendStringSize,\r
                                   (VOID *) (*MultiString)\r
                                   );\r
+    MaxLen = (MultiStringSize + AppendStringSize) / sizeof (CHAR16);\r
     ASSERT (*MultiString != NULL);\r
   }\r
   //\r
   // Append the incoming string\r
   //\r
-  StrCat (*MultiString, AppendString);\r
+  StrCatS (*MultiString, MaxLen, AppendString);\r
 \r
   return EFI_SUCCESS;\r
 }\r
@@ -533,6 +538,8 @@ MergeDefaultString (
   EFI_STRING   AltConfigHdr;\r
   UINTN        HeaderLength;\r
   UINTN        SizeAltCfgResp;\r
+  UINTN        MaxLen;\r
+  UINTN        TotalSize;\r
   \r
   if (*AltCfgResp == NULL) {\r
     return EFI_INVALID_PARAMETER;\r
@@ -569,13 +576,14 @@ MergeDefaultString (
   // Construct AltConfigHdr string  "&<ConfigHdr>&ALTCFG=XXXX\0"\r
   //                                  |1| StrLen (ConfigHdr) | 8 | 4 | 1 |\r
   //\r
-  AltConfigHdr = AllocateZeroPool ((1 + HeaderLength + 8 + 4 + 1) * sizeof (CHAR16));\r
+  MaxLen = 1 + HeaderLength + 8 + 4 + 1;\r
+  AltConfigHdr = AllocateZeroPool (MaxLen * sizeof (CHAR16));\r
   if (AltConfigHdr == NULL) {\r
     return EFI_OUT_OF_RESOURCES;\r
   }\r
-  StrCpy (AltConfigHdr, L"&");\r
-  StrnCat (AltConfigHdr, *AltCfgResp, HeaderLength);\r
-  StrCat (AltConfigHdr, L"&ALTCFG=");\r
+  StrCpyS (AltConfigHdr, MaxLen, L"&");\r
+  StrnCatS (AltConfigHdr, MaxLen, *AltCfgResp, HeaderLength);\r
+  StrCatS (AltConfigHdr, MaxLen, L"&ALTCFG=");\r
   HeaderLength = StrLen (AltConfigHdr);\r
   \r
   StringPtrDefault = StrStr (DefaultAltCfgResp, AltConfigHdr);\r
@@ -583,7 +591,7 @@ MergeDefaultString (
     //\r
     // Get AltCfg Name\r
     //\r
-    StrnCat (AltConfigHdr, StringPtrDefault + HeaderLength, 4);\r
+    StrnCatS (AltConfigHdr, MaxLen, StringPtrDefault + HeaderLength, 4);\r
     StringPtr = StrStr (*AltCfgResp, AltConfigHdr); \r
     \r
     //\r
@@ -592,34 +600,35 @@ MergeDefaultString (
     if (StringPtr == NULL) {\r
       StringPtrEnd   = StrStr (StringPtrDefault + 1, L"&GUID");\r
       SizeAltCfgResp = StrSize (*AltCfgResp);\r
+      TotalSize = SizeAltCfgResp + StrSize (StringPtrDefault);\r
       if (StringPtrEnd == NULL) {\r
         //\r
         // No more default string is found.\r
         //\r
         *AltCfgResp    = (EFI_STRING) ReallocatePool (\r
                                      SizeAltCfgResp,\r
-                                     SizeAltCfgResp + StrSize (StringPtrDefault),\r
+                                     TotalSize,\r
                                      (VOID *) (*AltCfgResp)\r
                                      );\r
         if (*AltCfgResp == NULL) {\r
           FreePool (AltConfigHdr);\r
           return EFI_OUT_OF_RESOURCES;\r
         }\r
-        StrCat (*AltCfgResp, StringPtrDefault);\r
+        StrCatS (*AltCfgResp, TotalSize / sizeof (CHAR16), StringPtrDefault);\r
         break;\r
       } else {\r
         TempChar = *StringPtrEnd;\r
         *StringPtrEnd = L'\0';\r
         *AltCfgResp = (EFI_STRING) ReallocatePool (\r
                                      SizeAltCfgResp,\r
-                                     SizeAltCfgResp + StrSize (StringPtrDefault),\r
+                                     TotalSize,\r
                                      (VOID *) (*AltCfgResp)\r
                                      );\r
         if (*AltCfgResp == NULL) {\r
           FreePool (AltConfigHdr);\r
           return EFI_OUT_OF_RESOURCES;\r
         }\r
-        StrCat (*AltCfgResp, StringPtrDefault);\r
+        StrCatS (*AltCfgResp, TotalSize / sizeof (CHAR16), StringPtrDefault);\r
         *StringPtrEnd = TempChar;\r
       }\r
     }\r
@@ -628,7 +637,7 @@ MergeDefaultString (
     // Find next AltCfg String\r
     //\r
     *(AltConfigHdr + HeaderLength) = L'\0';\r
-    StringPtrDefault = StrStr (StringPtrDefault + 1, AltConfigHdr);    \r
+    StringPtrDefault = StrStr (StringPtrDefault + 1, AltConfigHdr);\r
   }\r
   \r
   FreePool (AltConfigHdr);\r
@@ -649,9 +658,12 @@ InsertDefaultValue (
   )\r
 {\r
   LIST_ENTRY             *Link;\r
-  IFR_DEFAULT_DATA       *DefaultValueArray;\r
+  IFR_DEFAULT_DATA       *DefaultValueArray; \r
+  LIST_ENTRY             *DefaultLink;\r
\r
+  DefaultLink   = &BlockData->DefaultValueEntry;\r
 \r
-  for (Link = BlockData->DefaultValueEntry.ForwardLink; Link != &BlockData->DefaultValueEntry; Link = Link->ForwardLink) {\r
+  for (Link = DefaultLink->ForwardLink; Link != DefaultLink; Link = Link->ForwardLink) {\r
     DefaultValueArray = BASE_CR (Link, IFR_DEFAULT_DATA, Entry);\r
     if (DefaultValueArray->DefaultId == DefaultValueData->DefaultId) {\r
       //\r
@@ -661,7 +673,7 @@ InsertDefaultValue (
         //\r
         // Update the default value array in BlockData.\r
         //\r
-        DefaultValueArray->Value = DefaultValueData->Value;\r
+        CopyMem (&DefaultValueArray->Value, &DefaultValueData->Value, sizeof (EFI_IFR_TYPE_VALUE));\r
         DefaultValueArray->Type  = DefaultValueData->Type;\r
         DefaultValueArray->Cleaned = DefaultValueData->Cleaned;\r
       }\r
@@ -681,8 +693,8 @@ InsertDefaultValue (
 /**\r
   This function inserts new BlockData into the block link\r
 \r
-  @param  BlockLink   The list entry points to block array.\r
-  @param  BlockData   The point to BlockData is added.\r
+  @param  BlockLink      The list entry points to block array.\r
+  @param  BlockData      The point to BlockData is added.\r
   \r
 **/\r
 VOID\r
@@ -691,12 +703,17 @@ InsertBlockData (
   IN IFR_BLOCK_DATA    **BlockData\r
   )\r
 {\r
-  LIST_ENTRY      *Link;\r
-  IFR_BLOCK_DATA  *BlockArray;\r
-  IFR_BLOCK_DATA  *BlockSingleData;\r
+  LIST_ENTRY          *Link;\r
+  IFR_BLOCK_DATA      *BlockArray;\r
+  IFR_BLOCK_DATA      *BlockSingleData;\r
 \r
   BlockSingleData = *BlockData;\r
-  \r
+\r
+  if (BlockSingleData->Name != NULL) {\r
+    InsertTailList (BlockLink, &BlockSingleData->Entry);\r
+    return;\r
+  }\r
+\r
   //\r
   // Insert block data in its Offset and Width order.\r
   //\r
@@ -715,8 +732,10 @@ InsertBlockData (
         //\r
         // The same block array has been added.\r
         //\r
-        FreePool (BlockSingleData);\r
-        *BlockData = BlockArray;\r
+        if (BlockSingleData != BlockArray) {\r
+          FreePool (BlockSingleData);\r
+          *BlockData = BlockArray;\r
+        }\r
         return;\r
       }\r
     } else if (BlockArray->Offset > BlockSingleData->Offset) {\r
@@ -731,8 +750,225 @@ InsertBlockData (
   //\r
   // Add new block data into the tail.\r
   //\r
-  InsertTailList (Link, &BlockSingleData->Entry);\r
-  return;  \r
+  InsertTailList (Link, &BlockSingleData->Entry); \r
+}\r
+\r
+/**\r
+  Retrieves a pointer to the a Null-terminated ASCII string containing the list \r
+  of languages that an HII handle in the HII Database supports.  The returned \r
+  string is allocated using AllocatePool().  The caller is responsible for freeing\r
+  the returned string using FreePool().  The format of the returned string follows\r
+  the language format assumed the HII Database.\r
+  \r
+  If HiiHandle is NULL, then ASSERT().\r
+\r
+  @param[in]  HiiHandle  A handle that was previously registered in the HII Database.\r
+\r
+  @retval NULL   HiiHandle is not registered in the HII database\r
+  @retval NULL   There are not enough resources available to retrieve the suported \r
+                 languages.\r
+  @retval NULL   The list of suported languages could not be retrieved.\r
+  @retval Other  A pointer to the Null-terminated ASCII string of supported languages.\r
+\r
+**/\r
+CHAR8 *\r
+GetSupportedLanguages (\r
+  IN EFI_HII_HANDLE           HiiHandle\r
+  )\r
+{\r
+  EFI_STATUS  Status;\r
+  UINTN       LanguageSize;\r
+  CHAR8       TempSupportedLanguages;\r
+  CHAR8       *SupportedLanguages;\r
+\r
+  ASSERT (HiiHandle != NULL);\r
+\r
+  //\r
+  // Retrieve the size required for the supported languages buffer.\r
+  //\r
+  LanguageSize = 0;\r
+  Status = mPrivate.HiiString.GetLanguages (&mPrivate.HiiString, HiiHandle, &TempSupportedLanguages, &LanguageSize);\r
+\r
+  //\r
+  // If GetLanguages() returns EFI_SUCCESS for a zero size, \r
+  // then there are no supported languages registered for HiiHandle.  If GetLanguages() \r
+  // returns an error other than EFI_BUFFER_TOO_SMALL, then HiiHandle is not present\r
+  // in the HII Database\r
+  //\r
+  if (Status != EFI_BUFFER_TOO_SMALL) {\r
+    //\r
+    // Return NULL if the size can not be retrieved, or if HiiHandle is not in the HII Database\r
+    //\r
+    return NULL;\r
+  }\r
+\r
+  //\r
+  // Allocate the supported languages buffer.\r
+  //\r
+  SupportedLanguages = AllocateZeroPool (LanguageSize);\r
+  if (SupportedLanguages == NULL) {\r
+    //\r
+    // Return NULL if allocation fails.\r
+    //\r
+    return NULL;\r
+  }\r
+\r
+  //\r
+  // Retrieve the supported languages string\r
+  //\r
+  Status = mPrivate.HiiString.GetLanguages (&mPrivate.HiiString, HiiHandle, SupportedLanguages, &LanguageSize);\r
+  if (EFI_ERROR (Status)) {\r
+    //\r
+    // Free the buffer and return NULL if the supported languages can not be retrieved.\r
+    //\r
+    FreePool (SupportedLanguages);\r
+    return NULL;\r
+  }\r
+\r
+  //\r
+  // Return the Null-terminated ASCII string of supported languages\r
+  //\r
+  return SupportedLanguages;\r
+}\r
+\r
+/**\r
+  Retrieves a string from a string package.\r
+  \r
+  If HiiHandle is NULL, then ASSERT().\r
+  If StringId is 0, then ASSET.\r
+\r
+  @param[in]  HiiHandle  A handle that was previously registered in the HII Database.\r
+  @param[in]  StringId   The identifier of the string to retrieved from the string \r
+                         package associated with HiiHandle.\r
+\r
+  @retval NULL   The string specified by StringId is not present in the string package.\r
+  @retval Other  The string was returned.\r
+\r
+**/\r
+EFI_STRING\r
+InternalGetString (\r
+  IN EFI_HII_HANDLE  HiiHandle,\r
+  IN EFI_STRING_ID   StringId\r
+  )\r
+{\r
+  EFI_STATUS  Status;\r
+  UINTN       StringSize;\r
+  CHAR16      TempString;\r
+  EFI_STRING  String;\r
+  CHAR8       *SupportedLanguages;\r
+  CHAR8       *PlatformLanguage;\r
+  CHAR8       *BestLanguage;\r
+  CHAR8       *Language;\r
+\r
+  ASSERT (HiiHandle != NULL);\r
+  ASSERT (StringId != 0);\r
+\r
+  //\r
+  // Initialize all allocated buffers to NULL\r
+  // \r
+  SupportedLanguages = NULL;\r
+  PlatformLanguage   = NULL;\r
+  BestLanguage       = NULL;\r
+  String             = NULL;\r
+  Language           = "";\r
+\r
+  //\r
+  // Get the languages that the package specified by HiiHandle supports\r
+  //\r
+  SupportedLanguages = GetSupportedLanguages (HiiHandle);\r
+  if (SupportedLanguages == NULL) {\r
+    goto Error;\r
+  }\r
+\r
+  //\r
+  // Get the current platform language setting\r
+  //\r
+  GetEfiGlobalVariable2 (L"PlatformLang", (VOID**)&PlatformLanguage, NULL);\r
+\r
+  //\r
+  // Get the best matching language from SupportedLanguages\r
+  //\r
+  BestLanguage = GetBestLanguage (\r
+                   SupportedLanguages, \r
+                   FALSE,                                             // RFC 4646 mode\r
+                   Language,                                          // Highest priority \r
+                   PlatformLanguage != NULL ? PlatformLanguage : "",  // Next highest priority\r
+                   SupportedLanguages,                                // Lowest priority \r
+                   NULL\r
+                   );\r
+  if (BestLanguage == NULL) {\r
+    goto Error;\r
+  }\r
+\r
+  //\r
+  // Retrieve the size of the string in the string package for the BestLanguage\r
+  //\r
+  StringSize = 0;\r
+  Status = mPrivate.HiiString.GetString (\r
+                         &mPrivate.HiiString,\r
+                         BestLanguage,\r
+                         HiiHandle,\r
+                         StringId,\r
+                         &TempString,\r
+                         &StringSize,\r
+                         NULL\r
+                         );\r
+  //\r
+  // If GetString() returns EFI_SUCCESS for a zero size, \r
+  // then there are no supported languages registered for HiiHandle.  If GetString() \r
+  // returns an error other than EFI_BUFFER_TOO_SMALL, then HiiHandle is not present\r
+  // in the HII Database\r
+  //\r
+  if (Status != EFI_BUFFER_TOO_SMALL) {\r
+    goto Error;\r
+  }\r
+\r
+  //\r
+  // Allocate a buffer for the return string\r
+  //\r
+  String = AllocateZeroPool (StringSize);\r
+  if (String == NULL) {\r
+    goto Error;\r
+  }\r
+\r
+  //\r
+  // Retrieve the string from the string package\r
+  //\r
+  Status = mPrivate.HiiString.GetString (\r
+                         &mPrivate.HiiString,\r
+                         BestLanguage,\r
+                         HiiHandle,\r
+                         StringId,\r
+                         String,\r
+                         &StringSize,\r
+                         NULL\r
+                         );\r
+  if (EFI_ERROR (Status)) {\r
+    //\r
+    // Free the buffer and return NULL if the supported languages can not be retrieved.\r
+    //\r
+    FreePool (String);\r
+    String = NULL;\r
+  }\r
+\r
+Error:\r
+  //\r
+  // Free allocated buffers\r
+  //\r
+  if (SupportedLanguages != NULL) {\r
+    FreePool (SupportedLanguages);\r
+  }\r
+  if (PlatformLanguage != NULL) {\r
+    FreePool (PlatformLanguage);\r
+  }\r
+  if (BestLanguage != NULL) {\r
+    FreePool (BestLanguage);\r
+  }\r
+\r
+  //\r
+  // Return the Null-terminated Unicode string\r
+  //\r
+  return String;\r
 }\r
 \r
 /**\r
@@ -741,6 +977,8 @@ InsertBlockData (
   @param  RequestBlockArray  The block array is to be checked. \r
   @param  VarOffset          Offset of var to the structure\r
   @param  VarWidth           Width of var.\r
+  @param  IsNameValueType    Whether this varstore is name/value varstore or not.\r
+  @param  HiiHandle          Hii handle for this hii package.\r
   \r
   @retval TRUE   This Var is in the block range.\r
   @retval FALSE  This Var is not in the block range.\r
@@ -749,26 +987,41 @@ BOOLEAN
 BlockArrayCheck (\r
   IN IFR_BLOCK_DATA  *RequestBlockArray,\r
   IN UINT16          VarOffset,\r
-  IN UINT16          VarWidth\r
+  IN UINT16          VarWidth,\r
+  IN BOOLEAN         IsNameValueType,\r
+  IN EFI_HII_HANDLE  HiiHandle\r
   )\r
 {\r
   LIST_ENTRY          *Link;\r
   IFR_BLOCK_DATA      *BlockData;\r
-  \r
+  EFI_STRING          Name;\r
+\r
   //\r
   // No Request Block array, all vars are got.\r
   //\r
   if (RequestBlockArray == NULL) {\r
     return TRUE;\r
   }\r
-  \r
+\r
   //\r
   // Check the input var is in the request block range.\r
   //\r
   for (Link = RequestBlockArray->Entry.ForwardLink; Link != &RequestBlockArray->Entry; Link = Link->ForwardLink) {\r
     BlockData = BASE_CR (Link, IFR_BLOCK_DATA, Entry);\r
-    if ((VarOffset >= BlockData->Offset) && ((VarOffset + VarWidth) <= (BlockData->Offset + BlockData->Width))) {\r
-      return TRUE;\r
+\r
+    if (IsNameValueType) {\r
+      Name = InternalGetString (HiiHandle, VarOffset);\r
+      ASSERT (Name != NULL);\r
+\r
+      if (StrnCmp (BlockData->Name, Name, StrLen (Name)) == 0) {\r
+        FreePool (Name);\r
+        return TRUE;\r
+      }\r
+      FreePool (Name);\r
+    } else {\r
+      if ((VarOffset >= BlockData->Offset) && ((VarOffset + VarWidth) <= (BlockData->Offset + BlockData->Width))) {\r
+        return TRUE;\r
+      }\r
     }\r
   }\r
 \r
@@ -861,11 +1114,11 @@ GetVarStoreType (
   IN     EFI_STRING                 ConfigHdr,\r
   OUT    BOOLEAN                    *IsEfiVarstore,\r
   OUT    EFI_IFR_VARSTORE_EFI       **EfiVarStore\r
-  \r
   )\r
 {\r
   EFI_STATUS               Status;\r
   UINTN                    IfrOffset;\r
+  UINTN                    PackageOffset;\r
   EFI_IFR_OP_HEADER        *IfrOpHdr;\r
   CHAR16                   *VarStoreName;\r
   EFI_STRING               GuidStr;\r
@@ -875,6 +1128,7 @@ GetVarStoreType (
   UINT8                    *HiiFormPackage;\r
   UINTN                    PackageSize;\r
   EFI_IFR_VARSTORE_EFI     *IfrEfiVarStore;\r
+  EFI_HII_PACKAGE_HEADER   *PackageHeader;\r
   \r
   HiiFormPackage = NULL;\r
   LengthString     = 0;\r
@@ -882,16 +1136,33 @@ GetVarStoreType (
   GuidStr          = NULL;\r
   NameStr          = NULL;\r
   TempStr          = NULL;\r
+  *IsEfiVarstore   = FALSE;\r
 \r
   Status = GetFormPackageData(DataBaseRecord, &HiiFormPackage, &PackageSize);\r
   if (EFI_ERROR (Status)) {\r
     return Status;\r
   }\r
 \r
-  IfrOffset   = sizeof (EFI_HII_PACKAGE_HEADER);\r
+  IfrOffset     = sizeof (EFI_HII_PACKAGE_HEADER);\r
+  PackageOffset = IfrOffset;\r
+  PackageHeader = (EFI_HII_PACKAGE_HEADER *) HiiFormPackage;\r
+\r
   while (IfrOffset < PackageSize) {\r
-    IfrOpHdr  = (EFI_IFR_OP_HEADER *) (HiiFormPackage + IfrOffset);    \r
+    //\r
+    // More than one form packages exist.\r
+    //\r
+    if (PackageOffset >= PackageHeader->Length) {\r
+        //\r
+        // Process the new form package.\r
+        //\r
+        PackageOffset = sizeof (EFI_HII_PACKAGE_HEADER);\r
+        IfrOffset    += PackageOffset;\r
+        PackageHeader = (EFI_HII_PACKAGE_HEADER *) (HiiFormPackage + IfrOffset);\r
+    }\r
+\r
+    IfrOpHdr  = (EFI_IFR_OP_HEADER *) (HiiFormPackage + IfrOffset);\r
     IfrOffset += IfrOpHdr->Length;\r
+    PackageOffset += IfrOpHdr->Length;\r
 \r
     if (IfrOpHdr->OpCode == EFI_IFR_VARSTORE_EFI_OP ) {\r
       IfrEfiVarStore = (EFI_IFR_VARSTORE_EFI *) IfrOpHdr;\r
@@ -923,8 +1194,8 @@ GetVarStoreType (
         Status = EFI_OUT_OF_RESOURCES;\r
         goto Done;\r
       }\r
-      StrCpy (TempStr, GuidStr);\r
-      StrCat (TempStr, NameStr);\r
+      StrCpyS (TempStr, LengthString, GuidStr);\r
+      StrCatS (TempStr, LengthString, NameStr);\r
       if (ConfigHdr == NULL || StrnCmp (ConfigHdr, TempStr, StrLen (TempStr)) == 0) {\r
         *EfiVarStore = (EFI_IFR_VARSTORE_EFI *) AllocateZeroPool (IfrOpHdr->Length);\r
         if (*EfiVarStore == NULL) {\r
@@ -946,6 +1217,13 @@ GetVarStoreType (
       FreePool (GuidStr);\r
       FreePool (NameStr);\r
       FreePool (TempStr);\r
+\r
+      //\r
+      // Already found the varstore, break;\r
+      //\r
+      if (*IsEfiVarstore) {\r
+        break;\r
+      }\r
     }\r
   }\r
 Done:\r
@@ -957,630 +1235,859 @@ Done:
 }\r
 \r
 /**\r
-  This function parses Form Package to get the block array and the default\r
-  value array according to the request ConfigHdr.\r
+  Check whether the ConfigRequest string has the request elements.\r
+  For EFI_HII_VARSTORE_BUFFER type, the request has "&OFFSET=****&WIDTH=****..." format.\r
+  For EFI_HII_VARSTORE_NAME_VALUE type, the request has "&NAME1**&NAME2..." format.\r
 \r
-  @param  Package               Pointer to the form package data.\r
-  @param  PackageLength         Length of the pacakge.\r
-  @param  ConfigHdr             Request string ConfigHdr. If it is NULL,\r
-                                the first found varstore will be as ConfigHdr.\r
-  @param  RequestBlockArray     The block array is retrieved from the request string.\r
-  @param  VarStorageData        VarStorage structure contains the got block and default value.\r
-  @param  PIfrDefaultIdArray    Point to the got default id and default name array.\r
+  @param  ConfigRequest      The input config request string.\r
+\r
+  @retval  TRUE              The input include config request elements.\r
+  @retval  FALSE             The input string not includes.\r
 \r
-  @retval EFI_SUCCESS           The block array and the default value array are got.\r
-  @retval EFI_INVALID_PARAMETER The varstore defintion in the differnt form pacakges\r
-                                are conflicted. \r
-  @retval EFI_OUT_OF_RESOURCES  No enough memory.\r
 **/\r
-EFI_STATUS\r
-EFIAPI\r
-ParseIfrData (\r
-  IN     UINT8               *Package,\r
-  IN     UINT32              PackageLength,\r
-  IN     EFI_STRING          ConfigHdr,\r
-  IN     IFR_BLOCK_DATA      *RequestBlockArray,\r
-  IN OUT IFR_VARSTORAGE_DATA *VarStorageData,\r
-  OUT    IFR_DEFAULT_DATA    *DefaultIdArray\r
+BOOLEAN\r
+GetElementsFromRequest (\r
+  IN EFI_STRING    ConfigRequest\r
+  )\r
+{\r
+  EFI_STRING   TmpRequest;\r
+\r
+  TmpRequest = StrStr (ConfigRequest, L"PATH=");\r
+  ASSERT (TmpRequest != NULL);\r
+\r
+  if ((StrStr (TmpRequest, L"&OFFSET=") != NULL) || (StrStr (TmpRequest, L"&") != NULL)) {\r
+    return TRUE;\r
+  }\r
+\r
+  return FALSE;\r
+}\r
+\r
+/**\r
+  Check whether the this varstore is the request varstore.\r
+\r
+  @param  VarstoreGuid      Varstore guid.\r
+  @param  Name              Varstore name.\r
+  @param  ConfigHdr         Current configRequest info.\r
+\r
+  @retval  TRUE              This varstore is the requst one.\r
+  @retval  FALSE             This varstore is not the requst one.\r
+                                 \r
+**/\r
+BOOLEAN\r
+IsThisVarstore (\r
+  IN EFI_GUID    *VarstoreGuid,\r
+  IN CHAR16      *Name,\r
+  IN CHAR16      *ConfigHdr\r
   )\r
 {\r
-  EFI_STATUS               Status;\r
-  UINTN                    IfrOffset;\r
-  EFI_IFR_VARSTORE         *IfrVarStore;\r
-  EFI_IFR_VARSTORE_EFI     *IfrEfiVarStore;\r
-  EFI_IFR_OP_HEADER        *IfrOpHdr;\r
-  EFI_IFR_ONE_OF           *IfrOneOf;\r
-  EFI_IFR_ONE_OF_OPTION    *IfrOneOfOption;\r
-  EFI_IFR_DEFAULT          *IfrDefault;\r
-  EFI_IFR_ORDERED_LIST     *IfrOrderedList;\r
-  EFI_IFR_CHECKBOX         *IfrCheckBox;\r
-  EFI_IFR_PASSWORD         *IfrPassword;\r
-  EFI_IFR_STRING           *IfrString;\r
-  IFR_DEFAULT_DATA         DefaultData;\r
-  IFR_DEFAULT_DATA         *DefaultDataPtr;\r
-  IFR_BLOCK_DATA           *BlockData;\r
-  CHAR16                   *VarStoreName;\r
-  UINT16                   VarOffset;\r
-  UINT16                   VarWidth;\r
-  UINT16                   VarDefaultId;\r
   EFI_STRING               GuidStr;\r
   EFI_STRING               NameStr;\r
   EFI_STRING               TempStr;\r
   UINTN                    LengthString;\r
-  BOOLEAN                  FirstOneOfOption;\r
-  LIST_ENTRY               *LinkData;\r
-  LIST_ENTRY               *LinkDefault;\r
+  BOOLEAN                  RetVal;\r
 \r
-  LengthString     = 0;\r
-  Status           = EFI_SUCCESS;\r
-  GuidStr          = NULL;\r
-  NameStr          = NULL;\r
-  TempStr          = NULL;\r
-  BlockData        = NULL;\r
-  DefaultDataPtr   = NULL;\r
-  FirstOneOfOption = FALSE;\r
-  ZeroMem (&DefaultData, sizeof (IFR_DEFAULT_DATA));\r
+  RetVal       = FALSE;\r
+  GuidStr      = NULL;\r
+  TempStr      = NULL;\r
 \r
   //\r
-  // Go through the form package to parse OpCode one by one.\r
+  // If ConfigHdr has name field and varstore not has name, return FALSE.\r
   //\r
-  IfrOffset   = sizeof (EFI_HII_PACKAGE_HEADER);\r
-  while (IfrOffset < PackageLength) {\r
-    IfrOpHdr  = (EFI_IFR_OP_HEADER *) (Package + IfrOffset);\r
+  if (Name == NULL && ConfigHdr != NULL && StrStr (ConfigHdr, L"NAME=&") == NULL) {\r
+    return FALSE;\r
+  }\r
 \r
-    switch (IfrOpHdr->OpCode) {\r
-    case EFI_IFR_VARSTORE_OP:\r
-      //\r
-      // VarStore is found. Don't need to search any more.\r
-      //\r
-      if (VarStorageData->Size != 0) {\r
-        break;\r
-      }\r
+  GenerateSubStr (L"GUID=", sizeof (EFI_GUID), (VOID *)VarstoreGuid, 1, &GuidStr);\r
+  if (Name != NULL) {\r
+    GenerateSubStr (L"NAME=", StrLen (Name) * sizeof (CHAR16), (VOID *) Name, 2, &NameStr);\r
+  } else {\r
+    GenerateSubStr (L"NAME=", 0, NULL, 2, &NameStr);\r
+  }\r
+  LengthString = StrLen (GuidStr);\r
+  LengthString = LengthString + StrLen (NameStr) + 1;\r
+  TempStr = AllocateZeroPool (LengthString * sizeof (CHAR16));\r
+  if (TempStr == NULL) {\r
+    goto Done;\r
+  }\r
 \r
-      //\r
-      // Get the requied varstore information\r
-      // Add varstore by Guid and Name in ConfigHdr\r
-      // Make sure Offset is in varstore size and varstoreid\r
-      //\r
-      IfrVarStore = (EFI_IFR_VARSTORE *) IfrOpHdr;\r
-      VarStoreName = AllocateZeroPool (AsciiStrSize ((CHAR8 *)IfrVarStore->Name) * sizeof (CHAR16));\r
-      if (VarStoreName == NULL) {\r
-        Status = EFI_OUT_OF_RESOURCES;\r
-        goto Done;\r
-      }\r
-      AsciiStrToUnicodeStr ((CHAR8 *) IfrVarStore->Name, VarStoreName);\r
+  StrCpyS (TempStr, LengthString, GuidStr);\r
+  StrCatS (TempStr, LengthString, NameStr);\r
 \r
-      GenerateSubStr (L"GUID=", sizeof (EFI_GUID), (VOID *) &IfrVarStore->Guid, 1, &GuidStr);\r
-      GenerateSubStr (L"NAME=", StrLen (VarStoreName) * sizeof (CHAR16), (VOID *) VarStoreName, 2, &NameStr);\r
-      LengthString = StrLen (GuidStr);\r
-      LengthString = LengthString + StrLen (NameStr) + 1;\r
-      TempStr = AllocateZeroPool (LengthString * sizeof (CHAR16));\r
-      if (TempStr == NULL) {\r
-        FreePool (GuidStr);\r
-        FreePool (NameStr);\r
-        FreePool (VarStoreName);\r
-        Status = EFI_OUT_OF_RESOURCES;\r
-        goto Done;\r
-      }\r
-      StrCpy (TempStr, GuidStr);\r
-      StrCat (TempStr, NameStr);\r
-      if (ConfigHdr == NULL || StrnCmp (ConfigHdr, TempStr, StrLen (TempStr)) == 0) {\r
-        //\r
-        // Find the matched VarStore\r
-        //\r
-        CopyGuid (&VarStorageData->Guid, (EFI_GUID *) (VOID *) &IfrVarStore->Guid);\r
-        VarStorageData->VarStoreId = IfrVarStore->VarStoreId;\r
-        VarStorageData->Size       = IfrVarStore->Size;\r
-        VarStorageData->Name       = VarStoreName;\r
-      } else {\r
-        //\r
-        // No found, free the allocated memory \r
-        //\r
-        FreePool (VarStoreName);\r
-      }\r
-      //\r
-      // Free alllocated temp string.\r
-      //\r
-      FreePool (GuidStr);\r
-      FreePool (NameStr);\r
-      FreePool (TempStr);\r
-      break;\r
+  if (ConfigHdr == NULL || StrnCmp (ConfigHdr, TempStr, StrLen (TempStr)) == 0) {\r
+    RetVal = TRUE;\r
+  }\r
 \r
-    case EFI_IFR_VARSTORE_EFI_OP:\r
-      //\r
-      // VarStore is found. Don't need to search any more.\r
-      //\r
-      if (VarStorageData->Size != 0) {\r
-        break;\r
-      }\r
+Done:\r
+  if (GuidStr != NULL) {\r
+    FreePool (GuidStr); \r
+  }\r
 \r
-      //\r
-      // Get the requied varstore information\r
-      // Add varstore by Guid and Name in ConfigHdr\r
-      // Make sure Offset is in varstore size and varstoreid\r
-      //\r
-      IfrEfiVarStore = (EFI_IFR_VARSTORE_EFI *) IfrOpHdr;\r
+  if (NameStr != NULL) {\r
+    FreePool (NameStr);\r
+  }\r
 \r
-      //\r
-      // If the length is small than the structure, this is from old efi \r
-      // varstore definition. Old efi varstore get config directly from \r
-      // GetVariable function.\r
-      //      \r
-      if (IfrOpHdr->Length < sizeof (EFI_IFR_VARSTORE_EFI)) {\r
-        break;\r
-      }\r
+  if (TempStr != NULL) {\r
+    FreePool (TempStr);\r
+  }\r
 \r
-      VarStoreName = AllocateZeroPool (AsciiStrSize ((CHAR8 *)IfrEfiVarStore->Name) * sizeof (CHAR16));\r
+  return RetVal;\r
+}\r
+\r
+/**\r
+  This function parses Form Package to get the efi varstore info according to the request ConfigHdr.\r
+\r
+  @param  DataBaseRecord        The DataBaseRecord instance contains the found Hii handle and package.\r
+  @param  ConfigHdr             Request string ConfigHdr. If it is NULL,\r
+                                the first found varstore will be as ConfigHdr.\r
+  @retval  TRUE                 This hii package is the reqeust one.\r
+  @retval  FALSE                This hii package is not the reqeust one.\r
+**/                                \r
+BOOLEAN\r
+IsThisPackageList (\r
+  IN     HII_DATABASE_RECORD        *DataBaseRecord,\r
+  IN     EFI_STRING                 ConfigHdr\r
+  )\r
+{\r
+  EFI_STATUS               Status;\r
+  UINTN                    IfrOffset;\r
+  UINTN                    PackageOffset;\r
+  EFI_IFR_OP_HEADER        *IfrOpHdr;\r
+  CHAR16                   *VarStoreName;\r
+  UINT8                    *HiiFormPackage;\r
+  UINTN                    PackageSize;\r
+  EFI_IFR_VARSTORE_EFI     *IfrEfiVarStore;\r
+  EFI_HII_PACKAGE_HEADER   *PackageHeader;\r
+  EFI_IFR_VARSTORE         *IfrVarStore;\r
+  EFI_IFR_VARSTORE_NAME_VALUE *IfrNameValueVarStore;\r
+  BOOLEAN                  FindVarstore;\r
+\r
+  HiiFormPackage   = NULL;\r
+  VarStoreName     = NULL;\r
+  Status           = EFI_SUCCESS;\r
+  FindVarstore     = FALSE;\r
+\r
+  Status = GetFormPackageData(DataBaseRecord, &HiiFormPackage, &PackageSize);\r
+  if (EFI_ERROR (Status)) {\r
+    return FALSE;\r
+  }\r
+\r
+  IfrOffset     = sizeof (EFI_HII_PACKAGE_HEADER);\r
+  PackageOffset = IfrOffset;\r
+  PackageHeader = (EFI_HII_PACKAGE_HEADER *) HiiFormPackage;\r
+\r
+  while (IfrOffset < PackageSize) {\r
+    //\r
+    // More than one form packages exist.\r
+    //\r
+    if (PackageOffset >= PackageHeader->Length) {\r
+        //\r
+        // Process the new form package.\r
+        //\r
+        PackageOffset = sizeof (EFI_HII_PACKAGE_HEADER);\r
+        IfrOffset    += PackageOffset;\r
+        PackageHeader = (EFI_HII_PACKAGE_HEADER *) (HiiFormPackage + IfrOffset);\r
+    }\r
+\r
+    IfrOpHdr  = (EFI_IFR_OP_HEADER *) (HiiFormPackage + IfrOffset);\r
+    IfrOffset += IfrOpHdr->Length;\r
+    PackageOffset += IfrOpHdr->Length;\r
+\r
+    switch (IfrOpHdr->OpCode) {\r
+    \r
+    case EFI_IFR_VARSTORE_OP:\r
+      IfrVarStore = (EFI_IFR_VARSTORE *) IfrOpHdr;\r
+\r
+      VarStoreName = AllocateZeroPool (AsciiStrSize ((CHAR8 *)IfrVarStore->Name) * sizeof (CHAR16));\r
       if (VarStoreName == NULL) {\r
-        Status = EFI_OUT_OF_RESOURCES;\r
         goto Done;\r
       }\r
-      AsciiStrToUnicodeStr ((CHAR8 *) IfrEfiVarStore->Name, VarStoreName);\r
+      AsciiStrToUnicodeStr ((CHAR8 *)IfrVarStore->Name, VarStoreName);\r
 \r
-      GenerateSubStr (L"GUID=", sizeof (EFI_GUID), (VOID *) &IfrEfiVarStore->Guid, 1, &GuidStr);\r
-      GenerateSubStr (L"NAME=", StrLen (VarStoreName) * sizeof (CHAR16), (VOID *) VarStoreName, 2, &NameStr);\r
-      LengthString = StrLen (GuidStr);\r
-      LengthString = LengthString + StrLen (NameStr) + 1;\r
-      TempStr = AllocateZeroPool (LengthString * sizeof (CHAR16));\r
-      if (TempStr == NULL) {\r
-        FreePool (GuidStr);\r
-        FreePool (NameStr);\r
-        FreePool (VarStoreName);\r
-        Status = EFI_OUT_OF_RESOURCES;\r
+      if (IsThisVarstore((VOID *)&IfrVarStore->Guid, VarStoreName, ConfigHdr)) {\r
+        FindVarstore = TRUE;\r
         goto Done;\r
       }\r
-      StrCpy (TempStr, GuidStr);\r
-      StrCat (TempStr, NameStr);\r
-      if (ConfigHdr == NULL || StrnCmp (ConfigHdr, TempStr, StrLen (TempStr)) == 0) {\r
-        //\r
-        // Find the matched VarStore\r
-        //\r
-        CopyGuid (&VarStorageData->Guid, (EFI_GUID *) (VOID *) &IfrEfiVarStore->Guid);\r
-        VarStorageData->VarStoreId = IfrEfiVarStore->VarStoreId;\r
-        VarStorageData->Size       = IfrEfiVarStore->Size;\r
-        VarStorageData->Name       = VarStoreName;\r
-      } else {\r
-        //\r
-        // No found, free the allocated memory \r
-        //\r
-        FreePool (VarStoreName);\r
-      }\r
-      //\r
-      // Free alllocated temp string.\r
-      //\r
-      FreePool (GuidStr);\r
-      FreePool (NameStr);\r
-      FreePool (TempStr);\r
       break;\r
 \r
-    case EFI_IFR_DEFAULTSTORE_OP:\r
-      //\r
-      // Add new the map between default id and default name.\r
-      //\r
-      DefaultDataPtr = (IFR_DEFAULT_DATA *) AllocateZeroPool (sizeof (IFR_DEFAULT_DATA));\r
-      if (DefaultDataPtr == NULL) {\r
-        Status = EFI_OUT_OF_RESOURCES;\r
+    case EFI_IFR_VARSTORE_EFI_OP:\r
+      IfrEfiVarStore = (EFI_IFR_VARSTORE_EFI *) IfrOpHdr;\r
+      VarStoreName = AllocateZeroPool (AsciiStrSize ((CHAR8 *)IfrEfiVarStore->Name) * sizeof (CHAR16));\r
+      if (VarStoreName == NULL) {\r
         goto Done;\r
       }\r
-      DefaultDataPtr->DefaultId   = ((EFI_IFR_DEFAULTSTORE *) IfrOpHdr)->DefaultId;\r
-      InsertTailList (&DefaultIdArray->Entry, &DefaultDataPtr->Entry);\r
-      DefaultDataPtr = NULL;\r
-      break;\r
+      AsciiStrToUnicodeStr ((CHAR8 *)IfrEfiVarStore->Name, VarStoreName);\r
 \r
-    case EFI_IFR_FORM_OP:\r
-    case EFI_IFR_FORM_MAP_OP:\r
-      //\r
-      // No matched varstore is found and directly return.\r
-      //\r
-      if (VarStorageData->Size == 0) {\r
-        Status = EFI_SUCCESS;\r
+      if (IsThisVarstore (&IfrEfiVarStore->Guid, VarStoreName, ConfigHdr)) {\r
+        FindVarstore = TRUE;\r
         goto Done;\r
       }\r
       break;\r
 \r
-    case EFI_IFR_ONE_OF_OP:\r
-    case EFI_IFR_NUMERIC_OP:\r
-      //\r
-      // Numeric and OneOf has the same opcode structure.\r
-      //\r
+    case EFI_IFR_VARSTORE_NAME_VALUE_OP:\r
+      IfrNameValueVarStore = (EFI_IFR_VARSTORE_NAME_VALUE *) IfrOpHdr;\r
 \r
-      //\r
-      // Numeric and OneOf question is not in IFR Form. This IFR form is not valid. \r
-      //\r
-      if (VarStorageData->Size == 0) {\r
-        Status = EFI_INVALID_PARAMETER;\r
+      if (IsThisVarstore (&IfrNameValueVarStore->Guid, NULL, ConfigHdr)) {\r
+        FindVarstore = TRUE;\r
         goto Done;\r
       }\r
-      //\r
-      // Check whether this question is for the requested varstore.\r
-      //\r
-      IfrOneOf = (EFI_IFR_ONE_OF *) IfrOpHdr;\r
-      if (IfrOneOf->Question.VarStoreId != VarStorageData->VarStoreId) {\r
-        break;\r
-      }\r
+      break;\r
       \r
+    case EFI_IFR_FORM_OP:\r
+    case EFI_IFR_FORM_MAP_OP:\r
       //\r
-      // Get Offset/Width by Question header and OneOf Flags\r
-      //\r
-      VarOffset = IfrOneOf->Question.VarStoreInfo.VarOffset;\r
-      VarWidth  = (UINT16) (1 << (IfrOneOf->Flags & EFI_IFR_NUMERIC_SIZE));\r
-      //\r
-      // Check whether this question is in requested block array.\r
+      // No matched varstore is found and directly return.\r
       //\r
-      if (!BlockArrayCheck (RequestBlockArray, VarOffset, VarWidth)) {\r
-        //\r
-        // This question is not in the requested string. Skip it.\r
-        //\r
-        break;\r
-      }\r
+      goto Done;\r
 \r
-      //\r
-      // Check this var question is in the var storage \r
-      //\r
-      if ((VarOffset + VarWidth) > VarStorageData->Size) {\r
-        Status = EFI_INVALID_PARAMETER;\r
-        goto Done;\r
-      }\r
-      \r
-      //\r
-      // Set Block Data\r
-      //\r
-      BlockData = (IFR_BLOCK_DATA *) AllocateZeroPool (sizeof (IFR_BLOCK_DATA));\r
-      if (BlockData == NULL) {\r
-        Status = EFI_OUT_OF_RESOURCES;\r
-        goto Done;\r
-      }\r
-      BlockData->Offset     = VarOffset;\r
-      BlockData->Width      = VarWidth;\r
-      BlockData->QuestionId = IfrOneOf->Question.QuestionId;\r
-      BlockData->OpCode     = IfrOpHdr->OpCode;\r
-      BlockData->Scope      = IfrOpHdr->Scope;\r
-      InitializeListHead (&BlockData->DefaultValueEntry);\r
-      //\r
-      // Add Block Data into VarStorageData BlockEntry\r
-      //\r
-      InsertBlockData (&VarStorageData->BlockEntry, &BlockData);\r
-      \r
-      if (IfrOpHdr->OpCode == EFI_IFR_ONE_OF_OP) {\r
-        //\r
-        // Set this flag to TRUE for the first oneof option.\r
-        //\r
-        FirstOneOfOption = TRUE;\r
-      } else if (IfrOpHdr->OpCode == EFI_IFR_NUMERIC_OP) {\r
-        //\r
-        // Numeric minimum value will be used as default value when no default is specified. \r
-        //\r
-        DefaultData.Type        = DefaultValueFromDefault;\r
-        switch (IfrOneOf->Flags & EFI_IFR_NUMERIC_SIZE) {\r
-        case EFI_IFR_NUMERIC_SIZE_1:\r
-          DefaultData.Value = (UINT64) IfrOneOf->data.u8.MinValue;\r
-          break;\r
-  \r
-        case EFI_IFR_NUMERIC_SIZE_2:\r
-          CopyMem (&DefaultData.Value, &IfrOneOf->data.u16.MinValue, sizeof (UINT16));\r
-          break;\r
-  \r
-        case EFI_IFR_NUMERIC_SIZE_4:\r
-          CopyMem (&DefaultData.Value, &IfrOneOf->data.u32.MinValue, sizeof (UINT32));\r
-          break;\r
-  \r
-        case EFI_IFR_NUMERIC_SIZE_8:\r
-          CopyMem (&DefaultData.Value, &IfrOneOf->data.u64.MinValue, sizeof (UINT64));\r
-          break;\r
-        }\r
-        //\r
-        // Set default value base on the DefaultId list get from IFR data.\r
-        //        \r
-        for (LinkData = DefaultIdArray->Entry.ForwardLink; LinkData != &DefaultIdArray->Entry; LinkData = LinkData->ForwardLink) {\r
-          DefaultDataPtr = BASE_CR (LinkData, IFR_DEFAULT_DATA, Entry);     \r
-          DefaultData.DefaultId   = DefaultDataPtr->DefaultId;\r
-          InsertDefaultValue (BlockData, &DefaultData);\r
-        }\r
-      }\r
+    default:\r
       break;\r
+    }\r
+  }\r
+Done:\r
+  if (HiiFormPackage != NULL) {\r
+    FreePool (HiiFormPackage);\r
+  }\r
 \r
-    case EFI_IFR_ORDERED_LIST_OP:\r
-      //\r
-      // offset by question header\r
-      // width by EFI_IFR_ORDERED_LIST MaxContainers * OneofOption Type\r
-      // no default value and default id, how to define its default value?\r
-      //\r
+  if (VarStoreName != NULL) {\r
+    FreePool (VarStoreName);\r
+  }\r
 \r
-      //\r
-      // OrderedList question is not in IFR Form. This IFR form is not valid. \r
-      //\r
-      if (VarStorageData->Size == 0) {\r
-        Status = EFI_INVALID_PARAMETER;\r
-        goto Done;\r
-      }\r
-      //\r
-      // Check whether this question is for the requested varstore.\r
-      //\r
-      IfrOrderedList = (EFI_IFR_ORDERED_LIST *) IfrOpHdr;\r
-      if (IfrOrderedList->Question.VarStoreId != VarStorageData->VarStoreId) {\r
-        BlockData = NULL;\r
-        break;\r
-      }\r
+  return FindVarstore;\r
+}\r
+\r
+/**\r
+  Check whether the this op code is required.\r
+\r
+  @param  RequestBlockArray      The array includes all the request info or NULL.\r
+  @param  HiiHandle              The hii handle for this form package.\r
+  @param  VarStorageData         The varstore data strucure.\r
+  @param  IfrOpHdr               Ifr opcode header for this opcode.\r
+  @param  VarWidth               The buffer width for this opcode.\r
+  @param  ReturnData             The data block added for this opcode.\r
+\r
+  @retval  EFI_SUCCESS           This opcode is required.\r
+  @retval  Others                This opcode is not required or error occur.\r
+                                 \r
+**/\r
+EFI_STATUS\r
+IsThisOpcodeRequired (\r
+  IN     IFR_BLOCK_DATA           *RequestBlockArray,\r
+  IN     EFI_HII_HANDLE           HiiHandle,\r
+  IN OUT IFR_VARSTORAGE_DATA      *VarStorageData,\r
+  IN     EFI_IFR_OP_HEADER        *IfrOpHdr,\r
+  IN     UINT16                   VarWidth,\r
+  OUT    IFR_BLOCK_DATA           **ReturnData\r
+  )\r
+{\r
+  IFR_BLOCK_DATA           *BlockData;\r
+  UINT16                   VarOffset;\r
+  EFI_STRING_ID            NameId;\r
+  EFI_IFR_QUESTION_HEADER  *IfrQuestionHdr;\r
 \r
+  NameId    = 0;\r
+  VarOffset = 0;\r
+  IfrQuestionHdr = (EFI_IFR_QUESTION_HEADER  *)((CHAR8 *) IfrOpHdr + sizeof (EFI_IFR_OP_HEADER));\r
+\r
+  if (VarStorageData->Type == EFI_HII_VARSTORE_NAME_VALUE) {\r
+    NameId = IfrQuestionHdr->VarStoreInfo.VarName;\r
+\r
+    //\r
+    // Check whether this question is in requested block array.\r
+    //\r
+    if (!BlockArrayCheck (RequestBlockArray, NameId, 0, TRUE, HiiHandle)) {\r
       //\r
-      // Get Offset/Width by Question header and OneOf Flags\r
+      // This question is not in the requested string. Skip it.\r
       //\r
-      VarOffset = IfrOrderedList->Question.VarStoreInfo.VarOffset;\r
-      VarWidth  = IfrOrderedList->MaxContainers;\r
-      \r
+      return EFI_SUCCESS;\r
+    }\r
+  } else {\r
+    VarOffset = IfrQuestionHdr->VarStoreInfo.VarOffset;\r
+    \r
+    //\r
+    // Check whether this question is in requested block array.\r
+    //\r
+    if (!BlockArrayCheck (RequestBlockArray, VarOffset, VarWidth, FALSE, HiiHandle)) {\r
       //\r
-      // Set Block Data\r
+      // This question is not in the requested string. Skip it.\r
       //\r
-      BlockData = (IFR_BLOCK_DATA *) AllocateZeroPool (sizeof (IFR_BLOCK_DATA));\r
-      if (BlockData == NULL) {\r
-        Status = EFI_OUT_OF_RESOURCES;\r
-        goto Done;\r
-      }\r
-      BlockData->Offset     = VarOffset;\r
-      BlockData->Width      = VarWidth;\r
-      BlockData->QuestionId = IfrOrderedList->Question.QuestionId;\r
-      BlockData->OpCode     = IfrOpHdr->OpCode;\r
-      BlockData->Scope      = IfrOpHdr->Scope;\r
-      InitializeListHead (&BlockData->DefaultValueEntry);\r
-      break;\r
+      return EFI_SUCCESS;\r
+    }\r
 \r
-    case EFI_IFR_CHECKBOX_OP:\r
-      //\r
-      // EFI_IFR_DEFAULT_OP\r
-      // offset by question header\r
-      // width is 1 sizeof (BOOLEAN)\r
-      // default id by CheckBox Flags if CheckBox flags (Default or Mau) is set, the default value is 1 to be set.\r
-      // value by DefaultOption\r
-      // default id by DeaultOption DefaultId can override CheckBox Flags and Default value.\r
-      // \r
+    //\r
+    // Check this var question is in the var storage \r
+    //\r
+    if (((VarOffset + VarWidth) > VarStorageData->Size)) {\r
+      return EFI_INVALID_PARAMETER;\r
+    }\r
+  }\r
 \r
+  BlockData = (IFR_BLOCK_DATA *) AllocateZeroPool (sizeof (IFR_BLOCK_DATA));\r
+  if (BlockData == NULL) {\r
+    return EFI_OUT_OF_RESOURCES;\r
+  }\r
+\r
+  if (VarStorageData->Type == EFI_HII_VARSTORE_NAME_VALUE) {\r
+    BlockData->Name   = InternalGetString(HiiHandle, NameId);\r
+  } else {\r
+    BlockData->Offset = VarOffset;\r
+  }\r
+\r
+  BlockData->Width      = VarWidth;\r
+  BlockData->QuestionId = IfrQuestionHdr->QuestionId;\r
+  BlockData->OpCode     = IfrOpHdr->OpCode;\r
+  BlockData->Scope      = IfrOpHdr->Scope;\r
+  InitializeListHead (&BlockData->DefaultValueEntry);\r
+  //\r
+  // Add Block Data into VarStorageData BlockEntry\r
+  //\r
+  InsertBlockData (&VarStorageData->BlockEntry, &BlockData);\r
+  *ReturnData = BlockData;\r
+\r
+  return EFI_SUCCESS;\r
+}\r
+\r
+/**\r
+  This function parses Form Package to get the block array and the default\r
+  value array according to the request ConfigHdr.\r
+\r
+  @param  HiiHandle             Hii Handle for this hii package.\r
+  @param  Package               Pointer to the form package data.\r
+  @param  PackageLength         Length of the pacakge.\r
+  @param  ConfigHdr             Request string ConfigHdr. If it is NULL,\r
+                                the first found varstore will be as ConfigHdr.\r
+  @param  RequestBlockArray     The block array is retrieved from the request string.\r
+  @param  VarStorageData        VarStorage structure contains the got block and default value.\r
+  @param  DefaultIdArray        Point to the got default id and default name array.\r
+\r
+  @retval EFI_SUCCESS           The block array and the default value array are got.\r
+  @retval EFI_INVALID_PARAMETER The varstore defintion in the differnt form pacakges\r
+                                are conflicted. \r
+  @retval EFI_OUT_OF_RESOURCES  No enough memory.\r
+**/\r
+EFI_STATUS\r
+EFIAPI\r
+ParseIfrData (\r
+  IN     EFI_HII_HANDLE      HiiHandle,\r
+  IN     UINT8               *Package,\r
+  IN     UINT32              PackageLength,\r
+  IN     EFI_STRING          ConfigHdr,\r
+  IN     IFR_BLOCK_DATA      *RequestBlockArray,\r
+  IN OUT IFR_VARSTORAGE_DATA *VarStorageData,\r
+  OUT    IFR_DEFAULT_DATA    *DefaultIdArray\r
+  )\r
+{\r
+  EFI_STATUS               Status;\r
+  UINTN                    IfrOffset;\r
+  UINTN                    PackageOffset;\r
+  EFI_IFR_VARSTORE         *IfrVarStore;\r
+  EFI_IFR_VARSTORE_EFI     *IfrEfiVarStore;\r
+  EFI_IFR_OP_HEADER        *IfrOpHdr;\r
+  EFI_IFR_ONE_OF           *IfrOneOf;\r
+  EFI_IFR_REF4             *IfrRef;\r
+  EFI_IFR_ONE_OF_OPTION    *IfrOneOfOption;\r
+  EFI_IFR_DEFAULT          *IfrDefault;\r
+  EFI_IFR_ORDERED_LIST     *IfrOrderedList;\r
+  EFI_IFR_CHECKBOX         *IfrCheckBox;\r
+  EFI_IFR_PASSWORD         *IfrPassword;\r
+  EFI_IFR_STRING           *IfrString;\r
+  EFI_IFR_DATE             *IfrDate;\r
+  EFI_IFR_TIME             *IfrTime;\r
+  IFR_DEFAULT_DATA         DefaultData;\r
+  IFR_DEFAULT_DATA         *DefaultDataPtr;\r
+  IFR_BLOCK_DATA           *BlockData;\r
+  CHAR16                   *VarStoreName;\r
+  UINT16                   VarWidth;\r
+  UINT16                   VarDefaultId;\r
+  BOOLEAN                  FirstOneOfOption;\r
+  BOOLEAN                  FirstOrderedList;\r
+  LIST_ENTRY               *LinkData;\r
+  LIST_ENTRY               *LinkDefault;\r
+  EFI_IFR_VARSTORE_NAME_VALUE *IfrNameValueVarStore;\r
+  EFI_HII_PACKAGE_HEADER   *PackageHeader;\r
+  EFI_VARSTORE_ID          VarStoreId;\r
+\r
+  Status           = EFI_SUCCESS;\r
+  BlockData        = NULL;\r
+  DefaultDataPtr   = NULL;\r
+  FirstOneOfOption = FALSE;\r
+  VarStoreId       = 0;\r
+  FirstOrderedList = FALSE;\r
+  ZeroMem (&DefaultData, sizeof (IFR_DEFAULT_DATA));\r
+\r
+  //\r
+  // Go through the form package to parse OpCode one by one.\r
+  //\r
+  PackageOffset = sizeof (EFI_HII_PACKAGE_HEADER);\r
+  PackageHeader = (EFI_HII_PACKAGE_HEADER *) Package;\r
+  IfrOffset     = PackageOffset;\r
+  while (IfrOffset < PackageLength) {\r
+\r
+    //\r
+    // More than one form package found.\r
+    //\r
+    if (PackageOffset >= PackageHeader->Length) {\r
+        //\r
+        // Already found varstore for this request, break;\r
+        //\r
+        if (VarStoreId != 0) {\r
+          VarStoreId = 0;\r
+        }\r
+\r
+        //\r
+        // Get next package header info.\r
+        //\r
+        IfrOffset    += sizeof (EFI_HII_PACKAGE_HEADER);\r
+        PackageOffset = sizeof (EFI_HII_PACKAGE_HEADER);\r
+        PackageHeader = (EFI_HII_PACKAGE_HEADER *) (Package + IfrOffset);\r
+    }\r
+\r
+    IfrOpHdr  = (EFI_IFR_OP_HEADER *) (Package + IfrOffset);\r
+    switch (IfrOpHdr->OpCode) {\r
+    case EFI_IFR_VARSTORE_OP:\r
       //\r
-      // CheckBox question is not in IFR Form. This IFR form is not valid. \r
-      //\r
-      if (VarStorageData->Size == 0) {\r
-        Status = EFI_INVALID_PARAMETER;\r
-        goto Done;\r
-      }\r
-      //\r
-      // Check whether this question is for the requested varstore.\r
+      // VarStore is found. Don't need to search any more.\r
       //\r
-      IfrCheckBox = (EFI_IFR_CHECKBOX *) IfrOpHdr;\r
-      if (IfrCheckBox->Question.VarStoreId != VarStorageData->VarStoreId) {\r
+      if (VarStoreId != 0) {\r
         break;\r
       }\r
-      \r
-      //\r
-      // Get Offset/Width by Question header and OneOf Flags\r
-      //\r
-      VarOffset = IfrCheckBox->Question.VarStoreInfo.VarOffset;\r
-      VarWidth  = (UINT16) sizeof (BOOLEAN);\r
 \r
-      //\r
-      // Check whether this question is in requested block array.\r
-      //\r
-      if (!BlockArrayCheck (RequestBlockArray, VarOffset, VarWidth)) {\r
+      IfrVarStore = (EFI_IFR_VARSTORE *) IfrOpHdr;\r
+\r
+      VarStoreName = AllocateZeroPool (AsciiStrSize ((CHAR8 *)IfrVarStore->Name) * sizeof (CHAR16));\r
+      if (VarStoreName == NULL) {\r
+        Status = EFI_OUT_OF_RESOURCES;\r
+        goto Done;\r
+      }\r
+      AsciiStrToUnicodeStr ((CHAR8 *)IfrVarStore->Name, VarStoreName);\r
+\r
+      if (IsThisVarstore((VOID *)&IfrVarStore->Guid, VarStoreName, ConfigHdr)) {\r
         //\r
-        // This question is not in the requested string. Skip it.\r
+        // Find the matched VarStore\r
         //\r
-        break;\r
+        CopyGuid (&VarStorageData->Guid, (EFI_GUID *) (VOID *) &IfrVarStore->Guid);\r
+        VarStorageData->Size       = IfrVarStore->Size;\r
+        VarStorageData->Name       = VarStoreName;\r
+        VarStorageData->Type       = EFI_HII_VARSTORE_BUFFER;\r
+        VarStoreId                 = IfrVarStore->VarStoreId;\r
       }\r
+      break;\r
 \r
+    case EFI_IFR_VARSTORE_EFI_OP:\r
       //\r
-      // Check this var question is in the var storage \r
+      // VarStore is found. Don't need to search any more.\r
       //\r
-      if ((VarOffset + VarWidth) > VarStorageData->Size) {\r
-        Status = EFI_INVALID_PARAMETER;\r
-        goto Done;\r
+      if (VarStoreId != 0) {\r
+        break;\r
       }\r
-      \r
-      //\r
-      // Set Block Data\r
+\r
+      IfrEfiVarStore = (EFI_IFR_VARSTORE_EFI *) IfrOpHdr;\r
+\r
       //\r
-      BlockData = (IFR_BLOCK_DATA *) AllocateZeroPool (sizeof (IFR_BLOCK_DATA));\r
-      if (BlockData == NULL) {\r
+      // If the length is small than the structure, this is from old efi \r
+      // varstore definition. Old efi varstore get config directly from \r
+      // GetVariable function.\r
+      //      \r
+      if (IfrOpHdr->Length < sizeof (EFI_IFR_VARSTORE_EFI)) {\r
+        break;\r
+      }\r
+\r
+      VarStoreName = AllocateZeroPool (AsciiStrSize ((CHAR8 *)IfrEfiVarStore->Name) * sizeof (CHAR16));\r
+      if (VarStoreName == NULL) {\r
         Status = EFI_OUT_OF_RESOURCES;\r
         goto Done;\r
       }\r
-      BlockData->Offset     = VarOffset;\r
-      BlockData->Width      = VarWidth;\r
-      BlockData->QuestionId = IfrCheckBox->Question.QuestionId;\r
-      BlockData->OpCode     = IfrOpHdr->OpCode;\r
-      BlockData->Scope      = IfrOpHdr->Scope;\r
-      InitializeListHead (&BlockData->DefaultValueEntry);\r
-      //\r
-      // Add Block Data into VarStorageData BlockEntry\r
-      //\r
-      InsertBlockData (&VarStorageData->BlockEntry, &BlockData);\r
-      \r
-      //\r
-      // Add default value for standard ID by CheckBox Flag\r
-      //\r
-      VarDefaultId = EFI_HII_DEFAULT_CLASS_STANDARD;\r
-      //\r
-      // Prepare new DefaultValue\r
-      //\r
-      DefaultData.DefaultId   = VarDefaultId;\r
-      if ((IfrCheckBox->Flags & EFI_IFR_CHECKBOX_DEFAULT) == EFI_IFR_CHECKBOX_DEFAULT) {\r
-        //\r
-        // When flag is set, defautl value is TRUE.\r
-        //\r
-        DefaultData.Type     = DefaultValueFromFlag;\r
-        DefaultData.Value    = 1;\r
-      } else {\r
+      AsciiStrToUnicodeStr ((CHAR8 *)IfrEfiVarStore->Name, VarStoreName);\r
+\r
+      if (IsThisVarstore (&IfrEfiVarStore->Guid, VarStoreName, ConfigHdr)) {\r
         //\r
-        // When flag is not set, defautl value is FASLE.\r
+        // Find the matched VarStore\r
         //\r
-        DefaultData.Type     = DefaultValueFromDefault;\r
-        DefaultData.Value    = 0;\r
+        CopyGuid (&VarStorageData->Guid, (EFI_GUID *) (VOID *) &IfrEfiVarStore->Guid);\r
+        VarStorageData->Size       = IfrEfiVarStore->Size;\r
+        VarStorageData->Name       = VarStoreName;\r
+        VarStorageData->Type       = EFI_HII_VARSTORE_EFI_VARIABLE_BUFFER;\r
+        VarStoreId                 = IfrEfiVarStore->VarStoreId;\r
       }\r
-      //\r
-      // Add DefaultValue into current BlockData\r
-      //\r
-      InsertDefaultValue (BlockData, &DefaultData);\r
+      break;\r
 \r
+    case EFI_IFR_VARSTORE_NAME_VALUE_OP:\r
       //\r
-      // Add default value for Manufacture ID by CheckBox Flag\r
-      //\r
-      VarDefaultId = EFI_HII_DEFAULT_CLASS_MANUFACTURING;\r
-      //\r
-      // Prepare new DefaultValue\r
+      // VarStore is found. Don't need to search any more.\r
       //\r
-      DefaultData.DefaultId   = VarDefaultId;\r
-      if ((IfrCheckBox->Flags & EFI_IFR_CHECKBOX_DEFAULT_MFG) == EFI_IFR_CHECKBOX_DEFAULT_MFG) {\r
-        //\r
-        // When flag is set, defautl value is TRUE.\r
-        //\r
-        DefaultData.Type     = DefaultValueFromFlag;\r
-        DefaultData.Value    = 1;\r
-      } else {\r
+      if (VarStoreId != 0) {\r
+        break;\r
+      }\r
+\r
+      IfrNameValueVarStore = (EFI_IFR_VARSTORE_NAME_VALUE *) IfrOpHdr;\r
+\r
+      if (IsThisVarstore (&IfrNameValueVarStore->Guid, NULL, ConfigHdr)) {\r
         //\r
-        // When flag is not set, defautl value is FASLE.\r
+        // Find the matched VarStore\r
         //\r
-        DefaultData.Type     = DefaultValueFromDefault;        \r
-        DefaultData.Value    = 0;\r
+        CopyGuid (&VarStorageData->Guid, (EFI_GUID *) (VOID *) &IfrNameValueVarStore->Guid);\r
+        VarStorageData->Type       = EFI_HII_VARSTORE_NAME_VALUE;\r
+        VarStoreId                 = IfrNameValueVarStore->VarStoreId;\r
       }\r
-      //\r
-      // Add DefaultValue into current BlockData\r
-      //\r
-      InsertDefaultValue (BlockData, &DefaultData);\r
       break;\r
 \r
-    case EFI_IFR_STRING_OP:\r
-      //\r
-      // offset by question header\r
-      // width MaxSize * sizeof (CHAR16)\r
-      // no default value, only block array\r
-      //\r
-\r
+    case EFI_IFR_DEFAULTSTORE_OP:\r
       //\r
-      // String question is not in IFR Form. This IFR form is not valid. \r
+      // Add new the map between default id and default name.\r
       //\r
-      if (VarStorageData->Size == 0) {\r
-        Status = EFI_INVALID_PARAMETER;\r
+      DefaultDataPtr = (IFR_DEFAULT_DATA *) AllocateZeroPool (sizeof (IFR_DEFAULT_DATA));\r
+      if (DefaultDataPtr == NULL) {\r
+        Status = EFI_OUT_OF_RESOURCES;\r
         goto Done;\r
       }\r
-      //\r
-      // Check whether this question is for the requested varstore.\r
-      //\r
-      IfrString = (EFI_IFR_STRING *) IfrOpHdr;\r
-      if (IfrString->Question.VarStoreId != VarStorageData->VarStoreId) {\r
-        break;\r
-      }\r
-      \r
-      //\r
-      // Get Offset/Width by Question header and OneOf Flags\r
-      //\r
-      VarOffset = IfrString->Question.VarStoreInfo.VarOffset;\r
-      VarWidth  = (UINT16) (IfrString->MaxSize * sizeof (UINT16));\r
+      DefaultDataPtr->DefaultId   = ((EFI_IFR_DEFAULTSTORE *) IfrOpHdr)->DefaultId;\r
+      InsertTailList (&DefaultIdArray->Entry, &DefaultDataPtr->Entry);\r
+      DefaultDataPtr = NULL;\r
+      break;\r
 \r
+    case EFI_IFR_FORM_OP:\r
+    case EFI_IFR_FORM_MAP_OP:\r
       //\r
-      // Check whether this question is in requested block array.\r
+      // No matched varstore is found and directly return.\r
       //\r
-      if (!BlockArrayCheck (RequestBlockArray, VarOffset, VarWidth)) {\r
-        //\r
-        // This question is not in the requested string. Skip it.\r
-        //\r
-        break;\r
+      if ( VarStoreId == 0) {\r
+        Status = EFI_SUCCESS;\r
+        goto Done;\r
       }\r
+      break;\r
 \r
+    case EFI_IFR_REF_OP:\r
       //\r
-      // Check this var question is in the var storage \r
+      // Ref question is not in IFR Form. This IFR form is not valid. \r
       //\r
-      if ((VarOffset + VarWidth) > VarStorageData->Size) {\r
+      if ( VarStoreId == 0) {\r
         Status = EFI_INVALID_PARAMETER;\r
         goto Done;\r
       }\r
-      \r
       //\r
-      // Set Block Data\r
+      // Check whether this question is for the requested varstore.\r
       //\r
-      BlockData = (IFR_BLOCK_DATA *) AllocateZeroPool (sizeof (IFR_BLOCK_DATA));\r
-      if (BlockData == NULL) {\r
-        Status = EFI_OUT_OF_RESOURCES;\r
+      IfrRef = (EFI_IFR_REF4 *) IfrOpHdr;\r
+      if (IfrRef->Question.VarStoreId != VarStoreId) {\r
+        break;\r
+      }\r
+      VarWidth  = (UINT16) (sizeof (EFI_HII_REF));\r
+\r
+      Status = IsThisOpcodeRequired(RequestBlockArray, HiiHandle, VarStorageData, IfrOpHdr, VarWidth, &BlockData);\r
+      if (EFI_ERROR (Status)) {\r
         goto Done;\r
       }\r
-      BlockData->Offset     = VarOffset;\r
-      BlockData->Width      = VarWidth;\r
-      BlockData->QuestionId = IfrString->Question.QuestionId;\r
-      BlockData->OpCode     = IfrOpHdr->OpCode;\r
-      InitializeListHead (&BlockData->DefaultValueEntry);\r
-      \r
-      //\r
-      // Add Block Data into VarStorageData BlockEntry\r
-      //\r
-      InsertBlockData (&VarStorageData->BlockEntry, &BlockData);\r
-      \r
-      //\r
-      // No default value for string.\r
-      //\r
-      BlockData = NULL;\r
       break;\r
 \r
-    case EFI_IFR_PASSWORD_OP:\r
+    case EFI_IFR_ONE_OF_OP:\r
+    case EFI_IFR_NUMERIC_OP:\r
       //\r
-      // offset by question header\r
-      // width MaxSize * sizeof (CHAR16)\r
-      // no default value, only block array\r
+      // Numeric and OneOf has the same opcode structure.\r
       //\r
 \r
       //\r
-      // Password question is not in IFR Form. This IFR form is not valid. \r
+      // Numeric and OneOf question is not in IFR Form. This IFR form is not valid. \r
       //\r
-      if (VarStorageData->Size == 0) {\r
+      if (VarStoreId == 0) {\r
         Status = EFI_INVALID_PARAMETER;\r
         goto Done;\r
       }\r
       //\r
       // Check whether this question is for the requested varstore.\r
       //\r
-      IfrPassword = (EFI_IFR_PASSWORD *) IfrOpHdr;\r
-      if (IfrPassword->Question.VarStoreId != VarStorageData->VarStoreId) {\r
+      IfrOneOf = (EFI_IFR_ONE_OF *) IfrOpHdr;\r
+      if (IfrOneOf->Question.VarStoreId != VarStoreId) {\r
         break;\r
       }\r
-      \r
-      //\r
-      // Get Offset/Width by Question header and OneOf Flags\r
-      //\r
-      VarOffset = IfrPassword->Question.VarStoreInfo.VarOffset;\r
-      VarWidth  = (UINT16) (IfrPassword->MaxSize * sizeof (UINT16));\r
+      VarWidth  = (UINT16) (1 << (IfrOneOf->Flags & EFI_IFR_NUMERIC_SIZE));\r
 \r
+      Status = IsThisOpcodeRequired(RequestBlockArray, HiiHandle, VarStorageData, IfrOpHdr, VarWidth, &BlockData);\r
+      if (EFI_ERROR (Status)) {\r
+        goto Done;\r
+      }\r
+\r
+      if (BlockData == NULL) {\r
+        //\r
+        // BlockData == NULL means this opcode is not in the requst array.\r
+        //\r
+        break;\r
+      }\r
+\r
+      if (IfrOpHdr->OpCode == EFI_IFR_ONE_OF_OP) {\r
+        //\r
+        // Set this flag to TRUE for the first oneof option.\r
+        //\r
+        FirstOneOfOption = TRUE;\r
+      } else if (IfrOpHdr->OpCode == EFI_IFR_NUMERIC_OP) {\r
+        //\r
+        // Numeric minimum value will be used as default value when no default is specified. \r
+        //\r
+        DefaultData.Type        = DefaultValueFromDefault;\r
+        switch (IfrOneOf->Flags & EFI_IFR_NUMERIC_SIZE) {\r
+        case EFI_IFR_NUMERIC_SIZE_1:\r
+          DefaultData.Value.u8 = IfrOneOf->data.u8.MinValue;\r
+          break;\r
+\r
+        case EFI_IFR_NUMERIC_SIZE_2:\r
+          CopyMem (&DefaultData.Value.u16, &IfrOneOf->data.u16.MinValue, sizeof (UINT16));\r
+          break;\r
+\r
+        case EFI_IFR_NUMERIC_SIZE_4:\r
+          CopyMem (&DefaultData.Value.u32, &IfrOneOf->data.u32.MinValue, sizeof (UINT32));\r
+          break;\r
+\r
+        case EFI_IFR_NUMERIC_SIZE_8:\r
+          CopyMem (&DefaultData.Value.u64, &IfrOneOf->data.u64.MinValue, sizeof (UINT64));\r
+          break;\r
+\r
+        default:\r
+          Status = EFI_INVALID_PARAMETER;\r
+          goto Done;\r
+        }\r
+        //\r
+        // Set default value base on the DefaultId list get from IFR data.\r
+        //        \r
+        for (LinkData = DefaultIdArray->Entry.ForwardLink; LinkData != &DefaultIdArray->Entry; LinkData = LinkData->ForwardLink) {\r
+          DefaultDataPtr = BASE_CR (LinkData, IFR_DEFAULT_DATA, Entry);\r
+          DefaultData.DefaultId   = DefaultDataPtr->DefaultId;\r
+          InsertDefaultValue (BlockData, &DefaultData);\r
+        }\r
+      }\r
+      break;\r
+\r
+    case EFI_IFR_ORDERED_LIST_OP:\r
+      //\r
+      // offset by question header\r
+      // width by EFI_IFR_ORDERED_LIST MaxContainers * OneofOption Type\r
+      //\r
+\r
+      FirstOrderedList = TRUE;\r
+      //\r
+      // OrderedList question is not in IFR Form. This IFR form is not valid. \r
+      //\r
+      if (VarStoreId == 0) {\r
+        Status = EFI_INVALID_PARAMETER;\r
+        goto Done;\r
+      }\r
+      //\r
+      // Check whether this question is for the requested varstore.\r
+      //\r
+      IfrOrderedList = (EFI_IFR_ORDERED_LIST *) IfrOpHdr;\r
+      if (IfrOrderedList->Question.VarStoreId != VarStoreId) {\r
+        BlockData = NULL;\r
+        break;\r
+      }\r
+      VarWidth  = IfrOrderedList->MaxContainers;\r
+      Status = IsThisOpcodeRequired(RequestBlockArray, HiiHandle, VarStorageData, IfrOpHdr, VarWidth, &BlockData);\r
+      if (EFI_ERROR (Status)) {\r
+        goto Done;\r
+      }\r
+      break;\r
+\r
+    case EFI_IFR_CHECKBOX_OP:\r
+      //\r
+      // EFI_IFR_DEFAULT_OP\r
+      // offset by question header\r
+      // width is 1 sizeof (BOOLEAN)\r
+      // default id by CheckBox Flags if CheckBox flags (Default or Mau) is set, the default value is 1 to be set.\r
+      // value by DefaultOption\r
+      // default id by DeaultOption DefaultId can override CheckBox Flags and Default value.\r
+      // \r
+\r
+      //\r
+      // CheckBox question is not in IFR Form. This IFR form is not valid. \r
+      //\r
+      if (VarStoreId == 0) {\r
+        Status = EFI_INVALID_PARAMETER;\r
+        goto Done;\r
+      }\r
+      //\r
+      // Check whether this question is for the requested varstore.\r
+      //\r
+      IfrCheckBox = (EFI_IFR_CHECKBOX *) IfrOpHdr;\r
+      if (IfrCheckBox->Question.VarStoreId != VarStoreId) {\r
+        break;\r
+      }\r
+      VarWidth  = (UINT16) sizeof (BOOLEAN);\r
+      Status = IsThisOpcodeRequired(RequestBlockArray, HiiHandle, VarStorageData, IfrOpHdr, VarWidth, &BlockData);\r
+      if (EFI_ERROR (Status)) {\r
+        goto Done;\r
+      }\r
+\r
+      if (BlockData == NULL) {\r
+        //\r
+        // BlockData == NULL means this opcode is not in the requst array.\r
+        //\r
+        break;\r
+      }\r
+\r
+      //\r
+      // Add default value for standard ID by CheckBox Flag\r
+      //\r
+      VarDefaultId = EFI_HII_DEFAULT_CLASS_STANDARD;\r
+      //\r
+      // Prepare new DefaultValue\r
+      //\r
+      DefaultData.DefaultId   = VarDefaultId;\r
+      if ((IfrCheckBox->Flags & EFI_IFR_CHECKBOX_DEFAULT) == EFI_IFR_CHECKBOX_DEFAULT) {\r
+        //\r
+        // When flag is set, defautl value is TRUE.\r
+        //\r
+        DefaultData.Type    = DefaultValueFromFlag;\r
+        DefaultData.Value.b = TRUE;\r
+      } else {\r
+        //\r
+        // When flag is not set, defautl value is FASLE.\r
+        //\r
+        DefaultData.Type    = DefaultValueFromDefault;\r
+        DefaultData.Value.b = FALSE;\r
+      }\r
+      //\r
+      // Add DefaultValue into current BlockData\r
+      //\r
+      InsertDefaultValue (BlockData, &DefaultData);\r
+\r
+      //\r
+      // Add default value for Manufacture ID by CheckBox Flag\r
       //\r
-      // Check whether this question is in requested block array.\r
+      VarDefaultId = EFI_HII_DEFAULT_CLASS_MANUFACTURING;\r
+      //\r
+      // Prepare new DefaultValue\r
       //\r
-      if (!BlockArrayCheck (RequestBlockArray, VarOffset, VarWidth)) {\r
+      DefaultData.DefaultId   = VarDefaultId;\r
+      if ((IfrCheckBox->Flags & EFI_IFR_CHECKBOX_DEFAULT_MFG) == EFI_IFR_CHECKBOX_DEFAULT_MFG) {\r
+        //\r
+        // When flag is set, defautl value is TRUE.\r
+        //\r
+        DefaultData.Type    = DefaultValueFromFlag;\r
+        DefaultData.Value.b = TRUE;\r
+      } else {\r
         //\r
-        // This question is not in the requested string. Skip it.\r
+        // When flag is not set, defautl value is FASLE.\r
         //\r
+        DefaultData.Type    = DefaultValueFromDefault;\r
+        DefaultData.Value.b = FALSE;\r
+      }\r
+      //\r
+      // Add DefaultValue into current BlockData\r
+      //\r
+      InsertDefaultValue (BlockData, &DefaultData);\r
+      break;\r
+\r
+    case EFI_IFR_DATE_OP:\r
+      //\r
+      // offset by question header\r
+      // width MaxSize * sizeof (CHAR16)\r
+      // no default value, only block array\r
+      //\r
+\r
+      //\r
+      // Date question is not in IFR Form. This IFR form is not valid. \r
+      //\r
+      if (VarStoreId == 0) {\r
+        Status = EFI_INVALID_PARAMETER;\r
+        goto Done;\r
+      }\r
+      //\r
+      // Check whether this question is for the requested varstore.\r
+      //\r
+      IfrDate = (EFI_IFR_DATE *) IfrOpHdr;\r
+      if (IfrDate->Question.VarStoreId != VarStoreId) {\r
         break;\r
       }\r
 \r
+      VarWidth  = (UINT16) sizeof (EFI_HII_DATE);\r
+      Status = IsThisOpcodeRequired(RequestBlockArray, HiiHandle, VarStorageData, IfrOpHdr, VarWidth, &BlockData);\r
+      if (EFI_ERROR (Status)) {\r
+        goto Done;\r
+      }\r
+      break;\r
+\r
+    case EFI_IFR_TIME_OP:\r
+      //\r
+      // offset by question header\r
+      // width MaxSize * sizeof (CHAR16)\r
+      // no default value, only block array\r
+      //\r
+\r
       //\r
-      // Check this var question is in the var storage \r
+      // Time question is not in IFR Form. This IFR form is not valid. \r
       //\r
-      if ((VarOffset + VarWidth) > VarStorageData->Size) {\r
+      if (VarStoreId == 0) {\r
         Status = EFI_INVALID_PARAMETER;\r
         goto Done;\r
       }\r
-      \r
       //\r
-      // Set Block Data\r
+      // Check whether this question is for the requested varstore.\r
       //\r
-      BlockData = (IFR_BLOCK_DATA *) AllocateZeroPool (sizeof (IFR_BLOCK_DATA));\r
-      if (BlockData == NULL) {\r
-        Status = EFI_OUT_OF_RESOURCES;\r
+      IfrTime = (EFI_IFR_TIME *) IfrOpHdr;\r
+      if (IfrTime->Question.VarStoreId != VarStoreId) {\r
+        break;\r
+      }\r
+\r
+      VarWidth  = (UINT16) sizeof (EFI_HII_TIME);\r
+      Status = IsThisOpcodeRequired(RequestBlockArray, HiiHandle, VarStorageData, IfrOpHdr, VarWidth, &BlockData);\r
+      if (EFI_ERROR (Status)) {\r
         goto Done;\r
       }\r
-      BlockData->Offset     = VarOffset;\r
-      BlockData->Width      = VarWidth;\r
-      BlockData->QuestionId = IfrPassword->Question.QuestionId;\r
-      BlockData->OpCode     = IfrOpHdr->OpCode;\r
-      InitializeListHead (&BlockData->DefaultValueEntry);\r
-      \r
+      break;\r
+\r
+    case EFI_IFR_STRING_OP:\r
+      //\r
+      // offset by question header\r
+      // width MaxSize * sizeof (CHAR16)\r
+      // no default value, only block array\r
       //\r
-      // Add Block Data into VarStorageData BlockEntry\r
+\r
       //\r
-      InsertBlockData (&VarStorageData->BlockEntry, &BlockData);\r
-      \r
+      // String question is not in IFR Form. This IFR form is not valid. \r
+      //\r
+      if (VarStoreId == 0) {\r
+        Status = EFI_INVALID_PARAMETER;\r
+        goto Done;\r
+      }\r
+      //\r
+      // Check whether this question is for the requested varstore.\r
+      //\r
+      IfrString = (EFI_IFR_STRING *) IfrOpHdr;\r
+      if (IfrString->Question.VarStoreId != VarStoreId) {\r
+        break;\r
+      }\r
+\r
+      VarWidth  = (UINT16) (IfrString->MaxSize * sizeof (UINT16));\r
+      Status = IsThisOpcodeRequired(RequestBlockArray, HiiHandle, VarStorageData, IfrOpHdr, VarWidth, &BlockData);\r
+      if (EFI_ERROR (Status)) {\r
+        goto Done;\r
+      }\r
+      break;\r
+\r
+    case EFI_IFR_PASSWORD_OP:\r
+      //\r
+      // offset by question header\r
+      // width MaxSize * sizeof (CHAR16)\r
+      // no default value, only block array\r
+      //\r
+\r
+      //\r
+      // Password question is not in IFR Form. This IFR form is not valid. \r
+      //\r
+      if (VarStoreId == 0) {\r
+        Status = EFI_INVALID_PARAMETER;\r
+        goto Done;\r
+      }\r
+      //\r
+      // Check whether this question is for the requested varstore.\r
+      //\r
+      IfrPassword = (EFI_IFR_PASSWORD *) IfrOpHdr;\r
+      if (IfrPassword->Question.VarStoreId != VarStoreId) {\r
+        break;\r
+      }\r
+\r
+      VarWidth  = (UINT16) (IfrPassword->MaxSize * sizeof (UINT16));\r
+      Status = IsThisOpcodeRequired(RequestBlockArray, HiiHandle, VarStorageData, IfrOpHdr, VarWidth, &BlockData);\r
+      if (EFI_ERROR (Status)) {\r
+        goto Done;\r
+      }\r
+\r
       //\r
       // No default value for string.\r
       //\r
@@ -1594,9 +2101,13 @@ ParseIfrData (
       if (BlockData == NULL || BlockData->Scope == 0) {\r
         break;\r
       }\r
-      \r
+\r
       IfrOneOfOption = (EFI_IFR_ONE_OF_OPTION *) IfrOpHdr;\r
       if (BlockData->OpCode == EFI_IFR_ORDERED_LIST_OP) {\r
+\r
+        if (!FirstOrderedList){\r
+          break;\r
+        }\r
         //\r
         // Get ordered list option data type.\r
         //\r
@@ -1613,6 +2124,9 @@ ParseIfrData (
           // Invalid ordered list option data type.\r
           //\r
           Status = EFI_INVALID_PARAMETER;\r
+          if (BlockData->Name != NULL) {\r
+            FreePool (BlockData->Name);\r
+          }\r
           FreePool (BlockData);\r
           goto Done;\r
         }\r
@@ -1624,10 +2138,13 @@ ParseIfrData (
         //\r
         // Check whether this question is in requested block array.\r
         //\r
-        if (!BlockArrayCheck (RequestBlockArray, BlockData->Offset, BlockData->Width)) {\r
+        if (!BlockArrayCheck (RequestBlockArray, BlockData->Offset, BlockData->Width, (BOOLEAN)(BlockData->Name != NULL), HiiHandle)) {\r
           //\r
           // This question is not in the requested string. Skip it.\r
           //\r
+          if (BlockData->Name != NULL) {\r
+            FreePool (BlockData->Name);\r
+          }\r
           FreePool (BlockData);\r
           BlockData = NULL;\r
           break;\r
@@ -1635,8 +2152,11 @@ ParseIfrData (
         //\r
         // Check this var question is in the var storage \r
         //\r
-        if ((BlockData->Offset + BlockData->Width) > VarStorageData->Size) {\r
+        if ((BlockData->Name == NULL) && ((BlockData->Offset + BlockData->Width) > VarStorageData->Size)) {\r
           Status = EFI_INVALID_PARAMETER;\r
+          if (BlockData->Name != NULL) {\r
+            FreePool (BlockData->Name);\r
+          }\r
           FreePool (BlockData);\r
           goto Done;\r
         }\r
@@ -1644,10 +2164,9 @@ ParseIfrData (
         // Add Block Data into VarStorageData BlockEntry\r
         //\r
         InsertBlockData (&VarStorageData->BlockEntry, &BlockData);\r
-        //\r
-        // No default data for OrderedList.\r
-        //\r
-        BlockData = NULL;\r
+\r
+        FirstOrderedList = FALSE;\r
+\r
         break;\r
       }\r
 \r
@@ -1664,8 +2183,8 @@ ParseIfrData (
         \r
         // Prepare new DefaultValue\r
         //\r
-        DefaultData.Type  = DefaultValueFromFlag;\r
-        DefaultData.Value = IfrOneOfOption->Value.u64;\r
+        DefaultData.Type     = DefaultValueFromFlag;\r
+        CopyMem (&DefaultData.Value, &IfrOneOfOption->Value, IfrOneOfOption->Header.Length - OFFSET_OF (EFI_IFR_ONE_OF_OPTION, Value));\r
         if ((IfrOneOfOption->Flags & EFI_IFR_OPTION_DEFAULT) == EFI_IFR_OPTION_DEFAULT) {\r
           DefaultData.DefaultId = EFI_HII_DEFAULT_CLASS_STANDARD;\r
           InsertDefaultValue (BlockData, &DefaultData);\r
@@ -1674,10 +2193,8 @@ ParseIfrData (
           DefaultData.DefaultId = EFI_HII_DEFAULT_CLASS_MANUFACTURING;\r
           InsertDefaultValue (BlockData, &DefaultData);\r
         }\r
-\r
-        \r
       }\r
-      \r
+\r
       //\r
       // 2. Set as the default value when this is the first option.\r
       // The first oneof option value will be used as default value when no default value is specified. \r
@@ -1689,13 +2206,13 @@ ParseIfrData (
         //\r
         // Prepare new DefaultValue\r
         //        \r
-        DefaultData.Type        = DefaultValueFromDefault;\r
-        DefaultData.Value       = IfrOneOfOption->Value.u64;        \r
+        DefaultData.Type     = DefaultValueFromDefault;\r
+        CopyMem (&DefaultData.Value, &IfrOneOfOption->Value, IfrOneOfOption->Header.Length - OFFSET_OF (EFI_IFR_ONE_OF_OPTION, Value));\r
         for (LinkData = DefaultIdArray->Entry.ForwardLink; LinkData != &DefaultIdArray->Entry; LinkData = LinkData->ForwardLink) {\r
           DefaultDataPtr = BASE_CR (LinkData, IFR_DEFAULT_DATA, Entry); \r
           DefaultData.DefaultId   = DefaultDataPtr->DefaultId;\r
           InsertDefaultValue (BlockData, &DefaultData);\r
-        }        \r
+        }\r
       }\r
       break;\r
 \r
@@ -1705,77 +2222,794 @@ ParseIfrData (
       //\r
       if (BlockData == NULL || BlockData->Scope == 0) {\r
         //\r
-        // No matched block data is ignored.        \r
+        // No matched block data is ignored.\r
         //\r
         break;\r
       }\r
 \r
-      if (BlockData->OpCode == EFI_IFR_ORDERED_LIST_OP) {\r
+      //\r
+      // Get the DefaultId\r
+      //\r
+      IfrDefault     = (EFI_IFR_DEFAULT *) IfrOpHdr;\r
+      VarDefaultId   = IfrDefault->DefaultId;\r
+      //\r
+      // Prepare new DefaultValue\r
+      //\r
+      DefaultData.Type        = DefaultValueFromOpcode;\r
+      DefaultData.DefaultId   = VarDefaultId;\r
+      CopyMem (&DefaultData.Value, &IfrDefault->Value, IfrDefault->Header.Length - OFFSET_OF (EFI_IFR_DEFAULT, Value));\r
+\r
+      // If the value field is expression, set the cleaned flag.\r
+      if (IfrDefault->Type ==  EFI_IFR_TYPE_OTHER) {\r
+        DefaultData.Cleaned = TRUE;\r
+      }\r
+      //\r
+      // Add DefaultValue into current BlockData\r
+      //\r
+      InsertDefaultValue (BlockData, &DefaultData);\r
+\r
+      //\r
+      // After insert the default value, reset the cleaned value for next \r
+      // time used. If not set here, need to set the value before everytime \r
+      // use it.\r
+      //\r
+      DefaultData.Cleaned     = FALSE;\r
+      break;\r
+\r
+    case EFI_IFR_END_OP:\r
+      //\r
+      // End Opcode is for Var question.\r
+      //\r
+      if (BlockData != NULL) {\r
+        if (BlockData->Scope > 0) {\r
+          BlockData->Scope--;\r
+        }\r
+        if (BlockData->Scope == 0) {\r
+          BlockData = NULL;\r
+        }\r
+      }\r
+\r
+      break;\r
+\r
+    default:\r
+      if (BlockData != NULL) {\r
+        if (BlockData->Scope > 0) {\r
+          BlockData->Scope = (UINT8) (BlockData->Scope + IfrOpHdr->Scope);\r
+        }\r
+\r
+        if (BlockData->Scope == 0) {\r
+          BlockData = NULL;\r
+        }\r
+      }\r
+      break;\r
+    }\r
+\r
+    IfrOffset     += IfrOpHdr->Length;\r
+    PackageOffset += IfrOpHdr->Length;\r
+  }\r
+\r
+Done:\r
+  for (LinkData = VarStorageData->BlockEntry.ForwardLink; LinkData != &VarStorageData->BlockEntry; LinkData = LinkData->ForwardLink) {\r
+    BlockData = BASE_CR (LinkData, IFR_BLOCK_DATA, Entry);\r
+    for (LinkDefault = BlockData->DefaultValueEntry.ForwardLink; LinkDefault != &BlockData->DefaultValueEntry; ) {\r
+      DefaultDataPtr = BASE_CR (LinkDefault, IFR_DEFAULT_DATA, Entry);\r
+      LinkDefault = LinkDefault->ForwardLink;\r
+      if (DefaultDataPtr->Cleaned == TRUE) {\r
+        RemoveEntryList (&DefaultDataPtr->Entry);\r
+        FreePool (DefaultDataPtr);\r
+      }\r
+    }\r
+  }\r
+\r
+  return Status;\r
+}\r
+\r
+/**\r
+  parse the configrequest string, get the elements.\r
+\r
+  @param      ConfigRequest         The input configrequest string.\r
+  @param      Progress              Return the progress data.\r
+\r
+  @retval     Block data pointer.\r
+**/\r
+IFR_BLOCK_DATA *\r
+GetBlockElement (\r
+  IN  EFI_STRING          ConfigRequest,\r
+  OUT EFI_STRING          *Progress\r
+  )\r
+{\r
+  EFI_STRING           StringPtr;\r
+  IFR_BLOCK_DATA       *BlockData;\r
+  IFR_BLOCK_DATA       *RequestBlockArray;\r
+  EFI_STATUS           Status;\r
+  UINT8                *TmpBuffer;\r
+  UINT16               Offset;\r
+  UINT16               Width;\r
+  LIST_ENTRY           *Link;\r
+  IFR_BLOCK_DATA       *NextBlockData;\r
+  UINTN                Length;\r
+\r
+  TmpBuffer = NULL;\r
+\r
+  //\r
+  // Init RequestBlockArray\r
+  //\r
+  RequestBlockArray = (IFR_BLOCK_DATA *) AllocateZeroPool (sizeof (IFR_BLOCK_DATA));\r
+  if (RequestBlockArray == NULL) {\r
+    goto Done;\r
+  }\r
+  InitializeListHead (&RequestBlockArray->Entry);\r
+\r
+  //\r
+  // Get the request Block array from the request string\r
+  // Offset and Width\r
+  //\r
+\r
+  //\r
+  // Parse each <RequestElement> if exists\r
+  // Only <BlockName> format is supported by this help function.\r
+  // <BlockName> ::= &'OFFSET='<Number>&'WIDTH='<Number>\r
+  //\r
+  StringPtr = ConfigRequest;\r
+  while (*StringPtr != 0 && StrnCmp (StringPtr, L"&OFFSET=", StrLen (L"&OFFSET=")) == 0) {\r
+    //\r
+    // Skip the OFFSET string\r
+    //\r
+    *Progress   = StringPtr;\r
+    StringPtr += StrLen (L"&OFFSET=");\r
+    //\r
+    // Get Offset\r
+    //\r
+    Status = GetValueOfNumber (StringPtr, &TmpBuffer, &Length);\r
+    if (EFI_ERROR (Status)) {\r
+      goto Done;\r
+    }\r
+    Offset = 0;\r
+    CopyMem (\r
+      &Offset,\r
+      TmpBuffer,\r
+      (((Length + 1) / 2) < sizeof (UINT16)) ? ((Length + 1) / 2) : sizeof (UINT16)\r
+      );\r
+    FreePool (TmpBuffer);\r
+\r
+    StringPtr += Length;\r
+    if (StrnCmp (StringPtr, L"&WIDTH=", StrLen (L"&WIDTH=")) != 0) {\r
+      goto Done;\r
+    }\r
+    StringPtr += StrLen (L"&WIDTH=");\r
+\r
+    //\r
+    // Get Width\r
+    //\r
+    Status = GetValueOfNumber (StringPtr, &TmpBuffer, &Length);\r
+    if (EFI_ERROR (Status)) {\r
+      goto Done;\r
+    }\r
+    Width = 0;\r
+    CopyMem (\r
+      &Width,\r
+      TmpBuffer,\r
+      (((Length + 1) / 2) < sizeof (UINT16)) ? ((Length + 1) / 2) : sizeof (UINT16)\r
+      );\r
+    FreePool (TmpBuffer);\r
+\r
+    StringPtr += Length;\r
+    if (*StringPtr != 0 && *StringPtr != L'&') {\r
+      goto Done;\r
+    }\r
+    \r
+    //\r
+    // Set Block Data\r
+    //\r
+    BlockData = (IFR_BLOCK_DATA *) AllocateZeroPool (sizeof (IFR_BLOCK_DATA));\r
+    if (BlockData == NULL) {\r
+      goto Done;\r
+    }\r
+    BlockData->Offset = Offset;\r
+    BlockData->Width  = Width;\r
+    InsertBlockData (&RequestBlockArray->Entry, &BlockData);\r
+\r
+    //\r
+    // Skip &VALUE string if &VALUE does exists.\r
+    //\r
+    if (StrnCmp (StringPtr, L"&VALUE=", StrLen (L"&VALUE=")) == 0) {\r
+      StringPtr += StrLen (L"&VALUE=");\r
+\r
+      //\r
+      // Get Value\r
+      //\r
+      Status = GetValueOfNumber (StringPtr, &TmpBuffer, &Length);\r
+      if (EFI_ERROR (Status)) {\r
+        goto Done;\r
+      }\r
+\r
+      StringPtr += Length;\r
+      if (*StringPtr != 0 && *StringPtr != L'&') {\r
+        goto Done;\r
+      }\r
+    }\r
+    //\r
+    // If '\0', parsing is finished. \r
+    //\r
+    if (*StringPtr == 0) {\r
+      break;\r
+    }\r
+  }\r
+\r
+  //\r
+  // Merge the requested block data.\r
+  //\r
+  Link = RequestBlockArray->Entry.ForwardLink;\r
+  while ((Link != &RequestBlockArray->Entry) && (Link->ForwardLink != &RequestBlockArray->Entry)) {\r
+    BlockData = BASE_CR (Link, IFR_BLOCK_DATA, Entry);\r
+    NextBlockData = BASE_CR (Link->ForwardLink, IFR_BLOCK_DATA, Entry);\r
+    if ((NextBlockData->Offset >= BlockData->Offset) && (NextBlockData->Offset <= (BlockData->Offset + BlockData->Width))) {\r
+      if ((NextBlockData->Offset + NextBlockData->Width) > (BlockData->Offset + BlockData->Width)) {\r
+        BlockData->Width = (UINT16) (NextBlockData->Offset + NextBlockData->Width - BlockData->Offset);\r
+      }\r
+      RemoveEntryList (Link->ForwardLink);\r
+      FreePool (NextBlockData);\r
+      continue;\r
+    }\r
+    Link = Link->ForwardLink;\r
+  }\r
+\r
+  return RequestBlockArray;\r
+\r
+Done:\r
+  if (RequestBlockArray != NULL) {\r
+    //\r
+    // Free Link Array RequestBlockArray\r
+    //\r
+    while (!IsListEmpty (&RequestBlockArray->Entry)) {\r
+      BlockData = BASE_CR (RequestBlockArray->Entry.ForwardLink, IFR_BLOCK_DATA, Entry);\r
+      RemoveEntryList (&BlockData->Entry);\r
+      FreePool (BlockData);\r
+    }\r
+\r
+    FreePool (RequestBlockArray);\r
+  }\r
+\r
+  return NULL;\r
+}\r
+\r
+/**\r
+  parse the configrequest string, get the elements.\r
+\r
+  @param      ConfigRequest         The input config request string.\r
+  @param      Progress              Return the progress data.\r
+\r
+  @retval     return data block array.\r
+**/\r
+IFR_BLOCK_DATA *\r
+GetNameElement (\r
+  IN  EFI_STRING           ConfigRequest,\r
+  OUT EFI_STRING           *Progress\r
+  )\r
+{\r
+  EFI_STRING           StringPtr;\r
+  EFI_STRING           NextTag;\r
+  IFR_BLOCK_DATA       *BlockData;\r
+  IFR_BLOCK_DATA       *RequestBlockArray;\r
+  BOOLEAN              HasValue;\r
+\r
+  StringPtr = ConfigRequest;\r
+\r
+  //\r
+  // Init RequestBlockArray\r
+  //\r
+  RequestBlockArray = (IFR_BLOCK_DATA *) AllocateZeroPool (sizeof (IFR_BLOCK_DATA));\r
+  if (RequestBlockArray == NULL) {\r
+    goto Done;\r
+  }\r
+  InitializeListHead (&RequestBlockArray->Entry);\r
+\r
+  //\r
+  // Get the request Block array from the request string\r
+  //\r
+\r
+  //\r
+  // Parse each <RequestElement> if exists\r
+  // Only <BlockName> format is supported by this help function.\r
+  // <BlockName> ::= &'Name***=***\r
+  //\r
+  while (StringPtr != NULL && *StringPtr == L'&') {\r
+\r
+    *Progress   = StringPtr;\r
+    //\r
+    // Skip the L"&" string\r
+    //\r
+    StringPtr += 1;\r
+\r
+    HasValue = FALSE;\r
+    if ((NextTag = StrStr (StringPtr, L"=")) != NULL) {\r
+      *NextTag = L'\0';\r
+      HasValue = TRUE;\r
+    } else if ((NextTag = StrStr (StringPtr, L"&")) != NULL) {\r
+      *NextTag = L'\0';\r
+    }\r
+\r
+    //\r
+    // Set Block Data\r
+    //\r
+    BlockData = (IFR_BLOCK_DATA *) AllocateZeroPool (sizeof (IFR_BLOCK_DATA));\r
+    if (BlockData == NULL) {\r
+      goto Done;\r
+    }\r
+\r
+    //\r
+    // Get Name\r
+    //\r
+    BlockData->Name = AllocateCopyPool(StrSize (StringPtr), StringPtr);\r
+    InsertBlockData (&RequestBlockArray->Entry, &BlockData);\r
+\r
+    if (HasValue) {\r
+      //\r
+      // If has value, skip the value.\r
+      //    \r
+      StringPtr = NextTag + 1;\r
+      *NextTag  = L'=';\r
+      StringPtr = StrStr (StringPtr, L"&");\r
+    } else if (NextTag != NULL) {\r
+      //\r
+      // restore the '&' text.\r
+      //\r
+      StringPtr = NextTag;\r
+      *NextTag  = L'&';\r
+    }\r
+  }\r
+\r
+  return RequestBlockArray;\r
+\r
+Done:\r
+  if (RequestBlockArray != NULL) {\r
+    //\r
+    // Free Link Array RequestBlockArray\r
+    //\r
+    while (!IsListEmpty (&RequestBlockArray->Entry)) {\r
+      BlockData = BASE_CR (RequestBlockArray->Entry.ForwardLink, IFR_BLOCK_DATA, Entry);\r
+      RemoveEntryList (&BlockData->Entry);\r
+      if (BlockData->Name != NULL) {\r
+        FreePool (BlockData->Name);\r
+      }\r
+      FreePool (BlockData);\r
+    }\r
+\r
+    FreePool (RequestBlockArray);\r
+  }\r
+\r
+  return NULL;\r
+}\r
+\r
+/**\r
+  Generate ConfigRequest string base on the varstore info.\r
+\r
+  @param      ConfigHdr             The config header for this varstore.\r
+  @param      VarStorageData        The varstore info.\r
+  @param      Status                Return Status.\r
+  @param      ConfigRequest         The ConfigRequest info may be return.\r
+\r
+  @retval     TRUE                  Need to continue\r
+  @retval     Others                NO need to continue or error occur.\r
+**/\r
+BOOLEAN\r
+GenerateConfigRequest (\r
+  IN  CHAR16                       *ConfigHdr,\r
+  IN  IFR_VARSTORAGE_DATA          *VarStorageData,\r
+  OUT EFI_STATUS                   *Status,\r
+  IN OUT EFI_STRING                *ConfigRequest\r
+  )\r
+{\r
+  BOOLEAN               DataExist;\r
+  UINTN                 Length;\r
+  LIST_ENTRY            *Link;\r
+  CHAR16                *FullConfigRequest;\r
+  CHAR16                *StringPtr;\r
+  IFR_BLOCK_DATA        *BlockData;\r
+\r
+  //\r
+  // Append VarStorageData BlockEntry into *Request string\r
+  // Now support only one varstore in a form package.\r
+  //\r
+  \r
+  //\r
+  // Go through all VarStorageData Entry and get BlockEntry for each one for the multiple varstore in a single form package\r
+  // Then construct them all to return MultiRequest string : ConfigHdr BlockConfig\r
+  //\r
+  \r
+  //\r
+  // Compute the length of the entire request starting with <ConfigHdr> and a \r
+  // Null-terminator\r
+  //\r
+  DataExist = FALSE;\r
+  Length    = StrLen (ConfigHdr) + 1;\r
+\r
+  for (Link = VarStorageData->BlockEntry.ForwardLink; Link != &VarStorageData->BlockEntry; Link = Link->ForwardLink) {\r
+    DataExist = TRUE;\r
+    BlockData = BASE_CR (Link, IFR_BLOCK_DATA, Entry);\r
+    if (VarStorageData->Type == EFI_HII_VARSTORE_NAME_VALUE) {\r
+      //\r
+      // Add <BlockName> length for each Name\r
+      //\r
+      // <BlockName> ::= &Name1&Name2&... \r
+      //                 |1| StrLen(Name1)\r
+      //\r
+      Length = Length + (1 + StrLen (BlockData->Name));\r
+    } else {\r
+      //\r
+      // Add <BlockName> length for each Offset/Width pair\r
+      //\r
+      // <BlockName> ::= &OFFSET=1234&WIDTH=1234\r
+      //                 |  8   | 4 |   7  | 4 |\r
+      //\r
+      Length = Length + (8 + 4 + 7 + 4);\r
+    }\r
+  }\r
+  //\r
+  // No any request block data is found. The request string can't be constructed.\r
+  //\r
+  if (!DataExist) {\r
+    *Status = EFI_SUCCESS;\r
+    return FALSE;\r
+  }\r
+\r
+  //\r
+  // Allocate buffer for the entire <ConfigRequest>\r
+  //\r
+  FullConfigRequest = AllocateZeroPool (Length * sizeof (CHAR16));\r
+  if (FullConfigRequest == NULL) {\r
+    *Status = EFI_OUT_OF_RESOURCES;\r
+    return FALSE;\r
+  }\r
+  StringPtr = FullConfigRequest;\r
+\r
+  //\r
+  // Start with <ConfigHdr>\r
+  //\r
+  StrCpyS (StringPtr, Length, ConfigHdr);\r
+  StringPtr += StrLen (StringPtr);\r
+\r
+  //\r
+  // Loop through all the Offset/Width pairs and append them to ConfigRequest\r
+  //\r
+  for (Link = VarStorageData->BlockEntry.ForwardLink; Link != &VarStorageData->BlockEntry; Link = Link->ForwardLink) {\r
+    BlockData = BASE_CR (Link, IFR_BLOCK_DATA, Entry);\r
+    if (VarStorageData->Type == EFI_HII_VARSTORE_NAME_VALUE) {\r
+      //\r
+      // Append &Name1\0\r
+      //\r
+      UnicodeSPrint (\r
+        StringPtr,\r
+        (1 + StrLen (BlockData->Name) + 1) * sizeof (CHAR16),\r
+        L"&%s",\r
+        BlockData->Name\r
+      );\r
+    } else {\r
+      //\r
+      // Append &OFFSET=XXXX&WIDTH=YYYY\0\r
+      //\r
+      UnicodeSPrint (\r
+        StringPtr, \r
+        (8 + 4 + 7 + 4 + 1) * sizeof (CHAR16), \r
+        L"&OFFSET=%04X&WIDTH=%04X", \r
+        BlockData->Offset, \r
+        BlockData->Width\r
+      );\r
+    }\r
+    StringPtr += StrLen (StringPtr);\r
+  }\r
+  //\r
+  // Set to the got full request string.\r
+  //\r
+  HiiToLower (FullConfigRequest);\r
+\r
+  if (*ConfigRequest != NULL) {\r
+    FreePool (*ConfigRequest);\r
+  }\r
+  *ConfigRequest = FullConfigRequest;\r
+\r
+  return TRUE;\r
+}\r
+\r
+/**\r
+  Generate ConfigRequest Header base on the varstore info.\r
+\r
+  @param      VarStorageData        The varstore info.\r
+  @param      DevicePath            Device path for this varstore.\r
+  @param      ConfigHdr             The config header for this varstore.\r
+\r
+  @retval     EFI_SUCCESS           Generate the header success.\r
+  @retval     EFI_OUT_OF_RESOURCES  Allocate buffer fail.\r
+**/\r
+EFI_STATUS\r
+GenerateHdr (\r
+  IN   IFR_VARSTORAGE_DATA          *VarStorageData,\r
+  IN   EFI_DEVICE_PATH_PROTOCOL     *DevicePath,\r
+  OUT  EFI_STRING                   *ConfigHdr\r
+  )\r
+{\r
+  EFI_STRING                   GuidStr;\r
+  EFI_STRING                   NameStr;\r
+  EFI_STRING                   PathStr;\r
+  UINTN                        Length;\r
+  EFI_STATUS                   Status;\r
+\r
+  Status  = EFI_SUCCESS;\r
+  NameStr = NULL;\r
+  GuidStr = NULL;\r
+  PathStr = NULL;\r
+\r
+  //\r
+  // Construct <ConfigHdr> : "GUID=...&NAME=...&PATH=..." by VarStorageData Guid, Name and DriverHandle\r
+  //\r
+  GenerateSubStr (L"GUID=", sizeof (EFI_GUID), (VOID *) &VarStorageData->Guid, 1, &GuidStr);\r
+  if (VarStorageData->Name != NULL) {\r
+    GenerateSubStr (L"NAME=", StrLen (VarStorageData->Name) * sizeof (CHAR16), (VOID *) VarStorageData->Name, 2, &NameStr);\r
+  } else {\r
+    GenerateSubStr (L"NAME=", 0, NULL, 2, &NameStr);\r
+  }\r
+  GenerateSubStr (\r
+    L"PATH=",\r
+    GetDevicePathSize ((EFI_DEVICE_PATH_PROTOCOL *) DevicePath),\r
+    (VOID *) DevicePath,\r
+    1,\r
+    &PathStr\r
+    );\r
+  Length = StrLen (GuidStr) + StrLen (NameStr) + StrLen (PathStr) + 1;\r
+  if (VarStorageData->Name == NULL) {\r
+    Length += 1;\r
+  }\r
+\r
+  *ConfigHdr = AllocateZeroPool (Length * sizeof (CHAR16));\r
+  if (*ConfigHdr == NULL) {\r
+    Status = EFI_OUT_OF_RESOURCES;\r
+    goto Done;\r
+  }\r
+  StrCpyS (*ConfigHdr, Length, GuidStr);\r
+  StrCatS (*ConfigHdr, Length, NameStr);\r
+  if (VarStorageData->Name == NULL) {\r
+    StrCatS (*ConfigHdr, Length, L"&");\r
+  }\r
+  StrCatS (*ConfigHdr, Length, PathStr);\r
+\r
+  //\r
+  // Remove the last character L'&'\r
+  //\r
+  *(*ConfigHdr + StrLen (*ConfigHdr) - 1) = L'\0';\r
+\r
+Done:\r
+  if (GuidStr != NULL) {\r
+    FreePool (GuidStr);\r
+  }\r
+\r
+  if (NameStr != NULL) {\r
+    FreePool (NameStr);\r
+  }\r
+\r
+  if (PathStr != NULL) {\r
+    FreePool (PathStr);\r
+  }\r
+\r
+  return Status;\r
+}\r
+\r
+/**\r
+  Get Data buffer size based on data type.\r
+\r
+  @param      ValueType             The input data type.\r
+\r
+  @retval     The data buffer size for the input type.\r
+**/\r
+UINT16\r
+GetStorageWidth (\r
+  IN UINT8       ValueType\r
+  )\r
+{\r
+  UINT16         StorageWidth;\r
+\r
+  switch (ValueType) {\r
+  case EFI_IFR_NUMERIC_SIZE_1:\r
+  case EFI_IFR_TYPE_BOOLEAN:\r
+    StorageWidth = (UINT16) sizeof (UINT8);\r
+    break;\r
+\r
+  case EFI_IFR_NUMERIC_SIZE_2:\r
+    StorageWidth = (UINT16) sizeof (UINT16);\r
+    break;\r
+\r
+  case EFI_IFR_NUMERIC_SIZE_4:\r
+    StorageWidth = (UINT16) sizeof (UINT32);\r
+    break;\r
+\r
+  case EFI_IFR_NUMERIC_SIZE_8:\r
+    StorageWidth = (UINT16) sizeof (UINT64);\r
+    break;\r
+\r
+  case EFI_IFR_TYPE_TIME:\r
+    StorageWidth = (UINT16) sizeof (EFI_IFR_TIME);\r
+    break;\r
+\r
+  case EFI_IFR_TYPE_DATE:\r
+    StorageWidth = (UINT16) sizeof (EFI_IFR_DATE);\r
+    break;\r
+\r
+  default:\r
+    StorageWidth = 0;\r
+    break;\r
+  }\r
+\r
+  return StorageWidth;\r
+}\r
+\r
+/**\r
+  Generate ConfigAltResp string base on the varstore info.\r
+\r
+  @param      HiiHandle             Hii Handle for this hii package.\r
+  @param      ConfigHdr             The config header for this varstore.\r
+  @param      VarStorageData        The varstore info.\r
+  @param      DefaultIdArray        The Default id array.\r
+  @param      DefaultAltCfgResp     The DefaultAltCfgResp info may be return.\r
+\r
+  @retval     TRUE                  Need to continue\r
+  @retval     Others                NO need to continue or error occur.\r
+**/\r
+EFI_STATUS\r
+GenerateAltConfigResp (\r
+  IN  EFI_HII_HANDLE               HiiHandle,\r
+  IN  CHAR16                       *ConfigHdr,\r
+  IN  IFR_VARSTORAGE_DATA          *VarStorageData,\r
+  IN  IFR_DEFAULT_DATA             *DefaultIdArray,\r
+  IN OUT EFI_STRING                *DefaultAltCfgResp\r
+  )\r
+{\r
+  BOOLEAN               DataExist;\r
+  UINTN                 Length;\r
+  LIST_ENTRY            *Link;\r
+  LIST_ENTRY            *LinkData;\r
+  LIST_ENTRY            *LinkDefault;\r
+  LIST_ENTRY            *ListEntry;\r
+  CHAR16                *StringPtr;\r
+  IFR_BLOCK_DATA        *BlockData;\r
+  IFR_DEFAULT_DATA      *DefaultId;\r
+  IFR_DEFAULT_DATA      *DefaultValueData;\r
+  UINTN                 Width;\r
+  UINT8                 *TmpBuffer;\r
+  CHAR16                *DefaultString;\r
+\r
+  BlockData     = NULL;\r
+  DataExist     = FALSE;\r
+  DefaultString = NULL;\r
+  //\r
+  // Add length for <ConfigHdr> + '\0'\r
+  //\r
+  Length = StrLen (ConfigHdr) + 1;\r
+\r
+  for (Link = DefaultIdArray->Entry.ForwardLink; Link != &DefaultIdArray->Entry; Link = Link->ForwardLink) {\r
+    DefaultId = BASE_CR (Link, IFR_DEFAULT_DATA, Entry);\r
+    //\r
+    // Add length for "&<ConfigHdr>&ALTCFG=XXXX"\r
+    //                |1| StrLen (ConfigHdr) | 8 | 4 |\r
+    //\r
+    Length += (1 + StrLen (ConfigHdr) + 8 + 4);\r
+    \r
+    for (LinkData = VarStorageData->BlockEntry.ForwardLink; LinkData != &VarStorageData->BlockEntry; LinkData = LinkData->ForwardLink) {\r
+      BlockData = BASE_CR (LinkData, IFR_BLOCK_DATA, Entry);\r
+      ListEntry     = &BlockData->DefaultValueEntry;\r
+      for (LinkDefault = ListEntry->ForwardLink; LinkDefault != ListEntry; LinkDefault = LinkDefault->ForwardLink) {\r
+        DefaultValueData = BASE_CR (LinkDefault, IFR_DEFAULT_DATA, Entry);\r
+        if (DefaultValueData->DefaultId != DefaultId->DefaultId) {\r
+          continue;\r
+        }\r
+        if (VarStorageData->Type == EFI_HII_VARSTORE_NAME_VALUE) {\r
+          //\r
+          // Add length for "&Name1=zzzzzzzzzzzz"\r
+          //                |1|Name|1|Value|\r
+          //\r
+          Length += (1 + StrLen (BlockData->Name) + 1 + BlockData->Width * 2);\r
+        } else {\r
+          //\r
+          // Add length for "&OFFSET=XXXX&WIDTH=YYYY&VALUE=zzzzzzzzzzzz"\r
+          //                |    8  | 4 |   7  | 4 |   7  | Width * 2 |\r
+          //\r
+          Length += (8 + 4 + 7 + 4 + 7 + BlockData->Width * 2);\r
+        }\r
+        DataExist = TRUE;\r
+      }\r
+    }\r
+  }\r
+  \r
+  //\r
+  // No default value is found. The default string doesn't exist.\r
+  //\r
+  if (!DataExist) {\r
+    return EFI_SUCCESS;\r
+  }\r
+\r
+  //\r
+  // Allocate buffer for the entire <DefaultAltCfgResp>\r
+  //\r
+  *DefaultAltCfgResp = AllocateZeroPool (Length * sizeof (CHAR16));\r
+  if (*DefaultAltCfgResp == NULL) {\r
+    return EFI_OUT_OF_RESOURCES;\r
+  }\r
+  StringPtr = *DefaultAltCfgResp;\r
+\r
+  //\r
+  // Start with <ConfigHdr>\r
+  //\r
+  StrCpyS (StringPtr, Length, ConfigHdr);\r
+  StringPtr += StrLen (StringPtr);\r
+\r
+  for (Link = DefaultIdArray->Entry.ForwardLink; Link != &DefaultIdArray->Entry; Link = Link->ForwardLink) {\r
+    DefaultId = BASE_CR (Link, IFR_DEFAULT_DATA, Entry);\r
+    //\r
+    // Add <AltConfigHdr> of the form "&<ConfigHdr>&ALTCFG=XXXX\0"\r
+    //                                |1| StrLen (ConfigHdr) | 8 | 4 |\r
+    //\r
+    UnicodeSPrint (\r
+      StringPtr, \r
+      (1 + StrLen (ConfigHdr) + 8 + 4 + 1) * sizeof (CHAR16), \r
+      L"&%s&ALTCFG=%04X", \r
+      ConfigHdr, \r
+      DefaultId->DefaultId\r
+      );\r
+    StringPtr += StrLen (StringPtr);\r
+\r
+    for (LinkData = VarStorageData->BlockEntry.ForwardLink; LinkData != &VarStorageData->BlockEntry; LinkData = LinkData->ForwardLink) {\r
+      BlockData = BASE_CR (LinkData, IFR_BLOCK_DATA, Entry);\r
+      ListEntry     = &BlockData->DefaultValueEntry;\r
+      for (LinkDefault = ListEntry->ForwardLink; LinkDefault != ListEntry; LinkDefault = LinkDefault->ForwardLink) {\r
+        DefaultValueData = BASE_CR (LinkDefault, IFR_DEFAULT_DATA, Entry);\r
+        if (DefaultValueData->DefaultId != DefaultId->DefaultId) {\r
+          continue;\r
+        }\r
+        if (VarStorageData->Type == EFI_HII_VARSTORE_NAME_VALUE) {\r
+          UnicodeSPrint (\r
+            StringPtr, \r
+            (1 + StrLen (ConfigHdr) + 1) * sizeof (CHAR16), \r
+            L"&%s=", \r
+            BlockData->Name\r
+            );\r
+          StringPtr += StrLen (StringPtr);\r
+        } else {\r
+          //\r
+          // Add <BlockConfig>\r
+          // <BlockConfig> ::= 'OFFSET='<Number>&'WIDTH='<Number>&'VALUE'=<Number>\r
+          //\r
+          UnicodeSPrint (\r
+            StringPtr, \r
+            (8 + 4 + 7 + 4 + 7 + 1) * sizeof (CHAR16),\r
+            L"&OFFSET=%04X&WIDTH=%04X&VALUE=", \r
+            BlockData->Offset, \r
+            BlockData->Width\r
+            );\r
+          StringPtr += StrLen (StringPtr);\r
+        }\r
+        Width = BlockData->Width;\r
         //\r
-        // OrderedList Opcode is no default value.\r
+        // Convert Value to a hex string in "%x" format\r
+        // NOTE: This is in the opposite byte that GUID and PATH use\r
         //\r
-        break;\r
-      }\r
-      //\r
-      // Get the DefaultId\r
-      //\r
-      IfrDefault     = (EFI_IFR_DEFAULT *) IfrOpHdr;\r
-      VarDefaultId   = IfrDefault->DefaultId;\r
-      //\r
-      // Prepare new DefaultValue\r
-      //\r
-      DefaultData.Type        = DefaultValueFromOpcode;\r
-      DefaultData.DefaultId   = VarDefaultId;\r
-      DefaultData.Value       = IfrDefault->Value.u64;  \r
-      \r
-      // If the value field is expression, set the cleaned flag.\r
-      if (IfrDefault->Type ==  EFI_IFR_TYPE_OTHER) {\r
-        DefaultData.Cleaned = TRUE;\r
-      }\r
-      //\r
-      // Add DefaultValue into current BlockData\r
-      //\r
-      InsertDefaultValue (BlockData, &DefaultData);\r
-       \r
-      //\r
-      // After insert the default value, reset the cleaned value for next \r
-      // time used. If not set here, need to set the value before everytime \r
-      // use it.\r
-      //\r
-      DefaultData.Cleaned     = FALSE;\r
-      break;\r
-    case EFI_IFR_END_OP:\r
-      //\r
-      // End Opcode is for Var question.\r
-      //\r
-      if (BlockData != NULL && BlockData->Scope > 0) {\r
-        BlockData->Scope--;\r
-      }\r
-      break;\r
-    default:\r
-      if (BlockData != NULL && BlockData->Scope > 0) {\r
-        BlockData->Scope = (UINT8) (BlockData->Scope + IfrOpHdr->Scope);\r
+        if (BlockData->OpCode == EFI_IFR_STRING_OP){\r
+          DefaultString   = InternalGetString(HiiHandle, DefaultValueData->Value.string);\r
+          TmpBuffer = (UINT8 *) DefaultString;\r
+        } else {\r
+          TmpBuffer = (UINT8 *) &(DefaultValueData->Value);\r
+        }\r
+        for (; Width > 0 && (TmpBuffer != NULL); Width--) {\r
+          StringPtr += UnicodeValueToString (StringPtr, PREFIX_ZERO | RADIX_HEX, TmpBuffer[Width - 1], 2);\r
+        }\r
+        if (DefaultString != NULL){\r
+          FreePool(DefaultString);\r
+          DefaultString = NULL;\r
+        }\r
       }\r
-      break;\r
     }\r
-\r
-    IfrOffset += IfrOpHdr->Length;\r
   }\r
 \r
-Done:\r
-  for (LinkData = VarStorageData->BlockEntry.ForwardLink; LinkData != &VarStorageData->BlockEntry; LinkData = LinkData->ForwardLink) {\r
-    BlockData = BASE_CR (LinkData, IFR_BLOCK_DATA, Entry);\r
-    for (LinkDefault = BlockData->DefaultValueEntry.ForwardLink; LinkDefault != &BlockData->DefaultValueEntry; ) {\r
-      DefaultDataPtr = BASE_CR (LinkDefault, IFR_DEFAULT_DATA, Entry);\r
-      LinkDefault = LinkDefault->ForwardLink;\r
-      if (DefaultDataPtr->Cleaned == TRUE) {\r
-        RemoveEntryList (&DefaultDataPtr->Entry);\r
-        FreePool (DefaultDataPtr);\r
-      }\r
-    }\r
-  }\r
+  HiiToLower (*DefaultAltCfgResp);\r
 \r
-  return Status;  \r
+  return EFI_SUCCESS;\r
 }\r
 \r
 /**\r
@@ -1836,27 +3070,14 @@ GetFullStringFromHiiFormPackages (
   UINTN                        PackageSize;\r
   IFR_BLOCK_DATA               *RequestBlockArray;\r
   IFR_BLOCK_DATA               *BlockData;\r
-  IFR_BLOCK_DATA               *NextBlockData;\r
   IFR_DEFAULT_DATA             *DefaultValueData;\r
   IFR_DEFAULT_DATA             *DefaultId;\r
   IFR_DEFAULT_DATA             *DefaultIdArray;\r
   IFR_VARSTORAGE_DATA          *VarStorageData;\r
   EFI_STRING                   DefaultAltCfgResp;\r
-  EFI_STRING                   FullConfigRequest;\r
   EFI_STRING                   ConfigHdr;\r
-  EFI_STRING                   GuidStr;\r
-  EFI_STRING                   NameStr;\r
-  EFI_STRING                   PathStr;\r
   EFI_STRING                   StringPtr;\r
   EFI_STRING                   Progress;\r
-  UINTN                        Length;\r
-  UINT8                        *TmpBuffer;\r
-  UINT16                       Offset;\r
-  UINT16                       Width;\r
-  LIST_ENTRY                   *Link;\r
-  LIST_ENTRY                   *LinkData;\r
-  LIST_ENTRY                   *LinkDefault;\r
-  BOOLEAN                      DataExist;\r
 \r
   if (DataBaseRecord == NULL || DevicePath == NULL || Request == NULL || AltCfgResp == NULL) {\r
     return EFI_INVALID_PARAMETER;\r
@@ -1869,19 +3090,14 @@ GetFullStringFromHiiFormPackages (
   DefaultIdArray    = NULL;\r
   VarStorageData    = NULL;\r
   DefaultAltCfgResp = NULL;\r
-  FullConfigRequest = NULL;\r
   ConfigHdr         = NULL;\r
-  GuidStr           = NULL;\r
-  NameStr           = NULL;\r
-  PathStr           = NULL;\r
   HiiFormPackage    = NULL;\r
   PackageSize       = 0;\r
-  DataExist         = FALSE;\r
   Progress          = *Request;\r
 \r
   Status = GetFormPackageData (DataBaseRecord, &HiiFormPackage, &PackageSize);\r
   if (EFI_ERROR (Status)) {\r
-    return Status;\r
+    goto Done;\r
   }\r
 \r
   //\r
@@ -1917,410 +3133,101 @@ GetFullStringFromHiiFormPackages (
     while (*StringPtr != L'\0' && *StringPtr != L'&') {\r
       StringPtr ++;\r
     }\r
-    //\r
-    // Check the following string &OFFSET=\r
-    //\r
-    if (*StringPtr != L'\0' && StrnCmp (StringPtr, L"&OFFSET=", StrLen (L"&OFFSET=")) != 0) {\r
-      Progress = StringPtr;\r
-      Status   = EFI_INVALID_PARAMETER;\r
-      goto Done;\r
-    } else if (*StringPtr == L'\0') {\r
+\r
+    if (*StringPtr == L'\0') {\r
       //\r
       // No request block is found.\r
       //\r
       StringPtr = NULL;\r
     }\r
   }\r
-  if (StringPtr != NULL) {\r
-    //\r
-    // Init RequestBlockArray\r
-    //\r
-    RequestBlockArray = (IFR_BLOCK_DATA *) AllocateZeroPool (sizeof (IFR_BLOCK_DATA));\r
-    if (RequestBlockArray == NULL) {\r
-      Status = EFI_OUT_OF_RESOURCES;\r
-      goto Done;\r
-    }\r
-    InitializeListHead (&RequestBlockArray->Entry);\r
-\r
-    //\r
-    // Get the request Block array from the request string\r
-    // Offset and Width\r
-    //\r
-\r
-    //\r
-    // Parse each <RequestElement> if exists\r
-    // Only <BlockName> format is supported by this help function.\r
-    // <BlockName> ::= &'OFFSET='<Number>&'WIDTH='<Number>\r
-    //\r
-    while (*StringPtr != 0 && StrnCmp (StringPtr, L"&OFFSET=", StrLen (L"&OFFSET=")) == 0) {\r
-      //\r
-      // Skip the OFFSET string\r
-      //\r
-      Progress   = StringPtr;\r
-      StringPtr += StrLen (L"&OFFSET=");\r
-      //\r
-      // Get Offset\r
-      //\r
-      Status = GetValueOfNumber (StringPtr, &TmpBuffer, &Length);\r
-      if (EFI_ERROR (Status)) {\r
-        goto Done;\r
-      }\r
-      Offset = 0;\r
-      CopyMem (\r
-        &Offset,\r
-        TmpBuffer,\r
-        (((Length + 1) / 2) < sizeof (UINT16)) ? ((Length + 1) / 2) : sizeof (UINT16)\r
-        );\r
-      FreePool (TmpBuffer);\r
-  \r
-      StringPtr += Length;\r
-      if (StrnCmp (StringPtr, L"&WIDTH=", StrLen (L"&WIDTH=")) != 0) {\r
-        Status = EFI_INVALID_PARAMETER;\r
-        goto Done;\r
-      }\r
-      StringPtr += StrLen (L"&WIDTH=");\r
-  \r
-      //\r
-      // Get Width\r
-      //\r
-      Status = GetValueOfNumber (StringPtr, &TmpBuffer, &Length);\r
-      if (EFI_ERROR (Status)) {\r
-        goto Done;\r
-      }\r
-      Width = 0;\r
-      CopyMem (\r
-        &Width,\r
-        TmpBuffer,\r
-        (((Length + 1) / 2) < sizeof (UINT16)) ? ((Length + 1) / 2) : sizeof (UINT16)\r
-        );\r
-      FreePool (TmpBuffer);\r
-\r
-      StringPtr += Length;\r
-      if (*StringPtr != 0 && *StringPtr != L'&') {\r
-        Status = EFI_INVALID_PARAMETER;\r
-        goto Done;\r
-      }\r
-      \r
-      //\r
-      // Set Block Data\r
-      //\r
-      BlockData = (IFR_BLOCK_DATA *) AllocateZeroPool (sizeof (IFR_BLOCK_DATA));\r
-      if (BlockData == NULL) {\r
-        Status = EFI_OUT_OF_RESOURCES;\r
-        goto Done;\r
-      }\r
-      BlockData->Offset = Offset;\r
-      BlockData->Width  = Width;\r
-      InsertBlockData (&RequestBlockArray->Entry, &BlockData);\r
-      \r
-      //\r
-      // Skip &VALUE string if &VALUE does exists.\r
-      //\r
-      if (StrnCmp (StringPtr, L"&VALUE=", StrLen (L"&VALUE=")) == 0) {\r
-        StringPtr += StrLen (L"&VALUE=");\r
-\r
-        //\r
-        // Get Value\r
-        //\r
-        Status = GetValueOfNumber (StringPtr, &TmpBuffer, &Length);\r
-        if (EFI_ERROR (Status)) {\r
-          Status = EFI_INVALID_PARAMETER;\r
-          goto Done;\r
-        }\r
-\r
-        StringPtr += Length;\r
-        if (*StringPtr != 0 && *StringPtr != L'&') {\r
-          Status = EFI_INVALID_PARAMETER;\r
-          goto Done;\r
-        }\r
-      }\r
-      //\r
-      // If '\0', parsing is finished. \r
-      //\r
-      if (*StringPtr == 0) {\r
-        break;\r
-      }\r
-    }\r
-    \r
-    //\r
-    // Merge the requested block data.\r
-    //\r
-    Link = RequestBlockArray->Entry.ForwardLink;\r
-    while ((Link != &RequestBlockArray->Entry) && (Link->ForwardLink != &RequestBlockArray->Entry)) {\r
-      BlockData = BASE_CR (Link, IFR_BLOCK_DATA, Entry);\r
-      NextBlockData = BASE_CR (Link->ForwardLink, IFR_BLOCK_DATA, Entry);\r
-      if ((NextBlockData->Offset >= BlockData->Offset) && (NextBlockData->Offset <= (BlockData->Offset + BlockData->Width))) {\r
-        if ((NextBlockData->Offset + NextBlockData->Width) > (BlockData->Offset + BlockData->Width)) {\r
-          BlockData->Width = (UINT16) (NextBlockData->Offset + NextBlockData->Width - BlockData->Offset);\r
-        }\r
-        RemoveEntryList (Link->ForwardLink);\r
-        FreePool (NextBlockData);\r
-        continue;\r
-      }\r
-      Link = Link->ForwardLink;      \r
-    }\r
-  }\r
-  \r
-  //\r
-  // 2. Parse FormPackage to get BlockArray and DefaultId Array for the request BlockArray.\r
-  //\r
-\r
-  //\r
-  // Initialize DefaultIdArray to store the map between DeaultId and DefaultName\r
-  //\r
-  DefaultIdArray   = (IFR_DEFAULT_DATA *) AllocateZeroPool (sizeof (IFR_DEFAULT_DATA));\r
-  if (DefaultIdArray == NULL) {\r
-    Status = EFI_OUT_OF_RESOURCES;\r
-    goto Done;\r
-  }\r
-  InitializeListHead (&DefaultIdArray->Entry);\r
-\r
-  //\r
-  // Initialize VarStorageData to store the var store Block and Default value information.\r
-  //\r
-  VarStorageData = (IFR_VARSTORAGE_DATA *) AllocateZeroPool (sizeof (IFR_VARSTORAGE_DATA));\r
-  if (VarStorageData == NULL) {\r
-    Status = EFI_OUT_OF_RESOURCES;\r
-    goto Done;\r
-  }\r
-  InitializeListHead (&VarStorageData->Entry);\r
-  InitializeListHead (&VarStorageData->BlockEntry);\r
-\r
-  //\r
-  // Parse the opcode in form pacakge to get the default setting.\r
-  //\r
-  Status = ParseIfrData (HiiFormPackage, (UINT32) PackageSize, *Request, RequestBlockArray, VarStorageData, DefaultIdArray);\r
-  if (EFI_ERROR (Status)) {\r
-    goto Done;\r
-  }\r
-  \r
-  //\r
-  // No requested varstore in IFR data and directly return\r
-  //\r
-  if (VarStorageData->Size == 0) {\r
-    Status = EFI_SUCCESS;\r
-    goto Done;\r
-  }\r
-\r
-  //\r
-  // 3. Construct Request Element (Block Name) for 2.1 and 2.2 case.\r
-  //\r
-\r
-  //\r
-  // Construct <ConfigHdr> : "GUID=...&NAME=...&PATH=..." by VarStorageData Guid, Name and DriverHandle\r
-  //\r
-  GenerateSubStr (L"GUID=", sizeof (EFI_GUID), (VOID *) &VarStorageData->Guid, 1, &GuidStr);\r
-  GenerateSubStr (L"NAME=", StrLen (VarStorageData->Name) * sizeof (CHAR16), (VOID *) VarStorageData->Name, 2, &NameStr);\r
-  GenerateSubStr (\r
-    L"PATH=",\r
-    GetDevicePathSize ((EFI_DEVICE_PATH_PROTOCOL *) DevicePath),\r
-    (VOID *) DevicePath,\r
-    1,\r
-    &PathStr\r
-    );\r
-  Length = StrLen (GuidStr);\r
-  Length = Length + StrLen (NameStr);\r
-  Length = Length + StrLen (PathStr) + 1;\r
-  ConfigHdr = AllocateZeroPool (Length * sizeof (CHAR16));\r
-  if (ConfigHdr == NULL) {\r
-    Status = EFI_OUT_OF_RESOURCES;\r
-    goto Done;    \r
-  }\r
-  StrCpy (ConfigHdr, GuidStr);\r
-  StrCat (ConfigHdr, NameStr);\r
-  StrCat (ConfigHdr, PathStr);\r
 \r
   //\r
-  // Remove the last character L'&'\r
-  //\r
-  *(ConfigHdr + StrLen (ConfigHdr) - 1) = L'\0';\r
-\r
-  if (RequestBlockArray == NULL) {\r
-    //\r
-    // Append VarStorageData BlockEntry into *Request string\r
-    // Now support only one varstore in a form package.\r
-    //\r
-\r
-    //\r
-    // Go through all VarStorageData Entry and get BlockEntry for each one for the multiple varstore in a single form package\r
-    // Then construct them all to return MultiRequest string : ConfigHdr BlockConfig\r
-    //\r
-\r
-    //\r
-    // Compute the length of the entire request starting with <ConfigHdr> and a \r
-    // Null-terminator\r
-    //\r
-    DataExist = FALSE;\r
-    Length    = StrLen (ConfigHdr) + 1;\r
-\r
-    for (Link = VarStorageData->BlockEntry.ForwardLink; Link != &VarStorageData->BlockEntry; Link = Link->ForwardLink) {\r
-      //\r
-      // Add <BlockName> length for each Offset/Width pair\r
-      //\r
-      // <BlockName> ::= &OFFSET=1234&WIDTH=1234\r
-      //                 |  8   | 4 |   7  | 4 |\r
-      //\r
-      DataExist = TRUE;\r
-      Length = Length + (8 + 4 + 7 + 4);\r
-    }\r
-    \r
-    //\r
-    // No any request block data is found. The request string can't be constructed.\r
-    //\r
-    if (!DataExist) {\r
-      Status = EFI_SUCCESS;\r
-      goto Done;\r
-    }\r
-\r
-    //\r
-    // Allocate buffer for the entire <ConfigRequest>\r
-    //\r
-    FullConfigRequest = AllocateZeroPool (Length * sizeof (CHAR16));\r
-    if (FullConfigRequest == NULL) {\r
-      Status = EFI_OUT_OF_RESOURCES;\r
-      goto Done;\r
-    }\r
-    StringPtr = FullConfigRequest;\r
-  \r
-    //\r
-    // Start with <ConfigHdr>\r
-    //\r
-    StrCpy (StringPtr, ConfigHdr);\r
-    StringPtr += StrLen (StringPtr);\r
-\r
-    //\r
-    // Loop through all the Offset/Width pairs and append them to ConfigRequest\r
-    //\r
-    for (Link = VarStorageData->BlockEntry.ForwardLink; Link != &VarStorageData->BlockEntry; Link = Link->ForwardLink) {\r
-      BlockData = BASE_CR (Link, IFR_BLOCK_DATA, Entry);\r
-      //\r
-      // Append &OFFSET=XXXX&WIDTH=YYYY\0\r
-      //\r
-      UnicodeSPrint (\r
-        StringPtr, \r
-        (8 + 4 + 7 + 4 + 1) * sizeof (CHAR16), \r
-        L"&OFFSET=%04X&WIDTH=%04X", \r
-        BlockData->Offset, \r
-        BlockData->Width\r
-      );\r
-      StringPtr += StrLen (StringPtr);\r
+  // If StringPtr != NULL, get the request elements.\r
+  //\r
+  if (StringPtr != NULL) {\r
+    if (StrStr (StringPtr, L"&OFFSET=") != NULL) {\r
+      RequestBlockArray = GetBlockElement(StringPtr, &Progress);\r
+    } else {\r
+      RequestBlockArray = GetNameElement(StringPtr, &Progress);\r
     }\r
-    //\r
-    // Set to the got full request string.\r
-    //\r
-    HiiToLower (FullConfigRequest);\r
-    if (*Request != NULL) {\r
-      FreePool (*Request);\r
+\r
+    if (RequestBlockArray == NULL) {\r
+      Status = EFI_INVALID_PARAMETER;\r
+      goto Done;\r
     }\r
-    *Request = FullConfigRequest;\r
   }\r
-  \r
+\r
   //\r
-  // 4. Construct Default Value string in AltResp according to request element.\r
-  // Go through all VarStorageData Entry and get the DefaultId array for each one\r
-  // Then construct them all to : ConfigHdr AltConfigHdr ConfigBody AltConfigHdr ConfigBody\r
+  // Initialize DefaultIdArray to store the map between DeaultId and DefaultName\r
   //\r
-  DataExist = FALSE;\r
+  DefaultIdArray   = (IFR_DEFAULT_DATA *) AllocateZeroPool (sizeof (IFR_DEFAULT_DATA));\r
+  if (DefaultIdArray == NULL) {\r
+    Status = EFI_OUT_OF_RESOURCES;\r
+    goto Done;\r
+  }\r
+  InitializeListHead (&DefaultIdArray->Entry);\r
+\r
   //\r
-  // Add length for <ConfigHdr> + '\0'\r
+  // Initialize VarStorageData to store the var store Block and Default value information.\r
   //\r
-  Length = StrLen (ConfigHdr) + 1;\r
-  \r
-  for (Link = DefaultIdArray->Entry.ForwardLink; Link != &DefaultIdArray->Entry; Link = Link->ForwardLink) {\r
-    DefaultId = BASE_CR (Link, IFR_DEFAULT_DATA, Entry);\r
-    //\r
-    // Add length for "&<ConfigHdr>&ALTCFG=XXXX"\r
-    //                |1| StrLen (ConfigHdr) | 8 | 4 |\r
-    //\r
-    Length += (1 + StrLen (ConfigHdr) + 8 + 4);\r
-    \r
-    for (LinkData = VarStorageData->BlockEntry.ForwardLink; LinkData != &VarStorageData->BlockEntry; LinkData = LinkData->ForwardLink) {\r
-      BlockData = BASE_CR (LinkData, IFR_BLOCK_DATA, Entry);\r
-      for (LinkDefault = BlockData->DefaultValueEntry.ForwardLink; LinkDefault != &BlockData->DefaultValueEntry; LinkDefault = LinkDefault->ForwardLink) {\r
-        DefaultValueData = BASE_CR (LinkDefault, IFR_DEFAULT_DATA, Entry);\r
-        if (DefaultValueData->DefaultId == DefaultId->DefaultId) {\r
-          //\r
-          // Add length for "&OFFSET=XXXX&WIDTH=YYYY&VALUE=zzzzzzzzzzzz"\r
-          //                |    8  | 4 |   7  | 4 |   7  | Width * 2 |\r
-          //\r
-          Length += (8 + 4 + 7 + 4 + 7 + BlockData->Width * 2);\r
-          DataExist = TRUE;\r
-        }\r
-      }\r
-    }\r
+  VarStorageData = (IFR_VARSTORAGE_DATA *) AllocateZeroPool (sizeof (IFR_VARSTORAGE_DATA));\r
+  if (VarStorageData == NULL) {\r
+    Status = EFI_OUT_OF_RESOURCES;\r
+    goto Done;\r
   }\r
-  \r
+  InitializeListHead (&VarStorageData->Entry);\r
+  InitializeListHead (&VarStorageData->BlockEntry);\r
+\r
   //\r
-  // No default value is found. The default string doesn't exist.\r
+  // 2. Parse FormPackage to get BlockArray and DefaultId Array for the request BlockArray.\r
   //\r
-  if (!DataExist) {\r
-    Status = EFI_SUCCESS;\r
+\r
+  //\r
+  // Parse the opcode in form pacakge to get the default setting.\r
+  //\r
+  Status = ParseIfrData (DataBaseRecord->Handle,\r
+                         HiiFormPackage,\r
+                         (UINT32) PackageSize,\r
+                         *Request,\r
+                         RequestBlockArray,\r
+                         VarStorageData,\r
+                         DefaultIdArray);\r
+  if (EFI_ERROR (Status)) {\r
     goto Done;\r
   }\r
 \r
   //\r
-  // Allocate buffer for the entire <DefaultAltCfgResp>\r
+  // No requested varstore in IFR data and directly return\r
   //\r
-  DefaultAltCfgResp = AllocateZeroPool (Length * sizeof (CHAR16));\r
-  if (DefaultAltCfgResp == NULL) {\r
-    Status = EFI_OUT_OF_RESOURCES;\r
+  if (VarStorageData->Type == 0 && VarStorageData->Name == NULL) {\r
+    Status = EFI_SUCCESS;\r
     goto Done;\r
   }\r
-  StringPtr = DefaultAltCfgResp;\r
 \r
   //\r
-  // Start with <ConfigHdr>\r
+  // 3. Construct Request Element (Block Name) for 2.1 and 2.2 case.\r
   //\r
-  StrCpy (StringPtr, ConfigHdr);\r
-  StringPtr += StrLen (StringPtr);\r
-\r
-  for (Link = DefaultIdArray->Entry.ForwardLink; Link != &DefaultIdArray->Entry; Link = Link->ForwardLink) {\r
-    DefaultId = BASE_CR (Link, IFR_DEFAULT_DATA, Entry);\r
-    //\r
-    // Add <AltConfigHdr> of the form "&<ConfigHdr>&ALTCFG=XXXX\0"\r
-    //                                |1| StrLen (ConfigHdr) | 8 | 4 |\r
-    //\r
-    UnicodeSPrint (\r
-      StringPtr, \r
-      (1 + StrLen (ConfigHdr) + 8 + 4 + 1) * sizeof (CHAR16), \r
-      L"&%s&ALTCFG=%04X", \r
-      ConfigHdr, \r
-      DefaultId->DefaultId\r
-      );\r
-    StringPtr += StrLen (StringPtr);\r
-    \r
-    for (LinkData = VarStorageData->BlockEntry.ForwardLink; LinkData != &VarStorageData->BlockEntry; LinkData = LinkData->ForwardLink) {\r
-      BlockData = BASE_CR (LinkData, IFR_BLOCK_DATA, Entry);\r
-      for (LinkDefault = BlockData->DefaultValueEntry.ForwardLink; LinkDefault != &BlockData->DefaultValueEntry; LinkDefault = LinkDefault->ForwardLink) {\r
-        DefaultValueData = BASE_CR (LinkDefault, IFR_DEFAULT_DATA, Entry);\r
-        if (DefaultValueData->DefaultId == DefaultId->DefaultId) {\r
-          //\r
-          // Add <BlockConfig>\r
-          // <BlockConfig> ::= 'OFFSET='<Number>&'WIDTH='<Number>&'VALUE'=<Number>\r
-          //\r
-          UnicodeSPrint (\r
-            StringPtr, \r
-            (8 + 4 + 7 + 4 + 7 + 1) * sizeof (CHAR16),\r
-            L"&OFFSET=%04X&WIDTH=%04X&VALUE=", \r
-            BlockData->Offset, \r
-            BlockData->Width\r
-            );\r
-          StringPtr += StrLen (StringPtr);\r
+  Status = GenerateHdr (VarStorageData, DevicePath, &ConfigHdr);\r
+  if (EFI_ERROR (Status)) {\r
+    goto Done;\r
+  }\r
 \r
-          //\r
-          // Convert Value to a hex string in "%x" format\r
-          // NOTE: This is in the opposite byte that GUID and PATH use\r
-          //\r
-          Width     = BlockData->Width;\r
-          TmpBuffer = (UINT8 *) &(DefaultValueData->Value);\r
-          for (; Width > 0; Width--) {\r
-            StringPtr += UnicodeValueToString (StringPtr, PREFIX_ZERO | RADIX_HEX, TmpBuffer[Width - 1], 2);\r
-          }\r
-        }\r
-      }\r
+  if (RequestBlockArray == NULL) {\r
+    if (!GenerateConfigRequest(ConfigHdr, VarStorageData, &Status, Request)) {\r
+      goto Done;\r
     }\r
   }\r
-  HiiToLower (DefaultAltCfgResp);\r
+\r
+  //\r
+  // 4. Construct Default Value string in AltResp according to request element.\r
+  // Go through all VarStorageData Entry and get the DefaultId array for each one\r
+  // Then construct them all to : ConfigHdr AltConfigHdr ConfigBody AltConfigHdr ConfigBody\r
+  //\r
+  Status = GenerateAltConfigResp (DataBaseRecord->Handle,ConfigHdr, VarStorageData, DefaultIdArray, &DefaultAltCfgResp);\r
+  if (EFI_ERROR (Status)) {\r
+    goto Done;\r
+  }\r
 \r
   //\r
   // 5. Merge string into the input AltCfgResp if the iput *AltCfgResp is not NULL.\r
@@ -2340,12 +3247,15 @@ Done:
     while (!IsListEmpty (&RequestBlockArray->Entry)) {\r
       BlockData = BASE_CR (RequestBlockArray->Entry.ForwardLink, IFR_BLOCK_DATA, Entry);\r
       RemoveEntryList (&BlockData->Entry);\r
+      if (BlockData->Name != NULL) {\r
+        FreePool (BlockData->Name);\r
+      }\r
       FreePool (BlockData);\r
     }\r
 \r
     FreePool (RequestBlockArray);\r
   }\r
-  \r
+\r
   if (VarStorageData != NULL) {\r
     //\r
     // Free link array VarStorageData\r
@@ -2353,6 +3263,9 @@ Done:
     while (!IsListEmpty (&VarStorageData->BlockEntry)) {\r
       BlockData = BASE_CR (VarStorageData->BlockEntry.ForwardLink, IFR_BLOCK_DATA, Entry);\r
       RemoveEntryList (&BlockData->Entry);\r
+      if (BlockData->Name != NULL) {\r
+        FreePool (BlockData->Name);\r
+      }\r
       //\r
       // Free default value link array\r
       //\r
@@ -2377,19 +3290,10 @@ Done:
     }\r
     FreePool (DefaultIdArray);\r
   }\r
-  \r
+\r
   //\r
   // Free the allocated string \r
   //\r
-  if (GuidStr != NULL) {\r
-    FreePool (GuidStr);\r
-  }\r
-  if (NameStr != NULL) {\r
-    FreePool (NameStr);\r
-  }\r
-  if (PathStr != NULL) {\r
-    FreePool (PathStr);\r
-  }\r
   if (ConfigHdr != NULL) {\r
     FreePool (ConfigHdr);\r
   }\r
@@ -2405,7 +3309,7 @@ Done:
     if (*Request == NULL) {\r
       *PointerProgress = NULL;\r
     } else if (EFI_ERROR (Status)) {\r
-      *PointerProgress = Progress;\r
+      *PointerProgress = *Request;\r
     } else {\r
       *PointerProgress = *Request + StrLen (*Request);\r
     }\r
@@ -2454,10 +3358,11 @@ GetConfigRespFromEfiVarStore (
   UINT8      *VarStore;\r
   UINTN      BufferSize;\r
 \r
-  Status       = EFI_SUCCESS;\r
-  BufferSize   = 0;\r
-  VarStore     = NULL;\r
-  VarStoreName = NULL;\r
+  Status          = EFI_SUCCESS;\r
+  BufferSize      = 0;\r
+  VarStore        = NULL;\r
+  VarStoreName    = NULL;\r
+  *AccessProgress = Request;\r
   \r
   VarStoreName = AllocateZeroPool (AsciiStrSize ((CHAR8 *)EfiVarStoreInfo->Name) * sizeof (CHAR16));\r
   if (VarStoreName == NULL) {\r
@@ -2576,6 +3481,149 @@ Done:
   return Status;\r
 }\r
 \r
+/**\r
+  Validate the config request elements.\r
+\r
+  @param  ConfigElements                A null-terminated Unicode string in <ConfigRequest> format, \r
+                                        without configHdr field.\r
+\r
+  @retval     CHAR16 *    THE first Name/value pair not correct.\r
+  @retval     NULL        Success parse the name/value pair\r
+**/\r
+CHAR16 *\r
+OffsetWidthValidate (\r
+  CHAR16          *ConfigElements\r
+  )\r
+{\r
+  CHAR16    *StringPtr;\r
+  CHAR16    *RetVal;\r
+\r
+  StringPtr = ConfigElements;\r
+\r
+  while (1) {\r
+    RetVal    = StringPtr;\r
+    if (StrnCmp (StringPtr, L"&OFFSET=", StrLen (L"&OFFSET=")) != 0) {\r
+      return RetVal;\r
+    }\r
+\r
+    while (*StringPtr != L'\0' && StrnCmp (StringPtr, L"&WIDTH=", StrLen (L"&WIDTH=")) != 0) {\r
+      StringPtr++;\r
+    }\r
+    if (*StringPtr == L'\0') {\r
+      return RetVal;\r
+    }\r
+\r
+    StringPtr += StrLen (L"&WIDTH=");\r
+    while (*StringPtr != L'\0' && StrnCmp (StringPtr, L"&OFFSET=", StrLen (L"&OFFSET=")) != 0) {\r
+      StringPtr ++;\r
+    }\r
+\r
+    if (*StringPtr == L'\0') {\r
+      return NULL;\r
+    }\r
+  }\r
+}\r
+\r
+/**\r
+  Validate the config request elements.\r
+\r
+  @param  ConfigElements                A null-terminated Unicode string in <ConfigRequest> format, \r
+                                        without configHdr field.\r
+\r
+  @retval     CHAR16 *    THE first Name/value pair not correct.\r
+  @retval     NULL        Success parse the name/value pair\r
+\r
+**/\r
+CHAR16 *\r
+NameValueValidate (\r
+  CHAR16          *ConfigElements\r
+  )\r
+{\r
+  CHAR16    *StringPtr;\r
+  CHAR16    *RetVal;\r
+\r
+  StringPtr = ConfigElements;\r
+\r
+  while (1) {\r
+    RetVal = StringPtr;\r
+    if (*StringPtr != L'&') {\r
+      return RetVal;\r
+    }\r
+    StringPtr += 1;\r
+\r
+    StringPtr = StrStr (StringPtr, L"&");\r
+    \r
+    if (StringPtr == NULL) {\r
+      return NULL;\r
+    }\r
+  }\r
+}\r
+\r
+/**\r
+  Validate the config request string.\r
+\r
+  @param  ConfigRequest                A null-terminated Unicode string in <ConfigRequest> format.\r
+\r
+  @retval     CHAR16 *    THE first element not correct.\r
+  @retval     NULL        Success parse the name/value pair\r
+\r
+**/\r
+CHAR16 *\r
+ConfigRequestValidate (\r
+  CHAR16          *ConfigRequest\r
+  )\r
+{\r
+  BOOLEAN            HasNameField;\r
+  CHAR16             *StringPtr;\r
+\r
+  HasNameField = TRUE;\r
+  StringPtr    = ConfigRequest;\r
+\r
+  //\r
+  // Check <ConfigHdr>\r
+  //\r
+  if (StrnCmp (StringPtr, L"GUID=", StrLen (L"GUID=")) != 0) {\r
+    return ConfigRequest;\r
+  }\r
+  StringPtr += StrLen (L"GUID=");\r
+  while (*StringPtr != L'\0' && StrnCmp (StringPtr, L"&NAME=", StrLen (L"&NAME=")) != 0) {\r
+    StringPtr++;\r
+  }\r
+  if (*StringPtr == L'\0') {\r
+    return ConfigRequest;\r
+  }\r
+  StringPtr += StrLen (L"&NAME=");\r
+  if (*StringPtr == L'&') {\r
+    HasNameField = FALSE;\r
+  }\r
+  while (*StringPtr != L'\0' && StrnCmp (StringPtr, L"&PATH=", StrLen (L"&PATH=")) != 0) {\r
+    StringPtr++;\r
+  }\r
+  if (*StringPtr == L'\0') {\r
+    return ConfigRequest;\r
+  }\r
+  StringPtr += StrLen (L"&PATH=");\r
+  while (*StringPtr != L'\0' && *StringPtr != L'&') {\r
+    StringPtr ++;\r
+  }\r
+\r
+  if (*StringPtr == L'\0') {\r
+    return NULL;\r
+  }\r
+\r
+  if (HasNameField) {\r
+    //\r
+    // Should be Buffer varstore, config request should be "OFFSET/Width" pairs.\r
+    //\r
+    return OffsetWidthValidate(StringPtr);\r
+  } else {\r
+    //\r
+    // Should be Name/Value varstore, config request should be "&name1&name2..." pairs.\r
+    //\r
+    return NameValueValidate(StringPtr);\r
+  }\r
+}\r
+\r
 /**\r
   This function allows a caller to extract the current configuration\r
   for one or more named elements from one or more drivers.\r
@@ -2611,8 +3659,10 @@ Done:
                                  Progress parameter is set to NULL.\r
   @retval EFI_INVALID_PARAMETER  Illegal syntax. Progress set to most recent &\r
                                  before the error or the beginning of the string.\r
-  @retval EFI_INVALID_PARAMETER  Unknown name. Progress points to the & before the\r
-                                 name in question.\r
+  @retval EFI_INVALID_PARAMETER  The ExtractConfig function of the underlying HII\r
+                                 Configuration Access Protocol returned \r
+                                 EFI_INVALID_PARAMETER. Progress set to most recent\r
+                                 & before the error or the beginning of the string.\r
 \r
 **/\r
 EFI_STATUS\r
@@ -2644,7 +3694,9 @@ HiiConfigRoutingExtractConfig (
   BOOLEAN                             FirstElement;\r
   BOOLEAN                             IfrDataParsedFlag;\r
   BOOLEAN                             IsEfiVarStore;\r
-  EFI_IFR_VARSTORE_EFI                *EfiVarStoreInfo; \r
+  EFI_IFR_VARSTORE_EFI                *EfiVarStoreInfo;\r
+  EFI_STRING                          ErrorPtr;\r
+  UINTN                               DevicePathSize;\r
 \r
   if (This == NULL || Progress == NULL || Results == NULL) {\r
     return EFI_INVALID_PARAMETER;\r
@@ -2730,11 +3782,8 @@ HiiConfigRoutingExtractConfig (
       Database = CR (Link, HII_DATABASE_RECORD, DatabaseEntry, HII_DATABASE_RECORD_SIGNATURE);\r
       if ((DevicePathPkg = Database->PackageList->DevicePathPkg) != NULL) {\r
         CurrentDevicePath = DevicePathPkg + sizeof (EFI_HII_PACKAGE_HEADER);\r
-        if (CompareMem (\r
-              DevicePath,\r
-              CurrentDevicePath,\r
-              GetDevicePathSize ((EFI_DEVICE_PATH_PROTOCOL *) CurrentDevicePath)\r
-              ) == 0) {\r
+        DevicePathSize    = GetDevicePathSize ((EFI_DEVICE_PATH_PROTOCOL *) CurrentDevicePath);\r
+        if ((CompareMem (DevicePath,CurrentDevicePath,DevicePathSize) == 0) && IsThisPackageList(Database, ConfigRequest)) {\r
           DriverHandle = Database->DriverHandle;\r
           HiiHandle    = Database->Handle;\r
           break;\r
@@ -2762,12 +3811,22 @@ HiiConfigRoutingExtractConfig (
         goto Done;\r
       }\r
     }\r
-    \r
+\r
     //\r
-    // Check whether ConfigRequest contains request string OFFSET/WIDTH\r
+    // Validate ConfigRequest String.\r
+    //\r
+    ErrorPtr = ConfigRequestValidate(ConfigRequest);\r
+    if (ErrorPtr != NULL) {\r
+      *Progress = StrStr (StringPtr, ErrorPtr);\r
+      Status = EFI_INVALID_PARAMETER;\r
+      goto Done;\r
+    }\r
+\r
+    //\r
+    // Check whether ConfigRequest contains request string.\r
     //\r
     IfrDataParsedFlag = FALSE;\r
-    if ((HiiHandle != NULL) && (StrStr (ConfigRequest, L"&OFFSET=") == NULL)) {\r
+    if ((HiiHandle != NULL) && !GetElementsFromRequest(ConfigRequest)) {\r
       //\r
       // Get the full request string from IFR when HiiPackage is registered to HiiHandle \r
       //\r
@@ -2778,13 +3837,14 @@ HiiConfigRoutingExtractConfig (
         // AccessProgress indicates the parsing progress on <ConfigRequest>.\r
         // Map it to the progress on <MultiConfigRequest> then return it.\r
         //\r
+        ASSERT (AccessProgress != NULL);\r
         *Progress = StrStr (StringPtr, AccessProgress);\r
         goto Done;\r
       }\r
       //\r
       // Not any request block is found.\r
       //\r
-      if (StrStr (ConfigRequest, L"&OFFSET=") == NULL) {\r
+      if (!GetElementsFromRequest(ConfigRequest)) {\r
         AccessResults = AllocateCopyPool (StrSize (ConfigRequest), ConfigRequest);\r
         goto NextConfigString;\r
       }\r
@@ -2803,7 +3863,7 @@ HiiConfigRoutingExtractConfig (
       // Call the GetVariable function to extract settings.\r
       //\r
       Status = GetConfigRespFromEfiVarStore(This, EfiVarStoreInfo, ConfigRequest, &AccessResults, &AccessProgress);\r
-      FreePool (EfiVarStoreInfo);    \r
+      FreePool (EfiVarStoreInfo);\r
     } else {\r
       //\r
       // Call corresponding ConfigAccess protocol to extract settings\r
@@ -2813,7 +3873,9 @@ HiiConfigRoutingExtractConfig (
                       &gEfiHiiConfigAccessProtocolGuid,\r
                       (VOID **) &ConfigAccess\r
                       );\r
-      ASSERT_EFI_ERROR (Status);\r
+      if (EFI_ERROR (Status)) {\r
+        goto Done;\r
+      }\r
 \r
       Status = ConfigAccess->ExtractConfig (\r
                                ConfigAccess,\r
@@ -2855,7 +3917,7 @@ HiiConfigRoutingExtractConfig (
       DefaultResults = NULL;\r
     }\r
     \r
-NextConfigString:   \r
+NextConfigString:\r
     if (!FirstElement) {\r
       Status = AppendToMultiString (Results, L"&");\r
       ASSERT_EFI_ERROR (Status);\r
@@ -2918,9 +3980,9 @@ Done:
                                  instance.\r
   @param  Results                Null-terminated Unicode string in\r
                                  <MultiConfigAltResp> format which has all values\r
-                                 filled in for the names in the Request string.\r
-                                 String to be allocated by the  called function.\r
-                                 De-allocation is up to the caller.\r
+                                 filled in for the entirety of the current HII \r
+                                 database. String to be allocated by the  called \r
+                                 function. De-allocation is up to the caller.\r
 \r
   @retval EFI_SUCCESS            The Results string is filled with the values\r
                                  corresponding to all requested names.\r
@@ -3066,7 +4128,7 @@ HiiConfigRoutingExportConfig (
         if (StringPtr != NULL) {\r
           *StringPtr = 0;\r
         }\r
-        if (StrStr (AccessResults, L"&OFFSET=") != NULL) {\r
+        if (GetElementsFromRequest (AccessResults)) {\r
           Status = GetFullStringFromHiiFormPackages (Database, DevicePath, &AccessResults, &DefaultResults, NULL);\r
           ASSERT_EFI_ERROR (Status);\r
         }\r
@@ -3157,6 +4219,7 @@ HiiConfigRoutingRouteConfig (
   EFI_STRING                          AccessProgress;\r
   EFI_IFR_VARSTORE_EFI                *EfiVarStoreInfo;\r
   BOOLEAN                             IsEfiVarstore;\r
+  UINTN                               DevicePathSize;\r
 \r
   if (This == NULL || Progress == NULL) {\r
     return EFI_INVALID_PARAMETER;\r
@@ -3228,11 +4291,8 @@ HiiConfigRoutingRouteConfig (
 \r
       if ((DevicePathPkg = Database->PackageList->DevicePathPkg) != NULL) {\r
         CurrentDevicePath = DevicePathPkg + sizeof (EFI_HII_PACKAGE_HEADER);\r
-        if (CompareMem (\r
-              DevicePath,\r
-              CurrentDevicePath,\r
-              GetDevicePathSize ((EFI_DEVICE_PATH_PROTOCOL *) CurrentDevicePath)\r
-              ) == 0) {\r
+        DevicePathSize    = GetDevicePathSize ((EFI_DEVICE_PATH_PROTOCOL *) CurrentDevicePath);\r
+        if ((CompareMem (DevicePath,CurrentDevicePath,DevicePathSize) == 0) && IsThisPackageList(Database, ConfigResp)) {\r
           DriverHandle = Database->DriverHandle;\r
           break;\r
         }\r
@@ -3295,6 +4355,7 @@ HiiConfigRoutingRouteConfig (
                                );\r
     }\r
     if (EFI_ERROR (Status)) {\r
+      ASSERT (AccessProgress != NULL);\r
       //\r
       // AccessProgress indicates the parsing progress on <ConfigResp>.\r
       // Map it to the progress on <MultiConfigResp> then return it.\r
@@ -3387,6 +4448,8 @@ HiiBlockToConfig (
   CHAR16                              *TemString;\r
   CHAR16                              TemChar;\r
 \r
+  TmpBuffer = NULL;\r
+\r
   if (This == NULL || Progress == NULL || Config == NULL) {\r
     return EFI_INVALID_PARAMETER;\r
   }\r
@@ -3436,12 +4499,11 @@ HiiBlockToConfig (
   }\r
   if (*StringPtr == 0) {\r
     *Progress = StringPtr;\r
-    Status = EFI_SUCCESS;\r
 \r
     AppendToMultiString(Config, ConfigRequest);\r
     HiiToLower (*Config);\r
 \r
-    goto Exit;\r
+    return EFI_SUCCESS;\r
   }\r
   //\r
   // Skip '&'\r
@@ -3473,7 +4535,7 @@ HiiBlockToConfig (
     //\r
     Status = GetValueOfNumber (StringPtr, &TmpBuffer, &Length);\r
     if (EFI_ERROR (Status)) {\r
-      *Progress = ConfigRequest;\r
+      *Progress = TmpPtr - 1;\r
       goto Exit;\r
     }\r
     Offset = 0;\r
@@ -3486,7 +4548,7 @@ HiiBlockToConfig (
 \r
     StringPtr += Length;\r
     if (StrnCmp (StringPtr, L"&WIDTH=", StrLen (L"&WIDTH=")) != 0) {\r
-      *Progress = StringPtr - Length - StrLen (L"OFFSET=") - 1;\r
+      *Progress = TmpPtr - 1;\r
       Status = EFI_INVALID_PARAMETER;\r
       goto Exit;\r
     }\r
@@ -3497,7 +4559,7 @@ HiiBlockToConfig (
     //\r
     Status = GetValueOfNumber (StringPtr, &TmpBuffer, &Length);\r
     if (EFI_ERROR (Status)) {\r
-      *Progress = ConfigRequest;\r
+      *Progress =  TmpPtr - 1;\r
       goto Exit;\r
     }\r
     Width = 0;\r
@@ -3510,7 +4572,7 @@ HiiBlockToConfig (
 \r
     StringPtr += Length;\r
     if (*StringPtr != 0 && *StringPtr != L'&') {\r
-      *Progress = StringPtr - Length - StrLen (L"&WIDTH=");\r
+      *Progress =  TmpPtr - 1;\r
       Status = EFI_INVALID_PARAMETER;\r
       goto Exit;\r
     }\r
@@ -3564,8 +4626,8 @@ HiiBlockToConfig (
       *(ConfigElement + (StringPtr - TmpPtr)) = L'&';\r
     }\r
     *(ConfigElement + (StringPtr - TmpPtr) + 1) = 0;\r
-    StrCat (ConfigElement, L"VALUE=");\r
-    StrCat (ConfigElement, ValueStr);\r
+    StrCatS (ConfigElement, Length, L"VALUE=");\r
+    StrCatS (ConfigElement, Length, ValueStr);\r
 \r
     AppendToMultiString (Config, ConfigElement);\r
 \r
@@ -3633,8 +4695,9 @@ Exit:
                                  (see below)  is returned.\r
   @param  BlockSize              The length of the Block in units of UINT8.  On\r
                                  input, this is the size of the Block. On output,\r
-                                 if successful, contains the index of the  last\r
-                                 modified byte in the Block.\r
+                                 if successful, contains the largest index of the\r
+                                 modified byte in the Block, or the required buffer\r
+                                 size if the Block is not large enough.\r
   @param  Progress               On return, points to an element of the ConfigResp\r
                                  string filled in with the offset of the most\r
                                  recent '&' before the first failing name / value\r
@@ -3654,7 +4717,8 @@ Exit:
                                  value pair. Block is left updated and\r
                                  Progress points at the '&' preceding the first\r
                                  non-<BlockName>.\r
-  @retval EFI_DEVICE_ERROR       Block not large enough. Progress undefined.\r
+  @retval EFI_BUFFER_TOO_SMALL   Block not large enough. Progress undefined. \r
+                                 BlockSize is updated with the required buffer size.\r
   @retval EFI_NOT_FOUND          Target for the specified routing data was not found.\r
                                  Progress points to the "G" in "GUID" of the errant\r
                                  routing data.\r
@@ -3672,6 +4736,7 @@ HiiConfigToBlock (
 {\r
   HII_DATABASE_PRIVATE_DATA           *Private;\r
   EFI_STRING                          StringPtr;\r
+  EFI_STRING                          TmpPtr;\r
   UINTN                               Length;\r
   EFI_STATUS                          Status;\r
   UINT8                               *TmpBuffer;\r
@@ -3681,6 +4746,8 @@ HiiConfigToBlock (
   UINTN                               BufferSize;\r
   UINTN                               MaxBlockSize;\r
 \r
+  TmpBuffer = NULL;\r
+\r
   if (This == NULL || BlockSize == NULL || Progress == NULL) {\r
     return EFI_INVALID_PARAMETER;\r
   }\r
@@ -3723,24 +4790,21 @@ HiiConfigToBlock (
     Status = EFI_INVALID_PARAMETER;\r
     goto Exit;\r
   }\r
-  //\r
-  // Skip '&'\r
-  //\r
-  StringPtr++;\r
 \r
   //\r
   // Parse each <ConfigElement> if exists\r
-  // Only <BlockConfig> format is supported by this help function.\r
+  // Only '&'<BlockConfig> format is supported by this help function.\r
   // <BlockConfig> ::= 'OFFSET='<Number>&'WIDTH='<Number>&'VALUE='<Number>\r
   //\r
-  while (*StringPtr != 0 && StrnCmp (StringPtr, L"OFFSET=", StrLen (L"OFFSET=")) == 0) {\r
-    StringPtr += StrLen (L"OFFSET=");\r
+  while (*StringPtr != 0 && StrnCmp (StringPtr, L"&OFFSET=", StrLen (L"&OFFSET=")) == 0) {\r
+    TmpPtr     = StringPtr;\r
+    StringPtr += StrLen (L"&OFFSET=");\r
     //\r
     // Get Offset\r
     //\r
     Status = GetValueOfNumber (StringPtr, &TmpBuffer, &Length);\r
     if (EFI_ERROR (Status)) {\r
-      *Progress = ConfigResp;\r
+      *Progress = TmpPtr;\r
       goto Exit;\r
     }\r
     Offset = 0;\r
@@ -3753,7 +4817,7 @@ HiiConfigToBlock (
 \r
     StringPtr += Length;\r
     if (StrnCmp (StringPtr, L"&WIDTH=", StrLen (L"&WIDTH=")) != 0) {\r
-      *Progress = StringPtr - Length - StrLen (L"OFFSET=") - 1;\r
+      *Progress = TmpPtr;\r
       Status = EFI_INVALID_PARAMETER;\r
       goto Exit;\r
     }\r
@@ -3764,7 +4828,7 @@ HiiConfigToBlock (
     //\r
     Status = GetValueOfNumber (StringPtr, &TmpBuffer, &Length);\r
     if (EFI_ERROR (Status)) {\r
-      *Progress = ConfigResp;\r
+      *Progress = TmpPtr;\r
       goto Exit;\r
     }\r
     Width = 0;\r
@@ -3777,7 +4841,7 @@ HiiConfigToBlock (
 \r
     StringPtr += Length;\r
     if (StrnCmp (StringPtr, L"&VALUE=", StrLen (L"&VALUE=")) != 0) {\r
-      *Progress = StringPtr - Length - StrLen (L"&WIDTH=");\r
+      *Progress = TmpPtr;\r
       Status = EFI_INVALID_PARAMETER;\r
       goto Exit;\r
     }\r
@@ -3788,13 +4852,13 @@ HiiConfigToBlock (
     //\r
     Status = GetValueOfNumber (StringPtr, &Value, &Length);\r
     if (EFI_ERROR (Status)) {\r
-      *Progress = ConfigResp;\r
+      *Progress = TmpPtr;\r
       goto Exit;\r
     }\r
 \r
     StringPtr += Length;\r
     if (*StringPtr != 0 && *StringPtr != L'&') {\r
-      *Progress = StringPtr - Length - 7;\r
+      *Progress = TmpPtr;\r
       Status = EFI_INVALID_PARAMETER;\r
       goto Exit;\r
     }\r
@@ -3813,20 +4877,18 @@ HiiConfigToBlock (
     Value = NULL;\r
 \r
     //\r
-    // If '\0', parsing is finished. Otherwise skip '&' to continue\r
+    // If '\0', parsing is finished.\r
     //\r
     if (*StringPtr == 0) {\r
       break;\r
     }\r
-\r
-    StringPtr++;\r
   }\r
   \r
   //\r
-  // The input string is ConfigAltResp format.\r
+  // The input string is not ConfigResp format, return error.\r
   //\r
-  if ((*StringPtr != 0) && (StrnCmp (StringPtr, L"&GUID=", StrLen (L"&GUID=")) != 0)) {\r
-    *Progress = StringPtr - 1;\r
+  if (*StringPtr != 0) {\r
+    *Progress = StringPtr;\r
     Status = EFI_INVALID_PARAMETER;\r
     goto Exit;\r
   }\r
@@ -3837,7 +4899,7 @@ HiiConfigToBlock (
   if (MaxBlockSize > BufferSize) {\r
     *BlockSize = MaxBlockSize;\r
     if (Block != NULL) {\r
-      return EFI_DEVICE_ERROR;\r
+      return EFI_BUFFER_TOO_SMALL;\r
     }\r
   }\r
 \r
@@ -4082,8 +5144,8 @@ Exit:
     if (*AltCfgResp == NULL) {\r
       Status = EFI_OUT_OF_RESOURCES;\r
     } else {\r
-      StrnCpy (*AltCfgResp, HdrStart, HdrEnd - HdrStart);\r
-      StrCat (*AltCfgResp, Result);\r
+      StrnCpyS (*AltCfgResp, Length, HdrStart, HdrEnd - HdrStart);\r
+      StrCatS (*AltCfgResp, Length, Result);\r
       Status = EFI_SUCCESS;\r
     }\r
   }\r