[mirror_edk2.git] / NetworkPkg / Ip6Dxe / Ip6Driver.c

/** @file\r
  The driver binding and service binding protocol for IP6 driver.\r
\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
\r
**/\r
\r
#include "Ip6Impl.h"\r
\r
EFI_DRIVER_BINDING_PROTOCOL gIp6DriverBinding = {\r
  Ip6DriverBindingSupported,\r
  Ip6DriverBindingStart,\r
  Ip6DriverBindingStop,\r
  0xa,\r
  NULL,\r
  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
  // 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
  both device drivers and bus drivers.\r
\r
  The entry point for IP6 driver which installs the driver\r
  binding and component name protocol on its image.\r
\r
  @param[in]  ImageHandle           The firmware allocated handle for the UEFI image.\r
  @param[in]  SystemTable           A pointer to the EFI System Table.\r
\r
  @retval EFI_SUCCESS           The operation completed successfully.\r
  @retval EFI_OUT_OF_RESOURCES  The request could not be completed due to a lack of resources.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
Ip6DriverEntryPoint (\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
           &gIp6DriverBinding,\r
           ImageHandle,\r
           &gIp6ComponentName,\r
           &gIp6ComponentName2\r
           );\r
}\r
\r
/**\r
  Test to see if this driver supports ControllerHandle.\r
\r
  @param[in]  This                   Protocol instance pointer.\r
  @param[in]  ControllerHandle       Handle of device to test.\r
  @param[in]  RemainingDevicePath    Optional parameter use to pick a specific child\r
                                     device to start.\r
\r
  @retval EFI_SUCCESS                This driver supports this device.\r
  @retval EFI_ALREADY_STARTED        This driver is already running on this device.\r
  @retval other                      This driver does not support this device.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
Ip6DriverBindingSupported (\r
  IN EFI_DRIVER_BINDING_PROTOCOL  *This,\r
  IN EFI_HANDLE                   ControllerHandle,\r
  IN EFI_DEVICE_PATH_PROTOCOL     *RemainingDevicePath OPTIONAL\r
  )\r
{\r
  //\r
  // Test for the MNP service binding Protocol\r
  //\r
  return gBS->OpenProtocol (\r
                ControllerHandle,\r
                &gEfiManagedNetworkServiceBindingProtocolGuid,\r
                NULL,\r
                This->DriverBindingHandle,\r
                ControllerHandle,\r
                EFI_OPEN_PROTOCOL_TEST_PROTOCOL\r
                );\r
}\r
\r
/**\r
  Clean up an IP6 service binding instance. It releases all\r
  the resource allocated by the instance. The instance may be\r
  partly initialized, or partly destroyed. If a resource is\r
  destroyed, it is marked as that in case the destroy failed and\r
  being called again later.\r
\r
  @param[in]  IpSb               The IP6 service binding instance to clean up.\r
\r
  @retval EFI_SUCCESS            The resource used by the instance are cleaned up.\r
  @retval Others                 Failed to clean up some of the resources.\r
\r
**/\r
EFI_STATUS\r
Ip6CleanService (\r
  IN IP6_SERVICE            *IpSb\r
  )\r
{\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
  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
    }\r
  }\r
\r
  if (IpSb->DefaultInterface != NULL) {\r
    Ip6CleanInterface (IpSb->DefaultInterface, NULL);\r
    IpSb->DefaultInterface = NULL;\r
  }\r
\r
  Ip6CleanDefaultRouterList (IpSb);\r
\r
  Ip6CleanPrefixListTable (IpSb, &IpSb->OnlinkPrefix);\r
  Ip6CleanPrefixListTable (IpSb, &IpSb->AutonomousPrefix);\r
\r
  if (IpSb->RouteTable != NULL) {\r
    Ip6CleanRouteTable (IpSb->RouteTable);\r
    IpSb->RouteTable = NULL;\r
  }\r
\r
  if (IpSb->InterfaceId != NULL) {\r
    FreePool (IpSb->InterfaceId);\r
  }\r
\r
  IpSb->InterfaceId = NULL;\r
\r
  Ip6CleanAssembleTable (&IpSb->Assemble);\r
\r
  if (IpSb->MnpChildHandle != NULL) {\r
    if (IpSb->Mnp != NULL) {\r
      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
\r
      IpSb->Mnp = NULL;\r
    }\r
\r
    NetLibDestroyServiceChild (\r
      IpSb->Controller,\r
      IpSb->Image,\r
      &gEfiManagedNetworkServiceBindingProtocolGuid,\r
      IpSb->MnpChildHandle\r
      );\r
\r
    IpSb->MnpChildHandle = NULL;\r
  }\r
