1 files changed, 30 insertions, 1 deletions

diff --git a/embassy-executor/src/raw/run_queue.rs b/embassy-executor/src/raw/run_queue.rs
index c6c7d7109..5fd703aad 100644
--- a/embassy-executor/src/raw/run_queue.rs
+++ b/embassy-executor/src/raw/run_queue.rs
@@ -9,7 +9,7 @@ use cordyceps::SortedList;
 type TransferStack<T> = cordyceps::TransferStack<T>;
 
 #[cfg(not(target_has_atomic = "ptr"))]
-type TransferStack<T> = cordyceps::MutexTransferStack<mutex::raw_impls::cs::CriticalSectionRawMutex, T>;
+type TransferStack<T> = MutexTransferStack<T>;
 
 use super::{TaskHeader, TaskRef};
 
@@ -149,3 +149,32 @@ fn run_dequeue(taskref: &TaskRef) {
         taskref.header().state.run_dequeue(cs);
     })
 }
+
+/// A wrapper type that acts like TransferStack by wrapping a normal Stack in a CS mutex
+#[cfg(not(target_has_atomic="ptr"))]
+struct MutexTransferStack<T: Linked<cordyceps::stack::Links<T>>> {
+    inner: mutex::BlockingMutex<mutex::raw_impls::cs::CriticalSectionRawMutex, cordyceps::Stack<T>>,
+}
+
+#[cfg(not(target_has_atomic="ptr"))]
+impl<T: Linked<cordyceps::stack::Links<T>>> MutexTransferStack<T> {
+    const fn new() -> Self {
+        Self {
+            inner: mutex::BlockingMutex::new(cordyceps::Stack::new()),
+        }
+    }
+
+    fn push_was_empty(&self, item: T::Handle) -> bool {
+        self.inner.with_lock(|stack| {
+            let is_empty = stack.is_empty();
+            stack.push(item);
+            is_empty
+        })
+    }
+
+    fn take_all(&self) -> cordyceps::Stack<T> {
+        self.inner.with_lock(|stack| {
+            stack.take_all()
+        })
+    }
+}