embassy_embedded_hal/flash/partition/
blocking.rs1use core::cell::RefCell;
2
3use embassy_sync::blocking_mutex::raw::RawMutex;
4use embassy_sync::blocking_mutex::Mutex;
5use embedded_storage::nor_flash::{ErrorType, NorFlash, ReadNorFlash};
6
7use super::Error;
8
9pub struct BlockingPartition<'a, M: RawMutex, T: NorFlash> {
17 flash: &'a Mutex<M, RefCell<T>>,
18 offset: u32,
19 size: u32,
20}
21
22impl<'a, M: RawMutex, T: NorFlash> Clone for BlockingPartition<'a, M, T> {
23 fn clone(&self) -> Self {
24 Self {
25 flash: self.flash,
26 offset: self.offset,
27 size: self.size,
28 }
29 }
30}
31
32impl<'a, M: RawMutex, T: NorFlash> BlockingPartition<'a, M, T> {
33 pub const fn new(flash: &'a Mutex<M, RefCell<T>>, offset: u32, size: u32) -> Self {
35 if offset % T::READ_SIZE as u32 != 0 || offset % T::WRITE_SIZE as u32 != 0 || offset % T::ERASE_SIZE as u32 != 0
36 {
37 panic!("Partition offset must be a multiple of read, write and erase size");
38 }
39 if size % T::READ_SIZE as u32 != 0 || size % T::WRITE_SIZE as u32 != 0 || size % T::ERASE_SIZE as u32 != 0 {
40 panic!("Partition size must be a multiple of read, write and erase size");
41 }
42 Self { flash, offset, size }
43 }
44
45 pub const fn offset(&self) -> u32 {
47 self.offset
48 }
49
50 pub const fn size(&self) -> u32 {
52 self.size
53 }
54}
55
56impl<M: RawMutex, T: NorFlash> ErrorType for BlockingPartition<'_, M, T> {
57 type Error = Error<T::Error>;
58}
59
60impl<M: RawMutex, T: NorFlash> ReadNorFlash for BlockingPartition<'_, M, T> {
61 const READ_SIZE: usize = T::READ_SIZE;
62
63 fn read(&mut self, offset: u32, bytes: &mut [u8]) -> Result<(), Self::Error> {
64 if offset + bytes.len() as u32 > self.size {
65 return Err(Error::OutOfBounds);
66 }
67
68 self.flash.lock(|flash| {
69 flash
70 .borrow_mut()
71 .read(self.offset + offset, bytes)
72 .map_err(Error::Flash)
73 })
74 }
75
76 fn capacity(&self) -> usize {
77 self.size as usize
78 }
79}
80
81impl<M: RawMutex, T: NorFlash> NorFlash for BlockingPartition<'_, M, T> {
82 const WRITE_SIZE: usize = T::WRITE_SIZE;
83 const ERASE_SIZE: usize = T::ERASE_SIZE;
84
85 fn write(&mut self, offset: u32, bytes: &[u8]) -> Result<(), Self::Error> {
86 if offset + bytes.len() as u32 > self.size {
87 return Err(Error::OutOfBounds);
88 }
89
90 self.flash.lock(|flash| {
91 flash
92 .borrow_mut()
93 .write(self.offset + offset, bytes)
94 .map_err(Error::Flash)
95 })
96 }
97
98 fn erase(&mut self, from: u32, to: u32) -> Result<(), Self::Error> {
99 if to > self.size {
100 return Err(Error::OutOfBounds);
101 }
102
103 self.flash.lock(|flash| {
104 flash
105 .borrow_mut()
106 .erase(self.offset + from, self.offset + to)
107 .map_err(Error::Flash)
108 })
109 }
110}
111
112#[cfg(test)]
113mod tests {
114 use embassy_sync::blocking_mutex::raw::NoopRawMutex;
115
116 use super::*;
117 use crate::flash::mem_flash::MemFlash;
118
119 #[test]
120 fn can_read() {
121 let mut flash = MemFlash::<1024, 128, 4>::default();
122 flash.mem[132..132 + 8].fill(0xAA);
123
124 let flash = Mutex::<NoopRawMutex, _>::new(RefCell::new(flash));
125 let mut partition = BlockingPartition::new(&flash, 128, 256);
126
127 let mut read_buf = [0; 8];
128 partition.read(4, &mut read_buf).unwrap();
129
130 assert!(read_buf.iter().position(|&x| x != 0xAA).is_none());
131 }
132
133 #[test]
134 fn can_write() {
135 let flash = MemFlash::<1024, 128, 4>::default();
136
137 let flash = Mutex::<NoopRawMutex, _>::new(RefCell::new(flash));
138 let mut partition = BlockingPartition::new(&flash, 128, 256);
139
140 let write_buf = [0xAA; 8];
141 partition.write(4, &write_buf).unwrap();
142
143 let flash = flash.into_inner().take();
144 assert!(flash.mem[132..132 + 8].iter().position(|&x| x != 0xAA).is_none());
145 }
146
147 #[test]
148 fn can_erase() {
149 let flash = MemFlash::<1024, 128, 4>::new(0x00);
150
151 let flash = Mutex::<NoopRawMutex, _>::new(RefCell::new(flash));
152 let mut partition = BlockingPartition::new(&flash, 128, 256);
153
154 partition.erase(0, 128).unwrap();
155
156 let flash = flash.into_inner().take();
157 assert!(flash.mem[128..256].iter().position(|&x| x != 0xFF).is_none());
158 }
159}