123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468 |
- #define INCLUDE_FROM_XMEGA_NVM_C
- #include "XMEGANVM.h"
- #if defined(ENABLE_XPROG_PROTOCOL) || defined(__DOXYGEN__)
- static void XMEGANVM_SendAddress(const uint32_t AbsoluteAddress)
- {
-
- XPROGTarget_SendByte(AbsoluteAddress & 0xFF);
- XPROGTarget_SendByte(AbsoluteAddress >> 8);
- XPROGTarget_SendByte(AbsoluteAddress >> 16);
- XPROGTarget_SendByte(AbsoluteAddress >> 24);
- }
- static void XMEGANVM_SendNVMRegAddress(const uint8_t Register)
- {
-
- uint32_t Address = XPROG_Param_NVMBase | Register;
-
- XMEGANVM_SendAddress(Address);
- }
- bool XMEGANVM_WaitWhileNVMBusBusy(void)
- {
-
- for (;;)
- {
-
- XPROGTarget_SendByte(PDI_CMD_LDCS(PDI_REG_STATUS));
- uint8_t StatusRegister = XPROGTarget_ReceiveByte();
-
- if (!(TimeoutTicksRemaining))
- return false;
-
- if (StatusRegister & PDI_STATUS_NVM)
- return true;
- }
- }
- bool XMEGANVM_WaitWhileNVMControllerBusy(void)
- {
-
- XPROGTarget_SendByte(PDI_CMD_ST(PDI_POINTER_DIRECT, PDI_DATASIZE_4BYTES));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_STATUS);
-
- for (;;)
- {
-
- XPROGTarget_SendByte(PDI_CMD_LD(PDI_POINTER_INDIRECT, PDI_DATASIZE_1BYTE));
- uint8_t StatusRegister = XPROGTarget_ReceiveByte();
-
- if (!(TimeoutTicksRemaining))
- return false;
-
- if (!(StatusRegister & (1 << 7)))
- return true;
- }
- }
- bool XMEGANVM_EnablePDI(void)
- {
-
- XPROGTarget_EnableTargetPDI();
-
- XPROGTarget_SendByte(PDI_CMD_STCS(PDI_REG_RESET));
- XPROGTarget_SendByte(PDI_RESET_KEY);
-
- XPROGTarget_SendByte(PDI_CMD_STCS(PDI_REG_CTRL));
- XPROGTarget_SendByte(0x02);
-
- XPROGTarget_SendByte(PDI_CMD_KEY);
- for (uint8_t i = sizeof(PDI_NVMENABLE_KEY); i > 0; i--)
- XPROGTarget_SendByte(PDI_NVMENABLE_KEY[i - 1]);
-
- return XMEGANVM_WaitWhileNVMBusBusy();
- }
- void XMEGANVM_DisablePDI(void)
- {
- XMEGANVM_WaitWhileNVMBusBusy();
-
- do
- {
-
- XPROGTarget_SendByte(PDI_CMD_STCS(PDI_REG_RESET));
- XPROGTarget_SendByte(0x00);
-
- XPROGTarget_SendByte(PDI_CMD_LDCS(PDI_REG_RESET));
- } while (XPROGTarget_ReceiveByte() != 0x00);
- XPROGTarget_DisableTargetPDI();
- }
- bool XMEGANVM_GetMemoryCRC(const uint8_t CRCCommand,
- uint32_t* const CRCDest)
- {
- *CRCDest = 0;
-
- if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
- return false;
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
- XPROGTarget_SendByte(CRCCommand);
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CTRLA);
- XPROGTarget_SendByte(XMEGA_NVM_BIT_CTRLA_CMDEX);
-
- if (!(XMEGANVM_WaitWhileNVMBusBusy()))
- return false;
-
- if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
- return false;
-
- XPROGTarget_SendByte(PDI_CMD_ST(PDI_POINTER_DIRECT, PDI_DATASIZE_4BYTES));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_DAT0);
-
- XPROGTarget_SendByte(PDI_CMD_REPEAT(PDI_DATASIZE_1BYTE));
- XPROGTarget_SendByte(XMEGA_CRC_LENGTH_BYTES - 1);
-
- XPROGTarget_SendByte(PDI_CMD_LD(PDI_POINTER_INDIRECT_PI, PDI_DATASIZE_1BYTE));
- for (uint8_t i = 0; i < XMEGA_CRC_LENGTH_BYTES; i++)
- ((uint8_t*)CRCDest)[i] = XPROGTarget_ReceiveByte();
- return (TimeoutTicksRemaining > 0);
- }
- bool XMEGANVM_ReadMemory(const uint32_t ReadAddress,
- uint8_t* ReadBuffer,
- uint16_t ReadSize)
- {
-
- if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
- return false;
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
- XPROGTarget_SendByte(XMEGA_NVM_CMD_READNVM);
- if (ReadSize > 1)
- {
-
- XPROGTarget_SendByte(PDI_CMD_ST(PDI_POINTER_DIRECT, PDI_DATASIZE_4BYTES));
- XMEGANVM_SendAddress(ReadAddress);
-
- XPROGTarget_SendByte(PDI_CMD_REPEAT(PDI_DATASIZE_1BYTE));
- XPROGTarget_SendByte(ReadSize - 1);
-
- XPROGTarget_SendByte(PDI_CMD_LD(PDI_POINTER_INDIRECT_PI, PDI_DATASIZE_1BYTE));
- while (ReadSize-- && TimeoutTicksRemaining)
- *(ReadBuffer++) = XPROGTarget_ReceiveByte();
- }
- else
- {
-
- XPROGTarget_SendByte(PDI_CMD_LDS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendAddress(ReadAddress);
- *(ReadBuffer++) = XPROGTarget_ReceiveByte();
- }
- return (TimeoutTicksRemaining > 0);
- }
- bool XMEGANVM_WriteByteMemory(const uint8_t WriteCommand,
- const uint32_t WriteAddress,
- const uint8_t Byte)
- {
-
- if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
- return false;
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
- XPROGTarget_SendByte(WriteCommand);
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendAddress(WriteAddress);
- XPROGTarget_SendByte(Byte);
- return true;
- }
- bool XMEGANVM_WritePageMemory(const uint8_t WriteBuffCommand,
- const uint8_t EraseBuffCommand,
- const uint8_t WritePageCommand,
- const uint8_t PageMode,
- const uint32_t WriteAddress,
- const uint8_t* WriteBuffer,
- uint16_t WriteSize)
- {
- if (PageMode & XPROG_PAGEMODE_ERASE)
- {
-
- if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
- return false;
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
- XPROGTarget_SendByte(EraseBuffCommand);
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CTRLA);
- XPROGTarget_SendByte(XMEGA_NVM_BIT_CTRLA_CMDEX);
- }
- if (WriteSize)
- {
-
- if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
- return false;
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
- XPROGTarget_SendByte(WriteBuffCommand);
-
- XPROGTarget_SendByte(PDI_CMD_ST(PDI_POINTER_DIRECT, PDI_DATASIZE_4BYTES));
- XMEGANVM_SendAddress(WriteAddress);
-
- XPROGTarget_SendByte(PDI_CMD_REPEAT(PDI_DATASIZE_1BYTE));
- XPROGTarget_SendByte(WriteSize - 1);
-
- XPROGTarget_SendByte(PDI_CMD_ST(PDI_POINTER_INDIRECT_PI, PDI_DATASIZE_1BYTE));
- while (WriteSize--)
- XPROGTarget_SendByte(*(WriteBuffer++));
- }
- if (PageMode & XPROG_PAGEMODE_WRITE)
- {
-
- if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
- return false;
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
- XPROGTarget_SendByte(WritePageCommand);
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendAddress(WriteAddress);
- XPROGTarget_SendByte(0x00);
- }
- return true;
- }
- bool XMEGANVM_EraseMemory(const uint8_t EraseCommand,
- const uint32_t Address)
- {
-
- if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
- return false;
-
- if (EraseCommand == XMEGA_NVM_CMD_CHIPERASE)
- {
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
- XPROGTarget_SendByte(EraseCommand);
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CTRLA);
- XPROGTarget_SendByte(XMEGA_NVM_BIT_CTRLA_CMDEX);
- }
- else if (EraseCommand == XMEGA_NVM_CMD_ERASEEEPROM)
- {
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
- XPROGTarget_SendByte(XMEGA_NVM_CMD_ERASEEEPROMPAGEBUFF);
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CTRLA);
- XPROGTarget_SendByte(XMEGA_NVM_BIT_CTRLA_CMDEX);
-
- if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
- return false;
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
- XPROGTarget_SendByte(XMEGA_NVM_CMD_LOADEEPROMPAGEBUFF);
-
- XPROGTarget_SendByte(PDI_CMD_ST(PDI_POINTER_DIRECT, PDI_DATASIZE_4BYTES));
- XMEGANVM_SendAddress(Address);
-
- XPROGTarget_SendByte(PDI_CMD_REPEAT(PDI_DATASIZE_1BYTE));
- XPROGTarget_SendByte(XPROG_Param_EEPageSize - 1);
-
- XPROGTarget_SendByte(PDI_CMD_ST(PDI_POINTER_INDIRECT_PI, PDI_DATASIZE_1BYTE));
- for (uint8_t PageByte = 0; PageByte < XPROG_Param_EEPageSize; PageByte++)
- XPROGTarget_SendByte(0x00);
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
- XPROGTarget_SendByte(EraseCommand);
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CTRLA);
- XPROGTarget_SendByte(XMEGA_NVM_BIT_CTRLA_CMDEX);
- }
- else
- {
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
- XPROGTarget_SendByte(EraseCommand);
-
- XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
- XMEGANVM_SendAddress(Address);
- XPROGTarget_SendByte(0x00);
- }
-
- if (!(XMEGANVM_WaitWhileNVMBusBusy()))
- return false;
- return true;
- }
- #endif
|