osc2021/src/context.S at 088fb86c1c3b94861daf41fb6d07a5fb236ec084 · GrassLab/osc2021 · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
.global switch_to
switch_to:
    stp   x19, x20, [x0, 16 * 0]
    stp   x21, x22, [x0, 16 * 1]
    stp   x23, x24, [x0, 16 * 2]
    stp   x25, x26, [x0, 16 * 3]
    stp   x27, x28, [x0, 16 * 4]
    stp   fp, lr, [x0, 16 * 5]
    mov   x9, sp
    mrs   x10, ttbr0_el1
    stp   x9, x10, [x0, 16 * 6]

    ldp   x19, x20, [x1, 16 * 0]
    ldp   x21, x22, [x1, 16 * 1]
    ldp   x23, x24, [x1, 16 * 2]
    ldp   x25, x26, [x1, 16 * 3]
    ldp   x27, x28, [x1, 16 * 4]
    ldp   fp, lr, [x1, 16 * 5]
    ldp   x9, x10, [x1, 16 * 6]
    dsb   ish
    mov   sp, x9
    msr   ttbr0_el1, x10
    tlbi  vmalle1is
    dsb   ish
    isb
    msr   tpidr_el1, x1
    ret

.global get_current
get_current:
    mrs   x0, tpidr_el1
    ret

.global tpidr_el1_init
tpidr_el1_init:
    msr   tpidr_el1, x0
    ret