Fix a bug for vlan ping failure.

[mirror_edk2.git] / MdeModulePkg / Universal / Network / UefiPxeBcDxe / PxeBcSupport.c

/** @file\r
  Support routines for PxeBc.\r
\r
Copyright (c) 2007 - 2011, Intel Corporation. All rights reserved.<BR>\r
This program and the accompanying materials\r
are licensed and made available under the terms and conditions of the BSD License\r
which accompanies this distribution.  The full text of the license may be found at\r
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
\r
#include "PxeBcImpl.h"\r
\r
\r
/**\r
  The common notify function associated with various PxeBc events.\r
\r
  @param  Event     The event signaled.\r
  @param  Context   The context.\r
\r
**/\r
VOID\r
EFIAPI\r
PxeBcCommonNotify (\r
  IN EFI_EVENT           Event,\r
  IN VOID                *Context\r
  )\r
{\r
  *((BOOLEAN *) Context) = TRUE;\r
}\r
\r
\r
/**\r
  This function initialize(or configure) the Udp4Write instance.\r
\r
  @param  Udp4       Pointer to the EFI_UDP4_PROTOCOL instance.\r
  @param  StationIp  Pointer to the station ip address.\r
  @param  SubnetMask Pointer to the subnetmask of the station ip address.\r
  @param  Gateway    Pointer to the gateway ip address.\r
  @param  SrcPort    Pointer to the srouce port of the station.\r
\r
  @retval EFI_SUCCESS           The configuration settings were set, changed, or reset successfully.\r
  @retval EFI_NO_MAPPING        When using a default address, configuration (DHCP, BOOTP,\r
                                RARP, etc.) is not finished yet.\r
  @retval EFI_INVALID_PARAMETER One or more following conditions are TRUE:\r
  @retval EFI_ALREADY_STARTED   The EFI UDPv4 Protocol instance is already started/configured\r
                                and must be stopped/reset before it can be reconfigured.\r
  @retval EFI_ACCESS_DENIED     UdpConfigData. AllowDuplicatePort is FALSE\r
                                and UdpConfigData.StationPort is already used by\r
                                other instance.\r
  @retval EFI_OUT_OF_RESOURCES  The EFI UDPv4 Protocol driver cannot allocate memory for this\r
                                EFI UDPv4 Protocol instance.\r
  @retval EFI_DEVICE_ERROR      An unexpected network or system error occurred and this instance\r
                                was not opened.\r
  @retval Others                Please examine the function Udp4->Routes(Udp4, FALSE, &mZeroIp4Addr, &mZeroIp4Addr, Gateway) returns.\r
\r
**/\r
EFI_STATUS\r
PxeBcConfigureUdpWriteInstance (\r
  IN EFI_UDP4_PROTOCOL  *Udp4,\r
  IN EFI_IPv4_ADDRESS   *StationIp,\r
  IN EFI_IPv4_ADDRESS   *SubnetMask,\r
  IN EFI_IPv4_ADDRESS   *Gateway,\r
  IN OUT UINT16         *SrcPort\r
  )\r
{\r
  EFI_UDP4_CONFIG_DATA  Udp4CfgData;\r
  EFI_STATUS            Status;\r
\r
  ZeroMem (&Udp4CfgData, sizeof (Udp4CfgData));\r
\r
  Udp4CfgData.ReceiveTimeout = PXEBC_DEFAULT_LIFETIME;\r
  Udp4CfgData.TypeOfService  = DEFAULT_ToS;\r
  Udp4CfgData.TimeToLive     = DEFAULT_TTL;\r
  Udp4CfgData.AllowDuplicatePort = TRUE;\r
\r
  CopyMem (&Udp4CfgData.StationAddress, StationIp, sizeof (*StationIp));\r
  CopyMem (&Udp4CfgData.SubnetMask, SubnetMask, sizeof (*SubnetMask));\r
\r
  Udp4CfgData.StationPort    = *SrcPort;\r
\r
  //\r
  // Reset the instance.\r
  //\r
  Udp4->Configure (Udp4, NULL);\r
\r
  Status = Udp4->Configure (Udp4, &Udp4CfgData);\r
  if (!EFI_ERROR (Status) && (Gateway->Addr[0] != 0)) {\r
    //\r
    // basic configuration OK, need to add the default route entry\r
    //\r
    Status = Udp4->Routes (Udp4, FALSE, &mZeroIp4Addr, &mZeroIp4Addr, Gateway);\r
    if (EFI_ERROR (Status)) {\r
      //\r
      // roll back\r
      //\r
      Udp4->Configure (Udp4, NULL);\r
    }\r
  }\r
\r
  if (!EFI_ERROR (Status) && (*SrcPort == 0)) {\r
    Udp4->GetModeData (Udp4, &Udp4CfgData, NULL, NULL, NULL);\r
    *SrcPort = Udp4CfgData.StationPort;\r
  }\r
\r
  return Status;\r
}\r
\r
\r
/**\r
  Convert number to ASCII value.\r
\r
  @param  Number              Numeric value to convert to decimal ASCII value.\r
  @param  Buffer              Buffer to place ASCII version of the Number.\r
  @param  Length              Length of Buffer.\r
\r
**/\r
VOID\r
CvtNum (\r
  IN UINTN  Number,\r
  IN UINT8  *Buffer,\r
  IN UINTN   Length\r
  )\r
{\r
  UINTN Remainder;\r
\r
  while (Length > 0) {\r
    Remainder = Number % 10;\r
    Number /= 10;\r
    Length--;\r
    Buffer[Length] = (UINT8) ('0' + Remainder);\r
  }\r
}\r
\r
\r
/**\r
  Convert unsigned int number to decimal number.\r
\r
  @param  Number   The unsigned int number will be converted.\r
  @param  Buffer   Pointer to the buffer to store the decimal number after transform.\r
\r
  @return the length of the number after transform.\r
\r
**/\r
UINTN\r
UtoA10 (\r
  IN UINTN Number,\r
  IN CHAR8 *Buffer\r
  )\r
{\r
  UINTN Index;\r
  CHAR8 TempStr[64];\r
\r
  Index           = 63;\r
  TempStr[Index]  = 0;\r
\r
  do {\r
    Index--;\r
    TempStr[Index]  = (CHAR8) ('0' + (Number % 10));\r
    Number          = Number / 10;\r
  } while (Number != 0);\r
\r
  AsciiStrCpy (Buffer, &TempStr[Index]);\r
\r
  return AsciiStrLen (Buffer);\r
}\r
\r
\r
/**\r
  Convert ASCII numeric string to a UINTN value.\r
\r
  @param  Buffer  Pointer to the 8-byte unsigned int value.\r
\r
  @return UINTN value of the ASCII string.\r
\r
**/\r
UINT64\r
AtoU64 (\r
  IN UINT8 *Buffer\r
  )\r
{\r
  UINT64  Value;\r
  UINT8   Character;\r
\r
  Value = 0;\r
  while ((Character = *Buffer++) != '\0') {\r
    Value = MultU64x32 (Value, 10) + (Character - '0');\r
  }\r
\r
  return Value;\r
}\r
\r