初始版本
This commit is contained in:
@@ -0,0 +1,144 @@
|
||||
#include "dev_boot.h"
|
||||
|
||||
static uint32_t pdwCrc32Tbl[256]={0};
|
||||
|
||||
static void InitCrc32Table(void)
|
||||
{
|
||||
for (int wCnt = 0; wCnt != 256; wCnt++)
|
||||
{
|
||||
uint32_t dwCrc = wCnt;
|
||||
|
||||
for (int ucCnt = 0; ucCnt != 8; ucCnt++)
|
||||
{
|
||||
if (dwCrc & 1)
|
||||
{
|
||||
dwCrc = (dwCrc >> 1) ^ 0xEDB88320;
|
||||
}
|
||||
else
|
||||
{
|
||||
dwCrc >>= 1;
|
||||
}
|
||||
}
|
||||
|
||||
pdwCrc32Tbl[wCnt] = dwCrc;
|
||||
}
|
||||
}
|
||||
|
||||
void dev_boot_read_param(boot_para_t *pParam)
|
||||
{
|
||||
hdl_flash_read_data(FLASH_BINFO_BASE,(uint8_t *)pParam,sizeof(boot_para_t));
|
||||
}
|
||||
|
||||
int dev_boot_write_param(boot_para_t Param)
|
||||
{
|
||||
int res = LL_OK;
|
||||
|
||||
int wLen;
|
||||
uint32_t *pData;
|
||||
|
||||
pData= (uint32_t *)&Param;
|
||||
|
||||
wLen = sizeof(boot_para_t);
|
||||
|
||||
hdl_flash_unlock();
|
||||
/* Erase sector. */
|
||||
res = hdl_flash_erase_sector(FLASH_BINFO_BASE,FLASH_BINFO_SIZE);
|
||||
|
||||
if(res == LL_OK){
|
||||
|
||||
res = hdl_flash_write_data (FLASH_BINFO_BASE, (uint8_t *)pData, wLen);
|
||||
}
|
||||
|
||||
hdl_flash_lock();
|
||||
|
||||
return res;
|
||||
}
|
||||
|
||||
|
||||
void dev_boot_erase_app(void)
|
||||
{
|
||||
hdl_flash_unlock();
|
||||
|
||||
for(int Addr = FLASH_APP_BASE; Addr < FLASH_APP_SIZE; Addr += FLASH_SECTOR_SIZE) {
|
||||
|
||||
EFM_SectorErase(Addr);
|
||||
|
||||
SWDT_FeedDog();
|
||||
|
||||
}
|
||||
/* Lock EFM. */
|
||||
hdl_flash_lock();
|
||||
}
|
||||
|
||||
void dev_boot_write_app(uint32_t AddrOffset, uint8_t* wData, int wLen)
|
||||
{
|
||||
hdl_flash_unlock();
|
||||
|
||||
hdl_flash_write_data (FLASH_APP_BASE + AddrOffset, (uint8_t *)wData, wLen);
|
||||
|
||||
hdl_flash_lock();
|
||||
}
|
||||
|
||||
|
||||
uint8_t dev_boot_check_app(void)
|
||||
{
|
||||
uint32_t AppAddr =FLASH_APP_BASE;
|
||||
|
||||
uint32_t u32StackTop = *((__IO uint32_t*)AppAddr);
|
||||
|
||||
if ((u32StackTop > SRAM_BASE) && (u32StackTop <= (SRAM_BASE + SRAM_SIZE)))
|
||||
{
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
void dev_boot_run_app(void)
|
||||
{
|
||||
volatile uint32_t JumpAddress;
|
||||
|
||||
func_ptr_t JumpToApplication;
|
||||
|
||||
uint32_t AppAddr =FLASH_APP_BASE;
|
||||
|
||||
uint32_t u32StackTop = *((__IO uint32_t*)AppAddr);
|
||||
|
||||
if ((u32StackTop > SRAM_BASE) && (u32StackTop <= (SRAM_BASE + SRAM_SIZE)))
|
||||
{
|
||||
JumpAddress = *(__IO uint32_t*)(AppAddr + 4);
|
||||
|
||||
JumpToApplication = (func_ptr_t)JumpAddress;
|
||||
|
||||
__disable_fiq();
|
||||
|
||||
__set_MSP(*(__IO uint32_t*)AppAddr);
|
||||
|
||||
JumpToApplication();
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
uint32_t dev_boot_get_app_crc32(int dwLen)
|
||||
{
|
||||
if(dwLen >= 0xFFFFFFFF)
|
||||
return 0;
|
||||
|
||||
InitCrc32Table();
|
||||
|
||||
uint32_t Data;
|
||||
uint32_t dwCrc32Data = 0xFFFFFFFF;
|
||||
|
||||
for (int dwCnt = 0; dwCnt != dwLen; ++dwCnt)
|
||||
{
|
||||
Data = *((volatile uint8_t*)(FLASH_APP_BASE + dwCnt));
|
||||
|
||||
uint32_t dwTbl = (dwCrc32Data ^ Data) & 0xFF;
|
||||
|
||||
dwCrc32Data = ((dwCrc32Data >> 8) & 0xFFFFFF) ^ pdwCrc32Tbl[dwTbl];
|
||||
}
|
||||
|
||||
return ~dwCrc32Data;
|
||||
}
|
||||
Reference in New Issue
Block a user