1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
|
// required-features: sdmmc
#![no_std]
#![no_main]
#[path = "../common.rs"]
mod common;
use common::*;
use defmt::assert_eq;
use embassy_executor::Spawner;
use embassy_stm32::sdmmc::{CmdBlock, DataBlock, Sdmmc, StorageDevice};
use embassy_stm32::time::mhz;
use embassy_stm32::{bind_interrupts, peripherals, sdmmc};
use {defmt_rtt as _, panic_probe as _};
bind_interrupts!(struct Irqs {
SDIO => sdmmc::InterruptHandler<peripherals::SDIO>;
});
#[embassy_executor::main]
async fn main(_spawner: Spawner) {
info!("Hello World!");
let p = init();
let (mut sdmmc, mut dma, mut clk, mut cmd, mut d0, mut d1, mut d2, mut d3) =
(p.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 patterns = [pattern1.clone(), pattern2.clone()];
let mut block = DataBlock([0u8; 512]);
let mut blocks = [DataBlock([0u8; 512]), DataBlock([0u8; 512])];
// ======== Try 4bit. ==============
info!("initializing in 4-bit mode...");
let mut s = Sdmmc::new_4bit(
sdmmc.reborrow(),
Irqs,
dma.reborrow(),
clk.reborrow(),
cmd.reborrow(),
d0.reborrow(),
d1.reborrow(),
d2.reborrow(),
d3.reborrow(),
Default::default(),
);
let mut cmd_block = CmdBlock::new();
let mut storage = StorageDevice::new_sd_card(&mut s, &mut cmd_block, mhz(24))
.await
.unwrap();
let card = storage.card();
info!("Card: {:#?}", Debug2Format(&card));
info!("Clock: {}", storage.sdmmc.clock());
info!("writing pattern1...");
storage.write_block(block_idx, &pattern1).await.unwrap();
info!("reading...");
storage.read_block(block_idx, &mut block).await.unwrap();
assert_eq!(block, pattern1);
info!("writing pattern2...");
storage.write_block(block_idx, &pattern2).await.unwrap();
info!("reading...");
storage.read_block(block_idx, &mut block).await.unwrap();
assert_eq!(block, pattern2);
info!("writing blocks [pattern1, pattern2]...");
storage.write_blocks(block_idx, &patterns).await.unwrap();
info!("reading blocks...");
storage.read_blocks(block_idx, &mut blocks).await.unwrap();
assert_eq!(&blocks, &patterns);
drop(s);
// FIXME: this hangs on Rust 1.86 and higher.
// I haven't been able to figure out why.
/*
// ======== Try 1bit. ==============
info!("initializing in 1-bit mode...");
let mut s = Sdmmc::new_1bit(
sdmmc.reborrow(),
Irqs,
dma.reborrow(),
clk.reborrow(),
cmd.reborrow(),
d0.reborrow(),
Default::default(),
);
let mut err = None;
loop {
match s.init_sd_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 pattern1 written in 4bit mode...");
s.read_block(block_idx, &mut block).await.unwrap();
assert_eq!(block, pattern1);
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);
info!("writing blocks [pattern1, pattern2]...");
s.write_blocks(block_idx, &patterns).await.unwrap();
info!("reading blocks...");
s.read_blocks(block_idx, &mut blocks).await.unwrap();
assert_eq!(&blocks, &patterns);
drop(s);
*/
info!("Test OK");
cortex_m::asm::bkpt();
}
|
