]> git.proxmox.com Git - mirror_edk2.git/blobdiff - NetworkPkg/Ip6Dxe/Ip6Driver.c
UefiCpuPkg: Move AsmRelocateApLoopStart from Mpfuncs.nasm to AmdSev.nasm
[mirror_edk2.git] / NetworkPkg / Ip6Dxe / Ip6Driver.c
index d242b153df30cb2f4d8fe0aa6991f7c4441ab58c..b483a7d136d975ca5d6aea94c87cc2158465f303 100644 (file)
@@ -1,21 +1,16 @@
 /** @file\r
   The driver binding and service binding protocol for IP6 driver.\r
 \r
-  Copyright (c) 2009 - 2012, Intel Corporation. All rights reserved.<BR>\r
+  Copyright (c) 2009 - 2019, Intel Corporation. All rights reserved.<BR>\r
+  (C) Copyright 2015 Hewlett-Packard Development Company, L.P.<BR>\r
 \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
-  http://opensource.org/licenses/bsd-license.php.\r
-\r
-  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
-  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
+  SPDX-License-Identifier: BSD-2-Clause-Patent\r
 \r
 **/\r
 \r
 #include "Ip6Impl.h"\r
 \r
-EFI_DRIVER_BINDING_PROTOCOL gIp6DriverBinding = {\r
+EFI_DRIVER_BINDING_PROTOCOL  gIp6DriverBinding = {\r
   Ip6DriverBindingSupported,\r
   Ip6DriverBindingStart,\r
   Ip6DriverBindingStop,\r
@@ -24,6 +19,39 @@ EFI_DRIVER_BINDING_PROTOCOL gIp6DriverBinding = {
   NULL\r
 };\r
 \r
+BOOLEAN  mIpSec2Installed = FALSE;\r
+\r
+/**\r
+   Callback function for IpSec2 Protocol install.\r
+\r
+   @param[in] Event           Event whose notification function is being invoked\r
+   @param[in] Context         Pointer to the notification function's context\r
+\r
+**/\r
+VOID\r
+EFIAPI\r
+IpSec2InstalledCallback (\r
+  IN EFI_EVENT  Event,\r
+  IN VOID       *Context\r
+  )\r
+{\r
+  EFI_STATUS  Status;\r
+\r
+  //\r
+  // Test if protocol was even found.\r
+  // Notification function will be called at least once.\r
+  //\r
+  Status = gBS->LocateProtocol (&gEfiIpSec2ProtocolGuid, NULL, (VOID **)&mIpSec);\r
+  if ((Status == EFI_SUCCESS) && (mIpSec != NULL)) {\r
+    //\r
+    // Close the event so it does not get called again.\r
+    //\r
+    gBS->CloseEvent (Event);\r
+\r
+    mIpSec2Installed = TRUE;\r
+  }\r
+}\r
+\r
 /**\r
   This is the declaration of an EFI image entry point. This entry point is\r
   the same for UEFI Applications, UEFI OS Loaders, and UEFI Drivers including\r
@@ -42,10 +70,20 @@ EFI_DRIVER_BINDING_PROTOCOL gIp6DriverBinding = {
 EFI_STATUS\r
 EFIAPI\r
 Ip6DriverEntryPoint (\r
-  IN EFI_HANDLE             ImageHandle,\r
-  IN EFI_SYSTEM_TABLE       *SystemTable\r
+  IN EFI_HANDLE        ImageHandle,\r
+  IN EFI_SYSTEM_TABLE  *SystemTable\r
   )\r
 {\r
+  VOID  *Registration;\r
+\r
+  EfiCreateProtocolNotifyEvent (\r
+    &gEfiIpSec2ProtocolGuid,\r
+    TPL_CALLBACK,\r
+    IpSec2InstalledCallback,\r
+    NULL,\r
+    &Registration\r
+    );\r
+\r
   return EfiLibInstallDriverBindingComponentName2 (\r
            ImageHandle,\r
            SystemTable,\r
@@ -105,23 +143,41 @@ Ip6DriverBindingSupported (
 **/\r
 EFI_STATUS\r
 Ip6CleanService (\r
-  IN IP6_SERVICE            *IpSb\r
+  IN IP6_SERVICE  *IpSb\r
   )\r
 {\r
-  EFI_STATUS                Status;\r
-  EFI_IPv6_ADDRESS          AllNodes;\r
-  IP6_NEIGHBOR_ENTRY        *NeighborCache;\r
+  EFI_STATUS          Status;\r
+  EFI_IPv6_ADDRESS    AllNodes;\r
+  IP6_NEIGHBOR_ENTRY  *NeighborCache;\r
+\r
+  IpSb->State = IP6_SERVICE_DESTROY;\r
+\r
+  if (IpSb->Timer != NULL) {\r
+    gBS->SetTimer (IpSb->Timer, TimerCancel, 0);\r
+    gBS->CloseEvent (IpSb->Timer);\r
+\r
+    IpSb->Timer = NULL;\r
+  }\r
+\r
+  if (IpSb->FasterTimer != NULL) {\r
+    gBS->SetTimer (IpSb->FasterTimer, TimerCancel, 0);\r
+    gBS->CloseEvent (IpSb->FasterTimer);\r
+\r
+    IpSb->FasterTimer = NULL;\r
+  }\r
 \r
   Ip6ConfigCleanInstance (&IpSb->Ip6ConfigInstance);\r
 \r
-  //\r
-  // Leave link-scope all-nodes multicast address (FF02::1)\r
-  //\r
-  Ip6SetToAllNodeMulticast (FALSE, IP6_LINK_LOCAL_SCOPE, &AllNodes);\r
+  if (!IpSb->LinkLocalDadFail) {\r
+    //\r
+    // Leave link-scope all-nodes multicast address (FF02::1)\r
+    //\r
+    Ip6SetToAllNodeMulticast (FALSE, IP6_LINK_LOCAL_SCOPE, &AllNodes);\r
 \r
-  Status = Ip6LeaveGroup (IpSb, &AllNodes);\r
-  if (EFI_ERROR (Status)) {\r
-    return Status;\r
+    Status = Ip6LeaveGroup (IpSb, &AllNodes);\r
+    if (EFI_ERROR (Status)) {\r
+      return Status;\r
+    }\r
   }\r
 \r
   if (IpSb->DefaultInterface != NULL) {\r
@@ -152,11 +208,11 @@ Ip6CleanService (
       IpSb->Mnp->Cancel (IpSb->Mnp, NULL);\r
       IpSb->Mnp->Configure (IpSb->Mnp, NULL);\r
       gBS->CloseProtocol (\r
-            IpSb->MnpChildHandle,\r
-            &gEfiManagedNetworkProtocolGuid,\r
-            IpSb->Image,\r
-            IpSb->Controller\r
-            );\r
+             IpSb->MnpChildHandle,\r
+             &gEfiManagedNetworkProtocolGuid,\r
+             IpSb->Image,\r
+             IpSb->Controller\r
+             );\r
 \r
       IpSb->Mnp = NULL;\r
     }\r
@@ -175,19 +231,6 @@ Ip6CleanService (
     gBS->CloseEvent (IpSb->RecvRequest.MnpToken.Event);\r
   }\r
 \r
-  if (IpSb->Timer != NULL) {\r
-    gBS->SetTimer (IpSb->Timer, TimerCancel, 0);\r
-    gBS->CloseEvent (IpSb->Timer);\r
-\r
-    IpSb->Timer = NULL;\r
-  }\r
-\r
-  if (IpSb->FasterTimer != NULL) {\r
-    gBS->SetTimer (IpSb->FasterTimer, TimerCancel, 0);\r
-    gBS->CloseEvent (IpSb->FasterTimer);\r
-\r
-    IpSb->FasterTimer = NULL;\r
-  }\r
   //\r
   // Free the Neighbor Discovery resources\r
   //\r
@@ -214,16 +257,15 @@ Ip6CleanService (
 **/\r
 EFI_STATUS\r
 Ip6CreateService (\r
-  IN  EFI_HANDLE            Controller,\r
-  IN  EFI_HANDLE            ImageHandle,\r
-  OUT IP6_SERVICE           **Service\r
+  IN  EFI_HANDLE   Controller,\r
+  IN  EFI_HANDLE   ImageHandle,\r
+  OUT IP6_SERVICE  **Service\r
   )\r
 {\r
   IP6_SERVICE                           *IpSb;\r
   EFI_STATUS                            Status;\r
   EFI_MANAGED_NETWORK_COMPLETION_TOKEN  *MnpToken;\r
   EFI_MANAGED_NETWORK_CONFIG_DATA       *Config;\r
-  IP6_CONFIG_DATA_ITEM                  *DataItem;\r
 \r
   ASSERT (Service != NULL);\r
 \r
@@ -244,62 +286,61 @@ Ip6CreateService (
   IpSb->ServiceBinding.CreateChild  = Ip6ServiceBindingCreateChild;\r
   IpSb->ServiceBinding.DestroyChild = Ip6ServiceBindingDestroyChild;\r
   IpSb->State                       = IP6_SERVICE_UNSTARTED;\r
-  IpSb->InDestroy                   = FALSE;\r
 \r
-  IpSb->NumChildren                 = 0;\r
+  IpSb->NumChildren = 0;\r
   InitializeListHead (&IpSb->Children);\r
 \r
   InitializeListHead (&IpSb->Interfaces);\r
-  IpSb->DefaultInterface            = NULL;\r
-  IpSb->RouteTable                  = NULL;\r
+  IpSb->DefaultInterface = NULL;\r
+  IpSb->RouteTable       = NULL;\r
 \r
-  IpSb->RecvRequest.Signature       = IP6_LINK_RX_SIGNATURE;\r
-  IpSb->RecvRequest.CallBack        = NULL;\r
-  IpSb->RecvRequest.Context         = NULL;\r
-  MnpToken                          = &IpSb->RecvRequest.MnpToken;\r
-  MnpToken->Event                   = NULL;\r
-  MnpToken->Status                  = EFI_NOT_READY;\r
-  MnpToken->Packet.RxData           = NULL;\r
+  IpSb->RecvRequest.Signature = IP6_LINK_RX_SIGNATURE;\r
+  IpSb->RecvRequest.CallBack  = NULL;\r
+  IpSb->RecvRequest.Context   = NULL;\r
+  MnpToken                    = &IpSb->RecvRequest.MnpToken;\r
+  MnpToken->Event             = NULL;\r
+  MnpToken->Status            = EFI_NOT_READY;\r
+  MnpToken->Packet.RxData     = NULL;\r
 \r
   Ip6CreateAssembleTable (&IpSb->Assemble);\r
 \r
-  IpSb->MldCtrl.Mldv1QuerySeen      = 0;\r
+  IpSb->MldCtrl.Mldv1QuerySeen = 0;\r
   InitializeListHead (&IpSb->MldCtrl.Groups);\r
 \r
   ZeroMem (&IpSb->LinkLocalAddr, sizeof (EFI_IPv6_ADDRESS));\r
-  IpSb->LinkLocalOk                 = FALSE;\r
-  IpSb->LinkLocalDadFail            = FALSE;\r
-  IpSb->Dhcp6NeedStart              = FALSE;\r
-  IpSb->Dhcp6NeedInfoRequest        = FALSE;\r
-\r
-  IpSb->CurHopLimit                 = IP6_HOP_LIMIT;\r
-  IpSb->LinkMTU                     = IP6_MIN_LINK_MTU;\r
-  IpSb->BaseReachableTime           = IP6_REACHABLE_TIME;\r
+  IpSb->LinkLocalOk          = FALSE;\r
+  IpSb->LinkLocalDadFail     = FALSE;\r
+  IpSb->Dhcp6NeedStart       = FALSE;\r
+  IpSb->Dhcp6NeedInfoRequest = FALSE;\r
+\r
+  IpSb->CurHopLimit       = IP6_HOP_LIMIT;\r
+  IpSb->LinkMTU           = IP6_MIN_LINK_MTU;\r
+  IpSb->BaseReachableTime = IP6_REACHABLE_TIME;\r
   Ip6UpdateReachableTime (IpSb);\r
   //\r
   // RFC4861 RETRANS_TIMER: 1,000 milliseconds\r
   //\r
-  IpSb->RetransTimer                = IP6_RETRANS_TIMER;\r
+  IpSb->RetransTimer = IP6_RETRANS_TIMER;\r
 \r
-  IpSb->RoundRobin                  = 0;\r
+  IpSb->RoundRobin = 0;\r
 \r
   InitializeListHead (&IpSb->NeighborTable);\r
   InitializeListHead (&IpSb->DefaultRouterList);\r
   InitializeListHead (&IpSb->OnlinkPrefix);\r
   InitializeListHead (&IpSb->AutonomousPrefix);\r
 \r
-  IpSb->InterfaceIdLen              = IP6_IF_ID_LEN;\r
-  IpSb->InterfaceId                 = NULL;\r
+  IpSb->InterfaceIdLen = IP6_IF_ID_LEN;\r
+  IpSb->InterfaceId    = NULL;\r
 \r
-  IpSb->RouterAdvertiseReceived     = FALSE;\r
-  IpSb->SolicitTimer                = IP6_MAX_RTR_SOLICITATIONS;\r
-  IpSb->Ticks                       = 0;\r
+  IpSb->RouterAdvertiseReceived = FALSE;\r
+  IpSb->SolicitTimer            = IP6_MAX_RTR_SOLICITATIONS;\r
+  IpSb->Ticks                   = 0;\r
 \r
-  IpSb->Image                       = ImageHandle;\r
-  IpSb->Controller                  = Controller;\r
+  IpSb->Image      = ImageHandle;\r
+  IpSb->Controller = Controller;\r
 \r
-  IpSb->MnpChildHandle              = NULL;\r
-  IpSb->Mnp                         = NULL;\r
+  IpSb->MnpChildHandle = NULL;\r
+  IpSb->Mnp            = NULL;\r
 \r
   Config                            = &IpSb->MnpConfigData;\r
   Config->ReceivedQueueTimeoutValue = 0;\r
@@ -315,12 +356,12 @@ Ip6CreateService (
 \r
   ZeroMem (&IpSb->SnpMode, sizeof (EFI_SIMPLE_NETWORK_MODE));\r
 \r
-  IpSb->Timer                       = NULL;\r
-  IpSb->FasterTimer                 = NULL;\r
+  IpSb->Timer       = NULL;\r
+  IpSb->FasterTimer = NULL;\r
 \r
   ZeroMem (&IpSb->Ip6ConfigInstance, sizeof (IP6_CONFIG_INSTANCE));\r
 \r
-  IpSb->MacString                   = NULL;\r
+  IpSb->MacString = NULL;\r
 \r
   //\r
   // Create various resources. First create the route table, timer\r
@@ -368,7 +409,7 @@ Ip6CreateService (
   Status = gBS->OpenProtocol (\r
                   IpSb->MnpChildHandle,\r
                   &gEfiManagedNetworkProtocolGuid,\r
-                  (VOID **) (&IpSb->Mnp),\r
+                  (VOID **)(&IpSb->Mnp),\r
                   ImageHandle,\r
                   Controller,\r
                   EFI_OPEN_PROTOCOL_BY_DRIVER\r
@@ -394,6 +435,7 @@ Ip6CreateService (
     //\r
     IpSb->MaxPacketSize -= NET_VLAN_TAG_LEN;\r
   }\r
+\r
   IpSb->OldMaxPacketSize = IpSb->MaxPacketSize;\r
 \r
   //\r
@@ -411,22 +453,21 @@ Ip6CreateService (
     goto ON_ERROR;\r
   }\r
 \r
-  //\r
-  // The timer expires every 100 (IP6_TIMER_INTERVAL_IN_MS) milliseconds.\r
-  //\r
-  Status = gBS->SetTimer (IpSb->FasterTimer, TimerPeriodic, TICKS_PER_MS * IP6_TIMER_INTERVAL_IN_MS);\r
+  Status = NetLibGetMacString (IpSb->Controller, IpSb->Image, &IpSb->MacString);\r
   if (EFI_ERROR (Status)) {\r
     goto ON_ERROR;\r
   }\r
 \r
-  //\r
-  // The timer expires every 1000 (IP6_ONE_SECOND_IN_MS) milliseconds.\r
-  //\r
-  Status = gBS->SetTimer (IpSb->Timer, TimerPeriodic, TICKS_PER_MS * IP6_ONE_SECOND_IN_MS);\r
+  Status = Ip6ConfigInitInstance (&IpSb->Ip6ConfigInstance);\r
   if (EFI_ERROR (Status)) {\r
     goto ON_ERROR;\r
   }\r
 \r
+  IpSb->DefaultInterface = Ip6CreateInterface (IpSb, TRUE);\r
+  if (IpSb->DefaultInterface == NULL) {\r
+    Status = EFI_DEVICE_ERROR;\r
+    goto ON_ERROR;\r
+  }\r
 \r
   Status = gBS->CreateEvent (\r
                   EVT_NOTIFY_SIGNAL,\r
@@ -439,39 +480,6 @@ Ip6CreateService (
     goto ON_ERROR;\r
   }\r
 \r
-  Status = Ip6ReceiveFrame (Ip6AcceptFrame, IpSb);\r
-  if (EFI_ERROR (Status)) {\r
-    goto ON_ERROR;\r
-  }\r
-\r
-  Status = NetLibGetMacString (IpSb->Controller, IpSb->Image, &IpSb->MacString);\r
-  if (EFI_ERROR (Status)) {\r
-    goto ON_ERROR;\r
-  }\r
-\r
-  Status = Ip6ConfigInitInstance (&IpSb->Ip6ConfigInstance);\r
-  if (EFI_ERROR (Status)) {\r
-    goto ON_ERROR;\r
-  }\r
-\r
-  IpSb->DefaultInterface = Ip6CreateInterface (IpSb, TRUE);\r
-  if (IpSb->DefaultInterface == NULL) {\r
-    Status = EFI_DEVICE_ERROR;\r
-    goto ON_ERROR;\r
-  }\r
-\r
-  //\r
-  // If there is any manual address, set it.\r
-  //\r
-  DataItem = &IpSb->Ip6ConfigInstance.DataItem[Ip6ConfigDataTypeManualAddress];\r
-  if (DataItem->Data.Ptr != NULL) {\r
-    DataItem->SetData (\r
-                &IpSb->Ip6ConfigInstance,\r
-                DataItem->DataSize,\r
-                DataItem->Data.Ptr\r
-                );\r
-  }\r
-\r
   InsertHeadList (&IpSb->Interfaces, &IpSb->DefaultInterface->Link);\r
 \r
   *Service = IpSb;\r
@@ -483,7 +491,6 @@ ON_ERROR:
   return Status;\r
 }\r
 \r
-\r
 /**\r
   Start this driver on ControllerHandle.\r
 \r
@@ -492,7 +499,7 @@ ON_ERROR:
   @param[in]  RemainingDevicePath Optional parameter used to pick a specific child\r
                                   device to start.\r
 \r
-  @retval EFI_SUCCES              This driver is added to ControllerHandle.\r
+  @retval EFI_SUCCESS             This driver is added to ControllerHandle.\r
   @retval EFI_ALREADY_STARTED     This driver is already running on ControllerHandle.\r
   @retval other                   This driver does not support this device.\r
 \r
@@ -505,8 +512,14 @@ Ip6DriverBindingStart (
   IN EFI_DEVICE_PATH_PROTOCOL     *RemainingDevicePath OPTIONAL\r
   )\r
 {\r
-  IP6_SERVICE               *IpSb;\r
-  EFI_STATUS                Status;\r
+  IP6_SERVICE              *IpSb;\r
+  EFI_STATUS               Status;\r
+  EFI_IP6_CONFIG_PROTOCOL  *Ip6Cfg;\r
+  IP6_CONFIG_DATA_ITEM     *DataItem;\r
+\r
+  IpSb     = NULL;\r
+  Ip6Cfg   = NULL;\r
+  DataItem = NULL;\r
 \r
   //\r
   // Test for the Ip6 service binding protocol\r
@@ -532,34 +545,175 @@ Ip6DriverBindingStart (
 \r
   ASSERT (IpSb != NULL);\r
 \r
+  Ip6Cfg = &IpSb->Ip6ConfigInstance.Ip6Config;\r
+\r
   //\r
-  // Install the Ip6ServiceBinding Protocol onto ControlerHandle\r
+  // Install the Ip6ServiceBinding Protocol onto ControllerHandle\r
   //\r
   Status = gBS->InstallMultipleProtocolInterfaces (\r
                   &ControllerHandle,\r
                   &gEfiIp6ServiceBindingProtocolGuid,\r
                   &IpSb->ServiceBinding,\r
                   &gEfiIp6ConfigProtocolGuid,\r
-                  &IpSb->Ip6ConfigInstance.Ip6Config,\r
+                  Ip6Cfg,\r
                   NULL\r
                   );\r
+  if (EFI_ERROR (Status)) {\r
+    goto FREE_SERVICE;\r
+  }\r
 \r
+  //\r
+  // Read the config data from NV variable again.\r
+  // The default data can be changed by other drivers.\r
+  //\r
+  Status = Ip6ConfigReadConfigData (IpSb->MacString, &IpSb->Ip6ConfigInstance);\r
   if (EFI_ERROR (Status)) {\r
+    goto UNINSTALL_PROTOCOL;\r
+  }\r
 \r
-    Ip6CleanService (IpSb);\r
-    FreePool (IpSb);\r
-  } else {\r
-    //\r
-    // Initialize the IP6 ID\r
-    //\r
-    mIp6Id = NET_RANDOM (NetRandomInitSeed ());\r
+  //\r
+  // If there is any default manual address, set it.\r
+  //\r
+  DataItem = &IpSb->Ip6ConfigInstance.DataItem[Ip6ConfigDataTypeManualAddress];\r
+  if (DataItem->Data.Ptr != NULL) {\r
+    Status = Ip6Cfg->SetData (\r
+                       Ip6Cfg,\r
+                       Ip6ConfigDataTypeManualAddress,\r
+                       DataItem->DataSize,\r
+                       DataItem->Data.Ptr\r
+                       );\r
+    if ((Status == EFI_INVALID_PARAMETER) || (Status == EFI_BAD_BUFFER_SIZE)) {\r
+      //\r
+      // Clean the invalid ManualAddress configuration.\r
+      //\r
+      Status = Ip6Cfg->SetData (\r
+                         Ip6Cfg,\r
+                         Ip6ConfigDataTypeManualAddress,\r
+                         0,\r
+                         NULL\r
+                         );\r
+      DEBUG ((DEBUG_WARN, "Ip6DriverBindingStart: Clean the invalid ManualAddress configuration.\n"));\r
+    }\r
+  }\r
 \r
-    Ip6SetVariableData (IpSb);\r
+  //\r
+  // If there is any default gateway address, set it.\r
+  //\r
+  DataItem = &IpSb->Ip6ConfigInstance.DataItem[Ip6ConfigDataTypeGateway];\r
+  if (DataItem->Data.Ptr != NULL) {\r
+    Status = Ip6Cfg->SetData (\r
+                       Ip6Cfg,\r
+                       Ip6ConfigDataTypeGateway,\r
+                       DataItem->DataSize,\r
+                       DataItem->Data.Ptr\r
+                       );\r
+    if ((Status == EFI_INVALID_PARAMETER) || (Status == EFI_BAD_BUFFER_SIZE)) {\r
+      //\r
+      // Clean the invalid Gateway configuration.\r
+      //\r
+      Status = Ip6Cfg->SetData (\r
+                         Ip6Cfg,\r
+                         Ip6ConfigDataTypeGateway,\r
+                         0,\r
+                         NULL\r
+                         );\r
+      DEBUG ((DEBUG_WARN, "Ip6DriverBindingStart: Clean the invalid Gateway configuration.\n"));\r
+    }\r
   }\r
 \r
+  //\r
+  // ready to go: start the receiving and timer\r
+  //\r
+  Status = Ip6ReceiveFrame (Ip6AcceptFrame, IpSb);\r
+  if (EFI_ERROR (Status)) {\r
+    goto UNINSTALL_PROTOCOL;\r
+  }\r
+\r
+  //\r
+  // The timer expires every 100 (IP6_TIMER_INTERVAL_IN_MS) milliseconds.\r
+  //\r
+  Status = gBS->SetTimer (\r
+                  IpSb->FasterTimer,\r
+                  TimerPeriodic,\r
+                  TICKS_PER_MS * IP6_TIMER_INTERVAL_IN_MS\r
+                  );\r
+  if (EFI_ERROR (Status)) {\r
+    goto UNINSTALL_PROTOCOL;\r
+  }\r
+\r
+  //\r
+  // The timer expires every 1000 (IP6_ONE_SECOND_IN_MS) milliseconds.\r
+  //\r
+  Status = gBS->SetTimer (\r
+                  IpSb->Timer,\r
+                  TimerPeriodic,\r
+                  TICKS_PER_MS * IP6_ONE_SECOND_IN_MS\r
+                  );\r
+  if (EFI_ERROR (Status)) {\r
+    goto UNINSTALL_PROTOCOL;\r
+  }\r
+\r
+  //\r
+  // Initialize the IP6 ID\r
+  //\r
+  mIp6Id = NET_RANDOM (NetRandomInitSeed ());\r
+\r
+  return EFI_SUCCESS;\r
+\r
+UNINSTALL_PROTOCOL:\r
+  gBS->UninstallMultipleProtocolInterfaces (\r
+         ControllerHandle,\r
+         &gEfiIp6ServiceBindingProtocolGuid,\r
+         &IpSb->ServiceBinding,\r
+         &gEfiIp6ConfigProtocolGuid,\r
+         Ip6Cfg,\r
+         NULL\r
+         );\r
+\r
+FREE_SERVICE:\r
+  Ip6CleanService (IpSb);\r
+  FreePool (IpSb);\r
   return Status;\r
 }\r
 \r
+/**\r
+  Callback function which provided by user to remove one node in NetDestroyLinkList process.\r
+\r
+  @param[in]    Entry           The entry to be removed.\r
+  @param[in]    Context         Pointer to the callback context corresponds to the Context in NetDestroyLinkList.\r
+\r
+  @retval EFI_SUCCESS           The entry has been removed successfully.\r
+  @retval Others                Fail to remove the entry.\r
+\r
+**/\r
+EFI_STATUS\r
+EFIAPI\r
+Ip6DestroyChildEntryInHandleBuffer (\r
+  IN LIST_ENTRY  *Entry,\r
+  IN VOID        *Context\r
+  )\r
+{\r
+  IP6_PROTOCOL                  *IpInstance;\r
+  EFI_SERVICE_BINDING_PROTOCOL  *ServiceBinding;\r
+  UINTN                         NumberOfChildren;\r
+  EFI_HANDLE                    *ChildHandleBuffer;\r
+\r
+  if ((Entry == NULL) || (Context == NULL)) {\r
+    return EFI_INVALID_PARAMETER;\r
+  }\r
+\r
+  IpInstance        = NET_LIST_USER_STRUCT_S (Entry, IP6_PROTOCOL, Link, IP6_PROTOCOL_SIGNATURE);\r
+  ServiceBinding    = ((IP6_DESTROY_CHILD_IN_HANDLE_BUF_CONTEXT *)Context)->ServiceBinding;\r
+  NumberOfChildren  = ((IP6_DESTROY_CHILD_IN_HANDLE_BUF_CONTEXT *)Context)->NumberOfChildren;\r
+  ChildHandleBuffer = ((IP6_DESTROY_CHILD_IN_HANDLE_BUF_CONTEXT *)Context)->ChildHandleBuffer;\r
+\r
+  if (!NetIsInHandleBuffer (IpInstance->Handle, NumberOfChildren, ChildHandleBuffer)) {\r
+    return EFI_SUCCESS;\r
+  }\r
+\r
+  return ServiceBinding->DestroyChild (ServiceBinding, IpInstance->Handle);\r
+}\r
+\r
 /**\r
   Stop this driver on ControllerHandle.\r
 \r
@@ -583,37 +737,30 @@ Ip6DriverBindingStop (
   IN  EFI_HANDLE                   *ChildHandleBuffer OPTIONAL\r
   )\r
 {\r
-  EFI_SERVICE_BINDING_PROTOCOL  *ServiceBinding;\r
-  IP6_SERVICE                   *IpSb;\r
-  IP6_PROTOCOL                  *IpInstance;\r
-  EFI_HANDLE                    NicHandle;\r
-  EFI_STATUS                    Status;\r
-  BOOLEAN                       IsDhcp6;\r
-  EFI_TPL                       OldTpl;\r
-  INTN                          State;\r
+  EFI_SERVICE_BINDING_PROTOCOL             *ServiceBinding;\r
+  IP6_SERVICE                              *IpSb;\r
+  EFI_HANDLE                               NicHandle;\r
+  EFI_STATUS                               Status;\r
+  LIST_ENTRY                               *List;\r
+  INTN                                     State;\r
+  BOOLEAN                                  IsDhcp6;\r
+  IP6_DESTROY_CHILD_IN_HANDLE_BUF_CONTEXT  Context;\r
 \r
   IsDhcp6   = FALSE;\r
-  NicHandle = NetLibGetNicHandle (ControllerHandle, &gEfiDhcp6ProtocolGuid);\r
-\r
-  if (NicHandle != NULL) {\r
-    //\r
-    // DriverBindingStop is triggered by the uninstallation of the EFI DHCPv6\r
-    // Protocol used by Ip6Config.\r
-    //\r
-    IsDhcp6 = TRUE;\r
-  } else {\r
-\r
-    NicHandle = NetLibGetNicHandle (ControllerHandle, &gEfiManagedNetworkProtocolGuid);\r
-\r
-    if (NicHandle == NULL) {\r
-      return EFI_DEVICE_ERROR;\r
+  NicHandle = NetLibGetNicHandle (ControllerHandle, &gEfiManagedNetworkProtocolGuid);\r
+  if (NicHandle == NULL) {\r
+    NicHandle = NetLibGetNicHandle (ControllerHandle, &gEfiDhcp6ProtocolGuid);\r
+    if (NicHandle != NULL) {\r
+      IsDhcp6 = TRUE;\r
+    } else {\r
+      return EFI_SUCCESS;\r
     }\r
   }\r
 \r
   Status = gBS->OpenProtocol (\r
                   NicHandle,\r
                   &gEfiIp6ServiceBindingProtocolGuid,\r
-                  (VOID **) &ServiceBinding,\r
+                  (VOID **)&ServiceBinding,\r
                   This->DriverBindingHandle,\r
                   NicHandle,\r
                   EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
@@ -624,29 +771,26 @@ Ip6DriverBindingStop (
 \r
   IpSb = IP6_SERVICE_FROM_PROTOCOL (ServiceBinding);\r
 \r
-  OldTpl = gBS->RaiseTPL (TPL_CALLBACK);\r
-\r
-  if (IpSb->InDestroy) {\r
-    Status = EFI_SUCCESS;\r
-    goto Exit;\r
-  }\r
-\r
   if (IsDhcp6) {\r
-\r
     Status = Ip6ConfigDestroyDhcp6 (&IpSb->Ip6ConfigInstance);\r
     gBS->CloseEvent (IpSb->Ip6ConfigInstance.Dhcp6Event);\r
     IpSb->Ip6ConfigInstance.Dhcp6Event = NULL;\r
-  } else if (NumberOfChildren == 0) {\r
-\r
-    IpSb->InDestroy = TRUE;\r
-    State           = IpSb->State;\r
-    IpSb->State     = IP6_SERVICE_DESTROY;\r
-\r
+  } else if (NumberOfChildren != 0) {\r
     //\r
-    // Clear the variable data.\r
+    // NumberOfChildren is not zero, destroy the IP6 children instances in ChildHandleBuffer.\r
     //\r
-    Ip6ClearVariableData (IpSb);\r
-\r
+    List                      = &IpSb->Children;\r
+    Context.ServiceBinding    = ServiceBinding;\r
+    Context.NumberOfChildren  = NumberOfChildren;\r
+    Context.ChildHandleBuffer = ChildHandleBuffer;\r
+    Status                    = NetDestroyLinkList (\r
+                                  List,\r
+                                  Ip6DestroyChildEntryInHandleBuffer,\r
+                                  &Context,\r
+                                  NULL\r
+                                  );\r
+  } else if (IsListEmpty (&IpSb->Children)) {\r
+    State  = IpSb->State;\r
     Status = Ip6CleanService (IpSb);\r
     if (EFI_ERROR (Status)) {\r
       IpSb->State = State;\r
@@ -663,28 +807,13 @@ Ip6DriverBindingStop (
                     );\r
     ASSERT_EFI_ERROR (Status);\r
     FreePool (IpSb);\r
-  } else {\r
-    //\r
-    // NumberOfChildren is not zero, destroy all IP6 children instances.\r
-    //\r
-    while (!IsListEmpty (&IpSb->Children)) {\r
-      IpInstance = NET_LIST_HEAD (&IpSb->Children, IP6_PROTOCOL, Link);\r
-      ServiceBinding->DestroyChild (ServiceBinding, IpInstance->Handle);\r
-    }\r
-\r
-    if (IpSb->NumChildren != 0) {\r
-      Status = EFI_DEVICE_ERROR;\r
-    }\r
+    Status = EFI_SUCCESS;\r
   }\r
 \r
 Exit:\r
-\r
-  gBS->RestoreTPL (OldTpl);\r
-\r
   return Status;\r
 }\r
 \r
-\r
 /**\r
   Creates a child handle with a set of I/O services.\r
 \r
@@ -694,8 +823,8 @@ Exit:
                                  is not NULL, then the I/O services are added to\r
                                  the existing child handle.\r
 \r
-  @retval EFI_SUCCES             The child handle was created with the I/O services.\r
-  @retval EFI_OUT_OF_RESOURCES   There are not enough resources availabe to create\r
+  @retval EFI_SUCCESS            The child handle was created with the I/O services.\r
+  @retval EFI_OUT_OF_RESOURCES   There are not enough resources available to create\r
                                  the child.\r
   @retval other                  The child handle was not created.\r
 \r
@@ -707,17 +836,17 @@ Ip6ServiceBindingCreateChild (
   IN EFI_HANDLE                    *ChildHandle\r
   )\r
 {\r
-  IP6_SERVICE               *IpSb;\r
-  IP6_PROTOCOL              *IpInstance;\r
-  EFI_TPL                   OldTpl;\r
-  EFI_STATUS                Status;\r
-  VOID                      *Mnp;\r
+  IP6_SERVICE   *IpSb;\r
+  IP6_PROTOCOL  *IpInstance;\r
+  EFI_TPL       OldTpl;\r
+  EFI_STATUS    Status;\r
+  VOID          *Mnp;\r
 \r
   if ((This == NULL) || (ChildHandle == NULL)) {\r
     return EFI_INVALID_PARAMETER;\r
   }\r
 \r
-  IpSb       = IP6_SERVICE_FROM_PROTOCOL (This);\r
+  IpSb = IP6_SERVICE_FROM_PROTOCOL (This);\r
 \r
   if (IpSb->LinkLocalDadFail) {\r
     return EFI_DEVICE_ERROR;\r
@@ -752,14 +881,14 @@ Ip6ServiceBindingCreateChild (
   Status = gBS->OpenProtocol (\r
                   IpSb->MnpChildHandle,\r
                   &gEfiManagedNetworkProtocolGuid,\r
-                  (VOID **) &Mnp,\r
+                  (VOID **)&Mnp,\r
                   gIp6DriverBinding.DriverBindingHandle,\r
                   IpInstance->Handle,\r
                   EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER\r
                   );\r
   if (EFI_ERROR (Status)) {\r
     gBS->UninstallMultipleProtocolInterfaces (\r
-           ChildHandle,\r
+           *ChildHandle,\r
            &gEfiIp6ProtocolGuid,\r
            &IpInstance->Ip6Proto,\r
            NULL\r
@@ -781,7 +910,6 @@ Ip6ServiceBindingCreateChild (
 ON_ERROR:\r
 \r
   if (EFI_ERROR (Status)) {\r
-\r
     Ip6CleanProtocol (IpInstance);\r
 \r
     FreePool (IpInstance);\r
@@ -796,7 +924,7 @@ ON_ERROR:
   @param[in]  This               Protocol instance pointer.\r
   @param[in]  ChildHandle        Handle of the child to destroy.\r
 \r
-  @retval EFI_SUCCES             The I/O services were removed from the child\r
+  @retval EFI_SUCCESS            The I/O services were removed from the child\r
                                  handle.\r
   @retval EFI_UNSUPPORTED        The child handle does not support the I/O services\r
                                   that are being removed.\r
@@ -813,12 +941,11 @@ Ip6ServiceBindingDestroyChild (
   IN EFI_HANDLE                    ChildHandle\r
   )\r
 {\r
-  EFI_STATUS                Status;\r
-  IP6_SERVICE               *IpSb;\r
-  IP6_PROTOCOL              *IpInstance;\r
-  EFI_IP6_PROTOCOL          *Ip6;\r
-  EFI_TPL                   OldTpl;\r
-  INTN                      State;\r
+  EFI_STATUS        Status;\r
+  IP6_SERVICE       *IpSb;\r
+  IP6_PROTOCOL      *IpInstance;\r
+  EFI_IP6_PROTOCOL  *Ip6;\r
+  EFI_TPL           OldTpl;\r
 \r
   if ((This == NULL) || (ChildHandle == NULL)) {\r
     return EFI_INVALID_PARAMETER;\r
@@ -827,12 +954,12 @@ Ip6ServiceBindingDestroyChild (
   //\r
   // Retrieve the private context data structures\r
   //\r
-  IpSb   = IP6_SERVICE_FROM_PROTOCOL (This);\r
+  IpSb = IP6_SERVICE_FROM_PROTOCOL (This);\r
 \r
   Status = gBS->OpenProtocol (\r
                   ChildHandle,\r
                   &gEfiIp6ProtocolGuid,\r
-                  (VOID **) &Ip6,\r
+                  (VOID **)&Ip6,\r
                   gIp6DriverBinding.DriverBindingHandle,\r
                   ChildHandle,\r
                   EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
@@ -856,13 +983,12 @@ Ip6ServiceBindingDestroyChild (
   // when UDP driver is being stopped, it will destroy all\r
   // the IP child it opens.\r
   //\r
-  if (IpInstance->State == IP6_STATE_DESTROY) {\r
+  if (IpInstance->InDestroy) {\r
     gBS->RestoreTPL (OldTpl);\r
     return EFI_SUCCESS;\r
   }\r
 \r
-  State             = IpInstance->State;\r
-  IpInstance->State = IP6_STATE_DESTROY;\r
+  IpInstance->InDestroy = TRUE;\r
 \r
   //\r
   // Close the Managed Network protocol.\r
@@ -878,30 +1004,28 @@ Ip6ServiceBindingDestroyChild (
   // Uninstall the IP6 protocol first. Many thing happens during\r
   // this:\r
   // 1. The consumer of the IP6 protocol will be stopped if it\r
-  // opens the protocol BY_DRIVER. For eaxmple, if MNP driver is\r
+  // opens the protocol BY_DRIVER. For example, if MNP driver is\r
   // stopped, IP driver's stop function will be called, and uninstall\r
   // EFI_IP6_PROTOCOL will trigger the UDP's stop function. This\r
   // makes it possible to create the network stack bottom up, and\r
   // stop it top down.\r
   // 2. the upper layer will recycle the received packet. The recycle\r
   // event's TPL is higher than this function. The recycle events\r
-  // will be called back before preceeding. If any packets not recycled,\r
+  // will be called back before preceding. If any packets not recycled,\r
   // that means there is a resource leak.\r
   //\r
+  gBS->RestoreTPL (OldTpl);\r
   Status = gBS->UninstallProtocolInterface (\r
                   ChildHandle,\r
                   &gEfiIp6ProtocolGuid,\r
                   &IpInstance->Ip6Proto\r
                   );\r
-\r
+  OldTpl = gBS->RaiseTPL (TPL_CALLBACK);\r
   if (EFI_ERROR (Status)) {\r
     goto ON_ERROR;\r
   }\r
 \r
   Status = Ip6CleanProtocol (IpInstance);\r
-\r
-  Ip6SetVariableData (IpSb);\r
-\r
   if (EFI_ERROR (Status)) {\r
     gBS->InstallMultipleProtocolInterfaces (\r
            &ChildHandle,\r
@@ -923,7 +1047,6 @@ Ip6ServiceBindingDestroyChild (
   return EFI_SUCCESS;\r
 \r
 ON_ERROR:\r
-  IpInstance->State = State;\r
   gBS->RestoreTPL (OldTpl);\r
 \r
   return Status;\r