115 lines
2.8 KiB
C
115 lines
2.8 KiB
C
|
/*
|
||
|
|
* lfs util functions
|
||
|
|
*
|
||
|
|
* Copyright (c) 2017, Arm Limited. All rights reserved.
|
||
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
||
|
|
*/
|
||
|
|
#include "lfs_util.h"
|
||
|
|
#include "plat_config.h"
|
||
|
|
#ifdef FEATURE_BOOTLOADER_PROJECT_ENABLE
|
||
|
|
#include "common.h"
|
||
|
|
#else
|
||
|
|
#include DEBUG_LOG_HEADER_FILE
|
||
|
|
#endif
|
||
|
|
|
||
|
|
|
||
|
|
// Only compile if user does not provide custom config
|
||
|
|
#ifndef LFS_CONFIG
|
||
|
|
|
||
|
|
#if defined CHIP_EC618 || defined CHIP_EC618_Z0
|
||
|
|
uint8_t BSP_QSPI_SWReset(void);
|
||
|
|
uint8_t BSP_QSPI_XIP_Mode_Disable(void);
|
||
|
|
uint8_t BSP_QSPI_XIP_Mode_Enable(void);
|
||
|
|
#else
|
||
|
|
extern void FLASH_clrStatus( void );
|
||
|
|
#endif
|
||
|
|
|
||
|
|
|
||
|
|
AP_PLAT_COMMON_BSS static uint32_t gLFSAssertFlag = 0;
|
||
|
|
|
||
|
|
// Software CRC implementation with small lookup table
|
||
|
|
uint32_t lfs_crc(uint32_t crc, const void *buffer, size_t size) {
|
||
|
|
static uint32_t rtable[16] = {
|
||
|
|
0x00000000, 0x1db71064, 0x3b6e20c8, 0x26d930ac,
|
||
|
|
0x76dc4190, 0x6b6b51f4, 0x4db26158, 0x5005713c,
|
||
|
|
0xedb88320, 0xf00f9344, 0xd6d6a3e8, 0xcb61b38c,
|
||
|
|
0x9b64c2b0, 0x86d3d2d4, 0xa00ae278, 0xbdbdf21c,
|
||
|
|
};
|
||
|
|
|
||
|
|
#if 0
|
||
|
|
const uint8_t *data = buffer;
|
||
|
|
|
||
|
|
for (size_t i = 0; i < size; i++) {
|
||
|
|
crc = (crc >> 4) ^ rtable[(crc ^ (data[i] >> 0)) & 0xf];
|
||
|
|
crc = (crc >> 4) ^ rtable[(crc ^ (data[i] >> 4)) & 0xf];
|
||
|
|
}
|
||
|
|
|
||
|
|
#else
|
||
|
|
|
||
|
|
uint32_t *data_32 = (uint32_t*)buffer;
|
||
|
|
|
||
|
|
for(size_t i = 0; i < (size >> 2); i++, data_32++)
|
||
|
|
{
|
||
|
|
uint32_t aWord = *data_32;
|
||
|
|
|
||
|
|
for(size_t j = 0; j < 4; j++)
|
||
|
|
{
|
||
|
|
crc = (crc >> 4) ^ rtable[(crc ^ ((aWord & 0xff) >> 0)) & 0xf];
|
||
|
|
crc = (crc >> 4) ^ rtable[(crc ^ ((aWord & 0xff) >> 4)) & 0xf];
|
||
|
|
aWord >>= 8;
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|
||
|
|
const uint8_t* data_8 = (uint8_t*)data_32;
|
||
|
|
|
||
|
|
for (size_t i = 0; i < (size & 0x3); i++)
|
||
|
|
{
|
||
|
|
crc = (crc >> 4) ^ rtable[(crc ^ (data_8[i] >> 0)) & 0xf];
|
||
|
|
crc = (crc >> 4) ^ rtable[(crc ^ (data_8[i] >> 4)) & 0xf];
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif
|
||
|
|
return crc;
|
||
|
|
}
|
||
|
|
|
||
|
|
void lfs_setAssertFlag(uint32_t flag)
|
||
|
|
{
|
||
|
|
gLFSAssertFlag |= flag;
|
||
|
|
}
|
||
|
|
#ifndef LFS_NO_ASSERT
|
||
|
|
void lfs_assert(bool test)
|
||
|
|
{
|
||
|
|
if(test == 0)
|
||
|
|
{
|
||
|
|
// shall be atomic op below
|
||
|
|
__disable_irq();
|
||
|
|
|
||
|
|
if (gLFSAssertFlag & EC_FS_ASSERT_FLASH_RESET_FLAG)
|
||
|
|
{
|
||
|
|
#if defined CHIP_EC618 || defined CHIP_EC618_Z0
|
||
|
|
BSP_QSPI_XIP_Mode_Disable();
|
||
|
|
BSP_QSPI_SWReset();
|
||
|
|
BSP_QSPI_XIP_Mode_Enable();
|
||
|
|
#else
|
||
|
|
FLASH_clrStatus();
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
uint32_t excepFsAssertCount = BSP_GetFSAssertCount();
|
||
|
|
BSP_SetFSAssertCount(++excepFsAssertCount);
|
||
|
|
|
||
|
|
ECPLAT_PRINTF(UNILOG_LFS, lfs_assert_0, P_ERROR, "lfs assert count:%d", excepFsAssertCount);
|
||
|
|
|
||
|
|
if(excepFsAssertCount && ((excepFsAssertCount % EC_FS_ASSERT_REFORMAT_THRESHOLD) == 0))
|
||
|
|
{
|
||
|
|
ECPLAT_PRINTF(UNILOG_LFS, lfs_assert_1, P_ERROR, "!!!File System and Plat config will be clear!!!");
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
EC_ASSERT(0, 0, 0, 0);
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|
||
|
|
#endif/*LFS_NO_ASSERT*/
|
||
|
|
#endif
|