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

Commit 980c80a9 authored by Gilad Broner's avatar Gilad Broner
Browse files

mmc: sdhci-msm: add sysfs entries for PM QoS 



Add sysfs entries to allow getting the current status of
PM QoS voting and enable or disable voting.

Change-Id: If5b8e4b155090343112916c9c57a766bb2104e10
Signed-off-by: default avatarGilad Broner <gbroner@codeaurora.org>
parent 0bb69bc0

drivers/mmc/host/sdhci-msm.c

+180 −0
Original line number Diff line number Diff line
@@ -3203,11 +3203,69 @@ void sdhci_msm_pm_qos_irq_unvote(struct sdhci_host *host, bool async) 
			msm_host->pm_qos_irq.latency);

}



static ssize_t

sdhci_msm_pm_qos_irq_show(struct device *dev,

		struct device_attribute *attr, char *buf)

{

	struct sdhci_host *host = dev_get_drvdata(dev);

	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);

	struct sdhci_msm_host *msm_host = pltfm_host->priv;

	struct sdhci_msm_pm_qos_irq *irq = &msm_host->pm_qos_irq;



	return snprintf(buf, PAGE_SIZE,

		"IRQ PM QoS: enabled=%d, counter=%d, latency=%d\n",

		irq->enabled, atomic_read(&irq->counter), irq->latency);

}



static ssize_t

sdhci_msm_pm_qos_irq_enable_show(struct device *dev,

		struct device_attribute *attr, char *buf)

{

	struct sdhci_host *host = dev_get_drvdata(dev);

	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);

	struct sdhci_msm_host *msm_host = pltfm_host->priv;



	return snprintf(buf, PAGE_SIZE, "%u\n", msm_host->pm_qos_irq.enabled);

}



static ssize_t

sdhci_msm_pm_qos_irq_enable_store(struct device *dev,

		struct device_attribute *attr, const char *buf, size_t count)

{

	struct sdhci_host *host = dev_get_drvdata(dev);

	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);

	struct sdhci_msm_host *msm_host = pltfm_host->priv;

	uint32_t value;

	bool enable;

	int ret;



	ret = kstrtou32(buf, 0, &value);

	if (ret)

		goto out;

	enable = !!value;



	if (enable == msm_host->pm_qos_irq.enabled)

		goto out;



	msm_host->pm_qos_irq.enabled = enable;

	if (!enable) {

		cancel_work_sync(&msm_host->pm_qos_irq.unvote_work);

		atomic_set(&msm_host->pm_qos_irq.counter, 0);

		msm_host->pm_qos_irq.latency = PM_QOS_DEFAULT_VALUE;

		pm_qos_update_request(&msm_host->pm_qos_irq.req,

				msm_host->pm_qos_irq.latency);

	}



out:

	return count;

}



void sdhci_msm_pm_qos_irq_init(struct sdhci_host *host)

{

	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);

	struct sdhci_msm_host *msm_host = pltfm_host->priv;

	struct sdhci_msm_pm_qos_latency *irq_latency;

	int ret;



	if (!msm_host->pdata->pm_qos_data.irq_valid)

		return;
@@ -3234,6 +3292,101 @@ void sdhci_msm_pm_qos_irq_init(struct sdhci_host *host) 
	pm_qos_add_request(&msm_host->pm_qos_irq.req, PM_QOS_CPU_DMA_LATENCY,

			msm_host->pm_qos_irq.latency);

	msm_host->pm_qos_irq.enabled = true;



	/* sysfs */

	msm_host->pm_qos_irq.enable_attr.show =

		sdhci_msm_pm_qos_irq_enable_show;

	msm_host->pm_qos_irq.enable_attr.store =

		sdhci_msm_pm_qos_irq_enable_store;

	sysfs_attr_init(&msm_host->pm_qos_irq.enable_attr.attr);

	msm_host->pm_qos_irq.enable_attr.attr.name = "pm_qos_irq_enable";

	msm_host->pm_qos_irq.enable_attr.attr.mode = S_IRUGO | S_IWUSR;

	ret = device_create_file(&msm_host->pdev->dev,

		&msm_host->pm_qos_irq.enable_attr);

	if (ret)

		pr_err("%s: fail to create pm_qos_irq_enable (%d)\n",

			__func__, ret);



	msm_host->pm_qos_irq.status_attr.show = sdhci_msm_pm_qos_irq_show;

	msm_host->pm_qos_irq.status_attr.store = NULL;

	sysfs_attr_init(&msm_host->pm_qos_irq.status_attr.attr);

	msm_host->pm_qos_irq.status_attr.attr.name = "pm_qos_irq_status";

	msm_host->pm_qos_irq.status_attr.attr.mode = S_IRUGO;

	ret = device_create_file(&msm_host->pdev->dev,

			&msm_host->pm_qos_irq.status_attr);

	if (ret)

		pr_err("%s: fail to create pm_qos_irq_status (%d)\n",

			__func__, ret);

}



static ssize_t sdhci_msm_pm_qos_group_show(struct device *dev,

		struct device_attribute *attr, char *buf)

{

