src/cortex_a9/mutex.rs

@@ -3,25 +3,9 @@ use core::sync::atomic::{AtomicU32, Ordering};
 use core::cell::UnsafeCell;
 use super::asm::*;
 
-/// [Power-saving features](http://infocenter.arm.com/help/index.jsp?topic=/com.arm.doc.dht0008a/ch01s03s02.html)
-#[inline]
-fn wait_for_update() {
-    wfe();
-}
-
-/// [Power-saving features](http://infocenter.arm.com/help/index.jsp?topic=/com.arm.doc.dht0008a/ch01s03s02.html)
-#[inline]
-fn signal_update() {
-    dsb();
-    sev();
-}
-
 const LOCKED: u32 = 1;
 const UNLOCKED: u32 = 0;
 
-/// Mutex implementation for Cortex-A9
-///
-/// [ARM Synchronization Primitives Development Article: Implementing a mutex](http://infocenter.arm.com/help/index.jsp?topic=/com.arm.doc.dht0008a/ch01s03s02.html)
 pub struct Mutex<T> {
     locked: AtomicU32,
     inner: UnsafeCell<T>,
@@ -31,19 +15,15 @@ unsafe impl<T: Send> Sync for Mutex<T> {}
 unsafe impl<T: Send> Send for Mutex<T> {}
 
 impl<T> Mutex<T> {
-    /// Constructor, const-fn
     pub const fn new(inner: T) -> Self {
         Mutex{
             locked: AtomicU32::new(UNLOCKED),
             inner: UnsafeCell::new(inner),
         }
     }
-
+    
-    /// Lock the Mutex, blocks when already locked
     pub fn lock(&self) -> MutexGuard<T> {
-        while self.locked.compare_and_swap(UNLOCKED, LOCKED, Ordering::Acquire) != UNLOCKED {
+        while self.locked.compare_and_swap(UNLOCKED, LOCKED, Ordering::Acquire) != UNLOCKED {}
-            wait_for_update();
-        }
         dmb();
         MutexGuard { mutex: self }
     }
@@ -51,13 +31,10 @@ impl<T> Mutex<T> {
     fn unlock(&self) {
         dmb();
         self.locked.store(UNLOCKED, Ordering::Release);
-
+        dsb();
-        signal_update();
     }
 }
 
-/// Returned by `Mutex.lock()`, allows access to data via
-/// `Deref`/`DerefMutx`
 pub struct MutexGuard<'a, T> {
     mutex: &'a Mutex<T>,
 }
@@ -75,7 +52,6 @@ impl<'a, T> DerefMut for MutexGuard<'a, T> {
     }
 }
 
-/// Automatically `Mutex.unlock()` when this reference is dropped
 impl<'a, T> Drop for MutexGuard<'a, T> {
     fn drop(&mut self) {
         self.mutex.unlock();

src/main.rs

@@ -122,6 +122,5 @@ pub fn main() {
 }
 
 pub fn main_core1() {
-    println!("Hello from core1!");
     loop {}
 }

src/ram.rs

@@ -1,35 +1,36 @@
+use core::cell::RefCell;
 use core::alloc::GlobalAlloc;
 use core::ptr::NonNull;
 use alloc::alloc::Layout;
 use linked_list_allocator::Heap;
-use crate::cortex_a9::mutex::Mutex;
 use crate::zynq::ddr::DdrRam;
 
 #[global_allocator]
-static ALLOCATOR: CortexA9Alloc = CortexA9Alloc(Mutex::new(Heap::empty()));
+static ALLOCATOR: HeapAlloc = HeapAlloc(RefCell::new(Heap::empty()));
 
 /// LockedHeap doesn't locking properly
-struct CortexA9Alloc(Mutex<Heap>);
+struct HeapAlloc(RefCell<Heap>);
 
-unsafe impl Sync for CortexA9Alloc {}
+/// FIXME: unsound; lock properly
+unsafe impl Sync for HeapAlloc {}
 
-unsafe impl GlobalAlloc for CortexA9Alloc {
+unsafe impl GlobalAlloc for HeapAlloc {
     unsafe fn alloc(&self, layout: Layout) -> *mut u8 {
-        self.0.lock()
+        self.0.borrow_mut()
             .allocate_first_fit(layout)
             .ok()
             .map_or(0 as *mut u8, |allocation| allocation.as_ptr())
     }
 
     unsafe fn dealloc(&self, ptr: *mut u8, layout: Layout) {
-        self.0.lock()
+        self.0.borrow_mut()
             .deallocate(NonNull::new_unchecked(ptr), layout)
     }
 }
 
 pub fn init_alloc(ddr: &mut DdrRam) {
     unsafe {
-        ALLOCATOR.0.lock()
+        ALLOCATOR.0.borrow_mut()
             .init(ddr.ptr::<u8>() as usize, ddr.size());
     }
 }

src/stdio.rs

@@ -1,44 +1,19 @@
-use core::ops::{Deref, DerefMut};
-use crate::cortex_a9::mutex::{Mutex, MutexGuard};
 use crate::zynq::uart::Uart;
 
 const UART_RATE: u32 = 115_200;
-static mut UART: Mutex<LazyUart> = Mutex::new(LazyUart::Uninitialized);
+static mut UART: Option<Uart> = None;
 
+// TODO: locking for SMP
 #[doc(hidden)]
-pub fn get_uart<'a>() -> MutexGuard<'a, LazyUart> {
+pub fn get_uart() -> &'static mut Uart {
-    unsafe { UART.lock() }
+    unsafe {
-}
+        match &mut UART {
-
+            None => {
-/// Initializes the UART on first use through `.deref_mut()` for debug
-/// output through the `print!` and `println!` macros.
-pub enum LazyUart {
-    Uninitialized,
-    Initialized(Uart),
-}
-
-impl Deref for LazyUart {
-    type Target = Uart;
-    fn deref(&self) -> &Uart {
-        match self {
-            LazyUart::Uninitialized =>
-                panic!("stdio not initialized!"),
-            LazyUart::Initialized(uart) =>
-                uart,
-        }
-    }
-}
-
-impl DerefMut for LazyUart {
-    fn deref_mut(&mut self) -> &mut Uart {
-        match self {
-            LazyUart::Uninitialized => {
                 let uart = Uart::serial(UART_RATE);
-                *self = LazyUart::Initialized(uart);
+                UART = Some(uart);
-                self
+                UART.as_mut().unwrap()
             }
-            LazyUart::Initialized(uart) =>
+            Some(uart) => uart,
-                uart,
         }
     }
 }
@@ -47,7 +22,7 @@ impl DerefMut for LazyUart {
 macro_rules! print {
     ($($arg:tt)*) => ({
         use core::fmt::Write;
-        let mut uart = crate::stdio::get_uart();
+        let uart = crate::stdio::get_uart();
         let _ = write!(uart, $($arg)*);
     })
 }
@@ -56,7 +31,7 @@ macro_rules! print {
 macro_rules! println {
     ($($arg:tt)*) => ({
         use core::fmt::Write;
-        let mut uart = crate::stdio::get_uart();
+        let uart = crate::stdio::get_uart();
         let _ = write!(uart, $($arg)*);
         let _ = write!(uart, "\r\n");
         while !uart.tx_fifo_empty() {}