[mirror_edk2.git] / ShellPkg / Library / UefiShellNetwork1CommandsLib / Ping.c

/** @file\r
  The implementation for Ping shell command.\r
\r
  (C) Copyright 2015 Hewlett-Packard Development Company, L.P.<BR>\r
  Copyright (c) 2009 - 2018, Intel Corporation. All rights reserved.<BR>\r
  (C) Copyright 2016 Hewlett Packard Enterprise Development LP<BR>\r
\r
  SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
\r
#include "UefiShellNetwork1CommandsLib.h"\r
\r
#define PING_IP4_COPY_ADDRESS(Dest, Src)  (CopyMem ((Dest), (Src), sizeof (EFI_IPv4_ADDRESS)))\r
\r
UINT64  mCurrentTick = 0;\r
\r
//\r
// Function templates to match the IPv4 and IPv6 commands that we use.\r
//\r
typedef\r
EFI_STATUS\r
(EFIAPI *PING_IPX_POLL)(\r
  IN VOID          *This\r
  );\r
\r
typedef\r
EFI_STATUS\r
(EFIAPI *PING_IPX_TRANSMIT)(\r
  IN VOID          *This,\r
  IN VOID          *Token\r
  );\r
\r
typedef\r
EFI_STATUS\r
(EFIAPI *PING_IPX_RECEIVE)(\r
  IN VOID          *This,\r
  IN VOID          *Token\r
  );\r
\r
typedef\r
EFI_STATUS\r
(EFIAPI *PING_IPX_CANCEL)(\r
  IN VOID          *This,\r
  IN VOID          *Token OPTIONAL\r
  );\r
\r
///\r
/// A set of pointers to either IPv6 or IPv4 functions.\r
/// Unknown which one to the ping command.\r
///\r
typedef struct {\r
  PING_IPX_TRANSMIT    Transmit;\r
  PING_IPX_RECEIVE     Receive;\r
  PING_IPX_CANCEL      Cancel;\r
  PING_IPX_POLL        Poll;\r
} PING_IPX_PROTOCOL;\r
\r
typedef union {\r
  VOID    *RxData;\r
  VOID    *TxData;\r
} PING_PACKET;\r
\r
//\r
// PING_IPX_COMPLETION_TOKEN\r
// structures are used for both transmit and receive operations.\r
// This version is IP-unaware.\r
//\r
typedef struct {\r
  EFI_EVENT      Event;\r
  EFI_STATUS     Status;\r
  PING_PACKET    Packet;\r
} PING_IPX_COMPLETION_TOKEN;\r
\r
#pragma pack(1)\r
typedef struct _ICMPX_ECHO_REQUEST_REPLY {\r
  UINT8     Type;\r
  UINT8     Code;\r
  UINT16    Checksum;\r
  UINT16    Identifier;\r
  UINT16    SequenceNum;\r
  UINT32    TimeStamp;\r
  UINT8     Data[1];\r
} ICMPX_ECHO_REQUEST_REPLY;\r
#pragma pack()\r
\r
typedef struct _PING_ICMP_TX_INFO {\r
  LIST_ENTRY                   Link;\r
  UINT16                       SequenceNum;\r
  UINT32                       TimeStamp;\r
  PING_IPX_COMPLETION_TOKEN    *Token;\r
} PING_ICMPX_TX_INFO;\r
\r
#define DEFAULT_TIMEOUT       5000\r
#define MAX_SEND_NUMBER       10000\r
#define MAX_BUFFER_SIZE       32768\r
#define DEFAULT_TIMER_PERIOD  358049\r
#define ONE_SECOND            10000000\r
#define PING_IP_CHOICE_IP4    1\r
#define PING_IP_CHOICE_IP6    2\r
#define DEFAULT_SEND_COUNT    10\r
#define DEFAULT_BUFFER_SIZE   16\r
#define ICMP_V4_ECHO_REQUEST  0x8\r
#define ICMP_V4_ECHO_REPLY    0x0\r
#define STALL_1_MILLI_SECOND  1000\r
\r
#define PING_PRIVATE_DATA_SIGNATURE  SIGNATURE_32 ('P', 'i', 'n', 'g')\r
typedef struct _PING_PRIVATE_DATA {\r
  UINT32                       Signature;\r
  EFI_HANDLE                   NicHandle;\r
  EFI_HANDLE                   IpChildHandle;\r
  EFI_EVENT                    Timer;\r
\r
  UINT32                       TimerPeriod;\r
  UINT32                       RttTimerTick;\r
  EFI_EVENT                    RttTimer;\r
\r
  EFI_STATUS                   Status;\r
  LIST_ENTRY                   TxList;\r
  UINT16                       RxCount;\r
  UINT16                       TxCount;\r
  UINT64                       RttSum;\r
  UINT64                       RttMin;\r
  UINT64                       RttMax;\r
  UINT32                       SequenceNum;\r
\r
  UINT32                       SendNum;\r
  UINT32                       BufferSize;\r
  UINT32                       IpChoice;\r
\r
  PING_IPX_PROTOCOL            ProtocolPointers;\r
  VOID                         *IpProtocol;\r
  UINT8                        SrcAddress[MAX (sizeof (EFI_IPv6_ADDRESS), sizeof (EFI_IPv4_ADDRESS))];\r
  UINT8                        DstAddress[MAX (sizeof (EFI_IPv6_ADDRESS), sizeof (EFI_IPv4_ADDRESS))];\r
  PING_IPX_COMPLETION_TOKEN    RxToken;\r
  UINT16                       FailedCount;\r
} PING_PRIVATE_DATA;\r
\r
/**\r
  Calculate the internet checksum (see RFC 1071).\r
\r
  @param[in] Packet  Buffer which contains the data to be checksummed.\r
  @param[in] Length  Length to be checksummed.\r
\r
  @retval Checksum     Returns the 16 bit ones complement of\r
                       ones complement sum of 16 bit words\r
**/\r
UINT16\r
NetChecksum (\r
  IN UINT8   *Buffer,\r
  IN UINT32  Length\r
  )\r
{\r
  UINT32  Sum;\r
  UINT8   Odd;\r
  UINT16  *Packet;\r
\r
  Packet = (UINT16 *)Buffer;\r
\r
  Sum      = 0;\r
  Odd      = (UINT8)(Length & 1);\r
  Length >>= 1;\r
  while ((Length--) != 0) {\r
    Sum += *Packet++;\r
  }\r
\r
  if (Odd != 0) {\r
    Sum += *(UINT8 *)Packet;\r
  }\r
\r
  Sum = (Sum & 0xffff) + (Sum >> 16);\r
\r
  //\r
  // in case above carried\r
  //\r
  Sum += Sum >> 16;\r
\r
  return (UINT16)Sum;\r
}\r
\r
/**\r
  Reads and returns the current value of register.\r
  In IA64, the register is the Interval Timer Vector (ITV).\r
  In X86(IA32/X64), the register is the Time Stamp Counter (TSC)\r
\r
  @return The current value of the register.\r
\r
**/\r
\r
STATIC CONST SHELL_PARAM_ITEM  PingParamList[] = {\r
  {\r
    L"-l",\r
    TypeValue\r
  },\r
  {\r
    L"-n",\r
    TypeValue\r
  },\r
  {\r
    L"-s",\r
    TypeValue\r
  },\r
  {\r
    L"-_s",\r
    TypeValue\r
  },\r
  {\r
    L"-_ip6",\r
    TypeFlag\r
  },\r
  {\r
    NULL,\r
    TypeMax\r
  },\r
};\r
\r
//\r
// Global Variables in Ping command.\r
//\r
STATIC CONST CHAR16  *mDstString;\r
STATIC CONST CHAR16  *mSrcString;\r
\r
/**\r
  RTT timer tick routine.\r
\r
  @param[in]    Event    A EFI_EVENT type event.\r
  @param[in]    Context  The pointer to Context.\r
\r
**/\r
VOID\r
EFIAPI\r
RttTimerTickRoutine (\r
  IN EFI_EVENT  Event,\r
  IN VOID       *Context\r
  )\r
{\r
  UINT32  *RttTimerTick;\r
\r
  RttTimerTick = (UINT32 *)Context;\r
  (*RttTimerTick)++;\r
}\r
\r
/**\r
  Get the timer period of the system.\r
\r
  This function tries to get the system timer period by creating\r
  an 1ms period timer.\r
\r
  @return     System timer period in MS, or 0 if operation failed.\r
\r
**/\r
UINT32\r
GetTimerPeriod (\r
  VOID\r
  )\r
{\r
  EFI_STATUS  Status;\r
  UINT32      RttTimerTick;\r
  EFI_EVENT   TimerEvent;\r
  UINT32      StallCounter;\r
  EFI_TPL     OldTpl;\r
  UINT32      TimerPeriod;\r
\r
  RttTimerTick = 0;\r
  StallCounter = 0;\r
  TimerPeriod  = 0;\r
\r
  Status = gBS->CreateEvent (\r
                  EVT_TIMER | EVT_NOTIFY_SIGNAL,\r
                  TPL_NOTIFY,\r
                  RttTimerTickRoutine,\r
                  &RttTimerTick,\r
                  &TimerEvent\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    return 0;\r
  }\r
\r
  OldTpl = gBS->RaiseTPL (TPL_CALLBACK);\r
  Status = gBS->SetTimer (\r
                  TimerEvent,\r
                  TimerPeriodic,\r
                  TICKS_PER_MS\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    gBS->CloseEvent (TimerEvent);\r
    return 0;\r
  }\r
\r
  while (RttTimerTick < 10) {\r
    gBS->Stall (STALL_1_MILLI_SECOND);\r
    ++StallCounter;\r
  }\r
\r
  gBS->RestoreTPL (OldTpl);\r
\r
  gBS->SetTimer (TimerEvent, TimerCancel, 0);\r
  gBS->CloseEvent (TimerEvent);\r
\r
  TimerPeriod = StallCounter / RttTimerTick;\r
  if (TimerPeriod != 0) {\r
    return TimerPeriod;\r
  } else {\r
    return 1;\r
  }\r
}\r
\r
/**\r
  Initialize the timer event for RTT (round trip time).\r
\r
  @param[in]    Private    The pointer to PING_PRIVATE_DATA.\r
\r
  @retval EFI_SUCCESS      RTT timer is started.\r
  @retval Others           Failed to start the RTT timer.\r
\r
**/\r
EFI_STATUS\r
PingInitRttTimer (\r
  PING_PRIVATE_DATA  *Private\r
  )\r
{\r
  EFI_STATUS  Status;\r
\r
  Private->TimerPeriod = GetTimerPeriod ();\r
  if (Private->TimerPeriod == 0) {\r
    return EFI_ABORTED;\r
  }\r
\r
  Private->RttTimerTick = 0;\r
  Status                = gBS->CreateEvent (\r
                                 EVT_TIMER | EVT_NOTIFY_SIGNAL,\r
                                 TPL_NOTIFY,\r
                                 RttTimerTickRoutine,\r
                                 &Private->RttTimerTick,\r
                                 &Private->RttTimer\r
                                 );\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  Status = gBS->SetTimer (\r
                  Private->RttTimer,\r
                  TimerPeriodic,\r
                  TICKS_PER_MS\r
                  );\r
  if (EFI_ERROR (Status)) {\r
    gBS->CloseEvent (Private->RttTimer);\r
    return Status;\r
  }\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Free RTT timer event resource.\r
\r
  @param[in]    Private    The pointer to PING_PRIVATE_DATA.\r
\r
**/\r
VOID\r
PingFreeRttTimer (\r
  PING_PRIVATE_DATA  *Private\r
  )\r
{\r
  if (Private->RttTimer != NULL) {\r
    gBS->SetTimer (Private->RttTimer, TimerCancel, 0);\r
    gBS->CloseEvent (Private->RttTimer);\r
  }\r
}\r
\r
/**\r
  Read the current time.\r
\r
  @param[in]    Private    The pointer to PING_PRIVATE_DATA.\r
\r
  @retval the current tick value.\r
**/\r
UINT32\r
ReadTime (\r
  PING_PRIVATE_DATA  *Private\r
  )\r
{\r
  return Private->RttTimerTick;\r
}\r
\r
/**\r
  Calculate a duration in ms.\r
\r
  @param[in]    Private   The pointer to PING_PRIVATE_DATA.\r
  @param[in]    Begin     The start point of time.\r
  @param[in]    End       The end point of time.\r
\r
  @return               The duration in ms.\r
  @retval 0             The parameters were not valid.\r
**/\r
UINT32\r
CalculateTick (\r
  PING_PRIVATE_DATA  *Private,\r
  IN UINT32          Begin,\r
  IN UINT32          End\r
  )\r
{\r
  if (End < Begin) {\r
    return (0);\r
  }\r
\r
  return (End - Begin) * Private->TimerPeriod;\r
}\r
\r
/**\r
  Destroy PING_ICMPX_TX_INFO, and recollect the memory.\r
\r
  @param[in]    TxInfo    The pointer to PING_ICMPX_TX_INFO.\r
  @param[in]    IpChoice  Whether the token is IPv4 or IPv6\r
**/\r
VOID\r
PingDestroyTxInfo (\r
  IN PING_ICMPX_TX_INFO  *TxInfo,\r
  IN UINT32              IpChoice\r
  )\r
{\r
  EFI_IP6_TRANSMIT_DATA  *Ip6TxData;\r
  EFI_IP4_TRANSMIT_DATA  *Ip4TxData;\r
  EFI_IP6_FRAGMENT_DATA  *FragData;\r
  UINTN                  Index;\r
\r
  if (TxInfo == NULL) {\r
    return;\r
  }\r
\r
  if (TxInfo->Token != NULL) {\r
    if (TxInfo->Token->Event != NULL) {\r
      gBS->CloseEvent (TxInfo->Token->Event);\r
    }\r
\r
    if (TxInfo->Token->Packet.TxData != NULL) {\r
      if (IpChoice == PING_IP_CHOICE_IP6) {\r
        Ip6TxData = TxInfo->Token->Packet.TxData;\r
\r
        if (Ip6TxData->OverrideData != NULL) {\r
          FreePool (Ip6TxData->OverrideData);\r
        }\r
\r
        if (Ip6TxData->ExtHdrs != NULL) {\r
          FreePool (Ip6TxData->ExtHdrs);\r
        }\r
\r
        for (Index = 0; Index < Ip6TxData->FragmentCount; Index++) {\r
          FragData = Ip6TxData->FragmentTable[Index].FragmentBuffer;\r
          if (FragData != NULL) {\r
            FreePool (FragData);\r
          }\r
        }\r
      } else {\r
        Ip4TxData = TxInfo->Token->Packet.TxData;\r
\r
        if (Ip4TxData->OverrideData != NULL) {\r
          FreePool (Ip4TxData->OverrideData);\r
        }\r
\r
        for (Index = 0; Index < Ip4TxData->FragmentCount; Index++) {\r
          FragData = Ip4TxData->FragmentTable[Index].FragmentBuffer;\r
          if (FragData != NULL) {\r
            FreePool (FragData);\r
          }\r
        }\r
      }\r
    }\r
\r
    FreePool (TxInfo->Token);\r
  }\r
\r
  FreePool (TxInfo);\r
}\r
\r
/**\r
  Match the request, and reply with SequenceNum/TimeStamp.\r
\r
  @param[in]    Private    The pointer to PING_PRIVATE_DATA.\r
  @param[in]    Packet     The pointer to ICMPX_ECHO_REQUEST_REPLY.\r
\r
  @retval EFI_SUCCESS      The match is successful.\r
  @retval EFI_NOT_FOUND    The reply can't be matched with any request.\r
\r
**/\r
EFI_STATUS\r
Ping6MatchEchoReply (\r
  IN PING_PRIVATE_DATA         *Private,\r
  IN ICMPX_ECHO_REQUEST_REPLY  *Packet\r
  )\r
{\r
  PING_ICMPX_TX_INFO  *TxInfo;\r
  LIST_ENTRY          *Entry;\r
  LIST_ENTRY          *NextEntry;\r
\r
  NET_LIST_FOR_EACH_SAFE (Entry, NextEntry, &Private->TxList) {\r
    TxInfo = BASE_CR (Entry, PING_ICMPX_TX_INFO, Link);\r
\r
    if ((TxInfo->SequenceNum == Packet->SequenceNum) && (TxInfo->TimeStamp == Packet->TimeStamp)) {\r
      Private->RxCount++;\r
      RemoveEntryList (&TxInfo->Link);\r
      PingDestroyTxInfo (TxInfo, Private->IpChoice);\r
      return EFI_SUCCESS;\r
    }\r
  }\r
\r
  return EFI_NOT_FOUND;\r
}\r
\r
/**\r
  The original intention is to send a request.\r
  Currently, the application retransmits an icmp6 echo request packet\r
  per second in sendnumber times that is specified by the user.\r
  Because nothing can be done here, all things move to the timer rountine.\r
\r
  @param[in]    Event      A EFI_EVENT type event.\r
  @param[in]    Context    The pointer to Context.\r
\r
**/\r
VOID\r
EFIAPI\r
Ping6OnEchoRequestSent (\r
  IN EFI_EVENT  Event,\r
  IN VOID       *Context\r
  )\r
{\r
}\r
\r
/**\r
  receive reply, match and print reply infomation.\r
\r
  @param[in]    Event      A EFI_EVENT type event.\r
  @param[in]    Context    The pointer to context.\r
\r
**/\r
VOID\r
EFIAPI\r
Ping6OnEchoReplyReceived (\r
  IN EFI_EVENT  Event,\r
  IN VOID       *Context\r
  )\r
{\r
  EFI_STATUS                Status;\r
  PING_PRIVATE_DATA         *Private;\r
  ICMPX_ECHO_REQUEST_REPLY  *Reply;\r
  UINT32                    PayLoad;\r
  UINT32                    Rtt;\r
\r
  Private = (PING_PRIVATE_DATA *)Context;\r
\r
  if ((Private == NULL) || (Private->Status == EFI_ABORTED) || (Private->Signature != PING_PRIVATE_DATA_SIGNATURE)) {\r
    return;\r
  }\r
\r
  if (Private->RxToken.Packet.RxData == NULL) {\r
    return;\r
  }\r
\r
  if (Private->IpChoice == PING_IP_CHOICE_IP6) {\r
    Reply   = ((EFI_IP6_RECEIVE_DATA *)Private->RxToken.Packet.RxData)->FragmentTable[0].FragmentBuffer;\r
    PayLoad = ((EFI_IP6_RECEIVE_DATA *)Private->RxToken.Packet.RxData)->DataLength;\r
    if (((EFI_IP6_RECEIVE_DATA *)Private->RxToken.Packet.RxData)->Header->NextHeader != IP6_ICMP) {\r
      goto ON_EXIT;\r
    }\r
\r
    if (!IP6_IS_MULTICAST ((EFI_IPv6_ADDRESS *)&Private->DstAddress) &&\r
        !EFI_IP6_EQUAL (&((EFI_IP6_RECEIVE_DATA *)Private->RxToken.Packet.RxData)->Header->SourceAddress, (EFI_IPv6_ADDRESS *)&Private->DstAddress))\r
    {\r
      goto ON_EXIT;\r
    }\r
\r
    if ((Reply->Type != ICMP_V6_ECHO_REPLY) || (Reply->Code != 0)) {\r
      goto ON_EXIT;\r
    }\r
  } else {\r
    Reply   = ((EFI_IP4_RECEIVE_DATA *)Private->RxToken.Packet.RxData)->FragmentTable[0].FragmentBuffer;\r
    PayLoad = ((EFI_IP4_RECEIVE_DATA *)Private->RxToken.Packet.RxData)->DataLength;\r
    if (!IP4_IS_MULTICAST (EFI_IP4 (*(EFI_IPv4_ADDRESS *)Private->DstAddress)) &&\r
        !EFI_IP4_EQUAL (&((EFI_IP4_RECEIVE_DATA *)Private->RxToken.Packet.RxData)->Header->SourceAddress, (EFI_IPv4_ADDRESS *)&Private->DstAddress))\r
    {\r
      goto ON_EXIT;\r
    }\r
\r
    if ((Reply->Type != ICMP_V4_ECHO_REPLY) || (Reply->Code != 0)) {\r
      goto ON_EXIT;\r
    }\r
  }\r
\r
  if (PayLoad != Private->BufferSize) {\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Check whether the reply matches the sent request before.\r
  //\r
  Status = Ping6MatchEchoReply (Private, Reply);\r
  if (EFI_ERROR (Status)) {\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Display statistics on this icmp6 echo reply packet.\r
  //\r
  Rtt = CalculateTick (Private, Reply->TimeStamp, ReadTime (Private));\r
\r
  Private->RttSum += Rtt;\r
  Private->RttMin  = Private->RttMin > Rtt ? Rtt : Private->RttMin;\r
  Private->RttMax  = Private->RttMax < Rtt ? Rtt : Private->RttMax;\r
\r
  ShellPrintHiiEx (\r
    -1,\r
    -1,\r
    NULL,\r
    STRING_TOKEN (STR_PING_REPLY_INFO),\r
    gShellNetwork1HiiHandle,\r
    PayLoad,\r
    mDstString,\r
    Reply->SequenceNum,\r
    Private->IpChoice == PING_IP_CHOICE_IP6 ? ((EFI_IP6_RECEIVE_DATA *)Private->RxToken.Packet.RxData)->Header->HopLimit : 0,\r
    Rtt,\r
    Rtt + Private->TimerPeriod\r
    );\r
\r
ON_EXIT:\r
\r
  //\r
  // Recycle the packet before reusing RxToken\r
  //\r
  gBS->SignalEvent (Private->IpChoice == PING_IP_CHOICE_IP6 ? ((EFI_IP6_RECEIVE_DATA *)Private->RxToken.Packet.RxData)->RecycleSignal : ((EFI_IP4_RECEIVE_DATA *)Private->RxToken.Packet.RxData)->RecycleSignal);\r
\r
  if (Private->RxCount < Private->SendNum) {\r
    //\r
    // Continue to receive icmp echo reply packets.\r
    //\r
    Private->RxToken.Status = EFI_ABORTED;\r
\r
    Status = Private->ProtocolPointers.Receive (Private->IpProtocol, &Private->RxToken);\r
\r
    if (EFI_ERROR (Status)) {\r
      ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_PING_RECEIVE), gShellNetwork1HiiHandle, Status);\r
      Private->Status = EFI_ABORTED;\r
    }\r
  } else {\r
    //\r
    // All reply have already been received from the dest host.\r
    //\r
    Private->Status = EFI_SUCCESS;\r
  }\r
}\r
\r
/**\r
  Create a PING_IPX_COMPLETION_TOKEN.\r
\r
  @param[in]    Private        The pointer of PING_PRIVATE_DATA.\r
  @param[in]    TimeStamp      The TimeStamp of request.\r
  @param[in]    SequenceNum    The SequenceNum of request.\r
\r
  @return The pointer of PING_IPX_COMPLETION_TOKEN.\r
\r
**/\r
PING_IPX_COMPLETION_TOKEN *\r
PingGenerateToken (\r
  IN PING_PRIVATE_DATA  *Private,\r
  IN UINT32             TimeStamp,\r
  IN UINT16             SequenceNum\r
  )\r
{\r
  EFI_STATUS                 Status;\r
  PING_IPX_COMPLETION_TOKEN  *Token;\r
  VOID                       *TxData;\r
  ICMPX_ECHO_REQUEST_REPLY   *Request;\r
  UINT16                     HeadSum;\r
  UINT16                     TempChecksum;\r
\r
  Request = AllocateZeroPool (Private->BufferSize);\r
  if (Request == NULL) {\r
    return NULL;\r
  }\r
\r
  TxData = AllocateZeroPool (Private->IpChoice == PING_IP_CHOICE_IP6 ? sizeof (EFI_IP6_TRANSMIT_DATA) : sizeof (EFI_IP4_TRANSMIT_DATA));\r
  if (TxData == NULL) {\r
    FreePool (Request);\r
    return NULL;\r
  }\r
\r
  Token = AllocateZeroPool (sizeof (PING_IPX_COMPLETION_TOKEN));\r
  if (Token == NULL) {\r
    FreePool (Request);\r
    FreePool (TxData);\r
    return NULL;\r
  }\r
\r
  //\r
  // Assembly echo request packet.\r
  //\r
  Request->Type        = (UINT8)(Private->IpChoice == PING_IP_CHOICE_IP6 ? ICMP_V6_ECHO_REQUEST : ICMP_V4_ECHO_REQUEST);\r
  Request->Code        = 0;\r
  Request->SequenceNum = SequenceNum;\r
  Request->Identifier  = 0;\r
  Request->Checksum    = 0;\r
\r
  //\r
  // Assembly token for transmit.\r
  //\r
  if (Private->IpChoice == PING_IP_CHOICE_IP6) {\r
    Request->TimeStamp                                                 = TimeStamp;\r
    ((EFI_IP6_TRANSMIT_DATA *)TxData)->ExtHdrsLength                   = 0;\r
    ((EFI_IP6_TRANSMIT_DATA *)TxData)->ExtHdrs                         = NULL;\r
    ((EFI_IP6_TRANSMIT_DATA *)TxData)->OverrideData                    = 0;\r
    ((EFI_IP6_TRANSMIT_DATA *)TxData)->DataLength                      = Private->BufferSize;\r
    ((EFI_IP6_TRANSMIT_DATA *)TxData)->FragmentCount                   = 1;\r
    ((EFI_IP6_TRANSMIT_DATA *)TxData)->FragmentTable[0].FragmentBuffer = (VOID *)Request;\r
    ((EFI_IP6_TRANSMIT_DATA *)TxData)->FragmentTable[0].FragmentLength = Private->BufferSize;\r
  } else {\r
    ((EFI_IP4_TRANSMIT_DATA *)TxData)->OptionsLength                   = 0;\r
    ((EFI_IP4_TRANSMIT_DATA *)TxData)->OptionsBuffer                   = NULL;\r
    ((EFI_IP4_TRANSMIT_DATA *)TxData)->OverrideData                    = 0;\r
    ((EFI_IP4_TRANSMIT_DATA *)TxData)->TotalDataLength                 = Private->BufferSize;\r
    ((EFI_IP4_TRANSMIT_DATA *)TxData)->FragmentCount                   = 1;\r
    ((EFI_IP4_TRANSMIT_DATA *)TxData)->FragmentTable[0].FragmentBuffer = (VOID *)Request;\r
    ((EFI_IP4_TRANSMIT_DATA *)TxData)->FragmentTable[0].FragmentLength = Private->BufferSize;\r
    ((EFI_IP4_TRANSMIT_DATA *)TxData)->DestinationAddress.Addr[0]      = Private->DstAddress[0];\r
    ((EFI_IP4_TRANSMIT_DATA *)TxData)->DestinationAddress.Addr[1]      = Private->DstAddress[1];\r
    ((EFI_IP4_TRANSMIT_DATA *)TxData)->DestinationAddress.Addr[2]      = Private->DstAddress[2];\r
    ((EFI_IP4_TRANSMIT_DATA *)TxData)->DestinationAddress.Addr[3]      = Private->DstAddress[3];\r
\r
    HeadSum            = NetChecksum ((UINT8 *)Request, Private->BufferSize);\r
    Request->TimeStamp = TimeStamp;\r
    TempChecksum       = NetChecksum ((UINT8 *)&Request->TimeStamp, sizeof (UINT64));\r
    Request->Checksum  = (UINT16)(~NetAddChecksum (HeadSum, TempChecksum));\r
  }\r
\r
  Token->Status        = EFI_ABORTED;\r
  Token->Packet.TxData = TxData;\r
\r
  Status = gBS->CreateEvent (\r
                  EVT_NOTIFY_SIGNAL,\r
                  TPL_CALLBACK,\r
                  Ping6OnEchoRequestSent,\r
                  Private,\r
                  &Token->Event\r
                  );\r
\r
  if (EFI_ERROR (Status)) {\r
    FreePool (Request);\r
    FreePool (TxData);\r
    FreePool (Token);\r
    return NULL;\r
  }\r
\r
  return Token;\r
}\r
\r
/**\r
  Transmit the PING_IPX_COMPLETION_TOKEN.\r
\r
  @param[in]    Private    The pointer of PING_PRIVATE_DATA.\r
\r
  @retval EFI_SUCCESS             Transmitted successfully.\r
  @retval EFI_OUT_OF_RESOURCES    No memory is available on the platform.\r
  @retval others                  Transmitted unsuccessfully.\r
\r
**/\r
EFI_STATUS\r
PingSendEchoRequest (\r
  IN PING_PRIVATE_DATA  *Private\r
  )\r
{\r
  EFI_STATUS          Status;\r
  PING_ICMPX_TX_INFO  *TxInfo;\r
\r
  TxInfo = AllocateZeroPool (sizeof (PING_ICMPX_TX_INFO));\r
\r
  if (TxInfo == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  TxInfo->TimeStamp   = ReadTime (Private);\r
  TxInfo->SequenceNum = (UINT16)(Private->TxCount + 1);\r
  TxInfo->Token       = PingGenerateToken (\r
                          Private,\r
                          TxInfo->TimeStamp,\r
                          TxInfo->SequenceNum\r
                          );\r
\r
  if (TxInfo->Token == NULL) {\r
    PingDestroyTxInfo (TxInfo, Private->IpChoice);\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  ASSERT (Private->ProtocolPointers.Transmit != NULL);\r
\r
  InsertTailList (&Private->TxList, &TxInfo->Link);\r
\r
  Status = Private->ProtocolPointers.Transmit (Private->IpProtocol, TxInfo->Token);\r
\r
  if (EFI_ERROR (Status)) {\r
    RemoveEntryList (&TxInfo->Link);\r
    PingDestroyTxInfo (TxInfo, Private->IpChoice);\r
    return Status;\r
  }\r
\r
  Private->TxCount++;\r
\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
  Place a completion token into the receive packet queue to receive the echo reply.\r
\r
  @param[in]    Private    The pointer of PING_PRIVATE_DATA.\r
\r
  @retval EFI_SUCCESS      Put the token into the receive packet queue successfully.\r
  @retval others           Put the token into the receive packet queue unsuccessfully.\r
\r
**/\r
EFI_STATUS\r
Ping6ReceiveEchoReply (\r
  IN PING_PRIVATE_DATA  *Private\r
  )\r
{\r
  EFI_STATUS  Status;\r
\r
  ZeroMem (&Private->RxToken, sizeof (PING_IPX_COMPLETION_TOKEN));\r
\r
  Status = gBS->CreateEvent (\r
                  EVT_NOTIFY_SIGNAL,\r
                  TPL_CALLBACK,\r
                  Ping6OnEchoReplyReceived,\r
                  Private,\r
                  &Private->RxToken.Event\r
                  );\r
\r
  if (EFI_ERROR (Status)) {\r
    return Status;\r
  }\r
\r
  Private->RxToken.Status = EFI_NOT_READY;\r
\r
  Status = Private->ProtocolPointers.Receive (Private->IpProtocol, &Private->RxToken);\r
  if (EFI_ERROR (Status)) {\r
    ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_PING_RECEIVE), gShellNetwork1HiiHandle, Status);\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Remove the timeout request from the list.\r
\r
  @param[in]    Event    A EFI_EVENT type event.\r
  @param[in]    Context  The pointer to Context.\r
\r
**/\r
VOID\r
EFIAPI\r
Ping6OnTimerRoutine (\r
  IN EFI_EVENT  Event,\r
  IN VOID       *Context\r
  )\r
{\r
  EFI_STATUS          Status;\r
  PING_PRIVATE_DATA   *Private;\r
  PING_ICMPX_TX_INFO  *TxInfo;\r
  LIST_ENTRY          *Entry;\r
  LIST_ENTRY          *NextEntry;\r
  UINT64              Time;\r
\r
  Private = (PING_PRIVATE_DATA *)Context;\r
  if (Private->Signature != PING_PRIVATE_DATA_SIGNATURE) {\r
    Private->Status = EFI_NOT_FOUND;\r
    return;\r
  }\r
\r
  //\r
  // Retransmit icmp6 echo request packets per second in sendnumber times.\r
  //\r
  if (Private->TxCount < Private->SendNum) {\r
    Status = PingSendEchoRequest (Private);\r
    if (Private->TxCount != 0) {\r
      if (EFI_ERROR (Status)) {\r
        ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_PING_SEND_REQUEST), gShellNetwork1HiiHandle, Private->TxCount + 1);\r
      }\r
    }\r
  }\r
\r
  //\r
  // Check whether any icmp6 echo request in the list timeout.\r
  //\r
  NET_LIST_FOR_EACH_SAFE (Entry, NextEntry, &Private->TxList) {\r
    TxInfo = BASE_CR (Entry, PING_ICMPX_TX_INFO, Link);\r
    Time   = CalculateTick (Private, TxInfo->TimeStamp, ReadTime (Private));\r
\r
    //\r
    // Remove the timeout echo request from txlist.\r
    //\r
    if (Time > DEFAULT_TIMEOUT) {\r
      if (EFI_ERROR (TxInfo->Token->Status)) {\r
        Private->ProtocolPointers.Cancel (Private->IpProtocol, TxInfo->Token);\r
      }\r
\r
      //\r
      // Remove the timeout icmp6 echo request from list.\r
      //\r
      ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_PING_TIMEOUT), gShellNetwork1HiiHandle, TxInfo->SequenceNum);\r
\r
      RemoveEntryList (&TxInfo->Link);\r
      PingDestroyTxInfo (TxInfo, Private->IpChoice);\r
\r
      Private->RxCount++;\r
      Private->FailedCount++;\r
\r
      if (IsListEmpty (&Private->TxList) && (Private->TxCount == Private->SendNum)) {\r
        //\r
        // All the left icmp6 echo request in the list timeout.\r
        //\r
        Private->Status = EFI_TIMEOUT;\r
      }\r
    }\r
  }\r
}\r
\r
/**\r
  Determine if a IP4 address is Link Local.\r
\r
  169.254.1.0 through 169.254.254.255 is link local.\r
\r
  @param[in] Address  The address to test.\r
\r
  @retval TRUE      It is.\r
  @retval FALSE     It is not.\r
**/\r
BOOLEAN\r
PingNetIp4IsLinkLocalAddr (\r
  IN CONST EFI_IPv4_ADDRESS  *Address\r
  )\r
{\r
  return ((BOOLEAN)(Address->Addr[0] == 169 && Address->Addr[1] == 254 && Address->Addr[2] >= 1 && Address->Addr[2] <= 254));\r
}\r
\r
/**\r
  Determine if a IP4 address is unspecified.\r
\r
  @param[in] Address  The address to test.\r
\r
  @retval TRUE      It is.\r
  @retval FALSE     It is not.\r
**/\r
BOOLEAN\r
PingNetIp4IsUnspecifiedAddr (\r
  IN CONST EFI_IPv4_ADDRESS  *Address\r
  )\r
{\r
  return  ((BOOLEAN)((ReadUnaligned32 ((UINT32 *)&Address->Addr[0])) == 0x00000000));\r
}\r
\r
/**\r
  Create a valid IP instance.\r
\r
  @param[in]    Private    The pointer of PING_PRIVATE_DATA.\r
\r
  @retval EFI_SUCCESS              Create a valid IPx instance successfully.\r
  @retval EFI_ABORTED              Locate handle with ipx service binding protocol unsuccessfully.\r
  @retval EFI_INVALID_PARAMETER    The source address is unspecified when the destination address is a link-local address.\r
  @retval EFI_OUT_OF_RESOURCES     No memory is available on the platform.\r
  @retval EFI_NOT_FOUND            The source address is not found.\r
**/\r
EFI_STATUS\r
PingCreateIpInstance (\r
  IN  PING_PRIVATE_DATA  *Private\r
  )\r
{\r
  EFI_STATUS                    Status;\r
  UINTN                         HandleIndex;\r
  UINTN                         HandleNum;\r
  EFI_HANDLE                    *HandleBuffer;\r
  BOOLEAN                       UnspecifiedSrc;\r
  EFI_STATUS                    MediaStatus;\r
  EFI_SERVICE_BINDING_PROTOCOL  *EfiSb;\r
  VOID                          *IpXCfg;\r
  EFI_IP6_CONFIG_DATA           Ip6Config;\r
  EFI_IP4_CONFIG_DATA           Ip4Config;\r
  VOID                          *IpXInterfaceInfo;\r
  UINTN                         IfInfoSize;\r
  EFI_IPv6_ADDRESS              *Addr;\r
  UINTN                         AddrIndex;\r
\r
  HandleBuffer     = NULL;\r
  UnspecifiedSrc   = FALSE;\r
  MediaStatus      = EFI_SUCCESS;\r
  EfiSb            = NULL;\r
  IpXInterfaceInfo = NULL;\r
  IfInfoSize       = 0;\r
\r
  //\r
  // Locate all the handles with ip6 service binding protocol.\r
  //\r
  Status = gBS->LocateHandleBuffer (\r
                  ByProtocol,\r
                  Private->IpChoice == PING_IP_CHOICE_IP6 ? &gEfiIp6ServiceBindingProtocolGuid : &gEfiIp4ServiceBindingProtocolGuid,\r
                  NULL,\r
                  &HandleNum,\r
                  &HandleBuffer\r
                  );\r
  if (EFI_ERROR (Status) || (HandleNum == 0) || (HandleBuffer == NULL)) {\r
    return EFI_ABORTED;\r
  }\r
\r
  if ((Private->IpChoice == PING_IP_CHOICE_IP6) ? NetIp6IsUnspecifiedAddr ((EFI_IPv6_ADDRESS *)&Private->SrcAddress) : \\r
      PingNetIp4IsUnspecifiedAddr ((EFI_IPv4_ADDRESS *)&Private->SrcAddress))\r
  {\r
    //\r
    // SrcAddress is unspecified. So, both connected and configured interface will be automatic selected.\r
    //\r
    UnspecifiedSrc = TRUE;\r
  }\r
\r
  //\r
  // Source address is required when pinging a link-local address.\r
  //\r
  if (Private->IpChoice == PING_IP_CHOICE_IP6) {\r
    if (NetIp6IsLinkLocalAddr ((EFI_IPv6_ADDRESS *)&Private->DstAddress) && UnspecifiedSrc) {\r
      ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_PING_INVALID_SOURCE), gShellNetwork1HiiHandle);\r
      Status = EFI_INVALID_PARAMETER;\r
      goto ON_ERROR;\r
    }\r
  } else {\r
    ASSERT (Private->IpChoice == PING_IP_CHOICE_IP4);\r
    if (PingNetIp4IsLinkLocalAddr ((EFI_IPv4_ADDRESS *)&Private->DstAddress) && UnspecifiedSrc) {\r
      ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_PING_INVALID_SOURCE), gShellNetwork1HiiHandle);\r
      Status = EFI_INVALID_PARAMETER;\r
      goto ON_ERROR;\r
    }\r
  }\r
