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.
		
		
		
		
		
			
		
			
				
					275 lines
				
				9.5 KiB
			
		
		
			
		
	
	
					275 lines
				
				9.5 KiB
			|   
											8 years ago
										 | /*
 | ||
|  |              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 TINY target's NVM module. | ||
|  |  */ | ||
|  | 
 | ||
|  | #define  INCLUDE_FROM_TINYNVM_C
 | ||
|  | #include "TINYNVM.h"
 | ||
|  | 
 | ||
|  | #if defined(ENABLE_XPROG_PROTOCOL) || defined(__DOXYGEN__)
 | ||
|  | 
 | ||
|  | /** Sends the given pointer address to the target's TPI pointer register */ | ||
|  | static void TINYNVM_SendPointerAddress(const uint16_t AbsoluteAddress) | ||
|  | { | ||
|  | 	/* Send the given 16-bit address to the target, LSB first */ | ||
|  | 	XPROGTarget_SendByte(TPI_CMD_SSTPR | 0); | ||
|  | 	XPROGTarget_SendByte(AbsoluteAddress & 0xFF); | ||
|  | 	XPROGTarget_SendByte(TPI_CMD_SSTPR | 1); | ||
|  | 	XPROGTarget_SendByte(AbsoluteAddress >> 8); | ||
|  | } | ||
|  | 
 | ||
|  | /** Sends a SIN command to the target with the specified I/O address, ready for the data byte to be written.
 | ||
|  |  * | ||
|  |  *  \param[in] Address  6-bit I/O address to write to in the target's I/O memory space | ||
|  |  */ | ||
|  | static void TINYNVM_SendReadNVMRegister(const uint8_t Address) | ||
|  | { | ||
|  | 	/* The TPI command for reading from the I/O space uses strange addressing, where the I/O address's upper
 | ||
|  | 	 * two bits of the 6-bit address are shifted left once - use function to reduce code size */ | ||
|  | 	XPROGTarget_SendByte(TPI_CMD_SIN(Address)); | ||
|  | } | ||
|  | 
 | ||
|  | /** Sends a SOUT command to the target with the specified I/O address, ready for the data byte to be read.
 | ||
|  |  * | ||
|  |  *  \param[in] Address  6-bit I/O address to read from in the target's I/O memory space | ||
|  |  */ | ||
|  | static void TINYNVM_SendWriteNVMRegister(const uint8_t Address) | ||
|  | { | ||
|  | 	/* The TPI command for reading from the I/O space uses strange addressing, where the I/O address's upper
 | ||
|  | 	 * two bits of the 6-bit address are shifted left once - use function to reduce code size */ | ||
|  | 	XPROGTarget_SendByte(TPI_CMD_SOUT(Address)); | ||
|  | } | ||
|  | 
 | ||
