stm32/sdmmc: add hil test for f4.
This commit is contained in:
148
tests/stm32/src/bin/sdmmc.rs
Normal file
148
tests/stm32/src/bin/sdmmc.rs
Normal file
@ -0,0 +1,148 @@
|
||||
// required-features: sdmmc
|
||||
#![no_std]
|
||||
#![no_main]
|
||||
#![feature(type_alias_impl_trait)]
|
||||
|
||||
use defmt::{assert_eq, *};
|
||||
use embassy_executor::Spawner;
|
||||
use embassy_stm32::sdmmc::{DataBlock, Sdmmc};
|
||||
use embassy_stm32::time::mhz;
|
||||
use embassy_stm32::{interrupt, Config};
|
||||
use {defmt_rtt as _, panic_probe as _};
|
||||
|
||||
#[embassy_executor::main]
|
||||
async fn main(_spawner: Spawner) {
|
||||
info!("Hello World!");
|
||||
|
||||
let mut config = Config::default();
|
||||
config.rcc.sys_ck = Some(mhz(48));
|
||||
config.rcc.pll48 = true;
|
||||
let p = embassy_stm32::init(config);
|
||||
|
||||
#[cfg(feature = "stm32f429zi")]
|
||||
let (mut sdmmc, mut irq, mut dma, mut clk, mut cmd, mut d0, mut d1, mut d2, mut d3) = (
|
||||
p.SDIO,
|
||||
interrupt::take!(SDIO),
|
||||
p.DMA2_CH3,
|
||||
p.PC12,
|
||||
p.PD2,
|
||||
p.PC8,
|
||||
p.PC9,
|
||||
p.PC10,
|
||||
p.PC11,
|
||||
);
|
||||
|
||||
// Arbitrary block index
|
||||
let block_idx = 16;
|
||||
|
||||
let mut pattern1 = DataBlock([0u8; 512]);
|
||||
let mut pattern2 = DataBlock([0u8; 512]);
|
||||
for i in 0..512 {
|
||||
pattern1[i] = i as u8;
|
||||
pattern2[i] = !i as u8;
|
||||
}
|
||||
|
||||
let mut block = DataBlock([0u8; 512]);
|
||||
|
||||
// ======== Try 4bit. ==============
|
||||
info!("initializing in 4-bit mode...");
|
||||
let mut s = Sdmmc::new_4bit(
|
||||
&mut sdmmc,
|
||||
&mut irq,
|
||||
&mut dma,
|
||||
&mut clk,
|
||||
&mut cmd,
|
||||
&mut d0,
|
||||
&mut d1,
|
||||
&mut d2,
|
||||
&mut d3,
|
||||
Default::default(),
|
||||
);
|
||||
|
||||
let mut err = None;
|
||||
loop {
|
||||
match s.init_card(mhz(24)).await {
|
||||
Ok(_) => break,
|
||||
Err(e) => {
|
||||
if err != Some(e) {
|
||||
info!("waiting for card: {:?}", e);
|
||||
err = Some(e);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
let card = unwrap!(s.card());
|
||||
|
||||
info!("Card: {:#?}", Debug2Format(card));
|
||||
info!("Clock: {}", s.clock());
|
||||
|
||||
info!("writing pattern1...");
|
||||
s.write_block(block_idx, &pattern1).await.unwrap();
|
||||
|
||||
info!("reading...");
|
||||
s.read_block(block_idx, &mut block).await.unwrap();
|
||||
assert_eq!(block, pattern1);
|
||||
|
||||
info!("writing pattern2...");
|
||||
s.write_block(block_idx, &pattern2).await.unwrap();
|
||||
|
||||
info!("reading...");
|
||||
s.read_block(block_idx, &mut block).await.unwrap();
|
||||
assert_eq!(block, pattern2);
|
||||
|
||||
drop(s);
|
||||
|
||||
// ======== Try 1bit. ==============
|
||||
info!("initializing in 1-bit mode...");
|
||||
let mut s = Sdmmc::new_1bit(
|
||||
&mut sdmmc,
|
||||
&mut irq,
|
||||
&mut dma,
|
||||
&mut clk,
|
||||
&mut cmd,
|
||||
&mut d0,
|
||||
Default::default(),
|
||||
);
|
||||
|
||||
let mut err = None;
|
||||
loop {
|
||||
match s.init_card(mhz(24)).await {
|
||||
Ok(_) => break,
|
||||
Err(e) => {
|
||||
if err != Some(e) {
|
||||
info!("waiting for card: {:?}", e);
|
||||
err = Some(e);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
let card = unwrap!(s.card());
|
||||
|
||||
info!("Card: {:#?}", Debug2Format(card));
|
||||
info!("Clock: {}", s.clock());
|
||||
|
||||
info!("reading pattern2 written in 4bit mode...");
|
||||
s.read_block(block_idx, &mut block).await.unwrap();
|
||||
assert_eq!(block, pattern2);
|
||||
|
||||
info!("writing pattern1...");
|
||||
s.write_block(block_idx, &pattern1).await.unwrap();
|
||||
|
||||
info!("reading...");
|
||||
s.read_block(block_idx, &mut block).await.unwrap();
|
||||
assert_eq!(block, pattern1);
|
||||
|
||||
info!("writing pattern2...");
|
||||
s.write_block(block_idx, &pattern2).await.unwrap();
|
||||
|
||||
info!("reading...");
|
||||
s.read_block(block_idx, &mut block).await.unwrap();
|
||||
assert_eq!(block, pattern2);
|
||||
|
||||
drop(s);
|
||||
|
||||
info!("Test OK");
|
||||
cortex_m::asm::bkpt();
|
||||
}
|
Reference in New Issue
Block a user