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

rp/clocks: fix wrong PLL setup

Browse Source
This commit is contained in:
Dario Nieuwenhuis 2021-06-25 06:23:20 +02:00
parent c7c897bb72
commit 9cf1d5b29c
1 changed files with 7 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
embassy-rp/src/clocks.rs
View File

@ -155,15 +155,16 @@ unsafe fn configure_pll(
}); });
p.fbdiv_int().write(|w| w.set_fbdiv_int(0)); p.fbdiv_int().write(|w| w.set_fbdiv_int(0));
let ref_mhz = XOSC_MHZ / refdiv; let ref_freq = XOSC_MHZ * 1_000_000 / refdiv;
p.cs().write(|w| w.set_refdiv(ref_mhz as _));
let fbdiv = vco_freq / (ref_mhz * 1_000_000); let fbdiv = vco_freq / ref_freq;
assert!(fbdiv >= 16 && fbdiv <= 520); assert!(fbdiv >= 16 && fbdiv <= 320);
assert!((post_div1 >= 1 && post_div1 <= 7) && (post_div2 >= 1 && post_div2 <= 7)); assert!(post_div1 >= 1 && post_div1 <= 7);
assert!(post_div2 >= 1 && post_div2 <= 7);
assert!(post_div2 <= post_div1); assert!(post_div2 <= post_div1);
assert!(ref_mhz <= (vco_freq / 16)); assert!(ref_freq <= (vco_freq / 16));
p.cs().write(|w| w.set_refdiv(refdiv as _));
p.fbdiv_int().write(|w| w.set_fbdiv_int(fbdiv as _)); p.fbdiv_int().write(|w| w.set_fbdiv_int(fbdiv as _));
p.pwr().modify(|w| { p.pwr().modify(|w| {