arm: mxs: Clear CPSR V bit to activate low vectors

The MXS starts with CPSR V bit set, which makes the CPU jump to high vectors
in case of an exception. Those high vectors are located at 0xffff0000, which
is where the BootROM exception table is located as well. U-Boot should handle
exceptions on its own using its own exception handling code, which is located
at 0x0, i.e. at low vectors. Clear the CPSR V bit, so that the CPU would jump
to low vectors on exception instead, and therefore run the U-Boot exception
handling code.

Signed-off-by: Marek Vasut <marex@denx.de>
Reviewed-by: Fabio Estevam <festevam@gmail.com>
This commit is contained in:
Marek Vasut
2023-10-18 20:51:59 +02:00
committed by Fabio Estevam
parent cb1d68b143
commit 712aa6e24c
2 changed files with 11 additions and 1 deletions

View File

@@ -71,6 +71,7 @@ void reset_cpu(void)
* actually 0x20, this the associated <destination address>. Loading the PC * actually 0x20, this the associated <destination address>. Loading the PC
* register with an address performs a jump to that address. * register with an address performs a jump to that address.
*/ */
noinline __attribute__((target("arm")))
void mx28_fixup_vt(uint32_t start_addr) void mx28_fixup_vt(uint32_t start_addr)
{ {
/* ldr pc, [pc, #0x18] */ /* ldr pc, [pc, #0x18] */
@@ -85,6 +86,9 @@ void mx28_fixup_vt(uint32_t start_addr)
/* cppcheck-suppress nullPointer */ /* cppcheck-suppress nullPointer */
vt[i + 8] = start_addr + (4 * i); vt[i + 8] = start_addr + (4 * i);
} }
/* Make sure ARM core points to low vectors */
set_cr(get_cr() & ~CR_V);
} }
#ifdef CONFIG_ARCH_MISC_INIT #ifdef CONFIG_ARCH_MISC_INIT

View File

@@ -17,6 +17,7 @@
#include <asm/arch/sys_proto.h> #include <asm/arch/sys_proto.h>
#include <asm/gpio.h> #include <asm/gpio.h>
#include <asm/sections.h> #include <asm/sections.h>
#include <asm/system.h>
#include <linux/compiler.h> #include <linux/compiler.h>
#include "mxs_init.h" #include "mxs_init.h"
@@ -93,7 +94,9 @@ static uint8_t mxs_get_bootmode_index(void)
return i; return i;
} }
static void mxs_spl_fixup_vectors(void) static noinline
__attribute__((target("arm")))
void mxs_spl_fixup_vectors(void)
{ {
/* /*
* Copy our vector table to 0x0, since due to HAB, we cannot * Copy our vector table to 0x0, since due to HAB, we cannot
@@ -104,6 +107,9 @@ static void mxs_spl_fixup_vectors(void)
/* cppcheck-suppress nullPointer */ /* cppcheck-suppress nullPointer */
memcpy(0x0, _start, 0x60); memcpy(0x0, _start, 0x60);
/* Make sure ARM core points to low vectors */
set_cr(get_cr() & ~CR_V);
} }
static void mxs_spl_console_init(void) static void mxs_spl_console_init(void)