1 | //
|
---|
2 | // Cforall Version 1.0.0 Copyright (C) 2016 University of Waterloo
|
---|
3 | //
|
---|
4 | // CtxSwitch-arm64.S --
|
---|
5 | //
|
---|
6 | // Author : Peter A. Buhr
|
---|
7 | // Created On : Sun Aug 16 07:50:13 2020
|
---|
8 | // Last Modified By : Peter A. Buhr
|
---|
9 | // Last Modified On : Wed Aug 26 16:24:59 2020
|
---|
10 | // Update Count : 25
|
---|
11 | //
|
---|
12 |
|
---|
13 | // The context switch routine requires the initial the stack of a thread to
|
---|
14 | // look like the thread has saved its context in the normal manner.
|
---|
15 |
|
---|
16 | // Offsets must synchronized with the __stack_context_t in invoke.h.
|
---|
17 |
|
---|
18 | #define PTR_BYTE 8
|
---|
19 | #define SP_OFFSET ( 0 * PTR_BYTE )
|
---|
20 | #define FP_OFFSET ( 1 * PTR_BYTE )
|
---|
21 |
|
---|
22 | // Context switch between coroutines/tasks.
|
---|
23 | // void __cfactx_switch( struct __stack_context_t * from, struct __stack_context_t * to ) ;
|
---|
24 | // Arguments "from" in register x0, "to" in register x1.
|
---|
25 |
|
---|
26 | #define SAVE 20 * 8
|
---|
27 |
|
---|
28 | .file "CtxSwitch-arm64.S"
|
---|
29 | .text
|
---|
30 | .align 2
|
---|
31 | .global __cfactx_switch
|
---|
32 | .type __cfactx_switch, %function
|
---|
33 | __cfactx_switch:
|
---|
34 |
|
---|
35 | sub sp, sp, #SAVE // push stack
|
---|
36 |
|
---|
37 | // Save volatile GP registers x19-x30 on the stack.
|
---|
38 |
|
---|
39 | stp x19, x20, [sp, #0x00]
|
---|
40 | stp x21, x22, [sp, #0x10]
|
---|
41 | stp x23, x24, [sp, #0x20]
|
---|
42 | stp x25, x26, [sp, #0x30]
|
---|
43 | stp x27, x28, [sp, #0x40]
|
---|
44 | stp x29, x30, [sp, #0x50] // x29 => fp
|
---|
45 |
|
---|
46 | // Save volatile SIMD/FPU registers d8-d15 on the stack.
|
---|
47 |
|
---|
48 | stp d8, d9, [sp, #0x60]
|
---|
49 | stp d10, d11, [sp, #0x70]
|
---|
50 | stp d12, d13, [sp, #0x80]
|
---|
51 | stp d14, d15, [sp, #0x90]
|
---|
52 |
|
---|
53 | // Save old context in the "from" area.
|
---|
54 |
|
---|
55 | mov x4, sp // cannot store sp directly
|
---|
56 | str x4, [x0, #SP_OFFSET]
|
---|
57 | str fp, [x0, #FP_OFFSET]
|
---|
58 |
|
---|
59 | // Load new context from the "to" area.
|
---|
60 |
|
---|
61 | ldr fp, [x1, #FP_OFFSET]
|
---|
62 | ldr x4, [x1, #SP_OFFSET]
|
---|
63 | mov sp, x4 // cannot store sp directly
|
---|
64 |
|
---|
65 | // Load volatile GP registers x19-x30 from the stack.
|
---|
66 |
|
---|
67 | ldp x19, x20, [sp, #0x00]
|
---|
68 | ldp x21, x22, [sp, #0x10]
|
---|
69 | ldp x23, x24, [sp, #0x20]
|
---|
70 | ldp x25, x26, [sp, #0x30]
|
---|
71 | ldp x27, x28, [sp, #0x40]
|
---|
72 | ldp x29, x30, [sp, #0x50]
|
---|
73 |
|
---|
74 | // Load volatile SIMD/FPU registers d8-d15 from the stack.
|
---|
75 |
|
---|
76 | ldp d8, d9, [sp, #0x60]
|
---|
77 | ldp d10, d11, [sp, #0x70]
|
---|
78 | ldp d12, d13, [sp, #0x80]
|
---|
79 | ldp d14, d15, [sp, #0x90]
|
---|
80 |
|
---|
81 | add sp, sp, #SAVE // pop stack
|
---|
82 | ret // return to new thread (mov pc, x30)
|
---|
83 |
|
---|
84 | .size __cfactx_switch, .-__cfactx_switch
|
---|
85 | .section .note.GNU-stack,"",%progbits // mark no executable stack needed
|
---|
86 |
|
---|
87 | // Stub to create new stacks which can be context switched to
|
---|
88 | // void __cfactx_invoke_stub( void );
|
---|
89 |
|
---|
90 | .text
|
---|
91 | .align 2
|
---|
92 | .global __cfactx_invoke_stub
|
---|
93 | .type __cfactx_invoke_stub, %function
|
---|
94 | __cfactx_invoke_stub:
|
---|
95 | mov x0, x19 // load main as parameter 0
|
---|
96 | mov x1, x20 // load this as parameter 1
|
---|
97 | mov x30, x21 // load coroutine invoke routine
|
---|
98 | ret // and jmp to it (mov pc, x30)
|
---|
99 | .size __cfactx_invoke_stub, .-__cfactx_invoke_stub
|
---|
100 |
|
---|
101 | // Local Variables: //
|
---|
102 | // mode: c //
|
---|
103 | // tab-width: 4 //
|
---|
104 | // End: //
|
---|