LiJie/MXC_A39_20240320
11
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

800*320工程文件+初始demo提交

Browse Source
This commit is contained in:
Li Jie
2024-03-07 16:46:43 +08:00
parent 33e6eb45b3
commit 70ec3005bb
3306 changed files with 3374364 additions and 2563 deletions
Download Patch File Download Diff File Expand all files Collapse all files

211
SW/components/modules/dsp/dsp.c Normal file
View File

@ -0,0 +1,211 @@
#include <stdint.h>
#include <stdbool.h>
#include "fr30xx.h"
#include "dsp.h"
#include "FreeRTOS.h"
#include "ff.h"
#define LOAD_CODE_FRAME_SIZE_FROM_FS 512
#define LOAD_CODE_FRAME_SIZE_FROM_FLASH 256
bool dsp_load_code_from_fs(char *path)
{
struct bin_header {
uint32_t start;
uint32_t length;
} header;
FRESULT res;
FIL fstt;
uint32_t length;
uint32_t *ptr;
uint32_t *buffer, *_buffer;
bool ret = true;
res=f_open(&fstt, path, FA_OPEN_EXISTING | FA_READ);
if ( res != FR_OK ) {
return false;
}
else {
buffer = (void *)pvPortMalloc(LOAD_CODE_FRAME_SIZE_FROM_FS);
/* get text section storage information */
f_read(&fstt, (void *)&header, sizeof(struct bin_header), &length);
if (length != sizeof(struct bin_header)) {
goto error;
}
/* read text section storage into IRAM */
ptr = (void *)DSP_IRAM_2_MCU_SRAM(header.start);
while (header.length) {
uint32_t _length;
length = header.length > LOAD_CODE_FRAME_SIZE_FROM_FS ? LOAD_CODE_FRAME_SIZE_FROM_FS : header.length;
_buffer = buffer;
f_read(&fstt, (void *)_buffer, length, &_length);
if (length != _length) {
ret = false;
goto error;
}
while (_length) {
*ptr++ = *_buffer++;
_length -= 4;
}
header.length -= length;
}
/* get RO and RW section storage information */
f_read(&fstt, (void *)&header, sizeof(struct bin_header), &length);
if (length != sizeof(struct bin_header)) {
ret = false;
goto error;
}
/* read text section storage into DRAM */
ptr = (void *)DSP_DRAM_2_MCU_SRAM(header.start);
while (header.length) {
uint32_t _length;
length = header.length > LOAD_CODE_FRAME_SIZE_FROM_FS ? LOAD_CODE_FRAME_SIZE_FROM_FS : header.length;
_buffer = buffer;
f_read(&fstt, (void *)_buffer, length, &_length);
if (length != _length) {
ret = false;
goto error;
}
while (_length) {
*ptr++ = *_buffer++;
_length -= 4;
}
header.length -= length;
}
}
error:
vPortFree(buffer);
f_close(&fstt);
return ret;
}
bool dsp_load_code_from_internal_flash(uint32_t address, uint32_t length)
{
struct bin_header {
uint32_t start;
uint32_t length;
} header;
uint32_t sub_length, _sub_length;
uint32_t *ptr;
uint32_t *buffer, *_buffer;
bool ret = true;
buffer = (void *)pvPortMalloc(LOAD_CODE_FRAME_SIZE_FROM_FLASH);
/* get text section storage information */
flash_read(QSPI0, address, sizeof(struct bin_header), (void *)&header);
address += sizeof(struct bin_header);
/* read text section storage into IRAM */
ptr = (void *)DSP_IRAM_2_MCU_SRAM(header.start);
while (header.length) {
sub_length = header.length > LOAD_CODE_FRAME_SIZE_FROM_FLASH ? LOAD_CODE_FRAME_SIZE_FROM_FLASH : header.length;
_sub_length = sub_length;
_buffer = buffer;
flash_read(QSPI0, address, sub_length, (void *)_buffer);
while (sub_length) {
*ptr++ = *_buffer++;
sub_length -= 4;
}
header.length -= _sub_length;
address += _sub_length;
}
/* get RO and RW section storage information */
flash_read(QSPI0, address, sizeof(struct bin_header), (void *)&header);
address += sizeof(struct bin_header);
/* read text section storage into DRAM */
ptr = (void *)DSP_DRAM_2_MCU_SRAM(header.start);
while (header.length) {
sub_length = header.length > LOAD_CODE_FRAME_SIZE_FROM_FLASH ? LOAD_CODE_FRAME_SIZE_FROM_FLASH : header.length;
_sub_length = sub_length;
_buffer = buffer;
flash_read(QSPI0, address, sub_length, (void *)_buffer);
while (sub_length) {
*ptr++ = *_buffer++;
sub_length -= 4;
}
header.length -= _sub_length;
address += _sub_length;
}
error:
vPortFree(buffer);
return ret;
}
bool dsp_load_rw_from_internal_flash(uint32_t address, uint32_t length)
{
struct bin_header {
uint32_t start;
uint32_t length;
} header;
uint32_t sub_length, _sub_length;
uint32_t *ptr;
uint32_t *buffer, *_buffer;
bool ret = true;
buffer = (void *)pvPortMalloc(LOAD_CODE_FRAME_SIZE_FROM_FLASH);
/* get text section storage information */
flash_read(QSPI0, address, sizeof(struct bin_header), (void *)&header);
address += sizeof(struct bin_header);
/* jump to RW header */
address += header.length;
/* get RO and RW section storage information */
flash_read(QSPI0, address, sizeof(struct bin_header), (void *)&header);
address += sizeof(struct bin_header);
/* read text section storage into DRAM */
ptr = (void *)DSP_DRAM_2_MCU_SRAM(header.start);
while (header.length) {
sub_length = header.length > LOAD_CODE_FRAME_SIZE_FROM_FLASH ? LOAD_CODE_FRAME_SIZE_FROM_FLASH : header.length;
_sub_length = sub_length;
_buffer = buffer;
flash_read(QSPI0, address, sub_length, (void *)_buffer);
while (sub_length) {
*ptr++ = *_buffer++;
sub_length -= 4;
}
header.length -= _sub_length;
address += _sub_length;
}
error:
vPortFree(buffer);
return ret;
}
/* release DSP clock and keep DSP in suspend mode */
void dsp_prepare(void)
{
*(volatile uint32_t *)&SYSTEM->DSPClockEnable = 0xffffffff;
SYSTEM->DSPCTRL.DSP_RUNSTALL = 1;
}
void dsp_run(uint32_t vector)
{
SYSTEM->DSPVectorConfig.DSP_VEC_TBL = vector;
SYSTEM->DSPVectorConfig.DSP_VEC_SEL = 1;
SYSTEM->DSPCTRL.DSP_DBGEN = 1;
SYSTEM->DSPCTRL.DSP_NIDEN = 1;
SYSTEM->DSPCTRL.DSP_SPIDEN = 1;
SYSTEM->DSPCTRL.DSP_RUNSTALL = 0;
}