use core::marker::PhantomData;
use crate::analog::adc::{
AdcCalBasic,
AdcCalEfuse,
AdcCalScheme,
AdcCalSource,
AdcConfig,
Attenuation,
CalibrationAccess,
};
pub trait AdcHasLineCal {}
const GAIN_SCALE: u32 = 1 << 16;
#[derive(Clone, Copy)]
pub struct AdcCalLine<ADCI> {
basic: AdcCalBasic<ADCI>,
gain: u32,
_phantom: PhantomData<ADCI>,
}
impl<ADCI> crate::private::Sealed for AdcCalLine<ADCI> {}
impl<ADCI> AdcCalScheme<ADCI> for AdcCalLine<ADCI>
where
ADCI: AdcCalEfuse + AdcHasLineCal + CalibrationAccess,
{
fn new_cal(atten: Attenuation) -> Self {
let basic = AdcCalBasic::<ADCI>::new_cal(atten);
let (code, mv) = ADCI::cal_code(atten)
.map(|code| (code, ADCI::cal_mv(atten)))
.unwrap_or_else(|| {
(
AdcConfig::<ADCI>::adc_calibrate(atten, AdcCalSource::Ref),
1100, )
});
let gain = mv as u32 * GAIN_SCALE / code as u32;
Self {
basic,
gain,
_phantom: PhantomData,
}
}
fn adc_cal(&self) -> u16 {
self.basic.adc_cal()
}
fn adc_val(&self, val: u16) -> u16 {
let val = self.basic.adc_val(val);
(val as u32 * self.gain / GAIN_SCALE) as u16
}
}
#[cfg(any(esp32c2, esp32c3, esp32c5, esp32c6, esp32h2, esp32s3))]
impl AdcHasLineCal for crate::peripherals::ADC1<'_> {}
#[cfg(any(esp32c3, esp32s3))]
impl AdcHasLineCal for crate::peripherals::ADC2<'_> {}