IN UINT32 Offset\r
)\r
{\r
- UINT32 Data;\r
+ UINT32 Data;\r
\r
ASSERT (PciIo != NULL);\r
\r
PciIo,\r
EfiPciIoWidthUint32,\r
EFI_AHCI_BAR_INDEX,\r
- (UINT64) Offset,\r
+ (UINT64)Offset,\r
1,\r
&Data\r
);\r
PciIo,\r
EfiPciIoWidthUint32,\r
EFI_AHCI_BAR_INDEX,\r
- (UINT64) Offset,\r
+ (UINT64)Offset,\r
1,\r
&Data\r
);\r
\r
- return ;\r
+ return;\r
}\r
\r
/**\r
IN UINT32 AndData\r
)\r
{\r
- UINT32 Data;\r
+ UINT32 Data;\r
\r
ASSERT (PciIo != NULL);\r
\r
- Data = AhciReadReg (PciIo, Offset);\r
+ Data = AhciReadReg (PciIo, Offset);\r
\r
Data &= AndData;\r
\r
IN UINT32 OrData\r
)\r
{\r
- UINT32 Data;\r
+ UINT32 Data;\r
\r
ASSERT (PciIo != NULL);\r
\r
- Data = AhciReadReg (PciIo, Offset);\r
+ Data = AhciReadReg (PciIo, Offset);\r
\r
Data |= OrData;\r
\r
EFI_STATUS\r
EFIAPI\r
AhciWaitMmioSet (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN UINTN Offset,\r
- IN UINT32 MaskValue,\r
- IN UINT32 TestValue,\r
- IN UINT64 Timeout\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN UINTN Offset,\r
+ IN UINT32 MaskValue,\r
+ IN UINT32 TestValue,\r
+ IN UINT64 Timeout\r
)\r
{\r
- UINT32 Value;\r
- UINT64 Delay;\r
- BOOLEAN InfiniteWait;\r
+ UINT32 Value;\r
+ UINT64 Delay;\r
+ BOOLEAN InfiniteWait;\r
\r
if (Timeout == 0) {\r
InfiniteWait = TRUE;\r
//\r
// Access PCI MMIO space to see if the value is the tested one.\r
//\r
- Value = AhciReadReg (PciIo, (UINT32) Offset) & MaskValue;\r
+ Value = AhciReadReg (PciIo, (UINT32)Offset) & MaskValue;\r
\r
if (Value == TestValue) {\r
return EFI_SUCCESS;\r
MicroSecondDelay (100);\r
\r
Delay--;\r
-\r
} while (InfiniteWait || (Delay > 0));\r
\r
return EFI_TIMEOUT;\r
EFI_STATUS\r
EFIAPI\r
AhciWaitMemSet (\r
- IN EFI_PHYSICAL_ADDRESS Address,\r
- IN UINT32 MaskValue,\r
- IN UINT32 TestValue,\r
- IN UINT64 Timeout\r
+ IN EFI_PHYSICAL_ADDRESS Address,\r
+ IN UINT32 MaskValue,\r
+ IN UINT32 TestValue,\r
+ IN UINT64 Timeout\r
)\r
{\r
- UINT32 Value;\r
- UINT64 Delay;\r
- BOOLEAN InfiniteWait;\r
+ UINT32 Value;\r
+ UINT64 Delay;\r
+ BOOLEAN InfiniteWait;\r
\r
if (Timeout == 0) {\r
InfiniteWait = TRUE;\r
// compiler from optimizing the access to the memory address\r
// to only read once.\r
//\r
- Value = *(volatile UINT32 *) (UINTN) Address;\r
+ Value = *(volatile UINT32 *)(UINTN)Address;\r
Value &= MaskValue;\r
\r
if (Value == TestValue) {\r
MicroSecondDelay (100);\r
\r
Delay--;\r
-\r
} while (InfiniteWait || (Delay > 0));\r
\r
return EFI_TIMEOUT;\r
EFI_STATUS\r
EFIAPI\r
AhciCheckMemSet (\r
- IN UINTN Address,\r
- IN UINT32 MaskValue,\r
- IN UINT32 TestValue\r
+ IN UINTN Address,\r
+ IN UINT32 MaskValue,\r
+ IN UINT32 TestValue\r
)\r
{\r
- UINT32 Value;\r
+ UINT32 Value;\r
\r
- Value = *(volatile UINT32 *) Address;\r
+ Value = *(volatile UINT32 *)Address;\r
Value &= MaskValue;\r
\r
if (Value == TestValue) {\r
return EFI_NOT_READY;\r
}\r
\r
-\r
/**\r
\r
Clear the port interrupt and error status. It will also clear\r
VOID\r
EFIAPI\r
AhciClearPortStatus (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN UINT8 Port\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN UINT8 Port\r
)\r
{\r
- UINT32 Offset;\r
+ UINT32 Offset;\r
\r
//\r
// Clear any error status\r
VOID\r
EFIAPI\r
AhciDumpPortStatus (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN EFI_AHCI_REGISTERS *AhciRegisters,\r
- IN UINT8 Port,\r
- IN OUT EFI_ATA_STATUS_BLOCK *AtaStatusBlock\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN EFI_AHCI_REGISTERS *AhciRegisters,\r
+ IN UINT8 Port,\r
+ IN OUT EFI_ATA_STATUS_BLOCK *AtaStatusBlock\r
)\r
{\r
- UINTN Offset;\r
- UINT32 Data;\r
- UINTN FisBaseAddr;\r
- EFI_STATUS Status;\r
+ UINTN Offset;\r
+ UINT32 Data;\r
+ UINTN FisBaseAddr;\r
+ EFI_STATUS Status;\r
\r
ASSERT (PciIo != NULL);\r
\r
Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_TFD;\r
Data = AhciReadReg (PciIo, (UINT32)Offset);\r
\r
- AtaStatusBlock->AtaStatus = (UINT8)Data;\r
+ AtaStatusBlock->AtaStatus = (UINT8)Data;\r
if ((AtaStatusBlock->AtaStatus & BIT0) != 0) {\r
AtaStatusBlock->AtaError = (UINT8)(Data >> 8);\r
}\r
}\r
}\r
\r
-\r
/**\r
Enable the FIS running for giving port.\r
\r
EFI_STATUS\r
EFIAPI\r
AhciEnableFisReceive (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN UINT8 Port,\r
- IN UINT64 Timeout\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN UINT8 Port,\r
+ IN UINT64 Timeout\r
)\r
{\r
- UINT32 Offset;\r
+ UINT32 Offset;\r
\r
Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_CMD;\r
AhciOrReg (PciIo, Offset, EFI_AHCI_PORT_CMD_FRE);\r
EFI_STATUS\r
EFIAPI\r
AhciDisableFisReceive (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN UINT8 Port,\r
- IN UINT64 Timeout\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN UINT8 Port,\r
+ IN UINT64 Timeout\r
)\r
{\r
- UINT32 Offset;\r
- UINT32 Data;\r
+ UINT32 Offset;\r
+ UINT32 Data;\r
\r
Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_CMD;\r
Data = AhciReadReg (PciIo, Offset);\r
return EFI_SUCCESS;\r
}\r
\r
- AhciAndReg (PciIo, Offset, (UINT32)~(EFI_AHCI_PORT_CMD_FRE));\r
+ AhciAndReg (PciIo, Offset, (UINT32) ~(EFI_AHCI_PORT_CMD_FRE));\r
\r
return AhciWaitMmioSet (\r
PciIo,\r
);\r
}\r
\r
-\r
-\r
/**\r
Build the command list, command table and prepare the fis receiver.\r
\r
VOID\r
EFIAPI\r
AhciBuildCommand (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN EFI_AHCI_REGISTERS *AhciRegisters,\r
- IN UINT8 Port,\r
- IN UINT8 PortMultiplier,\r
- IN EFI_AHCI_COMMAND_FIS *CommandFis,\r
- IN EFI_AHCI_COMMAND_LIST *CommandList,\r
- IN EFI_AHCI_ATAPI_COMMAND *AtapiCommand OPTIONAL,\r
- IN UINT8 AtapiCommandLength,\r
- IN UINT8 CommandSlotNumber,\r
- IN OUT VOID *DataPhysicalAddr,\r
- IN UINT32 DataLength\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN EFI_AHCI_REGISTERS *AhciRegisters,\r
+ IN UINT8 Port,\r
+ IN UINT8 PortMultiplier,\r
+ IN EFI_AHCI_COMMAND_FIS *CommandFis,\r
+ IN EFI_AHCI_COMMAND_LIST *CommandList,\r
+ IN EFI_AHCI_ATAPI_COMMAND *AtapiCommand OPTIONAL,\r
+ IN UINT8 AtapiCommandLength,\r
+ IN UINT8 CommandSlotNumber,\r
+ IN OUT VOID *DataPhysicalAddr,\r
+ IN UINT32 DataLength\r
)\r
{\r
- UINT64 BaseAddr;\r
- UINT32 PrdtNumber;\r
- UINT32 PrdtIndex;\r
- UINTN RemainedData;\r
- UINTN MemAddr;\r
- DATA_64 Data64;\r
- UINT32 Offset;\r
+ UINT64 BaseAddr;\r
+ UINT32 PrdtNumber;\r
+ UINT32 PrdtIndex;\r
+ UINTN RemainedData;\r
+ UINTN MemAddr;\r
+ DATA_64 Data64;\r
+ UINT32 Offset;\r
\r
//\r
// Filling the PRDT\r
//\r
ASSERT (PrdtNumber <= 65535);\r
\r
- Data64.Uint64 = (UINTN) (AhciRegisters->AhciRFis) + sizeof (EFI_AHCI_RECEIVED_FIS) * Port;\r
+ Data64.Uint64 = (UINTN)(AhciRegisters->AhciRFis) + sizeof (EFI_AHCI_RECEIVED_FIS) * Port;\r
\r
BaseAddr = Data64.Uint64;\r
\r
- ZeroMem ((VOID *)((UINTN) BaseAddr), sizeof (EFI_AHCI_RECEIVED_FIS));\r
+ ZeroMem ((VOID *)((UINTN)BaseAddr), sizeof (EFI_AHCI_RECEIVED_FIS));\r
\r
ZeroMem (AhciRegisters->AhciCommandTable, sizeof (EFI_AHCI_COMMAND_TABLE));\r
\r
\r
AhciOrReg (PciIo, Offset, (EFI_AHCI_PORT_CMD_DLAE | EFI_AHCI_PORT_CMD_ATAPI));\r
} else {\r
- AhciAndReg (PciIo, Offset, (UINT32)~(EFI_AHCI_PORT_CMD_DLAE | EFI_AHCI_PORT_CMD_ATAPI));\r
+ AhciAndReg (PciIo, Offset, (UINT32) ~(EFI_AHCI_PORT_CMD_DLAE | EFI_AHCI_PORT_CMD_ATAPI));\r
}\r
\r
- RemainedData = (UINTN) DataLength;\r
- MemAddr = (UINTN) DataPhysicalAddr;\r
+ RemainedData = (UINTN)DataLength;\r
+ MemAddr = (UINTN)DataPhysicalAddr;\r
CommandList->AhciCmdPrdtl = PrdtNumber;\r
\r
for (PrdtIndex = 0; PrdtIndex < PrdtNumber; PrdtIndex++) {\r
AhciRegisters->AhciCommandTable->PrdtTable[PrdtIndex].AhciPrdtDbc = EFI_AHCI_MAX_DATA_PER_PRDT - 1;\r
}\r
\r
- Data64.Uint64 = (UINT64)MemAddr;\r
+ Data64.Uint64 = (UINT64)MemAddr;\r
AhciRegisters->AhciCommandTable->PrdtTable[PrdtIndex].AhciPrdtDba = Data64.Uint32.Lower32;\r
AhciRegisters->AhciCommandTable->PrdtTable[PrdtIndex].AhciPrdtDbau = Data64.Uint32.Upper32;\r
- RemainedData -= EFI_AHCI_MAX_DATA_PER_PRDT;\r
- MemAddr += EFI_AHCI_MAX_DATA_PER_PRDT;\r
+ RemainedData -= EFI_AHCI_MAX_DATA_PER_PRDT;\r
+ MemAddr += EFI_AHCI_MAX_DATA_PER_PRDT;\r
}\r
\r
//\r
}\r
\r
CopyMem (\r
- (VOID *) ((UINTN) AhciRegisters->AhciCmdList + (UINTN) CommandSlotNumber * sizeof (EFI_AHCI_COMMAND_LIST)),\r
+ (VOID *)((UINTN)AhciRegisters->AhciCmdList + (UINTN)CommandSlotNumber * sizeof (EFI_AHCI_COMMAND_LIST)),\r
CommandList,\r
sizeof (EFI_AHCI_COMMAND_LIST)\r
);\r
\r
- Data64.Uint64 = (UINT64)(UINTN) AhciRegisters->AhciCommandTablePciAddr;\r
+ Data64.Uint64 = (UINT64)(UINTN)AhciRegisters->AhciCommandTablePciAddr;\r
AhciRegisters->AhciCmdList[CommandSlotNumber].AhciCmdCtba = Data64.Uint32.Lower32;\r
AhciRegisters->AhciCmdList[CommandSlotNumber].AhciCmdCtbau = Data64.Uint32.Upper32;\r
AhciRegisters->AhciCmdList[CommandSlotNumber].AhciCmdPmp = PortMultiplier;\r
-\r
}\r
\r
/**\r
VOID\r
EFIAPI\r
AhciBuildCommandFis (\r
- IN OUT EFI_AHCI_COMMAND_FIS *CmdFis,\r
- IN EFI_ATA_COMMAND_BLOCK *AtaCommandBlock\r
+ IN OUT EFI_AHCI_COMMAND_FIS *CmdFis,\r
+ IN EFI_ATA_COMMAND_BLOCK *AtaCommandBlock\r
)\r
{\r
ZeroMem (CmdFis, sizeof (EFI_AHCI_COMMAND_FIS));\r
//\r
// Indicator it's a command\r
//\r
- CmdFis->AhciCFisCmdInd = 0x1;\r
- CmdFis->AhciCFisCmd = AtaCommandBlock->AtaCommand;\r
+ CmdFis->AhciCFisCmdInd = 0x1;\r
+ CmdFis->AhciCFisCmd = AtaCommandBlock->AtaCommand;\r
\r
- CmdFis->AhciCFisFeature = AtaCommandBlock->AtaFeatures;\r
- CmdFis->AhciCFisFeatureExp = AtaCommandBlock->AtaFeaturesExp;\r
+ CmdFis->AhciCFisFeature = AtaCommandBlock->AtaFeatures;\r
+ CmdFis->AhciCFisFeatureExp = AtaCommandBlock->AtaFeaturesExp;\r
\r
- CmdFis->AhciCFisSecNum = AtaCommandBlock->AtaSectorNumber;\r
- CmdFis->AhciCFisSecNumExp = AtaCommandBlock->AtaSectorNumberExp;\r
+ CmdFis->AhciCFisSecNum = AtaCommandBlock->AtaSectorNumber;\r
+ CmdFis->AhciCFisSecNumExp = AtaCommandBlock->AtaSectorNumberExp;\r
\r
- CmdFis->AhciCFisClyLow = AtaCommandBlock->AtaCylinderLow;\r
- CmdFis->AhciCFisClyLowExp = AtaCommandBlock->AtaCylinderLowExp;\r
+ CmdFis->AhciCFisClyLow = AtaCommandBlock->AtaCylinderLow;\r
+ CmdFis->AhciCFisClyLowExp = AtaCommandBlock->AtaCylinderLowExp;\r
\r
- CmdFis->AhciCFisClyHigh = AtaCommandBlock->AtaCylinderHigh;\r
- CmdFis->AhciCFisClyHighExp = AtaCommandBlock->AtaCylinderHighExp;\r
+ CmdFis->AhciCFisClyHigh = AtaCommandBlock->AtaCylinderHigh;\r
+ CmdFis->AhciCFisClyHighExp = AtaCommandBlock->AtaCylinderHighExp;\r
\r
CmdFis->AhciCFisSecCount = AtaCommandBlock->AtaSectorCount;\r
CmdFis->AhciCFisSecCountExp = AtaCommandBlock->AtaSectorCountExp;\r
\r
- CmdFis->AhciCFisDevHead = (UINT8) (AtaCommandBlock->AtaDeviceHead | 0xE0);\r
+ CmdFis->AhciCFisDevHead = (UINT8)(AtaCommandBlock->AtaDeviceHead | 0xE0);\r
}\r
\r
/**\r
AhciWaitDeviceReady (\r
IN EFI_PCI_IO_PROTOCOL *PciIo,\r
IN UINT8 Port\r
- )\r
+ )\r
{\r
- UINT32 PhyDetectDelay;\r
- UINT32 Data;\r
- UINT32 Offset;\r
+ UINT32 PhyDetectDelay;\r
+ UINT32 Data;\r
+ UINT32 Offset;\r
\r
//\r
// According to SATA1.0a spec section 5.2, we need to wait for PxTFD.BSY and PxTFD.DRQ\r
PhyDetectDelay = 16 * 1000;\r
do {\r
Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_SERR;\r
- if (AhciReadReg(PciIo, Offset) != 0) {\r
- AhciWriteReg (PciIo, Offset, AhciReadReg(PciIo, Offset));\r
+ if (AhciReadReg (PciIo, Offset) != 0) {\r
+ AhciWriteReg (PciIo, Offset, AhciReadReg (PciIo, Offset));\r
}\r
+\r
Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_TFD;\r
\r
Data = AhciReadReg (PciIo, Offset) & EFI_AHCI_PORT_TFD_MASK;\r
}\r
}\r
\r
-\r
/**\r
Reset the SATA port. Algorithm follows AHCI spec 1.3.1 section 10.4.2\r
\r
// SW is required to keep DET set to 0x1 at least for 1 milisecond to ensure that\r
// at least one COMRESET signal is sent.\r
//\r
- MicroSecondDelay(1000);\r
+ MicroSecondDelay (1000);\r
AhciAndReg (PciIo, Offset, ~(UINT32)EFI_AHCI_PORT_SSTS_DET_MASK);\r
\r
Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_SSTS;\r
UINT32 PortTfd;\r
EFI_STATUS Status;\r
\r
- Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_IS;\r
+ Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_IS;\r
PortInterrupt = AhciReadReg (PciIo, Offset);\r
if ((PortInterrupt & EFI_AHCI_PORT_IS_FATAL_ERROR_MASK) == 0) {\r
//\r
// If TFD.BSY or TFD.DRQ is still set it means that drive is hung and software has\r
// to reset it before sending any additional commands.\r
//\r
- Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_TFD;\r
+ Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_TFD;\r
PortTfd = AhciReadReg (PciIo, Offset);\r
if ((PortTfd & (EFI_AHCI_PORT_TFD_BSY | EFI_AHCI_PORT_TFD_DRQ)) != 0) {\r
Status = AhciResetPort (PciIo, Port);\r
IN SATA_FIS_TYPE FisType\r
)\r
{\r
- UINT32 Offset;\r
- UINT32 PortInterrupt;\r
- UINT32 PortTfd;\r
+ UINT32 Offset;\r
+ UINT32 PortInterrupt;\r
+ UINT32 PortTfd;\r
\r
- Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_IS;\r
+ Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_IS;\r
PortInterrupt = AhciReadReg (PciIo, Offset);\r
if ((PortInterrupt & EFI_AHCI_PORT_IS_ERROR_MASK) != 0) {\r
DEBUG ((DEBUG_ERROR, "AHCI: Error interrupt reported PxIS: %X\n", PortInterrupt));\r
return EFI_DEVICE_ERROR;\r
}\r
+\r
//\r
// For PIO setup FIS - According to SATA 2.6 spec section 11.7, D2h FIS means an error encountered.\r
// But Qemu and Marvel 9230 sata controller may just receive a D2h FIS from device\r
// By this way, we can know if there is a real error happened.\r
//\r
if (((FisType == SataFisD2H) && ((PortInterrupt & EFI_AHCI_PORT_IS_DHRS) != 0)) ||\r
- ((FisType == SataFisPioSetup) && (PortInterrupt & (EFI_AHCI_PORT_IS_PSS | EFI_AHCI_PORT_IS_DHRS)) != 0) ||\r
- ((FisType == SataFisDmaSetup) && (PortInterrupt & (EFI_AHCI_PORT_IS_DSS | EFI_AHCI_PORT_IS_DHRS)) != 0)) {\r
- Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_TFD;\r
- PortTfd = AhciReadReg (PciIo, (UINT32) Offset);\r
+ ((FisType == SataFisPioSetup) && ((PortInterrupt & (EFI_AHCI_PORT_IS_PSS | EFI_AHCI_PORT_IS_DHRS)) != 0)) ||\r
+ ((FisType == SataFisDmaSetup) && ((PortInterrupt & (EFI_AHCI_PORT_IS_DSS | EFI_AHCI_PORT_IS_DHRS)) != 0)))\r
+ {\r
+ Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_TFD;\r
+ PortTfd = AhciReadReg (PciIo, (UINT32)Offset);\r
if ((PortTfd & EFI_AHCI_PORT_TFD_ERR) != 0) {\r
return EFI_DEVICE_ERROR;\r
} else {\r
if (Status != EFI_NOT_READY) {\r
return Status;\r
}\r
+\r
//\r
// Stall for 100 microseconds.\r
//\r
EFI_STATUS\r
EFIAPI\r
AhciPioTransfer (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN EFI_AHCI_REGISTERS *AhciRegisters,\r
- IN UINT8 Port,\r
- IN UINT8 PortMultiplier,\r
- IN EFI_AHCI_ATAPI_COMMAND *AtapiCommand OPTIONAL,\r
- IN UINT8 AtapiCommandLength,\r
- IN BOOLEAN Read,\r
- IN EFI_ATA_COMMAND_BLOCK *AtaCommandBlock,\r
- IN OUT EFI_ATA_STATUS_BLOCK *AtaStatusBlock,\r
- IN OUT VOID *MemoryAddr,\r
- IN UINT32 DataCount,\r
- IN UINT64 Timeout,\r
- IN ATA_NONBLOCK_TASK *Task\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN EFI_AHCI_REGISTERS *AhciRegisters,\r
+ IN UINT8 Port,\r
+ IN UINT8 PortMultiplier,\r
+ IN EFI_AHCI_ATAPI_COMMAND *AtapiCommand OPTIONAL,\r
+ IN UINT8 AtapiCommandLength,\r
+ IN BOOLEAN Read,\r
+ IN EFI_ATA_COMMAND_BLOCK *AtaCommandBlock,\r
+ IN OUT EFI_ATA_STATUS_BLOCK *AtaStatusBlock,\r
+ IN OUT VOID *MemoryAddr,\r
+ IN UINT32 DataCount,\r
+ IN UINT64 Timeout,\r
+ IN ATA_NONBLOCK_TASK *Task\r
)\r
{\r
- EFI_STATUS Status;\r
- EFI_PHYSICAL_ADDRESS PhyAddr;\r
- VOID *Map;\r
- UINTN MapLength;\r
- EFI_PCI_IO_PROTOCOL_OPERATION Flag;\r
- EFI_AHCI_COMMAND_FIS CFis;\r
- EFI_AHCI_COMMAND_LIST CmdList;\r
- UINT32 PrdCount;\r
- UINT32 Retry;\r
+ EFI_STATUS Status;\r
+ EFI_PHYSICAL_ADDRESS PhyAddr;\r
+ VOID *Map;\r
+ UINTN MapLength;\r
+ EFI_PCI_IO_PROTOCOL_OPERATION Flag;\r
+ EFI_AHCI_COMMAND_FIS CFis;\r
+ EFI_AHCI_COMMAND_LIST CmdList;\r
+ UINT32 PrdCount;\r
+ UINT32 Retry;\r
\r
if (Read) {\r
Flag = EfiPciIoOperationBusMasterWrite;\r
// construct command list and command table with pci bus address\r
//\r
MapLength = DataCount;\r
- Status = PciIo->Map (\r
- PciIo,\r
- Flag,\r
- MemoryAddr,\r
- &MapLength,\r
- &PhyAddr,\r
- &Map\r
- );\r
+ Status = PciIo->Map (\r
+ PciIo,\r
+ Flag,\r
+ MemoryAddr,\r
+ &MapLength,\r
+ &PhyAddr,\r
+ &Map\r
+ );\r
\r
if (EFI_ERROR (Status) || (DataCount != MapLength)) {\r
return EFI_BAD_BUFFER_SIZE;\r
DEBUG ((DEBUG_VERBOSE, "Starting command for PIO transfer:\n"));\r
AhciPrintCommandBlock (AtaCommandBlock, DEBUG_VERBOSE);\r
Status = AhciStartCommand (\r
- PciIo,\r
- Port,\r
- 0,\r
- Timeout\r
- );\r
+ PciIo,\r
+ Port,\r
+ 0,\r
+ Timeout\r
+ );\r
if (EFI_ERROR (Status)) {\r
break;\r
}\r
if (Read && (AtapiCommand == 0)) {\r
Status = AhciWaitUntilFisReceived (PciIo, Port, Timeout, SataFisPioSetup);\r
if (Status == EFI_SUCCESS) {\r
- PrdCount = *(volatile UINT32 *) (&(AhciRegisters->AhciCmdList[0].AhciCmdPrdbc));\r
+ PrdCount = *(volatile UINT32 *)(&(AhciRegisters->AhciCmdList[0].AhciCmdPrdbc));\r
if (PrdCount == DataCount) {\r
Status = EFI_SUCCESS;\r
} else {\r
);\r
\r
PciIo->Unmap (\r
- PciIo,\r
- Map\r
- );\r
+ PciIo,\r
+ Map\r
+ );\r
\r
AhciDumpPortStatus (PciIo, AhciRegisters, Port, AtaStatusBlock);\r
\r
EFI_STATUS\r
EFIAPI\r
AhciDmaTransfer (\r
- IN ATA_ATAPI_PASS_THRU_INSTANCE *Instance,\r
- IN EFI_AHCI_REGISTERS *AhciRegisters,\r
- IN UINT8 Port,\r
- IN UINT8 PortMultiplier,\r
- IN EFI_AHCI_ATAPI_COMMAND *AtapiCommand OPTIONAL,\r
- IN UINT8 AtapiCommandLength,\r
- IN BOOLEAN Read,\r
- IN EFI_ATA_COMMAND_BLOCK *AtaCommandBlock,\r
- IN OUT EFI_ATA_STATUS_BLOCK *AtaStatusBlock,\r
- IN OUT VOID *MemoryAddr,\r
- IN UINT32 DataCount,\r
- IN UINT64 Timeout,\r
- IN ATA_NONBLOCK_TASK *Task\r
+ IN ATA_ATAPI_PASS_THRU_INSTANCE *Instance,\r
+ IN EFI_AHCI_REGISTERS *AhciRegisters,\r
+ IN UINT8 Port,\r
+ IN UINT8 PortMultiplier,\r
+ IN EFI_AHCI_ATAPI_COMMAND *AtapiCommand OPTIONAL,\r
+ IN UINT8 AtapiCommandLength,\r
+ IN BOOLEAN Read,\r
+ IN EFI_ATA_COMMAND_BLOCK *AtaCommandBlock,\r
+ IN OUT EFI_ATA_STATUS_BLOCK *AtaStatusBlock,\r
+ IN OUT VOID *MemoryAddr,\r
+ IN UINT32 DataCount,\r
+ IN UINT64 Timeout,\r
+ IN ATA_NONBLOCK_TASK *Task\r
)\r
{\r
- EFI_STATUS Status;\r
- EFI_PHYSICAL_ADDRESS PhyAddr;\r
- VOID *Map;\r
- UINTN MapLength;\r
- EFI_PCI_IO_PROTOCOL_OPERATION Flag;\r
- EFI_AHCI_COMMAND_FIS CFis;\r
- EFI_AHCI_COMMAND_LIST CmdList;\r
- EFI_PCI_IO_PROTOCOL *PciIo;\r
- EFI_TPL OldTpl;\r
- UINT32 Retry;\r
+ EFI_STATUS Status;\r
+ EFI_PHYSICAL_ADDRESS PhyAddr;\r
+ VOID *Map;\r
+ UINTN MapLength;\r
+ EFI_PCI_IO_PROTOCOL_OPERATION Flag;\r
+ EFI_AHCI_COMMAND_FIS CFis;\r
+ EFI_AHCI_COMMAND_LIST CmdList;\r
+ EFI_PCI_IO_PROTOCOL *PciIo;\r
+ EFI_TPL OldTpl;\r
+ UINT32 Retry;\r
\r
Map = NULL;\r
PciIo = Instance->PciIo;\r
}\r
\r
MapLength = DataCount;\r
- Status = PciIo->Map (\r
- PciIo,\r
- Flag,\r
- MemoryAddr,\r
- &MapLength,\r
- &PhyAddr,\r
- &Map\r
- );\r
+ Status = PciIo->Map (\r
+ PciIo,\r
+ Flag,\r
+ MemoryAddr,\r
+ &MapLength,\r
+ &PhyAddr,\r
+ &Map\r
+ );\r
\r
if (EFI_ERROR (Status) || (DataCount != MapLength)) {\r
return EFI_BAD_BUFFER_SIZE;\r
}\r
+\r
if (Task != NULL) {\r
Task->Map = Map;\r
}\r
}\r
\r
- if (Task == NULL || (Task != NULL && !Task->IsStart)) {\r
+ if ((Task == NULL) || ((Task != NULL) && !Task->IsStart)) {\r
AhciBuildCommandFis (&CFis, AtaCommandBlock);\r
\r
ZeroMem (&CmdList, sizeof (EFI_AHCI_COMMAND_LIST));\r
//\r
MicroSecondDelay (100);\r
}\r
+\r
gBS->RestoreTPL (OldTpl);\r
for (Retry = 0; Retry < AHCI_COMMAND_RETRIES; Retry++) {\r
AhciBuildCommand (\r
DEBUG ((DEBUG_VERBOSE, "Starting command for sync DMA transfer:\n"));\r
AhciPrintCommandBlock (AtaCommandBlock, DEBUG_VERBOSE);\r
Status = AhciStartCommand (\r
- PciIo,\r
- Port,\r
- 0,\r
- Timeout\r
- );\r
+ PciIo,\r
+ Port,\r
+ 0,\r
+ Timeout\r
+ );\r
if (EFI_ERROR (Status)) {\r
break;\r
}\r
+\r
Status = AhciWaitUntilFisReceived (PciIo, Port, Timeout, SataFisD2H);\r
if (Status == EFI_DEVICE_ERROR) {\r
DEBUG ((DEBUG_ERROR, "DMA command failed at retry: %d\n", Retry));\r
DEBUG ((DEBUG_VERBOSE, "Starting command for async DMA transfer:\n"));\r
AhciPrintCommandBlock (AtaCommandBlock, DEBUG_VERBOSE);\r
Status = AhciStartCommand (\r
- PciIo,\r
- Port,\r
- 0,\r
- Timeout\r
- );\r
+ PciIo,\r
+ Port,\r
+ 0,\r
+ Timeout\r
+ );\r
if (!EFI_ERROR (Status)) {\r
Task->IsStart = TRUE;\r
}\r
}\r
+\r
if (Task->IsStart) {\r
Status = AhciCheckFisReceived (PciIo, Port, SataFisD2H);\r
if (Status == EFI_DEVICE_ERROR) {\r
//\r
if (Status == EFI_SUCCESS) {\r
Task->IsStart = FALSE;\r
- Status = EFI_NOT_READY;\r
+ Status = EFI_NOT_READY;\r
}\r
}\r
\r
if (Status == EFI_NOT_READY) {\r
- if (!Task->InfiniteWait && Task->RetryTimes == 0) {\r
+ if (!Task->InfiniteWait && (Task->RetryTimes == 0)) {\r
Status = EFI_TIMEOUT;\r
} else {\r
Task->RetryTimes--;\r
// EFI_NOT_READY that means the command doesn't finished, try again.), first do the\r
// context cleanup, then set the packet's Asb status.\r
//\r
- if (Task == NULL ||\r
+ if ((Task == NULL) ||\r
((Task != NULL) && (Status != EFI_NOT_READY))\r
- ) {\r
+ )\r
+ {\r
AhciStopCommand (\r
PciIo,\r
Port,\r
EFI_STATUS\r
EFIAPI\r
AhciNonDataTransfer (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN EFI_AHCI_REGISTERS *AhciRegisters,\r
- IN UINT8 Port,\r
- IN UINT8 PortMultiplier,\r
- IN EFI_AHCI_ATAPI_COMMAND *AtapiCommand OPTIONAL,\r
- IN UINT8 AtapiCommandLength,\r
- IN EFI_ATA_COMMAND_BLOCK *AtaCommandBlock,\r
- IN OUT EFI_ATA_STATUS_BLOCK *AtaStatusBlock,\r
- IN UINT64 Timeout,\r
- IN ATA_NONBLOCK_TASK *Task\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN EFI_AHCI_REGISTERS *AhciRegisters,\r
+ IN UINT8 Port,\r
+ IN UINT8 PortMultiplier,\r
+ IN EFI_AHCI_ATAPI_COMMAND *AtapiCommand OPTIONAL,\r
+ IN UINT8 AtapiCommandLength,\r
+ IN EFI_ATA_COMMAND_BLOCK *AtaCommandBlock,\r
+ IN OUT EFI_ATA_STATUS_BLOCK *AtaStatusBlock,\r
+ IN UINT64 Timeout,\r
+ IN ATA_NONBLOCK_TASK *Task\r
)\r
{\r
- EFI_STATUS Status;\r
- EFI_AHCI_COMMAND_FIS CFis;\r
- EFI_AHCI_COMMAND_LIST CmdList;\r
- UINT32 Retry;\r
+ EFI_STATUS Status;\r
+ EFI_AHCI_COMMAND_FIS CFis;\r
+ EFI_AHCI_COMMAND_LIST CmdList;\r
+ UINT32 Retry;\r
\r
//\r
// Package read needed\r
DEBUG ((DEBUG_VERBOSE, "Starting command for non data transfer:\n"));\r
AhciPrintCommandBlock (AtaCommandBlock, DEBUG_VERBOSE);\r
Status = AhciStartCommand (\r
- PciIo,\r
- Port,\r
- 0,\r
- Timeout\r
- );\r
+ PciIo,\r
+ Port,\r
+ 0,\r
+ Timeout\r
+ );\r
if (EFI_ERROR (Status)) {\r
break;\r
}\r
EFI_STATUS\r
EFIAPI\r
AhciStopCommand (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN UINT8 Port,\r
- IN UINT64 Timeout\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN UINT8 Port,\r
+ IN UINT64 Timeout\r
)\r
{\r
- UINT32 Offset;\r
- UINT32 Data;\r
+ UINT32 Offset;\r
+ UINT32 Data;\r
\r
Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_CMD;\r
Data = AhciReadReg (PciIo, Offset);\r
}\r
\r
if ((Data & EFI_AHCI_PORT_CMD_ST) != 0) {\r
- AhciAndReg (PciIo, Offset, (UINT32)~(EFI_AHCI_PORT_CMD_ST));\r
+ AhciAndReg (PciIo, Offset, (UINT32) ~(EFI_AHCI_PORT_CMD_ST));\r
}\r
\r
return AhciWaitMmioSet (\r
EFI_STATUS\r
EFIAPI\r
AhciStartCommand (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN UINT8 Port,\r
- IN UINT8 CommandSlot,\r
- IN UINT64 Timeout\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN UINT8 Port,\r
+ IN UINT8 CommandSlot,\r
+ IN UINT64 Timeout\r
)\r
{\r
- UINT32 CmdSlotBit;\r
- EFI_STATUS Status;\r
- UINT32 PortStatus;\r
- UINT32 StartCmd;\r
- UINT32 PortTfd;\r
- UINT32 Offset;\r
- UINT32 Capability;\r
+ UINT32 CmdSlotBit;\r
+ EFI_STATUS Status;\r
+ UINT32 PortStatus;\r
+ UINT32 StartCmd;\r
+ UINT32 PortTfd;\r
+ UINT32 Offset;\r
+ UINT32 Capability;\r
\r
//\r
// Collect AHCI controller information\r
//\r
- Capability = AhciReadReg(PciIo, EFI_AHCI_CAPABILITY_OFFSET);\r
+ Capability = AhciReadReg (PciIo, EFI_AHCI_CAPABILITY_OFFSET);\r
\r
- CmdSlotBit = (UINT32) (1 << CommandSlot);\r
+ CmdSlotBit = (UINT32)(1 << CommandSlot);\r
\r
AhciClearPortStatus (\r
PciIo,\r
return Status;\r
}\r
\r
- Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_CMD;\r
+ Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_CMD;\r
PortStatus = AhciReadReg (PciIo, Offset);\r
\r
StartCmd = 0;\r
if ((PortStatus & EFI_AHCI_PORT_CMD_ALPE) != 0) {\r
- StartCmd = AhciReadReg (PciIo, Offset);\r
+ StartCmd = AhciReadReg (PciIo, Offset);\r
StartCmd &= ~EFI_AHCI_PORT_CMD_ICC_MASK;\r
StartCmd |= EFI_AHCI_PORT_CMD_ACTIVE;\r
}\r
\r
- Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_TFD;\r
+ Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_TFD;\r
PortTfd = AhciReadReg (PciIo, Offset);\r
\r
if ((PortTfd & (EFI_AHCI_PORT_TFD_BSY | EFI_AHCI_PORT_TFD_DRQ)) != 0) {\r
return EFI_SUCCESS;\r
}\r
\r
-\r
/**\r
Do AHCI HBA reset.\r
\r
EFI_STATUS\r
EFIAPI\r
AhciReset (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN UINT64 Timeout\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN UINT64 Timeout\r
)\r
{\r
- UINT64 Delay;\r
- UINT32 Value;\r
+ UINT64 Delay;\r
+ UINT32 Value;\r
\r
//\r
// Make sure that GHC.AE bit is set before accessing any AHCI registers.\r
//\r
- Value = AhciReadReg(PciIo, EFI_AHCI_GHC_OFFSET);\r
+ Value = AhciReadReg (PciIo, EFI_AHCI_GHC_OFFSET);\r
\r
if ((Value & EFI_AHCI_GHC_ENABLE) == 0) {\r
AhciOrReg (PciIo, EFI_AHCI_GHC_OFFSET, EFI_AHCI_GHC_ENABLE);\r
\r
AhciOrReg (PciIo, EFI_AHCI_GHC_OFFSET, EFI_AHCI_GHC_RESET);\r
\r
- Delay = DivU64x32(Timeout, 1000) + 1;\r
+ Delay = DivU64x32 (Timeout, 1000) + 1;\r
\r
do {\r
- Value = AhciReadReg(PciIo, EFI_AHCI_GHC_OFFSET);\r
+ Value = AhciReadReg (PciIo, EFI_AHCI_GHC_OFFSET);\r
\r
if ((Value & EFI_AHCI_GHC_RESET) == 0) {\r
break;\r
//\r
// Stall for 100 microseconds.\r
//\r
- MicroSecondDelay(100);\r
+ MicroSecondDelay (100);\r
\r
Delay--;\r
} while (Delay > 0);\r
EFI_STATUS\r
EFIAPI\r
AhciAtaSmartReturnStatusCheck (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN EFI_AHCI_REGISTERS *AhciRegisters,\r
- IN UINT8 Port,\r
- IN UINT8 PortMultiplier,\r
- IN OUT EFI_ATA_STATUS_BLOCK *AtaStatusBlock\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN EFI_AHCI_REGISTERS *AhciRegisters,\r
+ IN UINT8 Port,\r
+ IN UINT8 PortMultiplier,\r
+ IN OUT EFI_ATA_STATUS_BLOCK *AtaStatusBlock\r
)\r
{\r
- EFI_STATUS Status;\r
- EFI_ATA_COMMAND_BLOCK AtaCommandBlock;\r
- UINT8 LBAMid;\r
- UINT8 LBAHigh;\r
- UINTN FisBaseAddr;\r
- UINT32 Value;\r
+ EFI_STATUS Status;\r
+ EFI_ATA_COMMAND_BLOCK AtaCommandBlock;\r
+ UINT8 LBAMid;\r
+ UINT8 LBAHigh;\r
+ UINTN FisBaseAddr;\r
+ UINT32 Value;\r
\r
ZeroMem (&AtaCommandBlock, sizeof (EFI_ATA_COMMAND_BLOCK));\r
\r
\r
FisBaseAddr = (UINTN)AhciRegisters->AhciRFis + Port * sizeof (EFI_AHCI_RECEIVED_FIS);\r
\r
- Value = *(UINT32 *) (FisBaseAddr + EFI_AHCI_D2H_FIS_OFFSET);\r
+ Value = *(UINT32 *)(FisBaseAddr + EFI_AHCI_D2H_FIS_OFFSET);\r
\r
if ((Value & EFI_AHCI_FIS_TYPE_MASK) == EFI_AHCI_FIS_REGISTER_D2H) {\r
LBAMid = ((UINT8 *)(UINTN)(FisBaseAddr + EFI_AHCI_D2H_FIS_OFFSET))[5];\r
//\r
DEBUG ((DEBUG_INFO, "The S.M.A.R.T threshold exceeded condition is not detected\n"));\r
REPORT_STATUS_CODE (\r
- EFI_PROGRESS_CODE,\r
- (EFI_IO_BUS_ATA_ATAPI | EFI_IOB_ATA_BUS_SMART_UNDERTHRESHOLD)\r
- );\r
+ EFI_PROGRESS_CODE,\r
+ (EFI_IO_BUS_ATA_ATAPI | EFI_IOB_ATA_BUS_SMART_UNDERTHRESHOLD)\r
+ );\r
} else if ((LBAMid == 0xf4) && (LBAHigh == 0x2c)) {\r
//\r
// The threshold exceeded condition is detected by the device\r
//\r
DEBUG ((DEBUG_INFO, "The S.M.A.R.T threshold exceeded condition is detected\n"));\r
REPORT_STATUS_CODE (\r
- EFI_PROGRESS_CODE,\r
- (EFI_IO_BUS_ATA_ATAPI | EFI_IOB_ATA_BUS_SMART_OVERTHRESHOLD)\r
- );\r
+ EFI_PROGRESS_CODE,\r
+ (EFI_IO_BUS_ATA_ATAPI | EFI_IOB_ATA_BUS_SMART_OVERTHRESHOLD)\r
+ );\r
}\r
}\r
\r
VOID\r
EFIAPI\r
AhciAtaSmartSupport (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN EFI_AHCI_REGISTERS *AhciRegisters,\r
- IN UINT8 Port,\r
- IN UINT8 PortMultiplier,\r
- IN EFI_IDENTIFY_DATA *IdentifyData,\r
- IN OUT EFI_ATA_STATUS_BLOCK *AtaStatusBlock\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN EFI_AHCI_REGISTERS *AhciRegisters,\r
+ IN UINT8 Port,\r
+ IN UINT8 PortMultiplier,\r
+ IN EFI_IDENTIFY_DATA *IdentifyData,\r
+ IN OUT EFI_ATA_STATUS_BLOCK *AtaStatusBlock\r
)\r
{\r
- EFI_STATUS Status;\r
- EFI_ATA_COMMAND_BLOCK AtaCommandBlock;\r
+ EFI_STATUS Status;\r
+ EFI_ATA_COMMAND_BLOCK AtaCommandBlock;\r
\r
//\r
// Detect if the device supports S.M.A.R.T.\r
//\r
// S.M.A.R.T is not supported by the device\r
//\r
- DEBUG ((DEBUG_INFO, "S.M.A.R.T feature is not supported at port [%d] PortMultiplier [%d]!\n",\r
- Port, PortMultiplier));\r
+ DEBUG ((\r
+ DEBUG_INFO,\r
+ "S.M.A.R.T feature is not supported at port [%d] PortMultiplier [%d]!\n",\r
+ Port,\r
+ PortMultiplier\r
+ ));\r
REPORT_STATUS_CODE (\r
EFI_ERROR_CODE | EFI_ERROR_MINOR,\r
(EFI_IO_BUS_ATA_ATAPI | EFI_IOB_ATA_BUS_SMART_NOTSUPPORTED)\r
// Check if the feature is enabled. If not, then enable S.M.A.R.T.\r
//\r
if ((IdentifyData->AtaData.command_set_feature_enb_85 & 0x0001) != 0x0001) {\r
-\r
REPORT_STATUS_CODE (\r
EFI_PROGRESS_CODE,\r
(EFI_IO_BUS_ATA_ATAPI | EFI_IOB_ATA_BUS_SMART_DISABLE)\r
NULL\r
);\r
\r
-\r
if (!EFI_ERROR (Status)) {\r
//\r
// Send S.M.A.R.T AutoSave command to device\r
AtaStatusBlock\r
);\r
\r
- DEBUG ((DEBUG_INFO, "Enabled S.M.A.R.T feature at port [%d] PortMultiplier [%d]!\n",\r
- Port, PortMultiplier));\r
+ DEBUG ((\r
+ DEBUG_INFO,\r
+ "Enabled S.M.A.R.T feature at port [%d] PortMultiplier [%d]!\n",\r
+ Port,\r
+ PortMultiplier\r
+ ));\r
}\r
\r
- return ;\r
+ return;\r
}\r
\r
/**\r
EFI_STATUS\r
EFIAPI\r
AhciIdentify (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN EFI_AHCI_REGISTERS *AhciRegisters,\r
- IN UINT8 Port,\r
- IN UINT8 PortMultiplier,\r
- IN OUT EFI_IDENTIFY_DATA *Buffer\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN EFI_AHCI_REGISTERS *AhciRegisters,\r
+ IN UINT8 Port,\r
+ IN UINT8 PortMultiplier,\r
+ IN OUT EFI_IDENTIFY_DATA *Buffer\r
)\r
{\r
- EFI_STATUS Status;\r
- EFI_ATA_COMMAND_BLOCK AtaCommandBlock;\r
- EFI_ATA_STATUS_BLOCK AtaStatusBlock;\r
+ EFI_STATUS Status;\r
+ EFI_ATA_COMMAND_BLOCK AtaCommandBlock;\r
+ EFI_ATA_STATUS_BLOCK AtaStatusBlock;\r
\r
- if (PciIo == NULL || AhciRegisters == NULL || Buffer == NULL) {\r
+ if ((PciIo == NULL) || (AhciRegisters == NULL) || (Buffer == NULL)) {\r
return EFI_INVALID_PARAMETER;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
AhciIdentifyPacket (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN EFI_AHCI_REGISTERS *AhciRegisters,\r
- IN UINT8 Port,\r
- IN UINT8 PortMultiplier,\r
- IN OUT EFI_IDENTIFY_DATA *Buffer\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN EFI_AHCI_REGISTERS *AhciRegisters,\r
+ IN UINT8 Port,\r
+ IN UINT8 PortMultiplier,\r
+ IN OUT EFI_IDENTIFY_DATA *Buffer\r
)\r
{\r
- EFI_STATUS Status;\r
- EFI_ATA_COMMAND_BLOCK AtaCommandBlock;\r
- EFI_ATA_STATUS_BLOCK AtaStatusBlock;\r
+ EFI_STATUS Status;\r
+ EFI_ATA_COMMAND_BLOCK AtaCommandBlock;\r
+ EFI_ATA_STATUS_BLOCK AtaStatusBlock;\r
\r
- if (PciIo == NULL || AhciRegisters == NULL) {\r
+ if ((PciIo == NULL) || (AhciRegisters == NULL)) {\r
return EFI_INVALID_PARAMETER;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
AhciDeviceSetFeature (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN EFI_AHCI_REGISTERS *AhciRegisters,\r
- IN UINT8 Port,\r
- IN UINT8 PortMultiplier,\r
- IN UINT16 Feature,\r
- IN UINT32 FeatureSpecificData,\r
- IN UINT64 Timeout\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN EFI_AHCI_REGISTERS *AhciRegisters,\r
+ IN UINT8 Port,\r
+ IN UINT8 PortMultiplier,\r
+ IN UINT16 Feature,\r
+ IN UINT32 FeatureSpecificData,\r
+ IN UINT64 Timeout\r
)\r
{\r
- EFI_STATUS Status;\r
- EFI_ATA_COMMAND_BLOCK AtaCommandBlock;\r
- EFI_ATA_STATUS_BLOCK AtaStatusBlock;\r
+ EFI_STATUS Status;\r
+ EFI_ATA_COMMAND_BLOCK AtaCommandBlock;\r
+ EFI_ATA_STATUS_BLOCK AtaStatusBlock;\r
\r
ZeroMem (&AtaCommandBlock, sizeof (EFI_ATA_COMMAND_BLOCK));\r
ZeroMem (&AtaStatusBlock, sizeof (EFI_ATA_STATUS_BLOCK));\r
\r
AtaCommandBlock.AtaCommand = ATA_CMD_SET_FEATURES;\r
- AtaCommandBlock.AtaFeatures = (UINT8) Feature;\r
- AtaCommandBlock.AtaFeaturesExp = (UINT8) (Feature >> 8);\r
- AtaCommandBlock.AtaSectorCount = (UINT8) FeatureSpecificData;\r
- AtaCommandBlock.AtaSectorNumber = (UINT8) (FeatureSpecificData >> 8);\r
- AtaCommandBlock.AtaCylinderLow = (UINT8) (FeatureSpecificData >> 16);\r
- AtaCommandBlock.AtaCylinderHigh = (UINT8) (FeatureSpecificData >> 24);\r
+ AtaCommandBlock.AtaFeatures = (UINT8)Feature;\r
+ AtaCommandBlock.AtaFeaturesExp = (UINT8)(Feature >> 8);\r
+ AtaCommandBlock.AtaSectorCount = (UINT8)FeatureSpecificData;\r
+ AtaCommandBlock.AtaSectorNumber = (UINT8)(FeatureSpecificData >> 8);\r
+ AtaCommandBlock.AtaCylinderLow = (UINT8)(FeatureSpecificData >> 16);\r
+ AtaCommandBlock.AtaCylinderHigh = (UINT8)(FeatureSpecificData >> 24);\r
\r
Status = AhciNonDataTransfer (\r
PciIo,\r
EFI_STATUS\r
EFIAPI\r
AhciPacketCommandExecute (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN EFI_AHCI_REGISTERS *AhciRegisters,\r
- IN UINT8 Port,\r
- IN UINT8 PortMultiplier,\r
- IN EFI_EXT_SCSI_PASS_THRU_SCSI_REQUEST_PACKET *Packet\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN EFI_AHCI_REGISTERS *AhciRegisters,\r
+ IN UINT8 Port,\r
+ IN UINT8 PortMultiplier,\r
+ IN EFI_EXT_SCSI_PASS_THRU_SCSI_REQUEST_PACKET *Packet\r
)\r
{\r
- EFI_STATUS Status;\r
- VOID *Buffer;\r
- UINT32 Length;\r
- EFI_ATA_COMMAND_BLOCK AtaCommandBlock;\r
- EFI_ATA_STATUS_BLOCK AtaStatusBlock;\r
- BOOLEAN Read;\r
-\r
- if (Packet == NULL || Packet->Cdb == NULL) {\r
+ EFI_STATUS Status;\r
+ VOID *Buffer;\r
+ UINT32 Length;\r
+ EFI_ATA_COMMAND_BLOCK AtaCommandBlock;\r
+ EFI_ATA_STATUS_BLOCK AtaStatusBlock;\r
+ BOOLEAN Read;\r
+\r
+ if ((Packet == NULL) || (Packet->Cdb == NULL)) {\r
return EFI_INVALID_PARAMETER;\r
}\r
\r
ZeroMem (&AtaCommandBlock, sizeof (EFI_ATA_COMMAND_BLOCK));\r
ZeroMem (&AtaStatusBlock, sizeof (EFI_ATA_STATUS_BLOCK));\r
- AtaCommandBlock.AtaCommand = ATA_CMD_PACKET;\r
+ AtaCommandBlock.AtaCommand = ATA_CMD_PACKET;\r
//\r
// No OVL; No DMA\r
//\r
- AtaCommandBlock.AtaFeatures = 0x00;\r
+ AtaCommandBlock.AtaFeatures = 0x00;\r
//\r
// set the transfersize to ATAPI_MAX_BYTE_COUNT to let the device\r
// determine how many data should be transferred.\r
//\r
- AtaCommandBlock.AtaCylinderLow = (UINT8) (ATAPI_MAX_BYTE_COUNT & 0x00ff);\r
- AtaCommandBlock.AtaCylinderHigh = (UINT8) (ATAPI_MAX_BYTE_COUNT >> 8);\r
+ AtaCommandBlock.AtaCylinderLow = (UINT8)(ATAPI_MAX_BYTE_COUNT & 0x00ff);\r
+ AtaCommandBlock.AtaCylinderHigh = (UINT8)(ATAPI_MAX_BYTE_COUNT >> 8);\r
\r
if (Packet->DataDirection == EFI_EXT_SCSI_DATA_DIRECTION_READ) {\r
Buffer = Packet->InDataBuffer;\r
Length = Packet->InTransferLength;\r
- Read = TRUE;\r
+ Read = TRUE;\r
} else {\r
Buffer = Packet->OutDataBuffer;\r
Length = Packet->OutTransferLength;\r
- Read = FALSE;\r
+ Read = FALSE;\r
}\r
\r
if (Length == 0) {\r
NULL\r
);\r
}\r
+\r
return Status;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
AhciCreateTransferDescriptor (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN OUT EFI_AHCI_REGISTERS *AhciRegisters\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN OUT EFI_AHCI_REGISTERS *AhciRegisters\r
)\r
{\r
- EFI_STATUS Status;\r
- UINTN Bytes;\r
- VOID *Buffer;\r
+ EFI_STATUS Status;\r
+ UINTN Bytes;\r
+ VOID *Buffer;\r
\r
UINT32 Capability;\r
UINT32 PortImplementBitMap;\r
//\r
// Collect AHCI controller information\r
//\r
- Capability = AhciReadReg(PciIo, EFI_AHCI_CAPABILITY_OFFSET);\r
+ Capability = AhciReadReg (PciIo, EFI_AHCI_CAPABILITY_OFFSET);\r
//\r
// Get the number of command slots per port supported by this HBA.\r
//\r
- MaxCommandSlotNumber = (UINT8) (((Capability & 0x1F00) >> 8) + 1);\r
- Support64Bit = (BOOLEAN) (((Capability & BIT31) != 0) ? TRUE : FALSE);\r
+ MaxCommandSlotNumber = (UINT8)(((Capability & 0x1F00) >> 8) + 1);\r
+ Support64Bit = (BOOLEAN)(((Capability & BIT31) != 0) ? TRUE : FALSE);\r
\r
- PortImplementBitMap = AhciReadReg(PciIo, EFI_AHCI_PI_OFFSET);\r
+ PortImplementBitMap = AhciReadReg (PciIo, EFI_AHCI_PI_OFFSET);\r
//\r
// Get the highest bit of implemented ports which decides how many bytes are allocated for received FIS.\r
//\r
- MaxPortNumber = (UINT8)(UINTN)(HighBitSet32(PortImplementBitMap) + 1);\r
+ MaxPortNumber = (UINT8)(UINTN)(HighBitSet32 (PortImplementBitMap) + 1);\r
if (MaxPortNumber == 0) {\r
return EFI_DEVICE_ERROR;\r
}\r
\r
- MaxReceiveFisSize = MaxPortNumber * sizeof (EFI_AHCI_RECEIVED_FIS);\r
- Status = PciIo->AllocateBuffer (\r
- PciIo,\r
- AllocateAnyPages,\r
- EfiBootServicesData,\r
- EFI_SIZE_TO_PAGES ((UINTN) MaxReceiveFisSize),\r
- &Buffer,\r
- 0\r
- );\r
+ MaxReceiveFisSize = MaxPortNumber * sizeof (EFI_AHCI_RECEIVED_FIS);\r
+ Status = PciIo->AllocateBuffer (\r
+ PciIo,\r
+ AllocateAnyPages,\r
+ EfiBootServicesData,\r
+ EFI_SIZE_TO_PAGES ((UINTN)MaxReceiveFisSize),\r
+ &Buffer,\r
+ 0\r
+ );\r
\r
if (EFI_ERROR (Status)) {\r
return EFI_OUT_OF_RESOURCES;\r
\r
AhciRegisters->AhciRFis = Buffer;\r
AhciRegisters->MaxReceiveFisSize = MaxReceiveFisSize;\r
- Bytes = (UINTN)MaxReceiveFisSize;\r
+ Bytes = (UINTN)MaxReceiveFisSize;\r
\r
Status = PciIo->Map (\r
PciIo,\r
Status = EFI_DEVICE_ERROR;\r
goto Error5;\r
}\r
+\r
AhciRegisters->AhciRFisPciAddr = (EFI_AHCI_RECEIVED_FIS *)(UINTN)AhciRFisPciAddr;\r
\r
//\r
// Allocate memory for command list\r
// Note that the implementation is a single task model which only use a command list for all ports.\r
//\r
- Buffer = NULL;\r
+ Buffer = NULL;\r
MaxCommandListSize = MaxCommandSlotNumber * sizeof (EFI_AHCI_COMMAND_LIST);\r
- Status = PciIo->AllocateBuffer (\r
- PciIo,\r
- AllocateAnyPages,\r
- EfiBootServicesData,\r
- EFI_SIZE_TO_PAGES ((UINTN) MaxCommandListSize),\r
- &Buffer,\r
- 0\r
- );\r
+ Status = PciIo->AllocateBuffer (\r
+ PciIo,\r
+ AllocateAnyPages,\r
+ EfiBootServicesData,\r
+ EFI_SIZE_TO_PAGES ((UINTN)MaxCommandListSize),\r
+ &Buffer,\r
+ 0\r
+ );\r
\r
if (EFI_ERROR (Status)) {\r
//\r
\r
AhciRegisters->AhciCmdList = Buffer;\r
AhciRegisters->MaxCommandListSize = MaxCommandListSize;\r
- Bytes = (UINTN)MaxCommandListSize;\r
+ Bytes = (UINTN)MaxCommandListSize;\r
\r
Status = PciIo->Map (\r
PciIo,\r
Status = EFI_DEVICE_ERROR;\r
goto Error3;\r
}\r
+\r
AhciRegisters->AhciCmdListPciAddr = (EFI_AHCI_COMMAND_LIST *)(UINTN)AhciCmdListPciAddr;\r
\r
//\r
// Allocate memory for command table\r
// According to AHCI 1.3 spec, a PRD table can contain maximum 65535 entries.\r
//\r
- Buffer = NULL;\r
+ Buffer = NULL;\r
MaxCommandTableSize = sizeof (EFI_AHCI_COMMAND_TABLE);\r
\r
Status = PciIo->AllocateBuffer (\r
PciIo,\r
AllocateAnyPages,\r
EfiBootServicesData,\r
- EFI_SIZE_TO_PAGES ((UINTN) MaxCommandTableSize),\r
+ EFI_SIZE_TO_PAGES ((UINTN)MaxCommandTableSize),\r
&Buffer,\r
0\r
);\r
\r
AhciRegisters->AhciCommandTable = Buffer;\r
AhciRegisters->MaxCommandTableSize = MaxCommandTableSize;\r
- Bytes = (UINTN)MaxCommandTableSize;\r
+ Bytes = (UINTN)MaxCommandTableSize;\r
\r
Status = PciIo->Map (\r
PciIo,\r
Status = EFI_DEVICE_ERROR;\r
goto Error1;\r
}\r
+\r
AhciRegisters->AhciCommandTablePciAddr = (EFI_AHCI_COMMAND_TABLE *)(UINTN)AhciCommandTablePciAddr;\r
\r
return EFI_SUCCESS;\r
Error2:\r
PciIo->FreeBuffer (\r
PciIo,\r
- EFI_SIZE_TO_PAGES ((UINTN) MaxCommandTableSize),\r
+ EFI_SIZE_TO_PAGES ((UINTN)MaxCommandTableSize),\r
AhciRegisters->AhciCommandTable\r
);\r
Error3:\r
Error4:\r
PciIo->FreeBuffer (\r
PciIo,\r
- EFI_SIZE_TO_PAGES ((UINTN) MaxCommandListSize),\r
+ EFI_SIZE_TO_PAGES ((UINTN)MaxCommandListSize),\r
AhciRegisters->AhciCmdList\r
);\r
Error5:\r
Error6:\r
PciIo->FreeBuffer (\r
PciIo,\r
- EFI_SIZE_TO_PAGES ((UINTN) MaxReceiveFisSize),\r
+ EFI_SIZE_TO_PAGES ((UINTN)MaxReceiveFisSize),\r
AhciRegisters->AhciRFis\r
);\r
\r
**/\r
EFI_STATUS\r
AhciReadLogExt (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN EFI_AHCI_REGISTERS *AhciRegisters,\r
- IN UINT8 Port,\r
- IN UINT8 PortMultiplier,\r
- IN OUT UINT8 *Buffer,\r
- IN UINT8 LogNumber,\r
- IN UINT8 PageNumber\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN EFI_AHCI_REGISTERS *AhciRegisters,\r
+ IN UINT8 Port,\r
+ IN UINT8 PortMultiplier,\r
+ IN OUT UINT8 *Buffer,\r
+ IN UINT8 LogNumber,\r
+ IN UINT8 PageNumber\r
)\r
{\r
- EFI_ATA_COMMAND_BLOCK AtaCommandBlock;\r
- EFI_ATA_STATUS_BLOCK AtaStatusBlock;\r
+ EFI_ATA_COMMAND_BLOCK AtaCommandBlock;\r
+ EFI_ATA_STATUS_BLOCK AtaStatusBlock;\r
\r
- if (PciIo == NULL || AhciRegisters == NULL || Buffer == NULL) {\r
+ if ((PciIo == NULL) || (AhciRegisters == NULL) || (Buffer == NULL)) {\r
return EFI_INVALID_PARAMETER;\r
}\r
\r
**/\r
EFI_STATUS\r
AhciEnableDevSlp (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN EFI_AHCI_REGISTERS *AhciRegisters,\r
- IN UINT8 Port,\r
- IN UINT8 PortMultiplier,\r
- IN EFI_IDENTIFY_DATA *IdentifyData\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN EFI_AHCI_REGISTERS *AhciRegisters,\r
+ IN UINT8 Port,\r
+ IN UINT8 PortMultiplier,\r
+ IN EFI_IDENTIFY_DATA *IdentifyData\r
)\r
{\r
EFI_STATUS Status;\r
DEBUG ((DEBUG_INFO, "Port CMD/DEVSLP = %08x / %08x\n", PortCmd, PortDevSlp));\r
if (((PortDevSlp & AHCI_PORT_DEVSLP_DSP) == 0) ||\r
((PortCmd & (EFI_AHCI_PORT_CMD_HPCP | EFI_AHCI_PORT_CMD_MPSP)) != 0)\r
- ) {\r
+ )\r
+ {\r
return EFI_UNSUPPORTED;\r
}\r
\r
//\r
// Do not enable DevSlp if the device doesn't support DevSlp\r
//\r
- DEBUG ((DEBUG_INFO, "IDENTIFY DEVICE: [77] = %04x, [78] = %04x, [79] = %04x\n",\r
- IdentifyData->AtaData.reserved_77,\r
- IdentifyData->AtaData.serial_ata_features_supported, IdentifyData->AtaData.serial_ata_features_enabled));\r
+ DEBUG ((\r
+ DEBUG_INFO,\r
+ "IDENTIFY DEVICE: [77] = %04x, [78] = %04x, [79] = %04x\n",\r
+ IdentifyData->AtaData.reserved_77,\r
+ IdentifyData->AtaData.serial_ata_features_supported,\r
+ IdentifyData->AtaData.serial_ata_features_enabled\r
+ ));\r
if ((IdentifyData->AtaData.serial_ata_features_supported & BIT8) == 0) {\r
- DEBUG ((DEBUG_INFO, "DevSlp feature is not supported for device at port [%d] PortMultiplier [%d]!\n",\r
- Port, PortMultiplier));\r
+ DEBUG ((\r
+ DEBUG_INFO,\r
+ "DevSlp feature is not supported for device at port [%d] PortMultiplier [%d]!\n",\r
+ Port,\r
+ PortMultiplier\r
+ ));\r
return EFI_UNSUPPORTED;\r
}\r
\r
//\r
if ((IdentifyData->AtaData.serial_ata_features_enabled & BIT8) != 0) {\r
Status = AhciDeviceSetFeature (\r
- PciIo, AhciRegisters, Port, 0, ATA_SUB_CMD_ENABLE_SATA_FEATURE, 0x09, ATA_ATAPI_TIMEOUT\r
- );\r
- DEBUG ((DEBUG_INFO, "DevSlp set feature for device at port [%d] PortMultiplier [%d] - %r\n",\r
- Port, PortMultiplier, Status));\r
+ PciIo,\r
+ AhciRegisters,\r
+ Port,\r
+ 0,\r
+ ATA_SUB_CMD_ENABLE_SATA_FEATURE,\r
+ 0x09,\r
+ ATA_ATAPI_TIMEOUT\r
+ );\r
+ DEBUG ((\r
+ DEBUG_INFO,\r
+ "DevSlp set feature for device at port [%d] PortMultiplier [%d] - %r\n",\r
+ Port,\r
+ PortMultiplier,\r
+ Status\r
+ ));\r
if (EFI_ERROR (Status)) {\r
return Status;\r
}\r
}\r
\r
- Status = AhciReadLogExt(PciIo, AhciRegisters, Port, PortMultiplier, LogData, 0x30, 0x08);\r
+ Status = AhciReadLogExt (PciIo, AhciRegisters, Port, PortMultiplier, LogData, 0x30, 0x08);\r
\r
//\r
// Clear PxCMD.ST and PxDEVSLP.ADSE before updating PxDEVSLP.DITO and PxDEVSLP.MDAT.\r
ZeroMem (&DevSlpTiming, sizeof (DevSlpTiming));\r
} else {\r
CopyMem (&DevSlpTiming, &LogData[48], sizeof (DevSlpTiming));\r
- DEBUG ((DEBUG_INFO, "DevSlpTiming: Supported(%d), Deto(%d), Madt(%d)\n",\r
- DevSlpTiming.Supported, DevSlpTiming.Deto, DevSlpTiming.Madt));\r
+ DEBUG ((\r
+ DEBUG_INFO,\r
+ "DevSlpTiming: Supported(%d), Deto(%d), Madt(%d)\n",\r
+ DevSlpTiming.Supported,\r
+ DevSlpTiming.Deto,\r
+ DevSlpTiming.Madt\r
+ ));\r
}\r
\r
//\r
}\r
}\r
\r
-\r
AhciWriteReg (PciIo, Offset + EFI_AHCI_PORT_CMD, PortCmd);\r
\r
- DEBUG ((DEBUG_INFO, "Enabled DevSlp feature at port [%d] PortMultiplier [%d], Port CMD/DEVSLP = %08x / %08x\n",\r
- Port, PortMultiplier, PortCmd, PortDevSlp));\r
+ DEBUG ((\r
+ DEBUG_INFO,\r
+ "Enabled DevSlp feature at port [%d] PortMultiplier [%d], Port CMD/DEVSLP = %08x / %08x\n",\r
+ Port,\r
+ PortMultiplier,\r
+ PortCmd,\r
+ PortDevSlp\r
+ ));\r
\r
return EFI_SUCCESS;\r
}\r
**/\r
EFI_STATUS\r
AhciSpinUpDisk (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN EFI_AHCI_REGISTERS *AhciRegisters,\r
- IN UINT8 Port,\r
- IN UINT8 PortMultiplier,\r
- IN OUT EFI_IDENTIFY_DATA *IdentifyData\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN EFI_AHCI_REGISTERS *AhciRegisters,\r
+ IN UINT8 Port,\r
+ IN UINT8 PortMultiplier,\r
+ IN OUT EFI_IDENTIFY_DATA *IdentifyData\r
)\r
{\r
- EFI_STATUS Status;\r
- EFI_ATA_COMMAND_BLOCK AtaCommandBlock;\r
- EFI_ATA_STATUS_BLOCK AtaStatusBlock;\r
- UINT8 Buffer[512];\r
+ EFI_STATUS Status;\r
+ EFI_ATA_COMMAND_BLOCK AtaCommandBlock;\r
+ EFI_ATA_STATUS_BLOCK AtaStatusBlock;\r
+ UINT8 Buffer[512];\r
\r
if (IdentifyData->AtaData.specific_config == ATA_SPINUP_CFG_REQUIRED_IDD_INCOMPLETE) {\r
//\r
// Use SET_FEATURE subcommand to spin up the device.\r
//\r
Status = AhciDeviceSetFeature (\r
- PciIo, AhciRegisters, Port, PortMultiplier,\r
- ATA_SUB_CMD_PUIS_SET_DEVICE_SPINUP, 0x00, ATA_SPINUP_TIMEOUT\r
+ PciIo,\r
+ AhciRegisters,\r
+ Port,\r
+ PortMultiplier,\r
+ ATA_SUB_CMD_PUIS_SET_DEVICE_SPINUP,\r
+ 0x00,\r
+ ATA_SPINUP_TIMEOUT\r
);\r
- DEBUG ((DEBUG_INFO, "CMD_PUIS_SET_DEVICE_SPINUP for device at port [%d] PortMultiplier [%d] - %r!\n",\r
- Port, PortMultiplier, Status));\r
+ DEBUG ((\r
+ DEBUG_INFO,\r
+ "CMD_PUIS_SET_DEVICE_SPINUP for device at port [%d] PortMultiplier [%d] - %r!\n",\r
+ Port,\r
+ PortMultiplier,\r
+ Status\r
+ ));\r
if (EFI_ERROR (Status)) {\r
return Status;\r
}\r
//\r
// Perform READ SECTORS PIO Data-In command to Read LBA 0\r
//\r
- AtaCommandBlock.AtaCommand = ATA_CMD_READ_SECTORS;\r
- AtaCommandBlock.AtaSectorCount = 0x1;\r
+ AtaCommandBlock.AtaCommand = ATA_CMD_READ_SECTORS;\r
+ AtaCommandBlock.AtaSectorCount = 0x1;\r
\r
Status = AhciPioTransfer (\r
PciIo,\r
ATA_SPINUP_TIMEOUT,\r
NULL\r
);\r
- DEBUG ((DEBUG_INFO, "Read LBA 0 for device at port [%d] PortMultiplier [%d] - %r!\n",\r
- Port, PortMultiplier, Status));\r
+ DEBUG ((\r
+ DEBUG_INFO,\r
+ "Read LBA 0 for device at port [%d] PortMultiplier [%d] - %r!\n",\r
+ Port,\r
+ PortMultiplier,\r
+ Status\r
+ ));\r
if (EFI_ERROR (Status)) {\r
return Status;\r
}\r
ZeroMem (IdentifyData, sizeof (*IdentifyData));\r
Status = AhciIdentify (PciIo, AhciRegisters, Port, PortMultiplier, IdentifyData);\r
if (EFI_ERROR (Status)) {\r
- DEBUG ((DEBUG_ERROR, "Read IDD failed for device at port [%d] PortMultiplier [%d] - %r!\n",\r
- Port, PortMultiplier, Status));\r
+ DEBUG ((\r
+ DEBUG_ERROR,\r
+ "Read IDD failed for device at port [%d] PortMultiplier [%d] - %r!\n",\r
+ Port,\r
+ PortMultiplier,\r
+ Status\r
+ ));\r
return Status;\r
}\r
\r
- DEBUG ((DEBUG_INFO, "IDENTIFY DEVICE: [0] = %016x, [2] = %016x, [83] = %016x, [86] = %016x\n",\r
- IdentifyData->AtaData.config, IdentifyData->AtaData.specific_config,\r
- IdentifyData->AtaData.command_set_supported_83, IdentifyData->AtaData.command_set_feature_enb_86));\r
+ DEBUG ((\r
+ DEBUG_INFO,\r
+ "IDENTIFY DEVICE: [0] = %016x, [2] = %016x, [83] = %016x, [86] = %016x\n",\r
+ IdentifyData->AtaData.config,\r
+ IdentifyData->AtaData.specific_config,\r
+ IdentifyData->AtaData.command_set_supported_83,\r
+ IdentifyData->AtaData.command_set_feature_enb_86\r
+ ));\r
//\r
// Check if IDD is incomplete\r
//\r
**/\r
EFI_STATUS\r
AhciPuisEnable (\r
- IN EFI_PCI_IO_PROTOCOL *PciIo,\r
- IN EFI_AHCI_REGISTERS *AhciRegisters,\r
- IN UINT8 Port,\r
- IN UINT8 PortMultiplier\r
+ IN EFI_PCI_IO_PROTOCOL *PciIo,\r
+ IN EFI_AHCI_REGISTERS *AhciRegisters,\r
+ IN UINT8 Port,\r
+ IN UINT8 PortMultiplier\r
)\r
{\r
- EFI_STATUS Status;\r
+ EFI_STATUS Status;\r
\r
Status = EFI_SUCCESS;\r
if (mAtaAtapiPolicy->PuisEnable == 0) {\r
} else if (mAtaAtapiPolicy->PuisEnable == 1) {\r
Status = AhciDeviceSetFeature (PciIo, AhciRegisters, Port, PortMultiplier, ATA_SUB_CMD_ENABLE_PUIS, 0x00, ATA_ATAPI_TIMEOUT);\r
}\r
- DEBUG ((DEBUG_INFO, "%a PUIS feature at port [%d] PortMultiplier [%d] - %r!\n",\r
+\r
+ DEBUG ((\r
+ DEBUG_INFO,\r
+ "%a PUIS feature at port [%d] PortMultiplier [%d] - %r!\n",\r
(mAtaAtapiPolicy->PuisEnable == 0) ? "Disable" : (\r
- (mAtaAtapiPolicy->PuisEnable == 1) ? "Enable" : "Skip"\r
- ), Port, PortMultiplier, Status));\r
+ (mAtaAtapiPolicy->PuisEnable == 1) ? "Enable" : "Skip"\r
+ ),\r
+ Port,\r
+ PortMultiplier,\r
+ Status\r
+ ));\r
return Status;\r
}\r
\r
EFI_STATUS\r
EFIAPI\r
AhciModeInitialization (\r
- IN ATA_ATAPI_PASS_THRU_INSTANCE *Instance\r
+ IN ATA_ATAPI_PASS_THRU_INSTANCE *Instance\r
)\r
{\r
- EFI_STATUS Status;\r
- EFI_PCI_IO_PROTOCOL *PciIo;\r
- EFI_IDE_CONTROLLER_INIT_PROTOCOL *IdeInit;\r
- UINT32 Capability;\r
- UINT8 MaxPortNumber;\r
- UINT32 PortImplementBitMap;\r
-\r
- EFI_AHCI_REGISTERS *AhciRegisters;\r
-\r
- UINT8 Port;\r
- DATA_64 Data64;\r
- UINT32 Offset;\r
- UINT32 Data;\r
- EFI_IDENTIFY_DATA Buffer;\r
- EFI_ATA_DEVICE_TYPE DeviceType;\r
- EFI_ATA_COLLECTIVE_MODE *SupportedModes;\r
- EFI_ATA_TRANSFER_MODE TransferMode;\r
- UINT32 PhyDetectDelay;\r
- UINT32 Value;\r
+ EFI_STATUS Status;\r
+ EFI_PCI_IO_PROTOCOL *PciIo;\r
+ EFI_IDE_CONTROLLER_INIT_PROTOCOL *IdeInit;\r
+ UINT32 Capability;\r
+ UINT8 MaxPortNumber;\r
+ UINT32 PortImplementBitMap;\r
+\r
+ EFI_AHCI_REGISTERS *AhciRegisters;\r
+\r
+ UINT8 Port;\r
+ DATA_64 Data64;\r
+ UINT32 Offset;\r
+ UINT32 Data;\r
+ EFI_IDENTIFY_DATA Buffer;\r
+ EFI_ATA_DEVICE_TYPE DeviceType;\r
+ EFI_ATA_COLLECTIVE_MODE *SupportedModes;\r
+ EFI_ATA_TRANSFER_MODE TransferMode;\r
+ UINT32 PhyDetectDelay;\r
+ UINT32 Value;\r
\r
if (Instance == NULL) {\r
return EFI_INVALID_PARAMETER;\r
//\r
// Make sure that GHC.AE bit is set before accessing any AHCI registers.\r
//\r
- Value = AhciReadReg(PciIo, EFI_AHCI_GHC_OFFSET);\r
+ Value = AhciReadReg (PciIo, EFI_AHCI_GHC_OFFSET);\r
\r
if ((Value & EFI_AHCI_GHC_ENABLE) == 0) {\r
AhciOrReg (PciIo, EFI_AHCI_GHC_OFFSET, EFI_AHCI_GHC_ENABLE);\r
NULL\r
);\r
if (EFI_ERROR (Status)) {\r
- DEBUG ((DEBUG_WARN,\r
+ DEBUG ((\r
+ DEBUG_WARN,\r
"AhciModeInitialization: failed to enable 64-bit DMA on 64-bit capable controller (%r)\n",\r
- Status));\r
+ Status\r
+ ));\r
}\r
}\r
\r
//\r
// Get the number of command slots per port supported by this HBA.\r
//\r
- MaxPortNumber = (UINT8) ((Capability & 0x1F) + 1);\r
+ MaxPortNumber = (UINT8)((Capability & 0x1F) + 1);\r
\r
//\r
// Get the bit map of those ports exposed by this HBA.\r
// It indicates which ports that the HBA supports are available for software to use.\r
//\r
- PortImplementBitMap = AhciReadReg(PciIo, EFI_AHCI_PI_OFFSET);\r
+ PortImplementBitMap = AhciReadReg (PciIo, EFI_AHCI_PI_OFFSET);\r
\r
AhciRegisters = &Instance->AhciRegisters;\r
- Status = AhciCreateTransferDescriptor (PciIo, AhciRegisters);\r
+ Status = AhciCreateTransferDescriptor (PciIo, AhciRegisters);\r
\r
if (EFI_ERROR (Status)) {\r
return EFI_OUT_OF_RESOURCES;\r
}\r
\r
- for (Port = 0; Port < EFI_AHCI_MAX_PORTS; Port ++) {\r
+ for (Port = 0; Port < EFI_AHCI_MAX_PORTS; Port++) {\r
if ((PortImplementBitMap & (((UINT32)BIT0) << Port)) != 0) {\r
//\r
// According to AHCI spec, MaxPortNumber should be equal or greater than the number of implemented ports.\r
//\r
// Initialize FIS Base Address Register and Command List Base Address Register for use.\r
//\r
- Data64.Uint64 = (UINTN) (AhciRegisters->AhciRFisPciAddr) + sizeof (EFI_AHCI_RECEIVED_FIS) * Port;\r
- Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_FB;\r
+ Data64.Uint64 = (UINTN)(AhciRegisters->AhciRFisPciAddr) + sizeof (EFI_AHCI_RECEIVED_FIS) * Port;\r
+ Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_FB;\r
AhciWriteReg (PciIo, Offset, Data64.Uint32.Lower32);\r
Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_FBU;\r
AhciWriteReg (PciIo, Offset, Data64.Uint32.Upper32);\r
\r
- Data64.Uint64 = (UINTN) (AhciRegisters->AhciCmdListPciAddr);\r
- Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_CLB;\r
+ Data64.Uint64 = (UINTN)(AhciRegisters->AhciCmdListPciAddr);\r
+ Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_CLB;\r
AhciWriteReg (PciIo, Offset, Data64.Uint32.Lower32);\r
Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_CLBU;\r
AhciWriteReg (PciIo, Offset, Data64.Uint32.Upper32);\r
\r
Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_CMD;\r
- Data = AhciReadReg (PciIo, Offset);\r
+ Data = AhciReadReg (PciIo, Offset);\r
if ((Data & EFI_AHCI_PORT_CMD_CPD) != 0) {\r
AhciOrReg (PciIo, Offset, EFI_AHCI_PORT_CMD_POD);\r
}\r
// Wait for the Phy to detect the presence of a device.\r
//\r
PhyDetectDelay = EFI_AHCI_BUS_PHY_DETECT_TIMEOUT;\r
- Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_SSTS;\r
+ Offset = EFI_AHCI_PORT_START + Port * EFI_AHCI_PORT_REG_WIDTH + EFI_AHCI_PORT_SSTS;\r
do {\r
Data = AhciReadReg (PciIo, Offset) & EFI_AHCI_PORT_SSTS_DET_MASK;\r
if ((Data == EFI_AHCI_PORT_SSTS_DET_PCE) || (Data == EFI_AHCI_PORT_SSTS_DET)) {\r
Offset,\r
0x0000FFFF,\r
0x00000101,\r
- EFI_TIMER_PERIOD_SECONDS(16)\r
+ EFI_TIMER_PERIOD_SECONDS (16)\r
);\r
if (EFI_ERROR (Status)) {\r
continue;\r
}\r
\r
DEBUG ((\r
- DEBUG_INFO, "IDENTIFY DEVICE: [0] = %016x, [2] = %016x, [83] = %016x, [86] = %016x\n",\r
- Buffer.AtaData.config, Buffer.AtaData.specific_config,\r
- Buffer.AtaData.command_set_supported_83, Buffer.AtaData.command_set_feature_enb_86\r
+ DEBUG_INFO,\r
+ "IDENTIFY DEVICE: [0] = %016x, [2] = %016x, [83] = %016x, [86] = %016x\n",\r
+ Buffer.AtaData.config,\r
+ Buffer.AtaData.specific_config,\r
+ Buffer.AtaData.command_set_supported_83,\r
+ Buffer.AtaData.command_set_feature_enb_86\r
));\r
if ((Buffer.AtaData.config & BIT2) != 0) {\r
//\r
} else {\r
continue;\r
}\r
- DEBUG ((DEBUG_INFO, "port [%d] port multitplier [%d] has a [%a]\n",\r
- Port, 0, DeviceType == EfiIdeCdrom ? "cdrom" : "harddisk"));\r
+\r
+ DEBUG ((\r
+ DEBUG_INFO,\r
+ "port [%d] port multitplier [%d] has a [%a]\n",\r
+ Port,\r
+ 0,\r
+ DeviceType == EfiIdeCdrom ? "cdrom" : "harddisk"\r
+ ));\r
\r
//\r
// If the device is a hard disk, then try to enable S.M.A.R.T feature\r
TransferMode.ModeCategory = EFI_ATA_MODE_FLOW_PIO;\r
}\r
\r
- TransferMode.ModeNumber = (UINT8) (SupportedModes->PioMode.Mode);\r
+ TransferMode.ModeNumber = (UINT8)(SupportedModes->PioMode.Mode);\r
\r
//\r
// Set supported DMA mode on this IDE device. Note that UDMA & MDMA can't\r
//\r
if (SupportedModes->UdmaMode.Valid) {\r
TransferMode.ModeCategory = EFI_ATA_MODE_UDMA;\r
- TransferMode.ModeNumber = (UINT8) (SupportedModes->UdmaMode.Mode);\r
+ TransferMode.ModeNumber = (UINT8)(SupportedModes->UdmaMode.Mode);\r
} else if (SupportedModes->MultiWordDmaMode.Valid) {\r
TransferMode.ModeCategory = EFI_ATA_MODE_MDMA;\r
- TransferMode.ModeNumber = (UINT8) SupportedModes->MultiWordDmaMode.Mode;\r
+ TransferMode.ModeNumber = (UINT8)SupportedModes->MultiWordDmaMode.Mode;\r
}\r
\r
Status = AhciDeviceSetFeature (PciIo, AhciRegisters, Port, 0, 0x03, (UINT32)(*(UINT8 *)&TransferMode), ATA_ATAPI_TIMEOUT);\r
projects / mirror_edk2.git / blobdiff