From 9fd1101ae25f19ddd7b13a4660532339ddce3309 Mon Sep 17 00:00:00 2001 From: "Jan \"Yenya\" Kasprzak" Date: Wed, 26 Jun 2013 23:53:11 +0200 Subject: [PATCH] pwmled: verify the input of pwmled_set_brightness Also allow different number of current levels for each output --- firmware/pwmled.c | 22 +++++++++++++++++----- 1 file changed, 17 insertions(+), 5 deletions(-) diff --git a/firmware/pwmled.c b/firmware/pwmled.c index 6158067..c156d81 100644 --- a/firmware/pwmled.c +++ b/firmware/pwmled.c @@ -122,20 +122,32 @@ void pwmled_set_mode(unsigned char n, unsigned char mode) } } +#define CHECK_BRIGHTNESS(var, expr, array) \ + do { \ + (var) = (expr); \ + if ((var) >= sizeof(array)/sizeof(array[0])) \ + (var) = sizeof(array)/sizeof(array[0]) - 1; \ + } while (0) + void pwmled_set_brightness(uint16_t brightness) { unsigned char i; - adc_vals[0] = adc_targets_0[brightness & 0x7]; - adc_vals[1] = adc_targets_0[(brightness >> 3) & 0x7]; + CHECK_BRIGHTNESS(i, brightness & 0x7, adc_targets_0); + adc_vals[0] = adc_targets_0[i]; + CHECK_BRIGHTNESS(i, (brightness >> 3) & 0x7, adc_targets_0); + adc_vals[1] = adc_targets_0[i]; adc_vals[2] = adc_vals[1]; - adc_vals[3] = adc_targets_1[(brightness >> 6) & 0x7]; + CHECK_BRIGHTNESS(i, (brightness >> 6) & 0x7, adc_targets_1); + adc_vals[3] = adc_targets_1[i]; adc_vals[4] = adc_vals[3]; adc_vals[5] = adc_vals[3]; - adc_vals[6] = adc_targets_2[(brightness >> 9) & 0x7]; - adc_vals[7] = adc_targets_2[(brightness >> 12) & 0x7]; + CHECK_BRIGHTNESS(i, (brightness >> 9) & 0x7, adc_targets_2); + adc_vals[6] = adc_targets_2[i]; + CHECK_BRIGHTNESS(i, (brightness >> 12) & 0x7, adc_targets_2); + adc_vals[7] = adc_targets_2[i]; adc_vals[8] = adc_vals[7]; for (i = 0; i < N_PWMLEDS; i++) { -- 2.39.3