stm32: update stm32-metapac.
This commit is contained in:
@ -32,26 +32,22 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
into_ref!(adc);
|
||||
T::enable();
|
||||
T::reset();
|
||||
unsafe {
|
||||
T::regs().cr2().modify(|reg| reg.set_adon(true));
|
||||
}
|
||||
T::regs().cr2().modify(|reg| reg.set_adon(true));
|
||||
|
||||
// 11.4: Before starting a calibration, the ADC must have been in power-on state (ADON bit = ‘1’)
|
||||
// for at least two ADC clock cycles
|
||||
delay.delay_us((1_000_000 * 2) / Self::freq().0 + 1);
|
||||
|
||||
unsafe {
|
||||
// Reset calibration
|
||||
T::regs().cr2().modify(|reg| reg.set_rstcal(true));
|
||||
while T::regs().cr2().read().rstcal() {
|
||||
// spin
|
||||
}
|
||||
// Reset calibration
|
||||
T::regs().cr2().modify(|reg| reg.set_rstcal(true));
|
||||
while T::regs().cr2().read().rstcal() {
|
||||
// spin
|
||||
}
|
||||
|
||||
// Calibrate
|
||||
T::regs().cr2().modify(|reg| reg.set_cal(true));
|
||||
while T::regs().cr2().read().cal() {
|
||||
// spin
|
||||
}
|
||||
// Calibrate
|
||||
T::regs().cr2().modify(|reg| reg.set_cal(true));
|
||||
while T::regs().cr2().read().cal() {
|
||||
// spin
|
||||
}
|
||||
|
||||
// One cycle after calibration
|
||||
@ -81,20 +77,16 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
}
|
||||
|
||||
pub fn enable_vref(&self, _delay: &mut impl DelayUs<u32>) -> Vref {
|
||||
unsafe {
|
||||
T::regs().cr2().modify(|reg| {
|
||||
reg.set_tsvrefe(true);
|
||||
})
|
||||
}
|
||||
T::regs().cr2().modify(|reg| {
|
||||
reg.set_tsvrefe(true);
|
||||
});
|
||||
Vref {}
|
||||
}
|
||||
|
||||
pub fn enable_temperature(&self) -> Temperature {
|
||||
unsafe {
|
||||
T::regs().cr2().modify(|reg| {
|
||||
reg.set_tsvrefe(true);
|
||||
})
|
||||
}
|
||||
T::regs().cr2().modify(|reg| {
|
||||
reg.set_tsvrefe(true);
|
||||
});
|
||||
Temperature {}
|
||||
}
|
||||
|
||||
@ -104,41 +96,37 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
|
||||
/// Perform a single conversion.
|
||||
fn convert(&mut self) -> u16 {
|
||||
unsafe {
|
||||
T::regs().cr2().modify(|reg| {
|
||||
reg.set_adon(true);
|
||||
reg.set_swstart(true);
|
||||
});
|
||||
while T::regs().cr2().read().swstart() {}
|
||||
while !T::regs().sr().read().eoc() {}
|
||||
T::regs().cr2().modify(|reg| {
|
||||
reg.set_adon(true);
|
||||
reg.set_swstart(true);
|
||||
});
|
||||
while T::regs().cr2().read().swstart() {}
|
||||
while !T::regs().sr().read().eoc() {}
|
||||
|
||||
T::regs().dr().read().0 as u16
|
||||
}
|
||||
T::regs().dr().read().0 as u16
|
||||
}
|
||||
|
||||
pub fn read(&mut self, pin: &mut impl AdcPin<T>) -> u16 {
|
||||
unsafe {
|
||||
Self::set_channel_sample_time(pin.channel(), self.sample_time);
|
||||
T::regs().cr1().modify(|reg| {
|
||||
reg.set_scan(false);
|
||||
reg.set_discen(false);
|
||||
});
|
||||
T::regs().sqr1().modify(|reg| reg.set_l(0));
|
||||
Self::set_channel_sample_time(pin.channel(), self.sample_time);
|
||||
T::regs().cr1().modify(|reg| {
|
||||
reg.set_scan(false);
|
||||
reg.set_discen(false);
|
||||
});
|
||||
T::regs().sqr1().modify(|reg| reg.set_l(0));
|
||||
|
||||
T::regs().cr2().modify(|reg| {
|
||||
reg.set_cont(false);
|
||||
reg.set_exttrig(true);
|
||||
reg.set_swstart(false);
|
||||
reg.set_extsel(crate::pac::adc::vals::Extsel::SWSTART);
|
||||
});
|
||||
}
|
||||
T::regs().cr2().modify(|reg| {
|
||||
reg.set_cont(false);
|
||||
reg.set_exttrig(true);
|
||||
reg.set_swstart(false);
|
||||
reg.set_extsel(crate::pac::adc::vals::Extsel::SWSTART);
|
||||
});
|
||||
|
||||
// Configure the channel to sample
|
||||
unsafe { T::regs().sqr3().write(|reg| reg.set_sq(0, pin.channel())) }
|
||||
T::regs().sqr3().write(|reg| reg.set_sq(0, pin.channel()));
|
||||
self.convert()
|
||||
}
|
||||
|
||||
unsafe fn set_channel_sample_time(ch: u8, sample_time: SampleTime) {
|
||||
fn set_channel_sample_time(ch: u8, sample_time: SampleTime) {
|
||||
let sample_time = sample_time.into();
|
||||
if ch <= 9 {
|
||||
T::regs().smpr2().modify(|reg| reg.set_smp(ch as _, sample_time));
|
||||
|
@ -57,18 +57,14 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
//
|
||||
// 6.3.20 Vbat monitoring characteristics
|
||||
// ts_vbat ≥ 4μs
|
||||
unsafe {
|
||||
T::regs().ccr().modify(|reg| reg.set_vbaten(true));
|
||||
}
|
||||
T::regs().ccr().modify(|reg| reg.set_vbaten(true));
|
||||
Vbat
|
||||
}
|
||||
|
||||
pub fn enable_vref(&self, delay: &mut impl DelayUs<u32>) -> Vref {
|
||||
// Table 28. Embedded internal reference voltage
|
||||
// tstart = 10μs
|
||||
unsafe {
|
||||
T::regs().ccr().modify(|reg| reg.set_vrefen(true));
|
||||
}
|
||||
T::regs().ccr().modify(|reg| reg.set_vrefen(true));
|
||||
delay.delay_us(10);
|
||||
Vref
|
||||
}
|
||||
@ -79,27 +75,23 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
// 6.3.19 Temperature sensor characteristics
|
||||
// tstart ≤ 10μs
|
||||
// ts_temp ≥ 4μs
|
||||
unsafe {
|
||||
T::regs().ccr().modify(|reg| reg.set_tsen(true));
|
||||
}
|
||||
T::regs().ccr().modify(|reg| reg.set_tsen(true));
|
||||
delay.delay_us(10);
|
||||
Temperature
|
||||
}
|
||||
|
||||
fn calibrate(&self) {
|
||||
unsafe {
|
||||
// A.7.1 ADC calibration code example
|
||||
if T::regs().cr().read().aden() {
|
||||
T::regs().cr().modify(|reg| reg.set_addis(true));
|
||||
}
|
||||
while T::regs().cr().read().aden() {
|
||||
// spin
|
||||
}
|
||||
T::regs().cfgr1().modify(|reg| reg.set_dmaen(false));
|
||||
T::regs().cr().modify(|reg| reg.set_adcal(true));
|
||||
while T::regs().cr().read().adcal() {
|
||||
// spin
|
||||
}
|
||||
// A.7.1 ADC calibration code example
|
||||
if T::regs().cr().read().aden() {
|
||||
T::regs().cr().modify(|reg| reg.set_addis(true));
|
||||
}
|
||||
while T::regs().cr().read().aden() {
|
||||
// spin
|
||||
}
|
||||
T::regs().cfgr1().modify(|reg| reg.set_dmaen(false));
|
||||
T::regs().cr().modify(|reg| reg.set_adcal(true));
|
||||
while T::regs().cr().read().adcal() {
|
||||
// spin
|
||||
}
|
||||
}
|
||||
|
||||
@ -108,9 +100,7 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
}
|
||||
|
||||
pub fn set_resolution(&mut self, resolution: Resolution) {
|
||||
unsafe {
|
||||
T::regs().cfgr1().modify(|reg| reg.set_res(resolution.into()));
|
||||
}
|
||||
T::regs().cfgr1().modify(|reg| reg.set_res(resolution.into()));
|
||||
}
|
||||
|
||||
pub fn read<P>(&mut self, pin: &mut P) -> u16
|
||||
@ -118,18 +108,16 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
P: AdcPin<T> + crate::gpio::sealed::Pin,
|
||||
{
|
||||
let channel = pin.channel();
|
||||
unsafe {
|
||||
pin.set_as_analog();
|
||||
self.read_channel(channel)
|
||||
}
|
||||
pin.set_as_analog();
|
||||
self.read_channel(channel)
|
||||
}
|
||||
|
||||
pub fn read_internal(&mut self, channel: &mut impl InternalChannel<T>) -> u16 {
|
||||
let channel = channel.channel();
|
||||
unsafe { self.read_channel(channel) }
|
||||
self.read_channel(channel)
|
||||
}
|
||||
|
||||
unsafe fn read_channel(&mut self, channel: u8) -> u16 {
|
||||
fn read_channel(&mut self, channel: u8) -> u16 {
|
||||
// A.7.2 ADC enable sequence code example
|
||||
if T::regs().isr().read().adrdy() {
|
||||
T::regs().isr().modify(|reg| reg.set_adrdy(true));
|
||||
|
@ -100,13 +100,10 @@ where
|
||||
T::reset();
|
||||
|
||||
let presc = Prescaler::from_pclk2(T::frequency());
|
||||
unsafe {
|
||||
T::common_regs().ccr().modify(|w| w.set_adcpre(presc.adcpre()));
|
||||
|
||||
T::regs().cr2().modify(|reg| {
|
||||
reg.set_adon(crate::pac::adc::vals::Adon::ENABLED);
|
||||
});
|
||||
}
|
||||
T::common_regs().ccr().modify(|w| w.set_adcpre(presc.adcpre()));
|
||||
T::regs().cr2().modify(|reg| {
|
||||
reg.set_adon(crate::pac::adc::vals::Adon::ENABLED);
|
||||
});
|
||||
|
||||
delay.delay_us(ADC_POWERUP_TIME_US);
|
||||
|
||||
@ -121,19 +118,15 @@ where
|
||||
}
|
||||
|
||||
pub fn set_resolution(&mut self, resolution: Resolution) {
|
||||
unsafe {
|
||||
T::regs().cr1().modify(|reg| reg.set_res(resolution.into()));
|
||||
}
|
||||
T::regs().cr1().modify(|reg| reg.set_res(resolution.into()));
|
||||
}
|
||||
|
||||
/// Enables internal voltage reference and returns [VrefInt], which can be used in
|
||||
/// [Adc::read_internal()] to perform conversion.
|
||||
pub fn enable_vrefint(&self) -> VrefInt {
|
||||
unsafe {
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_tsvrefe(crate::pac::adccommon::vals::Tsvrefe::ENABLED);
|
||||
});
|
||||
}
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_tsvrefe(crate::pac::adccommon::vals::Tsvrefe::ENABLED);
|
||||
});
|
||||
|
||||
VrefInt {}
|
||||
}
|
||||
@ -144,11 +137,9 @@ where
|
||||
/// On STM32F42 and STM32F43 this can not be used together with [Vbat]. If both are enabled,
|
||||
/// temperature sensor will return vbat value.
|
||||
pub fn enable_temperature(&self) -> Temperature {
|
||||
unsafe {
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_tsvrefe(crate::pac::adccommon::vals::Tsvrefe::ENABLED);
|
||||
});
|
||||
}
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_tsvrefe(crate::pac::adccommon::vals::Tsvrefe::ENABLED);
|
||||
});
|
||||
|
||||
Temperature {}
|
||||
}
|
||||
@ -156,37 +147,33 @@ where
|
||||
/// Enables vbat input and returns [Vbat], which can be used in
|
||||
/// [Adc::read_internal()] to perform conversion.
|
||||
pub fn enable_vbat(&self) -> Vbat {
|
||||
unsafe {
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_vbate(crate::pac::adccommon::vals::Vbate::ENABLED);
|
||||
});
|
||||
}
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_vbate(crate::pac::adccommon::vals::Vbate::ENABLED);
|
||||
});
|
||||
|
||||
Vbat {}
|
||||
}
|
||||
|
||||
/// Perform a single conversion.
|
||||
fn convert(&mut self) -> u16 {
|
||||
unsafe {
|
||||
// clear end of conversion flag
|
||||
T::regs().sr().modify(|reg| {
|
||||
reg.set_eoc(crate::pac::adc::vals::Eoc::NOTCOMPLETE);
|
||||
});
|
||||
// clear end of conversion flag
|
||||
T::regs().sr().modify(|reg| {
|
||||
reg.set_eoc(crate::pac::adc::vals::Eoc::NOTCOMPLETE);
|
||||
});
|
||||
|
||||
// Start conversion
|
||||
T::regs().cr2().modify(|reg| {
|
||||
reg.set_swstart(true);
|
||||
});
|
||||
// Start conversion
|
||||
T::regs().cr2().modify(|reg| {
|
||||
reg.set_swstart(true);
|
||||
});
|
||||
|
||||
while T::regs().sr().read().strt() == crate::pac::adc::vals::Strt::NOTSTARTED {
|
||||
// spin //wait for actual start
|
||||
}
|
||||
while T::regs().sr().read().eoc() == crate::pac::adc::vals::Eoc::NOTCOMPLETE {
|
||||
// spin //wait for finish
|
||||
}
|
||||
|
||||
T::regs().dr().read().0 as u16
|
||||
while T::regs().sr().read().strt() == crate::pac::adc::vals::Strt::NOTSTARTED {
|
||||
// spin //wait for actual start
|
||||
}
|
||||
while T::regs().sr().read().eoc() == crate::pac::adc::vals::Eoc::NOTCOMPLETE {
|
||||
// spin //wait for finish
|
||||
}
|
||||
|
||||
T::regs().dr().read().0 as u16
|
||||
}
|
||||
|
||||
pub fn read<P>(&mut self, pin: &mut P) -> u16
|
||||
@ -194,18 +181,16 @@ where
|
||||
P: AdcPin<T>,
|
||||
P: crate::gpio::sealed::Pin,
|
||||
{
|
||||
unsafe {
|
||||
pin.set_as_analog();
|
||||
pin.set_as_analog();
|
||||
|
||||
self.read_channel(pin.channel())
|
||||
}
|
||||
self.read_channel(pin.channel())
|
||||
}
|
||||
|
||||
pub fn read_internal(&mut self, channel: &mut impl InternalChannel<T>) -> u16 {
|
||||
unsafe { self.read_channel(channel.channel()) }
|
||||
self.read_channel(channel.channel())
|
||||
}
|
||||
|
||||
unsafe fn read_channel(&mut self, channel: u8) -> u16 {
|
||||
fn read_channel(&mut self, channel: u8) -> u16 {
|
||||
// Configure ADC
|
||||
|
||||
// Select channel
|
||||
@ -219,7 +204,7 @@ where
|
||||
val
|
||||
}
|
||||
|
||||
unsafe fn set_channel_sample_time(ch: u8, sample_time: SampleTime) {
|
||||
fn set_channel_sample_time(ch: u8, sample_time: SampleTime) {
|
||||
let sample_time = sample_time.into();
|
||||
if ch <= 9 {
|
||||
T::regs().smpr2().modify(|reg| reg.set_smp(ch as _, sample_time));
|
||||
|
@ -12,7 +12,7 @@ pub const VREF_CALIB_MV: u32 = 3000;
|
||||
/// Sadly we cannot use `RccPeripheral::enable` since devices are quite inconsistent ADC clock
|
||||
/// configuration.
|
||||
fn enable() {
|
||||
critical_section::with(|_| unsafe {
|
||||
critical_section::with(|_| {
|
||||
#[cfg(stm32h7)]
|
||||
crate::pac::RCC.apb2enr().modify(|w| w.set_adcen(true));
|
||||
#[cfg(stm32g0)]
|
||||
@ -62,29 +62,25 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
pub fn new(adc: impl Peripheral<P = T> + 'd, delay: &mut impl DelayUs<u32>) -> Self {
|
||||
into_ref!(adc);
|
||||
enable();
|
||||
unsafe {
|
||||
T::regs().cr().modify(|reg| {
|
||||
#[cfg(not(adc_g0))]
|
||||
reg.set_deeppwd(false);
|
||||
reg.set_advregen(true);
|
||||
});
|
||||
T::regs().cr().modify(|reg| {
|
||||
#[cfg(not(adc_g0))]
|
||||
reg.set_deeppwd(false);
|
||||
reg.set_advregen(true);
|
||||
});
|
||||
|
||||
#[cfg(adc_g0)]
|
||||
T::regs().cfgr1().modify(|reg| {
|
||||
reg.set_chselrmod(false);
|
||||
});
|
||||
}
|
||||
#[cfg(adc_g0)]
|
||||
T::regs().cfgr1().modify(|reg| {
|
||||
reg.set_chselrmod(false);
|
||||
});
|
||||
|
||||
delay.delay_us(20);
|
||||
|
||||
unsafe {
|
||||
T::regs().cr().modify(|reg| {
|
||||
reg.set_adcal(true);
|
||||
});
|
||||
T::regs().cr().modify(|reg| {
|
||||
reg.set_adcal(true);
|
||||
});
|
||||
|
||||
while T::regs().cr().read().adcal() {
|
||||
// spin
|
||||
}
|
||||
while T::regs().cr().read().adcal() {
|
||||
// spin
|
||||
}
|
||||
|
||||
delay.delay_us(1);
|
||||
@ -96,11 +92,9 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
}
|
||||
|
||||
pub fn enable_vrefint(&self, delay: &mut impl DelayUs<u32>) -> VrefInt {
|
||||
unsafe {
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_vrefen(true);
|
||||
});
|
||||
}
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_vrefen(true);
|
||||
});
|
||||
|
||||
// "Table 24. Embedded internal voltage reference" states that it takes a maximum of 12 us
|
||||
// to stabilize the internal voltage reference, we wait a little more.
|
||||
@ -112,21 +106,17 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
}
|
||||
|
||||
pub fn enable_temperature(&self) -> Temperature {
|
||||
unsafe {
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_ch17sel(true);
|
||||
});
|
||||
}
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_ch17sel(true);
|
||||
});
|
||||
|
||||
Temperature {}
|
||||
}
|
||||
|
||||
pub fn enable_vbat(&self) -> Vbat {
|
||||
unsafe {
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_ch18sel(true);
|
||||
});
|
||||
}
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_ch18sel(true);
|
||||
});
|
||||
|
||||
Vbat {}
|
||||
}
|
||||
@ -136,12 +126,10 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
}
|
||||
|
||||
pub fn set_resolution(&mut self, resolution: Resolution) {
|
||||
unsafe {
|
||||
#[cfg(not(stm32g0))]
|
||||
T::regs().cfgr().modify(|reg| reg.set_res(resolution.into()));
|
||||
#[cfg(stm32g0)]
|
||||
T::regs().cfgr1().modify(|reg| reg.set_res(resolution.into()));
|
||||
}
|
||||
#[cfg(not(stm32g0))]
|
||||
T::regs().cfgr().modify(|reg| reg.set_res(resolution.into()));
|
||||
#[cfg(stm32g0)]
|
||||
T::regs().cfgr1().modify(|reg| reg.set_res(resolution.into()));
|
||||
}
|
||||
|
||||
/*
|
||||
@ -155,77 +143,73 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
|
||||
/// Perform a single conversion.
|
||||
fn convert(&mut self) -> u16 {
|
||||
unsafe {
|
||||
T::regs().isr().modify(|reg| {
|
||||
reg.set_eos(true);
|
||||
reg.set_eoc(true);
|
||||
});
|
||||
T::regs().isr().modify(|reg| {
|
||||
reg.set_eos(true);
|
||||
reg.set_eoc(true);
|
||||
});
|
||||
|
||||
// Start conversion
|
||||
T::regs().cr().modify(|reg| {
|
||||
reg.set_adstart(true);
|
||||
});
|
||||
// Start conversion
|
||||
T::regs().cr().modify(|reg| {
|
||||
reg.set_adstart(true);
|
||||
});
|
||||
|
||||
while !T::regs().isr().read().eos() {
|
||||
// spin
|
||||
}
|
||||
|
||||
T::regs().dr().read().0 as u16
|
||||
while !T::regs().isr().read().eos() {
|
||||
// spin
|
||||
}
|
||||
|
||||
T::regs().dr().read().0 as u16
|
||||
}
|
||||
|
||||
pub fn read(&mut self, pin: &mut impl AdcPin<T>) -> u16 {
|
||||
unsafe {
|
||||
// Make sure bits are off
|
||||
while T::regs().cr().read().addis() {
|
||||
// spin
|
||||
}
|
||||
|
||||
// Enable ADC
|
||||
T::regs().isr().modify(|reg| {
|
||||
reg.set_adrdy(true);
|
||||
});
|
||||
T::regs().cr().modify(|reg| {
|
||||
reg.set_aden(true);
|
||||
});
|
||||
|
||||
while !T::regs().isr().read().adrdy() {
|
||||
// spin
|
||||
}
|
||||
|
||||
// Configure channel
|
||||
Self::set_channel_sample_time(pin.channel(), self.sample_time);
|
||||
|
||||
// Select channel
|
||||
#[cfg(not(stm32g0))]
|
||||
T::regs().sqr1().write(|reg| reg.set_sq(0, pin.channel()));
|
||||
#[cfg(stm32g0)]
|
||||
T::regs().chselr().write(|reg| reg.set_chsel(1 << pin.channel()));
|
||||
|
||||
// Some models are affected by an erratum:
|
||||
// If we perform conversions slower than 1 kHz, the first read ADC value can be
|
||||
// corrupted, so we discard it and measure again.
|
||||
//
|
||||
// STM32L471xx: Section 2.7.3
|
||||
// STM32G4: Section 2.7.3
|
||||
#[cfg(any(rcc_l4, rcc_g4))]
|
||||
let _ = self.convert();
|
||||
|
||||
let val = self.convert();
|
||||
|
||||
T::regs().cr().modify(|reg| reg.set_addis(true));
|
||||
|
||||
val
|
||||
// Make sure bits are off
|
||||
while T::regs().cr().read().addis() {
|
||||
// spin
|
||||
}
|
||||
|
||||
// Enable ADC
|
||||
T::regs().isr().modify(|reg| {
|
||||
reg.set_adrdy(true);
|
||||
});
|
||||
T::regs().cr().modify(|reg| {
|
||||
reg.set_aden(true);
|
||||
});
|
||||
|
||||
while !T::regs().isr().read().adrdy() {
|
||||
// spin
|
||||
}
|
||||
|
||||
// Configure channel
|
||||
Self::set_channel_sample_time(pin.channel(), self.sample_time);
|
||||
|
||||
// Select channel
|
||||
#[cfg(not(stm32g0))]
|
||||
T::regs().sqr1().write(|reg| reg.set_sq(0, pin.channel()));
|
||||
#[cfg(stm32g0)]
|
||||
T::regs().chselr().write(|reg| reg.set_chsel(1 << pin.channel()));
|
||||
|
||||
// Some models are affected by an erratum:
|
||||
// If we perform conversions slower than 1 kHz, the first read ADC value can be
|
||||
// corrupted, so we discard it and measure again.
|
||||
//
|
||||
// STM32L471xx: Section 2.7.3
|
||||
// STM32G4: Section 2.7.3
|
||||
#[cfg(any(rcc_l4, rcc_g4))]
|
||||
let _ = self.convert();
|
||||
|
||||
let val = self.convert();
|
||||
|
||||
T::regs().cr().modify(|reg| reg.set_addis(true));
|
||||
|
||||
val
|
||||
}
|
||||
|
||||
#[cfg(stm32g0)]
|
||||
unsafe fn set_channel_sample_time(_ch: u8, sample_time: SampleTime) {
|
||||
fn set_channel_sample_time(_ch: u8, sample_time: SampleTime) {
|
||||
T::regs().smpr().modify(|reg| reg.set_smp1(sample_time.into()));
|
||||
}
|
||||
|
||||
#[cfg(not(stm32g0))]
|
||||
unsafe fn set_channel_sample_time(ch: u8, sample_time: SampleTime) {
|
||||
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));
|
||||
|
@ -46,8 +46,8 @@ foreach_peripheral!(
|
||||
(adc, ADC1) => {
|
||||
impl crate::rcc::sealed::RccPeripheral for crate::peripherals::ADC1 {
|
||||
fn frequency() -> crate::time::Hertz {
|
||||
critical_section::with(|_| unsafe {
|
||||
match crate::rcc::get_freqs().adc {
|
||||
critical_section::with(|_| {
|
||||
match unsafe { crate::rcc::get_freqs() }.adc {
|
||||
Some(ck) => ck,
|
||||
None => panic!("Invalid ADC clock configuration, AdcClockSource was likely not properly configured.")
|
||||
}
|
||||
@ -55,7 +55,7 @@ foreach_peripheral!(
|
||||
}
|
||||
|
||||
fn enable() {
|
||||
critical_section::with(|_| unsafe {
|
||||
critical_section::with(|_| {
|
||||
crate::pac::RCC.ahb1enr().modify(|w| w.set_adc12en(true))
|
||||
});
|
||||
ADC12_ENABLE_COUNTER.fetch_add(1, Ordering::SeqCst);
|
||||
@ -63,7 +63,7 @@ foreach_peripheral!(
|
||||
|
||||
fn disable() {
|
||||
if ADC12_ENABLE_COUNTER.load(Ordering::SeqCst) == 1 {
|
||||
critical_section::with(|_| unsafe {
|
||||
critical_section::with(|_| {
|
||||
crate::pac::RCC.ahb1enr().modify(|w| w.set_adc12en(false));
|
||||
})
|
||||
}
|
||||
@ -72,7 +72,7 @@ foreach_peripheral!(
|
||||
|
||||
fn reset() {
|
||||
if ADC12_ENABLE_COUNTER.load(Ordering::SeqCst) == 1 {
|
||||
critical_section::with(|_| unsafe {
|
||||
critical_section::with(|_| {
|
||||
crate::pac::RCC.ahb1rstr().modify(|w| w.set_adc12rst(true));
|
||||
crate::pac::RCC.ahb1rstr().modify(|w| w.set_adc12rst(false));
|
||||
});
|
||||
@ -85,8 +85,8 @@ foreach_peripheral!(
|
||||
(adc, ADC2) => {
|
||||
impl crate::rcc::sealed::RccPeripheral for crate::peripherals::ADC2 {
|
||||
fn frequency() -> crate::time::Hertz {
|
||||
critical_section::with(|_| unsafe {
|
||||
match crate::rcc::get_freqs().adc {
|
||||
critical_section::with(|_| {
|
||||
match unsafe { crate::rcc::get_freqs() }.adc {
|
||||
Some(ck) => ck,
|
||||
None => panic!("Invalid ADC clock configuration, AdcClockSource was likely not properly configured.")
|
||||
}
|
||||
@ -94,7 +94,7 @@ foreach_peripheral!(
|
||||
}
|
||||
|
||||
fn enable() {
|
||||
critical_section::with(|_| unsafe {
|
||||
critical_section::with(|_| {
|
||||
crate::pac::RCC.ahb1enr().modify(|w| w.set_adc12en(true))
|
||||
});
|
||||
ADC12_ENABLE_COUNTER.fetch_add(1, Ordering::SeqCst);
|
||||
@ -102,7 +102,7 @@ foreach_peripheral!(
|
||||
|
||||
fn disable() {
|
||||
if ADC12_ENABLE_COUNTER.load(Ordering::SeqCst) == 1 {
|
||||
critical_section::with(|_| unsafe {
|
||||
critical_section::with(|_| {
|
||||
crate::pac::RCC.ahb1enr().modify(|w| w.set_adc12en(false));
|
||||
})
|
||||
}
|
||||
@ -111,7 +111,7 @@ foreach_peripheral!(
|
||||
|
||||
fn reset() {
|
||||
if ADC12_ENABLE_COUNTER.load(Ordering::SeqCst) == 1 {
|
||||
critical_section::with(|_| unsafe {
|
||||
critical_section::with(|_| {
|
||||
crate::pac::RCC.ahb1rstr().modify(|w| w.set_adc12rst(true));
|
||||
crate::pac::RCC.ahb1rstr().modify(|w| w.set_adc12rst(false));
|
||||
});
|
||||
@ -124,8 +124,8 @@ foreach_peripheral!(
|
||||
(adc, ADC3) => {
|
||||
impl crate::rcc::sealed::RccPeripheral for crate::peripherals::ADC3 {
|
||||
fn frequency() -> crate::time::Hertz {
|
||||
critical_section::with(|_| unsafe {
|
||||
match crate::rcc::get_freqs().adc {
|
||||
critical_section::with(|_| {
|
||||
match unsafe { crate::rcc::get_freqs() }.adc {
|
||||
Some(ck) => ck,
|
||||
None => panic!("Invalid ADC clock configuration, AdcClockSource was likely not properly configured.")
|
||||
}
|
||||
@ -133,22 +133,22 @@ foreach_peripheral!(
|
||||
}
|
||||
|
||||
fn enable() {
|
||||
critical_section::with(|_| unsafe {
|
||||
critical_section::with(|_| {
|
||||
crate::pac::RCC.ahb4enr().modify(|w| w.set_adc3en(true))
|
||||
});
|
||||
}
|
||||
|
||||
fn disable() {
|
||||
critical_section::with(|_| unsafe {
|
||||
crate::pac::RCC.ahb4enr().modify(|w| w.set_adc3en(false));
|
||||
})
|
||||
critical_section::with(|_| {
|
||||
crate::pac::RCC.ahb4enr().modify(|w| w.set_adc3en(false));
|
||||
})
|
||||
}
|
||||
|
||||
fn reset() {
|
||||
critical_section::with(|_| unsafe {
|
||||
crate::pac::RCC.ahb4rstr().modify(|w| w.set_adc3rst(true));
|
||||
crate::pac::RCC.ahb4rstr().modify(|w| w.set_adc3rst(false));
|
||||
});
|
||||
critical_section::with(|_| {
|
||||
crate::pac::RCC.ahb4rstr().modify(|w| w.set_adc3rst(true));
|
||||
crate::pac::RCC.ahb4rstr().modify(|w| w.set_adc3rst(false));
|
||||
});
|
||||
}
|
||||
}
|
||||
|
||||
@ -232,9 +232,7 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
|
||||
let prescaler = Prescaler::from_ker_ck(T::frequency());
|
||||
|
||||
unsafe {
|
||||
T::common_regs().ccr().modify(|w| w.set_presc(prescaler.presc()));
|
||||
}
|
||||
T::common_regs().ccr().modify(|w| w.set_presc(prescaler.presc()));
|
||||
|
||||
let frequency = Hertz(T::frequency().0 / prescaler.divisor());
|
||||
info!("ADC frequency set to {} Hz", frequency.0);
|
||||
@ -251,9 +249,7 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
} else {
|
||||
Boost::LT50
|
||||
};
|
||||
unsafe {
|
||||
T::regs().cr().modify(|w| w.set_boost(boost));
|
||||
}
|
||||
T::regs().cr().modify(|w| w.set_boost(boost));
|
||||
|
||||
let mut s = Self {
|
||||
adc,
|
||||
@ -272,84 +268,68 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
}
|
||||
|
||||
fn power_up(&mut self, delay: &mut impl DelayUs<u16>) {
|
||||
unsafe {
|
||||
T::regs().cr().modify(|reg| {
|
||||
reg.set_deeppwd(false);
|
||||
reg.set_advregen(true);
|
||||
});
|
||||
}
|
||||
T::regs().cr().modify(|reg| {
|
||||
reg.set_deeppwd(false);
|
||||
reg.set_advregen(true);
|
||||
});
|
||||
|
||||
delay.delay_us(10);
|
||||
}
|
||||
|
||||
fn configure_differential_inputs(&mut self) {
|
||||
unsafe {
|
||||
T::regs().difsel().modify(|w| {
|
||||
for n in 0..20 {
|
||||
w.set_difsel(n, Difsel::SINGLEENDED);
|
||||
}
|
||||
})
|
||||
};
|
||||
T::regs().difsel().modify(|w| {
|
||||
for n in 0..20 {
|
||||
w.set_difsel(n, Difsel::SINGLEENDED);
|
||||
}
|
||||
});
|
||||
}
|
||||
|
||||
fn calibrate(&mut self) {
|
||||
unsafe {
|
||||
T::regs().cr().modify(|w| {
|
||||
w.set_adcaldif(Adcaldif::SINGLEENDED);
|
||||
w.set_adcallin(true);
|
||||
});
|
||||
T::regs().cr().modify(|w| {
|
||||
w.set_adcaldif(Adcaldif::SINGLEENDED);
|
||||
w.set_adcallin(true);
|
||||
});
|
||||
|
||||
T::regs().cr().modify(|w| w.set_adcal(true));
|
||||
T::regs().cr().modify(|w| w.set_adcal(true));
|
||||
|
||||
while T::regs().cr().read().adcal() {}
|
||||
}
|
||||
while T::regs().cr().read().adcal() {}
|
||||
}
|
||||
|
||||
fn enable(&mut self) {
|
||||
unsafe {
|
||||
T::regs().isr().write(|w| w.set_adrdy(true));
|
||||
T::regs().cr().modify(|w| w.set_aden(true));
|
||||
while !T::regs().isr().read().adrdy() {}
|
||||
T::regs().isr().write(|w| w.set_adrdy(true));
|
||||
}
|
||||
T::regs().isr().write(|w| w.set_adrdy(true));
|
||||
T::regs().cr().modify(|w| w.set_aden(true));
|
||||
while !T::regs().isr().read().adrdy() {}
|
||||
T::regs().isr().write(|w| w.set_adrdy(true));
|
||||
}
|
||||
|
||||
fn configure(&mut self) {
|
||||
// single conversion mode, software trigger
|
||||
unsafe {
|
||||
T::regs().cfgr().modify(|w| {
|
||||
w.set_cont(false);
|
||||
w.set_exten(Exten::DISABLED);
|
||||
})
|
||||
}
|
||||
T::regs().cfgr().modify(|w| {
|
||||
w.set_cont(false);
|
||||
w.set_exten(Exten::DISABLED);
|
||||
});
|
||||
}
|
||||
|
||||
pub fn enable_vrefint(&self) -> VrefInt {
|
||||
unsafe {
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_vrefen(true);
|
||||
});
|
||||
}
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_vrefen(true);
|
||||
});
|
||||
|
||||
VrefInt {}
|
||||
}
|
||||
|
||||
pub fn enable_temperature(&self) -> Temperature {
|
||||
unsafe {
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_vsenseen(true);
|
||||
});
|
||||
}
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_vsenseen(true);
|
||||
});
|
||||
|
||||
Temperature {}
|
||||
}
|
||||
|
||||
pub fn enable_vbat(&self) -> Vbat {
|
||||
unsafe {
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_vbaten(true);
|
||||
});
|
||||
}
|
||||
T::common_regs().ccr().modify(|reg| {
|
||||
reg.set_vbaten(true);
|
||||
});
|
||||
|
||||
Vbat {}
|
||||
}
|
||||
@ -359,30 +339,26 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
}
|
||||
|
||||
pub fn set_resolution(&mut self, resolution: Resolution) {
|
||||
unsafe {
|
||||
T::regs().cfgr().modify(|reg| reg.set_res(resolution.into()));
|
||||
}
|
||||
T::regs().cfgr().modify(|reg| reg.set_res(resolution.into()));
|
||||
}
|
||||
|
||||
/// Perform a single conversion.
|
||||
fn convert(&mut self) -> u16 {
|
||||
unsafe {
|
||||
T::regs().isr().modify(|reg| {
|
||||
reg.set_eos(true);
|
||||
reg.set_eoc(true);
|
||||
});
|
||||
T::regs().isr().modify(|reg| {
|
||||
reg.set_eos(true);
|
||||
reg.set_eoc(true);
|
||||
});
|
||||
|
||||
// Start conversion
|
||||
T::regs().cr().modify(|reg| {
|
||||
reg.set_adstart(true);
|
||||
});
|
||||
// Start conversion
|
||||
T::regs().cr().modify(|reg| {
|
||||
reg.set_adstart(true);
|
||||
});
|
||||
|
||||
while !T::regs().isr().read().eos() {
|
||||
// spin
|
||||
}
|
||||
|
||||
T::regs().dr().read().0 as u16
|
||||
while !T::regs().isr().read().eos() {
|
||||
// spin
|
||||
}
|
||||
|
||||
T::regs().dr().read().0 as u16
|
||||
}
|
||||
|
||||
pub fn read<P>(&mut self, pin: &mut P) -> u16
|
||||
@ -390,18 +366,16 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
P: AdcPin<T>,
|
||||
P: crate::gpio::sealed::Pin,
|
||||
{
|
||||
unsafe {
|
||||
pin.set_as_analog();
|
||||
pin.set_as_analog();
|
||||
|
||||
self.read_channel(pin.channel())
|
||||
}
|
||||
self.read_channel(pin.channel())
|
||||
}
|
||||
|
||||
pub fn read_internal(&mut self, channel: &mut impl InternalChannel<T>) -> u16 {
|
||||
unsafe { self.read_channel(channel.channel()) }
|
||||
self.read_channel(channel.channel())
|
||||
}
|
||||
|
||||
unsafe fn read_channel(&mut self, channel: u8) -> u16 {
|
||||
fn read_channel(&mut self, channel: u8) -> u16 {
|
||||
// Configure channel
|
||||
Self::set_channel_sample_time(channel, self.sample_time);
|
||||
|
||||
@ -417,7 +391,7 @@ impl<'d, T: Instance> Adc<'d, T> {
|
||||
self.convert()
|
||||
}
|
||||
|
||||
unsafe fn set_channel_sample_time(ch: u8, sample_time: SampleTime) {
|
||||
fn set_channel_sample_time(ch: u8, sample_time: SampleTime) {
|
||||
let sample_time = sample_time.into();
|
||||
if ch <= 9 {
|
||||
T::regs().smpr(0).modify(|reg| reg.set_smp(ch as _, sample_time));
|
||||
|
Reference in New Issue
Block a user