\r
  //\r
  // For each ip6 protocol, check interface addresses list.\r
  //\r
  for (HandleIndex = 0; HandleIndex < HandleNum; HandleIndex++) {\r
    EfiSb            = NULL;\r
    IpXInterfaceInfo = NULL;\r
    IfInfoSize       = 0;\r
\r
    if (UnspecifiedSrc) {\r
      //\r
      // Check media.\r
      //\r
      NetLibDetectMediaWaitTimeout (HandleBuffer[HandleIndex], 0, &MediaStatus);\r
      if (MediaStatus != EFI_SUCCESS) {\r
        //\r
        // Skip this one.\r
        //\r
        continue;\r
      }\r
    }\r
\r
    Status = gBS->HandleProtocol (\r
                    HandleBuffer[HandleIndex],\r
                    Private->IpChoice == PING_IP_CHOICE_IP6 ? &gEfiIp6ServiceBindingProtocolGuid : &gEfiIp4ServiceBindingProtocolGuid,\r
                    (VOID **)&EfiSb\r
                    );\r
    if (EFI_ERROR (Status)) {\r
      goto ON_ERROR;\r
    }\r
\r
    //\r
    // Ip6config protocol and ip6 service binding protocol are installed\r
    // on the same handle.\r
    //\r
    Status = gBS->HandleProtocol (\r
                    HandleBuffer[HandleIndex],\r
                    Private->IpChoice == PING_IP_CHOICE_IP6 ? &gEfiIp6ConfigProtocolGuid : &gEfiIp4Config2ProtocolGuid,\r
                    (VOID **)&IpXCfg\r
                    );\r
\r
    if (EFI_ERROR (Status)) {\r
      goto ON_ERROR;\r
    }\r
\r
    //\r
    // Get the interface information size.\r
    //\r
    if (Private->IpChoice == PING_IP_CHOICE_IP6) {\r
      Status = ((EFI_IP6_CONFIG_PROTOCOL *)IpXCfg)->GetData (\r
                                                      IpXCfg,\r
                                                      Ip6ConfigDataTypeInterfaceInfo,\r
                                                      &IfInfoSize,\r
                                                      NULL\r
                                                      );\r
    } else {\r
      Status = ((EFI_IP4_CONFIG2_PROTOCOL *)IpXCfg)->GetData (\r
                                                       IpXCfg,\r
                                                       Ip4Config2DataTypeInterfaceInfo,\r
                                                       &IfInfoSize,\r
                                                       NULL\r
                                                       );\r
    }\r
\r
    //\r
    // Skip the ones not in current use.\r
    //\r
    if (Status == EFI_NOT_STARTED) {\r
      continue;\r
    }\r
\r
    if (Status != EFI_BUFFER_TOO_SMALL) {\r
      ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_PING_GETDATA), gShellNetwork1HiiHandle, Status);\r
      goto ON_ERROR;\r
    }\r
