diff options
| author | shufps <[email protected]> | 2024-06-28 14:42:19 +0200 |
|---|---|---|
| committer | shufps <[email protected]> | 2024-06-28 14:42:19 +0200 |
| commit | ece6203a996207f25db737032d3e0dae3df80b64 (patch) | |
| tree | 0ab1ae24a3f47c5cdcaf73cfdfd5c8ec646f8125 | |
| parent | 26e660722cca9151e5a9331c328421145509ab20 (diff) | |
added DDS example
| -rw-r--r-- | examples/stm32l0/Cargo.toml | 2 | ||||
| -rw-r--r-- | examples/stm32l0/src/bin/dds.rs | 117 |
2 files changed, 118 insertions, 1 deletions
diff --git a/examples/stm32l0/Cargo.toml b/examples/stm32l0/Cargo.toml index 2c599e7a3..5b0519ac4 100644 --- a/examples/stm32l0/Cargo.toml +++ b/examples/stm32l0/Cargo.toml | |||
| @@ -6,7 +6,7 @@ license = "MIT OR Apache-2.0" | |||
| 6 | 6 | ||
| 7 | [dependencies] | 7 | [dependencies] |
| 8 | # Change stm32l072cz to your chip name, if necessary. | 8 | # Change stm32l072cz to your chip name, if necessary. |
| 9 | embassy-stm32 = { version = "0.1.0", path = "../../embassy-stm32", features = ["defmt", "stm32l072cz", "time-driver-any", "exti", "memory-x"] } | 9 | embassy-stm32 = { version = "0.1.0", path = "../../embassy-stm32", features = ["defmt", "stm32l072cz", "unstable-pac", "time-driver-any", "exti", "memory-x"] } |
| 10 | embassy-sync = { version = "0.6.0", path = "../../embassy-sync", features = ["defmt"] } | 10 | embassy-sync = { version = "0.6.0", path = "../../embassy-sync", features = ["defmt"] } |
| 11 | embassy-executor = { version = "0.5.0", path = "../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "defmt", "integrated-timers"] } | 11 | embassy-executor = { version = "0.5.0", path = "../../embassy-executor", features = ["arch-cortex-m", "executor-thread", "defmt", "integrated-timers"] } |
| 12 | embassy-time = { version = "0.3.1", path = "../../embassy-time", features = ["defmt", "defmt-timestamp-uptime", "tick-hz-32_768"] } | 12 | embassy-time = { version = "0.3.1", path = "../../embassy-time", features = ["defmt", "defmt-timestamp-uptime", "tick-hz-32_768"] } |
diff --git a/examples/stm32l0/src/bin/dds.rs b/examples/stm32l0/src/bin/dds.rs new file mode 100644 index 000000000..9759fc8f3 --- /dev/null +++ b/examples/stm32l0/src/bin/dds.rs | |||
| @@ -0,0 +1,117 @@ | |||
| 1 | #![no_std] | ||
| 2 | #![no_main] | ||
| 3 | |||
| 4 | use core::option::Option::Some; | ||
| 5 | use defmt::info; | ||
| 6 | use defmt_rtt as _; // global logger | ||
| 7 | use embassy_executor::Spawner; | ||
| 8 | use embassy_stm32::gpio::OutputType; | ||
| 9 | use embassy_stm32::interrupt; | ||
| 10 | use embassy_stm32::pac; | ||
| 11 | use embassy_stm32::rcc::*; | ||
| 12 | use embassy_stm32::time::hz; | ||
| 13 | use embassy_stm32::timer::low_level::Timer as LLTimer; | ||
| 14 | use embassy_stm32::timer::low_level::*; | ||
| 15 | use embassy_stm32::timer::simple_pwm::PwmPin; | ||
| 16 | use embassy_stm32::timer::Channel; | ||
| 17 | use embassy_stm32::Config; | ||
| 18 | use panic_probe as _; | ||
| 19 | |||
| 20 | const DDS_SINE_DATA: [u8; 256] = [ | ||
| 21 | 0x80, 0x83, 0x86, 0x89, 0x8c, 0x8f, 0x92, 0x95, 0x98, 0x9c, 0x9f, 0xa2, 0xa5, 0xa8, 0xab, 0xae, 0xb0, 0xb3, 0xb6, | ||
| 22 | 0xb9, 0xbc, 0xbf, 0xc1, 0xc4, 0xc7, 0xc9, 0xcc, 0xce, 0xd1, 0xd3, 0xd5, 0xd8, 0xda, 0xdc, 0xde, 0xe0, 0xe2, 0xe4, | ||
| 23 | 0xe6, 0xe8, 0xea, 0xec, 0xed, 0xef, 0xf0, 0xf2, 0xf3, 0xf5, 0xf6, 0xf7, 0xf8, 0xf9, 0xfa, 0xfb, 0xfc, 0xfc, 0xfd, | ||
| 24 | 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfe, 0xfd, 0xfc, 0xfc, 0xfb, | ||
| 25 | 0xfa, 0xf9, 0xf8, 0xf7, 0xf6, 0xf5, 0xf3, 0xf2, 0xf0, 0xef, 0xed, 0xec, 0xea, 0xe8, 0xe6, 0xe4, 0xe2, 0xe0, 0xde, | ||
| 26 | 0xdc, 0xda, 0xd8, 0xd5, 0xd3, 0xd1, 0xce, 0xcc, 0xc9, 0xc7, 0xc4, 0xc1, 0xbf, 0xbc, 0xb9, 0xb6, 0xb3, 0xb0, 0xae, | ||
| 27 | 0xab, 0xa8, 0xa5, 0xa2, 0x9f, 0x9c, 0x98, 0x95, 0x92, 0x8f, 0x8c, 0x89, 0x86, 0x83, 0x80, 0x7c, 0x79, 0x76, 0x73, | ||
| 28 | 0x70, 0x6d, 0x6a, 0x67, 0x63, 0x60, 0x5d, 0x5a, 0x57, 0x54, 0x51, 0x4f, 0x4c, 0x49, 0x46, 0x43, 0x40, 0x3e, 0x3b, | ||
| 29 | 0x38, 0x36, 0x33, 0x31, 0x2e, 0x2c, 0x2a, 0x27, 0x25, 0x23, 0x21, 0x1f, 0x1d, 0x1b, 0x19, 0x17, 0x15, 0x13, 0x12, | ||
| 30 | 0x10, 0x0f, 0x0d, 0x0c, 0x0a, 0x09, 0x08, 0x07, 0x06, 0x05, 0x04, 0x03, 0x03, 0x02, 0x01, 0x01, 0x01, 0x01, 0x01, | ||
| 31 | 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x03, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, | ||
| 32 | 0x0a, 0x0c, 0x0d, 0x0f, 0x10, 0x12, 0x13, 0x15, 0x17, 0x19, 0x1b, 0x1d, 0x1f, 0x21, 0x23, 0x25, 0x27, 0x2a, 0x2c, | ||
| 33 | 0x2e, 0x31, 0x33, 0x36, 0x38, 0x3b, 0x3e, 0x40, 0x43, 0x46, 0x49, 0x4c, 0x4f, 0x51, 0x54, 0x57, 0x5a, 0x5d, 0x60, | ||
| 34 | 0x63, 0x67, 0x6a, 0x6d, 0x70, 0x73, 0x76, 0x79, 0x7c, | ||
| 35 | ]; | ||
| 36 | |||
| 37 | // frequency: 15625/(256/(DDS_INCR/2**24)) = 999,99999Hz | ||
| 38 | static mut DDS_INCR: u32 = 0x10624DD2; | ||
| 39 | |||
| 40 | // fractional phase accumulator | ||
| 41 | static mut DDS_AKKU: u32 = 0x00000000; | ||
| 42 | |||
| 43 | #[interrupt] | ||
| 44 | fn TIM2() { | ||
| 45 | unsafe { | ||
| 46 | // get next value of DDS | ||
| 47 | DDS_AKKU = DDS_AKKU.wrapping_add(DDS_INCR); | ||
| 48 | let value = (DDS_SINE_DATA[(DDS_AKKU >> 24) as usize] as u16) << 3; | ||
| 49 | |||
| 50 | // set new output compare value | ||
| 51 | pac::TIM2.ccr(2).modify(|w| w.set_ccr(value)); | ||
| 52 | |||
| 53 | // reset interrupt flag | ||
| 54 | pac::TIM2.sr().modify(|r| r.set_uif(false)); | ||
| 55 | } | ||
| 56 | } | ||
| 57 | |||
| 58 | #[embassy_executor::main] | ||
| 59 | async fn main(_spawner: Spawner) { | ||
| 60 | info!("Hello World!"); | ||
| 61 | |||
| 62 | // configure for 32MHz (HSI16 * 6 / 3) | ||
| 63 | let mut config = Config::default(); | ||
| 64 | config.rcc.sys = Sysclk::PLL1_R; | ||
| 65 | config.rcc.hsi = true; | ||
| 66 | config.rcc.pll = Some(Pll { | ||
| 67 | source: PllSource::HSI, | ||
| 68 | div: PllDiv::DIV3, | ||
| 69 | mul: PllMul::MUL6, | ||
| 70 | }); | ||
| 71 | |||
| 72 | let p = embassy_stm32::init(config); | ||
| 73 | |||
| 74 | // setup PWM pin in AF mode | ||
| 75 | let _ch3 = PwmPin::new_ch3(p.PA2, OutputType::PushPull); | ||
| 76 | |||
| 77 | // initialize timer | ||
| 78 | let timer = LLTimer::new(p.TIM2); | ||
| 79 | |||
| 80 | // set counting mode | ||
| 81 | timer.set_counting_mode(CountingMode::EdgeAlignedUp); | ||
| 82 | |||
| 83 | // set pwm sample frequency | ||
| 84 | timer.set_frequency(hz(15625)); | ||
| 85 | |||
| 86 | // enable outputs | ||
| 87 | timer.enable_outputs(); | ||
| 88 | |||
| 89 | // start timer | ||
| 90 | timer.start(); | ||
| 91 | |||
| 92 | // set output compare mode | ||
| 93 | timer.set_output_compare_mode(Channel::Ch3, OutputCompareMode::PwmMode1); | ||
| 94 | |||
| 95 | // set output compare preload | ||
| 96 | timer.set_output_compare_preload(Channel::Ch3, true); | ||
| 97 | |||
| 98 | // set output polarity | ||
| 99 | timer.set_output_polarity(Channel::Ch3, OutputPolarity::ActiveHigh); | ||
| 100 | |||
| 101 | // set compare value | ||
| 102 | timer.set_compare_value(Channel::Ch3, timer.get_max_compare_value() / 2); | ||
| 103 | |||
| 104 | // enable pwm channel | ||
| 105 | timer.enable_channel(Channel::Ch3, true); | ||
| 106 | |||
| 107 | // enable timer interrupts | ||
| 108 | timer.enable_update_interrupt(true); | ||
| 109 | unsafe { cortex_m::peripheral::NVIC::unmask(interrupt::TIM2) }; | ||
| 110 | |||
| 111 | async { | ||
| 112 | loop { | ||
| 113 | embassy_time::Timer::after_millis(5000).await; | ||
| 114 | } | ||
| 115 | } | ||
| 116 | .await; | ||
| 117 | } | ||
