X-Git-Url: https://www.fi.muni.cz/~kas/git//home/kas/public_html/git/?p=bike-lights.git;a=blobdiff_plain;f=firmware%2Fpwmled.c;h=99650d00460aeff816954cb66ff13da2e1c86f48;hp=7cc300641a5fe3fe2cf536ae32945814721aa44b;hb=1e3c9f876c88582e3da20a51f43d340c40c372ab;hpb=dfdde30a343b7da032bea880b0677b49ff0e5d8a

diff --git a/firmware/pwmled.c b/firmware/pwmled.c
index 7cc3006..99650d0 100644
--- a/firmware/pwmled.c
+++ b/firmware/pwmled.c
@@ -5,7 +5,10 @@
 typedef struct {
 	uint16_t target, pwm;
 	int16_t err_sum;
-	unsigned char mode, state, probe_steady;
+	unsigned char mode, state;
+	union {
+		unsigned char probe_steady, mode_changed;
+	};
 	uint16_t mode_pwm[N_PWMLED_MODES];
 	int16_t err_sums[N_PWMLED_MODES];
 } pwmled_t;
@@ -27,10 +30,8 @@ pwmled_t pwmleds[N_PWMLEDS];
 	* 1024 \
 	/ (1100000/(gain))))
 
-#define PWMLED_TESTING 1
-
 static uint16_t adc_max[N_PWMLEDS] = {
-#ifdef PWMLED_TESTING
+#ifdef TESTING_FW
 	MA_GAIN_TO_ADC( 400, 20),
 	MA_GAIN_TO_ADC(  30, 20),
 	MA_GAIN_TO_ADC( 800,  1)
@@ -42,22 +43,22 @@ static uint16_t adc_max[N_PWMLEDS] = {
 };
 
 static uint16_t adc_vals[N_PWMLEDS*N_PWMLED_MODES] = {
-#ifdef PWMLED_TESTING
+#ifdef TESTING_FW
 	/* pwmled0 */
 	MA_GAIN_TO_ADC(  50, 20),
-	MA_GAIN_TO_ADC( 150, 20),
-	MA_GAIN_TO_ADC( 250, 20),
-	MA_GAIN_TO_ADC( 350, 20),
+	MA_GAIN_TO_ADC( 100, 20),
+	MA_GAIN_TO_ADC( 200, 20),
+	MA_GAIN_TO_ADC( 300, 20),
 	/* pwmled1 */
 	MA_GAIN_TO_ADC(   5, 20),
 	MA_GAIN_TO_ADC(  10, 20),
 	MA_GAIN_TO_ADC(  15, 20),
 	MA_GAIN_TO_ADC(  20, 20),
 	/* pwmled2 */
+	MA_GAIN_TO_ADC(  50,  1),
 	MA_GAIN_TO_ADC( 100,  1),
-	MA_GAIN_TO_ADC( 200,  1),
-	MA_GAIN_TO_ADC( 300,  1),
-	MA_GAIN_TO_ADC( 400,  1)
+	MA_GAIN_TO_ADC( 150,  1),
+	MA_GAIN_TO_ADC( 200,  1)
 #else
 	/* pwmled0 */
 	MA_GAIN_TO_ADC( 100, 20),
@@ -124,6 +125,7 @@ void pwmled_set_mode(unsigned char n, unsigned char mode)
 		led->state = ST_ON;
 		led->pwm = led->mode_pwm[mode - 1];
 		led->err_sum = led->err_sums[mode - 1];
+		led->mode_changed = 1;
 		pwm_set(n, led->pwm);
 	} else {
 		led->state = ST_OFF;
@@ -204,6 +206,10 @@ void pwmled_adc(unsigned char n, uint16_t adcval)
 	if (!ST_IS_ON(led->state))
 		return;
 
+	if (led->state == ST_ON && led->mode_changed) {
+		led->mode_changed--;
+		return;
+	}
 	// FIXME: test for maximum adcval value (adc_max[n])
 
 	old_pwm = led->pwm;
@@ -220,7 +226,8 @@ void pwmled_adc(unsigned char n, uint16_t adcval)
 	sum -= led->pwm << shift;
 	led->err_sum = sum;
 
-	if (led->pwm >= PWM_MAX) {
+	if (led->pwm >= PWM_MAX
+		|| (n == 1 && led->pwm > PWM_MAX/2 && adcval < 0x08)) {
 		pwmled_err(n);
 		return;
 	}