pinebuds/platform/cmsis/ca/startup_ARMCA.c

166 lines
8.4 KiB
C
Raw Normal View History

2022-08-15 04:20:27 -05:00
/******************************************************************************
* @file startup_ARMCA7.c
* @brief CMSIS Device System Source File for Arm Cortex-A9 Device Series
* @version V1.00
* @date 10. January 2018
*
* @note
*
******************************************************************************/
/*
* Copyright (c) 2009-2018 Arm Limited. All rights reserved.
*
* SPDX-License-Identifier: Apache-2.0
*
* Licensed under the Apache License, Version 2.0 (the License); you may
* not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an AS IS BASIS, WITHOUT
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
#include "cmsis.h"
#include "plat_addr_map.h"
/*----------------------------------------------------------------------------
Definitions
*----------------------------------------------------------------------------*/
#define USR_MODE 0x10 // User mode
#define FIQ_MODE 0x11 // Fast Interrupt Request mode
#define IRQ_MODE 0x12 // Interrupt Request mode
#define SVC_MODE 0x13 // Supervisor mode
#define ABT_MODE 0x17 // Abort mode
#define UND_MODE 0x1B // Undefined Instruction mode
#define SYS_MODE 0x1F // System mode
2022-08-15 04:20:27 -05:00
/*----------------------------------------------------------------------------
Internal References
*----------------------------------------------------------------------------*/
void Vectors(void) __attribute__((naked, target("arm"), section(".vectors")));
void Reset_Handler(void) __attribute__((naked, section(".boot_loader")));
2022-08-15 04:20:27 -05:00
/*----------------------------------------------------------------------------
Exception / Interrupt Handler
*----------------------------------------------------------------------------*/
void Undef_Handler(void) __attribute__((weak, alias("Default_Handler")));
void SVC_Handler(void) __attribute__((weak, alias("Default_Handler")));
void PAbt_Handler(void) __attribute__((weak, alias("Default_Handler")));
void DAbt_Handler(void) __attribute__((weak, alias("Default_Handler")));
void IRQ_Handler(void) __attribute__((weak, alias("Default_Handler")));
void FIQ_Handler(void) __attribute__((weak, alias("Default_Handler")));
2022-08-15 04:20:27 -05:00
/*----------------------------------------------------------------------------
Exception / Interrupt Vector Table
*----------------------------------------------------------------------------*/
void Vectors(void) {
__ASM volatile("LDR PC, ResetVectorPtr \n"
"LDR PC, UndefVectorPtr \n"
"LDR PC, SVCVectorPtr \n"
"LDR PC, PAbtVectorPtr \n"
"LDR PC, DAbtVectorPtr \n"
"LDR PC, HypVectorPtr \n"
"LDR PC, IRQVectorPtr \n"
"LDR PC, FIQVectorPtr \n"
"ResetVectorPtr: .LONG Init_Handler \n"
"UndefVectorPtr: .LONG Init_Handler \n"
"SVCVectorPtr: .LONG Init_Handler \n"
"PAbtVectorPtr: .LONG Init_Handler \n"
"DAbtVectorPtr: .LONG Init_Handler \n"
"HypVectorPtr: .LONG Init_Handler \n"
"IRQVectorPtr: .LONG Init_Handler \n"
"FIQVectorPtr: .LONG Init_Handler \n"
"Init_Handler: b Init_Handler \n");
2022-08-15 04:20:27 -05:00
}
/*----------------------------------------------------------------------------
Reset Handler called on controller reset
*----------------------------------------------------------------------------*/
void Reset_Handler(void) {
__ASM volatile(
// Mask interrupts
"CPSID if \n"
// Put any cores other than 0 to sleep
"MRC p15, 0, R0, c0, c0, 5 \n" // Read MPIDR
"ANDS R0, R0, #3 \n"
"goToSleep: \n"
"IT NE \n"
"WFINE \n"
"BNE goToSleep \n"
// Reset SCTLR Settings
"MRC p15, 0, R0, c1, c0, 0 \n" // Read CP15 System
// Control register
"BIC R0, R0, #(0x1 << 12) \n" // Clear I bit 12 to
// disable I Cache
"BIC R0, R0, #(0x1 << 2) \n" // Clear C bit 2 to
// disable D Cache
"BIC R0, R0, #0x1 \n" // Clear M bit 0 to
// disable MMU
"BIC R0, R0, #(0x1 << 11) \n" // Clear Z bit 11 to
// disable branch
// prediction
"BIC R0, R0, #(0x1 << 13) \n" // Clear V bit 13 to
// disable hivecs
"MCR p15, 0, R0, c1, c0, 0 \n" // Write value back
// to CP15 System
// Control register
"ISB \n"
// Configure ACTLR
"MRC p15, 0, r0, c1, c0, 1 \n" // Read CP15
// Auxiliary Control
// Register
//"ORR r0, r0, #(1 << 1) \n" // Enable L2
// prefetch hint (UNK/WI since r4p1)
"ORR r0, r0, #(1 << 6) \n" // Enable SMP
"MCR p15, 0, r0, c1, c0, 1 \n" // Write CP15
// Auxiliary Control
// Register
// Set Vector Base Address Register (VBAR) to point to this application's
// vector table
//"LDR R0, =Vectors \n"
"LDR R0, =" _TO_STRING(
DSP_BOOT_REG) " \n"
"MCR p15, 0, R0, c12, c0, 0 \n"
// Setup Stack for each exceptional mode
"CPS #0x11 \n"
"LDR SP, =Image$$FIQ_STACK$$ZI$$Limit \n"
"CPS #0x12 \n"
"LDR SP, =Image$$IRQ_STACK$$ZI$$Limit \n"
"CPS #0x13 \n"
"LDR SP, =Image$$SVC_STACK$$ZI$$Limit \n"
"CPS #0x17 \n"
"LDR SP, =Image$$ABT_STACK$$ZI$$Limit \n"
"CPS #0x1B \n"
"LDR SP, =Image$$UND_STACK$$ZI$$Limit \n"
"CPS #0x1F \n"
"LDR SP, =Image$$SYS_STACK$$ZI$$Limit \n"
// Call SystemInit
"BL SystemInit \n"
// Unmask interrupts
"CPSIE if \n"
// Call __main
"BL _start \n");
2022-08-15 04:20:27 -05:00
}
/*----------------------------------------------------------------------------
Default Handler for Exceptions / Interrupts
*----------------------------------------------------------------------------*/
void Default_Handler(void) {
while (1)
;
2022-08-15 04:20:27 -05:00
}