use core::future::poll_fn; use core::marker::PhantomData; use core::task::Poll; use super::blocking_delay_us; use crate::adc::{Adc, AdcChannel, Instance, SampleTime, VrefInt}; use crate::interrupt::typelevel::Interrupt; use crate::time::Hertz; use crate::{Peri, interrupt, rcc}; pub const VDDA_CALIB_MV: u32 = 3300; pub const ADC_MAX: u32 = (1 << 12) - 1; pub const VREF_INT: u32 = 1230; /// Interrupt handler. pub struct InterruptHandler { _phantom: PhantomData, } impl interrupt::typelevel::Handler for InterruptHandler { unsafe fn on_interrupt() { if T::regs().isr().read().eoc() { T::regs().ier().modify(|w| w.set_eocie(false)); } else { return; } T::state().waker.wake(); } } impl super::SealedSpecialConverter for T { const CHANNEL: u8 = 18; } impl super::SealedSpecialConverter for T { const CHANNEL: u8 = 16; } impl<'d, T: Instance> Adc<'d, T> { pub fn new( adc: Peri<'d, T>, _irq: impl interrupt::typelevel::Binding> + 'd, ) -> Self { use crate::pac::adc::vals; rcc::enable_and_reset::(); // Enable the adc regulator T::regs().cr().modify(|w| w.set_advregen(vals::Advregen::INTERMEDIATE)); T::regs().cr().modify(|w| w.set_advregen(vals::Advregen::ENABLED)); // Wait for the regulator to stabilize blocking_delay_us(10); assert!(!T::regs().cr().read().aden()); // Begin calibration T::regs().cr().modify(|w| w.set_adcaldif(false)); T::regs().cr().modify(|w| w.set_adcal(true)); while T::regs().cr().read().adcal() {} // Wait more than 4 clock cycles after adcal is cleared (RM0364 p. 223). blocking_delay_us((1_000_000 * 4) / Self::freq().0 as u64 + 1); // Enable the adc T::regs().cr().modify(|w| w.set_aden(true)); // Wait until the adc is ready while !T::regs().isr().read().adrdy() {} T::Interrupt::unpend(); unsafe { T::Interrupt::enable(); } Self { adc } } fn freq() -> Hertz { ::frequency() } pub fn sample_time_for_us(&self, us: u32) -> SampleTime { match us * Self::freq().0 / 1_000_000 { 0..=1 => SampleTime::CYCLES1_5, 2..=4 => SampleTime::CYCLES4_5, 5..=7 => SampleTime::CYCLES7_5, 8..=19 => SampleTime::CYCLES19_5, 20..=61 => SampleTime::CYCLES61_5, 62..=181 => SampleTime::CYCLES181_5, _ => SampleTime::CYCLES601_5, } } pub fn enable_vref(&self) -> super::VrefInt { T::common_regs().ccr().modify(|w| w.set_vrefen(true)); super::VrefInt {} } pub fn enable_temperature(&self) -> super::Temperature { T::common_regs().ccr().modify(|w| w.set_tsen(true)); super::Temperature {} } /// Perform a single conversion. async fn convert(&mut self) -> u16 { T::regs().isr().write(|_| {}); T::regs().ier().modify(|w| w.set_eocie(true)); T::regs().cr().modify(|w| w.set_adstart(true)); poll_fn(|cx| { T::state().waker.register(cx.waker()); if T::regs().isr().read().eoc() { Poll::Ready(()) } else { Poll::Pending } }) .await; T::regs().isr().write(|_| {}); T::regs().dr().read().rdata() } pub async fn read(&mut self, channel: &mut impl AdcChannel, sample_time: SampleTime) -> u16 { Self::set_channel_sample_time(channel.channel(), sample_time); // Configure the channel to sample T::regs().sqr1().write(|w| w.set_sq(0, channel.channel())); self.convert().await } fn set_channel_sample_time(ch: u8, sample_time: SampleTime) { let sample_time = sample_time.into(); if ch <= 9 { T::regs().smpr1().modify(|reg| reg.set_smp(ch as _, sample_time)); } else { T::regs().smpr2().modify(|reg| reg.set_smp((ch - 10) as _, sample_time)); } } } impl<'d, T: Instance> Drop for Adc<'d, T> { fn drop(&mut self) { use crate::pac::adc::vals; T::regs().cr().modify(|w| w.set_adstp(true)); while T::regs().cr().read().adstp() {} T::regs().cr().modify(|w| w.set_addis(true)); while T::regs().cr().read().aden() {} // Disable the adc regulator T::regs().cr().modify(|w| w.set_advregen(vals::Advregen::INTERMEDIATE)); T::regs().cr().modify(|w| w.set_advregen(vals::Advregen::DISABLED)); rcc::disable::(); } }