Add brightness to the LED mode.

This commit is contained in:
Benoît Allard
2024-09-25 23:20:48 +02:00
parent 7a0b67f3cb
commit 01d1856fcc
7 changed files with 52 additions and 26 deletions

View File

@@ -27,7 +27,7 @@
#endif
extern void led_driver_init();
extern void led_driver_color(uint8_t);
extern void led_driver_color(uint8_t, float);
static uint32_t led_mode = MODE_NOT_MOUNTED;
@@ -38,35 +38,43 @@ void led_set_mode(uint32_t mode) {
void led_blinking_task() {
#ifndef ENABLE_EMULATION
static uint32_t start_ms = 0;
static uint32_t stop_ms = 0;
static uint8_t led_state = false;
uint8_t state = led_state;
#ifdef PICO_DEFAULT_LED_PIN_INVERTED
state = !state;
#endif
uint32_t led_max_brightness = (led_mode & LED_BTNESS_MASK) >> LED_BTNESS_SHIFT;
uint32_t led_color = (led_mode & LED_COLOR_MASK) >> LED_COLOR_SHIFT;
uint32_t led_off = (led_mode & LED_OFF_MASK) >> LED_OFF_SHIFT;
uint32_t led_on = (led_mode & LED_ON_MASK) >> LED_ON_SHIFT;
uint32_t led_interval = led_state ? led_on : led_off;
// Blink every interval ms
if (board_millis() - start_ms < led_interval) {
return; // not enough time
}
start_ms += led_interval;
// how far in the current state from 0 - 1
float progress = (board_millis() - start_ms) / (stop_ms - start_ms);
if (state == false) {
led_driver_color(LED_COLOR_OFF);
if (!state){
// fading down so 1 -> 0
progress = 1 - progress;
}
else {
led_driver_color(led_color);
// maybe quick return if progress didn't changed much ?
// current one from 0 - 1
float led_brightness = (led_max_brightness / MAX_BTNESS) * progress;
led_driver_color(led_color, led_brightness);
if (board_millis() >= stop_ms){
start_ms = stop_ms;
led_state ^= 1; // toggle
stop_ms = start_ms + (led_state ? led_on : led_off);
}
led_state ^= 1; // toggle
#endif
}
void led_off_all() {
#ifndef ENABLE_EMULATION
led_driver_color(LED_COLOR_OFF);
led_driver_color(LED_COLOR_OFF, 0);
#endif
}