diff src/cs/system/main/gcc/exceptions.S @ 0:92470e5d0b9e

src: partial import from FC Selenite
author Mychaela Falconia <falcon@freecalypso.org>
date Fri, 15 May 2020 01:28:16 +0000
parents
children
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/src/cs/system/main/gcc/exceptions.S	Fri May 15 01:28:16 2020 +0000
@@ -0,0 +1,125 @@
+/*
+ * This module contains ARM exception handlers which used to be
+ * in chipsetsw/system/Main/int.s in TI's original version.
+ */
+
+	.text
+	.code	32
+
+@ layout of xdump buffer:
+@ struct xdump_s {
+@     long registers[16] // svc mode registers
+@     long cpsr          // svc mode CPSR
+@     long exception     // magic word + index of vector taken
+@     long stack[20]     // bottom 20 words of usr mode stack
+@ }
+
+	.globl	_arm_undefined
+_arm_undefined:
+	@ store r12 for Xdump_buffer pointer, r11 for index
+	stmfd   r13!,{r11,r12}
+	mov     r11,#1
+	b       save_regs
+
+	.globl	_arm_swi
+_arm_swi:
+	@ store r12 for Xdump_buffer pointer, r11 for index
+	stmfd   r13!,{r11,r12}
+	mov     r11,#2
+	b       save_regs
+
+	.globl	_arm_abort_prefetch
+_arm_abort_prefetch:
+	@ store r12 for Xdump_buffer pointer, r11 for index
+	stmfd   r13!,{r11,r12}
+	mov     r11,#3
+	b       save_regs
+
+	.globl	_arm_abort_data
+_arm_abort_data:
+	@ store r12 for Xdump_buffer pointer, r11 for index
+	stmfd   r13!,{r11,r12}
+	mov     r11,#4
+	b       save_regs
+
+	.globl	_arm_reserved
+_arm_reserved:
+	ldr	r13,=_Except_Stack_SP	@ mode unknown
+	@ store r12 for Xdump_buffer pointer, r11 for index
+	stmfd   r13!,{r11,r12}
+	mov     r11,#5
+	b       save_regs
+
+save_regs:
+        ldr     r12,=xdump_buffer
+        str     r14,[r12,#4*15] @ save r14_abt (original PC) into r15 slot
+
+        stmia   r12,{r0-r10}    @ save unbanked registers (except r11 and r12)
+        ldmfd   r13!,{r0,r1}    @ get original r11 and r12
+        str     r0,[r12,#4*11]  @ save original r11
+        str     r1,[r12,#4*12]  @ save original r12
+        mrs     r0,spsr         @ get original psr
+        str     r0,[r12,#4*16]  @ save original cpsr
+
+        mrs     r1,cpsr         @ save mode psr
+        bic     r2,r1,#0x1f     @ psr with mode bits cleared
+        and     r0,r0,#0x1f     @ get original mode bits
+        add     r0,r0,r2
+
+        msr     cpsr,r0		@ move to pre-exception mode
+        str     r13,[r12,#4*13] @ save original SP
+        str     r14,[r12,#4*14] @ save original LR
+        msr     cpsr,r1 	@ restore mode psr
+
+        @ r11 has original index
+        orr     r10,r11,#0xDE<<24 @ r10 = 0xDEAD0000 + index of vector taken
+        orr     r10,r10,#0xAD<<16
+        str     r10,[r12,#4*17] @ save magic + index
+
+        mov     r0,r11          @ put index into 1st argument
+        b       dar_exception
+
+@ the second part
+
+/*
+ * For the SP-in-RAM validity check, we use the following simplification:
+ * it doesn't really matter what the actual IRAM and XRAM sizes are on
+ * any given target, as the address decoder hooked up to the ARM7TDMI core
+ * always decodes the full 8 MiB address range for each, causing the
+ * actual memories to be aliased multiple times in those two ranges.
+ * Furthermore, the XRAM address range falls right after the IRAM one,
+ * thus we can get away with only a single range check.
+ */
+
+#define	RAM_LOW		0x00800000
+#define	RAM_HIGH	0x01800000
+
+#define	XDUMP_STACK_SIZE	20
+
+	.globl	exception
+exception:
+        ldr     r12,=xdump_buffer
+        ldr     r11,[r12,#4*13]   @ get svc mode r13
+        add     r12,r12,#4*18     @ base of stack buffer
+
+	@ check if svc r13(sp) is within internal/external RAM.
+	@ It *could* be invalid.
+        cmp     r11,#RAM_LOW
+        blt     nostack
+        mov     r0,#RAM_HIGH
+        sub     r0,r0,#XDUMP_STACK_SIZE
+        cmp     r11,r0
+        bge     nostack
+
+stack_range:              
+        ldmfd   r11!,{r0-r9}    @ copy ten stack words..
+        stmia   r12!,{r0-r9}
+        ldmfd   r11!,{r0-r9}    @ copy ten stack words..
+        stmia   r12!,{r0-r9}
+
+nostack:
+	@ we're finished saving all state.
+	@ Now execute C code for more flexibility.
+	@ set up a stack for this C call
+	ldr	sp,=_Stack_segment_end
+	b	dar_reset