pt1 bug gefixed und alternative farbschemata

This commit is contained in:
Alexander Alber 2022-06-27 00:05:07 +02:00
parent 46dcbd5e1e
commit bb06fc304e
4 changed files with 22 additions and 33 deletions

View File

@ -9,6 +9,7 @@ struct Pt1
/* PT1: y = y_(n-1) + (Ku - y_(n-1)) * dt/T1 */ /* PT1: y = y_(n-1) + (Ku - y_(n-1)) * dt/T1 */
Pt1(T K, T T1) : T1(T1), K(K){}; Pt1(T K, T T1) : T1(T1), K(K){};
Pt1() = default;
T update(T u, T dt) T update(T u, T dt)
{ {

View File

@ -12,9 +12,9 @@
#define SAMPLING_FREQUENCY_CONTROL \ #define SAMPLING_FREQUENCY_CONTROL \
1 // check number of times per second if the current band pass is the best 1 // check number of times per second if the current band pass is the best
// one // one
#define Q 20. // quality factor of band pass filters #define Q 30. // quality factor of band pass filters
#define PI 3.1415926535897932384626433832795 #define PI 3.1415926535897932384626433832795
#define n_BP 30 // number of band pass filters #define n_BP 40 // number of band pass filters
static const unsigned long sampling_period_bp = 1000000L / SAMPLING_FREQUENCY_BP; static const unsigned long sampling_period_bp = 1000000L / SAMPLING_FREQUENCY_BP;
static const unsigned long sampling_period_control = 1000000L / SAMPLING_FREQUENCY_CONTROL; static const unsigned long sampling_period_control = 1000000L / SAMPLING_FREQUENCY_CONTROL;
@ -23,7 +23,7 @@ static unsigned long last_us_bp = 0L;
static unsigned long last_us_control = 0L; static unsigned long last_us_control = 0L;
static Biquad<float> bp_filters[n_BP]; static Biquad<float> bp_filters[n_BP];
static Pt1<float> y_filter{1.f, 1.f}; static Pt1<float> y_filter[n_BP];
static Pt1<float> pos_filter{1.f, 1.f}; static Pt1<float> pos_filter{1.f, 1.f};
static float yy1[n_BP]; static float yy1[n_BP];
@ -45,7 +45,6 @@ static float pos_target_filtered = NUM_LEDS / 2;
static long initial_time; static long initial_time;
static int active = 15; static int active = 15;
static int candidate = 15;
static int rounds = 0; static int rounds = 0;
static int n_samples = 0; static int n_samples = 0;
@ -78,6 +77,7 @@ set_filter()
a1 = -2.f * cos(w0); a1 = -2.f * cos(w0);
a2 = 1.f - a; a2 = 1.f - a;
bp_filters[i] = Biquad<float>{a0, a1, a2, b0, b1, b2}; bp_filters[i] = Biquad<float>{a0, a1, a2, b0, b1, b2};
y_filter[i] = Pt1<float>{1.f, 1.f};
} }
} }
@ -88,7 +88,6 @@ void BeatDetectApp::init()
pos_target = NUM_LEDS / 2; pos_target = NUM_LEDS / 2;
pos_target_filtered = NUM_LEDS / 2; pos_target_filtered = NUM_LEDS / 2;
active = 15; active = 15;
candidate = 15;
rounds = 0; rounds = 0;
n_samples = 0; n_samples = 0;
@ -128,7 +127,7 @@ void BeatDetectApp::loop()
yy3[i] = yy2[i]; yy3[i] = yy2[i];
yy2[i] = yy1[i]; yy2[i] = yy1[i];
yy1[i] = y[i]; yy1[i] = y[i];
y_fil[i] = y_filter.update(std::abs(y[i]), y_fil[i] = y_filter[i].update(std::abs(y[i]),
0.005f); // linie der scheitelpunkte 0.005f); // linie der scheitelpunkte
// y_fil[i] += (abs(y[i]) - y_fil[i]) * 0.005; //linie der // y_fil[i] += (abs(y[i]) - y_fil[i]) * 0.005; //linie der
// scheitelpunkte // scheitelpunkte
@ -181,8 +180,12 @@ void BeatDetectApp::loop()
for (int i = 0; i < NUM_LEDS; i++) for (int i = 0; i < NUM_LEDS; i++)
{ {
//leds[i].g = get_value(i, pos_target_filtered);
//leds[i].r = get_value(i, pos_target_filtered + 2);
//leds[i].b = get_value(i, pos_target_filtered - 2);
leds[i].g = get_value(i, pos_target_filtered); leds[i].g = get_value(i, pos_target_filtered);
leds[i].r = get_value(i, pos_target_filtered + 2); leds[i].r = 0; //get_value(i, pos_target_filtered + 2);
leds[i].b = get_value(i, pos_target_filtered - 2); leds[i].b = get_value(i, pos_target_filtered - 2);
// leds[i].setRGB(brightness_red, brightness_green, brightness_blue); // leds[i].setRGB(brightness_red, brightness_green, brightness_blue);
@ -205,22 +208,16 @@ void BeatDetectApp::loop()
} }
} }
if (argmax > -1) if (argmax != active)
{ {
if (argmax == candidate) rounds++;
{
rounds++;
}
else
{
rounds = 0;
candidate = argmax;
}
if (rounds > 3)
{
rounds = 0;
active = candidate;
}
} }
if (rounds > 5)
{
rounds = 0;
active = argmax;
}
} }
} }

View File

@ -95,7 +95,8 @@ void FackelApp::init()
for (int i = 0; i < 128; i++) for (int i = 0; i < 128; i++)
{ {
uint8_t r, g, b; uint8_t r, g, b;
hsl_to_rgb(i / 5, 255, i * 2 > 128 ? 128 : i * 2, &r, &g, &b); //hsl_to_rgb(i / 5, 255, i * 2 > 128 ? 128 : i * 2, &r, &g, &b);
hsl_to_rgb(i / 5 + 180, 255, i * 2 > 128 ? 128 : i * 2, &r, &g, &b);
g = g == 1 ? 0 : g; g = g == 1 ? 0 : g;
b = b == 1 ? 0 : b; b = b == 1 ? 0 : b;
palette[i].r = r; palette[i].r = r;

View File

@ -22,10 +22,6 @@ std::vector<std::reference_wrapper<App>> apps = {
std::ref<App>(fackel_app) std::ref<App>(fackel_app)
}; };
<<<<<<< HEAD
unsigned int current_app = 1;
unsigned int next_app;
=======
static unsigned int current_app = 0; static unsigned int current_app = 0;
static unsigned int next_app; static unsigned int next_app;
static bool init_successfull = false; static bool init_successfull = false;
@ -55,20 +51,14 @@ void switch_app() {
next_app = next_app % apps.size(); next_app = next_app % apps.size();
} }
>>>>>>> update main app handling to include an off state
void setup() void setup()
{ {
next_app = current_app; next_app = current_app;
<<<<<<< HEAD
zauberstab_init();
//Serial.begin(115200);
=======
if (zauberstab_init() != 0) { if (zauberstab_init() != 0) {
return; return;
} }
Serial.begin(115200); Serial.begin(115200);
>>>>>>> update main app handling to include an off state
init_successfull = true; init_successfull = true;
apps[current_app].get().init(); apps[current_app].get().init();