Add STM32L4 fal_flash port

This commit is contained in:
Alexey Belyaev 2022-08-19 16:35:03 +06:00
parent 6204074c9d
commit 93eaf6a522
1 changed files with 145 additions and 0 deletions

View File

@ -0,0 +1,145 @@
/*
* Copyright (c) 2022, Spider, <spider@spider.vc>
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <string.h>
#include <fal.h>
#include <stm32l4xx.h>
static int init(void)
{
/* do nothing now */
return 1;
}
static int ef_err_port_cnt = 0;
int on_ic_read_cnt = 0;
int on_ic_write_cnt = 0;
void feed_dog(void)
{
}
static int read(long offset, uint8_t *buf, size_t size)
{
size_t i;
uint32_t addr = stm32_onchip_flash.addr + offset;
if( addr%4 != 0)
ef_err_port_cnt++;
for (i = 0; i < size; i++, addr++, buf++)
{
*buf = *(uint8_t *) addr;
}
on_ic_read_cnt++;
return size;
}
static int write(long offset, const uint8_t *buf, size_t size)
{
size_t i;
uint32_t addr = stm32_onchip_flash.addr + offset;
__ALIGN_BEGIN uint64_t write_data __ALIGN_END;
__ALIGN_BEGIN uint64_t read_data __ALIGN_END;
if(addr%4 != 0)
ef_err_port_cnt++;
/*
if((int)buf%8 != 0)
ef_err_port_cnt++;
*/
HAL_FLASH_Unlock();
for (i = 0; i < size; i += 8, buf+=8, addr += 8) {
memcpy(&write_data, buf, 8); //The third parameter used to ensure HAL_FLASH_Program is the alignment of the first address in memory
if (write_data != 0xFFFFFFFFFFFFFFFF)
HAL_FLASH_Program(FLASH_TYPEPROGRAM_DOUBLEWORD, addr, write_data);
read_data = *(uint64_t *)addr;
/* You can add your code under here. */
if (read_data != write_data) {
HAL_FLASH_Lock();
return -1;
}
else{
//FLash操作可能非常耗时如果有看门狗需要喂狗以下代码由用户实现
feed_dog();
}
}
HAL_FLASH_Lock();
on_ic_write_cnt++;
return size;
}
static int erase(long offset, size_t size)
{
// uint32_t addr = stm32_onchip_flash.addr + offset;
HAL_StatusTypeDef flash_status;
size_t erase_pages, i;
uint32_t PAGEError = 0;
erase_pages = size / FLASH_PAGE_SIZE;
if (size % FLASH_PAGE_SIZE != 0) {
erase_pages++;
}
FLASH_EraseInitTypeDef EraseInitStruct;
EraseInitStruct.TypeErase = FLASH_TYPEERASE_PAGES;
EraseInitStruct.NbPages = 1; //Wipe out one sector at a time to perform one feeding of the dog to prevent timeout
HAL_FLASH_Unlock();
for (i = 0; i < erase_pages; i++) {
EraseInitStruct.Page = (offset/FLASH_PAGE_SIZE) + i;
flash_status = HAL_FLASHEx_Erase(&EraseInitStruct, &PAGEError);
if (flash_status != HAL_OK) {
HAL_FLASH_Lock();
return -1;
}
else{
//FLash operation can be very time-consuming, if there is a watchdog that needs to feed the dog, the following code is implemented by the user
feed_dog();
}
}
HAL_FLASH_Lock();
return size;
}
/*
"stm32_onchip" : Flash
0x08000000: Flash
1024*1024Flash 1MB
128*1024Flash / STM32F2 128K
{init, read, write, erase} Flash init
8 : bit 0 0 fal 0.4.0 flash Flash
nor flash: 1 bit
stm32f2/f4: 8 bit
stm32f1: 32 bit
stm32l4: 64 bit
*/
//1.定义 flash 设备
const struct fal_flash_dev stm32_onchip_flash =
{
.name = "stm32_onchip",
.addr = 0x08000000,
.len = 256*1024,
.blk_size = FLASH_PAGE_SIZE,
.ops = {init, read, write, erase},
.write_gran = 64
};