You can not select more than 25 topics
			Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
		
		
		
		
		
			
		
			
				
					
					
						
							469 lines
						
					
					
						
							18 KiB
						
					
					
				
			
		
		
	
	
							469 lines
						
					
					
						
							18 KiB
						
					
					
				| /*
 | |
|              LUFA Library
 | |
|      Copyright (C) Dean Camera, 2017.
 | |
| 
 | |
|   dean [at] fourwalledcubicle [dot] com
 | |
|            www.lufa-lib.org
 | |
| */
 | |
| 
 | |
| /*
 | |
|   Copyright 2017  Dean Camera (dean [at] fourwalledcubicle [dot] com)
 | |
| 
 | |
|   Permission to use, copy, modify, distribute, and sell this
 | |
|   software and its documentation for any purpose is hereby granted
 | |
|   without fee, provided that the above copyright notice appear in
 | |
|   all copies and that both that the copyright notice and this
 | |
|   permission notice and warranty disclaimer appear in supporting
 | |
|   documentation, and that the name of the author not be used in
 | |
|   advertising or publicity pertaining to distribution of the
 | |
|   software without specific, written prior permission.
 | |
| 
 | |
|   The author disclaims all warranties with regard to this
 | |
|   software, including all implied warranties of merchantability
 | |
|   and fitness.  In no event shall the author be liable for any
 | |
|   special, indirect or consequential damages or any damages
 | |
|   whatsoever resulting from loss of use, data or profits, whether
 | |
|   in an action of contract, negligence or other tortious action,
 | |
|   arising out of or in connection with the use or performance of
 | |
|   this software.
 | |
| */
 | |
| 
 | |
| /** \file
 | |
|  *
 | |
|  *  Target-related functions for the XMEGA target's NVM module.
 | |
|  */
 | |
| 
 | |
| #define  INCLUDE_FROM_XMEGA_NVM_C
 | |
| #include "XMEGANVM.h"
 | |
| 
 | |
| #if defined(ENABLE_XPROG_PROTOCOL) || defined(__DOXYGEN__)
 | |
| 
 | |
| /** Sends the given 32-bit absolute address to the target.
 | |
|  *
 | |
|  *  \param[in] AbsoluteAddress  Absolute address to send to the target
 | |
|  */
 | |
| static void XMEGANVM_SendAddress(const uint32_t AbsoluteAddress)
 | |
| {
 | |
| 	/* Send the given 32-bit address to the target, LSB first */
 | |
| 	XPROGTarget_SendByte(AbsoluteAddress &  0xFF);
 | |
| 	XPROGTarget_SendByte(AbsoluteAddress >> 8);
 | |
| 	XPROGTarget_SendByte(AbsoluteAddress >> 16);
 | |
| 	XPROGTarget_SendByte(AbsoluteAddress >> 24);
 | |
| }
 | |
| 
 | |
| /** Sends the given NVM register address to the target.
 | |
|  *
 | |
|  *  \param[in] Register  NVM register whose absolute address is to be sent
 | |
|  */
 | |
| static void XMEGANVM_SendNVMRegAddress(const 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 */
 | |
| 	XMEGANVM_SendAddress(Address);
 | |
| }
 | |
| 
 | |
| /** Busy-waits while the NVM controller is busy performing a NVM operation, such as a FLASH page read or CRC
 | |
|  *  calculation.
 | |
|  *
 | |
|  *  \return Boolean \c true if the NVM controller became ready within the timeout period, \c false otherwise
 | |
|  */
 | |
| bool XMEGANVM_WaitWhileNVMBusBusy(void)
 | |
