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

Commit 97bf4e24 authored by Jigarkumar Kishorkumar Zala's avatar Jigarkumar Kishorkumar Zala
Browse files

leds: leds-qpnp-flash: add current derate control and expose max current 



Add sysfs entries for enabling/disabling current derate control,
and exposing the max allowed PMIC current for "flash LEDs" to userspace.

Change-Id: Ia9c6269923487f9cf356e0bd68f32f89a4b820e6
Signed-off-by: default avatarJigarkumar Kishorkumar Zala <j_zala@codeaurora.org>
parent d9c0d608

drivers/leds/leds-qpnp-flash.c

+112 −33
Original line number Diff line number Diff line 
/* Copyright (c) 2014, The Linux Foundation. All rights reserved.

/* Copyright (c) 2014-2015, The Linux Foundation. All rights reserved.

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License version 2 and
@@ -201,6 +201,46 @@ static u8 qpnp_flash_led_ctrl_dbg_regs[] = { 
	0x4A, 0x4B, 0x4F, 0x51, 0x52, 0x54, 0x55, 0x5A

};



static int

qpnp_flash_led_get_max_avail_current(struct flash_node_data *flash_node,

					struct qpnp_flash_led *led)

{

	union power_supply_propval prop;

	int max_curr_avail_ma;

	int rc;



	if (!led->battery_psy)

		led->battery_psy = power_supply_get_by_name("battery");



	if (led->battery_psy) {

		rc = led->battery_psy->get_property(led->battery_psy,

				POWER_SUPPLY_PROP_FLASH_CURRENT_MAX,

				&prop);

		if (rc) {

			dev_err(&led->spmi_dev->dev,

				"Failed to get power supply property\n");

			return -EINVAL;

		}



		if (!prop.intval) {

			dev_err(&led->spmi_dev->dev,

				"battery too low for flash\n");

			return 0;

		}

	} else {

		dev_err(&led->spmi_dev->dev,

			"failed to query power supply battery device\n");

		return -EINVAL;

	}

	max_curr_avail_ma = (int)(prop.intval / FLASH_LED_UA_PER_MA);

	max_curr_avail_ma = max_curr_avail_ma / 2;



	if (max_curr_avail_ma > flash_node->max_current)

		max_curr_avail_ma = flash_node->max_current;



	return max_curr_avail_ma;

}



static ssize_t qpnp_led_strobe_type_store(struct device *dev,

			struct device_attribute *attr,

			const char *buf, size_t count)
@@ -258,6 +298,55 @@ static ssize_t qpnp_flash_led_dump_regs_show(struct device *dev, 
	return count;

}



static ssize_t qpnp_flash_led_current_derate_store(struct device *dev,

				struct device_attribute *attr,

				const char *buf, size_t count)

{

	struct qpnp_flash_led *led;

	struct flash_node_data *flash_node;

	unsigned long val;

	struct led_classdev *led_cdev = dev_get_drvdata(dev);

	ssize_t ret;



	ret = kstrtoul(buf, 10, &val);

	if (ret)

		return ret;



	flash_node = container_of(led_cdev, struct flash_node_data, cdev);

	led = dev_get_drvdata(&flash_node->spmi_dev->dev);



	/*'0' for disable derate feature; non-zero to enable derate feature */

	if (val == 0)

		led->pdata->power_detect_en = false;

	else

		led->pdata->power_detect_en = true;



	return count;

}



static ssize_t qpnp_flash_led_max_current_show(struct device *dev,

			struct device_attribute *attr, char *buf)

{

	struct qpnp_flash_led *led;

	struct flash_node_data *flash_node;

	struct led_classdev *led_cdev = dev_get_drvdata(dev);

	int max_curr_avail_ma;

	flash_node = container_of(led_cdev, struct flash_node_data, cdev);

	led = dev_get_drvdata(&flash_node->spmi_dev->dev);



