cpiofs能够正常加载

2024-04-10 15:35:35 +08:00
parent 12aa44316f
commit 321f18d77c
26 changed files with 351 additions and 457 deletions
--- a/mkrtos_knl/arch/aarch64/aarch64_qemu/arch.h
+++ b/mkrtos_knl/arch/aarch64/aarch64_qemu/arch.h
@@ -61,6 +61,7 @@ typedef struct sp_info {
    mword_t sp;
    mword_t pc;
    mword_t u_sp; // user_sp
+    mword_t tpidr_el0;
 } sp_info_t;

 #define _barrier() __asm__ __volatile__("" : : : "memory")
--- a/mkrtos_knl/arch/aarch64/aarch64_qemu/vector.S
+++ b/mkrtos_knl/arch/aarch64/aarch64_qemu/vector.S
@@ -243,7 +243,9 @@ cpu_switch_to:
 	stp     x27, x28, [x8], #16
 	stp     x29, x9, [x8], #16
 	mrs		x9, sp_el1
-	stp     lr, x9, [x8]
+	stp     lr, x9, [x8], #16
+	mrs		x9, tpidr_el0
+	str		x9, [x8]

 	mov     x8, x1
 	ldp     x19, x20, [x8], #16
@@ -254,6 +256,8 @@ cpu_switch_to:
 	ldp     x29, x9, [x8], #16
 	ldr     lr, [x8], #8
 	mov     sp, x9
-	ldr		x9, [x8]
+	ldr		x9, [x8], #8
 	msr		sp_el1, x9
+	ldr		x9, [x8]
+	msr		tpidr_el0, x9
 	ret