| {
 | |
| 	/* Poll the STATUS register to check to see if NVM access has been enabled */
 | |
| 	for (;;)
 | |
| 	{
 | |
| 		/* Send the LDCS command to read the PDI STATUS register to see the NVM bus is active */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_LDCS(PDI_REG_STATUS));
 | |
| 
 | |
| 		uint8_t StatusRegister = XPROGTarget_ReceiveByte();
 | |
| 
 | |
| 		/* We might have timed out waiting for the status register read response, check here */
 | |
| 		if (!(TimeoutTicksRemaining))
 | |
| 		  return false;
 | |
| 
 | |
| 		/* Check the status register read response to see if the NVM bus is enabled */
 | |
| 		if (StatusRegister & PDI_STATUS_NVM)
 | |
| 		  return true;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| /** Waits while the target's NVM controller is busy performing an operation, exiting if the
 | |
|  *  timeout period expires.
 | |
|  *
 | |
|  *  \return Boolean \c true if the NVM controller became ready within the timeout period, \c false otherwise
 | |
|  */
 | |
| bool XMEGANVM_WaitWhileNVMControllerBusy(void)
 | |
| {
 | |
| 	/* Preload the pointer register with the NVM STATUS register address to check the BUSY flag */
 | |
| 	XPROGTarget_SendByte(PDI_CMD_ST(PDI_POINTER_DIRECT, PDI_DATASIZE_4BYTES));
 | |
| 	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_STATUS);
 | |
| 
 | |
| 	/* Poll the NVM STATUS register while the NVM controller is busy */
 | |
| 	for (;;)
 | |
| 	{
 | |
| 		/* Fetch the current status value via the pointer register (without auto-increment afterwards) */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_LD(PDI_POINTER_INDIRECT, PDI_DATASIZE_1BYTE));
 | |
| 
 | |
| 		uint8_t StatusRegister = XPROGTarget_ReceiveByte();
 | |
| 
 | |
| 		/* We might have timed out waiting for the status register read response, check here */
 | |
| 		if (!(TimeoutTicksRemaining))
 | |
| 		  return false;
 | |
| 
 | |
| 		/* Check to see if the BUSY flag is still set */
 | |
| 		if (!(StatusRegister & (1 << 7)))
 | |
| 		  return true;
 | |
| 	}
 | |
| }
 | |
| 
 | |
| /** Enables the physical PDI interface on the target and enables access to the internal NVM controller.
 | |
|  *
 | |
|  *  \return Boolean \c true if the PDI interface was enabled successfully, \c false otherwise
 | |
|  */
 | |
| bool XMEGANVM_EnablePDI(void)
 | |
| {
 | |
| 	/* Enable PDI programming mode with the attached target */
 | |
| 	XPROGTarget_EnableTargetPDI();
 | |
| 
 | |
| 	/* Store the RESET key into the RESET PDI register to keep the XMEGA in reset */
 | |
| 	XPROGTarget_SendByte(PDI_CMD_STCS(PDI_REG_RESET));
 | |
| 	XPROGTarget_SendByte(PDI_RESET_KEY);
 | |
| 
 | |
| 	/* Lower direction change guard time to 32 USART bits */
 | |
| 	XPROGTarget_SendByte(PDI_CMD_STCS(PDI_REG_CTRL));
 | |
| 	XPROGTarget_SendByte(0x02);
 | |
| 
 | |
| 	/* Enable access to the XPROG NVM bus by sending the documented NVM access key to the device */
 | |
| 	XPROGTarget_SendByte(PDI_CMD_KEY);
 | |
| 	for (uint8_t i = sizeof(PDI_NVMENABLE_KEY); i > 0; i--)
 | |
| 	  XPROGTarget_SendByte(PDI_NVMENABLE_KEY[i - 1]);
 | |
| 
 | |
| 	/* Wait until the NVM bus becomes active */
 | |
| 	return XMEGANVM_WaitWhileNVMBusBusy();
 | |
| }
 | |
| 
 | |
| /** Removes access to the target's NVM controller and physically disables the target's physical PDI interface. */
 | |
| void XMEGANVM_DisablePDI(void)
 | |
| {
 | |
| 	XMEGANVM_WaitWhileNVMBusBusy();
 | |
| 
 | |
| 	/* Clear the RESET key in the RESET PDI register to allow the XMEGA to run - must perform this until the
 | |
| 	 * change takes effect, as in some cases it takes multiple writes (silicon bug?).
 | |
| 	 */
 | |
| 	do
 | |
| 	{
 | |
| 		/* Clear reset register */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_STCS(PDI_REG_RESET));
 | |
| 		XPROGTarget_SendByte(0x00);
 | |
| 
 | |
| 		/* Read back the reset register, check to see if it took effect */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_LDCS(PDI_REG_RESET));
 | |
| 	} while (XPROGTarget_ReceiveByte() != 0x00);
 | |
| 
 | |
| 	XPROGTarget_DisableTargetPDI();
 | |
| }
 | |
| 
 | |
