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

Improve gpout example, clk_gpout_freq

Browse Source
This commit is contained in:
Caleb Jamison
2023-05-09 12:10:24 -04:00
parent c1eaad41f3
commit 5015c845c5
3 changed files with 26 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files

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

@ -544,9 +544,9 @@ pub fn clk_rtc_freq() -> u32 {
base / int
}
pub fn clk_gpout_freq(num: usize) -> u32 {
pub fn clk_gpout_freq<T: GpoutPin>(gpout: &Gpout<T>) -> u32 {
let c = pac::CLOCKS;
let src = unsafe { c.clk_gpout_ctrl(num).read().auxsrc() };
let src = unsafe { c.clk_gpout_ctrl(gpout.gpout.gpout_number()).read().auxsrc() };
let base = match src {
ClkGpoutCtrlAuxsrc::CLKSRC_PLL_SYS => pll_sys_freq(),
@ -563,7 +563,7 @@ pub fn clk_gpout_freq(num: usize) -> u32 {
_ => unreachable!(),
};
let div = unsafe { c.clk_gpout_div(num).read() };
let div = unsafe { c.clk_gpout_div(gpout.gpout.gpout_number()).read() };
let int = if div.int() == 0 { 65536 } else { div.int() };
// TODO handle fractional clock div
let _frac = div.frac();
@ -759,7 +759,7 @@ impl<'d, T: GpoutPin> Gpout<'d, T> {
unsafe {
let c = pac::CLOCKS;
c.clk_gpout_ctrl(self.gpout.gpout_number()).modify(|w| {
w.set_enable(true);
w.set_enable(false);
});
}
}