1. fix AtaPassThru.PassThru() sct failure

2. avoid reenumerate existing device to reduce boot time at AtaBus.

git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@11232 6f19259b-4bc3-4df7-8a09-765794883524

3 files changed, 91 insertions, 34 deletions

diff --git a/MdeModulePkg/Bus/Ata/AtaAtapiPassThru/AhciMode.c b/MdeModulePkg/Bus/Ata/AtaAtapiPassThru/AhciMode.c
index 92449f40c..40012d797 100644
--- a/MdeModulePkg/Bus/Ata/AtaAtapiPassThru/AhciMode.c
+++ b/MdeModulePkg/Bus/Ata/AtaAtapiPassThru/AhciMode.c
@@ -1,7 +1,7 @@
 /** @file

   The file for AHCI mode of ATA host controller.

   

-  Copyright (c) 2010, Intel Corporation. All rights reserved.<BR>

+  Copyright (c) 2010 - 2011, Intel Corporation. All rights reserved.<BR>

   This program and the accompanying materials                          

   are licensed and made available under the terms and conditions of the BSD License         

   which accompanies this distribution.  The full text of the license may be found at        

@@ -257,6 +257,42 @@ AhciClearPortStatus (
 }

 

 /**

+  This function is used to dump the Status Registers and if there is ERR bit set

+  in the Status Register, the Error Register's value is also be dumped.

+

+  @param  PciIo            The PCI IO protocol instance.

+  @param  Port             The number of port.

+  @param  AtaStatusBlock   A pointer to EFI_ATA_STATUS_BLOCK data structure.

+

+**/

+VOID

+EFIAPI

+AhciDumpPortStatus (

+  IN     EFI_PCI_IO_PROTOCOL        *PciIo,

+  IN     UINT8                      Port,

+  IN OUT EFI_ATA_STATUS_BLOCK       *AtaStatusBlock

+  )

+{

+  UINT32               Offset;

+  UINT32               Data;

+

+  ASSERT (PciIo != NULL);

+

+  Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_TFD;

+  Data   = AhciReadReg (PciIo, Offset);

+

+  if (AtaStatusBlock != NULL) {

+    ZeroMem (AtaStatusBlock, sizeof (EFI_ATA_STATUS_BLOCK));

+

+    AtaStatusBlock->AtaStatus  = (UINT8)Data;

+    if ((AtaStatusBlock->AtaStatus & BIT0) != 0) {

+      AtaStatusBlock->AtaError = (UINT8)(Data >> 8);

+    }

+  }

+}

+

+