\r
    IpXInterfaceInfo = AllocateZeroPool (IfInfoSize);\r
\r
    if (IpXInterfaceInfo == NULL) {\r
      Status = EFI_OUT_OF_RESOURCES;\r
      goto ON_ERROR;\r
    }\r
\r
    //\r
    // Get the interface info.\r
    //\r
    if (Private->IpChoice == PING_IP_CHOICE_IP6) {\r
      Status = ((EFI_IP6_CONFIG_PROTOCOL *)IpXCfg)->GetData (\r
                                                      IpXCfg,\r
                                                      Ip6ConfigDataTypeInterfaceInfo,\r
                                                      &IfInfoSize,\r
                                                      IpXInterfaceInfo\r
                                                      );\r
    } else {\r
      Status = ((EFI_IP4_CONFIG2_PROTOCOL *)IpXCfg)->GetData (\r
                                                       IpXCfg,\r
                                                       Ip4Config2DataTypeInterfaceInfo,\r
                                                       &IfInfoSize,\r
                                                       IpXInterfaceInfo\r
                                                       );\r
    }\r
\r
    if (EFI_ERROR (Status)) {\r
      ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_PING_GETDATA), gShellNetwork1HiiHandle, Status);\r
      goto ON_ERROR;\r
    }\r
\r
    //\r
    // Check whether the source address is one of the interface addresses.\r
    //\r
    if (Private->IpChoice == PING_IP_CHOICE_IP6) {\r
      for (AddrIndex = 0; AddrIndex < ((EFI_IP6_CONFIG_INTERFACE_INFO *)IpXInterfaceInfo)->AddressInfoCount; AddrIndex++) {\r
        Addr = &(((EFI_IP6_CONFIG_INTERFACE_INFO *)IpXInterfaceInfo)->AddressInfo[AddrIndex].Address);\r
\r
        if (UnspecifiedSrc) {\r
          if (!NetIp6IsUnspecifiedAddr (Addr) && !NetIp6IsLinkLocalAddr (Addr)) {\r
            //\r
            // Select the interface automatically.\r
            //\r
            CopyMem (&Private->SrcAddress, Addr, sizeof (Private->SrcAddress));\r
            break;\r
          }\r
        } else if (EFI_IP6_EQUAL (&Private->SrcAddress, Addr)) {\r
          //\r
          // Match a certain interface address.\r
          //\r
          break;\r
        }\r
      }\r
\r
      if (AddrIndex < ((EFI_IP6_CONFIG_INTERFACE_INFO *)IpXInterfaceInfo)->AddressInfoCount) {\r
        //\r
        // Found a nic handle with right interface address.\r
        //\r
        break;\r
      }\r
    } else {\r
      if (UnspecifiedSrc) {\r
        if (!PingNetIp4IsUnspecifiedAddr (&((EFI_IP4_CONFIG2_INTERFACE_INFO *)IpXInterfaceInfo)->StationAddress) &&\r
            !PingNetIp4IsLinkLocalAddr (&((EFI_IP4_CONFIG2_INTERFACE_INFO *)IpXInterfaceInfo)->StationAddress))\r
        {\r
          //\r
          // Select the interface automatically.\r
          //\r
          break;\r
        }\r
      } else if (EFI_IP4_EQUAL (&Private->SrcAddress, &((EFI_IP4_CONFIG2_INTERFACE_INFO *)IpXInterfaceInfo)->StationAddress)) {\r
        //\r
        // Match a certain interface address.\r
        //\r
        break;\r
      }\r
    }\r
