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

Commit 48c8242c authored by Sandeep Singh's avatar Sandeep Singh
Browse files

icnss: Add support for power supply monitoring feature 



Wlan platform driver registers to power supply framework
to receive a callback when any of battery parameters changes.
Wlan platform driver measures battery capacity/percentage once
it receives callback from power supply framework.Once
battery capacity/percentage reaches specific thresholds,
it indicates wlan fw to vote 3p3 ldo at a particular voltage
level.

Change-Id: I70b2a470bcdcef328f8721ac6755702883f331b3
Signed-off-by: default avatarSandeep Singh <sandsing@codeaurora.org>
parent 74de7711

drivers/soc/qcom/icnss.c

+139 −0
Original line number Diff line number Diff line
@@ -129,6 +129,17 @@ static struct icnss_clk_info icnss_clk_info[] = { 


#define ICNSS_CLK_INFO_SIZE		ARRAY_SIZE(icnss_clk_info)



static struct icnss_battery_level icnss_battery_level[] = {

	{70, 3300000},

	{60, 3200000},

	{50, 3100000},

	{25, 3000000},

	{0, 2850000},

};



#define ICNSS_BATTERY_LEVEL_COUNT	ARRAY_SIZE(icnss_battery_level)

#define ICNSS_MAX_BATTERY_LEVEL		100



enum icnss_pdr_cause_index {

	ICNSS_FW_CRASH,

	ICNSS_ROOT_PD_CRASH,
@@ -956,6 +967,78 @@ static int icnss_init_vph_monitor(struct icnss_priv *priv) 
	return ret;

}



static int icnss_get_battery_level(struct icnss_priv *priv)

{

	int err = 0, battery_percentage = 0;

	union power_supply_propval psp = {0,};



	if (!priv->batt_psy)

		priv->batt_psy = power_supply_get_by_name("battery");



	if (priv->batt_psy) {

		err = power_supply_get_property(priv->batt_psy,

						POWER_SUPPLY_PROP_CAPACITY,

						&psp);

		if (err) {

			icnss_pr_err("battery percentage read error:%d\n", err);

			goto out;

		}

		battery_percentage = psp.intval;

	}



	icnss_pr_info("Battery Percentage: %d\n", battery_percentage);

out:

	return battery_percentage;

}



static void icnss_update_soc_level(struct work_struct *work)

{

	int battery_percentage = 0, current_updated_voltage = 0, err = 0;

	int level_count;



	battery_percentage = icnss_get_battery_level(penv);

	if (!battery_percentage ||

	    battery_percentage > ICNSS_MAX_BATTERY_LEVEL) {

		icnss_pr_err("Battery percentage read failure\n");

		return;

	}



	for (level_count = 0; level_count < ICNSS_BATTERY_LEVEL_COUNT;

	     level_count++) {

		if (battery_percentage >=

		    icnss_battery_level[level_count].lower_battery_threshold) {

			current_updated_voltage =

				icnss_battery_level[level_count].ldo_voltage;

			break;

		}

	}



	if (level_count != ICNSS_BATTERY_LEVEL_COUNT &&

	    penv->last_updated_voltage != current_updated_voltage) {

		err = icnss_send_vbatt_update(penv, current_updated_voltage);

		if (err < 0) {

			icnss_pr_err("Unable to update ldo voltage");

			return;

		}

		penv->last_updated_voltage = current_updated_voltage;

	}

}



static int icnss_battery_supply_callback(struct notifier_block *nb,

					 unsigned long event, void *data)

{

	struct power_supply *psy = data;



	if (strcmp(psy->desc->name, "battery"))

		return NOTIFY_OK;



	if (test_bit(ICNSS_WLFW_CONNECTED, &penv->state) &&

	    !test_bit(ICNSS_FW_DOWN, &penv->state))

		queue_work(penv->soc_update_wq, &penv->soc_update_work);



	return NOTIFY_OK;

}



static int icnss_driver_event_server_arrive(void *data)

{

	int ret = 0;
@@ -1039,6 +1122,9 @@ static int icnss_driver_event_server_arrive(void *data) 
	if (penv->vbatt_supported)

		icnss_init_vph_monitor(penv);



	if (penv->psf_supported)

		queue_work(penv->soc_update_wq, &penv->soc_update_work);



	return ret;



err_setup_msa:
@@ -1067,6 +1153,9 @@ static int icnss_driver_event_server_exit(void *data) 
		adc_tm5_disable_chan_meas(penv->adc_tm_dev,

					  &penv->vph_monitor_params);



	if (penv->psf_supported)

		penv->last_updated_voltage = 0;



	return 0;

}
@@ -3425,6 +3514,17 @@ static void icnss_sysfs_destroy(struct icnss_priv *priv) 
		kobject_put(icnss_kobject);

}



