This commit is contained in:
Emil Fresk 2020-12-13 17:48:11 +01:00
parent 6277183906
commit aaa92ea2fa
3 changed files with 47 additions and 63 deletions

View file

@ -204,10 +204,6 @@ pub fn codegen(
items.push(quote!(
#(#cfgs)*
pub fn spawn(#(#args,)*) -> Result<(), #ty> {
// #let_instant // do we need it?
use rtic::Mutex as _;
use rtic::mutex_prelude::*;
let input = #tupled;
unsafe {
@ -277,9 +273,6 @@ pub fn codegen(
#(,#args)*
) -> Result<(), #ty> {
unsafe {
use rtic::Mutex as _;
use rtic::mutex_prelude::*;
let input = #tupled;
if let Some(index) = rtic::export::interrupt::free(|_| #app_path::#fq.dequeue()) {
#app_path::#inputs

View file

@ -68,8 +68,6 @@ pub fn codegen(app: &App, analysis: &Analysis, _extra: &Extra) -> Vec<TokenStrea
// Timer queue handler
{
let enum_ = util::interrupt_ident();
let app_name = &app.name;
let app_path = quote! {crate::#app_name};
let rt_err = util::rt_err_ident();
let arms = app
@ -111,8 +109,6 @@ pub fn codegen(app: &App, analysis: &Analysis, _extra: &Extra) -> Vec<TokenStrea
items.push(quote!(
#[no_mangle]
unsafe fn #bound_interrupt() {
use rtic::Mutex as _;
while let Some((task, index)) = rtic::export::interrupt::free(|_| #tq.dequeue(
|| #enable_isr,
))

View file

@ -2,17 +2,17 @@ use crate::{time::Instant, Monotonic};
use core::cmp::Ordering;
use heapless::{binary_heap::Min, ArrayLength, BinaryHeap};
pub struct TimerQueue<M, T, N>(pub BinaryHeap<NotReady<M, T>, N, Min>)
pub struct TimerQueue<Mono, Task, N>(pub BinaryHeap<NotReady<Mono, Task>, N, Min>)
where
M: Monotonic,
N: ArrayLength<NotReady<M, T>>,
T: Copy;
Mono: Monotonic,
N: ArrayLength<NotReady<Mono, Task>>,
Task: Copy;
impl<M, T, N> TimerQueue<M, T, N>
impl<Mono, Task, N> TimerQueue<Mono, Task, N>
where
M: Monotonic,
N: ArrayLength<NotReady<M, T>>,
T: Copy,
Mono: Monotonic,
N: ArrayLength<NotReady<Mono, Task>>,
Task: Copy,
{
/// # Safety
///
@ -23,7 +23,7 @@ where
#[inline]
pub unsafe fn enqueue_unchecked<F1, F2>(
&mut self,
nr: NotReady<M, T>,
nr: NotReady<Mono, Task>,
enable_interrupt: F1,
pend_handler: F2,
) where
@ -63,34 +63,30 @@ where
/// Dequeue a task from the TimerQueue
#[inline]
pub fn dequeue<F>(&mut self, disable_interrupt: F) -> Option<(T, u8)>
pub fn dequeue<F>(&mut self, disable_interrupt: F) -> Option<(Task, u8)>
where
F: FnOnce(),
{
unsafe {
M::clear_compare();
Mono::clear_compare();
if let Some(instant) = self.0.peek().map(|p| p.instant) {
let now = M::now();
match instant.checked_duration_since(&now) {
None => {
if instant < Mono::now() {
// instant < now
// task became ready
let nr = self.0.pop_unchecked();
Some((nr.task, nr.index))
}
Some(_) => {
} else {
// TODO: Fix this hack...
// Extract the compare time
M::set_compare(*instant.duration_since_epoch().integer());
Mono::set_compare(*instant.duration_since_epoch().integer());
// Double check that the instant we set is really in the future, else
// dequeue. If the monotonic is fast enough it can happen that from the
// read of now to the set of the compare, the time can overflow. This is to
// guard against this.
if instant.checked_duration_since(&M::now()).is_none() {
if instant < Mono::now() {
let nr = self.0.pop_unchecked();
Some((nr.task, nr.index))
@ -101,7 +97,6 @@ where
// Start counting down from the new reload
// mem::transmute::<_, SYST>(()).clear_current();
}
}
} else {
// The queue is empty
// mem::transmute::<_, SYST>(()).disable_interrupt();
@ -113,47 +108,47 @@ where
}
}
pub struct NotReady<M, T>
pub struct NotReady<Mono, Task>
where
T: Copy,
M: Monotonic,
Task: Copy,
Mono: Monotonic,
{
pub index: u8,
pub instant: Instant<M>,
pub task: T,
pub instant: Instant<Mono>,
pub task: Task,
}
impl<M, T> Eq for NotReady<M, T>
impl<Mono, Task> Eq for NotReady<Mono, Task>
where
T: Copy,
M: Monotonic,
Task: Copy,
Mono: Monotonic,
{
}
impl<M, T> Ord for NotReady<M, T>
impl<Mono, Task> Ord for NotReady<Mono, Task>
where
T: Copy,
M: Monotonic,
Task: Copy,
Mono: Monotonic,
{
fn cmp(&self, other: &Self) -> Ordering {
self.instant.cmp(&other.instant)
}
}
impl<M, T> PartialEq for NotReady<M, T>
impl<Mono, Task> PartialEq for NotReady<Mono, Task>
where
T: Copy,
M: Monotonic,
Task: Copy,
Mono: Monotonic,
{
fn eq(&self, other: &Self) -> bool {
self.instant == other.instant
}
}
impl<M, T> PartialOrd for NotReady<M, T>
impl<Mono, Task> PartialOrd for NotReady<Mono, Task>
where
T: Copy,
M: Monotonic,
Task: Copy,
Mono: Monotonic,
{
fn partial_cmp(&self, other: &Self) -> Option<Ordering> {
Some(self.cmp(&other))