\r
    FreePool (IpXInterfaceInfo);\r
    IpXInterfaceInfo = NULL;\r
  }\r
\r
  //\r
  // No exact interface address matched.\r
  //\r
\r
  if (HandleIndex == HandleNum) {\r
    ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_PING_CONFIGD_NIC_NF), gShellNetwork1HiiHandle, L"ping");\r
    Status = EFI_NOT_FOUND;\r
    goto ON_ERROR;\r
  }\r
\r
  Private->NicHandle = HandleBuffer[HandleIndex];\r
\r
  ASSERT (EfiSb != NULL);\r
  Status = EfiSb->CreateChild (EfiSb, &Private->IpChildHandle);\r
\r
  if (EFI_ERROR (Status)) {\r
    goto ON_ERROR;\r
  }\r
\r
  if (Private->IpChoice == PING_IP_CHOICE_IP6) {\r
    Status = gBS->OpenProtocol (\r
                    Private->IpChildHandle,\r
                    &gEfiIp6ProtocolGuid,\r
                    &Private->IpProtocol,\r
                    gImageHandle,\r
                    Private->IpChildHandle,\r
                    EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
                    );\r
    if (EFI_ERROR (Status)) {\r
      goto ON_ERROR;\r
    }\r
\r
    ZeroMem (&Ip6Config, sizeof (EFI_IP6_CONFIG_DATA));\r
\r
    //\r
    // Configure the ip6 instance for icmp6 packet exchange.\r
    //\r
    Ip6Config.DefaultProtocol   = 58;\r
    Ip6Config.AcceptAnyProtocol = FALSE;\r
    Ip6Config.AcceptIcmpErrors  = TRUE;\r
    Ip6Config.AcceptPromiscuous = FALSE;\r
    Ip6Config.TrafficClass      = 0;\r
    Ip6Config.HopLimit          = 128;\r
    Ip6Config.FlowLabel         = 0;\r
    Ip6Config.ReceiveTimeout    = 0;\r
    Ip6Config.TransmitTimeout   = 0;\r
\r
    IP6_COPY_ADDRESS (&Ip6Config.StationAddress, &Private->SrcAddress);\r
    IP6_COPY_ADDRESS (&Ip6Config.DestinationAddress, &Private->DstAddress);\r
\r
    Status = ((EFI_IP6_PROTOCOL *)(Private->IpProtocol))->Configure (Private->IpProtocol, &Ip6Config);\r
\r
    if (EFI_ERROR (Status)) {\r
      ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_PING_CONFIG), gShellNetwork1HiiHandle, Status);\r
      goto ON_ERROR;\r
    }\r