static void icnss_unregister_power_supply_notifier(struct icnss_priv *priv)

{

	if (priv->batt_psy)

		power_supply_put(penv->batt_psy);



	if (priv->psf_supported) {

		flush_workqueue(priv->soc_update_wq);

		destroy_workqueue(priv->soc_update_wq);

		power_supply_unreg_notifier(&priv->psf_nb);

	}

}

static int icnss_get_vbatt_info(struct icnss_priv *priv)

{

	struct adc_tm_chip *adc_tm_dev = NULL;
@@ -3463,6 +3563,36 @@ static int icnss_get_vbatt_info(struct icnss_priv *priv) 
	return 0;

}



static int icnss_get_psf_info(struct icnss_priv *priv)

{

	int ret = 0;



	priv->soc_update_wq = alloc_workqueue("icnss_soc_update",

					      WQ_UNBOUND, 1);

	if (!priv->soc_update_wq) {

		icnss_pr_err("Workqueue creation failed for soc update\n");

		ret = -EFAULT;

		goto out;

	}



	priv->psf_nb.notifier_call = icnss_battery_supply_callback;

	ret = power_supply_reg_notifier(&priv->psf_nb);

	if (ret < 0) {

		icnss_pr_err("Power supply framework registration err: %d\n",

			     ret);

		goto err_psf_registration;

	}



	INIT_WORK(&priv->soc_update_work, icnss_update_soc_level);



	return 0;



err_psf_registration:

	destroy_workqueue(priv->soc_update_wq);

out:

	return ret;

}



static int icnss_resource_parse(struct icnss_priv *priv)

{

	int ret = 0, i = 0;
@@ -3477,6 +3607,13 @@ static int icnss_resource_parse(struct icnss_priv *priv) 
		priv->vbatt_supported = true;

	}



	if (of_property_read_bool(pdev->dev.of_node, "qcom,psf-supported")) {

		ret = icnss_get_psf_info(priv);

		if (ret < 0)

			goto out;

		priv->psf_supported = true;

	}



	for (i = 0; i < ICNSS_VREG_INFO_SIZE; i++) {

		ret = icnss_get_vreg_info(dev, &priv->vreg_info[i]);
@@ -3725,6 +3862,8 @@ static int icnss_remove(struct platform_device *pdev) 


	device_init_wakeup(&penv->pdev->dev, false);



	icnss_unregister_power_supply_notifier(penv);



	icnss_debugfs_destroy(penv);



	icnss_sysfs_destroy(penv);

drivers/soc/qcom/icnss_private.h

+12 −0
Original line number Diff line number Diff line
@@ -10,6 +10,7 @@ 
#include <linux/iio/consumer.h>

#include <asm/dma-iommu.h>

#include <linux/kobject.h>

#include <linux/power_supply.h>



#define icnss_ipc_log_string(_x...) do {				\

	if (icnss_ipc_log_context)					\
@@ -183,6 +184,11 @@ struct icnss_clk_info { 
	bool required;

};



struct icnss_battery_level {

	int lower_battery_threshold;

	int ldo_voltage;

};



struct icnss_stats {

	struct {

		uint32_t posted;
@@ -373,6 +379,12 @@ struct icnss_priv { 
	uint16_t hang_event_data_len;

	void *hang_event_data;

	bool is_hyp_enabled;

	bool psf_supported;

	struct notifier_block psf_nb;

	struct power_supply *batt_psy;

	int last_updated_voltage;

	struct work_struct soc_update_work;

	struct workqueue_struct *soc_update_wq;

};



struct icnss_reg_info {