use core::marker::PhantomData;
use super::AdcHasLineCal;
use crate::analog::adc::{
AdcCalBasic,
AdcCalEfuse,
AdcCalScheme,
AdcCalSource,
AdcConfig,
Attenuation,
CalibrationAccess,
};
const GAIN_SCALE: u32 = 1 << 16;
#[derive(Clone, Copy)]
pub struct AdcCalLine<ADCX> {
basic: AdcCalBasic<ADCX>,
gain: u32,
_phantom: PhantomData<ADCX>,
}
impl<ADCX> crate::private::Sealed for AdcCalLine<ADCX> {}
impl<ADCX> AdcCalScheme<ADCX> for AdcCalLine<ADCX>
where
ADCX: AdcCalEfuse + AdcHasLineCal + CalibrationAccess,
{
fn new_cal(atten: Attenuation) -> Self {
Self::new_cal_with_channel(atten, 0)
}
fn new_cal_with_channel(atten: Attenuation, channel: u8) -> Self {
let basic = AdcCalBasic::<ADCX>::new_cal_with_channel(atten, channel);
let (code, mv) = ADCX::cal_code(atten)
.map(|code| (code, ADCX::cal_mv(atten)))
.unwrap_or_else(|| {
(
AdcConfig::<ADCX>::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
}
}