	if (led->pdata->power_detect_en) {

		max_curr_avail_ma =

			qpnp_flash_led_get_max_avail_current(flash_node, led);



		if (max_curr_avail_ma < 0)

			return -EINVAL;

		else

			max_curr_avail_ma = (int)flash_node->max_current;

	}



	return snprintf(buf, PAGE_SIZE, "%u\n", max_curr_avail_ma);

}



static struct device_attribute qpnp_flash_led_attrs[] = {

	__ATTR(strobe, (S_IRUGO | S_IWUSR | S_IWGRP),

				NULL,
@@ -265,6 +354,12 @@ static struct device_attribute qpnp_flash_led_attrs[] = { 
	__ATTR(reg_dump, (S_IRUGO | S_IWUSR | S_IWGRP),

				qpnp_flash_led_dump_regs_show,

				NULL),

	__ATTR(enable_current_derate, (S_IRUGO | S_IWUSR | S_IWGRP),

				NULL,

				qpnp_flash_led_current_derate_store),

	__ATTR(max_allowed_current, (S_IRUGO | S_IWUSR | S_IWGRP),

				qpnp_flash_led_max_current_show,

				NULL),

};



static int
@@ -450,7 +545,6 @@ static int qpnp_flash_led_module_disable(struct qpnp_flash_led *led, 
			return -EINVAL;

		}

	}



	return 0;

}
@@ -466,9 +560,8 @@ static void qpnp_flash_led_work(struct work_struct *work) 
				struct flash_node_data, work);

	struct qpnp_flash_led *led =

			dev_get_drvdata(&flash_node->spmi_dev->dev);

	union power_supply_propval prop;

	int rc, brightness = flash_node->cdev.brightness;

	u16 max_curr_avail_ma;

	int max_curr_avail_ma;

	u8 val;



	mutex_lock(&led->flash_led_lock);
@@ -482,8 +575,7 @@ static void qpnp_flash_led_work(struct work_struct *work) 
	flash_node->prgm_current = brightness;



	if (flash_node->boost_regulator && !flash_node->flash_on) {

		if (regulator_count_voltages(flash_node->boost_regulator)

									> 0) {

		if (regulator_count_voltages(flash_node->boost_regulator) > 0) {

			rc = regulator_set_voltage(flash_node->boost_regulator,

				flash_node->boost_voltage_max,

				flash_node->boost_voltage_max);
@@ -563,37 +655,24 @@ static void qpnp_flash_led_work(struct work_struct *work) 
		}

	} else if (flash_node->type == FLASH) {

		if (led->pdata->power_detect_en) {

			if (!led->battery_psy)

				led->battery_psy =

					power_supply_get_by_name("battery");



			if (led->battery_psy) {

				led->battery_psy->get_property(led->battery_psy,

					POWER_SUPPLY_PROP_FLASH_CURRENT_MAX,

					&prop);

				if (!prop.intval) {

			max_curr_avail_ma =

				qpnp_flash_led_get_max_avail_current

							(flash_node, led);

			if (max_curr_avail_ma < 0) {

				dev_err(&led->spmi_dev->dev,

						"battery too low for flash\n");

					"Failed to get Max available curr\n");

				goto exit_flash_led_work;

				}

			} else {

				dev_err(&led->spmi_dev->dev,

					"failed to query battery level\n");

				goto exit_flash_led_work;

			}



			max_curr_avail_ma = (u16)(prop.intval /

							FLASH_LED_UA_PER_MA);

			max_curr_avail_ma = max_curr_avail_ma / 2;



			if (max_curr_avail_ma < flash_node->prgm_current) {

				if (max_curr_avail_ma <

					flash_node->prgm_current) {

					dev_err(&led->spmi_dev->dev,

						"battery only supports %d mA.\n",

						max_curr_avail_ma);

				flash_node->prgm_current = max_curr_avail_ma;

					flash_node->prgm_current =

						(u16) max_curr_avail_ma;

				}

			}

		}



		val = (u8)((flash_node->duration - FLASH_DURATION_DIVIDER)

						/ FLASH_DURATION_DIVIDER);

		rc = qpnp_led_masked_write(led->spmi_dev,