refactor(h7): generic system init (#6172)
This commit is contained in:
@@ -0,0 +1,290 @@
|
||||
/*
|
||||
* Copyright (C) EdgeTX
|
||||
*
|
||||
* Based on code named
|
||||
* opentx - https://github.com/opentx/opentx
|
||||
* th9x - http://code.google.com/p/th9x
|
||||
* er9x - http://code.google.com/p/er9x
|
||||
* gruvin9x - http://code.google.com/p/gruvin9x
|
||||
*
|
||||
* License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License version 2 as
|
||||
* published by the Free Software Foundation.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*/
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
#include "stm32_cmsis.h"
|
||||
#include "stm32_hal.h"
|
||||
|
||||
|
||||
#if ((defined (__ICACHE_PRESENT) && (__ICACHE_PRESENT == 1U)) || \
|
||||
(defined (__DCACHE_PRESENT) && (__DCACHE_PRESENT == 1U)))
|
||||
#define USE_CACHE
|
||||
#endif
|
||||
|
||||
#if (defined (USE_CACHE) && defined (__MPU_PRESENT) && (__MPU_PRESENT == 1U))
|
||||
#define REQUIRE_MPU_CONFIG
|
||||
#endif
|
||||
|
||||
#if defined(ITCM_BASE) /* H7RS */ || defined(D1_ITCMRAM_BASE) /* H7 */
|
||||
#define LOAD_FAST_CODE_RAM
|
||||
#endif
|
||||
|
||||
#define NAKED __attribute__((naked))
|
||||
#define BOOTSTRAP __attribute__((section(".bootstrap")))
|
||||
|
||||
// Linker script symbols
|
||||
extern uint32_t _sisr_vector;
|
||||
|
||||
NAKED BOOTSTRAP void Reset_Handler()
|
||||
{
|
||||
asm inline (
|
||||
"ldr sp, =_estack \n"
|
||||
);
|
||||
|
||||
#if defined(BOOT)
|
||||
asm inline (
|
||||
"bl SystemInit \n"
|
||||
"bl SystemClock_Config \n"
|
||||
);
|
||||
|
||||
#if defined(USE_CACHE)
|
||||
asm inline (
|
||||
"bl CPU_CACHE_Enable \n"
|
||||
);
|
||||
#endif // USE_CACHE
|
||||
#endif // BOOT
|
||||
|
||||
// Copy code into RAM
|
||||
asm inline (
|
||||
"ldr r0, =_stext \n"
|
||||
"ldr r1, =_etext \n"
|
||||
"ldr r2, =_text_load \n"
|
||||
"bl naked_copy \n"
|
||||
);
|
||||
|
||||
#if defined(BOOT) && defined(REQUIRE_MPU_CONFIG)
|
||||
asm inline (
|
||||
"bl MPU_Config \n"
|
||||
);
|
||||
#endif
|
||||
|
||||
// Copy / setup ISR vector
|
||||
asm inline (
|
||||
"ldr r0, =_sisr_vector \n"
|
||||
"ldr r1, =_eisr_vector \n"
|
||||
"ldr r2, =_isr_load \n"
|
||||
"bl naked_copy \n"
|
||||
"bl set_vtor \n"
|
||||
);
|
||||
|
||||
#if defined(LOAD_FAST_CODE_RAM)
|
||||
// Copy code into fast RAM
|
||||
asm inline (
|
||||
"ldr r0, =_siram \n"
|
||||
"ldr r1, =_eiram \n"
|
||||
"ldr r2, =_stext_iram \n"
|
||||
"bl naked_copy \n"
|
||||
);
|
||||
#endif
|
||||
|
||||
// Copy initialized data segment
|
||||
asm inline (
|
||||
"ldr r0, =_sdata \n"
|
||||
"ldr r1, =_edata \n"
|
||||
"ldr r2, =_sidata \n"
|
||||
"bl naked_copy \n"
|
||||
);
|
||||
|
||||
// Execute early hooks
|
||||
asm inline (
|
||||
"bl init_hooks \n"
|
||||
);
|
||||
|
||||
// Zero fill bss segment
|
||||
asm inline (
|
||||
"ldr r2, =_sbss \n"
|
||||
"ldr r4, =_ebss \n"
|
||||
"movs r3, 0 \n"
|
||||
"b LoopFillZerobss \n"
|
||||
|
||||
"FillZerobss: \n"
|
||||
"str r3, [r2] \n"
|
||||
"adds r2, r2, 4 \n"
|
||||
|
||||
"LoopFillZerobss: \n"
|
||||
"cmp r2, r4 \n"
|
||||
"bcc FillZerobss \n"
|
||||
);
|
||||
|
||||
#if defined(USE_CACHE)
|
||||
asm inline (
|
||||
"bl clean_dcache \n"
|
||||
);
|
||||
#endif
|
||||
|
||||
asm inline (
|
||||
// Call static constructors
|
||||
"bl __libc_init_array \n"
|
||||
// Update global clock speed variable
|
||||
"bl SystemCoreClockUpdate \n"
|
||||
// Call the application's entry point
|
||||
"bl main \n"
|
||||
"bx lr \n"
|
||||
);
|
||||
}
|
||||
|
||||
BOOTSTRAP void set_vtor() { SCB->VTOR = (intptr_t)&_sisr_vector; }
|
||||
|
||||
NAKED BOOTSTRAP void naked_copy()
|
||||
{
|
||||
// r0: destination start
|
||||
// r1: destination end
|
||||
// r2: source start
|
||||
asm inline (
|
||||
"cmp r0, r2 \n"
|
||||
"beq SkipCopy \n"
|
||||
"movs r3, 0 \n"
|
||||
"b LoopCopyInit \n"
|
||||
|
||||
"CopyInit: \n"
|
||||
"ldr r4, [r2, r3] \n"
|
||||
"str r4, [r0, r3] \n"
|
||||
"adds r3, r3, #4 \n"
|
||||
|
||||
"LoopCopyInit: \n"
|
||||
"adds r4, r0, r3 \n"
|
||||
"cmp r4, r1 \n"
|
||||
"bcc CopyInit \n"
|
||||
|
||||
"SkipCopy: \n"
|
||||
"bx lr \n"
|
||||
);
|
||||
}
|
||||
|
||||
void init_hooks()
|
||||
{
|
||||
extern uint32_t __init_hook_array_start;
|
||||
extern uint32_t __init_hook_array_end;
|
||||
|
||||
typedef void (*hook_fct_t)();
|
||||
|
||||
for (uint32_t hook = (uint32_t)&__init_hook_array_start;
|
||||
hook != (uint32_t)&__init_hook_array_end; hook += sizeof(void*)) {
|
||||
(*(hook_fct_t*)hook)();
|
||||
}
|
||||
}
|
||||
|
||||
#if defined(USE_CACHE)
|
||||
// SCB_CleanDCache() is "forced inline"
|
||||
void clean_dcache() { SCB_CleanDCache(); }
|
||||
|
||||
#if defined(BOOT)
|
||||
BOOTSTRAP void CPU_CACHE_Enable()
|
||||
{
|
||||
/* Enable I-Cache */
|
||||
SCB_EnableICache();
|
||||
|
||||
/* Enable D-Cache */
|
||||
SCB_EnableDCache();
|
||||
}
|
||||
#endif // BOOT
|
||||
#endif // USE_CACHE
|
||||
|
||||
#if defined(BOOT) && defined(REQUIRE_MPU_CONFIG)
|
||||
// Linker script symbols
|
||||
extern uint32_t _dram_addr;
|
||||
extern uint32_t EXTRAM_START;
|
||||
extern uint32_t EXTRAM_SIZE;
|
||||
extern uint32_t NORFLASH_START;
|
||||
extern uint32_t NORFLASH_SIZE;
|
||||
|
||||
__STATIC_FORCEINLINE uint32_t mpu_region_size(uint32_t size)
|
||||
{
|
||||
return 32 - __CLZ(size) - 1;
|
||||
}
|
||||
|
||||
void MPU_Config()
|
||||
{
|
||||
MPU_Region_InitTypeDef MPU_InitStruct = {0};
|
||||
|
||||
/* Disables the MPU */
|
||||
HAL_MPU_Disable();
|
||||
|
||||
/*
|
||||
* Region 0: overwrite default setting to prevent speculative
|
||||
* read to unavailable memories.
|
||||
* Range: 0x60000000 to 0xE0000000
|
||||
*
|
||||
* Set as strongly ordered, code execution disabled
|
||||
*/
|
||||
MPU_InitStruct.Enable = MPU_REGION_ENABLE;
|
||||
MPU_InitStruct.Number = MPU_REGION_NUMBER0;
|
||||
MPU_InitStruct.BaseAddress = 0;
|
||||
MPU_InitStruct.Size = MPU_REGION_SIZE_4GB;
|
||||
MPU_InitStruct.SubRegionDisable = 0x87;
|
||||
MPU_InitStruct.TypeExtField = MPU_TEX_LEVEL0;
|
||||
MPU_InitStruct.AccessPermission = MPU_REGION_NO_ACCESS;
|
||||
MPU_InitStruct.DisableExec = MPU_INSTRUCTION_ACCESS_DISABLE;
|
||||
MPU_InitStruct.IsShareable = MPU_ACCESS_SHAREABLE;
|
||||
MPU_InitStruct.IsCacheable = MPU_ACCESS_NOT_CACHEABLE;
|
||||
MPU_InitStruct.IsBufferable = MPU_ACCESS_NOT_BUFFERABLE;
|
||||
HAL_MPU_ConfigRegion(&MPU_InitStruct);
|
||||
|
||||
/* Region 2: QSPI memory range, bank1 */
|
||||
MPU_InitStruct.Enable = MPU_REGION_ENABLE;
|
||||
MPU_InitStruct.Number = MPU_REGION_NUMBER2;
|
||||
MPU_InitStruct.BaseAddress = (uint32_t)&NORFLASH_START;
|
||||
MPU_InitStruct.Size = mpu_region_size((uint32_t)&NORFLASH_SIZE);
|
||||
MPU_InitStruct.SubRegionDisable = 0x0;
|
||||
MPU_InitStruct.TypeExtField = MPU_TEX_LEVEL1;
|
||||
MPU_InitStruct.AccessPermission = MPU_REGION_FULL_ACCESS;
|
||||
MPU_InitStruct.DisableExec = MPU_INSTRUCTION_ACCESS_ENABLE;
|
||||
MPU_InitStruct.IsShareable = MPU_ACCESS_NOT_SHAREABLE;
|
||||
MPU_InitStruct.IsCacheable = MPU_ACCESS_CACHEABLE;
|
||||
MPU_InitStruct.IsBufferable = MPU_ACCESS_BUFFERABLE;
|
||||
HAL_MPU_ConfigRegion(&MPU_InitStruct);
|
||||
|
||||
/* Region 3: external RAM memory range */
|
||||
MPU_InitStruct.Enable = MPU_REGION_ENABLE;
|
||||
MPU_InitStruct.Number = MPU_REGION_NUMBER3;
|
||||
MPU_InitStruct.BaseAddress = (uint32_t)&EXTRAM_START;
|
||||
MPU_InitStruct.Size = mpu_region_size((uint32_t)&EXTRAM_SIZE);
|
||||
MPU_InitStruct.SubRegionDisable = 0x0;
|
||||
MPU_InitStruct.TypeExtField = MPU_TEX_LEVEL1;
|
||||
MPU_InitStruct.AccessPermission = MPU_REGION_FULL_ACCESS;
|
||||
MPU_InitStruct.DisableExec = MPU_INSTRUCTION_ACCESS_ENABLE;
|
||||
MPU_InitStruct.IsShareable = MPU_ACCESS_NOT_SHAREABLE;
|
||||
MPU_InitStruct.IsCacheable = MPU_ACCESS_CACHEABLE;
|
||||
MPU_InitStruct.IsBufferable = MPU_ACCESS_BUFFERABLE;
|
||||
HAL_MPU_ConfigRegion(&MPU_InitStruct);
|
||||
|
||||
/* Region 4: dedicated DMA buffers (cache disabled) */
|
||||
MPU_InitStruct.Enable = MPU_REGION_ENABLE;
|
||||
MPU_InitStruct.Number = MPU_REGION_NUMBER4;
|
||||
MPU_InitStruct.BaseAddress = (uint32_t)&_dram_addr;
|
||||
MPU_InitStruct.Size = MPU_REGION_SIZE_64KB; // FIXME
|
||||
MPU_InitStruct.SubRegionDisable = 0x0;
|
||||
MPU_InitStruct.TypeExtField = MPU_TEX_LEVEL1;
|
||||
MPU_InitStruct.AccessPermission = MPU_REGION_FULL_ACCESS;
|
||||
MPU_InitStruct.DisableExec = MPU_INSTRUCTION_ACCESS_DISABLE;
|
||||
MPU_InitStruct.IsShareable = MPU_ACCESS_NOT_SHAREABLE;
|
||||
MPU_InitStruct.IsCacheable = MPU_ACCESS_NOT_CACHEABLE;
|
||||
MPU_InitStruct.IsBufferable = MPU_ACCESS_BUFFERABLE;
|
||||
HAL_MPU_ConfigRegion(&MPU_InitStruct);
|
||||
|
||||
|
||||
HAL_MPU_Enable(MPU_PRIVILEGED_DEFAULT);
|
||||
|
||||
/* Enable bus fault exception */
|
||||
SCB->SHCSR |= SCB_SHCSR_BUSFAULTENA_Msk;
|
||||
}
|
||||
#endif // REQUIRE_MPU_CONFIG
|
||||
Reference in New Issue
Block a user