| /** Retrieves the CRC value of the given memory space.
 | |
|  *
 | |
|  *  \param[in]  CRCCommand  NVM CRC command to issue to the target
 | |
|  *  \param[out] CRCDest     CRC Destination when read from the target
 | |
|  *
 | |
|  *  \return Boolean \c true if the command sequence complete successfully
 | |
|  */
 | |
| bool XMEGANVM_GetMemoryCRC(const uint8_t CRCCommand,
 | |
|                            uint32_t* const CRCDest)
 | |
| {
 | |
| 	*CRCDest = 0;
 | |
| 
 | |
| 	/* Wait until the NVM controller is no longer busy */
 | |
| 	if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
 | |
| 	  return false;
 | |
| 
 | |
| 	/* Set the NVM command to the correct CRC read command */
 | |
| 	XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
 | |
| 	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
 | |
| 	XPROGTarget_SendByte(CRCCommand);
 | |
| 
 | |
| 	/* Set CMDEX bit in NVM CTRLA register to start the CRC generation */
 | |
| 	XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
 | |
| 	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CTRLA);
 | |
| 	XPROGTarget_SendByte(XMEGA_NVM_BIT_CTRLA_CMDEX);
 | |
| 
 | |
| 	/* Wait until the NVM bus is ready again */
 | |
| 	if (!(XMEGANVM_WaitWhileNVMBusBusy()))
 | |
| 	  return false;
 | |
| 
 | |
| 	/* Wait until the NVM controller is no longer busy */
 | |
| 	if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
 | |
| 	  return false;
 | |
| 
 | |
| 	/* Load the PDI pointer register with the DAT0 register start address */
 | |
| 	XPROGTarget_SendByte(PDI_CMD_ST(PDI_POINTER_DIRECT, PDI_DATASIZE_4BYTES));
 | |
| 	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_DAT0);
 | |
| 
 | |
| 	/* Send the REPEAT command to grab the CRC bytes */
 | |
| 	XPROGTarget_SendByte(PDI_CMD_REPEAT(PDI_DATASIZE_1BYTE));
 | |
| 	XPROGTarget_SendByte(XMEGA_CRC_LENGTH_BYTES - 1);
 | |
| 
 | |
| 	/* Read in the CRC bytes from the target */
 | |
| 	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);
 | |
| }
 | |
| 
 | |
| /** Reads memory from the target's memory spaces.
 | |
|  *
 | |
|  *  \param[in]  ReadAddress  Start address to read from within the target's address space
 | |
|  *  \param[out] ReadBuffer   Buffer to store read data into
 | |
|  *  \param[in]  ReadSize     Number of bytes to read
 | |
|  *
 | |
|  *  \return Boolean \c true if the command sequence complete successfully
 | |
|  */
 | |
| bool XMEGANVM_ReadMemory(const uint32_t ReadAddress,
 | |
|                          uint8_t* ReadBuffer,
 | |
|                          uint16_t ReadSize)
 | |
| {
 | |
| 	/* Wait until the NVM controller is no longer busy */
 | |
| 	if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
 | |
| 	  return false;
 | |
| 
 | |
| 	/* Send the READNVM command to the NVM controller for reading of an arbitrary location */
 | |
| 	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)
 | |
| 	{
 | |
| 		/* Load the PDI pointer register with the start address we want to read from */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_ST(PDI_POINTER_DIRECT, PDI_DATASIZE_4BYTES));
 | |
| 		XMEGANVM_SendAddress(ReadAddress);
 | |
| 
 | |
| 		/* Send the REPEAT command with the specified number of bytes to read */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_REPEAT(PDI_DATASIZE_1BYTE));
 | |
| 		XPROGTarget_SendByte(ReadSize - 1);
 | |
| 
 | |
| 		/* Send a LD command with indirect access and post-increment to read out the bytes */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_LD(PDI_POINTER_INDIRECT_PI, PDI_DATASIZE_1BYTE));
 | |
| 		while (ReadSize-- && TimeoutTicksRemaining)
 | |
| 		  *(ReadBuffer++) = XPROGTarget_ReceiveByte();
 | |
| 	}
 | |
| 	else
 | |
| 	{
 | |
| 		/* Send a LDS command with the read address to read out the requested byte */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_LDS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
 | |
| 		XMEGANVM_SendAddress(ReadAddress);
 | |
| 		*(ReadBuffer++) = XPROGTarget_ReceiveByte();
 | |
| 	}
 | |
