54 lines
1.3 KiB
C++
54 lines
1.3 KiB
C++
|
#include "zauberstab.h"
|
||
|
|
|
||
|
|
unsigned long last_sample_time;
|
||
|
|
static int sample_counter = 0;
|
||
|
|
unsigned int top_led_pos = 0;
|
||
|
|
float rms_avg = 0;
|
||
|
|
float vu_filt = 0.0f;
|
||
|
|
float vu_filt_slow = 0.0f;
|
||
|
|
|
||
|
|
void setup()
|
||
|
|
{
|
||
|
|
zauberstab_init();
|
||
|
|
Serial.begin(115200);
|
||
|
|
FastLED.setBrightness(100);
|
||
|
|
}
|
||
|
|
|
||
|
|
void loop() {
|
||
|
|
if (micros()-last_sample_time >= 500){
|
||
|
|
last_sample_time = micros();
|
||
|
|
int32_t sample = get_sample();
|
||
|
|
float in = sample*sample;
|
||
|
|
sample_counter++;
|
||
|
|
rms_avg += (in - rms_avg)/(sample_counter + 1);
|
||
|
|
}
|
||
|
|
|
||
|
|
EVERY_N_MILLIS(10){
|
||
|
|
|
||
|
|
float vu = 20 * log10f(rms_avg);
|
||
|
|
vu_filt = (vu-vu_filt) * 0.8 + vu_filt;
|
||
|
|
vu_filt_slow = (vu_filt-vu_filt_slow) * 0.01 + vu_filt_slow;
|
||
|
|
//Serial.println(vu);
|
||
|
|
int max_led = vu_filt;
|
||
|
|
int top_led = vu_filt_slow;
|
||
|
|
|
||
|
|
max_led = max_led > 0xFF ? 0xFF : max_led;
|
||
|
|
|
||
|
|
if (top_led < max_led){
|
||
|
|
vu_filt_slow = vu_filt;
|
||
|
|
top_led = max_led;
|
||
|
|
}
|
||
|
|
|
||
|
|
fill_solid(leds, NUM_LEDS, CRGB::Black);
|
||
|
|
for(int i = 0; i < max_led; i++) {
|
||
|
|
int idx = map(i, 0, NUM_LEDS, 0, 0xFF);
|
||
|
|
leds[i] = ColorFromPalette(RainbowColors_p, idx);
|
||
|
|
}
|
||
|
|
|
||
|
|
leds[top_led] = CRGB::White;
|
||
|
|
|
||
|
|
FastLED.show();
|
||
|
|
rms_avg = 0.0f;
|
||
|
|
sample_counter = 0;
|
||
|
|
}
|
||
|
|
}
|