SCB.CCR.STKALIGN enables the automatic aligning of the stack pointer to 8 bytes on interrupt entry. Per ARM recommendations, and for AAPCS compliance, this bit should be enabled at all times. ARMv6M has this hardcoded to 1. Cortex M3 has this broken in rev 0, optional (default off) in rev 1, and optional (default on) in rev 2 and later. M4(f) has optional (default on) for all revisions, M7 has hardcoded to 1. See Section 2.3.3 in ARM document IHI0046B: http://infocenter.arm.com/help/topic/com.arm.doc.ihi0046b/IHI0046B_ABI_Advisory_1.pdf To ensure that all parts behave correctly, we make sure that we hardcode the feature on, for all parts. While not _required_ for anything other than rev1 cm3, inserting it into the common reset handler ensures no-one gets any surprises. Fixes Github issue #516
127 lines
3.4 KiB
C
127 lines
3.4 KiB
C
/*
|
|
* This file is part of the libopencm3 project.
|
|
*
|
|
* Copyright (C) 2010 Piotr Esden-Tempski <piotr@esden.net>,
|
|
* Copyright (C) 2012 chrysn <chrysn@fsfe.org>
|
|
*
|
|
* This library is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU Lesser General Public License as published by
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This library 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 Lesser General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Lesser General Public License
|
|
* along with this library. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <libopencm3/cm3/scb.h>
|
|
#include <libopencm3/cm3/vector.h>
|
|
|
|
/* load optional platform dependent initialization routines */
|
|
#include "../dispatch/vector_chipset.c"
|
|
/* load the weak symbols for IRQ_HANDLERS */
|
|
#include "../dispatch/vector_nvic.c"
|
|
|
|
/* Symbols exported by the linker script(s): */
|
|
extern unsigned _data_loadaddr, _data, _edata, _ebss, _stack;
|
|
typedef void (*funcp_t) (void);
|
|
extern funcp_t __preinit_array_start, __preinit_array_end;
|
|
extern funcp_t __init_array_start, __init_array_end;
|
|
extern funcp_t __fini_array_start, __fini_array_end;
|
|
|
|
void main(void);
|
|
void blocking_handler(void);
|
|
void null_handler(void);
|
|
|
|
__attribute__ ((section(".vectors")))
|
|
vector_table_t vector_table = {
|
|
.initial_sp_value = &_stack,
|
|
.reset = reset_handler,
|
|
.nmi = nmi_handler,
|
|
.hard_fault = hard_fault_handler,
|
|
|
|
/* Those are defined only on CM3 or CM4 */
|
|
#if defined(__ARM_ARCH_7M__) || defined(__ARM_ARCH_7EM__)
|
|
.memory_manage_fault = mem_manage_handler,
|
|
.bus_fault = bus_fault_handler,
|
|
.usage_fault = usage_fault_handler,
|
|
.debug_monitor = debug_monitor_handler,
|
|
#endif
|
|
|
|
.sv_call = sv_call_handler,
|
|
.pend_sv = pend_sv_handler,
|
|
.systick = sys_tick_handler,
|
|
.irq = {
|
|
IRQ_HANDLERS
|
|
}
|
|
};
|
|
|
|
void WEAK __attribute__ ((naked)) reset_handler(void)
|
|
{
|
|
volatile unsigned *src, *dest;
|
|
funcp_t *fp;
|
|
|
|
for (src = &_data_loadaddr, dest = &_data;
|
|
dest < &_edata;
|
|
src++, dest++) {
|
|
*dest = *src;
|
|
}
|
|
|
|
while (dest < &_ebss) {
|
|
*dest++ = 0;
|
|
}
|
|
|
|
/* Ensure 8-byte alignment of stack pointer on interrupts */
|
|
/* Enabled by default on most Cortex-M parts, but not M3 r1 */
|
|
SCB_CCR |= SCB_CCR_STKALIGN;
|
|
|
|
/* might be provided by platform specific vector.c */
|
|
pre_main();
|
|
|
|
/* Constructors. */
|
|
for (fp = &__preinit_array_start; fp < &__preinit_array_end; fp++) {
|
|
(*fp)();
|
|
}
|
|
for (fp = &__init_array_start; fp < &__init_array_end; fp++) {
|
|
(*fp)();
|
|
}
|
|
|
|
/* Call the application's entry point. */
|
|
main();
|
|
|
|
/* Destructors. */
|
|
for (fp = &__fini_array_start; fp < &__fini_array_end; fp++) {
|
|
(*fp)();
|
|
}
|
|
|
|
}
|
|
|
|
void blocking_handler(void)
|
|
{
|
|
while (1);
|
|
}
|
|
|
|
void null_handler(void)
|
|
{
|
|
/* Do nothing. */
|
|
}
|
|
|
|
#pragma weak nmi_handler = null_handler
|
|
#pragma weak hard_fault_handler = blocking_handler
|
|
#pragma weak sv_call_handler = null_handler
|
|
#pragma weak pend_sv_handler = null_handler
|
|
#pragma weak sys_tick_handler = null_handler
|
|
|
|
/* Those are defined only on CM3 or CM4 */
|
|
#if defined(__ARM_ARCH_7M__) || defined(__ARM_ARCH_7EM__)
|
|
#pragma weak mem_manage_handler = blocking_handler
|
|
#pragma weak bus_fault_handler = blocking_handler
|
|
#pragma weak usage_fault_handler = blocking_handler
|
|
#pragma weak debug_monitor_handler = null_handler
|
|
#endif
|
|
|