S32K144 bootload

/************************************************************************ (c) Copyright 2013-205 Freescale Semiconductor, Inc. ALL RIGHTS RESERVED. Redistribution and use in source and binary forms, with or without modification, are permitted provided that the following conditions are met: * Redistributions of source code must retain the above copyright notice, this list of conditions and the following disclaimer. * Redistributions in binary form must reproduce the above copyright notice, this list of conditions and the following disclaimer in the documentation and/or other materials provided with the distribution. * Neither the name of the <organization> nor the names of its contributors may be used to endorse or promote products derived from this software without specific prior written permission. THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL <COPYRIGHT HOLDER> BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. *******************************************************************************/ /* include the header files */ #include "fsl_flash_driver_c90tfs.h" /*! * @addtogroup c90tfs_flash_driver * @{ */ #define __relocate_code__ __attribute__((section(".relocate_code"), long_call)) /*! * @name C90TFS Flash driver APIs * @{ */ //flash_drv_status_t FlashCommandSequence (PFLASH_SSD_CONFIG pSSDConfig) __relocate_code__; /*---------------- Function Prototypes for Flash SSD --------------------*/ /*! * @brief Relocates a function to RAM address. * * This function provides a facility to relocate a function in RAM. * * @param dest: Destination address where you want to place the function. * @param size: Size of the function * @param src: Address of the function will be relocated * @return Relocated address of the function . */ uint32 RelocateFunction(uint32 dest, uint32 size, uint32 src) { uint32 temp; uint16 value, i, *pSrc, *pDest; temp = PGM2DATA((uint32)src - LAUNCH_COMMAND_OFFSET); pSrc = (uint16 *)temp; pDest = (uint16 *)dest; temp = size >>1; for (i = 0x0U; i < temp; i++) { value = *(uint16 *)(pSrc); pSrc++; *(uint16 *)(pDest) = value; pDest++; } return ((uint32)DATA2PGM((uint32)dest + LAUNCH_COMMAND_OFFSET)); //return dest; } /*! * @brief Initializes Flash. * * This API initializes Flash module by clearing status error * bit and reporting the memory configuration via SSD configuration structure. * * @param pSSDConfig: The SSD configuration structure pointer. * @param pFlashCommandSequence : Pointer to the Flash command sequence function. * @return Successful completion (FTFx_OK) */ flash_drv_status_t FlashInit (PFLASH_SSD_CONFIG pSSDConfig, pFLASHCOMMANDSEQUENCE pFlashCommandSequence) { #if FSL_FEATURE_FLASH_HAS_FLEX_NVM uint8 EEEDataSetSize; /* store EEE Data Set Size */ uint8 DEPartitionCode; /* store D/E-Flash Partition Code */ flash_drv_status_t ret; /* temporary variable */ /* clear RDCOLERR & ACCERR & FPVIOL flag in flash status register. Write 1 to clear*/ CLEAR_FTFx_FSTAT_ERROR_BITS; /* Write Command Code to FCCOB0 */ FTFx_FCCOB0 = FTFx_READ_RESOURCE; /* Write address to FCCOB1/2/3 */ FTFx_FCCOB1 = GET_BIT_16_23(DFLASH_IFR_READRESOURCE_ADDRESS); //0x8003F8U FTFx_FCCOB2 = GET_BIT_8_15(DFLASH_IFR_READRESOURCE_ADDRESS); FTFx_FCCOB3 = GET_BIT_0_7(DFLASH_IFR_READRESOURCE_ADDRESS); /* Write Resource Select Code of 0 to FCCOB8 to select IFR. Without this, */ /* an access error may occur if the register contains data from a previous command. */ /* for FTFE module, resource code is FCCOB4. For others, resource code is FCCOB8 */ FTFx_RSRC_CODE_REG = 0; ret = pFlashCommandSequence(pSSDConfig); /* read out EEdata set size and DEpartition code from FCCOBA, FCCOBB for FTFE module, from FCCOB6 and FCCOB7 for others */ #ifdef FTFE EEEDataSetSize = FTFx_FCCOBA; DEPartitionCode = FTFx_FCCOBB; #else EEEDataSetSize = FTFx_FCCOB6; DEPartitionCode = FTFx_FCCOB7; #endif DEPartitionCode = DEPartitionCode & 0x0FU; EEEDataSetSize = EEEDataSetSize & 0x0FU; /* Calculate D-Flash size and EEE size */ if (0x0U == DEPartitionCode) {pSSDConfig->DFlashSize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_DFLASH_SIZE_FOR_DEPART_0000;} else if (0x01U == DEPartitionCode) {pSSDConfig->DFlashSize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_DFLASH_SIZE_FOR_DEPART_0001;} else if (0x02U == DEPartitionCode) {pSSDConfig->DFlashSize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_DFLASH_SIZE_FOR_DEPART_0010;} else if (0x03U == DEPartitionCode) {pSSDConfig->DFlashSize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_DFLASH_SIZE_FOR_DEPART_0011;} else if (0x04U == DEPartitionCode) {pSSDConfig->DFlashSize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_DFLASH_SIZE_FOR_DEPART_0100;} else if (0x05U == DEPartitionCode) {pSSDConfig->DFlashSize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_DFLASH_SIZE_FOR_DEPART_0101;} else if (0x06U == DEPartitionCode) {pSSDConfig->DFlashSize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_DFLASH_SIZE_FOR_DEPART_0110;} else if (0x07U == DEPartitionCode) {pSSDConfig->DFlashSize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_DFLASH_SIZE_FOR_DEPART_0111;} else if (0x08U == DEPartitionCode) {pSSDConfig->DFlashSize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_DFLASH_SIZE_FOR_DEPART_1000;} else if (0x09U == DEPartitionCode) {pSSDConfig->DFlashSize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_DFLASH_SIZE_FOR_DEPART_1001;} else if (0x0AU == DEPartitionCode) {pSSDConfig->DFlashSize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_DFLASH_SIZE_FOR_DEPART_1010;} else if (0x0BU == DEPartitionCode) {pSSDConfig->DFlashSize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_DFLASH_SIZE_FOR_DEPART_1011;} else if (0x0CU == DEPartitionCode) {pSSDConfig->DFlashSize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_DFLASH_SIZE_FOR_DEPART_1100;} else if (0x0DU == DEPartitionCode) {pSSDConfig->DFlashSize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_DFLASH_SIZE_FOR_DEPART_1101;} else if (0x0EU == DEPartitionCode) {pSSDConfig->DFlashSize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_DFLASH_SIZE_FOR_DEPART_1110;} else if (0x0FU == DEPartitionCode) {pSSDConfig->DFlashSize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_DFLASH_SIZE_FOR_DEPART_1111;} else {/* Undefined value */} if (0x0U == EEEDataSetSize) {pSSDConfig->EEESize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_EEPROM_SIZE_FOR_EEESIZE_0000;} else if (0x01U == EEEDataSetSize) {pSSDConfig->EEESize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_EEPROM_SIZE_FOR_EEESIZE_0001;} else if (0x02U == EEEDataSetSize) {pSSDConfig->EEESize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_EEPROM_SIZE_FOR_EEESIZE_0010;} else if (0x03U == EEEDataSetSize) {pSSDConfig->EEESize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_EEPROM_SIZE_FOR_EEESIZE_0011;} else if (0x04U == EEEDataSetSize) {pSSDConfig->EEESize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_EEPROM_SIZE_FOR_EEESIZE_0100;} else if (0x05U == EEEDataSetSize) {pSSDConfig->EEESize = (uint32)FSL_FEATURE_FLASH_FLEX_NVM_EEPROM_SIZE_FOR_EEESIZE_0101;} else if (0x06U == EEEDataSetSize) {pSSDConfig->EEESize = (uint32)FS