| 
 | |
| 	return (TimeoutTicksRemaining > 0);
 | |
| }
 | |
| 
 | |
| /** Writes byte addressed memory to the target's memory spaces.
 | |
|  *
 | |
|  *  \param[in]  WriteCommand  Command to send to the device to write each memory byte
 | |
|  *  \param[in]  WriteAddress  Address to write to within the target's address space
 | |
|  *  \param[in]  Byte          Byte to write to the target
 | |
|  *
 | |
|  *  \return Boolean \c true if the command sequence complete successfully
 | |
|  */
 | |
| bool XMEGANVM_WriteByteMemory(const uint8_t WriteCommand,
 | |
|                               const uint32_t WriteAddress,
 | |
|                               const uint8_t Byte)
 | |
| {
 | |
| 	/* Wait until the NVM controller is no longer busy */
 | |
| 	if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
 | |
| 	  return false;
 | |
| 
 | |
| 	/* Send the memory write command to the target */
 | |
| 	XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
 | |
| 	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
 | |
| 	XPROGTarget_SendByte(WriteCommand);
 | |
| 
 | |
| 	/* Send new memory byte to the memory of the target */
 | |
| 	XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
 | |
| 	XMEGANVM_SendAddress(WriteAddress);
 | |
| 	XPROGTarget_SendByte(Byte);
 | |
| 
 | |
| 	return true;
 | |
| }
 | |
| 
 | |
| /** Writes page addressed memory to the target's memory spaces.
 | |
|  *
 | |
|  *  \param[in]  WriteBuffCommand  Command to send to the device to write a byte to the memory page buffer
 | |
|  *  \param[in]  EraseBuffCommand  Command to send to the device to erase the memory page buffer
 | |
|  *  \param[in]  WritePageCommand  Command to send to the device to write the page buffer to the destination memory
 | |
|  *  \param[in]  PageMode          Bitfield indicating what operations need to be executed on the specified page
 | |
|  *  \param[in]  WriteAddress      Start address to write the page data to within the target's address space
 | |
|  *  \param[in]  WriteBuffer       Buffer to source data from
 | |
|  *  \param[in]  WriteSize         Number of bytes to write
 | |
|  *
 | |
|  *  \return Boolean \c true if the command sequence complete successfully
 | |
|  */
 | |
| 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)
 | |
| 	{
 | |
| 		/* Wait until the NVM controller is no longer busy */
 | |
| 		if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
 | |
| 		  return false;
 | |
| 
 | |
| 		/* Send the memory buffer erase command to the target */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
 | |
| 		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
 | |
| 		XPROGTarget_SendByte(EraseBuffCommand);
 | |
| 
 | |
| 		/* Set CMDEX bit in NVM CTRLA register to start the buffer erase */
 | |
| 		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)
 | |
| 	{
 | |
| 		/* Wait until the NVM controller is no longer busy */
 | |
| 		if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
 | |
| 		  return false;
 | |
| 
 | |
| 		/* Send the memory buffer write command to the target */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
 | |
| 		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
 | |
| 		XPROGTarget_SendByte(WriteBuffCommand);
 | |
| 
 | |
| 		/* Load the PDI pointer register with the start address we want to write to */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_ST(PDI_POINTER_DIRECT, PDI_DATASIZE_4BYTES));
 | |
| 		XMEGANVM_SendAddress(WriteAddress);
 | |
| 
 | |
| 		/* Send the REPEAT command with the specified number of bytes to write */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_REPEAT(PDI_DATASIZE_1BYTE));
 | |
| 		XPROGTarget_SendByte(WriteSize - 1);
 | |
| 
 | |
| 		/* Send a ST command with indirect access and post-increment to write the bytes */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_ST(PDI_POINTER_INDIRECT_PI, PDI_DATASIZE_1BYTE));
 | |
| 		while (WriteSize--)
 | |
| 		  XPROGTarget_SendByte(*(WriteBuffer++));
 | |
| 	}
 | |
| 
 | |
| 	if (PageMode & XPROG_PAGEMODE_WRITE)
 | |
