Merge pull request #4524 from leftger/feat/add-vrefbuf-driver

Feat/add vrefbuf driver

4 files changed, 88 insertions, 3 deletions

diff --git a/embassy-stm32/Cargo.toml b/embassy-stm32/Cargo.toml
index 145a89b77..39e6f13f0 100644
--- a/embassy-stm32/Cargo.toml
+++ b/embassy-stm32/Cargo.toml
@@ -81,7 +81,7 @@ futures-util = { version = "0.3.30", default-features = false }
 sdio-host = "0.9.0"
 critical-section = "1.1"
 #stm32-metapac = { version = "16" }
-stm32-metapac = { git = "https://github.com/embassy-rs/stm32-data-generated", tag = "stm32-data-cad609e02a866422ffdbb8e07be26311cfdd07d9" }
+stm32-metapac = { git = "https://github.com/embassy-rs/stm32-data-generated", tag = "stm32-data-9941f338734a2e6c1652267f64b13f7b35d8c9db" }
 
 vcell = "0.1.3"
 nb = "1.0.0"
@@ -110,7 +110,7 @@ proc-macro2 = "1.0.36"
 quote = "1.0.15"
 
 #stm32-metapac = { version = "16", default-features = false, features = ["metadata"]}
-stm32-metapac = { git = "https://github.com/embassy-rs/stm32-data-generated", tag = "stm32-data-cad609e02a866422ffdbb8e07be26311cfdd07d9", default-features = false, features = ["metadata"] }
+stm32-metapac = { git = "https://github.com/embassy-rs/stm32-data-generated", tag = "stm32-data-9941f338734a2e6c1652267f64b13f7b35d8c9db", default-features = false, features = ["metadata"] }
 
 [features]
 default = ["rt"]
diff --git a/embassy-stm32/src/lib.rs b/embassy-stm32/src/lib.rs
index a676677e1..e4a8ff0ab 100644
--- a/embassy-stm32/src/lib.rs
+++ b/embassy-stm32/src/lib.rs
@@ -125,6 +125,8 @@ pub mod uid;
 pub mod usart;
 #[cfg(any(usb, otg))]
 pub mod usb;
+#[cfg(vrefbuf)]
+pub mod vrefbuf;
 #[cfg(iwdg)]
 pub mod wdg;
 #[cfg(xspi)]
diff --git a/embassy-stm32/src/rcc/wba.rs b/embassy-stm32/src/rcc/wba.rs
index 56ba7b58b..481437939 100644
--- a/embassy-stm32/src/rcc/wba.rs
+++ b/embassy-stm32/src/rcc/wba.rs
@@ -5,7 +5,7 @@ pub use crate::pac::rcc::vals::Otghssel;
 use crate::pac::rcc::vals::Pllrge;
 pub use crate::pac::rcc::vals::{
     Hdiv5, Hpre as AHBPrescaler, Hpre5 as AHB5Prescaler, Hsepre as HsePrescaler, Plldiv as PllDiv, Pllm as PllPreDiv,
-    Plln as PllMul, Pllsrc as PllSource, Ppre as APBPrescaler, Sw as Sysclk,
+    Plln as PllMul, Pllsrc as PllSource, Ppre as APBPrescaler, Sai1sel, Sw as Sysclk,
 };
 #[cfg(all(peri_usb_otg_hs))]
 pub use crate::pac::{syscfg::vals::Usbrefcksel, SYSCFG};
@@ -254,6 +254,16 @@ pub(crate) unsafe fn init(config: Config) {
         w.set_clksel(usb_refck_sel);
     });
 
+    #[cfg(sai_v4_2pdm)]
+    let audioclk = match config.mux.sai1sel {
+        Sai1sel::HSI => Some(HSI_FREQ),
+        Sai1sel::PLL1_Q => Some(pll1.q.expect("PLL1.Q not configured")),
+        Sai1sel::PLL1_P => Some(pll1.p.expect("PLL1.P not configured")),
+        Sai1sel::SYS => panic!("SYS not supported yet"),
+        Sai1sel::AUDIOCLK => panic!("AUDIOCLK not supported yet"),
+        _ => None,
+    };
+
     let lsi = config.ls.lsi.then_some(LSI_FREQ);
 
     config.mux.init();
@@ -279,6 +289,8 @@ pub(crate) unsafe fn init(config: Config) {
 
         // TODO
         lse: None,
+        #[cfg(sai_v4_2pdm)]
+        audioclk: audioclk,
     );
 }
 
diff --git a/embassy-stm32/src/vrefbuf/mod.rs b/embassy-stm32/src/vrefbuf/mod.rs
new file mode 100644
index 000000000..f614fcf99
--- /dev/null
+++ b/embassy-stm32/src/vrefbuf/mod.rs
@@ -0,0 +1,71 @@
+//! Voltage Reference Buffer (VREFBUF)
+// use core::ptr::{read_volatile, write_volatile};
+use core::marker::PhantomData;
+
+use embassy_hal_internal::PeripheralType;
+use stm32_metapac::vrefbuf::vals::*;
+
+use crate::Peri;
+
+/// Voltage Reference (VREFBUF) driver.
+pub struct VoltageReferenceBuffer<'d, T: Instance> {
+    vrefbuf: PhantomData<&'d mut T>,
+}
+
+impl<'d, T: Instance> VoltageReferenceBuffer<'d, T> {
+    /// Creates an VREFBUF (Voltage Reference) instance with a voltage scale and impedance mode.
+    ///
+    /// [Self] has to be started with [Self::new()].
+    pub fn new(_instance: Peri<'d, T>, voltage_scale: Vrs, impedance_mode: Hiz) -> Self {
+        #[cfg(rcc_wba)]
+        {
+            use crate::pac::RCC;
+            RCC.apb7enr().modify(|w| w.set_vrefen(true));
+        }
+        #[cfg(any(rcc_u5, rcc_h50, rcc_h5))]
+        {
+            use crate::pac::RCC;
+            RCC.apb3enr().modify(|w| w.set_vrefen(true));
+        }
+        #[cfg(any(rcc_h7rs, rcc_h7rm0433, rcc_h7ab, rcc_h7))]
+        {
+            use crate::pac::RCC;
+            RCC.apb4enr().modify(|w| w.set_vrefen(true));
+        }
+        let vrefbuf = T::regs();
+        vrefbuf.csr().modify(|w| {
+            w.set_hiz(impedance_mode);
+            w.set_envr(true);
+            w.set_vrs(voltage_scale);
+        });
+        while vrefbuf.csr().read().vrr() != false {
+            // wait...
+        }
+        trace!(
+            "Vrefbuf configured with voltage scale {} and impedance mode {}",
+            voltage_scale,
+            impedance_mode
+        );
+        VoltageReferenceBuffer { vrefbuf: PhantomData }
+    }
+}
+
+trait SealedInstance {
+    fn regs() -> crate::pac::vrefbuf::Vrefbuf;
+}
+
+/// VREFBUF instance trait.
+#[allow(private_bounds)]
+pub trait Instance: SealedInstance + PeripheralType {}
+
+foreach_peripheral!(
+    (vrefbuf, $inst:ident) => {
+        impl SealedInstance for crate::peripherals::$inst {
+            fn regs() -> crate::pac::vrefbuf::Vrefbuf {
+                crate::pac::$inst
+            }
+        }
+
+        impl Instance for crate::peripherals::$inst {}
+    };
+);