max/embassy
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

f4-rcc: Add option to enable debug_wfe and add hello example

Browse Source
This commit is contained in:
Thales Fragoso
2021-07-28 16:02:56 -03:00
parent 5abaf8e9d6
commit e7714983b3
2 changed files with 50 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

19
embassy-stm32/src/rcc/f4/mod.rs
View File

@ -24,6 +24,7 @@ pub struct Config {
pub hclk: Option<Hertz>,
pub pclk1: Option<Hertz>,
pub pclk2: Option<Hertz>,
pub enable_debug_wfe: bool,
}
/// RCC peripheral
@ -68,7 +69,7 @@ impl<'d> Rcc<'d> {
} else {
sysclk
};
assert!((SYSCLK_MIN..=SYSCLK_MAX).contains(&sysclk));
assert!((SYSCLK_MIN..=SYSCLK_MAX).contains(&sysclk), "sysclk");
let hclk = self.config.hclk.map(|h| h.0).unwrap_or(sysclk);
let (hpre_bits, hpre_div) = match (sysclk + hclk - 1) / hclk {
@ -168,6 +169,15 @@ impl<'d> Rcc<'d> {
});
}
if self.config.enable_debug_wfe {
unsafe {
RCC.ahb1enr().modify(|w| w.set_dma1en(true));
critical_section::with(|_| {
crate::dbgmcu::Dbgmcu::enable_all();
});
}
}
Clocks {
sys: Hertz(sysclk),
apb1: Hertz(pclk1),
@ -237,7 +247,7 @@ impl<'d> Rcc<'d> {
.unwrap();
let vco_in = pllsrcclk / pllm;
assert!((1_000_000..=2_000_000).contains(&vco_in));
assert!((1_000_000..=2_000_000).contains(&vco_in), "vco_in");
// Main scaler, must result in >= 100MHz (>= 192MHz for F401)
// and <= 432MHz, min 50, max 432
@ -256,7 +266,10 @@ impl<'d> Rcc<'d> {
} else {
sysclk * sysclk_div / vco_in
};
assert!((192_000_000..=432_000_000).contains(&(vco_in * plln)));
assert!(
(192_000_000..=432_000_000).contains(&(vco_in * plln)),
"plln"
);
let pllp = (sysclk_div / 2) - 1;