60 lines
1.8 KiB
Rust
60 lines
1.8 KiB
Rust
#![no_std]
|
|
#![no_main]
|
|
#![feature(type_alias_impl_trait)]
|
|
|
|
use defmt::info;
|
|
use embassy_executor::Spawner;
|
|
use embassy_stm32::adc::{Adc, SampleTime};
|
|
use embassy_stm32::opamp::{OpAmp, OpAmpGain};
|
|
use embassy_stm32::peripherals::ADC2;
|
|
use embassy_stm32::rcc::{AdcClockSource, Adcpres};
|
|
use embassy_stm32::time::mhz;
|
|
use embassy_stm32::{adc, bind_interrupts, Config};
|
|
use embassy_time::{Delay, Duration, Timer};
|
|
use {defmt_rtt as _, panic_probe as _};
|
|
|
|
bind_interrupts!(struct Irqs {
|
|
ADC1_2 => adc::InterruptHandler<ADC2>;
|
|
});
|
|
|
|
#[embassy_executor::main]
|
|
async fn main(_spawner: Spawner) -> ! {
|
|
let mut config = Config::default();
|
|
config.rcc.sysclk = Some(mhz(64));
|
|
config.rcc.hclk = Some(mhz(64));
|
|
config.rcc.pclk1 = Some(mhz(32));
|
|
config.rcc.pclk2 = Some(mhz(64));
|
|
config.rcc.adc = Some(AdcClockSource::Pll(Adcpres::DIV1));
|
|
|
|
let mut p = embassy_stm32::init(config);
|
|
|
|
info!("create adc...");
|
|
|
|
let mut adc = Adc::new(p.ADC2, Irqs, &mut Delay);
|
|
let mut opamp = OpAmp::new(p.OPAMP2);
|
|
|
|
adc.set_sample_time(SampleTime::Cycles601_5);
|
|
|
|
info!("enable vrefint...");
|
|
|
|
let mut vrefint = adc.enable_vref(&mut Delay);
|
|
let mut temperature = adc.enable_temperature();
|
|
let mut buffer = opamp.buffer_for(&mut p.PA7, OpAmpGain::Mul1);
|
|
|
|
loop {
|
|
let vref = adc.read(&mut vrefint).await;
|
|
info!("read vref: {} (should be {})", vref, vrefint.value());
|
|
|
|
let temp = adc.read(&mut temperature).await;
|
|
info!("read temperature: {}", temp);
|
|
|
|
let buffer = adc.read(&mut buffer).await;
|
|
info!("read buffer: {}", buffer);
|
|
|
|
let pin_mv = (buffer as u32 * vrefint.value() as u32 / vref as u32) * 3300 / 4095;
|
|
info!("computed pin mv: {}", pin_mv);
|
|
|
|
Timer::after(Duration::from_millis(500)).await;
|
|
}
|
|
}
|