bsps/xqspipsu: Add support for reading ECC

This adds a helper function to read the ECC status for an ECC unit in
SPI-attached NOR memory.
This commit is contained in:
Kinsey Moore
2023-03-16 12:37:43 -05:00
committed by Joel Sherrill
parent ddafdfe9ba
commit 7163014e3f
3 changed files with 253 additions and 0 deletions

View File

@@ -79,3 +79,32 @@ int QspiPsu_NOR_Read(
u32 ByteCount,
u8 **ReadBfrPtr
);
/*****************************************************************************/
/**
*
* This function performs a read of the ECC Status Register for a given address.
*
* @param QspiPsuPtr is a pointer to the QSPIPSU driver component to use.
* @param Address contains the address of the ECC unit for which the ECCSR
* needs to be read. The ECC unit contains 16 bytes of user data
* and all bytes in an ECC unit will return the same ECCSR.
* @param ReadBfrPtr is a pointer to a single byte to which the ECCSR will
* be written.
*
* @return XST_SUCCESS if successful, else XST_FAILURE.
*
* @note Only the three least significant bits of the returned byte are
* meaningful. If all bits are 0, ECC is enabled for this unit and
* no errors have been encountered.
* Bit 0 is 1: ECC is disabled for the requested unit.
* Bit 1 is 1: A single bit error has been corrected in user data.
* Bit 2 is 1: A single bit error has been found in the ECC data
* and may indicate user data corruption.
*
******************************************************************************/
int QspiPsu_NOR_Read_Ecc(
XQspiPsu *QspiPsuPtr,
u32 Address,
u8 *ReadBfrPtr
);

View File