|  | /** Busy-waits while the NVM controller is busy performing a NVM operation, such as a FLASH page read.
 | ||
|  |  * | ||
|  |  *  \return Boolean \c true if the NVM controller became ready within the timeout period, \c false otherwise | ||
|  |  */ | ||
|  | bool TINYNVM_WaitWhileNVMBusBusy(void) | ||
|  | { | ||
|  | 	/* Poll the STATUS register to check to see if NVM access has been enabled */ | ||
|  | 	for (;;) | ||
|  | 	{ | ||
|  | 		/* Send the SLDCS command to read the TPI STATUS register to see the NVM bus is active */ | ||
|  | 		XPROGTarget_SendByte(TPI_CMD_SLDCS(TPI_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 & TPI_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 TINYNVM_WaitWhileNVMControllerBusy(void) | ||
|  | { | ||
|  | 	/* Poll the STATUS register to check to see if NVM access has been enabled */ | ||
|  | 	for (;;) | ||
|  | 	{ | ||
|  | 		/* Send the SIN command to read the TPI STATUS register to see the NVM bus is busy */ | ||
|  | 		TINYNVM_SendReadNVMRegister(XPROG_Param_NVMCSRRegAddr); | ||
|  | 
 | ||
|  | 		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 TPI interface on the target and enables access to the internal NVM controller.
 | ||
|  |  * | ||
|  |  *  \return Boolean \c true if the TPI interface was enabled successfully, \c false otherwise | ||
|  |  */ | ||
|  | bool TINYNVM_EnableTPI(void) | ||
|  | { | ||
|  | 	/* Enable TPI programming mode with the attached target */ | ||
|  | 	XPROGTarget_EnableTargetTPI(); | ||
|  | 
 | ||
|  | 	/* Lower direction change guard time to 32 USART bits */ | ||
|  | 	XPROGTarget_SendByte(TPI_CMD_SSTCS(TPI_REG_CTRL)); | ||
|  | 	XPROGTarget_SendByte(0x02); | ||
|  | 
 | ||
|  | 	/* Enable access to the XPROG NVM bus by sending the documented NVM access key to the device */ | ||
|  | 	XPROGTarget_SendByte(TPI_CMD_SKEY); | ||
|  | 	for (uint8_t i = sizeof(TPI_NVMENABLE_KEY); i > 0; i--) | ||
|  | 	  XPROGTarget_SendByte(TPI_NVMENABLE_KEY[i - 1]); | ||
|  | 
 | ||
|  | 	/* Wait until the NVM bus becomes active */ | ||
|  | 	return TINYNVM_WaitWhileNVMBusBusy(); | ||
|  | } | ||
|  | 
 | ||
|  | /** Removes access to the target's NVM controller and physically disables the target's physical TPI interface. */ | ||
|  | void TINYNVM_DisableTPI(void) | ||
|  | { | ||
|  | 	TINYNVM_WaitWhileNVMBusBusy(); | ||
|  | 
 | ||
|  | 	do | ||
|  | 	{ | ||
|  | 		/* Clear the NVMEN bit in the TPI STATUS register to disable TPI mode */ | ||
|  | 		XPROGTarget_SendByte(TPI_CMD_SSTCS(TPI_REG_STATUS)); | ||
|  | 		XPROGTarget_SendByte(0x00); | ||
|  | 
 | ||
|  | 		/* Read back the STATUS register, check to see if it took effect */ | ||
|  | 		XPROGTarget_SendByte(TPI_CMD_SLDCS(TPI_REG_STATUS)); | ||
|  | 	} while (XPROGTarget_ReceiveByte() != 0x00); | ||
|  | 
 | ||
|  | 	XPROGTarget_DisableTargetTPI(); | ||
|  | } | ||
|  | 
 | ||
|  | /** 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     Length of the data to read from the device | ||
|  |  * | ||
|  |  *  \return Boolean \c true if the command sequence complete successfully | ||
|  |  */ | ||
|  | bool TINYNVM_ReadMemory(const uint16_t ReadAddress, | ||
|  |                         uint8_t* ReadBuffer, | ||
|  |                         uint16_t ReadSize) | ||
|  | { | ||
|  | 	/* Wait until the NVM controller is no longer busy */ | ||
|  | 	if (!(TINYNVM_WaitWhileNVMControllerBusy())) | ||
|  | 	  return false; | ||
|  | 
 | ||
|  | 	/* Set the NVM control register to the NO OP command for memory reading */ | ||
|  | 	TINYNVM_SendWriteNVMRegister(XPROG_Param_NVMCMDRegAddr); | ||
|  | 	XPROGTarget_SendByte(TINY_NVM_CMD_NOOP); | ||
|  | 
 | ||
|  | 	/* Send the address of the location to read from */ | ||
|  | 	TINYNVM_SendPointerAddress(ReadAddress); | ||
|  | 
 | ||
|  | 	while (ReadSize-- && TimeoutTicksRemaining) | ||
|  | 	{ | ||
|  | 		/* Read the byte of data from the target */ | ||
|  | 		XPROGTarget_SendByte(TPI_CMD_SLD(TPI_POINTER_INDIRECT_PI)); | ||
|  | 		*(ReadBuffer++) = XPROGTarget_ReceiveByte(); | ||
|  | 	} | ||
|  | 
 | ||
|  | 	return (TimeoutTicksRemaining > 0); | ||
|  | } | ||
|  | 
 | ||
|  | /** Writes word addressed memory to the target's memory spaces.
 | ||
|  |  * | ||
|  |  *  \param[in] WriteAddress  Start address to write to within the target's address space | ||
|  |  *  \param[in] WriteBuffer   Buffer to source data from | ||
|  |  *  \param[in] WriteLength   Total number of bytes to write to the device (must be an integer multiple of 2) | ||
|  |  * | ||
|  |  *  \return Boolean \c true if the command sequence complete successfully | ||
|  |  */ | ||
|  | bool TINYNVM_WriteMemory(const uint16_t WriteAddress, | ||
|  |                          uint8_t* WriteBuffer, | ||
|  |                          uint16_t WriteLength) | ||
|  | { | ||
|  | 	/* Wait until the NVM controller is no longer busy */ | ||
|  | 	if (!(TINYNVM_WaitWhileNVMControllerBusy())) | ||
|  | 	  return false; | ||
|  | 
 | ||
|  | 	/* Must have an integer number of words to write - if extra byte, word-align via a dummy high byte */ | ||
|  | 	if (WriteLength & 0x01) | ||
|  | 	  WriteBuffer[WriteLength++] = 0xFF; | ||
|  | 
 | ||
|  | 	/* Set the NVM control register to the WORD WRITE command for memory writing */ | ||
|  | 	TINYNVM_SendWriteNVMRegister(XPROG_Param_NVMCMDRegAddr); | ||
|  | 	XPROGTarget_SendByte(TINY_NVM_CMD_WORDWRITE); | ||
|  | 
 | ||
|  | 	/* Send the address of the location to write to */ | ||
|  | 	TINYNVM_SendPointerAddress(WriteAddress); | ||
|  | 
 | ||
|  | 	while (WriteLength) | ||
|  | 	{ | ||
|  | 		/* Wait until the NVM controller is no longer busy */ | ||
|  | 		if (!(TINYNVM_WaitWhileNVMControllerBusy())) | ||
|  | 		  return false; | ||
|  | 
 | ||
|  | 		/* Write the low byte of data to the target */ | ||
|  | 		XPROGTarget_SendByte(TPI_CMD_SST(TPI_POINTER_INDIRECT_PI)); | ||
|  | 		XPROGTarget_SendByte(*(WriteBuffer++)); | ||
|  | 
 | ||
|  | 		/* Write the high byte of data to the target */ | ||
|  | 		XPROGTarget_SendByte(TPI_CMD_SST(TPI_POINTER_INDIRECT_PI)); | ||
|  | 		XPROGTarget_SendByte(*(WriteBuffer++)); | ||
|  | 
 | ||
|  | 		/* Need to decrement the write length twice, since we wrote a whole two-byte word */ | ||
|  | 		WriteLength -= 2; | ||
|  | 	} | ||
|  | 
 | ||
|  | 	return true; | ||
|  | } | ||
|  | 
 | ||
|  | /** Erases the target's memory space.
 | ||
|  |  * | ||
|  |  *  \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 TINYNVM_EraseMemory(const uint8_t EraseCommand, | ||
|  |                          const uint16_t Address) | ||
|  | { | ||
|  | 	/* Wait until the NVM controller is no longer busy */ | ||
|  | 	if (!(TINYNVM_WaitWhileNVMControllerBusy())) | ||
|  | 	  return false; | ||
|  | 
 | ||
|  | 	/* Set the NVM control register to the target memory erase command */ | ||
|  | 	TINYNVM_SendWriteNVMRegister(XPROG_Param_NVMCMDRegAddr); | ||
|  | 	XPROGTarget_SendByte(EraseCommand); | ||
|  | 
 | ||
|  | 	/* Write to a high byte location within the target address space to start the erase process */ | ||
|  | 	TINYNVM_SendPointerAddress(Address | 0x0001); | ||
|  | 	XPROGTarget_SendByte(TPI_CMD_SST(TPI_POINTER_INDIRECT)); | ||
|  | 	XPROGTarget_SendByte(0x00); | ||
|  | 
 | ||
|  | 	/* Wait until the NVM controller is no longer busy */ | ||
|  | 	if (!(TINYNVM_WaitWhileNVMControllerBusy())) | ||
|  | 	  return false; | ||
|  | 
 | ||
|  | 	return true; | ||
|  | } | ||
|  | 
 | ||
|  | #endif
 | ||
|  | 
 |