aboutsummaryrefslogtreecommitdiff
path: root/src/sys/schedule.S
diff options
context:
space:
mode:
authorChristian Cunningham <cc@localhost>2022-02-05 12:40:47 -0700
committerChristian Cunningham <cc@localhost>2022-02-05 12:40:47 -0700
commite0ba2e06ace89f0e17dd912e684f91c5a7f28f7c (patch)
tree07d5bd3107b5599b47c91729e98d723454c803a8 /src/sys/schedule.S
parent345f80249ddef46a0a90d763e1b5651bbf967078 (diff)
Fixed SPSR preservation
Diffstat (limited to 'src/sys/schedule.S')
-rw-r--r--src/sys/schedule.S6
1 files changed, 3 insertions, 3 deletions
diff --git a/src/sys/schedule.S b/src/sys/schedule.S
index e8ab326..3c49494 100644
--- a/src/sys/schedule.S
+++ b/src/sys/schedule.S
@@ -8,9 +8,9 @@
ldr r3, =scheduler // struct Scheduler
ldr r2, [r3, #0] // struct Thread* rthread
str sp, [r2, #4] // svc_lr -> void* sp
- mrs r1, cpsr
- str r1, [r2, #0xc] // preserve cpsr
cps #0x13 // Svc mode
+ mrs r1, spsr
+ str r1, [r2, #0xc] // preserve cpsr
str lr, [r2, #0] // svc_lr -> void* pc
.endm
@@ -20,8 +20,8 @@
ldr lr, [r2, #0] // void* pc -> lr_svc
ldr r0, [r2, #4] // void* sp -> r0
ldr r1, [r2, #0xc] // restore cpsr
+ msr spsr_f, r1
cps #0x1f // Sys mode
- msr cpsr, r1
mov sp, r0 // Set stack pointer
// Restore Usr regs
pop {lr}