leds: lm3559: Fix overexposed images when flash is used

Change-Id: Ie353c61644e07d22448331961f16b06721f8ac77
Signed-off-by: John Kramer <john.kramer@motorola.com>

diff --git a/drivers/leds/led-lm3559.c b/drivers/leds/led-lm3559.c
index 2b8bb805efe8e1f4890fe9e860f8b94bdf7083cc..ffff728f030fedd85176416d5f0fe84fb857771a 100644 (file)
--- a/drivers/leds/led-lm3559.c
+++ b/drivers/leds/led-lm3559.c
@@ -281,10 +281,9 @@ static int lm3559_flash_prepare(struct lm3559_data *torch_data)
        if (err)
                return err;
 
-       if (torch_data->flash_dev.brightness != LED_OFF) {
+       if (torch_data->flash_dev.brightness) {
                uint8_t strobe_brightness;
-               uint val = torch_data->flash_dev.brightness;
-               val = (val * (1024/LM3559_STROBE_STEP)) >> 10;
+               uint val = torch_data->flash_dev.brightness - 1;
                strobe_brightness = val | (val << 4);
 
                err = lm3559_write_reg(torch_data, LM3559_FLASH_BRIGHTNESS,
@@ -335,8 +334,7 @@ static int lm3559_torch_enable(struct lm3559_data *torch_data)
 
        if (torch_data->torch_dev.brightness) {
                uint8_t torch_brightness;
-               uint val = torch_data->torch_dev.brightness;
-               val = (val * (1024/LM3559_TORCH_STEP)) >> 10;
+               uint val = (torch_data->torch_dev.brightness - 1) & 0x3F;
                torch_brightness = val | (val << 3);
 
                err = lm3559_write_reg(torch_data, LM3559_TORCH_BRIGHTNESS,