restructure into modules
This commit is contained in:
parent
601afd1560
commit
bd18905a96
7 changed files with 350 additions and 325 deletions
111
src/audio.rs
Normal file
111
src/audio.rs
Normal file
|
@ -0,0 +1,111 @@
|
||||||
|
use esp_idf_svc::sys::{esp_dsp, esp_nofail};
|
||||||
|
|
||||||
|
use crate::config::{AUDIO_BANDS, AUDIO_BUFFERS, AUDIO_SAMPLES_PER_BUF};
|
||||||
|
use crate::helpers::{falloff, falloff_f};
|
||||||
|
|
||||||
|
pub type AudioBuffer = [i32; AUDIO_SAMPLES_PER_BUF];
|
||||||
|
pub type DspBuffer = [f32; AUDIO_SAMPLES_PER_BUF];
|
||||||
|
|
||||||
|
pub struct AudioProcessor {
|
||||||
|
pub floating_max: i32,
|
||||||
|
pub current_powers: [f32; AUDIO_BANDS],
|
||||||
|
pub avg_powers: [f32; AUDIO_BANDS],
|
||||||
|
pub fft_buffer: [DspBuffer; AUDIO_BUFFERS],
|
||||||
|
pub next_fft_buf: usize,
|
||||||
|
fft_window: DspBuffer,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl AudioProcessor {
|
||||||
|
pub fn new() -> Self {
|
||||||
|
let mut buf: DspBuffer = [0f32; AUDIO_SAMPLES_PER_BUF];
|
||||||
|
|
||||||
|
unsafe {
|
||||||
|
esp_dsp::dsps_wind_hann_f32(buf.as_mut_ptr(), AUDIO_SAMPLES_PER_BUF as i32);
|
||||||
|
}
|
||||||
|
|
||||||
|
AudioProcessor {
|
||||||
|
floating_max: 0i32,
|
||||||
|
current_powers: [0f32; AUDIO_BANDS],
|
||||||
|
avg_powers: [0f32; AUDIO_BANDS],
|
||||||
|
fft_buffer: [[0f32; AUDIO_SAMPLES_PER_BUF]; AUDIO_BUFFERS],
|
||||||
|
next_fft_buf: 0,
|
||||||
|
fft_window: buf,
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
pub fn process(&mut self, audio: &AudioBuffer) -> usize {
|
||||||
|
let &(mut proc_fft_buffer) = &self.fft_buffer[self.next_fft_buf];
|
||||||
|
|
||||||
|
/* calculate floating max */
|
||||||
|
let mut new_max = 0i32;
|
||||||
|
for value in audio {
|
||||||
|
new_max = std::cmp::max(new_max, value.saturating_abs());
|
||||||
|
}
|
||||||
|
|
||||||
|
/* get maximum */
|
||||||
|
self.floating_max = std::cmp::max(
|
||||||
|
10000000,
|
||||||
|
if new_max > self.floating_max {
|
||||||
|
new_max
|
||||||
|
} else {
|
||||||
|
falloff(self.floating_max, falloff(self.floating_max, new_max))
|
||||||
|
},
|
||||||
|
);
|
||||||
|
|
||||||
|
/* convert to floats for input to fft */
|
||||||
|
for it in audio.iter().zip(proc_fft_buffer.iter_mut()) {
|
||||||
|
let (audio_it, fft_it) = it;
|
||||||
|
*fft_it = (*audio_it as f32) / (i32::MAX as f32);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* do fft */
|
||||||
|
let half_sample_count = (AUDIO_SAMPLES_PER_BUF / 2) as i32;
|
||||||
|
unsafe {
|
||||||
|
esp_nofail!(esp_dsp::dsps_mul_f32_ae32(
|
||||||
|
proc_fft_buffer.as_ptr(),
|
||||||
|
self.fft_window.as_ptr(),
|
||||||
|
proc_fft_buffer.as_mut_ptr(),
|
||||||
|
AUDIO_SAMPLES_PER_BUF as i32,
|
||||||
|
1,
|
||||||
|
1,
|
||||||
|
1,
|
||||||
|
));
|
||||||
|
|
||||||
|
esp_nofail!(esp_dsp::dsps_fft2r_fc32_aes3_(
|
||||||
|
proc_fft_buffer.as_mut_ptr(),
|
||||||
|
half_sample_count,
|
||||||
|
esp_dsp::dsps_fft_w_table_fc32,
|
||||||
|
)); // operating on half length but complex
|
||||||
|
esp_nofail!(esp_dsp::dsps_bit_rev2r_fc32(
|
||||||
|
proc_fft_buffer.as_mut_ptr(),
|
||||||
|
half_sample_count
|
||||||
|
)); // operating on half length but complex
|
||||||
|
esp_nofail!(esp_dsp::dsps_cplx2real_fc32_ae32_(
|
||||||
|
proc_fft_buffer.as_mut_ptr(),
|
||||||
|
half_sample_count,
|
||||||
|
esp_dsp::dsps_fft_w_table_fc32,
|
||||||
|
esp_dsp::dsps_fft_w_table_size,
|
||||||
|
)); // operating on half length but complex
|
||||||
|
|
||||||
|
for i in 0..half_sample_count as usize {
|
||||||
|
proc_fft_buffer[i] = (proc_fft_buffer[i * 2] * proc_fft_buffer[i * 2]
|
||||||
|
+ proc_fft_buffer[i * 2 + 1] * proc_fft_buffer[i * 2 + 1])
|
||||||
|
.sqrt();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* do band stats */
|
||||||
|
self.current_powers[0] = proc_fft_buffer[1..8].iter().sum::<f32>() / 8f32;
|
||||||
|
self.current_powers[1] = proc_fft_buffer[9..86].iter().sum::<f32>() / 78f32;
|
||||||
|
self.current_powers[2] = proc_fft_buffer[87..470].iter().sum::<f32>() / 384f32;
|
||||||
|
|
||||||
|
for it in self.current_powers.iter().zip(self.avg_powers.iter_mut()) {
|
||||||
|
let (current, avg) = it;
|
||||||
|
*avg = falloff_f(*avg, *current);
|
||||||
|
}
|
||||||
|
|
||||||
|
let last_fft_buf = self.next_fft_buf;
|
||||||
|
self.next_fft_buf = (self.next_fft_buf + 1) % AUDIO_BUFFERS;
|
||||||
|
last_fft_buf
|
||||||
|
}
|
||||||
|
}
|
5
src/config.rs
Normal file
5
src/config.rs
Normal file
|
@ -0,0 +1,5 @@
|
||||||
|
pub const LED_COUNT: usize = 72;
|
||||||
|
|
||||||
|
pub const AUDIO_SAMPLES_PER_BUF: usize = 1024;
|
||||||
|
pub const AUDIO_BUFFERS: usize = 2;
|
||||||
|
pub const AUDIO_BANDS: usize = 3;
|
42
src/effects/bass_sparks.rs
Normal file
42
src/effects/bass_sparks.rs
Normal file
|
@ -0,0 +1,42 @@
|
||||||
|
use esp_idf_svc::hal::units::{MilliSeconds,FromValueType};
|
||||||
|
|
||||||
|
use crate::audio::AudioProcessor;
|
||||||
|
use crate::effects::led_effect::{LedColors, LedEffect, Rgbv};
|
||||||
|
use crate::helpers::random_at_most;
|
||||||
|
use crate::LED_COUNT;
|
||||||
|
|
||||||
|
pub struct LedEffectBassSparks {
|
||||||
|
bass_color: Rgbv,
|
||||||
|
}
|
||||||
|
impl LedEffectBassSparks {
|
||||||
|
pub fn new() -> Self {
|
||||||
|
Self {
|
||||||
|
bass_color: Rgbv::black(0),
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
impl LedEffect for LedEffectBassSparks {
|
||||||
|
fn render(&mut self, processed: &AudioProcessor, _fft_buf: usize, leds: &mut LedColors) -> MilliSeconds {
|
||||||
|
if processed.floating_max > 10100000
|
||||||
|
&& (processed.current_powers[0] > 1.25 * processed.avg_powers[0])
|
||||||
|
{
|
||||||
|
self.bass_color = Rgbv::new(127, 0, 255, 4)
|
||||||
|
}
|
||||||
|
|
||||||
|
leds.fill(self.bass_color);
|
||||||
|
|
||||||
|
self.bass_color.decrease(3, 5, 5, 0);
|
||||||
|
|
||||||
|
if processed.floating_max > 10100000
|
||||||
|
&& (processed.current_powers[1] > 1.35 * processed.avg_powers[1])
|
||||||
|
&& (processed.current_powers[2] > 1.35 * processed.avg_powers[2])
|
||||||
|
{
|
||||||
|
for _ in 0..10 {
|
||||||
|
let led_index = random_at_most(LED_COUNT as u32 - 1) as usize;
|
||||||
|
leds[led_index] = Rgbv::white(31);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
10.ms()
|
||||||
|
}
|
||||||
|
}
|
123
src/effects/led_effect.rs
Normal file
123
src/effects/led_effect.rs
Normal file
|
@ -0,0 +1,123 @@
|
||||||
|
use anyhow::{bail, Result};
|
||||||
|
use bytemuck::{Pod, Zeroable};
|
||||||
|
use esp_idf_svc::hal::units::MilliSeconds;
|
||||||
|
|
||||||
|
use crate::{config::LED_COUNT, AudioProcessor};
|
||||||
|
|
||||||
|
pub trait LedEffect {
|
||||||
|
fn render(&mut self, processed: &AudioProcessor, fft_buf: usize, leds: &mut LedColors) -> MilliSeconds;
|
||||||
|
}
|
||||||
|
|
||||||
|
#[derive(Clone, Copy, Eq, PartialEq, Pod, Zeroable)]
|
||||||
|
#[repr(C, align(4))]
|
||||||
|
pub struct Rgbv {
|
||||||
|
_o: u8,
|
||||||
|
b: u8,
|
||||||
|
g: u8,
|
||||||
|
r: u8,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl Rgbv {
|
||||||
|
const _O_ONES: u8 = 0xE0;
|
||||||
|
|
||||||
|
#[rustfmt::skip] pub const fn black(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0x00, g: 0x00, b: 0x00, _o: Self::_O_ONES | o } }
|
||||||
|
#[rustfmt::skip] pub const fn white(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0xFF, g: 0xFF, b: 0xFF, _o: Self::_O_ONES | o } }
|
||||||
|
|
||||||
|
#[rustfmt::skip] pub const fn red(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0xFF, g: 0x00, b: 0x00, _o: Self::_O_ONES | o } }
|
||||||
|
#[rustfmt::skip] pub const fn green(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0x00, g: 0xFF, b: 0x00, _o: Self::_O_ONES | o } }
|
||||||
|
#[rustfmt::skip] pub const fn blue(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0x00, g: 0x00, b: 0xFF, _o: Self::_O_ONES | o } }
|
||||||
|
|
||||||
|
#[rustfmt::skip] pub const fn cyan(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0x00, g: 0xFF, b: 0xFF, _o: Self::_O_ONES | o } }
|
||||||
|
#[rustfmt::skip] pub const fn orange(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0xFF, g: 0x80, b: 0x00, _o: Self::_O_ONES | o } }
|
||||||
|
#[rustfmt::skip] pub const fn yellow(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0xFF, g: 0xFF, b: 0x00, _o: Self::_O_ONES | o } }
|
||||||
|
#[rustfmt::skip] pub const fn pink(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0xFF, g: 0x00, b: 0xFF, _o: Self::_O_ONES | o } }
|
||||||
|
|
||||||
|
pub const MAX_O: u8 = 31;
|
||||||
|
|
||||||
|
pub fn new(r: u8, g: u8, b: u8, o: u8) -> Self {
|
||||||
|
assert!(o <= Self::MAX_O);
|
||||||
|
Self {
|
||||||
|
r,
|
||||||
|
g,
|
||||||
|
b,
|
||||||
|
_o: o | Self::_O_ONES,
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
pub fn o(self) -> u8 {
|
||||||
|
self._o & !Self::_O_ONES
|
||||||
|
}
|
||||||
|
|
||||||
|
#[inline(always)]
|
||||||
|
pub fn set_o(mut self, o: u8) -> Self {
|
||||||
|
assert!(o <= Self::MAX_O);
|
||||||
|
self._o = o | Self::_O_ONES;
|
||||||
|
self
|
||||||
|
}
|
||||||
|
|
||||||
|
#[inline(always)]
|
||||||
|
pub fn increase(&mut self, r: u8, g: u8, b: u8, o: u8) -> Self {
|
||||||
|
self.r = self.r.saturating_add(r);
|
||||||
|
self.g = self.g.saturating_add(g);
|
||||||
|
self.b = self.b.saturating_add(b);
|
||||||
|
self.set_o(std::cmp::min(self.o() + o, Self::MAX_O));
|
||||||
|
*self
|
||||||
|
}
|
||||||
|
|
||||||
|
#[inline(always)]
|
||||||
|
pub fn decrease(&mut self, r: u8, g: u8, b: u8, o: u8) -> Self {
|
||||||
|
self.r = self.r.saturating_sub(r);
|
||||||
|
self.g = self.g.saturating_sub(g);
|
||||||
|
self.b = self.b.saturating_sub(b);
|
||||||
|
self.set_o(self.o().saturating_sub(o));
|
||||||
|
*self
|
||||||
|
}
|
||||||
|
|
||||||
|
/// Converts hue, saturation, value to RGB
|
||||||
|
/// // copied from rmt_neopixel example
|
||||||
|
pub fn from_hsv(h: u32, s: u32, v: u32, o: u8) -> Result<Self> {
|
||||||
|
assert!(o <= Self::MAX_O);
|
||||||
|
if h > 360 || s > 100 || v > 100 {
|
||||||
|
bail!("The given HSV values are not in valid range");
|
||||||
|
}
|
||||||
|
let s = s as f64 / 100.0;
|
||||||
|
let v = v as f64 / 100.0;
|
||||||
|
let c = s * v;
|
||||||
|
let x = c * (1.0 - (((h as f64 / 60.0) % 2.0) - 1.0).abs());
|
||||||
|
let m = v - c;
|
||||||
|
let (r, g, b) = match h {
|
||||||
|
0..=59 => (c, x, 0.0),
|
||||||
|
60..=119 => (x, c, 0.0),
|
||||||
|
120..=179 => (0.0, c, x),
|
||||||
|
180..=239 => (0.0, x, c),
|
||||||
|
240..=299 => (x, 0.0, c),
|
||||||
|
_ => (c, 0.0, x),
|
||||||
|
};
|
||||||
|
Ok(Self {
|
||||||
|
r: ((r + m) * 255.0) as u8,
|
||||||
|
g: ((g + m) * 255.0) as u8,
|
||||||
|
b: ((b + m) * 255.0) as u8,
|
||||||
|
_o: o | Self::_O_ONES,
|
||||||
|
})
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
pub type LedColors = [Rgbv; LED_COUNT];
|
||||||
|
|
||||||
|
#[repr(C, align(4))]
|
||||||
|
#[derive(Clone, Copy, Eq, PartialEq, Pod, Zeroable)]
|
||||||
|
pub struct LedData {
|
||||||
|
zeros: u32,
|
||||||
|
pub leds: LedColors,
|
||||||
|
ones: u32,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl LedData {
|
||||||
|
pub fn new() -> Self {
|
||||||
|
Self {
|
||||||
|
zeros: 0,
|
||||||
|
leds: [Rgbv::new(0, 0, 0, 0); LED_COUNT],
|
||||||
|
ones: 0, // sic. works as well, and triggers PWM change at the end of frame transfer instead of next one.
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
2
src/effects/mod.rs
Normal file
2
src/effects/mod.rs
Normal file
|
@ -0,0 +1,2 @@
|
||||||
|
pub mod led_effect;
|
||||||
|
pub mod bass_sparks;
|
33
src/helpers.rs
Normal file
33
src/helpers.rs
Normal file
|
@ -0,0 +1,33 @@
|
||||||
|
use esp_idf_svc::hal::sys::esp_random;
|
||||||
|
|
||||||
|
pub fn falloff(old: i32, new: i32) -> i32 {
|
||||||
|
(old >> 1) + (old >> 2) + (new >> 2)
|
||||||
|
}
|
||||||
|
pub fn falloff_f(old: f32, new: f32) -> f32 {
|
||||||
|
(old / 2.0f32) + (old / 4.0f32) + (new / 4.0f32)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub fn random_at_most(max: u32) -> u32 {
|
||||||
|
// impl from https://stackoverflow.com/a/6852396, adapted to uint32/2
|
||||||
|
// Assumes 0 <= max <= INT32_MAX
|
||||||
|
// Returns in the closed interval [0, max]
|
||||||
|
assert!(max < u32::MAX);
|
||||||
|
|
||||||
|
let num_bins = max + 1;
|
||||||
|
let num_rand = i32::MAX as u32 + 1;
|
||||||
|
let bin_size = num_rand / num_bins;
|
||||||
|
let defect = num_rand % num_bins;
|
||||||
|
|
||||||
|
let mut x: u32;
|
||||||
|
|
||||||
|
loop {
|
||||||
|
unsafe {
|
||||||
|
x = esp_random() >> 1; // This is carefully written not to overflow
|
||||||
|
if num_rand - defect > x {
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
// Truncated division is intentional
|
||||||
|
x / bin_size
|
||||||
|
}
|
359
src/main.rs
359
src/main.rs
|
@ -1,303 +1,27 @@
|
||||||
use bytemuck::{bytes_of, bytes_of_mut, Pod, Zeroable};
|
pub mod audio;
|
||||||
|
pub mod config;
|
||||||
|
pub mod effects;
|
||||||
|
pub mod helpers;
|
||||||
|
|
||||||
|
use audio::{AudioBuffer, AudioProcessor};
|
||||||
|
use bytemuck::{bytes_of, bytes_of_mut};
|
||||||
use esp_idf_svc::{
|
use esp_idf_svc::{
|
||||||
hal::{
|
hal::{
|
||||||
delay::FreeRtos, gpio::AnyIOPin, i2s, peripherals::Peripherals, spi, units::FromValueType,
|
delay::FreeRtos,
|
||||||
|
gpio::AnyIOPin,
|
||||||
|
i2s,
|
||||||
|
peripherals::Peripherals,
|
||||||
|
spi,
|
||||||
|
units::{FromValueType, MilliSeconds},
|
||||||
},
|
},
|
||||||
sys::{esp_dsp, esp_nofail, esp_random, TickType_t},
|
sys::{esp_dsp, esp_nofail, TickType_t},
|
||||||
};
|
};
|
||||||
|
|
||||||
use anyhow::{bail, Result};
|
use config::{AUDIO_BUFFERS, AUDIO_SAMPLES_PER_BUF, LED_COUNT};
|
||||||
|
use effects::{
|
||||||
const LED_COUNT: usize = 72;
|
bass_sparks::LedEffectBassSparks,
|
||||||
|
led_effect::{LedData, LedEffect},
|
||||||
const AUDIO_SAMPLES_PER_BUF: usize = 1024;
|
};
|
||||||
const AUDIO_BUFFERS: usize = 2;
|
|
||||||
const AUDIO_BANDS: usize = 3;
|
|
||||||
|
|
||||||
type AudioBuffer = [i32; AUDIO_SAMPLES_PER_BUF];
|
|
||||||
type DspBuffer = [f32; AUDIO_SAMPLES_PER_BUF];
|
|
||||||
|
|
||||||
#[derive(Clone, Copy, Eq, PartialEq, Pod, Zeroable)]
|
|
||||||
#[repr(C, align(4))]
|
|
||||||
struct Rgbv {
|
|
||||||
r: u8,
|
|
||||||
g: u8,
|
|
||||||
b: u8,
|
|
||||||
_o: u8,
|
|
||||||
}
|
|
||||||
|
|
||||||
impl Rgbv {
|
|
||||||
const _O_ONES: u8 = 0xE0;
|
|
||||||
|
|
||||||
#[rustfmt::skip] const fn black(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0x00, g: 0x00, b: 0x00, _o: Self::_O_ONES | o } }
|
|
||||||
#[rustfmt::skip] const fn white(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0xFF, g: 0xFF, b: 0xFF, _o: Self::_O_ONES | o } }
|
|
||||||
|
|
||||||
#[rustfmt::skip] const fn red(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0xFF, g: 0x00, b: 0x00, _o: Self::_O_ONES | o } }
|
|
||||||
#[rustfmt::skip] const fn green(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0x00, g: 0xFF, b: 0x00, _o: Self::_O_ONES | o } }
|
|
||||||
#[rustfmt::skip] const fn blue(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0x00, g: 0x00, b: 0xFF, _o: Self::_O_ONES | o } }
|
|
||||||
|
|
||||||
#[rustfmt::skip] const fn cyan(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0x00, g: 0xFF, b: 0xFF, _o: Self::_O_ONES | o } }
|
|
||||||
#[rustfmt::skip] const fn orange(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0xFF, g: 0x80, b: 0x00, _o: Self::_O_ONES | o } }
|
|
||||||
#[rustfmt::skip] const fn yellow(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0xFF, g: 0xFF, b: 0x00, _o: Self::_O_ONES | o } }
|
|
||||||
#[rustfmt::skip] const fn pink(o: u8) -> Self { assert!(o<=Self::MAX_O); Self {r: 0xFF, g: 0x00, b: 0xFF, _o: Self::_O_ONES | o } }
|
|
||||||
|
|
||||||
const MAX_O: u8 = 31;
|
|
||||||
|
|
||||||
pub fn new(r: u8, g: u8, b: u8, o: u8) -> Self {
|
|
||||||
assert!(o <= Self::MAX_O);
|
|
||||||
Self {
|
|
||||||
r,
|
|
||||||
g,
|
|
||||||
b,
|
|
||||||
_o: o | Self::_O_ONES,
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
pub fn o(self) -> u8 {
|
|
||||||
self._o & !Self::_O_ONES
|
|
||||||
}
|
|
||||||
|
|
||||||
#[inline(always)]
|
|
||||||
pub fn set_o(mut self, o: u8) -> Self {
|
|
||||||
assert!(o <= Self::MAX_O);
|
|
||||||
self._o = o | Self::_O_ONES;
|
|
||||||
self
|
|
||||||
}
|
|
||||||
|
|
||||||
#[inline(always)]
|
|
||||||
pub fn increase(mut self, r: u8, g: u8, b: u8, o: u8) -> Self {
|
|
||||||
self.r = self.r.saturating_add(r);
|
|
||||||
self.g = self.g.saturating_add(g);
|
|
||||||
self.b = self.b.saturating_add(b);
|
|
||||||
self.set_o(std::cmp::min(self.o() + o, Self::MAX_O));
|
|
||||||
self
|
|
||||||
}
|
|
||||||
|
|
||||||
#[inline(always)]
|
|
||||||
pub fn decrease(mut self, r: u8, g: u8, b: u8, o: u8) -> Self {
|
|
||||||
self.r = self.r.saturating_sub(r);
|
|
||||||
self.g = self.g.saturating_sub(g);
|
|
||||||
self.b = self.b.saturating_sub(b);
|
|
||||||
self.set_o(self.o().saturating_sub(o));
|
|
||||||
self
|
|
||||||
}
|
|
||||||
|
|
||||||
/// Converts hue, saturation, value to RGB
|
|
||||||
/// // copied from rmt_neopixel example
|
|
||||||
pub fn from_hsv(h: u32, s: u32, v: u32, o: u8) -> Result<Self> {
|
|
||||||
assert!(o <= Self::MAX_O);
|
|
||||||
if h > 360 || s > 100 || v > 100 {
|
|
||||||
bail!("The given HSV values are not in valid range");
|
|
||||||
}
|
|
||||||
let s = s as f64 / 100.0;
|
|
||||||
let v = v as f64 / 100.0;
|
|
||||||
let c = s * v;
|
|
||||||
let x = c * (1.0 - (((h as f64 / 60.0) % 2.0) - 1.0).abs());
|
|
||||||
let m = v - c;
|
|
||||||
let (r, g, b) = match h {
|
|
||||||
0..=59 => (c, x, 0.0),
|
|
||||||
60..=119 => (x, c, 0.0),
|
|
||||||
120..=179 => (0.0, c, x),
|
|
||||||
180..=239 => (0.0, x, c),
|
|
||||||
240..=299 => (x, 0.0, c),
|
|
||||||
_ => (c, 0.0, x),
|
|
||||||
};
|
|
||||||
Ok(Self {
|
|
||||||
r: ((r + m) * 255.0) as u8,
|
|
||||||
g: ((g + m) * 255.0) as u8,
|
|
||||||
b: ((b + m) * 255.0) as u8,
|
|
||||||
_o: o | Self::_O_ONES,
|
|
||||||
})
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
type LedColors = [Rgbv; LED_COUNT];
|
|
||||||
|
|
||||||
#[repr(C, align(4))]
|
|
||||||
#[derive(Clone, Copy, Eq, PartialEq, Pod, Zeroable)]
|
|
||||||
struct LedData {
|
|
||||||
zeros: u32,
|
|
||||||
leds: LedColors,
|
|
||||||
ones: u32,
|
|
||||||
}
|
|
||||||
|
|
||||||
impl LedData {
|
|
||||||
pub fn new() -> Self {
|
|
||||||
Self {
|
|
||||||
zeros: 0,
|
|
||||||
leds: [Rgbv::new(0, 0, 0, 0); LED_COUNT],
|
|
||||||
ones: 0, // sic. works as well, and triggers PWM change at the end of frame transfer instead of next one.
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
fn falloff(old: i32, new: i32) -> i32 {
|
|
||||||
(old >> 1) + (old >> 2) + (new >> 2)
|
|
||||||
}
|
|
||||||
fn falloff_f(old: f32, new: f32) -> f32 {
|
|
||||||
(old / 2.0f32) + (old / 4.0f32) + (new / 4.0f32)
|
|
||||||
}
|
|
||||||
|
|
||||||
fn random_at_most(max: u32) -> u32 {
|
|
||||||
// impl from https://stackoverflow.com/a/6852396, adapted to uint32/2
|
|
||||||
// Assumes 0 <= max <= INT32_MAX
|
|
||||||
// Returns in the closed interval [0, max]
|
|
||||||
assert!(max < u32::MAX);
|
|
||||||
|
|
||||||
let num_bins = max + 1;
|
|
||||||
let num_rand = i32::MAX as u32 + 1;
|
|
||||||
let bin_size = num_rand / num_bins;
|
|
||||||
let defect = num_rand % num_bins;
|
|
||||||
|
|
||||||
let mut x: u32;
|
|
||||||
|
|
||||||
loop {
|
|
||||||
unsafe {
|
|
||||||
x = esp_random() >> 1; // This is carefully written not to overflow
|
|
||||||
if num_rand - defect > x {
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
// Truncated division is intentional
|
|
||||||
x / bin_size
|
|
||||||
}
|
|
||||||
|
|
||||||
struct AudioProcessor {
|
|
||||||
floating_max: i32,
|
|
||||||
current_powers: [f32; AUDIO_BANDS],
|
|
||||||
avg_powers: [f32; AUDIO_BANDS],
|
|
||||||
fft_buffer: [DspBuffer; AUDIO_BUFFERS],
|
|
||||||
next_fft_buf: usize,
|
|
||||||
fft_window: DspBuffer,
|
|
||||||
}
|
|
||||||
|
|
||||||
impl AudioProcessor {
|
|
||||||
pub fn new() -> Self {
|
|
||||||
let mut buf: DspBuffer = [0f32; AUDIO_SAMPLES_PER_BUF];
|
|
||||||
|
|
||||||
unsafe {
|
|
||||||
esp_dsp::dsps_wind_hann_f32(buf.as_mut_ptr(), AUDIO_SAMPLES_PER_BUF as i32);
|
|
||||||
}
|
|
||||||
|
|
||||||
AudioProcessor {
|
|
||||||
floating_max: 0i32,
|
|
||||||
current_powers: [0f32; AUDIO_BANDS],
|
|
||||||
avg_powers: [0f32; AUDIO_BANDS],
|
|
||||||
fft_buffer: [[0f32; AUDIO_SAMPLES_PER_BUF]; AUDIO_BUFFERS],
|
|
||||||
next_fft_buf: 0,
|
|
||||||
fft_window: buf,
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
pub fn process(&mut self, audio: &AudioBuffer) -> usize {
|
|
||||||
let &(mut proc_fft_buffer) = &self.fft_buffer[self.next_fft_buf];
|
|
||||||
|
|
||||||
/* calculate floating max */
|
|
||||||
let mut new_max = 0i32;
|
|
||||||
for value in audio {
|
|
||||||
new_max = std::cmp::max(new_max, value.saturating_abs());
|
|
||||||
}
|
|
||||||
|
|
||||||
/* get maximum */
|
|
||||||
self.floating_max = std::cmp::max(
|
|
||||||
10000000,
|
|
||||||
if new_max > self.floating_max {
|
|
||||||
new_max
|
|
||||||
} else {
|
|
||||||
falloff(self.floating_max, falloff(self.floating_max, new_max))
|
|
||||||
},
|
|
||||||
);
|
|
||||||
|
|
||||||
/* convert to floats for input to fft */
|
|
||||||
for it in audio.iter().zip(proc_fft_buffer.iter_mut()) {
|
|
||||||
let (audio_it, fft_it) = it;
|
|
||||||
*fft_it = (*audio_it as f32) / (i32::MAX as f32);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* do fft */
|
|
||||||
let half_sample_count = (AUDIO_SAMPLES_PER_BUF / 2) as i32;
|
|
||||||
unsafe {
|
|
||||||
esp_nofail!(esp_dsp::dsps_mul_f32_ae32(
|
|
||||||
proc_fft_buffer.as_ptr(),
|
|
||||||
self.fft_window.as_ptr(),
|
|
||||||
proc_fft_buffer.as_mut_ptr(),
|
|
||||||
AUDIO_SAMPLES_PER_BUF as i32,
|
|
||||||
1,
|
|
||||||
1,
|
|
||||||
1,
|
|
||||||
));
|
|
||||||
|
|
||||||
esp_nofail!(esp_dsp::dsps_fft2r_fc32_aes3_(
|
|
||||||
proc_fft_buffer.as_mut_ptr(),
|
|
||||||
half_sample_count,
|
|
||||||
esp_dsp::dsps_fft_w_table_fc32,
|
|
||||||
)); // operating on half length but complex
|
|
||||||
esp_nofail!(esp_dsp::dsps_bit_rev2r_fc32(
|
|
||||||
proc_fft_buffer.as_mut_ptr(),
|
|
||||||
half_sample_count
|
|
||||||
)); // operating on half length but complex
|
|
||||||
esp_nofail!(esp_dsp::dsps_cplx2real_fc32_ae32_(
|
|
||||||
proc_fft_buffer.as_mut_ptr(),
|
|
||||||
half_sample_count,
|
|
||||||
esp_dsp::dsps_fft_w_table_fc32,
|
|
||||||
esp_dsp::dsps_fft_w_table_size,
|
|
||||||
)); // operating on half length but complex
|
|
||||||
|
|
||||||
for i in 0..half_sample_count as usize {
|
|
||||||
proc_fft_buffer[i] = (proc_fft_buffer[i * 2] * proc_fft_buffer[i * 2]
|
|
||||||
+ proc_fft_buffer[i * 2 + 1] * proc_fft_buffer[i * 2 + 1])
|
|
||||||
.sqrt();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* do band stats */
|
|
||||||
self.current_powers[0] = proc_fft_buffer[1..8].iter().sum::<f32>() / 8f32;
|
|
||||||
self.current_powers[1] = proc_fft_buffer[9..86].iter().sum::<f32>() / 78f32;
|
|
||||||
self.current_powers[2] = proc_fft_buffer[87..470].iter().sum::<f32>() / 384f32;
|
|
||||||
|
|
||||||
for it in self.current_powers.iter().zip(self.avg_powers.iter_mut()) {
|
|
||||||
let (current, avg) = it;
|
|
||||||
*avg = falloff_f(*avg, *current);
|
|
||||||
}
|
|
||||||
|
|
||||||
let last_fft_buf = self.next_fft_buf;
|
|
||||||
self.next_fft_buf = (self.next_fft_buf + 1) % AUDIO_BUFFERS;
|
|
||||||
last_fft_buf
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
trait LedEffect {
|
|
||||||
fn render(&mut self, processed: &AudioProcessor, fft_buf: usize, leds: &LedColors);
|
|
||||||
}
|
|
||||||
|
|
||||||
struct LedEffectBassSparks {}
|
|
||||||
impl LedEffect for LedEffectBassSparks {
|
|
||||||
fn render(&mut self, processed: &AudioProcessor, _fft_buf: usize, &(mut leds): &LedColors) {
|
|
||||||
let bass_color = if processed.floating_max > 10100000
|
|
||||||
&& (processed.current_powers[0] > 1.25 * processed.avg_powers[0])
|
|
||||||
{
|
|
||||||
Rgbv::new(127, 0, 255, 4)
|
|
||||||
} else {
|
|
||||||
Rgbv::new(0, 0, 0, 0)
|
|
||||||
};
|
|
||||||
|
|
||||||
leds.fill(bass_color);
|
|
||||||
|
|
||||||
bass_color.decrease(3, 5, 5, 0);
|
|
||||||
|
|
||||||
if true
|
|
||||||
/*processed.floating_max > 10100000
|
|
||||||
&& (processed.current_powers[1] > 1.35 * processed.avg_powers[1])
|
|
||||||
&& (processed.current_powers[2] > 1.35 * processed.avg_powers[2])*/
|
|
||||||
{
|
|
||||||
for _ in 0..10 {
|
|
||||||
let led_index = random_at_most(LED_COUNT as u32 - 1) as usize;
|
|
||||||
leds[led_index] = Rgbv::white(31);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
fn main() -> anyhow::Result<()> {
|
fn main() -> anyhow::Result<()> {
|
||||||
// It is necessary to call this function once. Otherwise some patches to the runtime
|
// It is necessary to call this function once. Otherwise some patches to the runtime
|
||||||
|
@ -316,19 +40,13 @@ fn main() -> anyhow::Result<()> {
|
||||||
let mut audio: [AudioBuffer; AUDIO_BUFFERS] = [[0; AUDIO_SAMPLES_PER_BUF]; AUDIO_BUFFERS];
|
let mut audio: [AudioBuffer; AUDIO_BUFFERS] = [[0; AUDIO_SAMPLES_PER_BUF]; AUDIO_BUFFERS];
|
||||||
let mut next_audio_buf: usize = 0;
|
let mut next_audio_buf: usize = 0;
|
||||||
|
|
||||||
// interfaces
|
|
||||||
let led_spi_per = peripherals.spi2;
|
// i2s config
|
||||||
let mic_i2s_per = peripherals.i2s0;
|
let mic_i2s_per = peripherals.i2s0;
|
||||||
|
|
||||||
// pins
|
|
||||||
let led_spi_sdo = peripherals.pins.gpio11;
|
|
||||||
let led_spi_sck = peripherals.pins.gpio12;
|
|
||||||
|
|
||||||
let mic_i2s_sd = peripherals.pins.gpio5;
|
let mic_i2s_sd = peripherals.pins.gpio5;
|
||||||
let mic_i2s_sclk = peripherals.pins.gpio4;
|
let mic_i2s_sclk = peripherals.pins.gpio4;
|
||||||
let mic_i2s_ws = peripherals.pins.gpio6;
|
let mic_i2s_ws = peripherals.pins.gpio6;
|
||||||
|
|
||||||
// i2s config
|
|
||||||
let mic_i2s_std_cfg = i2s::config::StdConfig::new(
|
let mic_i2s_std_cfg = i2s::config::StdConfig::new(
|
||||||
i2s::config::Config::new().role(i2s::config::Role::Controller),
|
i2s::config::Config::new().role(i2s::config::Role::Controller),
|
||||||
i2s::config::StdClkConfig::new(
|
i2s::config::StdClkConfig::new(
|
||||||
|
@ -342,7 +60,10 @@ fn main() -> anyhow::Result<()> {
|
||||||
)
|
)
|
||||||
.data_bit_width(i2s::config::DataBitWidth::Bits32)
|
.data_bit_width(i2s::config::DataBitWidth::Bits32)
|
||||||
.slot_bit_width(i2s::config::SlotBitWidth::Bits32)
|
.slot_bit_width(i2s::config::SlotBitWidth::Bits32)
|
||||||
.slot_mode_mask(i2s::config::SlotMode::Stereo, i2s::config::StdSlotMask::Both)
|
.slot_mode_mask(
|
||||||
|
i2s::config::SlotMode::Stereo,
|
||||||
|
i2s::config::StdSlotMask::Both,
|
||||||
|
)
|
||||||
.ws_width(32)
|
.ws_width(32)
|
||||||
.ws_polarity(false)
|
.ws_polarity(false)
|
||||||
.bit_shift(true)
|
.bit_shift(true)
|
||||||
|
@ -361,6 +82,10 @@ fn main() -> anyhow::Result<()> {
|
||||||
)?;
|
)?;
|
||||||
|
|
||||||
// spi config
|
// spi config
|
||||||
|
let led_spi_per = peripherals.spi2;
|
||||||
|
let led_spi_sdo = peripherals.pins.gpio11;
|
||||||
|
let led_spi_sck = peripherals.pins.gpio12;
|
||||||
|
|
||||||
let mut led_drv = spi::SpiDeviceDriver::new_single(
|
let mut led_drv = spi::SpiDeviceDriver::new_single(
|
||||||
led_spi_per,
|
led_spi_per,
|
||||||
led_spi_sck,
|
led_spi_sck,
|
||||||
|
@ -385,43 +110,27 @@ fn main() -> anyhow::Result<()> {
|
||||||
}
|
}
|
||||||
|
|
||||||
let mut processor = AudioProcessor::new();
|
let mut processor = AudioProcessor::new();
|
||||||
let mut effect = LedEffectBassSparks {};
|
let mut effect = LedEffectBassSparks::new();
|
||||||
|
|
||||||
// loop {
|
|
||||||
// leds.leds[0] = Rgbv::red(4);
|
|
||||||
// let output_buffer = bytes_of(&leds);
|
|
||||||
// led_drv.write(output_buffer)?;
|
|
||||||
|
|
||||||
// FreeRtos::delay_ms(10);
|
|
||||||
// }
|
|
||||||
|
|
||||||
mic_drv.rx_enable()?;
|
mic_drv.rx_enable()?;
|
||||||
|
|
||||||
loop {
|
loop {
|
||||||
// let buffer: &mut [u8; AUDIO_SAMPLES_PER_BUF*4] = cast_slice_mut(&mut audio[next_audio_buf]);
|
|
||||||
let buffer = bytes_of_mut(&mut audio[next_audio_buf]);
|
let buffer = bytes_of_mut(&mut audio[next_audio_buf]);
|
||||||
// let mut buffer:[u8;AUDIO_SAMPLES_PER_BUF*4] = [0;AUDIO_SAMPLES_PER_BUF*4];
|
let num_bytes_read = mic_drv.read(buffer, TickType_t::MAX)?;
|
||||||
let num_bytes_read = mic_drv.read(buffer.as_mut_slice(), TickType_t::MAX)?;
|
|
||||||
|
|
||||||
if num_bytes_read != AUDIO_SAMPLES_PER_BUF * 4 {
|
if num_bytes_read != AUDIO_SAMPLES_PER_BUF * 4 {
|
||||||
log::error!("buffer underflow");
|
log::error!("buffer underflow");
|
||||||
}
|
}
|
||||||
|
|
||||||
// for i in 0..AUDIO_SAMPLES_PER_BUF {
|
|
||||||
// let sample:&[u8;4] = &buffer[i*4..i*4+4].try_into().expect("bla");
|
|
||||||
// audio[next_audio_buf][i] = i32::from_le_bytes(*sample);
|
|
||||||
// }
|
|
||||||
|
|
||||||
// log::info!("a: {:08x}", audio[next_audio_buf][0]);
|
|
||||||
|
|
||||||
let current_fft_buf = processor.process(&audio[next_audio_buf]);
|
let current_fft_buf = processor.process(&audio[next_audio_buf]);
|
||||||
|
|
||||||
effect.render(&processor, current_fft_buf, &(leds.leds));
|
let delay_ms: MilliSeconds = effect.render(&processor, current_fft_buf, &mut leds.leds);
|
||||||
|
|
||||||
let output_buffer = bytes_of(&leds);
|
let output_buffer = bytes_of(&leds);
|
||||||
led_drv.write(output_buffer)?;
|
led_drv.write(output_buffer)?;
|
||||||
|
|
||||||
next_audio_buf = (next_audio_buf + 1) % AUDIO_BUFFERS;
|
next_audio_buf = (next_audio_buf + 1) % AUDIO_BUFFERS;
|
||||||
|
|
||||||
FreeRtos::delay_ms(10);
|
FreeRtos::delay_ms(delay_ms.into());
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
Loading…
Add table
Add a link
Reference in a new issue