mirror of
https://github.com/Rockbox/rockbox.git
synced 2025-10-14 02:27:39 -04:00
Exception handling code assumes at least word alignment of the context buffer. So far we were lucky that compiler placed it correctly but after compiler upgrade I was hit by the bug caused by missalignment of the context buffer. Credit goes to pamaury
107 lines
3.2 KiB
ArmAsm
107 lines
3.2 KiB
ArmAsm
/***************************************************************************
|
|
* __________ __ ___.
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
* \/ \/ \/ \/ \/
|
|
*
|
|
* Copyright (C) 2015 by Marcin Bukat
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version 2
|
|
* of the License, or (at your option) any later version.
|
|
*
|
|
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
|
* KIND, either express or implied.
|
|
*
|
|
****************************************************************************/
|
|
#include "mips.h"
|
|
#include "target-config.h"
|
|
#include "system.h"
|
|
|
|
/* Handling of exception:
|
|
* the code can register a "longjmp" buffer to restore the context in case of
|
|
* fault */
|
|
.data
|
|
.align 4
|
|
.global exception_jmp_ctx_ptr
|
|
exception_jmp_ctx_ptr:
|
|
/* buffer contains in order: s0-s7, sp, s8, ra */
|
|
.skip 44 /* = 4 * (9 callee saved registers + sp + ra) */
|
|
|
|
.set noreorder
|
|
.section .icode, "ax", %progbits
|
|
/* Prototype: int set_exception_jmp()
|
|
* Return: 1 in case of data abort, 0 otherwise */
|
|
.global set_exception_jmp
|
|
set_exception_jmp:
|
|
la v0, exception_jmp_ctx_ptr
|
|
sw s0, 0(v0)
|
|
sw s1, 4(v0)
|
|
sw s2, 8(v0)
|
|
sw s3, 12(v0)
|
|
sw s4, 16(v0)
|
|
sw s5, 20(v0)
|
|
sw s6, 24(v0)
|
|
sw s7, 28(v0)
|
|
sw sp, 32(v0)
|
|
sw s8, 36(v0)
|
|
sw ra, 40(v0)
|
|
jr ra
|
|
move v0, zero
|
|
|
|
/* restore context on read/write error, performs the interrupt return
|
|
* arguments:
|
|
* a0: exception type (EXCEPTION_*) */
|
|
.global restore_exception_jmp
|
|
restore_exception_jmp:
|
|
la v0, exception_jmp_ctx_ptr
|
|
lw s0, 0(v0)
|
|
lw s1, 4(v0)
|
|
lw s2, 8(v0)
|
|
lw s3, 12(v0)
|
|
lw s4, 16(v0)
|
|
lw s5, 20(v0)
|
|
lw s6, 24(v0)
|
|
lw s7, 28(v0)
|
|
lw sp, 32(v0)
|
|
lw s8, 36(v0)
|
|
lw v0, 40(v0)
|
|
mtc0 v0, C0_EPC
|
|
#ifdef CONFIG_JZ4760B
|
|
/* XBurst has a 3 interlock cycle delay, but we don't know if the interlock
|
|
* works with eret */
|
|
nop
|
|
#else
|
|
ehb
|
|
#endif
|
|
move v0, a0 /* set exception type */
|
|
eret
|
|
nop
|
|
.set reorder
|
|
|
|
#ifdef CONFIG_FLUSH_CACHES
|
|
.set noreorder
|
|
.text
|
|
.global target_flush_caches
|
|
target_flush_caches:
|
|
/* commit dcache and invalidate icache */
|
|
la t0, 0x80000000 /* an idx op should use an unmappable address */
|
|
ori t1, t0, DCACHE_SIZE /* cache size */
|
|
reloc_dcache_loop:
|
|
cache DCIndexWBInv, 0(t0) /* invalidate and write-back dcache index */
|
|
addiu t0, t0, DCACHE_LINE_SIZE /* bytes per cache line */
|
|
bne t0, t1, reloc_dcache_loop
|
|
nop
|
|
la t0, 0x80000000 /* an idx op should use an unmappable address */
|
|
ori t1, t0, ICACHE_SIZE /* cache size */
|
|
reloc_icache_loop:
|
|
cache ICIndexInv, 0(t0) /* invalidate icache index */
|
|
addiu t0, t0, ICACHE_LINE_SIZE /* bytes per cache line */
|
|
bne t0, t1, reloc_icache_loop
|
|
nop
|
|
jr ra
|
|
nop
|
|
#endif
|