\r
    Private->ProtocolPointers.Transmit = (PING_IPX_TRANSMIT)((EFI_IP6_PROTOCOL *)Private->IpProtocol)->Transmit;\r
    Private->ProtocolPointers.Receive  = (PING_IPX_RECEIVE)((EFI_IP6_PROTOCOL *)Private->IpProtocol)->Receive;\r
    Private->ProtocolPointers.Cancel   = (PING_IPX_CANCEL)((EFI_IP6_PROTOCOL *)Private->IpProtocol)->Cancel;\r
    Private->ProtocolPointers.Poll     = (PING_IPX_POLL)((EFI_IP6_PROTOCOL *)Private->IpProtocol)->Poll;\r
  } else {\r
    Status = gBS->OpenProtocol (\r
                    Private->IpChildHandle,\r
                    &gEfiIp4ProtocolGuid,\r
                    &Private->IpProtocol,\r
                    gImageHandle,\r
                    Private->IpChildHandle,\r
                    EFI_OPEN_PROTOCOL_GET_PROTOCOL\r
                    );\r
    if (EFI_ERROR (Status)) {\r
      goto ON_ERROR;\r
    }\r
\r
    ZeroMem (&Ip4Config, sizeof (EFI_IP4_CONFIG_DATA));\r
\r
    //\r
    // Configure the ip4 instance for icmp4 packet exchange.\r
    //\r
    Ip4Config.DefaultProtocol   = 1;\r
    Ip4Config.AcceptAnyProtocol = FALSE;\r
    Ip4Config.AcceptBroadcast   = FALSE;\r
    Ip4Config.AcceptIcmpErrors  = TRUE;\r
    Ip4Config.AcceptPromiscuous = FALSE;\r
    Ip4Config.DoNotFragment     = FALSE;\r
    Ip4Config.RawData           = FALSE;\r
    Ip4Config.ReceiveTimeout    = 0;\r
    Ip4Config.TransmitTimeout   = 0;\r
    Ip4Config.UseDefaultAddress = TRUE;\r
    Ip4Config.TimeToLive        = 128;\r
    Ip4Config.TypeOfService     = 0;\r
\r
    Status = ((EFI_IP4_PROTOCOL *)(Private->IpProtocol))->Configure (Private->IpProtocol, &Ip4Config);\r
\r
    if (EFI_ERROR (Status)) {\r
      ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_PING_CONFIG), gShellNetwork1HiiHandle, Status);\r
      goto ON_ERROR;\r
    }\r
