esp_wifi/preempt/
preempt_riscv.rs

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
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
use esp_wifi_sys::c_types;

use super::*;
use crate::hal::interrupt::TrapFrame;

#[derive(Debug, Clone, Copy)]
pub struct Context {
    trap_frame: TrapFrame,
    pub thread_semaphore: u32,
    pub next: *mut Context,
    pub allocated_stack: *const u8,
}

impl Context {
    pub(crate) fn new() -> Self {
        Context {
            trap_frame: TrapFrame::default(),
            thread_semaphore: 0,
            next: core::ptr::null_mut(),
            allocated_stack: core::ptr::null(),
        }
    }
}

pub(crate) fn task_create(
    task: extern "C" fn(*mut c_types::c_void),
    param: *mut c_types::c_void,
    task_stack_size: usize,
) -> *mut Context {
    unsafe {
        let ctx = allocate_task();

        (*ctx).trap_frame.pc = task as usize;
        (*ctx).trap_frame.a0 = param as usize;

        let stack = malloc(task_stack_size as u32);
        (*ctx).allocated_stack = stack.cast();

        // stack must be aligned by 16
        let task_stack_ptr = stack as usize + task_stack_size;
        let stack_ptr = task_stack_ptr - (task_stack_ptr % 0x10);
        (*ctx).trap_frame.sp = stack_ptr;

        ctx
    }
}

pub(crate) fn restore_task_context(ctx: *mut Context, trap_frame: &mut TrapFrame) {
    unsafe {
        trap_frame.ra = (*ctx).trap_frame.ra;
        trap_frame.sp = (*ctx).trap_frame.sp;
        trap_frame.a0 = (*ctx).trap_frame.a0;
        trap_frame.a1 = (*ctx).trap_frame.a1;
        trap_frame.a2 = (*ctx).trap_frame.a2;
        trap_frame.a3 = (*ctx).trap_frame.a3;
        trap_frame.a4 = (*ctx).trap_frame.a4;
        trap_frame.a5 = (*ctx).trap_frame.a5;
        trap_frame.a6 = (*ctx).trap_frame.a6;
        trap_frame.a7 = (*ctx).trap_frame.a7;
        trap_frame.t0 = (*ctx).trap_frame.t0;
        trap_frame.t1 = (*ctx).trap_frame.t1;
        trap_frame.t2 = (*ctx).trap_frame.t2;
        trap_frame.t3 = (*ctx).trap_frame.t3;
        trap_frame.t4 = (*ctx).trap_frame.t4;
        trap_frame.t5 = (*ctx).trap_frame.t5;
        trap_frame.t6 = (*ctx).trap_frame.t6;
        trap_frame.s0 = (*ctx).trap_frame.s0;
        trap_frame.s1 = (*ctx).trap_frame.s1;
        trap_frame.s2 = (*ctx).trap_frame.s2;
        trap_frame.s3 = (*ctx).trap_frame.s3;
        trap_frame.s4 = (*ctx).trap_frame.s4;
        trap_frame.s5 = (*ctx).trap_frame.s5;
        trap_frame.s6 = (*ctx).trap_frame.s6;
        trap_frame.s7 = (*ctx).trap_frame.s7;
        trap_frame.s8 = (*ctx).trap_frame.s8;
        trap_frame.s9 = (*ctx).trap_frame.s9;
        trap_frame.s10 = (*ctx).trap_frame.s10;
        trap_frame.s11 = (*ctx).trap_frame.s11;
        trap_frame.gp = (*ctx).trap_frame.gp;
        trap_frame.tp = (*ctx).trap_frame.tp;
        trap_frame.pc = (*ctx).trap_frame.pc;
    }
}

pub(crate) fn save_task_context(ctx: *mut Context, trap_frame: &TrapFrame) {
    unsafe {
        (*ctx).trap_frame.ra = trap_frame.ra;
        (*ctx).trap_frame.sp = trap_frame.sp;
        (*ctx).trap_frame.a0 = trap_frame.a0;
        (*ctx).trap_frame.a1 = trap_frame.a1;
        (*ctx).trap_frame.a2 = trap_frame.a2;
        (*ctx).trap_frame.a3 = trap_frame.a3;
        (*ctx).trap_frame.a4 = trap_frame.a4;
        (*ctx).trap_frame.a5 = trap_frame.a5;
        (*ctx).trap_frame.a6 = trap_frame.a6;
        (*ctx).trap_frame.a7 = trap_frame.a7;
        (*ctx).trap_frame.t0 = trap_frame.t0;
        (*ctx).trap_frame.t1 = trap_frame.t1;
        (*ctx).trap_frame.t2 = trap_frame.t2;
        (*ctx).trap_frame.t3 = trap_frame.t3;
        (*ctx).trap_frame.t4 = trap_frame.t4;
        (*ctx).trap_frame.t5 = trap_frame.t5;
        (*ctx).trap_frame.t6 = trap_frame.t6;
        (*ctx).trap_frame.s0 = trap_frame.s0;
        (*ctx).trap_frame.s1 = trap_frame.s1;
        (*ctx).trap_frame.s2 = trap_frame.s2;
        (*ctx).trap_frame.s3 = trap_frame.s3;
        (*ctx).trap_frame.s4 = trap_frame.s4;
        (*ctx).trap_frame.s5 = trap_frame.s5;
        (*ctx).trap_frame.s6 = trap_frame.s6;
        (*ctx).trap_frame.s7 = trap_frame.s7;
        (*ctx).trap_frame.s8 = trap_frame.s8;
        (*ctx).trap_frame.s9 = trap_frame.s9;
        (*ctx).trap_frame.s10 = trap_frame.s10;
        (*ctx).trap_frame.s11 = trap_frame.s11;
        (*ctx).trap_frame.gp = trap_frame.gp;
        (*ctx).trap_frame.tp = trap_frame.tp;
        (*ctx).trap_frame.pc = trap_frame.pc;
    }
}