esp_wifi/preempt/
preempt_xtensa.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
use esp_wifi_sys::c_types;

use super::*;
use crate::hal::trapframe::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::new(),
            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 {
    trace!("task_create {:?} {:?} {}", task, param, task_stack_size);
    unsafe {
        let ctx = allocate_task();

        (*ctx).trap_frame.PC = task as usize as u32;
        (*ctx).trap_frame.A6 = param as usize as u32;

        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 % 16);
        (*ctx).trap_frame.A1 = stack_ptr as u32;

        (*ctx).trap_frame.PS = 0x00040000 | (1 & 3) << 16; // For windowed ABI set WOE and CALLINC (pretend task was 'call4'd).

        (*ctx).trap_frame.A0 = 0;

        *((task_stack_ptr - 4) as *mut u32) = 0;
        *((task_stack_ptr - 8) as *mut u32) = 0;
        *((task_stack_ptr - 12) as *mut u32) = stack_ptr as u32;
        *((task_stack_ptr - 16) as *mut u32) = 0;

        ctx
    }
}

pub(crate) fn restore_task_context(ctx: *mut Context, trap_frame: &mut TrapFrame) {
    unsafe {
        *trap_frame = (*ctx).trap_frame;
    }
}

pub(crate) fn save_task_context(ctx: *mut Context, trap_frame: &TrapFrame) {
    unsafe {
        (*ctx).trap_frame = *trap_frame;
    }
}