\r
    Private->ProtocolPointers.Transmit = (PING_IPX_TRANSMIT)((EFI_IP4_PROTOCOL *)Private->IpProtocol)->Transmit;\r
    Private->ProtocolPointers.Receive  = (PING_IPX_RECEIVE)((EFI_IP4_PROTOCOL *)Private->IpProtocol)->Receive;\r
    Private->ProtocolPointers.Cancel   = (PING_IPX_CANCEL)((EFI_IP4_PROTOCOL *)Private->IpProtocol)->Cancel;\r
    Private->ProtocolPointers.Poll     = (PING_IPX_POLL)((EFI_IP4_PROTOCOL *)Private->IpProtocol)->Poll;\r
  }\r
\r
  if (HandleBuffer != NULL) {\r
    FreePool (HandleBuffer);\r
  }\r
\r
  return EFI_SUCCESS;\r
\r
ON_ERROR:\r
  if (HandleBuffer != NULL) {\r
    FreePool (HandleBuffer);\r
  }\r
\r
  if (IpXInterfaceInfo != NULL) {\r
    FreePool (IpXInterfaceInfo);\r
  }\r
\r
  if ((EfiSb != NULL) && (Private->IpChildHandle != NULL)) {\r
    EfiSb->DestroyChild (EfiSb, Private->IpChildHandle);\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
  Destroy the IP instance.\r
\r
  @param[in]    Private    The pointer of PING_PRIVATE_DATA.\r
\r
**/\r
VOID\r
Ping6DestroyIp6Instance (\r
  IN PING_PRIVATE_DATA  *Private\r
  )\r
{\r
  EFI_STATUS                    Status;\r
  EFI_SERVICE_BINDING_PROTOCOL  *IpSb;\r
\r
  gBS->CloseProtocol (\r
         Private->IpChildHandle,\r
         Private->IpChoice == PING_IP_CHOICE_IP6 ? &gEfiIp6ProtocolGuid : &gEfiIp4ProtocolGuid,\r
         gImageHandle,\r
         Private->IpChildHandle\r
         );\r
\r
  Status = gBS->HandleProtocol (\r
                  Private->NicHandle,\r
                  Private->IpChoice == PING_IP_CHOICE_IP6 ? &gEfiIp6ServiceBindingProtocolGuid : &gEfiIp4ServiceBindingProtocolGuid,\r
                  (VOID **)&IpSb\r
                  );\r
\r
  if (!EFI_ERROR (Status)) {\r
    IpSb->DestroyChild (IpSb, Private->IpChildHandle);\r
  }\r
}\r
\r
/**\r
  The Ping Process.\r
\r
  @param[in]   SendNumber     The send request count.\r
  @param[in]   BufferSize     The send buffer size.\r
  @param[in]   SrcAddress     The source address.\r
  @param[in]   DstAddress     The destination address.\r
  @param[in]   IpChoice       The choice between IPv4 and IPv6.\r
\r
  @retval SHELL_SUCCESS  The ping processed successfullly.\r
  @retval others         The ping processed unsuccessfully.\r
**/\r
SHELL_STATUS\r
ShellPing (\r
  IN UINT32            SendNumber,\r
  IN UINT32            BufferSize,\r
  IN EFI_IPv6_ADDRESS  *SrcAddress,\r
  IN EFI_IPv6_ADDRESS  *DstAddress,\r
  IN UINT32            IpChoice\r
  )\r
{\r
  EFI_STATUS          Status;\r
  PING_PRIVATE_DATA   *Private;\r
  PING_ICMPX_TX_INFO  *TxInfo;\r
  LIST_ENTRY          *Entry;\r
  LIST_ENTRY          *NextEntry;\r
  SHELL_STATUS        ShellStatus;\r
\r
  ShellStatus = SHELL_SUCCESS;\r
  Private     = AllocateZeroPool (sizeof (PING_PRIVATE_DATA));\r
\r
  if (Private == NULL) {\r
    return (SHELL_OUT_OF_RESOURCES);\r
  }\r
\r
  Private->IpChoice   = IpChoice;\r
  Private->Signature  = PING_PRIVATE_DATA_SIGNATURE;\r
  Private->SendNum    = SendNumber;\r
  Private->BufferSize = BufferSize;\r
  Private->RttMin     = ~((UINT64)(0x0));\r
  Private->Status     = EFI_NOT_READY;\r
\r
  CopyMem (&Private->SrcAddress, SrcAddress, sizeof (Private->SrcAddress));\r
  CopyMem (&Private->DstAddress, DstAddress, sizeof (Private->DstAddress));\r
\r
  InitializeListHead (&Private->TxList);\r
\r
  //\r
  // Open and configure a ip instance for us.\r
  //\r
  Status = PingCreateIpInstance (Private);\r
\r
  if (EFI_ERROR (Status)) {\r
    ShellStatus = SHELL_ACCESS_DENIED;\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Print the command line itself.\r
  //\r
  ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_PING_START), gShellNetwork1HiiHandle, mDstString, Private->BufferSize);\r
  //\r
  // Create a ipv6 token to receive the first icmp6 echo reply packet.\r
  //\r
  Status = Ping6ReceiveEchoReply (Private);\r
\r
  if (EFI_ERROR (Status)) {\r
    ShellStatus = SHELL_ACCESS_DENIED;\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Create and start timer to send icmp6 echo request packet per second.\r
  //\r
  Status = gBS->CreateEvent (\r
                  EVT_TIMER | EVT_NOTIFY_SIGNAL,\r
                  TPL_CALLBACK,\r
                  Ping6OnTimerRoutine,\r
                  Private,\r
                  &Private->Timer\r
                  );\r
\r
  if (EFI_ERROR (Status)) {\r
    ShellStatus = SHELL_ACCESS_DENIED;\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Start a timer to calculate the RTT.\r
  //\r
  Status = PingInitRttTimer (Private);\r
  if (EFI_ERROR (Status)) {\r
    ShellStatus = SHELL_ACCESS_DENIED;\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Create a ipv6 token to send the first icmp6 echo request packet.\r
  //\r
  Status = PingSendEchoRequest (Private);\r
  //\r
  // EFI_NOT_READY for IPsec is enable and IKE is not established.\r
  //\r
  if (EFI_ERROR (Status) && (Status != EFI_NOT_READY)) {\r
    ShellStatus = SHELL_ACCESS_DENIED;\r
    if (Status == EFI_NOT_FOUND) {\r
      ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_PING_NOSOURCE_INDO), gShellNetwork1HiiHandle, mDstString);\r
    } else if (Status == RETURN_NO_MAPPING) {\r
      ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_PING_NOROUTE_FOUND), gShellNetwork1HiiHandle, mDstString, mSrcString);\r
    } else {\r
      ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_PING_NETWORK_ERROR), gShellNetwork1HiiHandle, L"ping", Status);\r
    }\r
