pinebuds/platform/cmsis/system_cp.c

236 lines
8.0 KiB
C
Raw Normal View History

2022-08-15 04:20:27 -05:00
/***************************************************************************
*
* Copyright 2015-2019 BES.
* All rights reserved. All unpublished rights reserved.
*
* No part of this work may be used or reproduced in any form or by any
* means, or stored in a database or retrieval system, without prior written
* permission of BES.
*
* Use of this work is governed by a license granted by BES.
* This work contains confidential and proprietary information of
* BES. which is protected by copyright, trade secret,
* trademark and other intellectual property rights.
*
****************************************************************************/
#ifndef __ARM_ARCH_ISA_ARM
#ifdef CHIP_HAS_CP
#include "cmsis_nvic.h"
#include "hal_cache.h"
#include "hal_location.h"
#include "plat_addr_map.h"
#include "plat_types.h"
2022-08-15 04:20:27 -05:00
#ifdef __ARMCC_VERSION
#include "link_sym_armclang.h"
#endif
// The vector table must be aligned to NVIC_NUM_VECTORS-word boundary, rounding
// up to the next power of two
2022-08-15 04:20:27 -05:00
// -- 0x100 for 33~64 vectors, and 0x200 for 65~128 vectors
#if defined(ROM_BUILD) || defined(PROGRAMMER) || (RAMCP_SIZE <= 0)
#define VECTOR_LOC_CP ALIGNED(0x200)
2022-08-15 04:20:27 -05:00
#else
#define VECTOR_LOC_CP __attribute__((section(".vector_table_cp")))
2022-08-15 04:20:27 -05:00
#endif
#define FAULT_HANDLER_CP __attribute__((weak, alias("NVIC_default_handler_cp")))
2022-08-15 04:20:27 -05:00
static uint32_t VECTOR_LOC_CP vector_table_cp[NVIC_NUM_VECTORS];
static void NAKED NVIC_default_handler_cp(void) {
asm volatile("_loop:; nop; nop; nop; nop; b _loop;");
2022-08-15 04:20:27 -05:00
}
void FAULT_HANDLER_CP Reset_Handler_cp(void);
void FAULT_HANDLER_CP NMI_Handler_cp(void);
void FAULT_HANDLER_CP HardFault_Handler_cp(void);
void FAULT_HANDLER_CP MemManage_Handler_cp(void);
void FAULT_HANDLER_CP BusFault_Handler_cp(void);
void FAULT_HANDLER_CP UsageFault_Handler_cp(void);
void FAULT_HANDLER_CP SVC_Handler_cp(void);
void FAULT_HANDLER_CP DebugMon_Handler_cp(void);
void FAULT_HANDLER_CP PendSV_Handler_cp(void);
void FAULT_HANDLER_CP SysTick_Handler_cp(void);
static const uint32_t fault_handlers_cp[NVIC_USER_IRQ_OFFSET] = {
(uint32_t)0,
(uint32_t)Reset_Handler_cp,
(uint32_t)NMI_Handler_cp,
(uint32_t)HardFault_Handler_cp,
(uint32_t)MemManage_Handler_cp,
(uint32_t)BusFault_Handler_cp,
(uint32_t)UsageFault_Handler_cp,
(uint32_t)NVIC_default_handler_cp,
(uint32_t)NVIC_default_handler_cp,
(uint32_t)NVIC_default_handler_cp,
(uint32_t)NVIC_default_handler_cp,
(uint32_t)SVC_Handler_cp,
(uint32_t)DebugMon_Handler_cp,
(uint32_t)NVIC_default_handler_cp,
(uint32_t)PendSV_Handler_cp,
(uint32_t)SysTick_Handler_cp,
};
void NVIC_InitVectors_cp(void) {
int i;
2022-08-15 04:20:27 -05:00
for (i = 0; i < NVIC_NUM_VECTORS; i++) {
vector_table_cp[i] = (i < ARRAY_SIZE(fault_handlers_cp))
? fault_handlers_cp[i]
: (uint32_t)NVIC_default_handler_cp;
}
2022-08-15 04:20:27 -05:00
SCB->VTOR = (uint32_t)vector_table_cp;
2022-08-15 04:20:27 -05:00
}
void NVIC_SetDefaultFaultHandler_cp(NVIC_DEFAULT_FAULT_HANDLER_T handler) {
int i;
2022-08-15 04:20:27 -05:00
for (i = 1; i < ARRAY_SIZE(fault_handlers_cp); i++) {
if (vector_table_cp[i] == (uint32_t)NVIC_default_handler_cp) {
vector_table_cp[i] = (uint32_t)handler;
2022-08-15 04:20:27 -05:00
}
}
2022-08-15 04:20:27 -05:00
}
void SystemInit_cp(void) {
2022-08-15 04:20:27 -05:00
#if (__FPU_USED == 1)
SCB->CPACR |= ((3UL << 10 * 2) | /* set CP10 Full Access */
(3UL << 11 * 2)); /* set CP11 Full Access */
2022-08-15 04:20:27 -05:00
#endif
SCB->CCR |= SCB_CCR_DIV_0_TRP_Msk;
2022-08-15 04:20:27 -05:00
#ifdef __ARM_ARCH_8M_MAIN__
// Disable stack limit check on hard fault, NMI and reset
// (The check will generate STKOF usage fault)
SCB->CCR |= SCB_CCR_STKOFHFNMIGN_Msk;
2022-08-15 04:20:27 -05:00
#endif
#ifdef UNALIGNED_ACCESS
SCB->CCR &= ~SCB_CCR_UNALIGN_TRP_Msk;
2022-08-15 04:20:27 -05:00
#else
SCB->CCR |= SCB_CCR_UNALIGN_TRP_Msk;
2022-08-15 04:20:27 -05:00
#endif
#ifdef USAGE_FAULT
SCB->SHCSR |= SCB_SHCSR_USGFAULTENA_Msk;
NVIC_SetPriority(UsageFault_IRQn, IRQ_PRIORITY_REALTIME);
2022-08-15 04:20:27 -05:00
#else
SCB->SHCSR &= ~SCB_SHCSR_USGFAULTENA_Msk;
2022-08-15 04:20:27 -05:00
#endif
#ifdef BUS_FAULT
SCB->SHCSR |= SCB_SHCSR_BUSFAULTENA_Msk;
NVIC_SetPriority(BusFault_IRQn, IRQ_PRIORITY_REALTIME);
2022-08-15 04:20:27 -05:00
#else
SCB->SHCSR &= ~SCB_SHCSR_BUSFAULTENA_Msk;
2022-08-15 04:20:27 -05:00
#endif
#ifdef MEM_FAULT
SCB->SHCSR |= SCB_SHCSR_MEMFAULTENA_Msk;
NVIC_SetPriority(MemoryManagement_IRQn, IRQ_PRIORITY_REALTIME);
2022-08-15 04:20:27 -05:00
#else
SCB->SHCSR &= ~SCB_SHCSR_MEMFAULTENA_Msk;
2022-08-15 04:20:27 -05:00
#endif
}
extern uint32_t __cp_text_sram_start_flash__[];
extern uint32_t __cp_text_sram_start[];
extern uint32_t __cp_text_sram_end[];
extern uint32_t __cp_data_sram_start_flash__[];
extern uint32_t __cp_data_sram_start[];
extern uint32_t __cp_data_sram_end[];
extern uint32_t __cp_bss_sram_start[];
extern uint32_t __cp_bss_sram_end[];
void NAKED system_cp_reset_handler(void) {
asm volatile(
2022-08-15 04:20:27 -05:00
#ifdef __ARM_ARCH_8M_MAIN__
"ldr r0, =" TO_STRING(
__cp_stack_limit) ";"
"msr msplim, r0;"
2022-08-15 04:20:27 -05:00
#endif
"ldr r3, =" TO_STRING(
__cp_stack_top) ";"
"msr msp, r3;"
"movs r4, 0;"
"mov r5, r4;"
"mov r6, r4;"
"mov r7, r4;"
"mov r8, r4;"
"mov r9, r4;"
"mov r10, r4;"
"mov r11, r4;"
"mov r12, r4;"
2022-08-15 04:20:27 -05:00
#if !defined(__SOFTFP__) && defined(__ARM_FP) && (__ARM_FP >= 4)
"ldr.w r0, =0xE000ED88;"
"ldr r1, [r0];"
"orr r1, r1, #(0xF << 20);"
"str r1, [r0];"
"dsb;"
"isb;"
"vmov s0, s1, r4, r5;"
"vmov s2, s3, r4, r5;"
"vmov s4, s5, r4, r5;"
"vmov s6, s7, r4, r5;"
"vmov s8, s9, r4, r5;"
"vmov s10, s11, r4, r5;"
"vmov s12, s13, r4, r5;"
"vmov s14, s15, r4, r5;"
"vmov s16, s17, r4, r5;"
"vmov s18, s19, r4, r5;"
"vmov s20, s21, r4, r5;"
"vmov s22, s23, r4, r5;"
"vmov s24, s25, r4, r5;"
"vmov s26, s27, r4, r5;"
"vmov s28, s29, r4, r5;"
"vmov s30, s31, r4, r5;"
2022-08-15 04:20:27 -05:00
#endif
"bl hal_cmu_cp_get_entry_addr;"
"blx r0;");
2022-08-15 04:20:27 -05:00
}
void system_cp_init(int load_code) {
NVIC_InitVectors_cp();
2022-08-15 04:20:27 -05:00
// Enable icache
hal_cachecp_enable(HAL_CACHE_ID_I_CACHE);
// Enable dcache
hal_cachecp_enable(HAL_CACHE_ID_D_CACHE);
// Enable write back
hal_cachecp_writeback_enable(HAL_CACHE_ID_D_CACHE);
2022-08-15 04:20:27 -05:00
SystemInit_cp();
2022-08-15 04:20:27 -05:00
#if !(defined(ROM_BUILD) || defined(PROGRAMMER))
uint32_t *dst;
uint32_t *src;
if (load_code) {
dst = __cp_text_sram_start;
src = __cp_text_sram_start_flash__;
for (; dst < __cp_text_sram_end; dst++, src++) {
*dst = *src;
2022-08-15 04:20:27 -05:00
}
}
dst = __cp_data_sram_start;
src = __cp_data_sram_start_flash__;
for (; dst < __cp_data_sram_end; dst++, src++) {
*dst = *src;
}
dst = __cp_bss_sram_start;
for (; dst < __cp_bss_sram_end; dst++) {
*dst = 0;
}
2022-08-15 04:20:27 -05:00
#endif
}
void system_cp_term(void) {
// Disable dcache
hal_cachecp_disable(HAL_CACHE_ID_D_CACHE);
// Disable icache
hal_cachecp_disable(HAL_CACHE_ID_I_CACHE);
2022-08-15 04:20:27 -05:00
}
#endif
#endif