+/**

   Enable the FIS running for giving port.

     

   @param      PciIo          The PCI IO protocol instance.

@@ -621,7 +657,7 @@ AhciPioTransfer (
   //

   Delay = (UINT32) (DivU64x32(Timeout, 1000) + 1);

   do {

-    Value = *(UINT32 *) (FisBaseAddr + EFI_AHCI_PIO_FIS_OFFSET);

+    Value = *(volatile UINT32 *) (FisBaseAddr + EFI_AHCI_PIO_FIS_OFFSET);

 

     if ((Value & EFI_AHCI_FIS_TYPE_MASK) == EFI_AHCI_FIS_PIO_SETUP) {

       break;

@@ -686,6 +722,8 @@ Exit:
     Map

     );

 

+  AhciDumpPortStatus (PciIo, Port, AtaStatusBlock);

+

   return Status;

 }

 

@@ -855,6 +893,8 @@ Exit:
            Map

            );  

   

+  AhciDumpPortStatus (PciIo, Port, AtaStatusBlock);

+

   return Status;

 }

 

@@ -942,7 +982,7 @@ AhciNonDataTransfer (
   //

   Delay = (UINT32) (DivU64x32(Timeout, 1000) + 1);

   do {

-    Value = *(UINT32 *) (FisBaseAddr + EFI_AHCI_D2H_FIS_OFFSET);

+    Value = *(volatile UINT32 *) (FisBaseAddr + EFI_AHCI_D2H_FIS_OFFSET);

 

     if ((Value & EFI_AHCI_FIS_TYPE_MASK) == EFI_AHCI_FIS_REGISTER_D2H) {

       break;

@@ -984,6 +1024,8 @@ Exit:
     Timeout

     );

 

+  AhciDumpPortStatus (PciIo, Port, AtaStatusBlock);

+

   return Status;

 }

 

@@ -1082,17 +1124,6 @@ AhciStartCommand (
     return Status;

   }

 

-  //

-  // Setting the command

-  //

-  Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_SACT;

-  AhciAndReg (PciIo, Offset, 0);

-  AhciOrReg (PciIo, Offset, CmdSlotBit);

-

-  Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_CI;

-  AhciAndReg (PciIo, Offset, 0);

-  AhciOrReg (PciIo, Offset, CmdSlotBit);

-

   Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_CMD;

   PortStatus = AhciReadReg (PciIo, Offset);

   

@@ -1124,6 +1155,17 @@ AhciStartCommand (
   Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_CMD;

   AhciOrReg (PciIo, Offset, EFI_AHCI_PORT_CMD_ST | StartCmd);

 

+  //

+  // Setting the command

+  //

+  Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_SACT;

+  AhciAndReg (PciIo, Offset, 0);

+  AhciOrReg (PciIo, Offset, CmdSlotBit);

+

+  Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_CI;

+  AhciAndReg (PciIo, Offset, 0);

+  AhciOrReg (PciIo, Offset, CmdSlotBit);

+

   return EFI_SUCCESS;

 }

 

diff --git a/MdeModulePkg/Bus/Ata/AtaBusDxe/AtaBus.c b/MdeModulePkg/Bus/Ata/AtaBusDxe/AtaBus.c
index 9bf0a61a5..875baa88b 100644
--- a/MdeModulePkg/Bus/Ata/AtaBusDxe/AtaBus.c
+++ b/MdeModulePkg/Bus/Ata/AtaBusDxe/AtaBus.c
@@ -4,7 +4,7 @@
   This file implements protocol interfaces: Driver Binding protocol,

   Block IO protocol and DiskInfo protocol.

     

-  Copyright (c) 2009 - 2010, Intel Corporation. All rights reserved.<BR>

+  Copyright (c) 2009 - 2011, Intel Corporation. All rights reserved.<BR>

   This program and the accompanying materials

   are licensed and made available under the terms and conditions of the BSD License

   which accompanies this distribution.  The full text of the license may be found at

@@ -173,15 +173,43 @@ RegisterAtaDevice (
   ATA_DEVICE                        *AtaDevice;

   EFI_ATA_PASS_THRU_PROTOCOL        *AtaPassThru;

   EFI_DEVICE_PATH_PROTOCOL          *NewDevicePathNode;

+  EFI_DEVICE_PATH_PROTOCOL          *DevicePath;

+  EFI_DEVICE_PATH_PROTOCOL          *RemainingDevicePath;

+  EFI_HANDLE                        DeviceHandle;

 

+  AtaDevice         = NULL;

   NewDevicePathNode = NULL;

+  DevicePath        = NULL;

+  RemainingDevicePath = NULL;

+

+  //

+  // Build device path 

+  //

+  AtaPassThru = AtaBusDriverData->AtaPassThru;

+  Status = AtaPassThru->BuildDevicePath (AtaPassThru, Port, PortMultiplierPort, &NewDevicePathNode);

+  if (EFI_ERROR (Status)) {

+    goto Done;

+  }

+

+  DevicePath = AppendDevicePathNode (AtaBusDriverData->ParentDevicePath, NewDevicePathNode);

+  if (DevicePath == NULL) {

+    goto Done;

+  }

+

+  DeviceHandle = NULL;

+  Status = gBS->LocateDevicePath (&gEfiDevicePathProtocolGuid, &RemainingDevicePath, &DeviceHandle);

+  if (!EFI_ERROR (Status) && (DeviceHandle != NULL) && IsDevicePathEnd(RemainingDevicePath)) {

+    Status = EFI_ALREADY_STARTED;

+    goto Done;

+  }

 

   //

   // Allocate ATA device from the template.

   //

   AtaDevice = AllocateCopyPool (sizeof (gAtaDeviceTemplate), &gAtaDeviceTemplate);

   if (AtaDevice == NULL) {

-    return EFI_OUT_OF_RESOURCES;

+    Status = EFI_OUT_OF_RESOURCES;

+    goto Done;

   }

 

   //

@@ -189,6 +217,7 @@ RegisterAtaDevice (
   //

   AtaDevice->BlockIo.Media = &AtaDevice->BlockMedia;

   AtaDevice->AtaBusDriverData = AtaBusDriverData;

+  AtaDevice->DevicePath = DevicePath;

   AtaDevice->Port = Port;

   AtaDevice->PortMultiplierPort = PortMultiplierPort;

   AtaDevice->Asb = AllocateAlignedBuffer (AtaDevice, sizeof (*AtaDevice->Asb));

@@ -236,15 +265,6 @@ RegisterAtaDevice (
   }

 

   //

-  // Build device path 

-  //

-  AtaPassThru = AtaBusDriverData->AtaPassThru;

-  Status = AtaPassThru->BuildDevicePath (AtaPassThru, Port, PortMultiplierPort, &NewDevicePathNode);

-  if (EFI_ERROR (Status)) {

-    goto Done;

-  }

-

-  //

   // Update to AHCI interface GUID based on device path node. The default one

   // is IDE interface GUID copied from template.

   //

@@ -252,11 +272,6 @@ RegisterAtaDevice (
     CopyGuid (&AtaDevice->DiskInfo.Interface, &gEfiDiskInfoAhciInterfaceGuid);

   }

 

-  AtaDevice->DevicePath = AppendDevicePathNode (AtaBusDriverData->ParentDevicePath, NewDevicePathNode);

-  if (AtaDevice->DevicePath == NULL) {

-    goto Done;

-  }

-

   Status = gBS->InstallMultipleProtocolInterfaces (

                   &AtaDevice->Handle,

                   &gEfiDevicePathProtocolGuid,

@@ -279,13 +294,13 @@ RegisterAtaDevice (
          AtaDevice->Handle,

          EFI_OPEN_PROTOCOL_BY_CHILD_CONTROLLER

          );

-  

+

 Done:

   if (NewDevicePathNode != NULL) {

     FreePool (NewDevicePathNode);

   }

 

-  if (EFI_ERROR (Status)) {

+  if (EFI_ERROR (Status) && (AtaDevice != NULL)) {

     ReleaseAtaResources (AtaDevice);  

     DEBUG ((DEBUG_ERROR | DEBUG_INIT, "Failed to initialize Port %x PortMultiplierPort %x, status = %r\n", Port, PortMultiplierPort, Status));

   }

diff --git a/MdeModulePkg/Bus/Ata/AtaBusDxe/AtaBus.h b/MdeModulePkg/Bus/Ata/AtaBusDxe/AtaBus.h
index 21ad36035..4cda0e5cc 100644
--- a/MdeModulePkg/Bus/Ata/AtaBusDxe/AtaBus.h
+++ b/MdeModulePkg/Bus/Ata/AtaBusDxe/AtaBus.h
@@ -4,7 +4,7 @@
   This file defines common data structures, macro definitions and some module

   internal function header files.

 

-  Copyright (c) 2009 - 2010, Intel Corporation. All rights reserved.<BR>

+  Copyright (c) 2009 - 2011, Intel Corporation. All rights reserved.<BR>

   This program and the accompanying materials

   are licensed and made available under the terms and conditions of the BSD License

   which accompanies this distribution.  The full text of the license may be found at

@@ -39,7 +39,7 @@
 //

 // Time out value for ATA pass through protocol

 //

-#define ATA_TIMEOUT                       EFI_TIMER_PERIOD_SECONDS (1)

+#define ATA_TIMEOUT                       EFI_TIMER_PERIOD_SECONDS (3)

 

 //

 // Maximum number of times to retry ATA command