Provide a way for a peripheral to query its clock frequency
Currently this looks up the frequency in the global singleton that must be initialized by the per-chip RCC implementation. At present, this is only done for the L0 family of chips.
This commit is contained in:
@ -77,12 +77,14 @@ impl<T: Instance> Clock<T> {
|
||||
}
|
||||
}
|
||||
|
||||
pub fn start(&'static self, timer_freq: Hertz) {
|
||||
pub fn start(&'static self) {
|
||||
let inner = T::inner();
|
||||
|
||||
T::enable();
|
||||
T::reset();
|
||||
|
||||
let timer_freq = T::frequency();
|
||||
|
||||
// NOTE(unsafe) Critical section to use the unsafe methods
|
||||
critical_section::with(|_| {
|
||||
unsafe {
|
||||
|
@ -469,35 +469,31 @@ impl RccExt for RCC {
|
||||
}
|
||||
};
|
||||
|
||||
let (apb1_freq, apb1_tim_freq, apb1_pre) = match cfgr.apb1_pre {
|
||||
APBPrescaler::NotDivided => (ahb_freq, ahb_freq, 1),
|
||||
let apb1_freq = match cfgr.apb1_pre {
|
||||
APBPrescaler::NotDivided => ahb_freq,
|
||||
pre => {
|
||||
let pre: Ppre = pre.into();
|
||||
let pre: u8 = 1 << (pre.0 - 3);
|
||||
let freq = ahb_freq / pre as u32;
|
||||
(freq, freq * 2, pre as u8)
|
||||
freq
|
||||
}
|
||||
};
|
||||
|
||||
let (apb2_freq, apb2_tim_freq, apb2_pre) = match cfgr.apb2_pre {
|
||||
APBPrescaler::NotDivided => (ahb_freq, ahb_freq, 1),
|
||||
let apb2_freq = match cfgr.apb2_pre {
|
||||
APBPrescaler::NotDivided => ahb_freq,
|
||||
pre => {
|
||||
let pre: Ppre = pre.into();
|
||||
let pre: u8 = 1 << (pre.0 - 3);
|
||||
let freq = ahb_freq / (1 << (pre as u8 - 3));
|
||||
(freq, freq * 2, pre as u8)
|
||||
freq
|
||||
}
|
||||
};
|
||||
|
||||
Clocks {
|
||||
sys_clk: sys_clk.hz(),
|
||||
ahb_clk: ahb_freq.hz(),
|
||||
apb1_clk: apb1_freq.hz(),
|
||||
apb2_clk: apb2_freq.hz(),
|
||||
apb1_tim_clk: apb1_tim_freq.hz(),
|
||||
apb2_tim_clk: apb2_tim_freq.hz(),
|
||||
apb1_pre,
|
||||
apb2_pre,
|
||||
sys: sys_clk.hz(),
|
||||
ahb: ahb_freq.hz(),
|
||||
apb1: apb1_freq.hz(),
|
||||
apb2: apb2_freq.hz(),
|
||||
}
|
||||
}
|
||||
}
|
||||
|
@ -9,14 +9,10 @@ use core::mem::MaybeUninit;
|
||||
/// The existence of this value indicates that the clock configuration can no longer be changed
|
||||
#[derive(Clone, Copy)]
|
||||
pub struct Clocks {
|
||||
pub sys_clk: Hertz,
|
||||
pub ahb_clk: Hertz,
|
||||
pub apb1_clk: Hertz,
|
||||
pub apb1_tim_clk: Hertz,
|
||||
pub apb2_clk: Hertz,
|
||||
pub apb2_tim_clk: Hertz,
|
||||
pub apb1_pre: u8,
|
||||
pub apb2_pre: u8,
|
||||
pub sys: Hertz,
|
||||
pub ahb: Hertz,
|
||||
pub apb1: Hertz,
|
||||
pub apb2: Hertz,
|
||||
}
|
||||
|
||||
static mut CLOCK_FREQS: MaybeUninit<Clocks> = MaybeUninit::uninit();
|
||||
@ -50,6 +46,7 @@ cfg_if::cfg_if! {
|
||||
|
||||
pub(crate) mod sealed {
|
||||
pub trait RccPeripheral {
|
||||
fn frequency() -> crate::time::Hertz;
|
||||
fn reset();
|
||||
fn enable();
|
||||
fn disable();
|
||||
@ -59,8 +56,16 @@ pub(crate) mod sealed {
|
||||
pub trait RccPeripheral: sealed::RccPeripheral + 'static {}
|
||||
|
||||
crate::pac::peripheral_rcc!(
|
||||
($inst:ident, $enable:ident, $reset:ident, $perien:ident, $perirst:ident) => {
|
||||
($inst:ident, $clk:ident, $enable:ident, $reset:ident, $perien:ident, $perirst:ident) => {
|
||||
impl sealed::RccPeripheral for peripherals::$inst {
|
||||
fn frequency() -> crate::time::Hertz {
|
||||
critical_section::with(|_| {
|
||||
unsafe {
|
||||
let freqs = get_freqs();
|
||||
freqs.$clk
|
||||
}
|
||||
})
|
||||
}
|
||||
fn enable() {
|
||||
critical_section::with(|_| {
|
||||
unsafe {
|
||||
|
@ -37,7 +37,6 @@ pub struct Spi<'d, T: Instance> {
|
||||
|
||||
impl<'d, T: Instance> Spi<'d, T> {
|
||||
pub fn new<F>(
|
||||
pclk: Hertz,
|
||||
_peri: impl Unborrow<Target = T> + 'd,
|
||||
sck: impl Unborrow<Target = impl SckPin<T>>,
|
||||
mosi: impl Unborrow<Target = impl MosiPin<T>>,
|
||||
@ -60,6 +59,7 @@ impl<'d, T: Instance> Spi<'d, T> {
|
||||
let mosi = mosi.degrade();
|
||||
let miso = miso.degrade();
|
||||
|
||||
let pclk = T::frequency();
|
||||
let br = Self::compute_baud_rate(pclk, freq.into());
|
||||
|
||||
unsafe {
|
||||
|
Reference in New Issue
Block a user