@ -40,8 +40,10 @@
void NVMTarget_SendNVMRegAddress ( uint8_t Register )
{
/* Determine the absolute register address from the NVM base memory address and the NVM register address */
uint32_t Address = XPROG_Param_NVMBase | Register ;
/* Send the calculated 32-bit address to the target, LSB first */
PDITarget_SendByte ( Address & 0xFF ) ;
PDITarget_SendByte ( Address > > 8 ) ;
PDITarget_SendByte ( Address > > 16 ) ;
@ -50,38 +52,30 @@ void NVMTarget_SendNVMRegAddress(uint8_t Register)
void NVMTarget_SendAddress ( uint32_t AbsoluteAddress )
{
/* Send the given 32-bit address to the target, LSB first */
PDITarget_SendByte ( AbsoluteAddress & 0xFF ) ;
PDITarget_SendByte ( AbsoluteAddress > > 8 ) ;
PDITarget_SendByte ( AbsoluteAddress > > 16 ) ;
PDITarget_SendByte ( AbsoluteAddress > > 24 ) ;
}
bool NVMTarget_WaitWhileNVM Bus Busy( void )
bool NVMTarget_WaitWhileNVM Controller Busy( void )
{
uint8_t AttemptsRemaining = 255 ;
TCNT0 = 0 ;
/* Poll the STATUS register to check to see if NVM access has been enabled */
while ( AttemptsRemaining - - )
{
PDITarget_SendByte ( PDI_CMD_LDCS | PDI_STATUS_REG ) ;
if ( PDITarget_ReceiveByte ( ) & PDI_STATUS_NVM )
return true ;
}
return false ;
}
void NVMTarget_WaitWhileNVMControllerBusy ( void )
{
/* Poll the NVM STATUS register while the NVM controller is busy */
for ( ; ; )
while ( TCNT0 < NVM_BUSY_TIMEOUT_MS )
{
/* Send a LDS command to read the NVM STATUS register to check the BUSY flag */
PDITarget_SendByte ( PDI_CMD_LDS | ( PDI_DATSIZE_4BYTES < < 2 ) ) ;
NVMTarget_SendNVMRegAddress ( NVM_REG_STATUS ) ;
/* Check to see if the BUSY flag is still set */
if ( ! ( PDITarget_ReceiveByte ( ) & ( 1 < < 7 ) ) )
return ;
return true ;
}
return false ;
}
uint32_t NVMTarget_GetMemoryCRC ( uint8_t MemoryCommand )
@ -101,18 +95,20 @@ uint32_t NVMTarget_GetMemoryCRC(uint8_t MemoryCommand)
PDITarget_SendByte ( 1 < < 0 ) ;
/* Wait until the NVM bus and controller is no longer busy */
NVM Target_WaitWhileNVMBusBusy( ) ;
PDI Target_WaitWhileNVMBusBusy( ) ;
NVMTarget_WaitWhileNVMControllerBusy ( ) ;
/* Read the three bytes generated CRC value */
/* Read the first generated CRC byte value */
PDITarget_SendByte ( PDI_CMD_LDS | ( PDI_DATSIZE_4BYTES < < 2 ) ) ;
NVMTarget_SendNVMRegAddress ( NVM_REG_DAT0 ) ;
MemoryCRC = PDITarget_ReceiveByte ( ) ;
/* Read the second generated CRC byte value */
PDITarget_SendByte ( PDI_CMD_LDS | ( PDI_DATSIZE_4BYTES < < 2 ) ) ;
NVMTarget_SendNVMRegAddress ( NVM_REG_DAT1 ) ;
MemoryCRC | = ( ( uint16_t ) PDITarget_ReceiveByte ( ) < < 8 ) ;
/* Read the third generated CRC byte value */
PDITarget_SendByte ( PDI_CMD_LDS | ( PDI_DATSIZE_4BYTES < < 2 ) ) ;
NVMTarget_SendNVMRegAddress ( NVM_REG_DAT2 ) ;
MemoryCRC | = ( ( uint32_t ) PDITarget_ReceiveByte ( ) < < 16 ) ;
@ -123,17 +119,33 @@ uint32_t NVMTarget_GetMemoryCRC(uint8_t MemoryCommand)
void NVMTarget_ReadMemory ( uint32_t ReadAddress , uint8_t * ReadBuffer , uint16_t ReadSize )
{
NVMTarget_WaitWhileNVMControllerBusy ( ) ;
/* Send the READNVM command to the NVM controller for reading of an aribtrary location */
PDITarget_SendByte ( PDI_CMD_STS | ( PDI_DATSIZE_4BYTES < < 2 ) ) ;
NVMTarget_SendNVMRegAddress ( NVM_REG_CMD ) ;
PDITarget_SendByte ( NVM_CMD_READNVM ) ;
/* TODO: Optimize via REPEAT and buffer orientated commands */
for ( uint16_t i = 0 ; i < ReadSize ; i + + )
/* Send the address of the first location to read from - this also primes the internal address
* counters so that we can use the REPEAT command later to save on overhead for multiple bytes */
PDITarget_SendByte ( PDI_CMD_LDS | ( PDI_DATSIZE_4BYTES < < 2 ) ) ;
NVMTarget_SendAddress ( ReadAddress ) ;
* ( ReadBuffer + + ) = PDITarget_ReceiveByte ( ) ;
/* Check to see if we are reading more than a single byte */
if ( ReadSize > 1 )
{
PDITarget_SendByte ( PDI_CMD_LDS | ( PDI_DATSIZE_4BYTES < < 2 ) ) ;
NVMTarget_SendAddress ( ReadAddress + + ) ;
* ( ReadBuffer + + ) = PDITarget_ReceiveByte ( ) ;
/* Decrement the ReadSize counter as we have already read once byte of memory */
ReadSize - - ;
/* Send the REPEAT command with the specified number of bytes remaining to read */
PDITarget_SendByte ( PDI_CMD_REPEAT | PDI_DATSIZE_2BYTES ) ;
PDITarget_SendByte ( ReadSize & 0xFF ) ;
PDITarget_SendByte ( ReadSize > > 8 ) ;
/* Send a LD command with indirect access and postincrement to read out the remaining bytes */
PDITarget_SendByte ( PDI_CMD_LD | ( PDI_POINTER_INDIRECT_PI < < 2 ) | PDI_DATSIZE_1BYTE ) ;
for ( uint16_t i = 1 ; i < ReadSize ; i + + )
* ( ReadBuffer + + ) = PDITarget_ReceiveByte ( ) ;
}
}
@ -145,6 +157,7 @@ void NVMTarget_EraseMemory(uint8_t EraseCommand, uint32_t Address)
NVMTarget_SendNVMRegAddress ( NVM_REG_CMD ) ;
PDITarget_SendByte ( EraseCommand ) ;
/* Chip erase is handled seperately, since it's procedure is different to other erase types */
if ( EraseCommand = = NVM_CMD_CHIPERASE )
{
/* Set CMDEX bit in NVM CTRLA register to start the chip erase */
@ -160,7 +173,8 @@ void NVMTarget_EraseMemory(uint8_t EraseCommand, uint32_t Address)
PDITarget_SendByte ( 0x00 ) ;
}
NVMTarget_WaitWhileNVMBusBusy ( ) ;
/* Wait until both the NVM bus and NVM controller are ready again */
PDITarget_WaitWhileNVMBusBusy ( ) ;
NVMTarget_WaitWhileNVMControllerBusy ( ) ;
}