\r
  if (IpSb->RecvRequest.MnpToken.Event != NULL) {\r
    gBS->CloseEvent (IpSb->RecvRequest.MnpToken.Event);\r
  }\r
\r
  //\r
  // Free the Neighbor Discovery resources\r
  //\r
  while (!IsListEmpty (&IpSb->NeighborTable)) {\r
    NeighborCache = NET_LIST_HEAD (&IpSb->NeighborTable, IP6_NEIGHBOR_ENTRY, Link);\r
    Ip6FreeNeighborEntry (IpSb, NeighborCache, FALSE, TRUE, EFI_SUCCESS, NULL, NULL);\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Create a new IP6 driver service binding protocol.\r
\r
  @param[in]  Controller         The controller that has MNP service binding\r
                                 installed.\r
  @param[in]  ImageHandle        The IP6 driver's image handle.\r
  @param[out]  Service           The variable to receive the newly created IP6\r
                                 service.\r
\r
  @retval EFI_OUT_OF_RESOURCES   Failed to allocate some resources.\r
  @retval EFI_SUCCESS            A new IP6 service binding private is created.\r
\r
**/\r
EFI_STATUS\r
Ip6CreateService (\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
\r
  ASSERT (Service != NULL);\r
\r
  *Service = NULL;\r
\r
  //\r
  // allocate a service private data then initialize all the filed to\r
  // empty resources, so if any thing goes wrong when allocating\r
  // resources, Ip6CleanService can be called to clean it up.\r
  //\r
  IpSb = AllocateZeroPool (sizeof (IP6_SERVICE));\r
\r
  if (IpSb == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  IpSb->Signature                   = IP6_SERVICE_SIGNATURE;\r
  IpSb->ServiceBinding.CreateChild  = Ip6ServiceBindingCreateChild;\r
  IpSb->ServiceBinding.DestroyChild = Ip6ServiceBindingDestroyChild;\r
  IpSb->State                       = IP6_SERVICE_UNSTARTED;\r
\r
  IpSb->NumChildren                 = 0;\r
  InitializeListHead (&IpSb->Children);\r
\r
  InitializeListHead (&IpSb->Interfaces);\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
\r
  Ip6CreateAssembleTable (&IpSb->Assemble);\r
\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
  Ip6UpdateReachableTime (IpSb);\r
  //\r
  // RFC4861 RETRANS_TIMER: 1,000 milliseconds\r
  //\r
  IpSb->RetransTimer                = IP6_RETRANS_TIMER;\r
\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
\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
\r
  IpSb->MnpChildHandle              = NULL;\r
  IpSb->Mnp                         = NULL;\r
\r
  Config                            = &IpSb->MnpConfigData;\r
  Config->ReceivedQueueTimeoutValue = 0;\r
  Config->TransmitQueueTimeoutValue = 0;\r
  Config->ProtocolTypeFilter        = IP6_ETHER_PROTO;\r
  Config->EnableUnicastReceive      = TRUE;\r
  Config->EnableMulticastReceive    = TRUE;\r
  Config->EnableBroadcastReceive    = TRUE;\r
  Config->EnablePromiscuousReceive  = FALSE;\r
  Config->FlushQueuesOnReset        = TRUE;\r
  Config->EnableReceiveTimestamps   = FALSE;\r
  Config->DisableBackgroundPolling  = FALSE;\r
\r
  ZeroMem (&IpSb->SnpMode, sizeof (EFI_SIMPLE_NETWORK_MODE));\r
\r
  IpSb->Timer                       = NULL;\r
  IpSb->FasterTimer                 = NULL;\r
\r
  ZeroMem (&IpSb->Ip6ConfigInstance, sizeof (IP6_CONFIG_INSTANCE));\r
\r
  IpSb->MacString                   = NULL;\r
\r
  //\r
  // Create various resources. First create the route table, timer\r
  // event, MNP token event and MNP child.\r
  //\r
\r
  IpSb->RouteTable = Ip6CreateRouteTable ();\r
  if (IpSb->RouteTable == NULL) {\r
    Status = EFI_OUT_OF_RESOURCES;\r
    goto ON_ERROR;\r
  }\r
\r
  Status = gBS->CreateEvent (\r
                  EVT_NOTIFY_SIGNAL | EVT_TIMER,\r
                  TPL_CALLBACK,\r
                  Ip6TimerTicking,\r
                  IpSb,\r
                  &IpSb->Timer\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    goto ON_ERROR;\r
  }\r
\r
  Status = gBS->CreateEvent (\r
                  EVT_NOTIFY_SIGNAL | EVT_TIMER,\r
                  TPL_CALLBACK,\r
                  Ip6NdFasterTimerTicking,\r
                  IpSb,\r
                  &IpSb->FasterTimer\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    goto ON_ERROR;\r
  }\r
\r
  Status = NetLibCreateServiceChild (\r
             Controller,\r
             ImageHandle,\r
             &gEfiManagedNetworkServiceBindingProtocolGuid,\r
             &IpSb->MnpChildHandle\r
             );\r
  if (EFI_ERROR (Status)) {\r
    goto ON_ERROR;\r
  }\r
\r
  Status = gBS->OpenProtocol (\r
                  IpSb->MnpChildHandle,\r
                  &gEfiManagedNetworkProtocolGuid,\r
                  (VOID **) (&IpSb->Mnp),\r
                  ImageHandle,\r
                  Controller,\r
                  EFI_OPEN_PROTOCOL_BY_DRIVER\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    goto ON_ERROR;\r
  }\r
\r
  Status = Ip6ServiceConfigMnp (IpSb, TRUE);\r
  if (EFI_ERROR (Status)) {\r
    goto ON_ERROR;\r
  }\r
\r
  Status = IpSb->Mnp->GetModeData (IpSb->Mnp, NULL, &IpSb->SnpMode);\r
  if (EFI_ERROR (Status)) {\r
    goto ON_ERROR;\r
  }\r
\r
  IpSb->MaxPacketSize = IP6_MIN_LINK_MTU - sizeof (EFI_IP6_HEADER);\r
  if (NetLibGetVlanId (IpSb->Controller) != 0) {\r
    //\r
    // This is a VLAN device, reduce MTU by VLAN tag length\r
    //\r
    IpSb->MaxPacketSize -= NET_VLAN_TAG_LEN;\r
  }\r
  IpSb->OldMaxPacketSize = IpSb->MaxPacketSize;\r
\r
  //\r
  // Currently only ETHERNET is supported in IPv6 stack, since\r
  // link local address requires an IEEE 802 48-bit MACs for\r
  // EUI-64 format interface identifier mapping.\r
  //\r
  if (IpSb->SnpMode.IfType != NET_IFTYPE_ETHERNET) {\r
    Status = EFI_UNSUPPORTED;\r
    goto ON_ERROR;\r
  }\r
\r
  Status = Ip6InitMld (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
  Status = gBS->CreateEvent (\r
                  EVT_NOTIFY_SIGNAL,\r
                  TPL_NOTIFY,\r
                  Ip6OnFrameReceived,\r
                  &IpSb->RecvRequest,\r
                  &MnpToken->Event\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    goto ON_ERROR;\r
  }\r
\r
  InsertHeadList (&IpSb->Interfaces, &IpSb->DefaultInterface->Link);\r
\r
  *Service = IpSb;\r
  return EFI_SUCCESS;\r
\r
ON_ERROR:\r
  Ip6CleanService (IpSb);\r
  FreePool (IpSb);\r
  return Status;\r
}\r
\r
\r
/**\r
  Start this driver on ControllerHandle.\r
\r
  @param[in]  This                Protocol instance pointer.\r
  @param[in]  ControllerHandle    Handle of device to bind driver to.\r
  @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_ALREADY_STARTED     This driver is already running on ControllerHandle.\r
  @retval other                   This driver does not support this device.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
Ip6DriverBindingStart (\r
  IN EFI_DRIVER_BINDING_PROTOCOL  *This,\r
  IN EFI_HANDLE                   ControllerHandle,\r
  IN EFI_DEVICE_PATH_PROTOCOL     *RemainingDevicePath OPTIONAL\r
  )\r
{\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
  //\r
  Status = gBS->OpenProtocol (\r
                  ControllerHandle,\r
                  &gEfiIp6ServiceBindingProtocolGuid,\r
                  NULL,\r
                  This->DriverBindingHandle,\r
                  ControllerHandle,\r
                  EFI_OPEN_PROTOCOL_TEST_PROTOCOL\r
                  );\r
\r
  if (Status == EFI_SUCCESS) {\r
    return EFI_ALREADY_STARTED;\r
  }\r
\r
  Status = Ip6CreateService (ControllerHandle, This->DriverBindingHandle, &IpSb);\r
\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  ASSERT (IpSb != NULL);\r
\r
  Ip6Cfg  = &IpSb->Ip6ConfigInstance.Ip6Config;\r
\r
  //\r
  // Install the Ip6ServiceBinding Protocol onto ControlerHandle\r
  //\r
  Status = gBS->InstallMultipleProtocolInterfaces (\r
                  &ControllerHandle,\r
                  &gEfiIp6ServiceBindingProtocolGuid,\r
                  &IpSb->ServiceBinding,\r
                  &gEfiIp6ConfigProtocolGuid,\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
  //\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 ((EFI_D_WARN, "Ip6DriverBindingStart: Clean the invalid ManualAddress configuration.\n"));\r
    }\r
  }\r
\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 ((EFI_D_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
  @param[in]  This               Protocol instance pointer.\r
  @param[in]  ControllerHandle   Handle of device to stop driver on.\r
  @param[in]  NumberOfChildren   Number of Handles in ChildHandleBuffer. If number\r
                                 of children is zero, stop the entire  bus driver.\r
  @param[in]  ChildHandleBuffer  An array of child handles to be freed. May be NULL\r
                                 if NumberOfChildren is 0.\r
\r
  @retval EFI_SUCCESS           The device was stopped.\r
  @retval EFI_DEVICE_ERROR      The device could not be stopped due to a device error.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
Ip6DriverBindingStop (\r
  IN  EFI_DRIVER_BINDING_PROTOCOL  *This,\r
  IN  EFI_HANDLE                   ControllerHandle,\r
  IN  UINTN                        NumberOfChildren,\r
  IN  EFI_HANDLE                   *ChildHandleBuffer OPTIONAL\r
  )\r
{\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, &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
                  This->DriverBindingHandle,\r
                  NicHandle,\r
                  EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    return EFI_DEVICE_ERROR;\r
  }\r
\r
  IpSb = IP6_SERVICE_FROM_PROTOCOL (ServiceBinding);\r
\r
  if (IsDhcp6) {\r
    Status = Ip6ConfigDestroyDhcp6 (&IpSb->Ip6ConfigInstance);\r
    gBS->CloseEvent (IpSb->Ip6ConfigInstance.Dhcp6Event);\r
    IpSb->Ip6ConfigInstance.Dhcp6Event = NULL;\r
  } else if (NumberOfChildren != 0) {\r
    //\r
    // NumberOfChildren is not zero, destroy the IP6 children instances in ChildHandleBuffer.\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
      goto Exit;\r
    }\r
\r
    Status = gBS->UninstallMultipleProtocolInterfaces (\r
                    NicHandle,\r
                    &gEfiIp6ServiceBindingProtocolGuid,\r
                    ServiceBinding,\r
                    &gEfiIp6ConfigProtocolGuid,\r
                    &IpSb->Ip6ConfigInstance.Ip6Config,\r
                    NULL\r
                    );\r
    ASSERT_EFI_ERROR (Status);\r
    FreePool (IpSb);\r
    Status = EFI_SUCCESS;\r
  }\r
\r
Exit:\r
  return Status;\r
}\r
\r
\r
/**\r
  Creates a child handle with a set of I/O services.\r
\r
  @param[in]  This               Protocol instance pointer.\r
  @param[in]  ChildHandle        Pointer to the handle of the child to create.   If\r
                                 it is NULL, then a new handle is created.   If it\r
                                 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 available to create\r
                                 the child.\r
  @retval other                  The child handle was not created.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
Ip6ServiceBindingCreateChild (\r
  IN EFI_SERVICE_BINDING_PROTOCOL  *This,\r
  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
\r
  if ((This == NULL) || (ChildHandle == NULL)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  IpSb       = IP6_SERVICE_FROM_PROTOCOL (This);\r
\r
  if (IpSb->LinkLocalDadFail) {\r
    return EFI_DEVICE_ERROR;\r
  }\r
\r
  IpInstance = AllocatePool (sizeof (IP6_PROTOCOL));\r
\r
  if (IpInstance == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  Ip6InitProtocol (IpSb, IpInstance);\r
\r
  //\r
  // Install Ip6 onto ChildHandle\r
  //\r
  Status = gBS->InstallMultipleProtocolInterfaces (\r
                  ChildHandle,\r
                  &gEfiIp6ProtocolGuid,\r
                  &IpInstance->Ip6Proto,\r
                  NULL\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    goto ON_ERROR;\r
  }\r
\r
  IpInstance->Handle = *ChildHandle;\r
\r
  //\r
  // Open the Managed Network protocol BY_CHILD.\r
  //\r
  Status = gBS->OpenProtocol (\r
                  IpSb->MnpChildHandle,\r
                  &gEfiManagedNetworkProtocolGuid,\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
           &gEfiIp6ProtocolGuid,\r
           &IpInstance->Ip6Proto,\r
           NULL\r
           );\r
\r
    goto ON_ERROR;\r
  }\r
\r
  //\r
  // Insert it into the service binding instance.\r
  //\r
  OldTpl = gBS->RaiseTPL (TPL_CALLBACK);\r
\r
  InsertTailList (&IpSb->Children, &IpInstance->Link);\r
  IpSb->NumChildren++;\r
\r
  gBS->RestoreTPL (OldTpl);\r
\r
ON_ERROR:\r
\r
  if (EFI_ERROR (Status)) {\r
\r
    Ip6CleanProtocol (IpInstance);\r
\r
    FreePool (IpInstance);\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Destroys a child handle with a set of I/O services.\r
\r
  @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
                                 handle.\r
  @retval EFI_UNSUPPORTED        The child handle does not support the I/O services\r
                                  that are being removed.\r
  @retval EFI_INVALID_PARAMETER  Child handle is NULL.\r
  @retval EFI_ACCESS_DENIED      The child handle could not be destroyed because\r
                                 its I/O services are being used.\r
  @retval other                  The child handle was not destroyed.\r
\r
**/\r
EFI_STATUS\r
EFIAPI\r
Ip6ServiceBindingDestroyChild (\r
  IN EFI_SERVICE_BINDING_PROTOCOL  *This,\r
  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
\r
  if ((This == NULL) || (ChildHandle == NULL)) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  //\r
  // Retrieve the private context data structures\r
  //\r
  IpSb   = IP6_SERVICE_FROM_PROTOCOL (This);\r
\r
  Status = gBS->OpenProtocol (\r
                  ChildHandle,\r
                  &gEfiIp6ProtocolGuid,\r
                  (VOID **) &Ip6,\r
                  gIp6DriverBinding.DriverBindingHandle,\r
                  ChildHandle,\r
                  EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
                  );\r
\r
  if (EFI_ERROR (Status)) {\r
    return EFI_UNSUPPORTED;\r
  }\r
\r
  IpInstance = IP6_INSTANCE_FROM_PROTOCOL (Ip6);\r
\r
  if (IpInstance->Service != IpSb) {\r
    return EFI_INVALID_PARAMETER;\r
  }\r
\r
  OldTpl = gBS->RaiseTPL (TPL_CALLBACK);\r
\r
  //\r
  // A child can be destroyed more than once. For example,\r
  // Ip6DriverBindingStop will destroy all of its children.\r
  // when UDP driver is being stopped, it will destroy all\r
  // the IP child it opens.\r
  //\r
  if (IpInstance->InDestroy) {\r
    gBS->RestoreTPL (OldTpl);\r
    return EFI_SUCCESS;\r
  }\r
\r
  IpInstance->InDestroy = TRUE;\r
\r
  //\r
  // Close the Managed Network protocol.\r
  //\r
  gBS->CloseProtocol (\r
         IpSb->MnpChildHandle,\r
         &gEfiManagedNetworkProtocolGuid,\r
         gIp6DriverBinding.DriverBindingHandle,\r
         ChildHandle\r
         );\r
\r
  //\r
  // 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
  // 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
  // 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
  OldTpl = gBS->RaiseTPL (TPL_CALLBACK);\r
  if (EFI_ERROR (Status)) {\r
    goto ON_ERROR;\r
  }\r
\r
  Status = Ip6CleanProtocol (IpInstance);\r
  if (EFI_ERROR (Status)) {\r
    gBS->InstallMultipleProtocolInterfaces (\r
           &ChildHandle,\r
           &gEfiIp6ProtocolGuid,\r
           Ip6,\r
           NULL\r
           );\r
\r
    goto ON_ERROR;\r
  }\r
\r
  RemoveEntryList (&IpInstance->Link);\r
  ASSERT (IpSb->NumChildren > 0);\r
  IpSb->NumChildren--;\r
\r
  gBS->RestoreTPL (OldTpl);\r
\r
  FreePool (IpInstance);\r
  return EFI_SUCCESS;\r
\r
ON_ERROR:\r
  gBS->RestoreTPL (OldTpl);\r
\r
  return Status;\r
}\r