Commit c4c0efb0 authored by Xuewen Yan's avatar Xuewen Yan Committed by Viresh Kumar
Browse files

cpufreq: qcom-cpufreq-hw: Add cpufreq qos for LMh 



Before update thermal pressure, the max cpufreq should be limited.
Add QOS control for Lmh throttle cpufreq.

Signed-off-by: default avatarXuewen Yan <xuewen.yan@unisoc.com>
Signed-off-by: default avatarViresh Kumar <viresh.kumar@linaro.org>
parent f7968c22

drivers/cpufreq/qcom-cpufreq-hw.c

+14 −0
Original line number Diff line number Diff line
@@ -13,6 +13,7 @@ 
#include <linux/of_address.h>

#include <linux/of_platform.h>

#include <linux/pm_opp.h>

#include <linux/pm_qos.h>

#include <linux/slab.h>

#include <linux/spinlock.h>

#include <linux/units.h>
@@ -56,6 +57,8 @@ struct qcom_cpufreq_data { 
	struct cpufreq_policy *policy;



	bool per_core_dcvs;



	struct freq_qos_request throttle_freq_req;

};



static unsigned long cpu_hw_rate, xo_rate;
@@ -321,6 +324,8 @@ static void qcom_lmh_dcvs_notify(struct qcom_cpufreq_data *data) 


	throttled_freq = freq_hz / HZ_PER_KHZ;



	freq_qos_update_request(&data->throttle_freq_req, throttled_freq);



	/* Update thermal pressure (the boost frequencies are accepted) */

	arch_update_thermal_pressure(policy->related_cpus, throttled_freq);
@@ -413,6 +418,14 @@ static int qcom_cpufreq_hw_lmh_init(struct cpufreq_policy *policy, int index) 
	if (data->throttle_irq < 0)

		return data->throttle_irq;



	ret = freq_qos_add_request(&policy->constraints,

				   &data->throttle_freq_req, FREQ_QOS_MAX,

				   FREQ_QOS_MAX_DEFAULT_VALUE);

	if (ret < 0) {

		dev_err(&pdev->dev, "Failed to add freq constraint (%d)\n", ret);

		return ret;

	}



	data->cancel_throttle = false;

	data->policy = policy;
@@ -479,6 +492,7 @@ static void qcom_cpufreq_hw_lmh_exit(struct qcom_cpufreq_data *data) 
	if (data->throttle_irq <= 0)

		return;



	freq_qos_remove_request(&data->throttle_freq_req);

	free_irq(data->throttle_irq, data);

}