A-Team_Digital_Solutions/android_kernel_motorola_sm6375
Watch
2
0
Fork
You've already forked android_kernel_motorola_sm6375
 0
mirror of https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git synced 2026-10-11 15:11:48 -04:00
Code Issues Projects Releases Packages Wiki Activity

soc: qcom: hyp_core_ctl: fix issue with CPU Freq policy dependency

Browse source 
commit 9acfa80c3d
("BACKPORT: driver core: fw_devlink: Add support for batching fwnode parsing")
changed the way drivers gets probed and by the time hyp core ctl driver tries
to get CPU freq policy, cpufreq driver is not probed which leads to hyp core
ctl driver probe failure. Fix the dependency on CPU Freq policy by moving
freq qos initialization from probe to first write of the min freq node.

Change-Id: I75c628e768ee37a78d1ee54df3e55b6d2389f9a2
Signed-off-by: Satya Durga Srinivasu Prabhala <satyap@codeaurora.org>
This commit is contained in:
Satya Durga Srinivasu Prabhala 2020-08-04 05:11:35 -07:00 • committed by Gerrit - the friendly Code Review server
commit c1b84fedb0
1 changed files with 46 additions and 30 deletions
Download patch file Download diff file Expand all files Collapse all files

76
drivers/soc/qcom/hyp_core_ctl.c
View file

@ -792,6 +792,44 @@ static ssize_t status_show(struct device *dev, struct device_attribute *attr,
static DEVICE_ATTR_RO(status);
static bool freq_qos_init_done;
static int init_freq_qos_req(void)
{
int cpu, ret;
struct cpufreq_policy *policy;
struct freq_qos_request *qos_req;
for_each_possible_cpu(cpu) {
policy = cpufreq_cpu_get(cpu);
if (!policy) {
pr_err("cpufreq policy not found for cpu%d\n", cpu);
ret = -ESRCH;
goto remove_qos_req;
}
qos_req = &per_cpu(qos_min_req, cpu);
ret = freq_qos_add_request(&policy->constraints, qos_req,
FREQ_QOS_MIN, FREQ_QOS_MIN_DEFAULT_VALUE);
if (ret < 0) {
pr_err("Failed to add min freq constraint (%d)\n", ret);
cpufreq_cpu_put(policy);
goto remove_qos_req;
}
cpufreq_cpu_put(policy);
}
return 0;
remove_qos_req:
for_each_possible_cpu(cpu) {
qos_req = &per_cpu(qos_min_req, cpu);
if (freq_qos_request_active(qos_req))
freq_qos_remove_request(qos_req);
}
return ret;
}
static ssize_t hcc_min_freq_store(struct device *dev,
struct device_attribute *attr,
const char *buf, size_t count)
@ -806,6 +844,12 @@ static ssize_t hcc_min_freq_store(struct device *dev,
goto err_out;
}
if (!freq_qos_init_done) {
if (init_freq_qos_req())
goto err_out;
freq_qos_init_done = true;
}
while ((cp = strpbrk(cp + 1, " :")))
ntokens++;
@ -947,37 +991,15 @@ static int hyp_core_ctl_probe(struct platform_device *pdev)
int ret;
struct hyp_core_ctl_data *hcd;
struct sched_param param = { .sched_priority = MAX_RT_PRIO - 1 };
int cpu;
struct cpufreq_policy *policy;
struct freq_qos_request *qos_req;
ret = hh_rm_register_notifier(&hh_vcpu_nb);
if (ret)
return ret;
for_each_possible_cpu(cpu) {
policy = cpufreq_cpu_get(cpu);
if (!policy) {
pr_err("cpufreq policy not found for cpu%d\n", cpu);
ret = -ESRCH;
goto remove_qos_req;
}
qos_req = &per_cpu(qos_min_req, cpu);
ret = freq_qos_add_request(&policy->constraints, qos_req,
FREQ_QOS_MIN, FREQ_QOS_MIN_DEFAULT_VALUE);
if (ret < 0) {
pr_err("Failed to add min freq constraint (%d)\n", ret);
cpufreq_cpu_put(policy);
goto remove_qos_req;
}
cpufreq_cpu_put(policy);
}
hcd = kzalloc(sizeof(*hcd), GFP_KERNEL);
if (!hcd) {
ret = -ENOMEM;
goto remove_qos_req;
goto unregister_rm_notifier;
}
spin_lock_init(&hcd->lock);
@ -1018,13 +1040,7 @@ stop_task:
kthread_stop(hcd->task);
free_hcd:
kfree(hcd);
remove_qos_req:
for_each_possible_cpu(cpu) {
qos_req = &per_cpu(qos_min_req, cpu);
if (freq_qos_request_active(qos_req))
freq_qos_remove_request(qos_req);
}
unregister_rm_notifier:
hh_rm_unregister_notifier(&hh_vcpu_nb);
return ret;