TechPanelGM/kernel_xiaomi_sm8250
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

leds: qti-flash: Set TORCH_MODE for bharger-flash

Browse Source 
In Bharger-flash, the charger h/w is to be notified
of the Torch-charger concurrency. This is done by setting
the TORCH_MODE bit before enabling the torch-config.
Implement this and identify bharger-flash based on
the peripheral-subtype.

Change-Id: I6207f45f506ab595bd261a297abdd8f40990c8d4
Signed-off-by: Anirudh Ghayal <aghayal@codeaurora.org>
This commit is contained in:
Anirudh Ghayal
2020-03-15 05:39:33 +05:30
parent 54d025871e
commit 859eb6ee38
1 changed files with 26 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

26
drivers/leds/leds-qti-flash.c
View File

@@ -19,6 +19,8 @@
#include "leds.h" #include "leds.h"
#define FLASH_PERPH_SUBTYPE 0x05
#define FLASH_LED_STATUS1 0x06 #define FLASH_LED_STATUS1 0x06
#define FLASH_LED_STATUS2 0x07 #define FLASH_LED_STATUS2 0x07
@@ -59,6 +61,9 @@
#define FLASH_LED_ENABLE(id) BIT(id) #define FLASH_LED_ENABLE(id) BIT(id)
#define FLASH_LED_DISABLE 0 #define FLASH_LED_DISABLE 0
#define FORCE_TORCH_MODE 0x68
#define FORCE_TORCH BIT(0)
#define MAX_IRES_LEVELS 2 #define MAX_IRES_LEVELS 2
#define IRES_12P5_MAX_CURR_MA 1500 #define IRES_12P5_MAX_CURR_MA 1500
#define IRES_5P0_MAX_CURR_MA 640 #define IRES_5P0_MAX_CURR_MA 640
@@ -139,6 +144,7 @@ struct qti_flash_led {
u16 base; u16 base;
u8 max_channels; u8 max_channels;
u8 ref_count; u8 ref_count;
u8 subtype;
}; };
static const u32 flash_led_max_ires_values[MAX_IRES_LEVELS] = { static const u32 flash_led_max_ires_values[MAX_IRES_LEVELS] = {
@@ -336,6 +342,13 @@ static int qti_flash_led_enable(struct flash_node_data *fnode)
goto out; goto out;
} }
if (fnode->type == FLASH_LED_TYPE_TORCH && led->subtype == 0x6) {
rc = qti_flash_led_masked_write(led, FORCE_TORCH_MODE,
FORCE_TORCH, FORCE_TORCH);
if (rc < 0)
goto out;
}
fnode->configured = true; fnode->configured = true;
if ((fnode->strobe_sel == HW_STROBE) && if ((fnode->strobe_sel == HW_STROBE) &&
@@ -368,6 +381,13 @@ static int qti_flash_led_disable(struct flash_node_data *fnode)
if (rc < 0) if (rc < 0)
goto out; goto out;
if (fnode->type == FLASH_LED_TYPE_TORCH && led->subtype == 0x6) {
rc = qti_flash_led_masked_write(led, FORCE_TORCH_MODE,
FORCE_TORCH, 0);
if (rc < 0)
goto out;
}
fnode->current_ma = 0; fnode->current_ma = 0;
out: out:
@@ -1203,6 +1223,12 @@ static int qti_flash_led_probe(struct platform_device *pdev)
return rc; return rc;
} }
rc = qti_flash_led_read(led, FLASH_PERPH_SUBTYPE, &led->subtype, 1);
if (rc < 0) {
pr_err("Failed to read flash-perph subtype rc=%d\n", rc);
return rc;
}
rc = qti_flash_led_setup(led); rc = qti_flash_led_setup(led);
if (rc < 0) { if (rc < 0) {
pr_err("Failed to initialize flash LED, rc=%d\n", rc); pr_err("Failed to initialize flash LED, rc=%d\n", rc);