2022-11-09 19:14:43 +01:00
|
|
|
// 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::*;
|
2022-11-09 19:14:43 +01:00
|
|
|
use embassy_executor::Spawner;
|
2022-11-09 21:58:56 +01:00
|
|
|
use embassy_nrf::i2s;
|
2022-11-09 19:14:43 +01:00
|
|
|
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
|
|
|
|
2022-11-09 19:14:43 +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
|
|
|
|
2022-11-09 19:14:43 +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!(),
|
|
|
|
};
|
2022-11-09 19:14:43 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
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)
|
2022-11-09 19:14:43 +01:00
|
|
|
.abs()
|
|
|
|
- amplitude / 2
|
|
|
|
}
|