Skip to content
Open
Changes from all commits
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
32 changes: 31 additions & 1 deletion firmware/AmbiSensor/hub.h
Original file line number Diff line number Diff line change
Expand Up @@ -72,6 +72,12 @@ void hub_init() {

void show_ambi() {
static GHtimer tmr(45);
static bool filterInit = false;
static float filt[8][3];
static uint8_t stable[8][3];
const float alpha = 0.22f;
const uint8_t blackLevelThreshold = 2; // без миганий на черном
const uint8_t minColorDelta = 3; // порог для переключения цвета
if (tmr) {
for (uint8_t i = 0; i < 5; i++) {
if (!data.led_num[i]) return;
Expand Down Expand Up @@ -100,7 +106,31 @@ void show_ambi() {
b = constrain(b, 0, 255);
}

colors[i] = CRGB(r, g, b);
if (!filterInit) {
filt[i][0] = r;
filt[i][1] = g;
filt[i][2] = b;
} else {
filt[i][0] += (r - filt[i][0]) * alpha;
filt[i][1] += (g - filt[i][1]) * alpha;
filt[i][2] += (b - filt[i][2]) * alpha;
}

uint8_t rf = (filt[i][0] < blackLevelThreshold) ? 0 : (uint8_t)filt[i][0];
uint8_t gf = (filt[i][1] < blackLevelThreshold) ? 0 : (uint8_t)filt[i][1];
uint8_t bf = (filt[i][2] < blackLevelThreshold) ? 0 : (uint8_t)filt[i][2];

if (!filterInit) {
stable[i][0] = rf;
stable[i][1] = gf;
stable[i][2] = bf;
} else {
if (abs((int)rf - (int)stable[i][0]) >= minColorDelta) stable[i][0] = rf;
if (abs((int)gf - (int)stable[i][1]) >= minColorDelta) stable[i][1] = gf;
if (abs((int)bf - (int)stable[i][2]) >= minColorDelta) stable[i][2] = bf;
}

colors[i] = CRGB(stable[i][0], stable[i][1], stable[i][2]);
}

uint16_t led_to = 0;
Expand Down