	struct sdhci_host *host = dev_get_drvdata(dev);

	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);

	struct sdhci_msm_host *msm_host = pltfm_host->priv;

	struct sdhci_msm_pm_qos_group *group;

	int i;

	int nr_groups = msm_host->pdata->pm_qos_data.cpu_group_map.nr_groups;

	int offset = 0;



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

		group = &msm_host->pm_qos[i];

		offset += snprintf(&buf[offset], PAGE_SIZE,

			"Group #%d (mask=0x%lx) PM QoS: enabled=%d, counter=%d, latency=%d\n",

			i, group->req.cpus_affine.bits[0],

			msm_host->pm_qos_group_enable,

			atomic_read(&group->counter),

			group->latency);

	}



	return offset;

}



static ssize_t sdhci_msm_pm_qos_group_enable_show(struct device *dev,

		struct device_attribute *attr, char *buf)

{

	struct sdhci_host *host = dev_get_drvdata(dev);

	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);

	struct sdhci_msm_host *msm_host = pltfm_host->priv;



	return snprintf(buf, PAGE_SIZE, "%s\n",

		msm_host->pm_qos_group_enable ? "enabled" : "disabled");

}



static ssize_t sdhci_msm_pm_qos_group_enable_store(struct device *dev,

		struct device_attribute *attr, const char *buf, size_t count)

{

	struct sdhci_host *host = dev_get_drvdata(dev);

	struct sdhci_pltfm_host *pltfm_host = sdhci_priv(host);

	struct sdhci_msm_host *msm_host = pltfm_host->priv;

	int nr_groups = msm_host->pdata->pm_qos_data.cpu_group_map.nr_groups;

	uint32_t value;

	bool enable;

	int ret;

	int i;



	ret = kstrtou32(buf, 0, &value);

	if (ret)

		goto out;

	enable = !!value;



	if (enable == msm_host->pm_qos_group_enable)

		goto out;



	msm_host->pm_qos_group_enable = enable;

	if (!enable) {

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

			cancel_work_sync(&msm_host->pm_qos[i].unvote_work);

			atomic_set(&msm_host->pm_qos[i].counter, 0);

			msm_host->pm_qos[i].latency = PM_QOS_DEFAULT_VALUE;

			pm_qos_update_request(&msm_host->pm_qos[i].req,

				msm_host->pm_qos[i].latency);

		}

	}



out:

	return count;

}



static int sdhci_msm_get_cpu_group(struct sdhci_msm_host *msm_host, int cpu)
@@ -3320,6 +3473,7 @@ void sdhci_msm_pm_qos_cpu_init(struct sdhci_host *host, 
	int nr_groups = msm_host->pdata->pm_qos_data.cpu_group_map.nr_groups;

	struct sdhci_msm_pm_qos_group *group;

	int i;

	int ret;



	if (msm_host->pm_qos_group_enable)

		return;
@@ -3349,6 +3503,32 @@ void sdhci_msm_pm_qos_cpu_init(struct sdhci_host *host, 
	}

	msm_host->pm_qos_prev_cpu = -1;

	msm_host->pm_qos_group_enable = true;



	/* sysfs */

	msm_host->pm_qos_group_status_attr.show = sdhci_msm_pm_qos_group_show;

	msm_host->pm_qos_group_status_attr.store = NULL;

	sysfs_attr_init(&msm_host->pm_qos_group_status_attr.attr);

	msm_host->pm_qos_group_status_attr.attr.name =

			"pm_qos_cpu_groups_status";

	msm_host->pm_qos_group_status_attr.attr.mode = S_IRUGO;

	ret = device_create_file(&msm_host->pdev->dev,

			&msm_host->pm_qos_group_status_attr);

	if (ret)

		dev_err(&msm_host->pdev->dev, "%s: fail to create pm_qos_group_status_attr (%d)\n",

			__func__, ret);

	msm_host->pm_qos_group_enable_attr.show =

			sdhci_msm_pm_qos_group_enable_show;

	msm_host->pm_qos_group_enable_attr.store =

			sdhci_msm_pm_qos_group_enable_store;

	sysfs_attr_init(&msm_host->pm_qos_group_enable_attr.attr);

	msm_host->pm_qos_group_enable_attr.attr.name =

			"pm_qos_cpu_groups_enable";

	msm_host->pm_qos_group_enable_attr.attr.mode = S_IRUGO;

	ret = device_create_file(&msm_host->pdev->dev,

			&msm_host->pm_qos_group_enable_attr);

	if (ret)

		dev_err(&msm_host->pdev->dev, "%s: fail to create pm_qos_group_enable_attr (%d)\n",

			__func__, ret);

}



static void sdhci_msm_pre_req(struct sdhci_host *host,

drivers/mmc/host/sdhci-msm.h

+4 −0
Original line number Diff line number Diff line
@@ -120,6 +120,8 @@ struct sdhci_msm_pm_qos_group { 
struct sdhci_msm_pm_qos_irq {

	struct pm_qos_request req;

	struct work_struct unvote_work;

	struct device_attribute enable_attr;

	struct device_attribute status_attr;

	atomic_t counter;

	s32 latency;

	bool enabled;
@@ -204,6 +206,8 @@ struct sdhci_msm_host { 
	u32 ice_clk_rate;

	struct sdhci_msm_pm_qos_group *pm_qos;

	int pm_qos_prev_cpu;

	struct device_attribute pm_qos_group_enable_attr;

	struct device_attribute pm_qos_group_status_attr;

	bool pm_qos_group_enable;

	struct sdhci_msm_pm_qos_irq pm_qos_irq;

};