add missing ReadFlash(optional) function

toxxin · toxxin · commit e830a7a87005 · 2024-12-22T22:52:33.000+01:00
Signed-off-by: Anton Glukhov &lt;anton.a.glukhov@gmail.com&gt;
diff --git a/Cargo.toml b/Cargo.toml
@@ -14,4 +14,5 @@ description = "A crate to write CMSIS-DAP flash algorithms for flashing embedded
 default = ["erase-chip", "panic-handler"]
 erase-chip = []
 panic-handler = []
+read-flash = []
 verify = []
diff --git a/src/lib.rs b/src/lib.rs
@@ -75,6 +75,15 @@ pub trait FlashAlgorithm: Sized + 'static {
     /// * `data` - The data to compare with.
     #[cfg(feature = "verify")]
     fn verify(&mut self, address: u32, size: u32, data: Option<&[u8]>) -> Result<(), ErrorCode>;
+
+    /// Read flash.
+    ///
+    /// # Arguments
+    ///
+    /// * `address` - The start address of the flash to read.
+    /// * `data` - The data.
+    #[cfg(feature = "read-flash")]
+    fn read_flash(&mut self, address: u32, data: &mut [u8]) -> Result<(), ErrorCode>;
 }
 
 #[derive(Debug, Copy, Clone, PartialEq, Eq, Hash)]
@@ -167,6 +176,7 @@ macro_rules! algorithm {
             }
         }
         $crate::erase_chip!($type);
+        $crate::read_flash!($type);
         $crate::verify!($type);
 
         #[allow(non_upper_case_globals)]
@@ -270,6 +280,33 @@ macro_rules! erase_chip {
     };
 }
 
+#[doc(hidden)]
+#[macro_export]
+#[cfg(not(feature = "read-flash"))]
+macro_rules! read_flash {
+    ($type:ty) => {};
+}
+#[doc(hidden)]
+#[macro_export]
+#[cfg(feature = "read-flash")]
+macro_rules! read_flash {
+    ($type:ty) => {
+        #[no_mangle]
+        #[link_section = ".entry"]
+        pub unsafe extern "C" fn ReadFlash(addr: u32, size: u32, data: *mut u8) -> u32 {
+            if !_IS_INIT {
+                return 1;
+            }
+            let this = &mut *_ALGO_INSTANCE.as_mut_ptr();
+            let data_slice: &mut [u8] = unsafe { core::slice::from_raw_parts_mut(data, size as usize) };
+            match <$type as $crate::FlashAlgorithm>::read_flash(this, addr, data_slice) {
+                Ok(()) => 0,
+                Err(e) => e.get(),
+            }
+        }
+    };
+}
+
 #[doc(hidden)]
 #[macro_export]
 #[cfg(not(feature = "verify"))]
