Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 859eb6ee authored by Anirudh Ghayal's avatar Anirudh Ghayal
Browse files

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



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: default avatarAnirudh Ghayal <aghayal@codeaurora.org>
parent 54d02587

drivers/leds/leds-qti-flash.c

+26 −0
Original line number Original line Diff line number Diff line
@@ -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);