|
|
@@ -3,6 +3,11 @@
|
|
|
#include <hal.h>
|
|
|
#include "debug.h"
|
|
|
|
|
|
+// Maximum duty cycle limit
|
|
|
+#ifndef BACKLIGHT_LIMIT_VAL
|
|
|
+# define BACKLIGHT_LIMIT_VAL 255
|
|
|
+#endif
|
|
|
+
|
|
|
// GPIOV2 && GPIOV3
|
|
|
#ifndef BACKLIGHT_PAL_MODE
|
|
|
# define BACKLIGHT_PAL_MODE 2
|
|
|
@@ -58,6 +63,11 @@ static uint16_t cie_lightness(uint16_t v) {
|
|
|
}
|
|
|
}
|
|
|
|
|
|
+static uint32_t rescale_limit_val(uint32_t val) {
|
|
|
+ // rescale the supplied backlight value to be in terms of the value limit
|
|
|
+ return (val * (BACKLIGHT_LIMIT_VAL + 1)) / 256;
|
|
|
+}
|
|
|
+
|
|
|
void backlight_init_ports(void) {
|
|
|
#ifdef USE_GPIOV1
|
|
|
palSetPadMode(PAL_PORT(BACKLIGHT_PIN), PAL_PAD(BACKLIGHT_PIN), PAL_MODE_STM32_ALTERNATE_PUSHPULL);
|
|
|
@@ -85,7 +95,7 @@ void backlight_set(uint8_t level) {
|
|
|
pwmDisableChannel(&BACKLIGHT_PWM_DRIVER, BACKLIGHT_PWM_CHANNEL - 1);
|
|
|
} else {
|
|
|
// Turn backlight on
|
|
|
- uint32_t duty = (uint32_t)(cie_lightness(0xFFFF * (uint32_t)level / BACKLIGHT_LEVELS));
|
|
|
+ uint32_t duty = (uint32_t)(cie_lightness(rescale_limit_val(0xFFFF * (uint32_t)level / BACKLIGHT_LEVELS)));
|
|
|
pwmEnableChannel(&BACKLIGHT_PWM_DRIVER, BACKLIGHT_PWM_CHANNEL - 1, PWM_FRACTION_TO_WIDTH(&BACKLIGHT_PWM_DRIVER, 0xFFFF, duty));
|
|
|
}
|
|
|
}
|
|
|
@@ -129,7 +139,7 @@ void breathing_callback(PWMDriver *pwmp) {
|
|
|
static uint16_t breathing_counter = 0;
|
|
|
breathing_counter = (breathing_counter + 1) % (breathing_period * 256);
|
|
|
uint8_t index = breathing_counter / interval % BREATHING_STEPS;
|
|
|
- uint32_t duty = cie_lightness(scale_backlight(breathing_table[index] * 256));
|
|
|
+ uint32_t duty = cie_lightness(rescale_limit_val(scale_backlight(breathing_table[index] * 256)));
|
|
|
|
|
|
chSysLockFromISR();
|
|
|
pwmEnableChannelI(pwmp, BACKLIGHT_PWM_CHANNEL - 1, PWM_FRACTION_TO_WIDTH(&BACKLIGHT_PWM_DRIVER, 0xFFFF, duty));
|