diff options
Diffstat (limited to 'examples/stm32h5/src/bin')
| -rw-r--r-- | examples/stm32h5/src/bin/dts.rs | 75 |
1 files changed, 75 insertions, 0 deletions
diff --git a/examples/stm32h5/src/bin/dts.rs b/examples/stm32h5/src/bin/dts.rs new file mode 100644 index 000000000..8c18fafea --- /dev/null +++ b/examples/stm32h5/src/bin/dts.rs | |||
| @@ -0,0 +1,75 @@ | |||
| 1 | #![no_std] | ||
| 2 | #![no_main] | ||
| 3 | |||
| 4 | use defmt::*; | ||
| 5 | use embassy_executor::Spawner; | ||
| 6 | use embassy_stm32::dts::{Dts, InterruptHandler, SampleTime}; | ||
| 7 | use embassy_stm32::peripherals::DTS; | ||
| 8 | use embassy_stm32::rcc::frequency; | ||
| 9 | use embassy_stm32::{bind_interrupts, dts, Config}; | ||
| 10 | use embassy_time::Timer; | ||
| 11 | use {defmt_rtt as _, panic_probe as _}; | ||
| 12 | |||
| 13 | bind_interrupts!(struct Irqs { | ||
| 14 | DTS => InterruptHandler; | ||
| 15 | }); | ||
| 16 | |||
| 17 | #[embassy_executor::main] | ||
| 18 | async fn main(_spawner: Spawner) { | ||
| 19 | let mut config = Config::default(); | ||
| 20 | { | ||
| 21 | use embassy_stm32::rcc::*; | ||
| 22 | config.rcc.hsi = Some(HSIPrescaler::DIV1); | ||
| 23 | config.rcc.csi = true; | ||
| 24 | config.rcc.pll1 = Some(Pll { | ||
| 25 | source: PllSource::HSI, | ||
| 26 | prediv: PllPreDiv::DIV4, | ||
| 27 | mul: PllMul::MUL25, | ||
| 28 | divp: Some(PllDiv::DIV2), | ||
| 29 | divq: Some(PllDiv::DIV4), // SPI1 cksel defaults to pll1_q | ||
| 30 | divr: None, | ||
| 31 | }); | ||
| 32 | config.rcc.pll2 = Some(Pll { | ||
| 33 | source: PllSource::HSI, | ||
| 34 | prediv: PllPreDiv::DIV4, | ||
| 35 | mul: PllMul::MUL25, | ||
| 36 | divp: None, | ||
| 37 | divq: None, | ||
| 38 | divr: Some(PllDiv::DIV4), // 100mhz | ||
| 39 | }); | ||
| 40 | config.rcc.sys = Sysclk::PLL1_P; // 200 Mhz | ||
| 41 | config.rcc.ahb_pre = AHBPrescaler::DIV1; // 200 Mhz | ||
| 42 | config.rcc.apb1_pre = APBPrescaler::DIV2; // 100 Mhz | ||
| 43 | config.rcc.apb2_pre = APBPrescaler::DIV2; // 100 Mhz | ||
| 44 | config.rcc.apb3_pre = APBPrescaler::DIV2; // 100 Mhz | ||
| 45 | config.rcc.voltage_scale = VoltageScale::Scale1; | ||
| 46 | config.rcc.mux.adcdacsel = mux::Adcdacsel::PLL2_R; | ||
| 47 | } | ||
| 48 | let p = embassy_stm32::init(config); | ||
| 49 | |||
| 50 | info!("Hello World!"); | ||
| 51 | |||
| 52 | let mut config = dts::Config::default(); | ||
| 53 | config.sample_time = SampleTime::ClockCycles15; | ||
| 54 | let mut dts = Dts::new(p.DTS, Irqs, config); | ||
| 55 | |||
| 56 | let cal = Dts::factory_calibration(); | ||
| 57 | let convert_to_celsius = |raw_temp: u16| { | ||
| 58 | let raw_temp = raw_temp as f32; | ||
| 59 | let sample_time = (config.sample_time as u8) as f32; | ||
| 60 | |||
| 61 | let f = frequency::<DTS>().0 as f32; | ||
| 62 | |||
| 63 | let t0 = cal.t0 as f32; | ||
| 64 | let fmt0 = cal.fmt0.0 as f32; | ||
| 65 | let ramp_coeff = cal.ramp_coeff as f32; | ||
| 66 | |||
| 67 | ((f * sample_time / raw_temp) - fmt0) / ramp_coeff + t0 | ||
| 68 | }; | ||
| 69 | |||
| 70 | loop { | ||
| 71 | let temp = dts.read().await; | ||
| 72 | info!("Temp: {} degrees", convert_to_celsius(temp)); | ||
| 73 | Timer::after_millis(500).await; | ||
| 74 | } | ||
| 75 | } | ||
