**/\r
BOOLEAN\r
IsErasedFlashBuffer (\r
- IN UINT8 *Buffer,\r
- IN UINTN BufferSize\r
+ IN UINT8 *Buffer,\r
+ IN UINTN BufferSize\r
)\r
{\r
- BOOLEAN IsEmpty;\r
- UINT8 *Ptr;\r
- UINTN Index;\r
+ BOOLEAN IsEmpty;\r
+ UINT8 *Ptr;\r
+ UINTN Index;\r
\r
Ptr = Buffer;\r
IsEmpty = TRUE;\r
**/\r
EFI_STATUS\r
FtwEraseSpareBlock (\r
- IN EFI_FTW_DEVICE *FtwDevice\r
+ IN EFI_FTW_DEVICE *FtwDevice\r
)\r
{\r
return FtwDevice->FtwBackupFvb->EraseBlocks (\r
// 2. Lba falls into the range of working block.\r
//\r
return (BOOLEAN)\r
- (\r
- (FvBlock == FtwDevice->FtwFvBlock) &&\r
- (Lba >= FtwDevice->FtwWorkBlockLba) &&\r
- (Lba <= FtwDevice->FtwWorkSpaceLba)\r
- );\r
+ (\r
+ (FvBlock == FtwDevice->FtwFvBlock) &&\r
+ (Lba >= FtwDevice->FtwWorkBlockLba) &&\r
+ (Lba <= FtwDevice->FtwWorkSpaceLba)\r
+ );\r
}\r
\r
/**\r
**/\r
EFI_HANDLE\r
GetFvbByAddress (\r
- IN EFI_PHYSICAL_ADDRESS Address,\r
- OUT EFI_FIRMWARE_VOLUME_BLOCK_PROTOCOL **FvBlock\r
+ IN EFI_PHYSICAL_ADDRESS Address,\r
+ OUT EFI_FIRMWARE_VOLUME_BLOCK_PROTOCOL **FvBlock\r
)\r
{\r
EFI_STATUS Status;\r
UINTN BlockSize;\r
UINTN NumberOfBlocks;\r
\r
- *FvBlock = NULL;\r
- FvbHandle = NULL;\r
+ *FvBlock = NULL;\r
+ FvbHandle = NULL;\r
HandleBuffer = NULL;\r
//\r
// Locate all handles of Fvb protocol\r
if (EFI_ERROR (Status)) {\r
return NULL;\r
}\r
+\r
//\r
// Get the FVB to access variable store\r
//\r
if (EFI_ERROR (Status)) {\r
break;\r
}\r
+\r
//\r
// Compare the address and select the right one\r
//\r
\r
if ((Address >= FvbBaseAddress) && (Address < (FvbBaseAddress + BlockSize * NumberOfBlocks))) {\r
*FvBlock = Fvb;\r
- FvbHandle = HandleBuffer[Index];\r
+ FvbHandle = HandleBuffer[Index];\r
break;\r
}\r
}\r
BOOLEAN IsSwapped;\r
EFI_HANDLE FvbHandle;\r
\r
- if (!FeaturePcdGet(PcdFullFtwServiceEnable)) {\r
+ if (!FeaturePcdGet (PcdFullFtwServiceEnable)) {\r
return FALSE;\r
}\r
\r
- Status = FtwGetSarProtocol ((VOID **) &SarProtocol);\r
+ Status = FtwGetSarProtocol ((VOID **)&SarProtocol);\r
if (EFI_ERROR (Status)) {\r
return FALSE;\r
}\r
+\r
//\r
// Get the boot block range\r
//\r
if (EFI_ERROR (Status)) {\r
return FALSE;\r
}\r
+\r
//\r
// Get FVB by address\r
//\r
if (FvbHandle == NULL) {\r
return FALSE;\r
}\r
+\r
//\r
// Compare the Fvb\r
//\r
- return (BOOLEAN) (FvBlock == BootFvb);\r
+ return (BOOLEAN)(FvBlock == BootFvb);\r
}\r
\r
/**\r
**/\r
EFI_STATUS\r
FlushSpareBlockToBootBlock (\r
- EFI_FTW_DEVICE *FtwDevice\r
+ EFI_FTW_DEVICE *FtwDevice\r
)\r
{\r
EFI_STATUS Status;\r
EFI_FIRMWARE_VOLUME_BLOCK_PROTOCOL *BootFvb;\r
EFI_LBA BootLba;\r
\r
- if (!FeaturePcdGet(PcdFullFtwServiceEnable)) {\r
+ if (!FeaturePcdGet (PcdFullFtwServiceEnable)) {\r
return EFI_UNSUPPORTED;\r
}\r
\r
//\r
// Locate swap address range protocol\r
//\r
- Status = FtwGetSarProtocol ((VOID **) &SarProtocol);\r
+ Status = FtwGetSarProtocol ((VOID **)&SarProtocol);\r
if (EFI_ERROR (Status)) {\r
return Status;\r
}\r
+\r
//\r
// Allocate a memory buffer\r
//\r
Length = FtwDevice->SpareAreaLength;\r
- Buffer = AllocatePool (Length);\r
+ Buffer = AllocatePool (Length);\r
if (Buffer == NULL) {\r
return EFI_OUT_OF_RESOURCES;\r
}\r
+\r
//\r
// Get TopSwap bit state\r
//\r
FreePool (Buffer);\r
return EFI_ABORTED;\r
}\r
+\r
//\r
// Read data from current boot block\r
//\r
BootLba = 0;\r
Ptr = Buffer;\r
for (Index = 0; Index < FtwDevice->NumberOfSpareBlock; Index += 1) {\r
- Count = FtwDevice->SpareBlockSize;\r
+ Count = FtwDevice->SpareBlockSize;\r
Status = BootFvb->Read (\r
BootFvb,\r
BootLba + Index,\r
//\r
Ptr = Buffer;\r
for (Index = 0; Index < FtwDevice->NumberOfSpareBlock; Index += 1) {\r
- Count = FtwDevice->SpareBlockSize;\r
+ Count = FtwDevice->SpareBlockSize;\r
Status = FtwDevice->FtwBackupFvb->Read (\r
FtwDevice->FtwBackupFvb,\r
FtwDevice->FtwSpareLba + Index,\r
\r
Ptr += Count;\r
}\r
+\r
//\r
// Set TopSwap bit\r
//\r
return Status;\r
}\r
}\r
+\r
//\r
// Erase current spare block\r
// Because TopSwap is set, this actually erase the top block (boot block)!\r
FreePool (Buffer);\r
return EFI_ABORTED;\r
}\r
+\r
//\r
// Write memory buffer to current spare block. Still top block.\r
//\r
Ptr = Buffer;\r
for (Index = 0; Index < FtwDevice->NumberOfSpareBlock; Index += 1) {\r
- Count = FtwDevice->SpareBlockSize;\r
+ Count = FtwDevice->SpareBlockSize;\r
Status = FtwDevice->FtwBackupFvb->Write (\r
FtwDevice->FtwBackupFvb,\r
FtwDevice->FtwSpareLba + Index,\r
if ((FtwDevice == NULL) || (FvBlock == NULL)) {\r
return EFI_INVALID_PARAMETER;\r
}\r
+\r
//\r
// Allocate a memory buffer\r
//\r
Length = FtwDevice->SpareAreaLength;\r
- Buffer = AllocatePool (Length);\r
+ Buffer = AllocatePool (Length);\r
if (Buffer == NULL) {\r
return EFI_OUT_OF_RESOURCES;\r
}\r
+\r
//\r
// Read all content of spare block to memory buffer\r
//\r
Ptr = Buffer;\r
for (Index = 0; Index < FtwDevice->NumberOfSpareBlock; Index += 1) {\r
- Count = FtwDevice->SpareBlockSize;\r
+ Count = FtwDevice->SpareBlockSize;\r
Status = FtwDevice->FtwBackupFvb->Read (\r
FtwDevice->FtwBackupFvb,\r
FtwDevice->FtwSpareLba + Index,\r
\r
Ptr += Count;\r
}\r
+\r
//\r
// Erase the target block\r
//\r
FreePool (Buffer);\r
return EFI_ABORTED;\r
}\r
+\r
//\r
// Write memory buffer to block, using the FvBlock protocol interface\r
//\r
Ptr = Buffer;\r
for (Index = 0; Index < NumberOfBlocks; Index += 1) {\r
- Count = BlockSize;\r
- Status = FvBlock->Write (FvBlock, Lba + Index, 0, &Count, Ptr);\r
+ Count = BlockSize;\r
+ Status = FvBlock->Write (FvBlock, Lba + Index, 0, &Count, Ptr);\r
if (EFI_ERROR (Status)) {\r
DEBUG ((DEBUG_ERROR, "Ftw: FVB Write block - %r\n", Status));\r
FreePool (Buffer);\r
**/\r
EFI_STATUS\r
FlushSpareBlockToWorkingBlock (\r
- EFI_FTW_DEVICE *FtwDevice\r
+ EFI_FTW_DEVICE *FtwDevice\r
)\r
{\r
- EFI_STATUS Status;\r
- UINTN Length;\r
- UINT8 *Buffer;\r
- EFI_FAULT_TOLERANT_WORKING_BLOCK_HEADER *WorkingBlockHeader;\r
- UINTN Count;\r
- UINT8 *Ptr;\r
- UINTN Index;\r
+ EFI_STATUS Status;\r
+ UINTN Length;\r
+ UINT8 *Buffer;\r
+ EFI_FAULT_TOLERANT_WORKING_BLOCK_HEADER *WorkingBlockHeader;\r
+ UINTN Count;\r
+ UINT8 *Ptr;\r
+ UINTN Index;\r
\r
//\r
// Allocate a memory buffer\r
//\r
Length = FtwDevice->SpareAreaLength;\r
- Buffer = AllocatePool (Length);\r
+ Buffer = AllocatePool (Length);\r
if (Buffer == NULL) {\r
return EFI_OUT_OF_RESOURCES;\r
}\r
//\r
Ptr = Buffer;\r
for (Index = 0; Index < FtwDevice->NumberOfSpareBlock; Index += 1) {\r
- Count = FtwDevice->SpareBlockSize;\r
+ Count = FtwDevice->SpareBlockSize;\r
Status = FtwDevice->FtwBackupFvb->Read (\r
FtwDevice->FtwBackupFvb,\r
FtwDevice->FtwSpareLba + Index,\r
\r
Ptr += Count;\r
}\r
+\r
//\r
// Clear the CRC and STATE, copy data from spare to working block.\r
//\r
- WorkingBlockHeader = (EFI_FAULT_TOLERANT_WORKING_BLOCK_HEADER *) (Buffer + (UINTN) FtwDevice->FtwWorkSpaceLbaInSpare * FtwDevice->SpareBlockSize + FtwDevice->FtwWorkSpaceBaseInSpare);\r
+ WorkingBlockHeader = (EFI_FAULT_TOLERANT_WORKING_BLOCK_HEADER *)(Buffer + (UINTN)FtwDevice->FtwWorkSpaceLbaInSpare * FtwDevice->SpareBlockSize + FtwDevice->FtwWorkSpaceBaseInSpare);\r
InitWorkSpaceHeader (WorkingBlockHeader);\r
WorkingBlockHeader->WorkingBlockValid = FTW_ERASE_POLARITY;\r
WorkingBlockHeader->WorkingBlockInvalid = FTW_ERASE_POLARITY;\r
// skip Signature and Crc.\r
//\r
Status = FtwUpdateFvState (\r
- FtwDevice->FtwFvBlock,\r
- FtwDevice->WorkBlockSize,\r
- FtwDevice->FtwWorkSpaceLba,\r
- FtwDevice->FtwWorkSpaceBase + sizeof (EFI_GUID) + sizeof (UINT32),\r
- WORKING_BLOCK_INVALID\r
- );\r
+ FtwDevice->FtwFvBlock,\r
+ FtwDevice->WorkBlockSize,\r
+ FtwDevice->FtwWorkSpaceLba,\r
+ FtwDevice->FtwWorkSpaceBase + sizeof (EFI_GUID) + sizeof (UINT32),\r
+ WORKING_BLOCK_INVALID\r
+ );\r
if (EFI_ERROR (Status)) {\r
FreePool (Buffer);\r
return EFI_ABORTED;\r
FreePool (Buffer);\r
return EFI_ABORTED;\r
}\r
+\r
//\r
// Write memory buffer to working block, using the FvBlock protocol interface\r
//\r
Ptr = Buffer;\r
for (Index = 0; Index < FtwDevice->NumberOfWorkBlock; Index += 1) {\r
- Count = FtwDevice->WorkBlockSize;\r
+ Count = FtwDevice->WorkBlockSize;\r
Status = FtwDevice->FtwFvBlock->Write (\r
FtwDevice->FtwFvBlock,\r
FtwDevice->FtwWorkBlockLba + Index,\r
\r
Ptr += Count;\r
}\r
+\r
//\r
// Since the memory buffer will not be used, free memory Buffer.\r
//\r
// So hardcode offset as sizeof(EFI_GUID)+sizeof(UINT32) to skip Signature and Crc.\r
//\r
Status = FtwUpdateFvState (\r
- FtwDevice->FtwFvBlock,\r
- FtwDevice->WorkBlockSize,\r
- FtwDevice->FtwWorkSpaceLba,\r
- FtwDevice->FtwWorkSpaceBase + sizeof (EFI_GUID) + sizeof (UINT32),\r
- WORKING_BLOCK_VALID\r
- );\r
+ FtwDevice->FtwFvBlock,\r
+ FtwDevice->WorkBlockSize,\r
+ FtwDevice->FtwWorkSpaceLba,\r
+ FtwDevice->FtwWorkSpaceBase + sizeof (EFI_GUID) + sizeof (UINT32),\r
+ WORKING_BLOCK_VALID\r
+ );\r
if (EFI_ERROR (Status)) {\r
return EFI_ABORTED;\r
}\r
\r
FtwDevice->FtwWorkSpaceHeader->WorkingBlockInvalid = FTW_INVALID_STATE;\r
- FtwDevice->FtwWorkSpaceHeader->WorkingBlockValid = FTW_VALID_STATE;\r
+ FtwDevice->FtwWorkSpaceHeader->WorkingBlockValid = FTW_VALID_STATE;\r
\r
return EFI_SUCCESS;\r
}\r
//\r
// Read state from device, assume State is only one byte.\r
//\r
- Length = sizeof (UINT8);\r
- Status = FvBlock->Read (FvBlock, Lba, Offset, &Length, &State);\r
+ Length = sizeof (UINT8);\r
+ Status = FvBlock->Read (FvBlock, Lba, Offset, &Length, &State);\r
if (EFI_ERROR (Status)) {\r
return EFI_ABORTED;\r
}\r
\r
State ^= FTW_POLARITY_REVERT;\r
- State = (UINT8) (State | NewBit);\r
+ State = (UINT8)(State | NewBit);\r
State ^= FTW_POLARITY_REVERT;\r
\r
//\r
// Write state back to device\r
//\r
- Length = sizeof (UINT8);\r
- Status = FvBlock->Write (FvBlock, Lba, Offset, &Length, &State);\r
+ Length = sizeof (UINT8);\r
+ Status = FvBlock->Write (FvBlock, Lba, Offset, &Length, &State);\r
\r
return Status;\r
}\r
OUT EFI_FAULT_TOLERANT_WRITE_HEADER **FtwWriteHeader\r
)\r
{\r
- UINTN Offset;\r
- EFI_FAULT_TOLERANT_WRITE_HEADER *FtwHeader;\r
+ UINTN Offset;\r
+ EFI_FAULT_TOLERANT_WRITE_HEADER *FtwHeader;\r
\r
*FtwWriteHeader = NULL;\r
- FtwHeader = (EFI_FAULT_TOLERANT_WRITE_HEADER *) (FtwWorkSpaceHeader + 1);\r
+ FtwHeader = (EFI_FAULT_TOLERANT_WRITE_HEADER *)(FtwWorkSpaceHeader + 1);\r
Offset = sizeof (EFI_FAULT_TOLERANT_WORKING_BLOCK_HEADER);\r
\r
while (FtwHeader->Complete == FTW_VALID_STATE) {\r
return EFI_ABORTED;\r
}\r
\r
- FtwHeader = (EFI_FAULT_TOLERANT_WRITE_HEADER *) ((UINT8 *) FtwWorkSpaceHeader + Offset);\r
+ FtwHeader = (EFI_FAULT_TOLERANT_WRITE_HEADER *)((UINT8 *)FtwWorkSpaceHeader + Offset);\r
}\r
+\r
//\r
// Last write header is found\r
//\r
**/\r
EFI_STATUS\r
FtwGetLastWriteRecord (\r
- IN EFI_FAULT_TOLERANT_WRITE_HEADER *FtwWriteHeader,\r
- OUT EFI_FAULT_TOLERANT_WRITE_RECORD **FtwWriteRecord\r
+ IN EFI_FAULT_TOLERANT_WRITE_HEADER *FtwWriteHeader,\r
+ OUT EFI_FAULT_TOLERANT_WRITE_RECORD **FtwWriteRecord\r
)\r
{\r
- UINTN Index;\r
- EFI_FAULT_TOLERANT_WRITE_RECORD *FtwRecord;\r
+ UINTN Index;\r
+ EFI_FAULT_TOLERANT_WRITE_RECORD *FtwRecord;\r
\r
*FtwWriteRecord = NULL;\r
- FtwRecord = (EFI_FAULT_TOLERANT_WRITE_RECORD *) (FtwWriteHeader + 1);\r
+ FtwRecord = (EFI_FAULT_TOLERANT_WRITE_RECORD *)(FtwWriteHeader + 1);\r
\r
//\r
// Try to find the last write record "that has not completed"\r
FtwRecord++;\r
\r
if (FtwWriteHeader->PrivateDataSize != 0) {\r
- FtwRecord = (EFI_FAULT_TOLERANT_WRITE_RECORD *) ((UINTN) FtwRecord + (UINTN) FtwWriteHeader->PrivateDataSize);\r
+ FtwRecord = (EFI_FAULT_TOLERANT_WRITE_RECORD *)((UINTN)FtwRecord + (UINTN)FtwWriteHeader->PrivateDataSize);\r
}\r
}\r
+\r
//\r
// if Index == NumberOfWrites, then\r
// the last record has been written successfully,\r
// also return the last record.\r
//\r
if (Index == FtwWriteHeader->NumberOfWrites) {\r
- *FtwWriteRecord = (EFI_FAULT_TOLERANT_WRITE_RECORD *) ((UINTN) FtwRecord - FTW_RECORD_SIZE (FtwWriteHeader->PrivateDataSize));\r
+ *FtwWriteRecord = (EFI_FAULT_TOLERANT_WRITE_RECORD *)((UINTN)FtwRecord - FTW_RECORD_SIZE (FtwWriteHeader->PrivateDataSize));\r
return EFI_SUCCESS;\r
}\r
\r
**/\r
BOOLEAN\r
IsFirstRecordOfWrites (\r
- IN EFI_FAULT_TOLERANT_WRITE_HEADER *FtwHeader,\r
- IN EFI_FAULT_TOLERANT_WRITE_RECORD *FtwRecord\r
+ IN EFI_FAULT_TOLERANT_WRITE_HEADER *FtwHeader,\r
+ IN EFI_FAULT_TOLERANT_WRITE_RECORD *FtwRecord\r
)\r
{\r
- UINT8 *Head;\r
- UINT8 *Ptr;\r
+ UINT8 *Head;\r
+ UINT8 *Ptr;\r
\r
- Head = (UINT8 *) FtwHeader;\r
- Ptr = (UINT8 *) FtwRecord;\r
+ Head = (UINT8 *)FtwHeader;\r
+ Ptr = (UINT8 *)FtwRecord;\r
\r
Head += sizeof (EFI_FAULT_TOLERANT_WRITE_HEADER);\r
- return (BOOLEAN) (Head == Ptr);\r
+ return (BOOLEAN)(Head == Ptr);\r
}\r
\r
/**\r
**/\r
BOOLEAN\r
IsLastRecordOfWrites (\r
- IN EFI_FAULT_TOLERANT_WRITE_HEADER *FtwHeader,\r
- IN EFI_FAULT_TOLERANT_WRITE_RECORD *FtwRecord\r
+ IN EFI_FAULT_TOLERANT_WRITE_HEADER *FtwHeader,\r
+ IN EFI_FAULT_TOLERANT_WRITE_RECORD *FtwRecord\r
)\r
{\r
- UINT8 *Head;\r
- UINT8 *Ptr;\r
+ UINT8 *Head;\r
+ UINT8 *Ptr;\r
\r
- Head = (UINT8 *) FtwHeader;\r
- Ptr = (UINT8 *) FtwRecord;\r
+ Head = (UINT8 *)FtwHeader;\r
+ Ptr = (UINT8 *)FtwRecord;\r
\r
Head += FTW_WRITE_TOTAL_SIZE (FtwHeader->NumberOfWrites - 1, FtwHeader->PrivateDataSize);\r
- return (BOOLEAN) (Head == Ptr);\r
+ return (BOOLEAN)(Head == Ptr);\r
}\r
\r
/**\r
**/\r
EFI_STATUS\r
GetPreviousRecordOfWrites (\r
- IN EFI_FAULT_TOLERANT_WRITE_HEADER *FtwHeader,\r
- IN OUT EFI_FAULT_TOLERANT_WRITE_RECORD **FtwRecord\r
+ IN EFI_FAULT_TOLERANT_WRITE_HEADER *FtwHeader,\r
+ IN OUT EFI_FAULT_TOLERANT_WRITE_RECORD **FtwRecord\r
)\r
{\r
- UINT8 *Ptr;\r
+ UINT8 *Ptr;\r
\r
if (IsFirstRecordOfWrites (FtwHeader, *FtwRecord)) {\r
*FtwRecord = NULL;\r
return EFI_ACCESS_DENIED;\r
}\r
\r
- Ptr = (UINT8 *) (*FtwRecord);\r
- Ptr -= FTW_RECORD_SIZE (FtwHeader->PrivateDataSize);\r
- *FtwRecord = (EFI_FAULT_TOLERANT_WRITE_RECORD *) Ptr;\r
+ Ptr = (UINT8 *)(*FtwRecord);\r
+ Ptr -= FTW_RECORD_SIZE (FtwHeader->PrivateDataSize);\r
+ *FtwRecord = (EFI_FAULT_TOLERANT_WRITE_RECORD *)Ptr;\r
return EFI_SUCCESS;\r
}\r
\r
**/\r
EFI_STATUS\r
InitFtwDevice (\r
- OUT EFI_FTW_DEVICE **FtwData\r
+ OUT EFI_FTW_DEVICE **FtwData\r
)\r
{\r
- EFI_FTW_DEVICE *FtwDevice;\r
+ EFI_FTW_DEVICE *FtwDevice;\r
\r
//\r
// Allocate private data of this driver,\r
//\r
// Initialize other parameters, and set WorkSpace as FTW_ERASED_BYTE.\r
//\r
- FtwDevice->WorkSpaceLength = (UINTN) PcdGet32 (PcdFlashNvStorageFtwWorkingSize);\r
- FtwDevice->SpareAreaLength = (UINTN) PcdGet32 (PcdFlashNvStorageFtwSpareSize);\r
+ FtwDevice->WorkSpaceLength = (UINTN)PcdGet32 (PcdFlashNvStorageFtwWorkingSize);\r
+ FtwDevice->SpareAreaLength = (UINTN)PcdGet32 (PcdFlashNvStorageFtwSpareSize);\r
if ((FtwDevice->WorkSpaceLength == 0) || (FtwDevice->SpareAreaLength == 0)) {\r
DEBUG ((DEBUG_ERROR, "Ftw: Workspace or Spare block does not exist!\n"));\r
FreePool (FtwDevice);\r
return EFI_INVALID_PARAMETER;\r
}\r
\r
- FtwDevice->Signature = FTW_DEVICE_SIGNATURE;\r
- FtwDevice->FtwFvBlock = NULL;\r
- FtwDevice->FtwBackupFvb = NULL;\r
- FtwDevice->FtwWorkSpaceLba = (EFI_LBA) (-1);\r
- FtwDevice->FtwSpareLba = (EFI_LBA) (-1);\r
+ FtwDevice->Signature = FTW_DEVICE_SIGNATURE;\r
+ FtwDevice->FtwFvBlock = NULL;\r
+ FtwDevice->FtwBackupFvb = NULL;\r
+ FtwDevice->FtwWorkSpaceLba = (EFI_LBA)(-1);\r
+ FtwDevice->FtwSpareLba = (EFI_LBA)(-1);\r
\r
- FtwDevice->WorkSpaceAddress = (EFI_PHYSICAL_ADDRESS) PcdGet64 (PcdFlashNvStorageFtwWorkingBase64);\r
+ FtwDevice->WorkSpaceAddress = (EFI_PHYSICAL_ADDRESS)PcdGet64 (PcdFlashNvStorageFtwWorkingBase64);\r
if (FtwDevice->WorkSpaceAddress == 0) {\r
- FtwDevice->WorkSpaceAddress = (EFI_PHYSICAL_ADDRESS) PcdGet32 (PcdFlashNvStorageFtwWorkingBase);\r
+ FtwDevice->WorkSpaceAddress = (EFI_PHYSICAL_ADDRESS)PcdGet32 (PcdFlashNvStorageFtwWorkingBase);\r
}\r
\r
- FtwDevice->SpareAreaAddress = (EFI_PHYSICAL_ADDRESS) PcdGet64 (PcdFlashNvStorageFtwSpareBase64);\r
+ FtwDevice->SpareAreaAddress = (EFI_PHYSICAL_ADDRESS)PcdGet64 (PcdFlashNvStorageFtwSpareBase64);\r
if (FtwDevice->SpareAreaAddress == 0) {\r
- FtwDevice->SpareAreaAddress = (EFI_PHYSICAL_ADDRESS) PcdGet32 (PcdFlashNvStorageFtwSpareBase);\r
+ FtwDevice->SpareAreaAddress = (EFI_PHYSICAL_ADDRESS)PcdGet32 (PcdFlashNvStorageFtwSpareBase);\r
}\r
\r
*FtwData = FtwDevice;\r
return EFI_SUCCESS;\r
}\r
\r
-\r
/**\r
Find the proper Firmware Volume Block protocol for FTW operation.\r
\r
**/\r
EFI_STATUS\r
FindFvbForFtw (\r
- IN OUT EFI_FTW_DEVICE *FtwDevice\r
+ IN OUT EFI_FTW_DEVICE *FtwDevice\r
)\r
{\r
EFI_STATUS Status;\r
if (EFI_ERROR (Status) || ((Attributes & EFI_FVB2_WRITE_STATUS) == 0)) {\r
continue;\r
}\r
+\r
//\r
// Compare the address and select the right one\r
//\r
}\r
\r
if ((FtwDevice->FtwFvBlock == NULL) && (FtwDevice->WorkSpaceAddress >= FvbBaseAddress) &&\r
- ((FtwDevice->WorkSpaceAddress + FtwDevice->WorkSpaceLength) <= (FvbBaseAddress + BlockSize * NumberOfBlocks))) {\r
+ ((FtwDevice->WorkSpaceAddress + FtwDevice->WorkSpaceLength) <= (FvbBaseAddress + BlockSize * NumberOfBlocks)))\r
+ {\r
FtwDevice->FtwFvBlock = Fvb;\r
//\r
// To get the LBA of work space\r
//\r
for (LbaIndex = 1; LbaIndex <= NumberOfBlocks; LbaIndex += 1) {\r
- if ((FtwDevice->WorkSpaceAddress >= (FvbBaseAddress + BlockSize * (LbaIndex - 1)))\r
- && (FtwDevice->WorkSpaceAddress < (FvbBaseAddress + BlockSize * LbaIndex))) {\r
+ if ( (FtwDevice->WorkSpaceAddress >= (FvbBaseAddress + BlockSize * (LbaIndex - 1)))\r
+ && (FtwDevice->WorkSpaceAddress < (FvbBaseAddress + BlockSize * LbaIndex)))\r
+ {\r
FtwDevice->FtwWorkSpaceLba = LbaIndex - 1;\r
//\r
// Get the Work space size and Base(Offset)\r
//\r
- FtwDevice->FtwWorkSpaceSize = FtwDevice->WorkSpaceLength;\r
- FtwDevice->WorkBlockSize = BlockSize;\r
- FtwDevice->FtwWorkSpaceBase = (UINTN) (FtwDevice->WorkSpaceAddress - (FvbBaseAddress + FtwDevice->WorkBlockSize * (LbaIndex - 1)));\r
+ FtwDevice->FtwWorkSpaceSize = FtwDevice->WorkSpaceLength;\r
+ FtwDevice->WorkBlockSize = BlockSize;\r
+ FtwDevice->FtwWorkSpaceBase = (UINTN)(FtwDevice->WorkSpaceAddress - (FvbBaseAddress + FtwDevice->WorkBlockSize * (LbaIndex - 1)));\r
FtwDevice->NumberOfWorkSpaceBlock = FTW_BLOCKS (FtwDevice->FtwWorkSpaceBase + FtwDevice->FtwWorkSpaceSize, FtwDevice->WorkBlockSize);\r
if (FtwDevice->FtwWorkSpaceSize >= FtwDevice->WorkBlockSize) {\r
//\r
// Check the alignment of work space address and length, they should be block size aligned when work space size is larger than one block size.\r
//\r
if (((FtwDevice->WorkSpaceAddress & (FtwDevice->WorkBlockSize - 1)) != 0) ||\r
- ((FtwDevice->WorkSpaceLength & (FtwDevice->WorkBlockSize - 1)) != 0)) {\r
+ ((FtwDevice->WorkSpaceLength & (FtwDevice->WorkBlockSize - 1)) != 0))\r
+ {\r
DEBUG ((DEBUG_ERROR, "Ftw: Work space address or length is not block size aligned when work space size is larger than one block size\n"));\r
FreePool (HandleBuffer);\r
ASSERT (FALSE);\r
ASSERT (FALSE);\r
return EFI_ABORTED;\r
}\r
+\r
break;\r
}\r
}\r
}\r
\r
if ((FtwDevice->FtwBackupFvb == NULL) && (FtwDevice->SpareAreaAddress >= FvbBaseAddress) &&\r
- ((FtwDevice->SpareAreaAddress + FtwDevice->SpareAreaLength) <= (FvbBaseAddress + BlockSize * NumberOfBlocks))) {\r
+ ((FtwDevice->SpareAreaAddress + FtwDevice->SpareAreaLength) <= (FvbBaseAddress + BlockSize * NumberOfBlocks)))\r
+ {\r
FtwDevice->FtwBackupFvb = Fvb;\r
//\r
// To get the LBA of spare\r
//\r
for (LbaIndex = 1; LbaIndex <= NumberOfBlocks; LbaIndex += 1) {\r
- if ((FtwDevice->SpareAreaAddress >= (FvbBaseAddress + BlockSize * (LbaIndex - 1)))\r
- && (FtwDevice->SpareAreaAddress < (FvbBaseAddress + BlockSize * LbaIndex))) {\r
+ if ( (FtwDevice->SpareAreaAddress >= (FvbBaseAddress + BlockSize * (LbaIndex - 1)))\r
+ && (FtwDevice->SpareAreaAddress < (FvbBaseAddress + BlockSize * LbaIndex)))\r
+ {\r
//\r
// Get the NumberOfSpareBlock and BlockSize\r
//\r
ASSERT (FALSE);\r
return EFI_ABORTED;\r
}\r
+\r
//\r
// Check the alignment of spare area address and length, they should be block size aligned\r
//\r
if (((FtwDevice->SpareAreaAddress & (FtwDevice->SpareBlockSize - 1)) != 0) ||\r
- ((FtwDevice->SpareAreaLength & (FtwDevice->SpareBlockSize - 1)) != 0)) {\r
+ ((FtwDevice->SpareAreaLength & (FtwDevice->SpareBlockSize - 1)) != 0))\r
+ {\r
DEBUG ((DEBUG_ERROR, "Ftw: Spare area address or length is not block size aligned\n"));\r
FreePool (HandleBuffer);\r
//\r
ASSERT (FALSE);\r
CpuDeadLoop ();\r
}\r
+\r
break;\r
}\r
}\r
}\r
}\r
+\r
FreePool (HandleBuffer);\r
\r
if ((FtwDevice->FtwBackupFvb == NULL) || (FtwDevice->FtwFvBlock == NULL) ||\r
- (FtwDevice->FtwWorkSpaceLba == (EFI_LBA) (-1)) || (FtwDevice->FtwSpareLba == (EFI_LBA) (-1))) {\r
+ (FtwDevice->FtwWorkSpaceLba == (EFI_LBA)(-1)) || (FtwDevice->FtwSpareLba == (EFI_LBA)(-1)))\r
+ {\r
return EFI_ABORTED;\r
}\r
+\r
DEBUG ((DEBUG_INFO, "Ftw: FtwWorkSpaceLba - 0x%lx, WorkBlockSize - 0x%x, FtwWorkSpaceBase - 0x%x\n", FtwDevice->FtwWorkSpaceLba, FtwDevice->WorkBlockSize, FtwDevice->FtwWorkSpaceBase));\r
DEBUG ((DEBUG_INFO, "Ftw: FtwSpareLba - 0x%lx, SpareBlockSize - 0x%x\n", FtwDevice->FtwSpareLba, FtwDevice->SpareBlockSize));\r
\r
return EFI_SUCCESS;\r
}\r
\r
-\r
/**\r
Initialization for Fault Tolerant Write protocol.\r
\r
**/\r
EFI_STATUS\r
InitFtwProtocol (\r
- IN OUT EFI_FTW_DEVICE *FtwDevice\r
+ IN OUT EFI_FTW_DEVICE *FtwDevice\r
)\r
{\r
EFI_STATUS Status;\r
// block, unless there are not enough blocks before the block that contains\r
// working space.\r
//\r
- FtwDevice->NumberOfWorkBlock = (UINTN) (FtwDevice->FtwWorkSpaceLba + FtwDevice->NumberOfWorkSpaceBlock);\r
+ FtwDevice->NumberOfWorkBlock = (UINTN)(FtwDevice->FtwWorkSpaceLba + FtwDevice->NumberOfWorkSpaceBlock);\r
while (FtwDevice->NumberOfWorkBlock * FtwDevice->WorkBlockSize > FtwDevice->SpareAreaLength) {\r
FtwDevice->NumberOfWorkBlock--;\r
}\r
}\r
+\r
FtwDevice->FtwWorkBlockLba = FtwDevice->FtwWorkSpaceLba + FtwDevice->NumberOfWorkSpaceBlock - FtwDevice->NumberOfWorkBlock;\r
DEBUG ((DEBUG_INFO, "Ftw: NumberOfWorkBlock - 0x%x, FtwWorkBlockLba - 0x%lx\n", FtwDevice->NumberOfWorkBlock, FtwDevice->FtwWorkBlockLba));\r
\r
// Calcualte the LBA and base of work space in spare block.\r
// Note: Do not assume Spare Block and Work Block have same block size.\r
//\r
- WorkSpaceLbaOffset = FtwDevice->FtwWorkSpaceLba - FtwDevice->FtwWorkBlockLba;\r
- FtwDevice->FtwWorkSpaceLbaInSpare = (EFI_LBA) (((UINTN) WorkSpaceLbaOffset * FtwDevice->WorkBlockSize + FtwDevice->FtwWorkSpaceBase) / FtwDevice->SpareBlockSize);\r
- FtwDevice->FtwWorkSpaceBaseInSpare = ((UINTN) WorkSpaceLbaOffset * FtwDevice->WorkBlockSize + FtwDevice->FtwWorkSpaceBase) % FtwDevice->SpareBlockSize;\r
+ WorkSpaceLbaOffset = FtwDevice->FtwWorkSpaceLba - FtwDevice->FtwWorkBlockLba;\r
+ FtwDevice->FtwWorkSpaceLbaInSpare = (EFI_LBA)(((UINTN)WorkSpaceLbaOffset * FtwDevice->WorkBlockSize + FtwDevice->FtwWorkSpaceBase) / FtwDevice->SpareBlockSize);\r
+ FtwDevice->FtwWorkSpaceBaseInSpare = ((UINTN)WorkSpaceLbaOffset * FtwDevice->WorkBlockSize + FtwDevice->FtwWorkSpaceBase) % FtwDevice->SpareBlockSize;\r
DEBUG ((DEBUG_INFO, "Ftw: WorkSpaceLbaInSpare - 0x%lx, WorkSpaceBaseInSpare - 0x%x\n", FtwDevice->FtwWorkSpaceLbaInSpare, FtwDevice->FtwWorkSpaceBaseInSpare));\r
\r
//\r
// Initialize other parameters, and set WorkSpace as FTW_ERASED_BYTE.\r
//\r
- FtwDevice->FtwWorkSpace = (UINT8 *) (FtwDevice + 1);\r
- FtwDevice->FtwWorkSpaceHeader = (EFI_FAULT_TOLERANT_WORKING_BLOCK_HEADER *) FtwDevice->FtwWorkSpace;\r
+ FtwDevice->FtwWorkSpace = (UINT8 *)(FtwDevice + 1);\r
+ FtwDevice->FtwWorkSpaceHeader = (EFI_FAULT_TOLERANT_WORKING_BLOCK_HEADER *)FtwDevice->FtwWorkSpace;\r
\r
FtwDevice->FtwLastWriteHeader = NULL;\r
FtwDevice->FtwLastWriteRecord = NULL;\r
//\r
if (IsValidWorkSpace (FtwDevice->FtwWorkSpaceHeader)) {\r
Status = FlushSpareBlockToWorkingBlock (FtwDevice);\r
- DEBUG ((DEBUG_INFO, "Ftw: Restart working block update in %a() - %r\n",\r
- __FUNCTION__, Status));\r
+ DEBUG ((\r
+ DEBUG_INFO,\r
+ "Ftw: Restart working block update in %a() - %r\n",\r
+ __FUNCTION__,\r
+ Status\r
+ ));\r
FtwAbort (&FtwDevice->FtwInstance);\r
//\r
// Refresh work space.\r
Status = WorkSpaceRefresh (FtwDevice);\r
ASSERT_EFI_ERROR (Status);\r
} else {\r
- DEBUG ((DEBUG_INFO,\r
- "Ftw: Both working and spare blocks are invalid, init workspace\n"));\r
+ DEBUG ((\r
+ DEBUG_INFO,\r
+ "Ftw: Both working and spare blocks are invalid, init workspace\n"\r
+ ));\r
//\r
// If both are invalid, then initialize work space.\r
//\r
ASSERT_EFI_ERROR (Status);\r
}\r
}\r
+\r
//\r
// If the FtwDevice->FtwLastWriteRecord is 1st record of write header &&\r
// (! SpareComplete) THEN call Abort().\r
//\r
if ((FtwDevice->FtwLastWriteHeader->HeaderAllocated == FTW_VALID_STATE) &&\r
- (FtwDevice->FtwLastWriteRecord->SpareComplete != FTW_VALID_STATE) &&\r
- IsFirstRecordOfWrites (FtwDevice->FtwLastWriteHeader, FtwDevice->FtwLastWriteRecord)\r
- ) {\r
+ (FtwDevice->FtwLastWriteRecord->SpareComplete != FTW_VALID_STATE) &&\r
+ IsFirstRecordOfWrites (FtwDevice->FtwLastWriteHeader, FtwDevice->FtwLastWriteRecord)\r
+ )\r
+ {\r
DEBUG ((DEBUG_ERROR, "Ftw: Init.. find first record not SpareCompleted, abort()\n"));\r
FtwAbort (&FtwDevice->FtwInstance);\r
}\r
+\r
//\r
// If Header is incompleted and the last record has completed, then\r
// call Abort() to set the Header->Complete FLAG.\r
//\r
if ((FtwDevice->FtwLastWriteHeader->Complete != FTW_VALID_STATE) &&\r
- (FtwDevice->FtwLastWriteRecord->DestinationComplete == FTW_VALID_STATE) &&\r
- IsLastRecordOfWrites (FtwDevice->FtwLastWriteHeader, FtwDevice->FtwLastWriteRecord)\r
- ) {\r
+ (FtwDevice->FtwLastWriteRecord->DestinationComplete == FTW_VALID_STATE) &&\r
+ IsLastRecordOfWrites (FtwDevice->FtwLastWriteHeader, FtwDevice->FtwLastWriteRecord)\r
+ )\r
+ {\r
DEBUG ((DEBUG_ERROR, "Ftw: Init.. find last record completed but header not, abort()\n"));\r
FtwAbort (&FtwDevice->FtwInstance);\r
}\r
+\r
//\r
// To check the workspace buffer following last Write header/records is EMPTY or not.\r
// If it's not EMPTY, FTW also need to call reclaim().\r
//\r
FtwHeader = FtwDevice->FtwLastWriteHeader;\r
- Offset = (UINT8 *) FtwHeader - FtwDevice->FtwWorkSpace;\r
+ Offset = (UINT8 *)FtwHeader - FtwDevice->FtwWorkSpace;\r
if (FtwDevice->FtwWorkSpace[Offset] != FTW_ERASED_BYTE) {\r
Offset += FTW_WRITE_TOTAL_SIZE (FtwHeader->NumberOfWrites, FtwHeader->PrivateDataSize);\r
}\r
// Restart if it's boot block\r
//\r
if ((FtwDevice->FtwLastWriteHeader->Complete != FTW_VALID_STATE) &&\r
- (FtwDevice->FtwLastWriteRecord->SpareComplete == FTW_VALID_STATE)\r
- ) {\r
+ (FtwDevice->FtwLastWriteRecord->SpareComplete == FTW_VALID_STATE)\r
+ )\r
+ {\r
if (FtwDevice->FtwLastWriteRecord->BootBlockUpdate == FTW_VALID_STATE) {\r
Status = FlushSpareBlockToBootBlock (FtwDevice);\r
DEBUG ((DEBUG_ERROR, "Ftw: Restart boot block update - %r\n", Status));\r
// if (SpareCompleted) THEN Restart to fault tolerant write.\r
//\r
FvbHandle = NULL;\r
- FvbHandle = GetFvbByAddress ((EFI_PHYSICAL_ADDRESS) (UINTN) ((INT64) FtwDevice->SpareAreaAddress + FtwDevice->FtwLastWriteRecord->RelativeOffset), &Fvb);\r
+ FvbHandle = GetFvbByAddress ((EFI_PHYSICAL_ADDRESS)(UINTN)((INT64)FtwDevice->SpareAreaAddress + FtwDevice->FtwLastWriteRecord->RelativeOffset), &Fvb);\r
if (FvbHandle != NULL) {\r
Status = FtwRestart (&FtwDevice->FtwInstance, FvbHandle);\r
DEBUG ((DEBUG_ERROR, "Ftw: Restart last write - %r\n", Status));\r
ASSERT_EFI_ERROR (Status);\r
}\r
+\r
FtwAbort (&FtwDevice->FtwInstance);\r
}\r
}\r
+\r
//\r
// Hook the protocol API\r
//\r