IO: update board io demo code

surban · Feb 20, 2024 · 2f44baf · 2f44baf
1 parent d8bf7b5
commit 2f44baf
Showing 1 changed file with 9 additions and 2 deletions.
diff --git a/openemc-firmware/src/boards/stm_nucleo_f103rb.rs b/openemc-firmware/src/boards/stm_nucleo_f103rb.rs
@@ -148,9 +148,16 @@ impl Board for BoardImpl {
     }
 
     fn io_read(&mut self) -> Vec<u8, IO_BUFFER_SIZE> {
-        let data = mem::take(&mut self.io_data_buf);
+        let data = self.io_data_buf.clone();
         defmt::info!("Sent {} bytes IO board data", data.len());
-        io_write_available();
+
+        if self.io_data_buf.is_empty() {
+            io_write_available();
+        } else {
+            self.io_data_buf.truncate(self.io_data_buf.len() - 1);
+            io_read_available();
+        }
+
         data
     }
 }