embassy/examples/nrf/src/bin/i2s.rs

47 lines
1.4 KiB
Rust
Raw Normal View History

// Example inspired by RTIC's I2S demo: https://github.com/nrf-rs/nrf-hal/blob/master/examples/i2s-controller-demo/src/main.rs
#![no_std]
#![no_main]
#![feature(type_alias_impl_trait)]
2022-11-09 21:58:56 +01:00
//use defmt::*;
use embassy_executor::Spawner;
2022-11-09 21:58:56 +01:00
use embassy_nrf::i2s;
use {defmt_rtt as _, panic_probe as _};
#[repr(align(4))]
pub struct Aligned<T: ?Sized>(T);
#[embassy_executor::main]
async fn main(_spawner: Spawner) {
let p = embassy_nrf::init(Default::default());
let config = i2s::Config::default();
2022-11-09 22:47:55 +01:00
let mut i2s = i2s::I2S::new(p.I2S, p.P0_28, p.P0_29, p.P0_31, p.P0_11, p.P0_30, config);
2022-11-09 21:58:56 +01:00
let mut signal_buf: Aligned<[i16; 32]> = Aligned([0i16; 32]);
let len = signal_buf.0.len() / 2;
for x in 0..len {
signal_buf.0[2 * x] = triangle_wave(x as i32, len, 2048, 0, 1) as i16;
signal_buf.0[2 * x + 1] = triangle_wave(x as i32, len, 2048, 0, 1) as i16;
}
i2s.set_tx_enabled(true);
2022-11-10 00:10:42 +01:00
i2s.start();
2022-11-09 21:58:56 +01:00
loop {
2022-11-10 00:10:42 +01:00
match i2s.tx(signal_buf.0.as_slice()).await {
2022-11-09 21:58:56 +01:00
Ok(_) => todo!(),
Err(_) => todo!(),
};
}
}
fn triangle_wave(x: i32, length: usize, amplitude: i32, phase: i32, periods: i32) -> i32 {
let length = length as i32;
amplitude
2022-11-09 21:58:56 +01:00
- ((2 * periods * (x + phase + length / (4 * periods)) * amplitude / length) % (2 * amplitude) - amplitude)
.abs()
- amplitude / 2
}