diff options
Diffstat (limited to 'firmware')
-rw-r--r-- | firmware/target/mips/ingenic_jz47xx/crt0.S | 76 | ||||
-rw-r--r-- | firmware/thread.c | 75 |
2 files changed, 50 insertions, 101 deletions
diff --git a/firmware/target/mips/ingenic_jz47xx/crt0.S b/firmware/target/mips/ingenic_jz47xx/crt0.S index 6ac40c2f52..af82ad5d12 100644 --- a/firmware/target/mips/ingenic_jz47xx/crt0.S +++ b/firmware/target/mips/ingenic_jz47xx/crt0.S | |||
@@ -216,10 +216,10 @@ _init_stack_loop: | |||
216 | .section .vectors, "ax", %progbits | 216 | .section .vectors, "ax", %progbits |
217 | real_exception_handler: | 217 | real_exception_handler: |
218 | addiu sp, -0x80 | 218 | addiu sp, -0x80 |
219 | sw ra, 0(sp) | 219 | sw ra, 0(sp) |
220 | sw fp, 4(sp) | 220 | sw fp, 4(sp) |
221 | sw gp, 8(sp) | 221 | sw gp, 8(sp) |
222 | sw t9, 0xC(sp) | 222 | sw t9, 0xC(sp) |
223 | sw t8, 0x10(sp) | 223 | sw t8, 0x10(sp) |
224 | sw s7, 0x14(sp) | 224 | sw s7, 0x14(sp) |
225 | sw s6, 0x18(sp) | 225 | sw s6, 0x18(sp) |
@@ -274,60 +274,10 @@ real_exception_handler: | |||
274 | _int: | 274 | _int: |
275 | jal intr_handler | 275 | jal intr_handler |
276 | nop | 276 | nop |
277 | lw ra, 0(sp) | 277 | j _exception_return |
278 | lw fp, 4(sp) | ||
279 | sw gp, 8(sp) | ||
280 | lw t9, 0xC(sp) | ||
281 | lw t8, 0x10(sp) | ||
282 | lw s7, 0x14(sp) | ||
283 | lw s6, 0x18(sp) | ||
284 | lw s5, 0x1C(sp) | ||
285 | lw s4, 0x20(sp) | ||
286 | lw s3, 0x24(sp) | ||
287 | lw s2, 0x28(sp) | ||
288 | lw s1, 0x2C(sp) | ||
289 | lw s0, 0x30(sp) | ||
290 | lw t7, 0x34(sp) | ||
291 | lw t6, 0x38(sp) | ||
292 | lw t5, 0x3C(sp) | ||
293 | lw t4, 0x40(sp) | ||
294 | lw t3, 0x44(sp) | ||
295 | lw t2, 0x48(sp) | ||
296 | lw t1, 0x4C(sp) | ||
297 | lw t0, 0x50(sp) | ||
298 | lw a3, 0x54(sp) | ||
299 | lw a2, 0x58(sp) | ||
300 | lw a1, 0x5C(sp) | ||
301 | lw a0, 0x60(sp) | ||
302 | lw v1, 0x64(sp) | ||
303 | lw v0, 0x68(sp) | ||
304 | lw $1, 0x6C(sp) | ||
305 | lw k0, 0x70(sp) | ||
306 | mtlo k0 | ||
307 | nop | ||
308 | lw k0, 0x74(sp) | ||
309 | mthi k0 | ||
310 | nop | ||
311 | lw k0, 0x78(sp) | ||
312 | nop | ||
313 | mtc0 k0, C0_STATUS # Status register | ||
314 | sll zero, 1 | ||
315 | sll zero, 1 | ||
316 | sll zero, 1 | ||
317 | sll zero, 1 | ||
318 | lw k0, 0x7C(sp) | ||
319 | nop | ||
320 | mtc0 k0, C0_EPC # Exception Program Counter | ||
321 | sll zero, 1 | ||
322 | sll zero, 1 | ||
323 | sll zero, 1 | ||
324 | sll zero, 1 | ||
325 | addiu sp, 0x80 | ||
326 | eret # Exception Return | ||
327 | nop | ||
328 | 278 | ||
329 | _exception: | 279 | _exception: |
330 | add a0, sp, $0 | 280 | move a0, sp |
331 | mfc0 a1, C0_CAUSE # C0_CAUSE of last exception | 281 | mfc0 a1, C0_CAUSE # C0_CAUSE of last exception |
332 | sll zero, 1 | 282 | sll zero, 1 |
333 | sll zero, 1 | 283 | sll zero, 1 |
@@ -340,10 +290,12 @@ _exception: | |||
340 | sll zero, 1 | 290 | sll zero, 1 |
341 | jal exception_handler | 291 | jal exception_handler |
342 | nop | 292 | nop |
343 | lw ra, 0(sp) | 293 | |
344 | lw fp, 4(sp) | 294 | _exception_return: |
345 | sw gp, 8(sp) | 295 | lw ra, 0(sp) |
346 | lw t9, 0xC(sp) | 296 | lw fp, 4(sp) |
297 | lw gp, 8(sp) | ||
298 | lw t9, 0xC(sp) | ||
347 | lw t8, 0x10(sp) | 299 | lw t8, 0x10(sp) |
348 | lw s7, 0x14(sp) | 300 | lw s7, 0x14(sp) |
349 | lw s6, 0x18(sp) | 301 | lw s6, 0x18(sp) |
@@ -375,15 +327,15 @@ _exception: | |||
375 | mthi k0 | 327 | mthi k0 |
376 | nop | 328 | nop |
377 | lw k0, 0x78(sp) | 329 | lw k0, 0x78(sp) |
378 | nop | ||
379 | mtc0 k0, C0_STATUS # Status register | 330 | mtc0 k0, C0_STATUS # Status register |
331 | nop | ||
380 | sll zero, 1 | 332 | sll zero, 1 |
381 | sll zero, 1 | 333 | sll zero, 1 |
382 | sll zero, 1 | 334 | sll zero, 1 |
383 | sll zero, 1 | 335 | sll zero, 1 |
384 | lw k0, 0x7C(sp) | 336 | lw k0, 0x7C(sp) |
385 | nop | ||
386 | mtc0 k0, C0_EPC # Exception Program Counter | 337 | mtc0 k0, C0_EPC # Exception Program Counter |
338 | nop | ||
387 | sll zero, 1 | 339 | sll zero, 1 |
388 | sll zero, 1 | 340 | sll zero, 1 |
389 | sll zero, 1 | 341 | sll zero, 1 |
diff --git a/firmware/thread.c b/firmware/thread.c index 453fbf510a..6efe8252e7 100644 --- a/firmware/thread.c +++ b/firmware/thread.c | |||
@@ -937,23 +937,23 @@ static inline void core_sleep(void) | |||
937 | void start_thread(void); /* Provide C access to ASM label */ | 937 | void start_thread(void); /* Provide C access to ASM label */ |
938 | static void __attribute__((used)) _start_thread(void) | 938 | static void __attribute__((used)) _start_thread(void) |
939 | { | 939 | { |
940 | /* $t1 = context */ | 940 | /* t1 = context */ |
941 | asm volatile ( | 941 | asm volatile ( |
942 | "start_thread: \n" | 942 | "start_thread: \n" |
943 | ".set noreorder \n" | 943 | ".set noreorder \n" |
944 | ".set noat \n" | 944 | ".set noat \n" |
945 | "lw $8, 4($9) \n" /* Fetch thread function pointer ($8 = $t0, $9 = $t1) */ | 945 | "lw $8, 4($9) \n" /* Fetch thread function pointer ($8 = t0, $9 = t1) */ |
946 | "lw $29, 40($9) \n" /* Set initial sp(=$29) */ | 946 | "lw $29, 40($9) \n" /* Set initial sp(=$29) */ |
947 | "jalr $8 \n" /* Start the thread */ | ||
947 | "sw $0, 48($9) \n" /* Clear start address */ | 948 | "sw $0, 48($9) \n" /* Clear start address */ |
948 | "jr $8 \n" /* Start the thread */ | ||
949 | "nop \n" | ||
950 | ".set at \n" | 949 | ".set at \n" |
951 | ".set reorder \n" | 950 | ".set reorder \n" |
951 | ::: "t0" | ||
952 | ); | 952 | ); |
953 | thread_exit(); | 953 | thread_exit(); |
954 | } | 954 | } |
955 | 955 | ||
956 | /* Place context pointer in $s0 slot, function pointer in $s1 slot, and | 956 | /* Place context pointer in s0 slot, function pointer in s1 slot, and |
957 | * start_thread pointer in context_start */ | 957 | * start_thread pointer in context_start */ |
958 | #define THREAD_STARTUP_INIT(core, thread, function) \ | 958 | #define THREAD_STARTUP_INIT(core, thread, function) \ |
959 | ({ (thread)->context.r[0] = (uint32_t)&(thread)->context, \ | 959 | ({ (thread)->context.r[0] = (uint32_t)&(thread)->context, \ |
@@ -969,22 +969,21 @@ static inline void store_context(void* addr) | |||
969 | asm volatile ( | 969 | asm volatile ( |
970 | ".set noreorder \n" | 970 | ".set noreorder \n" |
971 | ".set noat \n" | 971 | ".set noat \n" |
972 | "move $8, %0 \n" | 972 | "sw $16, 0(%0) \n" /* s0 */ |
973 | "sw $16, 0($8) \n" /* $s0 */ | 973 | "sw $17, 4(%0) \n" /* s1 */ |
974 | "sw $17, 4($8) \n" /* $s1 */ | 974 | "sw $18, 8(%0) \n" /* s2 */ |
975 | "sw $18, 8($8) \n" /* $s2 */ | 975 | "sw $19, 12(%0) \n" /* s3 */ |
976 | "sw $19, 12($8) \n" /* $s3 */ | 976 | "sw $20, 16(%0) \n" /* s4 */ |
977 | "sw $20, 16($8) \n" /* $s4 */ | 977 | "sw $21, 20(%0) \n" /* s5 */ |
978 | "sw $21, 20($8) \n" /* $s5 */ | 978 | "sw $22, 24(%0) \n" /* s6 */ |
979 | "sw $22, 24($8) \n" /* $s6 */ | 979 | "sw $23, 28(%0) \n" /* s7 */ |
980 | "sw $23, 28($8) \n" /* $s7 */ | 980 | "sw $28, 32(%0) \n" /* gp */ |
981 | "sw $28, 32($8) \n" /* gp */ | 981 | "sw $30, 36(%0) \n" /* fp */ |
982 | "sw $30, 36($8) \n" /* fp */ | 982 | "sw $29, 40(%0) \n" /* sp */ |
983 | "sw $29, 40($8) \n" /* sp */ | 983 | "sw $31, 44(%0) \n" /* ra */ |
984 | "sw $31, 44($8) \n" /* ra */ | ||
985 | ".set at \n" | 984 | ".set at \n" |
986 | ".set reorder \n" | 985 | ".set reorder \n" |
987 | : : "r" (addr) : "t0" | 986 | : : "r" (addr) |
988 | ); | 987 | ); |
989 | } | 988 | } |
990 | 989 | ||
@@ -997,29 +996,27 @@ static inline void load_context(const void* addr) | |||
997 | asm volatile ( | 996 | asm volatile ( |
998 | ".set noat \n" | 997 | ".set noat \n" |
999 | ".set noreorder \n" | 998 | ".set noreorder \n" |
1000 | "lw $8, 48(%0) \n" /* Get start address ($8 = $t0) */ | 999 | "lw $8, 48(%0) \n" /* Get start address ($8 = t0) */ |
1001 | "beqz $8, running \n" /* NULL -> already running */ | 1000 | "beqz $8, running \n" /* NULL -> already running */ |
1002 | "nop \n" | 1001 | "nop \n" |
1003 | "move $9, %0 \n" /* $t1 = context */ | ||
1004 | "jr $8 \n" | 1002 | "jr $8 \n" |
1005 | "nop \n" | 1003 | "move $9, %0 \n" /* t1 = context */ |
1006 | "running: \n" | 1004 | "running: \n" |
1007 | "move $8, %0 \n" | 1005 | "lw $16, 0(%0) \n" /* s0 */ |
1008 | "lw $16, 0($8) \n" /* $s0 */ | 1006 | "lw $17, 4(%0) \n" /* s1 */ |
1009 | "lw $17, 4($8) \n" /* $s1 */ | 1007 | "lw $18, 8(%0) \n" /* s2 */ |
1010 | "lw $18, 8($8) \n" /* $s2 */ | 1008 | "lw $19, 12(%0) \n" /* s3 */ |
1011 | "lw $19, 12($8) \n" /* $s3 */ | 1009 | "lw $20, 16(%0) \n" /* s4 */ |
1012 | "lw $20, 16($8) \n" /* $s4 */ | 1010 | "lw $21, 20(%0) \n" /* s5 */ |
1013 | "lw $21, 20($8) \n" /* $s5 */ | 1011 | "lw $22, 24(%0) \n" /* s6 */ |
1014 | "lw $22, 24($8) \n" /* $s6 */ | 1012 | "lw $23, 28(%0) \n" /* s7 */ |
1015 | "lw $23, 28($8) \n" /* $s7 */ | 1013 | "lw $28, 32(%0) \n" /* gp */ |
1016 | "lw $28, 32($8) \n" /* gp */ | 1014 | "lw $30, 36(%0) \n" /* fp */ |
1017 | "lw $30, 36($8) \n" /* fp */ | 1015 | "lw $29, 40(%0) \n" /* sp */ |
1018 | "lw $29, 40($8) \n" /* sp */ | 1016 | "lw $31, 44(%0) \n" /* ra */ |
1019 | "lw $31, 44($8) \n" /* ra */ | ||
1020 | ".set at \n" | 1017 | ".set at \n" |
1021 | ".set reorder \n" | 1018 | ".set reorder \n" |
1022 | : : "r" (addr) : "t0" /* only! */ | 1019 | : : "r" (addr) : "t0", "t1" |
1023 | ); | 1020 | ); |
1024 | } | 1021 | } |
1025 | 1022 | ||
@@ -1033,9 +1030,9 @@ static inline void core_sleep(void) | |||
1033 | __cpm_idle_mode(); | 1030 | __cpm_idle_mode(); |
1034 | #endif | 1031 | #endif |
1035 | asm volatile(".set mips32r2 \n" | 1032 | asm volatile(".set mips32r2 \n" |
1036 | "mfc0 $8, $12 \n" /* mfc $t0, $12 */ | 1033 | "mfc0 $8, $12 \n" /* mfc t0, $12 */ |
1037 | "move $9, $8 \n" /* move $t1, $t0 */ | 1034 | "move $9, $8 \n" /* move t1, t0 */ |
1038 | "la $10, 0x8000000 \n" /* la $t2, 0x8000000 */ | 1035 | "la $10, 0x8000000 \n" /* la t2, 0x8000000 */ |
1039 | "or $8, $8, $10 \n" /* Enable reduced power mode */ | 1036 | "or $8, $8, $10 \n" /* Enable reduced power mode */ |
1040 | "mtc0 $8, $12 \n" | 1037 | "mtc0 $8, $12 \n" |
1041 | "wait \n" | 1038 | "wait \n" |