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