\r
    goto ON_EXIT;\r
  }\r
\r
  Status = gBS->SetTimer (\r
                  Private->Timer,\r
                  TimerPeriodic,\r
                  ONE_SECOND\r
                  );\r
\r
  if (EFI_ERROR (Status)) {\r
    ShellStatus = SHELL_ACCESS_DENIED;\r
    goto ON_EXIT;\r
  }\r
\r
  //\r
  // Control the ping6 process by two factors:\r
  // 1. Hot key\r
  // 2. Private->Status\r
  //   2.1. success means all icmp6 echo request packets get reply packets.\r
  //   2.2. timeout means the last icmp6 echo reply request timeout to get reply.\r
  //   2.3. noready means ping6 process is on-the-go.\r
  //\r
  while (Private->Status == EFI_NOT_READY) {\r
    Status = Private->ProtocolPointers.Poll (Private->IpProtocol);\r
    if (ShellGetExecutionBreakFlag ()) {\r
      Private->Status = EFI_ABORTED;\r
      goto ON_STAT;\r
    }\r
  }\r
\r
ON_STAT:\r
  //\r
  // Display the statistics in all.\r
  //\r
  gBS->SetTimer (Private->Timer, TimerCancel, 0);\r
\r
  if (Private->TxCount != 0) {\r
    ShellPrintHiiEx (\r
      -1,\r
      -1,\r
      NULL,\r
      STRING_TOKEN (STR_PING_STAT),\r
      gShellNetwork1HiiHandle,\r
      Private->TxCount,\r
      (Private->RxCount - Private->FailedCount),\r
      (100 - ((100 * (Private->RxCount - Private->FailedCount)) / Private->TxCount)),\r
      Private->RttSum\r
      );\r
  }\r
\r
  if (Private->RxCount > Private->FailedCount) {\r
    ShellPrintHiiEx (\r
      -1,\r
      -1,\r
      NULL,\r
      STRING_TOKEN (STR_PING_RTT),\r
      gShellNetwork1HiiHandle,\r
      Private->RttMin,\r
      Private->RttMin + Private->TimerPeriod,\r
      Private->RttMax,\r
      Private->RttMax + Private->TimerPeriod,\r
      DivU64x64Remainder (Private->RttSum, (Private->RxCount - Private->FailedCount), NULL),\r
      DivU64x64Remainder (Private->RttSum, (Private->RxCount - Private->FailedCount), NULL) + Private->TimerPeriod\r
      );\r
  }\r
