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
use crate::processor;
use core::{
    ptr,
    task::{RawWaker, RawWakerVTable, Waker},
};

static VTABLE: RawWakerVTable = RawWakerVTable::new(clone, wake, wake, drop);

pub struct WakeRoot(());

#[allow(clippy::unused_self)]
impl WakeRoot {
    pub fn new() -> Self {
        Self(())
    }

    pub fn wait() {
        processor::wait_for_event();
    }

    pub fn to_waker(&self) -> Waker {
        unsafe { Waker::from_raw(raw_waker()) }
    }
}

fn raw_waker() -> RawWaker {
    RawWaker::new(ptr::null(), &VTABLE)
}

unsafe fn clone(_data: *const ()) -> RawWaker {
    raw_waker()
}

unsafe fn wake(_data: *const ()) {
    // In r0p0, r1p0, r1p1 and r2p0 versions of Cortex-M3 the event register is not
    // set for the exception entry, exception exit or debug events.
    #[cfg(any(
        cortexm_core = "cortexm3_r0p0",
        cortexm_core = "cortexm3_r1p0",
        cortexm_core = "cortexm3_r1p1",
        cortexm_core = "cortexm3_r2p0",
    ))]
    processor::send_event();
}