@@ -79,6 +79,7 @@ extern "C" {
#define BANK_REG_RD 0x16
#define BANK_REG_WR 0x17
#define READ_ECCSR 0x18
/* Bank register is called Extended Address Register in Micron */
#define EXTADD_REG_RD 0xC8
#define EXTADD_REG_WR 0xC5

View File

@@ -2003,3 +2003,226 @@ static int FlashEnableQuadMode(XQspiPsu *QspiPsuPtr)
return Status;
}
static int MultiDieReadEcc(
XQspiPsu *QspiPsuPtr,
u32 Address,
u32 ByteCount,
u8 *WriteBfrPtr,
u8 *ReadBfrPtr
);
int QspiPsu_NOR_Read_Ecc(
XQspiPsu *QspiPsuPtr,
u32 Address,
u8 *ReadBfrPtr
)
{
u32 RealAddr;
u32 DiscardByteCnt;
u32 FlashMsgCnt;
u8 EccBuffer[16];
int ByteCount = sizeof(EccBuffer);
int Status;
/* Check die boundary conditions if required for any flash */
if (Flash_Config_Table[FCTIndex].NumDie > 1) {
Status = MultiDieReadEcc(QspiPsuPtr, Address, ByteCount,
CmdBfr, EccBuffer);
if (Status == XST_SUCCESS) {
/* All bytes are the same, so copy one return byte into the output buffer */
*ReadBfrPtr = EccBuffer[0];
}
return Status;
}
/* For Dual Stacked, split and read for boundary crossing */
/*
* Translate address based on type of connection
* If stacked assert the slave select based on address
*/
RealAddr = GetRealAddr(QspiPsuPtr, Address);
CmdBfr[COMMAND_OFFSET] = READ_ECCSR;
CmdBfr[ADDRESS_1_OFFSET] =
(u8)((RealAddr & 0xFF000000) >> 24);
CmdBfr[ADDRESS_2_OFFSET] =
(u8)((RealAddr & 0xFF0000) >> 16);
CmdBfr[ADDRESS_3_OFFSET] =
(u8)((RealAddr & 0xFF00) >> 8);
CmdBfr[ADDRESS_4_OFFSET] =
(u8)(RealAddr & 0xF0);
DiscardByteCnt = 5;
FlashMsgCnt = 0;
FlashMsg[FlashMsgCnt].TxBfrPtr = CmdBfr;
FlashMsg[FlashMsgCnt].RxBfrPtr = NULL;
FlashMsg[FlashMsgCnt].ByteCount = DiscardByteCnt;
FlashMsg[FlashMsgCnt].BusWidth = XQSPIPSU_SELECT_MODE_SPI;
FlashMsg[FlashMsgCnt].Flags = XQSPIPSU_MSG_FLAG_TX;
FlashMsgCnt++;
FlashMsg[FlashMsgCnt].TxBfrPtr = NULL;
FlashMsg[FlashMsgCnt].RxBfrPtr = NULL;
FlashMsg[FlashMsgCnt].ByteCount = DUMMY_CLOCKS;
FlashMsg[FlashMsgCnt].Flags = 0;
FlashMsgCnt++;
FlashMsg[FlashMsgCnt].TxBfrPtr = NULL;
FlashMsg[FlashMsgCnt].RxBfrPtr = EccBuffer;
FlashMsg[FlashMsgCnt].ByteCount = ByteCount;
FlashMsg[FlashMsgCnt].BusWidth = XQSPIPSU_SELECT_MODE_SPI;
FlashMsg[FlashMsgCnt].Flags = XQSPIPSU_MSG_FLAG_RX;
if (QspiPsuPtr->Config.ConnectionMode ==
XQSPIPSU_CONNECTION_MODE_PARALLEL) {
FlashMsg[FlashMsgCnt].Flags |= XQSPIPSU_MSG_FLAG_STRIPE;
}
TransferInProgress = TRUE;
Status = XQspiPsu_InterruptTransfer(QspiPsuPtr, FlashMsg,
FlashMsgCnt + 1);
if (Status == XST_SUCCESS) {
while (TransferInProgress);
/* All bytes are the same, so copy one return byte into the output buffer */
*ReadBfrPtr = EccBuffer[0];
}
return Status;
}
/*****************************************************************************/
/**
*
* This function performs an ECC read operation for multi die flash devices.
* Default setting is in DMA mode.
*
* @param QspiPsuPtr is a pointer to the QSPIPSU driver component to use.
* @param Address contains the address of the first sector which needs to
* be erased.
* @param ByteCount contains the total size to be erased.
* @param WriteBfrPtr is pointer to the write buffer which contains data to be
* transmitted
* @param ReadBfrPtr is pointer to the read buffer to which valid received data
* should be written
*
* @return XST_SUCCESS if successful, else XST_FAILURE.
*
* @note None.
*
******************************************************************************/
static int MultiDieReadEcc(
XQspiPsu *QspiPsuPtr,
u32 Address,
u32 ByteCount,
u8 *WriteBfrPtr,
u8 *ReadBuffer
)
{
u32 RealAddr;
u32 DiscardByteCnt;
u32 FlashMsgCnt;
int Status;
u32 cur_bank = 0;
u32 nxt_bank = 0;
u32 bank_size;
u32 remain_len = ByteCount;
u32 data_len;
u32 transfer_len;
/*
* Some flash devices like N25Q512 have multiple dies
* in it. Read operation in these devices is bounded
* by its die segment. In a continuous read, across
* multiple dies, when the last byte of the selected
* die segment is read, the next byte read is the
* first byte of the same die segment. This is Die
* cross over issue. So to handle this issue, split
* a read transaction, that spans across multiple
* banks, into one read per bank. Bank size is 16MB
* for single and dual stacked mode and 32MB for dual
* parallel mode.
*/
if (QspiPsuPtr->Config.ConnectionMode ==
XQSPIPSU_CONNECTION_MODE_PARALLEL)
bank_size = SIXTEENMB << 1;
else
bank_size = SIXTEENMB;
while (remain_len) {
cur_bank = Address / bank_size;
nxt_bank = (Address + remain_len) / bank_size;
if (cur_bank != nxt_bank) {
transfer_len = (bank_size * (cur_bank + 1)) - Address;
if (remain_len < transfer_len)
data_len = remain_len;
else
data_len = transfer_len;
} else {
data_len = remain_len;
}
/*
* Translate address based on type of connection
* If stacked assert the slave select based on address
*/
RealAddr = GetRealAddr(QspiPsuPtr, Address);
WriteBfrPtr[COMMAND_OFFSET] = READ_ECCSR;
WriteBfrPtr[ADDRESS_1_OFFSET] =
(u8)((RealAddr & 0xFF000000) >> 24);
WriteBfrPtr[ADDRESS_2_OFFSET] =
(u8)((RealAddr & 0xFF0000) >> 16);
WriteBfrPtr[ADDRESS_3_OFFSET] =
(u8)((RealAddr & 0xFF00) >> 8);
WriteBfrPtr[ADDRESS_4_OFFSET] =
(u8)(RealAddr & 0xF0);
DiscardByteCnt = 5;
FlashMsgCnt = 0;
FlashMsg[FlashMsgCnt].TxBfrPtr = WriteBfrPtr;
FlashMsg[FlashMsgCnt].RxBfrPtr = NULL;
FlashMsg[FlashMsgCnt].ByteCount = DiscardByteCnt;
FlashMsg[FlashMsgCnt].BusWidth = XQSPIPSU_SELECT_MODE_SPI;
FlashMsg[FlashMsgCnt].Flags = XQSPIPSU_MSG_FLAG_TX;
FlashMsgCnt++;
FlashMsg[FlashMsgCnt].TxBfrPtr = NULL;
FlashMsg[FlashMsgCnt].RxBfrPtr = NULL;
FlashMsg[FlashMsgCnt].ByteCount = DUMMY_CLOCKS;
FlashMsg[FlashMsgCnt].Flags = 0;
FlashMsgCnt++;
FlashMsg[FlashMsgCnt].TxBfrPtr = NULL;
FlashMsg[FlashMsgCnt].RxBfrPtr = ReadBuffer;
FlashMsg[FlashMsgCnt].ByteCount = data_len;
FlashMsg[FlashMsgCnt].BusWidth = XQSPIPSU_SELECT_MODE_SPI;
FlashMsg[FlashMsgCnt].Flags = XQSPIPSU_MSG_FLAG_RX;
if (QspiPsuPtr->Config.ConnectionMode ==
XQSPIPSU_CONNECTION_MODE_PARALLEL)
FlashMsg[FlashMsgCnt].Flags |=
XQSPIPSU_MSG_FLAG_STRIPE;
TransferInProgress = TRUE;
Status = XQspiPsu_InterruptTransfer(QspiPsuPtr, FlashMsg,
FlashMsgCnt + 1);
if (Status != XST_SUCCESS)
return XST_FAILURE;
while (TransferInProgress);
ReadBuffer += data_len;
Address += data_len;
remain_len -= data_len;
}
return 0;
}