embassy/examples/stm32l4/src/bin/dac.rs

45 lines
956 B
Rust
Raw Normal View History

2021-06-08 20:04:56 +02:00
#![no_std]
#![no_main]
#![feature(type_alias_impl_trait)]
use defmt::*;
2021-07-24 13:57:11 +02:00
use embassy_stm32::dac::{Channel, Dac, Value};
use embassy_stm32::pac;
2022-06-12 22:15:44 +02:00
use {defmt_rtt as _, panic_probe as _};
2021-06-08 20:04:56 +02:00
#[cortex_m_rt::entry]
fn main() -> ! {
2021-07-24 13:57:11 +02:00
info!("Hello World!");
2021-06-08 20:04:56 +02:00
unsafe {
pac::RCC.apb1enr1().modify(|w| {
w.set_dac1en(true);
});
}
2021-06-08 20:04:56 +02:00
let p = embassy_stm32::init(Default::default());
let mut dac = Dac::new_1ch(p.DAC1, p.PA4);
2021-06-08 20:04:56 +02:00
loop {
for v in 0..=255 {
2021-07-03 14:05:12 +02:00
unwrap!(dac.set(Channel::Ch1, Value::Bit8(to_sine_wave(v))));
unwrap!(dac.trigger(Channel::Ch1));
2021-06-08 20:04:56 +02:00
}
}
}
use micromath::F32Ext;
fn to_sine_wave(v: u8) -> u8 {
if v >= 128 {
// top half
2021-06-10 21:33:43 +02:00
let r = 3.14 * ((v - 128) as f32 / 128.0);
2021-06-08 20:04:56 +02:00
(r.sin() * 128.0 + 127.0) as u8
} else {
// bottom half
2021-06-10 21:33:43 +02:00
let r = 3.14 + 3.14 * (v as f32 / 128.0);
2021-06-08 20:04:56 +02:00
(r.sin() * 128.0 + 127.0) as u8
}
}