Obbart/ETcontroller_PRO
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

led class refactor

Browse Source
This commit is contained in:
Emanuele Trabattoni
2025-08-01 10:38:41 +02:00
parent eaa643bf3c
commit 25aa2d6cb6
3 changed files with 87 additions and 50 deletions
Download Patch File Download Diff File Expand all files Collapse all files

81
lib/GPIO/LED_Driver.cpp
View File

@@ -10,8 +10,8 @@ namespace drivers
{
LOG_INFO("Inizializing RGB Led");
pinMode(c_ledPin, OUTPUT);
m_lp.pin = c_ledPin;
m_lp.blinkTask = NULL;
m_blinkTask = NULL;
m_flashTimer = NULL;
}
Led::~Led()
@@ -22,54 +22,85 @@ namespace drivers
void Led::setColor(const color_t color)
{
std::lock_guard<std::mutex> lock(m_ledMutex);
blinkStop();
m_colorDefault = color;
rgbLedWrite(c_ledPin, color.g, color.r, color.b);
}
void Led::flashHandle(TimerHandle_t th)
{
Led *led = (Led *)pvTimerGetTimerID(th);
std::lock_guard<std::mutex> lock(led->m_ledMutex);
rgbLedWrite(led->c_ledPin, led->m_colorDefault.g, led->m_colorDefault.r, led->m_colorDefault.b); // reset color to saved color
LOG_DEBUG("Led Flash timer expired");
xTimerDelete(th, 0);
led->m_flashTimer = NULL;
}
void Led::flashColor(const uint16_t tOn, const color_t color)
{
std::lock_guard<std::mutex> lock(m_ledMutex);
if (m_flashTimer == NULL)
{
blinkStop();
rgbLedWrite(c_ledPin, color.g, color.r, color.b); // set color to flash
m_flashTimer = xTimerCreate("flasher", pdMS_TO_TICKS(tOn), pdFALSE, this, flashHandle);
xTimerStart(m_flashTimer, 0);
LOG_DEBUG("Led Flash timer created");
}
}
void Led::blinkColor(const uint16_t tOn, const uint16_t tOff, const color_t color)
{
std::lock_guard<std::mutex> lock(m_ledMutex);
blinkStop();
m_lp.color1 = color;
m_lp.color2 = {0, 0, 0};
m_lp.tOn = tOn;
m_lp.tOff = tOff;
xTaskCreate(blinkTask, "blinker", TASK_STACK, static_cast<void *>(&m_lp), TASK_PRIORITY, &m_lp.blinkTask);
m_color1 = color;
m_color2 = {0, 0, 0};
m_tOn = tOn;
m_tOff = tOff;
xTaskCreate(blinkTask, "blinker", TASK_STACK, this, TASK_PRIORITY, &m_blinkTask);
}
void Led::blinkAlternate(const uint16_t tOn, const uint16_t tOff, const color_t color1, const color_t color2)
{
{
blinkStop();
m_lp.color1 = color1;
m_lp.color2 = color2;
m_lp.tOn = tOn;
m_lp.tOff = tOff;
xTaskCreate(blinkTask, "blinker", TASK_STACK, static_cast<void *>(&m_lp), TASK_PRIORITY, &m_lp.blinkTask);
}
std::lock_guard<std::mutex> lock(m_ledMutex);
blinkStop();
m_color1 = color1;
m_color2 = color2;
m_tOn = tOn;
m_tOff = tOff;
xTaskCreate(blinkTask, "blinker", TASK_STACK, this, TASK_PRIORITY, &m_blinkTask);
}
void Led::blinkStop()
{
if (m_lp.blinkTask != NULL)
vTaskDelete(m_lp.blinkTask);
m_lp.blinkTask = NULL;
if (m_blinkTask != NULL)
vTaskDelete(m_blinkTask);
m_blinkTask = NULL;
}
void Led::blinkTask(void *params)
{
Led *led = static_cast<Led *>(params);
LOG_DEBUG("Blinker Task Created");
led_params_t *lPar = static_cast<led_params_t *>(params);
while (true)
{
rgbLedWrite(lPar->pin, lPar->color1.g, lPar->color1.r, lPar->color1.b);
delay(lPar->tOn);
rgbLedWrite(lPar->pin, lPar->color2.g, lPar->color2.r, lPar->color2.b); // off
if (lPar->tOff == 0)
{
std::lock_guard<std::mutex> lock(led->m_ledMutex);
rgbLedWrite(led->c_ledPin, led->m_color1.g, led->m_color1.r, led->m_color1.b);
}
delay(led->m_tOn);
{
std::lock_guard<std::mutex> lock(led->m_ledMutex);
rgbLedWrite(led->c_ledPin, led->m_color2.g, led->m_color2.r, led->m_color2.b); // off
}
if (led->m_tOff == 0)
break;
delay(lPar->tOff);
delay(led->m_tOff);
}
LOG_DEBUG("Blinker Task Ended");
lPar->blinkTask = NULL;
led->m_blinkTask = NULL;
vTaskDelete(NULL);
}
}