X-Git-Url: https://git.proxmox.com/?p=mirror_edk2.git;a=blobdiff_plain;f=EmbeddedPkg%2FDrivers%2FSataSiI3132Dxe%2FSiI3132AtaPassThru.c;fp=EmbeddedPkg%2FDrivers%2FSataSiI3132Dxe%2FSiI3132AtaPassThru.c;h=0000000000000000000000000000000000000000;hp=0e2905c1ebb052e78b1249d065616f3594512bd6;hb=704ff0ff2a9f277eaa465b1697ca439fda81cdc2;hpb=f2bd980059d9f826bb366ddeb35e3365c65b477d diff --git a/EmbeddedPkg/Drivers/SataSiI3132Dxe/SiI3132AtaPassThru.c b/EmbeddedPkg/Drivers/SataSiI3132Dxe/SiI3132AtaPassThru.c deleted file mode 100644 index 0e2905c1eb..0000000000 --- a/EmbeddedPkg/Drivers/SataSiI3132Dxe/SiI3132AtaPassThru.c +++ /dev/null @@ -1,827 +0,0 @@ -/** @file -* -* Copyright (c) 2011-2015, ARM Limited. All rights reserved. -* -* SPDX-License-Identifier: BSD-2-Clause-Patent -* -**/ - -#include "SataSiI3132.h" - -#include -#include - -SATA_SI3132_DEVICE* -GetSataDevice ( - IN SATA_SI3132_INSTANCE* SataInstance, - IN UINT16 Port, - IN UINT16 PortMultiplierPort -) { - LIST_ENTRY *List; - SATA_SI3132_PORT *SataPort; - SATA_SI3132_DEVICE *SataDevice; - - if (Port >= SATA_SII3132_MAXPORT) { - return NULL; - } - - SataPort = &(SataInstance->Ports[Port]); - List = SataPort->Devices.ForwardLink; - - while (List != &SataPort->Devices) { - SataDevice = (SATA_SI3132_DEVICE*)List; - if (SataDevice->Index == PortMultiplierPort) { - return SataDevice; - } - List = List->ForwardLink; - } - return NULL; -} - -EFI_STATUS -EFIAPI -SiI3132AtaPassThruCommand ( - IN SATA_SI3132_INSTANCE *SataSiI3132Instance, - IN SATA_SI3132_PORT *SataPort, - IN UINT16 PortMultiplierPort, - IN OUT EFI_ATA_PASS_THRU_COMMAND_PACKET *Packet, - IN EFI_EVENT Event OPTIONAL - ) -{ - SATA_SI3132_DEVICE *SataDevice; - EFI_PHYSICAL_ADDRESS PhysInDataBuffer; - UINTN InDataBufferLength = 0; - EFI_PHYSICAL_ADDRESS PhysOutDataBuffer; - UINTN OutDataBufferLength; - CONST UINTN EmptySlot = 0; - UINTN Control = PRB_CTRL_ATA; - UINTN Protocol = 0; - UINT32 Value32, Error, Timeout = 0; - CONST UINT32 IrqMask = (SII3132_PORT_INT_CMDCOMPL | SII3132_PORT_INT_CMDERR) << 16; - EFI_STATUS Status; - VOID* PciAllocMapping = NULL; - EFI_PCI_IO_PROTOCOL *PciIo; - - PciIo = SataSiI3132Instance->PciIo; - ZeroMem (SataPort->HostPRB, sizeof (SATA_SI3132_PRB)); - - // Construct Si3132 PRB - switch (Packet->Protocol) { - case EFI_ATA_PASS_THRU_PROTOCOL_ATA_HARDWARE_RESET: - ASSERT (0); //TODO: Implement me! - break; - case EFI_ATA_PASS_THRU_PROTOCOL_ATA_SOFTWARE_RESET: - SATA_TRACE ("SiI3132AtaPassThru() EFI_ATA_PASS_THRU_PROTOCOL_ATA_SOFTWARE_RESET"); - Control = PRB_CTRL_SRST; - - if (FeaturePcdGet (PcdSataSiI3132FeaturePMPSupport)) { - SataPort->HostPRB->Fis.Control = 0x0F; - } - break; - case EFI_ATA_PASS_THRU_PROTOCOL_ATA_NON_DATA: - ASSERT (0); //TODO: Implement me! - break; - - // There is no difference for SiI3132 between PIO and DMA invokation - case EFI_ATA_PASS_THRU_PROTOCOL_UDMA_DATA_IN: - case EFI_ATA_PASS_THRU_PROTOCOL_PIO_DATA_IN: - // Fixup the size for block transfer. Following UEFI Specification, 'InTransferLength' should - // be in number of bytes. But for most data transfer commands, the value is in number of blocks - if (Packet->Acb->AtaCommand == ATA_CMD_IDENTIFY_DRIVE) { - InDataBufferLength = Packet->InTransferLength; - } else { - SataDevice = GetSataDevice (SataSiI3132Instance, SataPort->Index, PortMultiplierPort); - if (!SataDevice || (SataDevice->BlockSize == 0)) { - return EFI_INVALID_PARAMETER; - } - - InDataBufferLength = Packet->InTransferLength * SataDevice->BlockSize; - } - - Status = PciIo->Map ( - PciIo, EfiPciIoOperationBusMasterWrite, - Packet->InDataBuffer, &InDataBufferLength, &PhysInDataBuffer, &PciAllocMapping - ); - if (EFI_ERROR (Status)) { - return Status; - } - - // Construct SGEs (32-bit system) - SataPort->HostPRB->Sge[0].DataAddressLow = (UINT32)PhysInDataBuffer; - SataPort->HostPRB->Sge[0].DataAddressHigh = (UINT32)(PhysInDataBuffer >> 32); - SataPort->HostPRB->Sge[0].Attributes = SGE_TRM; // Only one SGE - SataPort->HostPRB->Sge[0].DataCount = InDataBufferLength; - - // Copy the Ata Command Block - CopyMem (&SataPort->HostPRB->Fis, Packet->Acb, sizeof (EFI_ATA_COMMAND_BLOCK)); - - // Fixup the FIS - SataPort->HostPRB->Fis.FisType = 0x27; // Register - Host to Device FIS - SataPort->HostPRB->Fis.Control = 1 << 7; // Is a command - if (FeaturePcdGet (PcdSataSiI3132FeaturePMPSupport)) { - SataPort->HostPRB->Fis.Control |= PortMultiplierPort & 0xFF; - } - break; - case EFI_ATA_PASS_THRU_PROTOCOL_UDMA_DATA_OUT: - case EFI_ATA_PASS_THRU_PROTOCOL_PIO_DATA_OUT: - SataDevice = GetSataDevice (SataSiI3132Instance, SataPort->Index, PortMultiplierPort); - if (!SataDevice || (SataDevice->BlockSize == 0)) { - return EFI_INVALID_PARAMETER; - } - - // Fixup the size for block transfer. Following UEFI Specification, 'InTransferLength' should - // be in number of bytes. But for most data transfer commands, the value is in number of blocks - OutDataBufferLength = Packet->OutTransferLength * SataDevice->BlockSize; - - Status = PciIo->Map ( - PciIo, EfiPciIoOperationBusMasterRead, - Packet->OutDataBuffer, &OutDataBufferLength, &PhysOutDataBuffer, &PciAllocMapping - ); - if (EFI_ERROR (Status)) { - return Status; - } - - // Construct SGEs (32-bit system) - SataPort->HostPRB->Sge[0].DataAddressLow = (UINT32)PhysOutDataBuffer; - SataPort->HostPRB->Sge[0].DataAddressHigh = (UINT32)(PhysOutDataBuffer >> 32); - SataPort->HostPRB->Sge[0].Attributes = SGE_TRM; // Only one SGE - SataPort->HostPRB->Sge[0].DataCount = OutDataBufferLength; - - // Copy the Ata Command Block - CopyMem (&SataPort->HostPRB->Fis, Packet->Acb, sizeof (EFI_ATA_COMMAND_BLOCK)); - - // Fixup the FIS - SataPort->HostPRB->Fis.FisType = 0x27; // Register - Host to Device FIS - SataPort->HostPRB->Fis.Control = 1 << 7; // Is a command - if (FeaturePcdGet (PcdSataSiI3132FeaturePMPSupport)) { - SataPort->HostPRB->Fis.Control |= PortMultiplierPort & 0xFF; - } - break; - case EFI_ATA_PASS_THRU_PROTOCOL_DMA: - ASSERT (0); //TODO: Implement me! - break; - case EFI_ATA_PASS_THRU_PROTOCOL_DMA_QUEUED: - ASSERT (0); //TODO: Implement me! - break; - case EFI_ATA_PASS_THRU_PROTOCOL_DEVICE_DIAGNOSTIC: - ASSERT (0); //TODO: Implement me! - break; - case EFI_ATA_PASS_THRU_PROTOCOL_DEVICE_RESET: - ASSERT (0); //TODO: Implement me! - break; - case EFI_ATA_PASS_THRU_PROTOCOL_FPDMA: - ASSERT (0); //TODO: Implement me! - break; - case EFI_ATA_PASS_THRU_PROTOCOL_RETURN_RESPONSE: - ASSERT (0); //TODO: Implement me! - break; - default: - ASSERT (0); - break; - } - - SataPort->HostPRB->Control = Control; - SataPort->HostPRB->ProtocolOverride = Protocol; - - // Clear IRQ - SATA_PORT_WRITE32 (SataPort->RegBase + SII3132_PORT_INTSTATUS_REG, IrqMask); - - if (!FeaturePcdGet (PcdSataSiI3132FeatureDirectCommandIssuing)) { - // Indirect Command Issuance - - //TODO: Find which slot is free (maybe use the Cmd FIFO) - //SATA_PORT_READ32 (SataPort->RegBase + SII3132_PORT_CMDEXECFIFO_REG, &EmptySlot); - - SATA_PORT_WRITE32 (SataPort->RegBase + SII3132_PORT_CMDACTIV_REG + (EmptySlot * 8), - (UINT32)(SataPort->PhysAddrHostPRB & 0xFFFFFFFF)); - SATA_PORT_WRITE32 (SataPort->RegBase + SII3132_PORT_CMDACTIV_REG + (EmptySlot * 8) + 4, - (UINT32)((SataPort->PhysAddrHostPRB >> 32) & 0xFFFFFFFF)); - } else { - // Direct Command Issuance - Status = PciIo->Mem.Write (PciIo, EfiPciIoWidthUint32, 1, // Bar 1 - SataPort->RegBase + (EmptySlot * 0x80), - sizeof (SATA_SI3132_PRB) / 4, - SataPort->HostPRB); - ASSERT_EFI_ERROR (Status); - - SATA_PORT_WRITE32 (SataPort->RegBase + SII3132_PORT_CMDEXECFIFO_REG, EmptySlot); - } - -#if 0 - // Could need to be implemented if we run multiple command in parallel to know which slot has been completed - SATA_PORT_READ32 (SataPort->RegBase + SII3132_PORT_SLOTSTATUS_REG, &Value32); - Timeout = Packet->Timeout; - while (!Timeout && !Value32) { - gBS->Stall (1); - SATA_PORT_READ32 (SataPort->RegBase + SII3132_PORT_SLOTSTATUS_REG, &Value32); - Timeout--; - } -#else - SATA_PORT_READ32 (SataPort->RegBase + SII3132_PORT_INTSTATUS_REG, &Value32); - if (!Packet->Timeout) { - while (!(Value32 & IrqMask)) { - gBS->Stall (1); - SATA_PORT_READ32 (SataPort->RegBase + SII3132_PORT_INTSTATUS_REG, &Value32); - } - } else { - Timeout = Packet->Timeout; - while (Timeout && !(Value32 & IrqMask)) { - gBS->Stall (1); - SATA_PORT_READ32 (SataPort->RegBase + SII3132_PORT_INTSTATUS_REG, &Value32); - Timeout--; - } - } -#endif - // Fill Packet Ata Status Block - Status = PciIo->Mem.Read (PciIo, EfiPciIoWidthUint32, 1, // Bar 1 - SataPort->RegBase + 0x08, - sizeof (EFI_ATA_STATUS_BLOCK) / 4, - Packet->Asb); - ASSERT_EFI_ERROR (Status); - - - if ((Packet->Timeout != 0) && (Timeout == 0)) { - DEBUG ((EFI_D_ERROR, "SiI3132AtaPassThru() Err:Timeout\n")); - //ASSERT (0); - return EFI_TIMEOUT; - } else if (Value32 & (SII3132_PORT_INT_CMDERR << 16)) { - SATA_PORT_READ32 (SataPort->RegBase + SII3132_PORT_CMDERROR_REG, &Error); - DEBUG ((EFI_D_ERROR, "SiI3132AtaPassThru() CmdErr:0x%X (SiI3132 Err:0x%X)\n", Value32, Error)); - ASSERT (0); - return EFI_DEVICE_ERROR; - } else if (Value32 & (SII3132_PORT_INT_CMDCOMPL << 16)) { - // Clear Command Complete - SATA_PORT_WRITE32 (SataPort->RegBase + SII3132_PORT_INTSTATUS_REG, SII3132_PORT_INT_CMDCOMPL << 16); - - if (PciAllocMapping) { - Status = PciIo->Unmap (PciIo, PciAllocMapping); - ASSERT (!EFI_ERROR (Status)); - } - - // If the command was ATA_CMD_IDENTIFY_DRIVE then we need to update the BlockSize - if (Packet->Acb->AtaCommand == ATA_CMD_IDENTIFY_DRIVE) { - ATA_IDENTIFY_DATA *IdentifyData = (ATA_IDENTIFY_DATA*)Packet->InDataBuffer; - - // Get the corresponding Block Device - SataDevice = GetSataDevice (SataSiI3132Instance, SataPort->Index, PortMultiplierPort); - - // Check logical block size - if ((IdentifyData->phy_logic_sector_support & BIT12) != 0) { - ASSERT (SataDevice != NULL); - SataDevice->BlockSize = (UINT32) (((IdentifyData->logic_sector_size_hi << 16) | - IdentifyData->logic_sector_size_lo) * sizeof (UINT16)); - } else { - SataDevice->BlockSize = 0x200; - } - } - return EFI_SUCCESS; - } else { - ASSERT (0); - return EFI_DEVICE_ERROR; - } -} - -/** - Sends an ATA command to an ATA device that is attached to the ATA controller. This function - supports both blocking I/O and non-blocking I/O. The blocking I/O functionality is required, - and the non-blocking I/O functionality is optional. - - @param[in] This A pointer to the EFI_ATA_PASS_THRU_PROTOCOL instance. - @param[in] Port The port number of the ATA device to send the command. - @param[in] PortMultiplierPort The port multiplier port number of the ATA device to send the command. - If there is no port multiplier, then specify 0. - @param[in,out] Packet A pointer to the ATA command to send to the ATA device specified by Port - and PortMultiplierPort. - @param[in] Event If non-blocking I/O is not supported then Event is ignored, and blocking - I/O is performed. If Event is NULL, then blocking I/O is performed. If - Event is not NULL and non blocking I/O is supported, then non-blocking - I/O is performed, and Event will be signaled when the ATA command completes. - - @retval EFI_SUCCESS The ATA command was sent by the host. For bi-directional commands, - InTransferLength bytes were transferred from InDataBuffer. For write and - bi-directional commands, OutTransferLength bytes were transferred by OutDataBuffer. - @retval EFI_BAD_BUFFER_SIZE The ATA command was not executed. The number of bytes that could be transferred - is returned in InTransferLength. For write and bi-directional commands, - OutTransferLength bytes were transferred by OutDataBuffer. - @retval EFI_NOT_READY The ATA command could not be sent because there are too many ATA commands - already queued. The caller may retry again later. - @retval EFI_DEVICE_ERROR A device error occurred while attempting to send the ATA command. - @retval EFI_INVALID_PARAMETER Port, PortMultiplierPort, or the contents of Acb are invalid. The ATA - command was not sent, so no additional status information is available. - -**/ -EFI_STATUS -EFIAPI -SiI3132AtaPassThru ( - IN EFI_ATA_PASS_THRU_PROTOCOL *This, - IN UINT16 Port, - IN UINT16 PortMultiplierPort, - IN OUT EFI_ATA_PASS_THRU_COMMAND_PACKET *Packet, - IN EFI_EVENT Event OPTIONAL - ) -{ - SATA_SI3132_INSTANCE *SataSiI3132Instance; - SATA_SI3132_DEVICE *SataDevice; - SATA_SI3132_PORT *SataPort; - - SataSiI3132Instance = INSTANCE_FROM_ATAPASSTHRU_THIS (This); - if (!SataSiI3132Instance) { - return EFI_INVALID_PARAMETER; - } - - SataDevice = GetSataDevice (SataSiI3132Instance, Port, PortMultiplierPort); - if (!SataDevice) { - return EFI_INVALID_PARAMETER; - } - SataPort = SataDevice->Port; - - DEBUG ((EFI_D_INFO, "SiI3132AtaPassThru(%d,%d) : AtaCmd:0x%X Prot:%d\n", Port, PortMultiplierPort, - Packet->Acb->AtaCommand, Packet->Protocol)); - - return SiI3132AtaPassThruCommand (SataSiI3132Instance, SataPort, PortMultiplierPort, Packet, Event); -} - -/** - Used to retrieve the list of legal port numbers for ATA devices on an ATA controller. - These can either be the list of ports where ATA devices are actually present or the - list of legal port numbers for the ATA controller. Regardless, the caller of this - function must probe the port number returned to see if an ATA device is actually - present at that location on the ATA controller. - - The GetNextPort() function retrieves the port number on an ATA controller. If on input - Port is 0xFFFF, then the port number of the first port on the ATA controller is returned - in Port and EFI_SUCCESS is returned. - - If Port is a port number that was returned on a previous call to GetNextPort(), then the - port number of the next port on the ATA controller is returned in Port, and EFI_SUCCESS - is returned. If Port is not 0xFFFF and Port was not returned on a previous call to - GetNextPort(), then EFI_INVALID_PARAMETER is returned. - - If Port is the port number of the last port on the ATA controller, then EFI_NOT_FOUND is - returned. - - @param[in] This A pointer to the EFI_ATA_PASS_THRU_PROTOCOL instance. - @param[in,out] Port On input, a pointer to the port number on the ATA controller. - On output, a pointer to the next port number on the ATA - controller. An input value of 0xFFFF retrieves the first port - number on the ATA controller. - - @retval EFI_SUCCESS The next port number on the ATA controller was returned in Port. - @retval EFI_NOT_FOUND There are no more ports on this ATA controller. - @retval EFI_INVALID_PARAMETER Port is not 0xFFFF and Port was not returned on a previous call - to GetNextPort(). - -**/ -EFI_STATUS -EFIAPI -SiI3132GetNextPort ( - IN EFI_ATA_PASS_THRU_PROTOCOL *This, - IN OUT UINT16 *Port - ) -{ - SATA_SI3132_INSTANCE *SataSiI3132Instance; - UINTN PrevPort; - EFI_STATUS Status = EFI_SUCCESS; - - SataSiI3132Instance = INSTANCE_FROM_ATAPASSTHRU_THIS (This); - if (!SataSiI3132Instance) { - return EFI_INVALID_PARAMETER; - } - - PrevPort = *Port; - - if (PrevPort == 0xFFFF) { - *Port = 0; - } else { - if (PrevPort < SATA_SII3132_MAXPORT) { - *Port = PrevPort + 1; - } else { - Status = EFI_NOT_FOUND; - } - } - return Status; -} - -/** - Used to retrieve the list of legal port multiplier port numbers for ATA devices on a port of an ATA - controller. These can either be the list of port multiplier ports where ATA devices are actually - present on port or the list of legal port multiplier ports on that port. Regardless, the caller of this - function must probe the port number and port multiplier port number returned to see if an ATA - device is actually present. - - The GetNextDevice() function retrieves the port multiplier port number of an ATA device - present on a port of an ATA controller. - - If PortMultiplierPort points to a port multiplier port number value that was returned on a - previous call to GetNextDevice(), then the port multiplier port number of the next ATA device - on the port of the ATA controller is returned in PortMultiplierPort, and EFI_SUCCESS is - returned. - - If PortMultiplierPort points to 0xFFFF, then the port multiplier port number of the first - ATA device on port of the ATA controller is returned in PortMultiplierPort and - EFI_SUCCESS is returned. - - If PortMultiplierPort is not 0xFFFF and the value pointed to by PortMultiplierPort - was not returned on a previous call to GetNextDevice(), then EFI_INVALID_PARAMETER - is returned. - - If PortMultiplierPort is the port multiplier port number of the last ATA device on the port of - the ATA controller, then EFI_NOT_FOUND is returned. - - @param[in] This A pointer to the EFI_ATA_PASS_THRU_PROTOCOL instance. - @param[in] Port The port number present on the ATA controller. - @param[in,out] PortMultiplierPort On input, a pointer to the port multiplier port number of an - ATA device present on the ATA controller. - If on input a PortMultiplierPort of 0xFFFF is specified, - then the port multiplier port number of the first ATA device - is returned. On output, a pointer to the port multiplier port - number of the next ATA device present on an ATA controller. - - @retval EFI_SUCCESS The port multiplier port number of the next ATA device on the port - of the ATA controller was returned in PortMultiplierPort. - @retval EFI_NOT_FOUND There are no more ATA devices on this port of the ATA controller. - @retval EFI_INVALID_PARAMETER PortMultiplierPort is not 0xFFFF, and PortMultiplierPort was not - returned on a previous call to GetNextDevice(). - -**/ -EFI_STATUS -EFIAPI -SiI3132GetNextDevice ( - IN EFI_ATA_PASS_THRU_PROTOCOL *This, - IN UINT16 Port, - IN OUT UINT16 *PortMultiplierPort - ) -{ - SATA_SI3132_INSTANCE *SataSiI3132Instance; - SATA_SI3132_PORT *SataPort; - SATA_SI3132_DEVICE *SataDevice; - LIST_ENTRY *List; - EFI_STATUS Status = EFI_SUCCESS; - - SataSiI3132Instance = INSTANCE_FROM_ATAPASSTHRU_THIS (This); - if (!SataSiI3132Instance) { - return EFI_INVALID_PARAMETER; - } - - if (Port >= SATA_SII3132_MAXPORT) { - return EFI_INVALID_PARAMETER; - } - - SataPort = &(SataSiI3132Instance->Ports[Port]); - - if (*PortMultiplierPort == 0xFFFF) { - List = SataPort->Devices.ForwardLink; - if (List != &SataPort->Devices) { - // The list is not empty, return the first device - *PortMultiplierPort = ((SATA_SI3132_DEVICE*)List)->Index; - } else { - Status = EFI_NOT_FOUND; - } - } else { - SataDevice = GetSataDevice (SataSiI3132Instance, Port, *PortMultiplierPort); - if (SataDevice != NULL) { - // We have found the previous port multiplier, return the next one - List = SataDevice->Link.ForwardLink; - if (List != &SataPort->Devices) { - *PortMultiplierPort = ((SATA_SI3132_DEVICE*)List)->Index; - } else { - Status = EFI_NOT_FOUND; - } - } else { - Status = EFI_NOT_FOUND; - } - } - return Status; -} - -/** - Used to allocate and build a device path node for an ATA device on an ATA controller. - - The BuildDevicePath() function allocates and builds a single device node for the ATA - device specified by Port and PortMultiplierPort. If the ATA device specified by Port and - PortMultiplierPort is not present on the ATA controller, then EFI_NOT_FOUND is returned. - If DevicePath is NULL, then EFI_INVALID_PARAMETER is returned. If there are not enough - resources to allocate the device path node, then EFI_OUT_OF_RESOURCES is returned. - - Otherwise, DevicePath is allocated with the boot service AllocatePool(), the contents of - DevicePath are initialized to describe the ATA device specified by Port and PortMultiplierPort, - and EFI_SUCCESS is returned. - - @param[in] This A pointer to the EFI_ATA_PASS_THRU_PROTOCOL instance. - @param[in] Port Port specifies the port number of the ATA device for which a - device path node is to be allocated and built. - @param[in] PortMultiplierPort The port multiplier port number of the ATA device for which a - device path node is to be allocated and built. If there is no - port multiplier, then specify 0. - @param[in,out] DevicePath A pointer to a single device path node that describes the ATA - device specified by Port and PortMultiplierPort. This function - is responsible for allocating the buffer DevicePath with the - boot service AllocatePool(). It is the caller's responsibility - to free DevicePath when the caller is finished with DevicePath. - @retval EFI_SUCCESS The device path node that describes the ATA device specified by - Port and PortMultiplierPort was allocated and returned in DevicePath. - @retval EFI_NOT_FOUND The ATA device specified by Port and PortMultiplierPort does not - exist on the ATA controller. - @retval EFI_INVALID_PARAMETER DevicePath is NULL. - @retval EFI_OUT_OF_RESOURCES There are not enough resources to allocate DevicePath. - -**/ -EFI_STATUS -EFIAPI -SiI3132BuildDevicePath ( - IN EFI_ATA_PASS_THRU_PROTOCOL *This, - IN UINT16 Port, - IN UINT16 PortMultiplierPort, - IN OUT EFI_DEVICE_PATH_PROTOCOL **DevicePath - ) -{ - SATA_SI3132_INSTANCE *SataSiI3132Instance; - SATA_SI3132_DEVICE *SataDevice; - EFI_DEVICE_PATH_PROTOCOL *SiI3132DevicePath; - - SATA_TRACE ("SiI3132BuildDevicePath()"); - - SataSiI3132Instance = INSTANCE_FROM_ATAPASSTHRU_THIS (This); - if (!SataSiI3132Instance) { - return EFI_INVALID_PARAMETER; - } - - SataDevice = GetSataDevice (SataSiI3132Instance, Port, PortMultiplierPort); - if (SataDevice == NULL) { - return EFI_NOT_FOUND; - } - - SiI3132DevicePath = CreateDeviceNode (MESSAGING_DEVICE_PATH, MSG_SATA_DP, sizeof (SATA_DEVICE_PATH)); - if (SiI3132DevicePath == NULL) { - return EFI_OUT_OF_RESOURCES; - } - - ((SATA_DEVICE_PATH*)SiI3132DevicePath)->HBAPortNumber = Port; - if (FeaturePcdGet (PcdSataSiI3132FeaturePMPSupport)) { - ((SATA_DEVICE_PATH*)SiI3132DevicePath)->PortMultiplierPortNumber = PortMultiplierPort; - } else { - //Temp:((SATA_DEVICE_PATH*)SiI3132DevicePath)->PortMultiplierPortNumber = SATA_HBA_DIRECT_CONNECT_FLAG; - ((SATA_DEVICE_PATH*)SiI3132DevicePath)->PortMultiplierPortNumber = 0; - } - ((SATA_DEVICE_PATH*)SiI3132DevicePath)->Lun = Port; //TODO: Search information how to define properly LUN (Logical Unit Number) - - *DevicePath = SiI3132DevicePath; - return EFI_SUCCESS; -} - -/** - Used to translate a device path node to a port number and port multiplier port number. - - The GetDevice() function determines the port and port multiplier port number associated with - the ATA device described by DevicePath. If DevicePath is a device path node type that the - ATA Pass Thru driver supports, then the ATA Pass Thru driver will attempt to translate the contents - DevicePath into a port number and port multiplier port number. - - If this translation is successful, then that port number and port multiplier port number are returned - in Port and PortMultiplierPort, and EFI_SUCCESS is returned. - - If DevicePath, Port, or PortMultiplierPort are NULL, then EFI_INVALID_PARAMETER is returned. - - If DevicePath is not a device path node type that the ATA Pass Thru driver supports, then - EFI_UNSUPPORTED is returned. - - If DevicePath is a device path node type that the ATA Pass Thru driver supports, but there is not - a valid translation from DevicePath to a port number and port multiplier port number, then - EFI_NOT_FOUND is returned. - - @param[in] This A pointer to the EFI_ATA_PASS_THRU_PROTOCOL instance. - @param[in] DevicePath A pointer to the device path node that describes an ATA device on the - ATA controller. - @param[out] Port On return, points to the port number of an ATA device on the ATA controller. - @param[out] PortMultiplierPort On return, points to the port multiplier port number of an ATA device - on the ATA controller. - - @retval EFI_SUCCESS DevicePath was successfully translated to a port number and port multiplier - port number, and they were returned in Port and PortMultiplierPort. - @retval EFI_INVALID_PARAMETER DevicePath is NULL. - @retval EFI_INVALID_PARAMETER Port is NULL. - @retval EFI_INVALID_PARAMETER PortMultiplierPort is NULL. - @retval EFI_UNSUPPORTED This driver does not support the device path node type in DevicePath. - @retval EFI_NOT_FOUND A valid translation from DevicePath to a port number and port multiplier - port number does not exist. -**/ -EFI_STATUS -EFIAPI -SiI3132GetDevice ( - IN EFI_ATA_PASS_THRU_PROTOCOL *This, - IN EFI_DEVICE_PATH_PROTOCOL *DevicePath, - OUT UINT16 *Port, - OUT UINT16 *PortMultiplierPort - ) -{ - SATA_SI3132_INSTANCE *SataSiI3132Instance; - - SATA_TRACE ("SiI3132GetDevice()"); - - if (!DevicePath || !Port || !PortMultiplierPort) { - return EFI_INVALID_PARAMETER; - } - - if ((DevicePath->Type != MESSAGING_DEVICE_PATH) || (DevicePath->SubType != MSG_SATA_DP)) { - return EFI_UNSUPPORTED; - } - - SataSiI3132Instance = INSTANCE_FROM_ATAPASSTHRU_THIS (This); - if (!SataSiI3132Instance) { - return EFI_INVALID_PARAMETER; - } - - if (((SATA_DEVICE_PATH*)DevicePath)->Lun >= SATA_SII3132_MAXPORT) { - return EFI_NOT_FOUND; - } - - if (FeaturePcdGet (PcdSataSiI3132FeaturePMPSupport)) { - ASSERT (0); //TODO: Implement me! - return EFI_UNSUPPORTED; - } else { - *Port = ((SATA_DEVICE_PATH*)DevicePath)->Lun; - // Return the first Sata Device as there should be only one directly connected - *PortMultiplierPort = ((SATA_SI3132_DEVICE*)SataSiI3132Instance->Ports[*Port].Devices.ForwardLink)->Index; - return EFI_SUCCESS; - } -} - -EFI_STATUS -SiI3132HwResetPort ( - IN SATA_SI3132_PORT *SataPort - ) -{ - EFI_PCI_IO_PROTOCOL *PciIo; - UINT32 Value32; - UINTN Timeout; - - SATA_TRACE ("SiI3132HwResetPort()"); - - PciIo = SataPort->Instance->PciIo; - - // Clear Port Reset - SATA_PORT_WRITE32 (SataPort->RegBase + SII3132_PORT_CONTROLCLEAR_REG, SII3132_PORT_CONTROL_RESET); - - SATA_PORT_READ32 (SataPort->RegBase + SII3132_PORT_STATUS_REG, &Value32); - ASSERT (!(Value32 & SII3132_PORT_CONTROL_RESET)); - - // Initialize error counters - SATA_PORT_WRITE32 (SataPort->RegBase + SII3132_PORT_ERRCOUNTDECODE, 0); - SATA_PORT_WRITE32 (SataPort->RegBase + SII3132_PORT_ERRCOUNTCRC, 0); - SATA_PORT_WRITE32 (SataPort->RegBase + SII3132_PORT_ERRCOUNTHANDSHAKE, 0); - - // Enable interrupts for command completion and command errors - SATA_PORT_WRITE32 (SataPort->RegBase + SII3132_PORT_ENABLEINT_REG, SII3132_PORT_INT_CMDCOMPL | SII3132_PORT_INT_CMDERR); - - // Clear IRQ - SATA_PORT_WRITE32 (SataPort->RegBase + SII3132_PORT_ENABLEINT_REG, SII3132_PORT_INT_CMDCOMPL | SII3132_PORT_INT_CMDERR | SII3132_PORT_INT_PORTRDY | (1 << 3)); - - // Wait until Port Ready - SATA_PORT_READ32 (SataPort->RegBase + SII3132_PORT_INTSTATUS_REG, &Value32); - Timeout = 1000; - while ((Timeout > 0) && ((Value32 & SII3132_PORT_INT_PORTRDY) == 0)) { - gBS->Stall (1); - Timeout--; - SATA_PORT_READ32 (SataPort->RegBase + SII3132_PORT_INTSTATUS_REG, &Value32); - } - // Clear IRQ - SATA_PORT_WRITE32 (SataPort->RegBase + SII3132_PORT_INTSTATUS_REG, SII3132_PORT_INT_PORTRDY); - - if (Timeout == 0) { - SATA_TRACE ("SiI3132HwResetPort(): Timeout"); - return EFI_TIMEOUT; - } else if ((Value32 & SII3132_PORT_INT_PORTRDY) == 0) { - SATA_TRACE ("SiI3132HwResetPort(): Port Not Ready"); - return EFI_DEVICE_ERROR; - } else { - return EFI_SUCCESS; - } -} - -/** - Resets a specific port on the ATA controller. This operation also resets all the ATA devices - connected to the port. - - The ResetChannel() function resets an a specific port on an ATA controller. This operation - resets all the ATA devices connected to that port. If this ATA controller does not support - a reset port operation, then EFI_UNSUPPORTED is returned. - - If a device error occurs while executing that port reset operation, then EFI_DEVICE_ERROR is - returned. - - If a timeout occurs during the execution of the port reset operation, then EFI_TIMEOUT is returned. - - If the port reset operation is completed, then EFI_SUCCESS is returned. - - @param[in] This A pointer to the EFI_ATA_PASS_THRU_PROTOCOL instance. - @param[in] Port The port number on the ATA controller. - - @retval EFI_SUCCESS The ATA controller port was reset. - @retval EFI_UNSUPPORTED The ATA controller does not support a port reset operation. - @retval EFI_DEVICE_ERROR A device error occurred while attempting to reset the ATA port. - @retval EFI_TIMEOUT A timeout occurred while attempting to reset the ATA port. - -**/ -EFI_STATUS -EFIAPI -SiI3132ResetPort ( - IN EFI_ATA_PASS_THRU_PROTOCOL *This, - IN UINT16 Port - ) -{ - SATA_SI3132_INSTANCE *SataSiI3132Instance; - SATA_SI3132_PORT *SataPort; - - SATA_TRACE ("SiI3132ResetPort()"); - - SataSiI3132Instance = INSTANCE_FROM_ATAPASSTHRU_THIS (This); - if (!SataSiI3132Instance) { - return EFI_INVALID_PARAMETER; - } - - if (Port >= SATA_SII3132_MAXPORT) { - return EFI_UNSUPPORTED; - } - - SataPort = &(SataSiI3132Instance->Ports[Port]); - return SiI3132HwResetPort (SataPort); -} - -/** - Resets an ATA device that is connected to an ATA controller. - - The ResetDevice() function resets the ATA device specified by Port and PortMultiplierPort. - If this ATA controller does not support a device reset operation, then EFI_UNSUPPORTED is - returned. - - If Port or PortMultiplierPort are not in a valid range for this ATA controller, then - EFI_INVALID_PARAMETER is returned. - - If a device error occurs while executing that device reset operation, then EFI_DEVICE_ERROR - is returned. - - If a timeout occurs during the execution of the device reset operation, then EFI_TIMEOUT is - returned. - - If the device reset operation is completed, then EFI_SUCCESS is returned. - - @param[in] This A pointer to the EFI_ATA_PASS_THRU_PROTOCOL instance. - @param[in] Port Port represents the port number of the ATA device to be reset. - @param[in] PortMultiplierPort The port multiplier port number of the ATA device to reset. - If there is no port multiplier, then specify 0. - @retval EFI_SUCCESS The ATA device specified by Port and PortMultiplierPort was reset. - @retval EFI_UNSUPPORTED The ATA controller does not support a device reset operation. - @retval EFI_INVALID_PARAMETER Port or PortMultiplierPort are invalid. - @retval EFI_DEVICE_ERROR A device error occurred while attempting to reset the ATA device - specified by Port and PortMultiplierPort. - @retval EFI_TIMEOUT A timeout occurred while attempting to reset the ATA device - specified by Port and PortMultiplierPort. - -**/ -EFI_STATUS -EFIAPI -SiI3132ResetDevice ( - IN EFI_ATA_PASS_THRU_PROTOCOL *This, - IN UINT16 Port, - IN UINT16 PortMultiplierPort - ) -{ - EFI_PCI_IO_PROTOCOL *PciIo; - SATA_SI3132_INSTANCE *SataSiI3132Instance; - SATA_SI3132_PORT *SataPort; - SATA_SI3132_DEVICE *SataDevice; - UINTN Timeout; - UINT32 Value32; - - SATA_TRACE ("SiI3132ResetDevice()"); - - SataSiI3132Instance = INSTANCE_FROM_ATAPASSTHRU_THIS (This); - if (!SataSiI3132Instance) { - return EFI_INVALID_PARAMETER; - } - - PciIo = SataSiI3132Instance->PciIo; - - SataDevice = GetSataDevice (SataSiI3132Instance, Port, PortMultiplierPort); - if (!SataDevice) { - return EFI_INVALID_PARAMETER; - } - SataPort = SataDevice->Port; - - SATA_PORT_WRITE32 (SataPort->RegBase + SII3132_PORT_CONTROLSET_REG, SII3132_PORT_DEVICE_RESET); - - Timeout = 100; - SATA_PORT_READ32 (SataPort->RegBase + SII3132_PORT_STATUS_REG, &Value32); - while ((Timeout > 0) && ((Value32 & SII3132_PORT_DEVICE_RESET) != 0)) { - gBS->Stall (1); - SATA_PORT_READ32 (SataPort->RegBase + SII3132_PORT_STATUS_REG, &Value32); - Timeout--; - } - - if (Timeout == 0) { - SATA_TRACE ("SiI3132ResetDevice(): Timeout"); - return EFI_TIMEOUT; - } else { - return EFI_SUCCESS; - } -}