| 	{
 | |
| 		/* Wait until the NVM controller is no longer busy */
 | |
| 		if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
 | |
| 		  return false;
 | |
| 
 | |
| 		/* Send the memory write command to the target */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
 | |
| 		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
 | |
| 		XPROGTarget_SendByte(WritePageCommand);
 | |
| 
 | |
| 		/* Send the address of the first page location to write the memory page */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
 | |
| 		XMEGANVM_SendAddress(WriteAddress);
 | |
| 		XPROGTarget_SendByte(0x00);
 | |
| 	}
 | |
| 
 | |
| 	return true;
 | |
| }
 | |
| 
 | |
| /** Erases a specific memory space of the target.
 | |
|  *
 | |
|  *  \param[in] EraseCommand  NVM erase command to send to the device
 | |
|  *  \param[in] Address       Address inside the memory space to erase
 | |
|  *
 | |
|  *  \return Boolean \c true if the command sequence complete successfully
 | |
|  */
 | |
| bool XMEGANVM_EraseMemory(const uint8_t EraseCommand,
 | |
|                           const uint32_t Address)
 | |
| {
 | |
| 	/* Wait until the NVM controller is no longer busy */
 | |
| 	if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
 | |
| 	  return false;
 | |
| 
 | |
| 	/* EEPROM and Chip erasures are triggered differently to FLASH section erasures */
 | |
| 	if (EraseCommand == XMEGA_NVM_CMD_CHIPERASE)
 | |
| 	{
 | |
| 		/* Send the memory erase command to the target */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
 | |
| 		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
 | |
| 		XPROGTarget_SendByte(EraseCommand);
 | |
| 
 | |
| 		/* Set CMDEX bit in NVM CTRLA register to start the erase sequence */
 | |
| 		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)
 | |
| 	{
 | |
| 		/* Send the EEPROM page buffer erase command to the target */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
 | |
| 		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
 | |
| 		XPROGTarget_SendByte(XMEGA_NVM_CMD_ERASEEEPROMPAGEBUFF);
 | |
| 
 | |
| 		/* Set CMDEX bit in NVM CTRLA register to start the buffer erase */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
 | |
| 		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CTRLA);
 | |
| 		XPROGTarget_SendByte(XMEGA_NVM_BIT_CTRLA_CMDEX);
 | |
| 
 | |
| 		/* Wait until the NVM controller is no longer busy */
 | |
| 		if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
 | |
| 		  return false;
 | |
| 
 | |
| 		/* Send the EEPROM memory buffer write command to the target */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
 | |
| 		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
 | |
| 		XPROGTarget_SendByte(XMEGA_NVM_CMD_LOADEEPROMPAGEBUFF);
 | |
| 
 | |
| 		/* Load the PDI pointer register with the EEPROM page start address */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_ST(PDI_POINTER_DIRECT, PDI_DATASIZE_4BYTES));
 | |
| 		XMEGANVM_SendAddress(Address);
 | |
| 
 | |
| 		/* Send the REPEAT command with the specified number of bytes to write */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_REPEAT(PDI_DATASIZE_1BYTE));
 | |
| 		XPROGTarget_SendByte(XPROG_Param_EEPageSize - 1);
 | |
| 
 | |
| 		/* Send a ST command with indirect access and post-increment to tag each byte in the EEPROM page buffer */
 | |
| 		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);
 | |
| 
 | |
| 		/* Send the memory erase command to the target */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
 | |
| 		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
 | |
| 		XPROGTarget_SendByte(EraseCommand);
 | |
| 
 | |
| 		/* Set CMDEX bit in NVM CTRLA register to start the EEPROM erase sequence */
 | |
| 		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
 | |
| 	{
 | |
| 		/* Send the memory erase command to the target */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
 | |
| 		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
 | |
| 		XPROGTarget_SendByte(EraseCommand);
 | |
| 
 | |
| 		/* Other erase modes just need us to address a byte within the target memory space */
 | |
| 		XPROGTarget_SendByte(PDI_CMD_STS(PDI_DATASIZE_4BYTES, PDI_DATASIZE_1BYTE));
 | |
| 		XMEGANVM_SendAddress(Address);
 | |
| 		XPROGTarget_SendByte(0x00);
 | |
| 	}
 | |
| 
 | |
| 	/* Wait until the NVM bus is ready again */
 | |
| 	if (!(XMEGANVM_WaitWhileNVMBusBusy()))
 | |
| 	  return false;
 | |
| 
 | |
| 	return true;
 | |
| }
 | |
| 
 | |
| #endif
 | |
| 
 |