mirror of
https://github.com/rtic-rs/rtic.git
synced 2024-12-17 23:49:35 +01:00
now uses the async_await syntax
This commit is contained in:
parent
36c17931e9
commit
1e26a536cd
1 changed files with 215 additions and 0 deletions
215
examples/async_systick3.rs
Normal file
215
examples/async_systick3.rs
Normal file
|
@ -0,0 +1,215 @@
|
||||||
|
//! examples/async_task2
|
||||||
|
#![no_main]
|
||||||
|
#![no_std]
|
||||||
|
#![feature(const_fn)]
|
||||||
|
#![feature(type_alias_impl_trait)]
|
||||||
|
|
||||||
|
// use core::cell::Cell;
|
||||||
|
// use core::cell::UnsafeCell;
|
||||||
|
use core::future::Future;
|
||||||
|
use core::mem;
|
||||||
|
// use core::mem::MaybeUninit;
|
||||||
|
use core::pin::Pin;
|
||||||
|
// use core::ptr;
|
||||||
|
// use core::ptr::NonNull;
|
||||||
|
// use core::sync::atomic::{AtomicPtr, AtomicU32, Ordering};
|
||||||
|
use core::task::{Context, Poll, RawWaker, RawWakerVTable, Waker};
|
||||||
|
use rtic::async_util::Task;
|
||||||
|
|
||||||
|
use cortex_m_semihosting::{debug, hprintln};
|
||||||
|
|
||||||
|
use panic_semihosting as _;
|
||||||
|
use rtic::Mutex;
|
||||||
|
|
||||||
|
#[rtic::app(device = lm3s6965, dispatchers = [SSI0])]
|
||||||
|
mod app {
|
||||||
|
use crate::*;
|
||||||
|
|
||||||
|
#[resources]
|
||||||
|
struct Resources {
|
||||||
|
systick: Systick,
|
||||||
|
}
|
||||||
|
|
||||||
|
#[init]
|
||||||
|
fn init(cx: init::Context) -> init::LateResources {
|
||||||
|
hprintln!("init").ok();
|
||||||
|
foo::spawn().unwrap();
|
||||||
|
init::LateResources {
|
||||||
|
systick: Systick {
|
||||||
|
syst: cx.core.SYST,
|
||||||
|
state: State::Done,
|
||||||
|
queue: BinaryHeap::new(),
|
||||||
|
// waker: None,
|
||||||
|
},
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#[idle]
|
||||||
|
fn idle(_: idle::Context) -> ! {
|
||||||
|
// debug::exit(debug::EXIT_SUCCESS);
|
||||||
|
loop {
|
||||||
|
hprintln!("idle").ok();
|
||||||
|
cortex_m::asm::wfi(); // put the MCU in sleep mode until interrupt occurs
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#[task(resources = [systick])]
|
||||||
|
async fn foo(mut cx: foo::Context) {
|
||||||
|
// BEGIN BOILERPLATE
|
||||||
|
type F = impl Future + 'static;
|
||||||
|
fn create(cx: foo::Context<'static>) -> F {
|
||||||
|
task(cx)
|
||||||
|
}
|
||||||
|
|
||||||
|
static mut TASK: Task<F> = Task::new();
|
||||||
|
|
||||||
|
hprintln!("foo trampoline").ok();
|
||||||
|
unsafe {
|
||||||
|
match TASK {
|
||||||
|
Task::Idle | Task::Done(_) => {
|
||||||
|
hprintln!("foo spawn task").ok();
|
||||||
|
TASK.spawn(|| create(mem::transmute(cx)));
|
||||||
|
}
|
||||||
|
_ => {}
|
||||||
|
};
|
||||||
|
|
||||||
|
hprintln!("foo trampoline poll").ok();
|
||||||
|
TASK.poll(|| {
|
||||||
|
let _ = foo::spawn();
|
||||||
|
});
|
||||||
|
|
||||||
|
match TASK {
|
||||||
|
Task::Done(ref r) => {
|
||||||
|
hprintln!("foo trampoline done").ok();
|
||||||
|
// hprintln!("r = {:?}", mem::transmute::<_, &u32>(r)).ok();
|
||||||
|
}
|
||||||
|
_ => {
|
||||||
|
hprintln!("foo trampoline running").ok();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
// END BOILERPLATE
|
||||||
|
|
||||||
|
async fn task(mut cx: foo::Context<'static>) {
|
||||||
|
hprintln!("foo task").ok();
|
||||||
|
|
||||||
|
hprintln!("prepare two futures").ok();
|
||||||
|
let d1 = timer_delay(&mut cx.resources.systick, 5000000);
|
||||||
|
let d2 = timer_delay(&mut cx.resources.systick, 1000000);
|
||||||
|
|
||||||
|
//let pair = futures::future::join(d1, d2);
|
||||||
|
hprintln!("foo task resumed").ok();
|
||||||
|
|
||||||
|
hprintln!("delay short time").ok();
|
||||||
|
timer_delay(&mut cx.resources.systick, 1000000).await;
|
||||||
|
hprintln!("foo task resumed").ok();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
// RTIC task bound to the HW SysTick interrupt
|
||||||
|
#[task(binds = SysTick, resources = [systick], priority = 2)]
|
||||||
|
fn systic(mut cx: systic::Context) {
|
||||||
|
hprintln!("systic interrupt").ok();
|
||||||
|
cx.resources.systick.lock(|s| {
|
||||||
|
s.syst.disable_interrupt();
|
||||||
|
s.state = State::Done;
|
||||||
|
s.queue.pop().map(|w| w.waker.wake());
|
||||||
|
if let Some(w) = s.queue.peek() {
|
||||||
|
s.syst.set_reload(w.time);
|
||||||
|
} else {
|
||||||
|
s.syst.disable_interrupt();
|
||||||
|
}
|
||||||
|
});
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
//=============
|
||||||
|
// Timer
|
||||||
|
// Later we want a proper queue
|
||||||
|
|
||||||
|
//use core::cmp::{Ord, Ordering, PartialOrd};
|
||||||
|
use core::cmp::Ordering;
|
||||||
|
use heapless::binary_heap::{BinaryHeap, Max};
|
||||||
|
use heapless::consts::U8;
|
||||||
|
use heapless::Vec;
|
||||||
|
|
||||||
|
pub enum State {
|
||||||
|
Started,
|
||||||
|
Done,
|
||||||
|
}
|
||||||
|
|
||||||
|
struct Timeout {
|
||||||
|
time: u32,
|
||||||
|
waker: Waker,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl Ord for Timeout {
|
||||||
|
fn cmp(&self, other: &Self) -> Ordering {
|
||||||
|
self.time.cmp(&other.time)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl PartialOrd for Timeout {
|
||||||
|
fn partial_cmp(&self, other: &Self) -> Option<Ordering> {
|
||||||
|
Some(self.cmp(&other))
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl PartialEq for Timeout {
|
||||||
|
fn eq(&self, other: &Self) -> bool {
|
||||||
|
self.time == other.time
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl Eq for Timeout {}
|
||||||
|
|
||||||
|
pub struct Systick {
|
||||||
|
syst: cortex_m::peripheral::SYST,
|
||||||
|
state: State,
|
||||||
|
queue: BinaryHeap<Timeout, U8, Max>,
|
||||||
|
}
|
||||||
|
|
||||||
|
//=============
|
||||||
|
// Timer
|
||||||
|
// Later we want a proper queue
|
||||||
|
|
||||||
|
pub struct Timer<'a, T: Mutex<T = Systick>> {
|
||||||
|
request: Option<u32>,
|
||||||
|
systick: &'a mut T,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl<'a, T: Mutex<T = Systick>> Future for Timer<'a, T> {
|
||||||
|
type Output = ();
|
||||||
|
fn poll(mut self: Pin<&mut Self>, cx: &mut Context<'_>) -> Poll<Self::Output> {
|
||||||
|
let Self { request, systick } = &mut *self;
|
||||||
|
systick.lock(|s| {
|
||||||
|
// enqueue a new request
|
||||||
|
request.take().map(|t| {
|
||||||
|
s.syst.set_reload(t);
|
||||||
|
s.syst.enable_counter();
|
||||||
|
s.syst.enable_interrupt();
|
||||||
|
s.state = State::Started;
|
||||||
|
s.queue.push(Timeout {
|
||||||
|
time: t,
|
||||||
|
waker: cx.waker().clone(),
|
||||||
|
});
|
||||||
|
});
|
||||||
|
|
||||||
|
match s.state {
|
||||||
|
State::Done => Poll::Ready(()),
|
||||||
|
State::Started => {
|
||||||
|
// s.waker = Some(cx.waker().clone());
|
||||||
|
Poll::Pending
|
||||||
|
}
|
||||||
|
}
|
||||||
|
})
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
fn timer_delay<'a, T: Mutex<T = Systick>>(systick: &'a mut T, t: u32) -> Timer<'a, T> {
|
||||||
|
hprintln!("timer_delay {}", t);
|
||||||
|
Timer {
|
||||||
|
request: Some(t),
|
||||||
|
systick,
|
||||||
|
}
|
||||||
|
}
|
Loading…
Reference in a new issue