Set gain at runtime

This commit is contained in:
Quentin Smith
2022-08-20 17:08:29 -04:00
parent a46f33b214
commit 530f192acc
3 changed files with 41 additions and 10 deletions

View File

@ -31,3 +31,4 @@ fixed = "1.10.0"
embedded-storage = "0.3.0"
usbd-hid = "0.5.2"
serde = { version = "1.0.136", default-features = false }
num-integer = { version = "0.1.45", default-features = false }

View File

@ -8,6 +8,7 @@ use embassy_nrf::interrupt;
use embassy_nrf::pdm::{Config, Channels, Pdm};
use embassy_time::{Duration, Timer};
use fixed::types::I7F1;
use num_integer::Roots;
use {defmt_rtt as _, panic_probe as _};
#[embassy_executor::main]
@ -20,15 +21,23 @@ async fn main(_p: Spawner) {
let mut pdm = Pdm::new(p.PDM, interrupt::take!(PDM), &mut p.P0_00, &mut p.P0_01, config);
loop {
let mut buf = [0; 128];
pdm.sample(&mut buf).await;
info!(
"{} samples, min {=i16}, max {=i16}, mean {=i16}",
buf.len(),
buf.iter().min().unwrap(),
buf.iter().max().unwrap(),
(buf.iter().map(|v| i32::from(*v)).sum::<i32>() / buf.len() as i32) as i16,
);
Timer::after(Duration::from_millis(100)).await;
for gain in [I7F1::from_num(-20), I7F1::from_num(0), I7F1::from_num(20)] {
pdm.set_gain(gain, gain);
info!("Gain = {} dB", defmt::Debug2Format(&gain));
for _ in 0..10 {
let mut buf = [0; 128];
pdm.sample(&mut buf).await;
info!(
"{} samples, min {=i16}, max {=i16}, RMS {=i16}",
buf.len(),
buf.iter().min().unwrap(),
buf.iter().max().unwrap(),
(
buf.iter().map(|v| i32::from(*v).pow(2)).fold(0i32, |a,b| a.saturating_add(b))
/ buf.len() as i32).sqrt() as i16,
);
Timer::after(Duration::from_millis(100)).await;
}
}
}
}