\r
ON_EXIT:\r
\r
  if (Private != NULL) {\r
    NET_LIST_FOR_EACH_SAFE (Entry, NextEntry, &Private->TxList) {\r
      TxInfo = BASE_CR (Entry, PING_ICMPX_TX_INFO, Link);\r
\r
      if ((Private->IpProtocol != NULL) && (Private->ProtocolPointers.Cancel != NULL)) {\r
        Status = Private->ProtocolPointers.Cancel (Private->IpProtocol, TxInfo->Token);\r
      }\r
\r
      RemoveEntryList (&TxInfo->Link);\r
      PingDestroyTxInfo (TxInfo, Private->IpChoice);\r
    }\r
\r
    PingFreeRttTimer (Private);\r
\r
    if (Private->Timer != NULL) {\r
      gBS->CloseEvent (Private->Timer);\r
    }\r
\r
    if ((Private->IpProtocol != NULL) && (Private->ProtocolPointers.Cancel != NULL)) {\r
      Status = Private->ProtocolPointers.Cancel (Private->IpProtocol, &Private->RxToken);\r
    }\r
\r
    if (Private->RxToken.Event != NULL) {\r
      gBS->CloseEvent (Private->RxToken.Event);\r
    }\r
\r
    if (Private->IpChildHandle != NULL) {\r
      Ping6DestroyIp6Instance (Private);\r
    }\r
\r
    FreePool (Private);\r
  }\r
\r
  return ShellStatus;\r
}\r
\r
/**\r
  Function for 'ping' command.\r
\r
  @param[in] ImageHandle  Handle to the Image (NULL if Internal).\r
  @param[in] SystemTable  Pointer to the System Table (NULL if Internal).\r
\r
  @retval SHELL_SUCCESS  The ping processed successfullly.\r
  @retval others         The ping processed unsuccessfully.\r
\r
**/\r
SHELL_STATUS\r
EFIAPI\r
ShellCommandRunPing (\r
  IN EFI_HANDLE        ImageHandle,\r
  IN EFI_SYSTEM_TABLE  *SystemTable\r
  )\r
{\r
  EFI_STATUS        Status;\r
  SHELL_STATUS      ShellStatus;\r
  EFI_IPv6_ADDRESS  DstAddress;\r
  EFI_IPv6_ADDRESS  SrcAddress;\r
  UINT64            BufferSize;\r
  UINTN             SendNumber;\r
  LIST_ENTRY        *ParamPackage;\r
  CONST CHAR16      *ValueStr;\r
  UINTN             NonOptionCount;\r
  UINT32            IpChoice;\r
  CHAR16            *ProblemParam;\r
\r
  //\r
  // we use IPv6 buffers to hold items...\r
  // make sure this is enough space!\r
  //\r
  ASSERT (sizeof (EFI_IPv4_ADDRESS) <= sizeof (EFI_IPv6_ADDRESS));\r
  ASSERT (sizeof (EFI_IP4_COMPLETION_TOKEN) <= sizeof (EFI_IP6_COMPLETION_TOKEN));\r
\r
  IpChoice = PING_IP_CHOICE_IP4;\r
\r
  ShellStatus  = SHELL_SUCCESS;\r
  ProblemParam = NULL;\r
\r
  Status = ShellCommandLineParseEx (PingParamList, &ParamPackage, &ProblemParam, TRUE, FALSE);\r
  if (EFI_ERROR (Status)) {\r
    ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_GEN_PARAM_INV), gShellNetwork1HiiHandle, L"ping", ProblemParam);\r
    ShellStatus = SHELL_INVALID_PARAMETER;\r
    goto ON_EXIT;\r
  }\r
\r
  if (ShellCommandLineGetFlag (ParamPackage, L"-_ip6")) {\r
    IpChoice = PING_IP_CHOICE_IP6;\r
  }\r
\r
  //\r
  // Parse the parameter of count number.\r
  //\r
  ValueStr = ShellCommandLineGetValue (ParamPackage, L"-n");\r
  if (ValueStr != NULL) {\r
    SendNumber = ShellStrToUintn (ValueStr);\r
\r
    //\r
    // ShellStrToUintn will return 0 when input is 0 or an invalid input string.\r
    //\r
    if ((SendNumber == 0) || (SendNumber > MAX_SEND_NUMBER)) {\r
      ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_GEN_PARAM_INV), gShellNetwork1HiiHandle, L"ping", ValueStr);\r
      ShellStatus = SHELL_INVALID_PARAMETER;\r
      goto ON_EXIT;\r
    }\r
  } else {\r
    SendNumber = DEFAULT_SEND_COUNT;\r
  }\r
\r
  //\r
  // Parse the parameter of buffer size.\r
  //\r
  ValueStr = ShellCommandLineGetValue (ParamPackage, L"-l");\r
  if (ValueStr != NULL) {\r
    BufferSize = ShellStrToUintn (ValueStr);\r
\r
    //\r
    // ShellStrToUintn will return 0 when input is 0 or an invalid input string.\r
    //\r
    if ((BufferSize < 16) || (BufferSize > MAX_BUFFER_SIZE)) {\r
      ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_GEN_PARAM_INV), gShellNetwork1HiiHandle, L"ping", ValueStr);\r
      ShellStatus = SHELL_INVALID_PARAMETER;\r
      goto ON_EXIT;\r
    }\r
  } else {\r
    BufferSize = DEFAULT_BUFFER_SIZE;\r
  }\r
\r
  ZeroMem (&SrcAddress, sizeof (EFI_IPv6_ADDRESS));\r
  ZeroMem (&DstAddress, sizeof (EFI_IPv6_ADDRESS));\r
\r
  //\r
  // Parse the parameter of source ip address.\r
  //\r
  ValueStr = ShellCommandLineGetValue (ParamPackage, L"-s");\r
  if (ValueStr == NULL) {\r
    ValueStr = ShellCommandLineGetValue (ParamPackage, L"-_s");\r
  }\r
\r
  if (ValueStr != NULL) {\r
    mSrcString = ValueStr;\r
    if (IpChoice == PING_IP_CHOICE_IP6) {\r
      Status = NetLibStrToIp6 (ValueStr, &SrcAddress);\r
    } else {\r
      Status = NetLibStrToIp4 (ValueStr, (EFI_IPv4_ADDRESS *)&SrcAddress);\r
    }\r
\r
    if (EFI_ERROR (Status)) {\r
      ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_GEN_PARAM_INV), gShellNetwork1HiiHandle, L"ping", ValueStr);\r
      ShellStatus = SHELL_INVALID_PARAMETER;\r
      goto ON_EXIT;\r
    }\r
  }\r
\r
  //\r
  // Parse the parameter of destination ip address.\r
  //\r
  NonOptionCount = ShellCommandLineGetCount (ParamPackage);\r
  if (NonOptionCount < 2) {\r
    ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_GEN_TOO_FEW), gShellNetwork1HiiHandle, L"ping");\r
    ShellStatus = SHELL_INVALID_PARAMETER;\r
    goto ON_EXIT;\r
  }\r
\r
  if (NonOptionCount > 2) {\r
    ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_GEN_TOO_MANY), gShellNetwork1HiiHandle, L"ping");\r
    ShellStatus = SHELL_INVALID_PARAMETER;\r
    goto ON_EXIT;\r
  }\r
\r
  ValueStr = ShellCommandLineGetRawValue (ParamPackage, 1);\r
  if (ValueStr != NULL) {\r
    mDstString = ValueStr;\r
    if (IpChoice == PING_IP_CHOICE_IP6) {\r
      Status = NetLibStrToIp6 (ValueStr, &DstAddress);\r
    } else {\r
      Status = NetLibStrToIp4 (ValueStr, (EFI_IPv4_ADDRESS *)&DstAddress);\r
    }\r
\r
    if (EFI_ERROR (Status)) {\r
      ShellPrintHiiEx (-1, -1, NULL, STRING_TOKEN (STR_GEN_PARAM_INV), gShellNetwork1HiiHandle, L"ping", ValueStr);\r
      ShellStatus = SHELL_INVALID_PARAMETER;\r
      goto ON_EXIT;\r
    }\r
  }\r
\r
  //\r
  // Enter into ping process.\r
  //\r
  ShellStatus = ShellPing (\r
                  (UINT32)SendNumber,\r
                  (UINT32)BufferSize,\r
                  &SrcAddress,\r
                  &DstAddress,\r
                  IpChoice\r
                  );\r
\r
ON_EXIT:\r
  ShellCommandLineFreeVarList (ParamPackage);\r
  return ShellStatus;\r
}\r