diff --git a/src/sdmmc.rs b/src/sdmmc.rs index 8027ff87..9fb1a7fb 100644 --- a/src/sdmmc.rs +++ b/src/sdmmc.rs @@ -1229,6 +1229,69 @@ macro_rules! sdmmc { } } + + /// Write blocks to card. Buffer length must be multiple of 512 + pub fn write_blocks( + &mut self, + address: u32, + buffer: &[u8] + ) -> Result<(), Error> { + let _card = self.card()?; + + assert!(buffer.len() % 512 == 0, + "Buffer length must be a multiple of 512"); + + if !self.cmd16_illegal { + self.cmd(common_cmd::set_block_length(512))?; // CMD16 + } + let n_blocks = buffer.len() / 512; + + self.cmd(sd_cmd::set_block_count(buffer.len() as u32 / 512))?; // CMD23 + + // Setup write command + self.start_datapath_transfer(512 * n_blocks as u32, 9, Dir::HostToCard); + self.cmd(common_cmd::write_multiple_blocks(address))?; // CMD25 + + + let mut i = 0; + let mut status; + while { + status = self.sdmmc.star.read(); + !(status.txunderr().bit() + || status.dcrcfail().bit() + || status.dtimeout().bit() + || status.dataend().bit()) + } { + if status.txfifohe().bit() { + for _ in 0..8 { + let mut wb = [0u8; 4]; + wb.copy_from_slice(&buffer[i..i + 4]); + let word = u32::from_le_bytes(wb); + self.sdmmc.fifor.write(|w| unsafe { w.bits(word) }); + i += 4; + } + } + + if i >= buffer.len() { + break; + } + } + + err_from_datapath_sm!(status); + self.clear_static_interrupt_flags(); + + let mut timeout: u32 = 0xFFFF_FFFF; + + // Try to read card status (CMD13) + while timeout > 0 { + if self.card_ready()? { + return Ok(()); + } + timeout -= 1; + } + Err(Error::SoftwareTimeout) + } + #[cfg(feature = "sdmmc-fatfs")] #[cfg_attr(docsrs, doc(cfg(feature = "sdmmc-fatfs")))] pub fn sdmmc_block_device(self) -> SdmmcBlockDevice> {