]> git.proxmox.com Git - mirror_edk2.git/blobdiff - EmbeddedPkg/Drivers/Lan9118Dxe/Lan9118Dxe.c
EmbeddedPkg: Fix typos in comments
[mirror_edk2.git] / EmbeddedPkg / Drivers / Lan9118Dxe / Lan9118Dxe.c
index b269c60f39eb73fa8d39bfcc6a6dbb346121d4d2..bdc390f352480bdf751c586ce950d12dc62d69f7 100644 (file)
@@ -14,7 +14,6 @@
 \r
 #include "Lan9118Dxe.h"\r
 \r
-\r
 typedef struct {\r
   MAC_ADDR_DEVICE_PATH      Lan9118;\r
   EFI_DEVICE_PATH_PROTOCOL  End;\r
@@ -99,16 +98,25 @@ Lan9118DxeEntry (
   SnpMode->NvRamSize = 0;           // No NVRAM with this device\r
   SnpMode->NvRamAccessSize = 0; // No NVRAM with this device\r
 \r
-  // Update network mode information\r
-  SnpMode->ReceiveFilterMask = EFI_SIMPLE_NETWORK_RECEIVE_MULTICAST |\r
-                                 EFI_SIMPLE_NETWORK_RECEIVE_UNICAST |\r
-                                 EFI_SIMPLE_NETWORK_RECEIVE_BROADCAST |\r
-                                 EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS;/* |\r
-                                 EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS_MULTICAST;*/\r
-  // Current allowed settings\r
-  SnpMode->ReceiveFilterSetting = EFI_SIMPLE_NETWORK_RECEIVE_MULTICAST |\r
-                                    EFI_SIMPLE_NETWORK_RECEIVE_UNICAST |\r
-                                    EFI_SIMPLE_NETWORK_RECEIVE_BROADCAST;\r
+  //\r
+  // Claim that all receive filter settings are supported, though the MULTICAST mode\r
+  // is not completely supported. The LAN9118 Ethernet controller is only able to\r
+  // do a "hash filtering" and not a perfect filtering on multicast addresses. The\r
+  // controller does not filter the multicast addresses directly but a hash value\r
+  // of them. The hash value of a multicast address is derived from its CRC and\r
+  // ranges from 0 to 63 included.\r
+  // We claim that the perfect MULTICAST filtering mode is supported because\r
+  // we do not want the user to switch directly to the PROMISCOUS_MULTICAST mode\r
+  // and thus not being able to take advantage of the hash filtering.\r
+  //\r
+  SnpMode->ReceiveFilterMask = EFI_SIMPLE_NETWORK_RECEIVE_UNICAST              |\r
+                               EFI_SIMPLE_NETWORK_RECEIVE_MULTICAST            |\r
+                               EFI_SIMPLE_NETWORK_RECEIVE_BROADCAST            |\r
+                               EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS          |\r
+                               EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS_MULTICAST;\r
+\r
+  // We do not intend to receive anything for the time being.\r
+  SnpMode->ReceiveFilterSetting = 0;\r
 \r
   // LAN9118 has 64bit hash table, can filter 64 MCast MAC Addresses\r
   SnpMode->MaxMCastFilterCount = MAX_MCAST_FILTER_CNT;\r
@@ -134,7 +142,7 @@ Lan9118DxeEntry (
   // Power up the device so we can find the MAC address\r
   Status = Lan9118Initialize (Snp);\r
   if (EFI_ERROR (Status)) {\r
-    DEBUG ((EFI_D_ERROR, "Lan9118: Error initialising hardware\n"));\r
+    DEBUG ((EFI_D_ERROR, "LAN9118: Error initialising hardware\n"));\r
     return EFI_DEVICE_ERROR;\r
   }\r
 \r
@@ -175,7 +183,7 @@ Lan9118DxeEntry (
 EFI_STATUS\r
 EFIAPI\r
 SnpStart (\r
-  IN        EFI_SIMPLE_NETWORK_PROTOCOL* Snp\r
+  IN  EFI_SIMPLE_NETWORK_PROTOCOL  *Snp\r
  )\r
 {\r
   // Check Snp instance\r
@@ -184,10 +192,9 @@ SnpStart (
   }\r
 \r
   // Check state\r
-  if ((Snp->Mode->State == EfiSimpleNetworkStarted) || (Snp->Mode->State == EfiSimpleNetworkInitialized)) {\r
+  if ((Snp->Mode->State == EfiSimpleNetworkStarted)    ||\r
+      (Snp->Mode->State == EfiSimpleNetworkInitialized)  ) {\r
     return EFI_ALREADY_STARTED;\r
-  } else if (Snp->Mode->State == EfiSimpleNetworkMaxState) {\r
-    return EFI_DEVICE_ERROR;\r
   }\r
 \r
   // Change state\r
@@ -211,7 +218,7 @@ SnpStop (
   }\r
 \r
   // Check state of the driver\r
-  if ((Snp->Mode->State == EfiSimpleNetworkStopped) || (Snp->Mode->State == EfiSimpleNetworkMaxState)) {\r
+  if (Snp->Mode->State == EfiSimpleNetworkStopped) {\r
     return EFI_NOT_STARTED;\r
   }\r
 \r
@@ -275,7 +282,7 @@ SnpInitialize (
   }\r
 \r
   // Initiate a PHY reset\r
-  Status = PhySoftReset (PHY_RESET_PMT | PHY_RESET_CHECK_LINK, Snp);\r
+  Status = PhySoftReset (PHY_RESET_PMT, Snp);\r
   if (EFI_ERROR (Status)) {\r
     Snp->Mode->State = EfiSimpleNetworkStopped;\r
     DEBUG ((EFI_D_WARN, "Warning: Link not ready after TimeOut. Check ethernet cable\n"));\r
@@ -290,7 +297,7 @@ SnpInitialize (
   }\r
 \r
   // Read the PM register\r
-  PmConf = MmioRead32 (LAN9118_PMT_CTRL);\r
+  PmConf = Lan9118MmioRead32 (LAN9118_PMT_CTRL);\r
 \r
   // MPTCTRL_WOL_EN: Allow Wake-On-Lan to detect wake up frames or magic packets\r
   // MPTCTRL_ED_EN:  Allow energy detection to allow lowest power consumption mode\r
@@ -299,9 +306,7 @@ SnpInitialize (
   PmConf |= (MPTCTRL_WOL_EN | MPTCTRL_ED_EN | MPTCTRL_PME_EN);\r
 \r
   // Write the current configuration to the register\r
-  MmioWrite32 (LAN9118_PMT_CTRL, PmConf);\r
-  gBS->Stall (LAN9118_STALL);\r
-  gBS->Stall (LAN9118_STALL);\r
+  Lan9118MmioWrite32 (LAN9118_PMT_CTRL, PmConf);\r
 \r
   // Configure GPIO and HW\r
   Status = ConfigureHardware (HW_CONF_USE_LEDS, Snp);\r
@@ -336,7 +341,7 @@ SnpInitialize (
   // Do auto-negotiation if supported\r
   Status = AutoNegotiate (AUTO_NEGOTIATE_ADVERTISE_ALL, Snp);\r
   if (EFI_ERROR(Status)) {\r
-    DEBUG ((EFI_D_WARN, "Lan9118: Auto Negociation not supported.\n"));\r
+    DEBUG ((EFI_D_WARN, "LAN9118: Auto Negotiation failed.\n"));\r
   }\r
 \r
   // Configure flow control depending on speed capabilities\r
@@ -345,19 +350,14 @@ SnpInitialize (
     return Status;\r
   }\r
 \r
-  // Enable the receiver and transmitter\r
-  Status = StartRx (0, Snp);\r
-  if (EFI_ERROR(Status)) {\r
-    return Status;\r
-  }\r
-\r
+  // Enable the transmitter\r
   Status = StartTx (START_TX_MAC | START_TX_CFG, Snp);\r
   if (EFI_ERROR(Status)) {\r
     return Status;\r
   }\r
 \r
   // Now acknowledge all interrupts\r
-  MmioWrite32 (LAN9118_INT_STS, ~0);\r
+  Lan9118MmioWrite32 (LAN9118_INT_STS, ~0);\r
 \r
   // Declare the driver as initialized\r
   Snp->Mode->State = EfiSimpleNetworkInitialized;\r
@@ -400,7 +400,7 @@ SnpReset (
   }\r
 \r
   // Initiate a PHY reset\r
-  Status = PhySoftReset (PHY_RESET_PMT | PHY_RESET_CHECK_LINK, Snp);\r
+  Status = PhySoftReset (PHY_RESET_PMT, Snp);\r
   if (EFI_ERROR (Status)) {\r
     Snp->Mode->State = EfiSimpleNetworkStopped;\r
     return EFI_NOT_STARTED;\r
@@ -420,7 +420,7 @@ SnpReset (
   }\r
 \r
   // Read the PM register\r
-  PmConf = MmioRead32 (LAN9118_PMT_CTRL);\r
+  PmConf = Lan9118MmioRead32 (LAN9118_PMT_CTRL);\r
 \r
   // MPTCTRL_WOL_EN: Allow Wake-On-Lan to detect wake up frames or magic packets\r
   // MPTCTRL_ED_EN:  Allow energy detection to allow lowest power consumption mode\r
@@ -428,17 +428,21 @@ SnpReset (
   PmConf |= (MPTCTRL_WOL_EN | MPTCTRL_ED_EN | MPTCTRL_PME_EN);\r
 \r
   // Write the current configuration to the register\r
-  MmioWrite32 (LAN9118_PMT_CTRL, PmConf);\r
-  gBS->Stall (LAN9118_STALL);\r
+  Lan9118MmioWrite32 (LAN9118_PMT_CTRL, PmConf);\r
+\r
+  // Reactivate the LEDs\r
+  Status = ConfigureHardware (HW_CONF_USE_LEDS, Snp);\r
+  if (EFI_ERROR (Status)) {\r
+    return Status;\r
+  }\r
 \r
   // Check that a buffer size was specified in SnpInitialize\r
   if (gTxBuffer != 0) {\r
-    HwConf = MmioRead32 (LAN9118_HW_CFG);        // Read the HW register\r
+    HwConf = Lan9118MmioRead32 (LAN9118_HW_CFG);        // Read the HW register\r
     HwConf &= ~HW_CFG_TX_FIFO_SIZE_MASK;         // Clear buffer bits first\r
     HwConf |= HW_CFG_TX_FIFO_SIZE(gTxBuffer);    // assign size chosen in SnpInitialize\r
 \r
-    MmioWrite32 (LAN9118_HW_CFG, HwConf);        // Write the conf\r
-    gBS->Stall (LAN9118_STALL);\r
+    Lan9118MmioWrite32 (LAN9118_HW_CFG, HwConf);        // Write the conf\r
   }\r
 \r
   // Enable the receiver and transmitter and clear their contents\r
@@ -446,7 +450,7 @@ SnpReset (
   StartTx (START_TX_MAC | START_TX_CFG | START_TX_CLEAR, Snp);\r
 \r
   // Now acknowledge all interrupts\r
-  MmioWrite32 (LAN9118_INT_STS, ~0);\r
+  Lan9118MmioWrite32 (LAN9118_INT_STS, ~0);\r
 \r
   return EFI_SUCCESS;\r
 }\r
@@ -473,7 +477,7 @@ SnpShutdown (
     DEBUG ((EFI_D_WARN, "Warning: LAN9118 Driver not yet initialized\n"));\r
     return EFI_DEVICE_ERROR;\r
   } else if (Snp->Mode->State == EfiSimpleNetworkStopped) {\r
-    DEBUG ((EFI_D_WARN, "Warning: LAN9118 Driver in stopped state\n"));\r
+    DEBUG ((EFI_D_WARN, "Warning: LAN9118 Driver not started\n"));\r
     return EFI_NOT_STARTED;\r
   }\r
 \r
@@ -490,167 +494,250 @@ SnpShutdown (
     return Status;\r
   }\r
 \r
+  // Back to the started and thus not initialized state\r
+  Snp->Mode->State = EfiSimpleNetworkStarted;\r
+\r
   return EFI_SUCCESS;\r
 }\r
 \r
+/**\r
+  Enable and/or disable the receive filters of the LAN9118\r
+\r
+  Please refer to the UEFI specification for the precedence rules among the\r
+  Enable, Disable and ResetMCastFilter parameters.\r
+\r
+  @param[in]  Snp               A pointer to the EFI_SIMPLE_NETWORK_PROTOCOL\r
+                                instance.\r
+  @param[in]  Enable            A bit mask of receive filters to enable.\r
+  @param[in]  Disable           A bit mask of receive filters to disable.\r
+  @param[in]  ResetMCastFilter  Set to TRUE to reset the contents of the multicast\r
+                                receive filters on the network interface to\r
+                                their default values.\r
+  @param[in]  MCastFilterCnt    Number of multicast HW MAC addresses in the new\r
+                                MCastFilter list. This value must be less than or\r
+                                equal to the MCastFilterCnt field of\r
+                                EFI_SIMPLE_NETWORK_MODE. This field is optional if\r
+                                ResetMCastFilter is TRUE.\r
+  @param[in]  MCastFilter       A pointer to a list of new multicast receive\r
+                                filter HW MAC addresses. This list will replace\r
+                                any existing multicast HW MAC address list. This\r
+                                field is optional if ResetMCastFilter is TRUE.\r
+\r
+  @retval  EFI_SUCCESS            The receive filters of the LAN9118 were updated.\r
+  @retval  EFI_NOT_STARTED        The LAN9118 has not been started.\r
+  @retval  EFI_INVALID_PARAMETER  One or more of the following conditions is TRUE :\r
+                                  . This is NULL\r
+                                  . Multicast is being enabled (the\r
+                                    EFI_SIMPLE_NETWORK_RECEIVE_MULTICAST bit is set in\r
+                                    Enable, it is not set in Disable, and ResetMCastFilter\r
+                                    is FALSE) and MCastFilterCount is zero.\r
+                                  . Multicast is being enabled and MCastFilterCount is\r
+                                    greater than Snp->Mode->MaxMCastFilterCount.\r
+                                  . Multicast is being enabled and MCastFilter is NULL\r
+                                  . Multicast is being enabled and one or more of the\r
+                                    addresses in the MCastFilter list are not valid\r
+                                    multicast MAC addresses.\r
+  @retval  EFI_DEVICE_ERROR       The LAN9118 has been started but not initialized.\r
 \r
-/*\r
- *  UEFI ReceiveFilters() function\r
- *\r
- */\r
+**/\r
 EFI_STATUS\r
 EFIAPI\r
 SnpReceiveFilters (\r
-  IN        EFI_SIMPLE_NETWORK_PROTOCOL* Snp,\r
-  IN        UINT32 Enable,\r
-  IN        UINT32 Disable,\r
-  IN        BOOLEAN Reset,\r
-  IN        UINTN NumMfilter          OPTIONAL,\r
-  IN        EFI_MAC_ADDRESS *Mfilter  OPTIONAL\r
+  IN  EFI_SIMPLE_NETWORK_PROTOCOL  *Snp,\r
+  IN  UINT32                       Enable,\r
+  IN  UINT32                       Disable,\r
+  IN  BOOLEAN                      ResetMCastFilter,\r
+  IN  UINTN                        MCastFilterCnt  OPTIONAL,\r
+  IN  EFI_MAC_ADDRESS              *MCastFilter  OPTIONAL\r
   )\r
 {\r
-  UINT32 MacCSRValue;\r
-  UINT32 MultHashTableHigh;\r
-  UINT32 MultHashTableLow;\r
-  UINT32 Crc;\r
-  UINT8 BitToSelect;\r
-  UINT32 Count;\r
+  EFI_SIMPLE_NETWORK_MODE  *Mode;\r
+  UINT32                   MultHashTableHigh;\r
+  UINT32                   MultHashTableLow;\r
+  UINT32                   Count;\r
+  UINT32                   Crc;\r
+  UINT8                    HashValue;\r
+  UINT32                   MacCSRValue;\r
+  UINT32                   ReceiveFilterSetting;\r
+  EFI_MAC_ADDRESS          *Mac;\r
+  EFI_MAC_ADDRESS          ZeroMac;\r
 \r
-  MacCSRValue = 0;\r
-  MultHashTableHigh = 0;\r
-  MultHashTableLow = 0;\r
-  Crc = 0xFFFFFFFF;\r
-  BitToSelect = 0;\r
-  Count = 0;\r
+  // Check Snp Instance\r
+  if (Snp == NULL) {\r
+    return EFI_INVALID_PARAMETER;\r
+  }\r
+  Mode = Snp->Mode;\r
 \r
   // Check that driver was started and initialised\r
-  if (Snp->Mode->State == EfiSimpleNetworkStarted) {\r
+  if (Mode->State == EfiSimpleNetworkStarted) {\r
     DEBUG ((EFI_D_WARN, "Warning: LAN9118 Driver not initialized\n"));\r
     return EFI_DEVICE_ERROR;\r
-  } else if (Snp->Mode->State == EfiSimpleNetworkStopped) {\r
+  } else if (Mode->State == EfiSimpleNetworkStopped) {\r
     DEBUG ((EFI_D_WARN, "Warning: LAN9118 Driver in stopped state\n"));\r
     return EFI_NOT_STARTED;\r
   }\r
 \r
-  // If reset then clear the filter registers\r
-  if (Reset) {\r
-    Enable |= EFI_SIMPLE_NETWORK_RECEIVE_MULTICAST;\r
-    IndirectMACWrite32 (INDIRECT_MAC_INDEX_HASHL, 0x00000000);\r
-    IndirectMACWrite32 (INDIRECT_MAC_INDEX_HASHH, 0x00000000);\r
+  if ((Enable  & (~Mode->ReceiveFilterMask)) ||\r
+      (Disable & (~Mode->ReceiveFilterMask))    ) {\r
+    return EFI_INVALID_PARAMETER;\r
   }\r
 \r
-  // Set the hash tables\r
-  if ((NumMfilter > 0) && (!Reset)) {\r
-\r
-    // Read the Multicast High Hash Table\r
-    MultHashTableHigh = IndirectMACRead32 (INDIRECT_MAC_INDEX_HASHH);\r
+  //\r
+  // Check the validity of the multicast setting and compute the\r
+  // hash values of the multicast mac addresses to listen to.\r
+  //\r
 \r
-    // Read the Multicast Low Hash Table\r
-    MultHashTableLow = IndirectMACRead32 (INDIRECT_MAC_INDEX_HASHL);\r
+  MultHashTableHigh = 0;\r
+  MultHashTableLow  = 0;\r
+  if ((!ResetMCastFilter)                                     &&\r
+      ((Disable & EFI_SIMPLE_NETWORK_RECEIVE_MULTICAST) == 0) &&\r
+      ((Enable  & EFI_SIMPLE_NETWORK_RECEIVE_MULTICAST) != 0)    ) {\r
+    if ((MCastFilterCnt == 0)                        ||\r
+        (MCastFilterCnt > Mode->MaxMCastFilterCount) ||\r
+        (MCastFilter == NULL)                           ) {\r
+      return EFI_INVALID_PARAMETER;\r
+    }\r
+    //\r
+    // Check the validity of all multicast addresses before to change\r
+    // anything.\r
+    //\r
+    for (Count = 0; Count < MCastFilterCnt; Count++) {\r
+      if ((MCastFilter[Count].Addr[0] & 1) == 0) {\r
+        return EFI_INVALID_PARAMETER;\r
+      }\r
+    }\r
 \r
+    //\r
     // Go through each filter address and set appropriate bits on hash table\r
-    for (Count = 0; Count < NumMfilter; Count++) {\r
+    //\r
+    for (Count = 0; Count < MCastFilterCnt; Count++) {\r
+      Mac = &(MCastFilter[Count]);\r
+      CopyMem (&Mode->MCastFilter[Count], Mac, sizeof(EFI_MAC_ADDRESS));\r
 \r
-      // Generate a 32-bit CRC for Ethernet\r
-      Crc = GenEtherCrc32 (&Mfilter[Count],6);\r
+      Crc = GenEtherCrc32 (Mac, NET_ETHER_ADDR_LEN);\r
       //gBS->CalculateCrc32 ((VOID*)&Mfilter[Count],6,&Crc); <-- doesn't work as desired\r
 \r
-      // Get the most significant 6 bits to index hash registers\r
-      BitToSelect = (Crc >> 26) & 0x3F;\r
+      //\r
+      // The most significant 6 bits of the MAC address CRC constitute the hash\r
+      // value of the MAC address.\r
+      //\r
+      HashValue = (Crc >> 26) & 0x3F;\r
 \r
       // Select hashlow register if MSB is not set\r
-      if ((BitToSelect & 0x20) == 0) {\r
-        MultHashTableLow |= (1 << BitToSelect);\r
+      if ((HashValue & 0x20) == 0) {\r
+        MultHashTableLow |= (1 << HashValue);\r
       } else {\r
-        MultHashTableHigh |= (1 << (BitToSelect & 0x1F));\r
+        MultHashTableHigh |= (1 << (HashValue & 0x1F));\r
       }\r
     }\r
-\r
-    // Write the desired hash\r
-    IndirectMACWrite32 (INDIRECT_MAC_INDEX_HASHL, MultHashTableLow);\r
-    IndirectMACWrite32 (INDIRECT_MAC_INDEX_HASHH, MultHashTableHigh);\r
+    Mode->MCastFilterCount = MCastFilterCnt;\r
+  } else if (ResetMCastFilter) {\r
+    Mode->MCastFilterCount = 0;\r
+  } else {\r
+    MultHashTableLow  = IndirectMACRead32 (INDIRECT_MAC_INDEX_HASHL);\r
+    MultHashTableHigh = IndirectMACRead32 (INDIRECT_MAC_INDEX_HASHH);\r
   }\r
 \r
+  //\r
+  // Before to change anything, stop and reset the reception of\r
+  // packets.\r
+  //\r
+  StopRx (STOP_RX_CLEAR, Snp);\r
+\r
+  //\r
+  // Write the mask of the selected hash values for the multicast filtering.\r
+  // The two masks are set to zero if the multicast filtering is not enabled.\r
+  //\r
+  IndirectMACWrite32 (INDIRECT_MAC_INDEX_HASHL, MultHashTableLow);\r
+  IndirectMACWrite32 (INDIRECT_MAC_INDEX_HASHH, MultHashTableHigh);\r
+\r
+  ReceiveFilterSetting = (Mode->ReceiveFilterSetting | Enable) & (~Disable);\r
+\r
+  //\r
   // Read MAC controller\r
-  MacCSRValue = IndirectMACRead32 (INDIRECT_MAC_INDEX_CR);\r
+  //\r
+  MacCSRValue  = IndirectMACRead32 (INDIRECT_MAC_INDEX_CR);\r
+  MacCSRValue &= ~(MACCR_HPFILT | MACCR_BCAST | MACCR_PRMS | MACCR_MCPAS);\r
 \r
-  // Set the options for the MAC_CSR\r
-  if (Enable & EFI_SIMPLE_NETWORK_RECEIVE_UNICAST) {\r
-    StartRx (0, Snp);\r
+  if (ReceiveFilterSetting & EFI_SIMPLE_NETWORK_RECEIVE_UNICAST) {\r
+    Lan9118SetMacAddress (&Mode->CurrentAddress, Snp);\r
     DEBUG ((DEBUG_NET, "Allowing Unicast Frame Reception\n"));\r
+  } else {\r
+    //\r
+    // The Unicast packets do not have to be listen to, set the MAC\r
+    // address of the LAN9118 to be the "not configured" all zeroes\r
+    // ethernet MAC address.\r
+    //\r
+    ZeroMem (&ZeroMac, NET_ETHER_ADDR_LEN);\r
+    Lan9118SetMacAddress (&ZeroMac, Snp);\r
   }\r
 \r
-  if (Disable & EFI_SIMPLE_NETWORK_RECEIVE_UNICAST) {\r
-    StopRx (0, Snp);\r
-    DEBUG ((DEBUG_NET, "Disabling Unicast Frame Reception\n"));\r
-  }\r
-\r
-  if (Enable & EFI_SIMPLE_NETWORK_RECEIVE_MULTICAST) {\r
+  if (ReceiveFilterSetting & EFI_SIMPLE_NETWORK_RECEIVE_MULTICAST) {\r
     MacCSRValue |= MACCR_HPFILT;\r
     DEBUG ((DEBUG_NET, "Allowing Multicast Frame Reception\n"));\r
   }\r
 \r
-  if (Disable & EFI_SIMPLE_NETWORK_RECEIVE_MULTICAST) {\r
-    MacCSRValue &= ~MACCR_HPFILT;\r
-    DEBUG ((DEBUG_NET, "Disabling Multicast Frame Reception\n"));\r
-  }\r
-\r
-  if (Enable & EFI_SIMPLE_NETWORK_RECEIVE_BROADCAST) {\r
-    MacCSRValue &= ~(MACCR_BCAST);\r
-    DEBUG ((DEBUG_NET, "Allowing Broadcast Frame Reception\n"));\r
+  if (ReceiveFilterSetting & EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS_MULTICAST) {\r
+    MacCSRValue |= MACCR_MCPAS;\r
+    DEBUG ((DEBUG_NET, "Enabling Promiscuous Multicast Mode\n"));\r
   }\r
 \r
-  if (Disable & EFI_SIMPLE_NETWORK_RECEIVE_BROADCAST) {\r
+  if ((ReceiveFilterSetting & EFI_SIMPLE_NETWORK_RECEIVE_BROADCAST) == 0) {\r
     MacCSRValue |= MACCR_BCAST;\r
-    DEBUG ((DEBUG_NET, "Disabling Broadcast Frame Reception\n"));\r
+  } else {\r
+    DEBUG ((DEBUG_NET, "Allowing Broadcast Frame Reception\n"));\r
   }\r
 \r
-  if (Enable & EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS) {\r
+  if (ReceiveFilterSetting & EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS) {\r
     MacCSRValue |= MACCR_PRMS;\r
     DEBUG ((DEBUG_NET, "Enabling Promiscuous Mode\n"));\r
   }\r
 \r
-  if (Disable & EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS) {\r
-    MacCSRValue &= ~MACCR_PRMS;\r
-    DEBUG ((DEBUG_NET, "Disabling Promiscuous Mode\n"));\r
-  }\r
-\r
-  if (Enable & EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS_MULTICAST) {\r
-    MacCSRValue |= (MACCR_HPFILT | MACCR_PRMS);\r
-    DEBUG ((DEBUG_NET, "Enabling Promiscuous Multicast Mode\n"));\r
-  }\r
-\r
-  if (Disable & EFI_SIMPLE_NETWORK_RECEIVE_PROMISCUOUS_MULTICAST) {\r
-    MacCSRValue &= ~(MACCR_HPFILT | MACCR_PRMS);\r
-    DEBUG ((DEBUG_NET, "Disabling Promiscuous Multicast Mode\n"));\r
-  }\r
-\r
+  //\r
   // Write the options to the MAC_CSR\r
+  //\r
   IndirectMACWrite32 (INDIRECT_MAC_INDEX_CR, MacCSRValue);\r
-  gBS->Stall (LAN9118_STALL);\r
+\r
+  //\r
+  // If we have to retrieve something, start packet reception.\r
+  //\r
+  Mode->ReceiveFilterSetting = ReceiveFilterSetting;\r
+  if (ReceiveFilterSetting != 0) {\r
+    StartRx (0, Snp);\r
+  }\r
 \r
   return EFI_SUCCESS;\r
 }\r
 \r
-/*\r
- *  UEFI StationAddress() function\r
- *\r
- */\r
+/**\r
+  Modify of reset the current station address\r
+\r
+  @param[in]  Snp               A pointer to the EFI_SIMPLE_NETWORK_PROTOCOL\r
+                                instance.\r
+  @param[in]  Reset             Flag used to reset the station address to the\r
+                                LAN9118's permanent address.\r
+  @param[in]  New               New station address to be used for the network interface.\r
+\r
+  @retval  EFI_SUCCESS            The LAN9118's station address was updated.\r
+  @retval  EFI_NOT_STARTED        The LAN9118 has not been started.\r
+  @retval  EFI_INVALID_PARAMETER  One or more of the following conditions is TRUE :\r
+                                  . The "New" station address is invalid.\r
+                                  . "Reset" is FALSE and "New" is NULL.\r
+  @retval  EFI_DEVICE_ERROR       The LAN9118 has been started but not initialized.\r
+\r
+**/\r
 EFI_STATUS\r
 EFIAPI\r
 SnpStationAddress (\r
-  IN        EFI_SIMPLE_NETWORK_PROTOCOL *Snp,\r
-  IN        BOOLEAN Reset,\r
-  IN        EFI_MAC_ADDRESS *NewMac\r
+  IN  EFI_SIMPLE_NETWORK_PROTOCOL  *Snp,\r
+  IN  BOOLEAN                      Reset,\r
+  IN  EFI_MAC_ADDRESS              *New\r
 )\r
 {\r
-  DEBUG ((DEBUG_NET, "SnpStationAddress()\n"));\r
-\r
   UINT32 Count;\r
-  UINT8  PermAddr[6];\r
-  UINT64 DefaultMacAddress;\r
+  UINT8  PermAddr[NET_ETHER_ADDR_LEN];\r
 \r
-  Count = 0;\r
+  DEBUG ((DEBUG_NET, "SnpStationAddress()\n"));\r
 \r
   // Check Snp instance\r
   if (Snp == NULL) {\r
@@ -670,25 +757,41 @@ SnpStationAddress (
   if (Reset) {\r
     // Try using EEPROM first. Read the first byte of data from EEPROM at the address 0x0\r
     if ((IndirectEEPROMRead32 (0) & 0xFF) == EEPROM_EXTERNAL_SERIAL_EEPROM) {\r
-      for (Count = 1; Count < 7; Count++) {\r
-        PermAddr[Count - 1] = IndirectEEPROMRead32 (Count);\r
+      for (Count = 0; Count < NET_ETHER_ADDR_LEN; Count++) {\r
+        PermAddr[Count] = IndirectEEPROMRead32 (Count + 1);\r
       }\r
-\r
-      // Write address\r
+      New = (EFI_MAC_ADDRESS *) PermAddr;\r
       Lan9118SetMacAddress ((EFI_MAC_ADDRESS *) PermAddr, Snp);\r
     } else {\r
-      DEBUG ((EFI_D_ERROR, "Lan9118: Warning: No valid MAC address in EEPROM, using fallback\n"));\r
-      DefaultMacAddress = FixedPcdGet64 (PcdLan9118DefaultMacAddress);\r
-      Lan9118SetMacAddress ((EFI_MAC_ADDRESS *) &DefaultMacAddress, Snp);\r
+      DEBUG ((EFI_D_ERROR, "LAN9118: Warning: No valid MAC address in EEPROM, using fallback\n"));\r
+      New = (EFI_MAC_ADDRESS*) (FixedPcdGet64 (PcdLan9118DefaultMacAddress));\r
     }\r
   } else {\r
     // Otherwise use the specified new MAC address\r
-    if (NewMac == NULL) {\r
+    if (New == NULL) {\r
+      return EFI_INVALID_PARAMETER;\r
+    }\r
+    //\r
+    // If it is a multicast address, it is not valid.\r
+    //\r
+    if (New->Addr[0] & 0x01) {\r
       return EFI_INVALID_PARAMETER;\r
     }\r
+  }\r
+\r
+  CopyMem (&Snp->Mode->CurrentAddress, New, NET_ETHER_ADDR_LEN);\r
 \r
-    // Write address\r
-    Lan9118SetMacAddress (NewMac, Snp);\r
+  //\r
+  // If packet reception is currently activated, stop and reset it,\r
+  // set the new ethernet address and restart the packet reception.\r
+  // Otherwise, nothing to do, the MAC address will be updated in\r
+  // SnpReceiveFilters() when the UNICAST packet reception will be\r
+  // activated.\r
+  //\r
+  if (Snp->Mode->ReceiveFilterSetting  != 0) {\r
+    StopRx (STOP_RX_CLEAR, Snp);\r
+    Lan9118SetMacAddress (New, Snp);\r
+    StartRx (0, Snp);\r
   }\r
 \r
   return EFI_SUCCESS;\r
@@ -707,7 +810,8 @@ SnpStatistics (
       OUT   EFI_NETWORK_STATISTICS *Statistics\r
   )\r
 {\r
-  LAN9118_DRIVER *LanDriver;\r
+  LAN9118_DRIVER  *LanDriver;\r
+  EFI_STATUS      Status;\r
 \r
   LanDriver = INSTANCE_FROM_SNP_THIS (Snp);\r
 \r
@@ -727,31 +831,39 @@ SnpStatistics (
     return EFI_NOT_STARTED;\r
   }\r
 \r
-  // Check pointless condition\r
-  if ((!Reset) && (StatSize == NULL) && (Statistics == NULL)) {\r
-    return EFI_SUCCESS;\r
-  }\r
-\r
-  // Check the parameters\r
-  if ((StatSize == NULL) && (Statistics != NULL)) {\r
-    return EFI_INVALID_PARAMETER;\r
-  }\r
-\r
-  // Do a reset if required\r
+  //\r
+  // Do a reset if required. It is not clearly stated in the UEFI specification\r
+  // whether the reset has to be done before to copy the statistics in "Statictics"\r
+  // or after. It is a bit strange to do it before but that is what is expected by\r
+  // the SCT test on Statistics() with reset : "0x3de76704,0x4bf5,0x42cd,0x8c,0x89,\r
+  // 0x54,0x7e,0x4f,0xad,0x4f,0x24".\r
+  //\r
   if (Reset) {\r
     ZeroMem (&LanDriver->Stats, sizeof(EFI_NETWORK_STATISTICS));\r
   }\r
 \r
-  // Check buffer size\r
-  if (*StatSize < sizeof(EFI_NETWORK_STATISTICS)) {\r
-    *StatSize = sizeof(EFI_NETWORK_STATISTICS);\r
-    return EFI_BUFFER_TOO_SMALL;\r
+  Status = EFI_SUCCESS;\r
+  if (StatSize == NULL) {\r
+    if (Statistics != NULL) {\r
+      return EFI_INVALID_PARAMETER;\r
+    }\r
+  } else {\r
+    if (Statistics == NULL) {\r
+      Status = EFI_BUFFER_TOO_SMALL;\r
+    } else {\r
+      // Fill in the statistics\r
+      CopyMem (\r
+        Statistics, &LanDriver->Stats,\r
+        MIN (*StatSize, sizeof (EFI_NETWORK_STATISTICS))\r
+        );\r
+      if (*StatSize < sizeof (EFI_NETWORK_STATISTICS)) {\r
+        Status = EFI_BUFFER_TOO_SMALL;\r
+      }\r
+    }\r
+    *StatSize = sizeof (EFI_NETWORK_STATISTICS);\r
   }\r
 \r
-  // Fill in the statistics\r
-  CopyMem (Statistics, &LanDriver->Stats, sizeof(EFI_NETWORK_STATISTICS));\r
-\r
-  return EFI_SUCCESS;\r
+  return Status;\r
 }\r
 \r
 /*\r
@@ -846,9 +958,9 @@ SnpNvData (
 EFI_STATUS\r
 EFIAPI\r
 SnpGetStatus (\r
-  IN        EFI_SIMPLE_NETWORK_PROTOCOL* Snp,\r
-      OUT   UINT32 *IrqStat  OPTIONAL,\r
-      OUT   VOID **TxBuff    OPTIONAL\r
+  IN   EFI_SIMPLE_NETWORK_PROTOCOL  *Snp,\r
+  OUT  UINT32                       *IrqStat  OPTIONAL,\r
+  OUT  VOID                         **TxBuff  OPTIONAL\r
   )\r
 {\r
   UINT32          FifoInt;\r
@@ -866,7 +978,12 @@ SnpGetStatus (
     return EFI_INVALID_PARAMETER;\r
   }\r
 \r
-  if (Snp->Mode->State != EfiSimpleNetworkInitialized) {\r
+  // Check that driver was started and initialised\r
+  if (Snp->Mode->State == EfiSimpleNetworkStarted) {\r
+    DEBUG ((EFI_D_WARN, "Warning: LAN9118 Driver not initialized\n"));\r
+    return EFI_DEVICE_ERROR;\r
+  } else if (Snp->Mode->State == EfiSimpleNetworkStopped) {\r
+    DEBUG ((EFI_D_WARN, "Warning: LAN9118 Driver in stopped state\n"));\r
     return EFI_NOT_STARTED;\r
   }\r
 \r
@@ -874,51 +991,46 @@ SnpGetStatus (
   // consumer of SNP does not call GetStatus.)\r
   // TODO will we lose TxStatuses if this happens? Maybe in SnpTransmit we\r
   // should check for it and dump the TX Status FIFO.\r
-  FifoInt = MmioRead32 (LAN9118_FIFO_INT);\r
+  FifoInt = Lan9118MmioRead32 (LAN9118_FIFO_INT);\r
 \r
   // Clear the TX Status FIFO Overflow\r
   if ((FifoInt & INSTS_TXSO) == 0) {\r
     FifoInt |= INSTS_TXSO;\r
-    MmioWrite32 (LAN9118_FIFO_INT, FifoInt);\r
+    Lan9118MmioWrite32 (LAN9118_FIFO_INT, FifoInt);\r
   }\r
 \r
   // Read interrupt status if IrqStat is not NULL\r
   if (IrqStat != NULL) {\r
+    *IrqStat = 0;\r
 \r
     // Check for receive interrupt\r
-    if (MmioRead32 (LAN9118_INT_STS) & INSTS_RSFL) { // Data moved from rx FIFO\r
+    if (Lan9118MmioRead32 (LAN9118_INT_STS) & INSTS_RSFL) { // Data moved from rx FIFO\r
       *IrqStat |= EFI_SIMPLE_NETWORK_RECEIVE_INTERRUPT;\r
-      MmioWrite32 (LAN9118_INT_STS,INSTS_RSFL);\r
-    } else {\r
-      *IrqStat &= ~EFI_SIMPLE_NETWORK_RECEIVE_INTERRUPT;\r
+      Lan9118MmioWrite32 (LAN9118_INT_STS,INSTS_RSFL);\r
     }\r
 \r
     // Check for transmit interrupt\r
-    if (MmioRead32 (LAN9118_INT_STS) & INSTS_TSFL) {\r
+    if (Lan9118MmioRead32 (LAN9118_INT_STS) & INSTS_TSFL) {\r
       *IrqStat |= EFI_SIMPLE_NETWORK_TRANSMIT_INTERRUPT;\r
-      MmioWrite32 (LAN9118_INT_STS,INSTS_TSFL);\r
-    } else {\r
-      *IrqStat &= ~EFI_SIMPLE_NETWORK_TRANSMIT_INTERRUPT;\r
+      Lan9118MmioWrite32 (LAN9118_INT_STS,INSTS_TSFL);\r
     }\r
 \r
     // Check for software interrupt\r
-    if (MmioRead32 (LAN9118_INT_STS) & INSTS_SW_INT) {\r
+    if (Lan9118MmioRead32 (LAN9118_INT_STS) & INSTS_SW_INT) {\r
       *IrqStat |= EFI_SIMPLE_NETWORK_SOFTWARE_INTERRUPT;\r
-      MmioWrite32 (LAN9118_INT_STS,INSTS_SW_INT);\r
-    } else {\r
-      *IrqStat &= ~EFI_SIMPLE_NETWORK_SOFTWARE_INTERRUPT;\r
+      Lan9118MmioWrite32 (LAN9118_INT_STS,INSTS_SW_INT);\r
     }\r
   }\r
 \r
   // Check Status of transmitted packets\r
   // (We ignore TXSTATUS_NO_CA has it might happen in Full Duplex)\r
 \r
-  NumTxStatusEntries = MmioRead32(LAN9118_TX_FIFO_INF) & TXFIFOINF_TXSUSED_MASK;\r
+  NumTxStatusEntries = Lan9118MmioRead32(LAN9118_TX_FIFO_INF) & TXFIFOINF_TXSUSED_MASK;\r
   if (NumTxStatusEntries > 0) {\r
-    TxStatus = MmioRead32 (LAN9118_TX_STATUS);\r
+    TxStatus = Lan9118MmioRead32 (LAN9118_TX_STATUS);\r
     PacketTag = TxStatus >> 16;\r
     TxStatus = TxStatus & 0xFFFF;\r
-    if ((TxStatus & TXSTATUS_ES) && TxStatus != (TXSTATUS_ES | TXSTATUS_NO_CA)) {\r
+    if ((TxStatus & TXSTATUS_ES) && (TxStatus != (TXSTATUS_ES | TXSTATUS_NO_CA))) {\r
       DEBUG ((EFI_D_ERROR, "LAN9118: There was an error transmitting. TxStatus=0x%08x:", TxStatus));\r
       if (TxStatus & TXSTATUS_NO_CA) {\r
         DEBUG ((EFI_D_ERROR, "- No carrier\n"));\r
@@ -939,30 +1051,41 @@ SnpGetStatus (
         DEBUG ((EFI_D_ERROR, "- Lost carrier during Tx\n"));\r
       }\r
       return EFI_DEVICE_ERROR;\r
-    } else {\r
+    } else if (TxBuff != NULL) {\r
       LanDriver->Stats.TxTotalFrames += 1;\r
       *TxBuff = LanDriver->TxRing[PacketTag % LAN9118_TX_RING_NUM_ENTRIES];\r
     }\r
+  } else if (TxBuff != NULL) {\r
+    *TxBuff = NULL;\r
   }\r
 \r
   // Check for a TX Error interrupt\r
-  Interrupts = MmioRead32 (LAN9118_INT_STS);\r
+  Interrupts = Lan9118MmioRead32 (LAN9118_INT_STS);\r
   if (Interrupts & INSTS_TXE) {\r
     DEBUG ((EFI_D_ERROR, "LAN9118: Transmitter error. Restarting..."));\r
 \r
-    // Initiate a software reset\r
+    // Software reset, the TXE interrupt is cleared by the reset.\r
     Status = SoftReset (0, Snp);\r
     if (EFI_ERROR (Status)) {\r
       DEBUG ((EFI_D_ERROR, "\n\tSoft Reset Failed: Hardware Error\n"));\r
       return EFI_DEVICE_ERROR;\r
     }\r
 \r
-    // Acknowledge the TXE\r
-    MmioWrite32 (LAN9118_INT_STS, INSTS_TXE);\r
-    gBS->Stall (LAN9118_STALL);\r
+    // Reactivate the LEDs\r
+    Status = ConfigureHardware (HW_CONF_USE_LEDS, Snp);\r
+    if (EFI_ERROR (Status)) {\r
+      return Status;\r
+    }\r
 \r
-    // Restart the transmitter\r
+    //\r
+    // Restart the transmitter and if necessary the receiver.\r
+    // Do not ask for FIFO reset as it has already been done\r
+    // by SoftReset().\r
+    //\r
     StartTx (START_TX_MAC | START_TX_CFG, Snp);\r
+    if (Snp->Mode->ReceiveFilterSetting != 0) {\r
+      StartRx (0, Snp);\r
+    }\r
   }\r
 \r
   // Update the media status\r
@@ -1018,7 +1141,13 @@ SnpTransmit (
   if ((Snp == NULL) || (Data == NULL)) {\r
     return EFI_INVALID_PARAMETER;\r
   }\r
-  if (Snp->Mode->State != EfiSimpleNetworkInitialized) {\r
+\r
+  // Check that driver was started and initialised\r
+  if (Snp->Mode->State == EfiSimpleNetworkStarted) {\r
+    DEBUG ((EFI_D_WARN, "Warning: LAN9118 Driver not initialized\n"));\r
+    return EFI_DEVICE_ERROR;\r
+  } else if (Snp->Mode->State == EfiSimpleNetworkStopped) {\r
+    DEBUG ((EFI_D_WARN, "Warning: LAN9118 Driver in stopped state\n"));\r
     return EFI_NOT_STARTED;\r
   }\r
 \r
@@ -1033,6 +1162,13 @@ SnpTransmit (
     }\r
   }\r
 \r
+  //\r
+  // Check validity of BufferSize\r
+  //\r
+  if (BuffSize < Snp->Mode->MediaHeaderSize) {\r
+      return EFI_BUFFER_TOO_SMALL;\r
+  }\r
+\r
   // Before transmitting check the link status\r
   /*if (CheckLinkStatus (0, Snp) < 0) {\r
     return EFI_NOT_READY;\r
@@ -1082,25 +1218,25 @@ SnpTransmit (
     CommandB = TX_CMD_B_PACKET_TAG (PacketTag) | TX_CMD_B_PACKET_LENGTH (BuffSize);\r
 \r
     // Write the commands first\r
-    MmioWrite32 (LAN9118_TX_DATA, CommandA);\r
-    MmioWrite32 (LAN9118_TX_DATA, CommandB);\r
+    Lan9118MmioWrite32 (LAN9118_TX_DATA, CommandA);\r
+    Lan9118MmioWrite32 (LAN9118_TX_DATA, CommandB);\r
 \r
     // Write the destination address\r
-    MmioWrite32 (LAN9118_TX_DATA,\r
+    Lan9118MmioWrite32 (LAN9118_TX_DATA,\r
                (DstAddr->Addr[0]) |\r
                (DstAddr->Addr[1] << 8) |\r
                (DstAddr->Addr[2] << 16) |\r
                (DstAddr->Addr[3] << 24)\r
                );\r
 \r
-    MmioWrite32 (LAN9118_TX_DATA,\r
+    Lan9118MmioWrite32 (LAN9118_TX_DATA,\r
                (DstAddr->Addr[4]) |\r
                (DstAddr->Addr[5] << 8) |\r
                (SrcAddr->Addr[0] << 16) | // Write the Source Address\r
                (SrcAddr->Addr[1] << 24)\r
                );\r
 \r
-    MmioWrite32 (LAN9118_TX_DATA,\r
+    Lan9118MmioWrite32 (LAN9118_TX_DATA,\r
                (SrcAddr->Addr[2]) |\r
                (SrcAddr->Addr[3] << 8) |\r
                (SrcAddr->Addr[4] << 16) |\r
@@ -1108,18 +1244,18 @@ SnpTransmit (
                );\r
 \r
     // Write the Protocol\r
-    MmioWrite32 (LAN9118_TX_DATA, (UINT32)(HTONS (LocalProtocol)));\r
+    Lan9118MmioWrite32 (LAN9118_TX_DATA, (UINT32)(HTONS (LocalProtocol)));\r
 \r
     // Next buffer is the payload\r
     CommandA = TX_CMD_A_LAST_SEGMENT | TX_CMD_A_BUFF_SIZE (BuffSize - HdrSize) | TX_CMD_A_COMPLETION_INT | TX_CMD_A_DATA_START_OFFSET (2); // 2 bytes beginning offset\r
 \r
     // Write the commands\r
-    MmioWrite32 (LAN9118_TX_DATA, CommandA);\r
-    MmioWrite32 (LAN9118_TX_DATA, CommandB);\r
+    Lan9118MmioWrite32 (LAN9118_TX_DATA, CommandA);\r
+    Lan9118MmioWrite32 (LAN9118_TX_DATA, CommandB);\r
 \r
     // Write the payload\r
     for (Count = 0; Count < ((BuffSize + 3) >> 2) - 3; Count++) {\r
-      MmioWrite32 (LAN9118_TX_DATA, LocalData[Count + 3]);\r
+      Lan9118MmioWrite32 (LAN9118_TX_DATA, LocalData[Count + 3]);\r
     }\r
   } else {\r
     // Format pointer\r
@@ -1130,12 +1266,12 @@ SnpTransmit (
     CommandB = TX_CMD_B_PACKET_TAG (PacketTag) | TX_CMD_B_PACKET_LENGTH (BuffSize);\r
 \r
     // Write the commands first\r
-    MmioWrite32 (LAN9118_TX_DATA, CommandA);\r
-    MmioWrite32 (LAN9118_TX_DATA, CommandB);\r
+    Lan9118MmioWrite32 (LAN9118_TX_DATA, CommandA);\r
+    Lan9118MmioWrite32 (LAN9118_TX_DATA, CommandB);\r
 \r
     // Write all the data\r
     for (Count = 0; Count < ((BuffSize + 3) >> 2); Count++) {\r
-      MmioWrite32 (LAN9118_TX_DATA, LocalData[Count]);\r
+      Lan9118MmioWrite32 (LAN9118_TX_DATA, LocalData[Count]);\r
     }\r
   }\r
 \r
@@ -1172,6 +1308,7 @@ SnpReceive (
   )\r
 {\r
   LAN9118_DRIVER  *LanDriver;\r
+  UINT32          IntSts;\r
   UINT32          RxFifoStatus;\r
   UINT32          NumPackets;\r
   UINT32          RxCfgValue;\r
@@ -1193,16 +1330,42 @@ SnpReceive (
 #endif\r
 \r
   // Check preliminaries\r
-  if ((Snp == NULL) || (Data == NULL)) {\r
+  if ((Snp == NULL) || (Data == NULL) || (BuffSize == NULL)) {\r
     return EFI_INVALID_PARAMETER;\r
   }\r
 \r
-  if (Snp->Mode->State != EfiSimpleNetworkInitialized) {\r
+  // Check that driver was started and initialised\r
+  if (Snp->Mode->State == EfiSimpleNetworkStarted) {\r
+    DEBUG ((EFI_D_WARN, "Warning: LAN9118 Driver not initialized\n"));\r
+    return EFI_DEVICE_ERROR;\r
+  } else if (Snp->Mode->State == EfiSimpleNetworkStopped) {\r
+    DEBUG ((EFI_D_WARN, "Warning: LAN9118 Driver in stopped state\n"));\r
     return EFI_NOT_STARTED;\r
   }\r
 \r
+  //\r
+  // If the receiver raised the RXE error bit, check if the receiver status\r
+  // FIFO is full and if not just acknowledge the error. The two other\r
+  // conditions to get a RXE error are :\r
+  // . the RX data FIFO is read whereas being empty.\r
+  // . the RX status FIFO is read whereas being empty.\r
+  // The RX data and status FIFO are read by this driver only in the following\r
+  // code of this function. After the readings, the RXE error bit is checked\r
+  // and if raised, the controller is reset. Thus, at this point, we consider\r
+  // that the only valid reason to get an RXE error is the receiver status\r
+  // FIFO being full. And if this is not the case, we consider that this is\r
+  // a spurious error and we just get rid of it. We experienced such 'spurious'\r
+  // errors when running the driver on an A57 on Juno. No valid reason to\r
+  // explain those errors has been found so far and everything seems to\r
+  // work perfectly when they are just ignored.\r
+  //\r
+  IntSts = Lan9118MmioRead32 (LAN9118_INT_STS);\r
+  if ((IntSts & INSTS_RXE) && (!(IntSts & INSTS_RSFF))) {\r
+    Lan9118MmioWrite32 (LAN9118_INT_STS, INSTS_RXE);\r
+  }\r
+\r
   // Count dropped frames\r
-  DroppedFrames = MmioRead32 (LAN9118_RX_DROP);\r
+  DroppedFrames = Lan9118MmioRead32 (LAN9118_RX_DROP);\r
   LanDriver->Stats.RxDroppedFrames += DroppedFrames;\r
 \r
   NumPackets = RxStatusUsedSpace (0, Snp) / 4;\r
@@ -1211,7 +1374,7 @@ SnpReceive (
   }\r
 \r
   // Read Rx Status (only if not empty)\r
-  RxFifoStatus = MmioRead32 (LAN9118_RX_STATUS);\r
+  RxFifoStatus = Lan9118MmioRead32 (LAN9118_RX_STATUS);\r
   LanDriver->Stats.RxTotalFrames += 1;\r
 \r
   // First check for errors\r
@@ -1267,12 +1430,6 @@ SnpReceive (
   PLength = GET_RXSTATUS_PACKET_LENGTH(RxFifoStatus);\r
   LanDriver->Stats.RxTotalBytes += (PLength - 4);\r
 \r
-  // Check buffer size\r
-  if (*BuffSize < PLength) {\r
-    *BuffSize = PLength;\r
-    return EFI_BUFFER_TOO_SMALL;\r
-  }\r
-\r
   // If padding is applied, read more DWORDs\r
   if (PLength % 4) {\r
     Padding = 4 - (PLength % 4);\r
@@ -1282,15 +1439,21 @@ SnpReceive (
     Padding = 0;\r
   }\r
 \r
+  // Check buffer size\r
+  if (*BuffSize < (PLength + Padding)) {\r
+    *BuffSize = PLength + Padding;\r
+    return EFI_BUFFER_TOO_SMALL;\r
+  }\r
+\r
   // Set the amount of data to be transfered out of FIFO for THIS packet\r
   // This can be used to trigger an interrupt, and status can be checked\r
-  RxCfgValue = MmioRead32 (LAN9118_RX_CFG);\r
+  RxCfgValue = Lan9118MmioRead32 (LAN9118_RX_CFG);\r
   RxCfgValue &= ~(RXCFG_RX_DMA_CNT_MASK);\r
   RxCfgValue |= RXCFG_RX_DMA_CNT (ReadLimit);\r
 \r
   // Set end alignment to 4-bytes\r
   RxCfgValue &= ~(RXCFG_RX_END_ALIGN_MASK);\r
-  MmioWrite32 (LAN9118_RX_CFG, RxCfgValue);\r
+  Lan9118MmioWrite32 (LAN9118_RX_CFG, RxCfgValue);\r
 \r
   // Update buffer size\r
   *BuffSize = PLength; // -4 bytes may be needed: Received in buffer as\r
@@ -1305,29 +1468,7 @@ SnpReceive (
 \r
   // Read Rx Packet\r
   for (Count = 0; Count < ReadLimit; Count++) {\r
-    RawData[Count] = MmioRead32 (LAN9118_RX_DATA);\r
-  }\r
-\r
-  // Check for Rx errors (worst possible error)\r
-  if (MmioRead32 (LAN9118_INT_STS) & INSTS_RXE) {\r
-    DEBUG ((EFI_D_WARN, "Warning: Receiver Error. Restarting...\n"));\r
-\r
-    // Initiate a software reset\r
-    Status = SoftReset (0, Snp);\r
-    if (EFI_ERROR (Status)) {\r
-      DEBUG ((EFI_D_ERROR, "Error: Soft Reset Failed: Hardware Error.\n"));\r
-      return EFI_DEVICE_ERROR;\r
-    }\r
-\r
-    // Acknowledge the RXE\r
-    MmioWrite32 (LAN9118_INT_STS, INSTS_RXE);\r
-    gBS->Stall (LAN9118_STALL);\r
-\r
-    // Restart the rx (and do not clear FIFO)\r
-    StartRx (0, Snp);\r
-\r
-    // Say that command could not be sent\r
-    return EFI_DEVICE_ERROR;\r
+    RawData[Count] = Lan9118MmioRead32 (LAN9118_RX_DATA);\r
   }\r
 \r
   // Get the destination address\r
@@ -1349,7 +1490,7 @@ SnpReceive (
     Src.Addr[3] = (RawData[2] & 0xFF00) >> 8;\r
     Src.Addr[4] = (RawData[2] & 0xFF0000) >> 16;\r
     Src.Addr[5] = (RawData[2] & 0xFF000000) >> 24;\r
-    CopyMem (SrcAddr,&Src, NET_ETHER_ADDR_LEN);\r
+    CopyMem (SrcAddr, &Src, NET_ETHER_ADDR_LEN);\r
   }\r
 \r
   // Get the protocol\r
@@ -1357,6 +1498,34 @@ SnpReceive (
     *Protocol = NTOHS (RawData[3] & 0xFFFF);\r
   }\r
 \r
+  // Check for Rx errors (worst possible error)\r
+  if (Lan9118MmioRead32 (LAN9118_INT_STS) & INSTS_RXE) {\r
+    DEBUG ((EFI_D_WARN, "Warning: Receiver Error. Restarting...\n"));\r
+\r
+    // Software reset, the RXE interrupt is cleared by the reset.\r
+    Status = SoftReset (0, Snp);\r
+    if (EFI_ERROR (Status)) {\r
+      DEBUG ((EFI_D_ERROR, "Error: Soft Reset Failed: Hardware Error.\n"));\r
+      return EFI_DEVICE_ERROR;\r
+    }\r
+\r
+    // Reactivate the LEDs\r
+    Status = ConfigureHardware (HW_CONF_USE_LEDS, Snp);\r
+    if (EFI_ERROR (Status)) {\r
+      return Status;\r
+    }\r
+\r
+    //\r
+    // Restart the receiver and the transmitter without resetting the FIFOs\r
+    // as it has been done by SoftReset().\r
+    //\r
+    StartRx (0, Snp);\r
+    StartTx (START_TX_MAC | START_TX_CFG, Snp);\r
+\r
+    // Say that command could not be sent\r
+    return EFI_DEVICE_ERROR;\r
+  }\r
+\r
 #if defined(EVAL_PERFORMANCE)\r
   UINT64 EndClock = GetPerformanceCounter ();\r
   DEBUG ((EFI_D_ERROR, "Receive Time processing: %d counts @ %d Hz\n", StartClock - EndClock,Perf));\r