arch/arm/mach-msm/cpufreq.c - kernel/msm - Gitiles

 /* arch/arm/mach-msm/cpufreq.c
  *
  * MSM architecture cpufreq driver
  *
  * Copyright (C) 2007 Google, Inc.
  * Copyright (c) 2007-2012, Code Aurora Forum. All rights reserved.
  * Author: Mike A. Chan <mikechan@google.com>
  *
  * This software is licensed under the terms of the GNU General Public
  * License version 2, as published by the Free Software Foundation, and
  * may be copied, distributed, and modified under those terms.
  *
  * This program is distributed in the hope that it will be useful,
  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.	 See the
  * GNU General Public License for more details.
  *
  */

 #include <linux/earlysuspend.h>
 #include <linux/init.h>
 #include <linux/cpufreq.h>
 #include <linux/workqueue.h>
 #include <linux/completion.h>
 #include <linux/cpu.h>
 #include <linux/cpumask.h>
 #include <linux/sched.h>
 #include <linux/suspend.h>
 #include <mach/socinfo.h>

 #include "acpuclock.h"

 #ifdef CONFIG_SMP
 struct cpufreq_work_struct {
 	struct work_struct work;
 	struct cpufreq_policy *policy;
 	struct completion complete;
 	int frequency;
 	int status;
 };

 static DEFINE_PER_CPU(struct cpufreq_work_struct, cpufreq_work);
 static struct workqueue_struct *msm_cpufreq_wq;
 #endif

 struct cpufreq_suspend_t {
 	struct mutex suspend_mutex;
 	int device_suspended;
 };

 static DEFINE_PER_CPU(struct cpufreq_suspend_t, cpufreq_suspend);

 static int override_cpu;

 static int set_cpu_freq(struct cpufreq_policy *policy, unsigned int new_freq)
 {
 	int ret = 0;
 	struct cpufreq_freqs freqs;

 	freqs.old = policy->cur;
 	if (override_cpu) {
 		if (policy->cur == policy->max)
 			return 0;
 		else
 			freqs.new = policy->max;
 	} else
 		freqs.new = new_freq;
 	freqs.cpu = policy->cpu;
 	cpufreq_notify_transition(&freqs, CPUFREQ_PRECHANGE);
 	ret = acpuclk_set_rate(policy->cpu, new_freq, SETRATE_CPUFREQ);
 	if (!ret)
 		cpufreq_notify_transition(&freqs, CPUFREQ_POSTCHANGE);

 	return ret;
 }

 #ifdef CONFIG_SMP
 static void set_cpu_work(struct work_struct *work)
 {
 	struct cpufreq_work_struct *cpu_work =
 		container_of(work, struct cpufreq_work_struct, work);

 	cpu_work->status = set_cpu_freq(cpu_work->policy, cpu_work->frequency);
 	complete(&cpu_work->complete);
 }
 #endif

 static int msm_cpufreq_target(struct cpufreq_policy *policy,
 				unsigned int target_freq,
 				unsigned int relation)
 {
 	int ret = -EFAULT;
 	int index;
 	struct cpufreq_frequency_table *table;
 #ifdef CONFIG_SMP
 	struct cpufreq_work_struct *cpu_work = NULL;
 	cpumask_var_t mask;

 	if (!alloc_cpumask_var(&mask, GFP_KERNEL))
 		return -ENOMEM;

 	if (!cpu_active(policy->cpu)) {
 		pr_info("cpufreq: cpu %d is not active.\n", policy->cpu);
 		return -ENODEV;
 	}
 #endif

 	mutex_lock(&per_cpu(cpufreq_suspend, policy->cpu).suspend_mutex);

 	if (per_cpu(cpufreq_suspend, policy->cpu).device_suspended) {
 		pr_debug("cpufreq: cpu%d scheduling frequency change "
 				"in suspend.\n", policy->cpu);
 		ret = -EFAULT;
 		goto done;
 	}

 	table = cpufreq_frequency_get_table(policy->cpu);
 	if (cpufreq_frequency_table_target(policy, table, target_freq, relation,
 			&index)) {
 		pr_err("cpufreq: invalid target_freq: %d\n", target_freq);
 		ret = -EINVAL;
 		goto done;
 	}

 #ifdef CONFIG_CPU_FREQ_DEBUG
 	pr_debug("CPU[%d] target %d relation %d (%d-%d) selected %d\n",
 		policy->cpu, target_freq, relation,
 		policy->min, policy->max, table[index].frequency);
 #endif

 #ifdef CONFIG_SMP
 	cpu_work = &per_cpu(cpufreq_work, policy->cpu);
 	cpu_work->policy = policy;
 	cpu_work->frequency = table[index].frequency;
 	cpu_work->status = -ENODEV;

 	cpumask_clear(mask);
 	cpumask_set_cpu(policy->cpu, mask);
 	if (cpumask_equal(mask, &current->cpus_allowed)) {
 		ret = set_cpu_freq(cpu_work->policy, cpu_work->frequency);
 		goto done;
 	} else {
 		cancel_work_sync(&cpu_work->work);
 		INIT_COMPLETION(cpu_work->complete);
 		queue_work_on(policy->cpu, msm_cpufreq_wq, &cpu_work->work);
 		wait_for_completion(&cpu_work->complete);
 	}

 	free_cpumask_var(mask);
 	ret = cpu_work->status;
 #else
 	ret = set_cpu_freq(policy, table[index].frequency);
 #endif

 done:
 	mutex_unlock(&per_cpu(cpufreq_suspend, policy->cpu).suspend_mutex);
 	return ret;
 }

 static int msm_cpufreq_verify(struct cpufreq_policy *policy)
 {
 	cpufreq_verify_within_limits(policy, policy->cpuinfo.min_freq,
 			policy->cpuinfo.max_freq);
 	return 0;
 }

 static int __cpuinit msm_cpufreq_init(struct cpufreq_policy *policy)
 {
 	int cur_freq;
 	int index;
 	struct cpufreq_frequency_table *table;
 #ifdef CONFIG_SMP
 	struct cpufreq_work_struct *cpu_work = NULL;
 #endif

 	/*
 	 * In 8625 both cpu core's frequency can not
 	 * be changed independently. Each cpu is bound to
 	 * same frequency. Hence set the cpumask to all cpu.
 	 */
 	if (cpu_is_msm8625())
 		cpumask_setall(policy->cpus);

 	table = cpufreq_frequency_get_table(policy->cpu);
 	if (table == NULL)
 		return -ENODEV;
 	if (cpufreq_frequency_table_cpuinfo(policy, table)) {
 #ifdef CONFIG_MSM_CPU_FREQ_SET_MIN_MAX
 		policy->cpuinfo.min_freq = CONFIG_MSM_CPU_FREQ_MIN;
 		policy->cpuinfo.max_freq = CONFIG_MSM_CPU_FREQ_MAX;
 #endif
 	}
 #ifdef CONFIG_MSM_CPU_FREQ_SET_MIN_MAX
 	policy->min = CONFIG_MSM_CPU_FREQ_MIN;
 	policy->max = CONFIG_MSM_CPU_FREQ_MAX;
 #endif

 	cur_freq = acpuclk_get_rate(policy->cpu);
 	if (cpufreq_frequency_table_target(policy, table, cur_freq,
 	    CPUFREQ_RELATION_H, &index) &&
 	    cpufreq_frequency_table_target(policy, table, cur_freq,
 	    CPUFREQ_RELATION_L, &index)) {
 		pr_info("cpufreq: cpu%d at invalid freq: %d\n",
 				policy->cpu, cur_freq);
 		return -EINVAL;
 	}

 	if (cur_freq != table[index].frequency) {
 		int ret = 0;
 		ret = acpuclk_set_rate(policy->cpu, table[index].frequency,
 				SETRATE_CPUFREQ);
 		if (ret)
 			return ret;
 		pr_info("cpufreq: cpu%d init at %d switching to %d\n",
 				policy->cpu, cur_freq, table[index].frequency);
 		cur_freq = table[index].frequency;
 	}

 	policy->cur = cur_freq;

 	policy->cpuinfo.transition_latency =
 		acpuclk_get_switch_time() * NSEC_PER_USEC;
 #ifdef CONFIG_SMP
 	cpu_work = &per_cpu(cpufreq_work, policy->cpu);
 	INIT_WORK(&cpu_work->work, set_cpu_work);
 	init_completion(&cpu_work->complete);
 #endif

 	return 0;
 }

 static int msm_cpufreq_suspend(void)
 {
 	int cpu;

 	for_each_possible_cpu(cpu) {
 		mutex_lock(&per_cpu(cpufreq_suspend, cpu).suspend_mutex);
 		per_cpu(cpufreq_suspend, cpu).device_suspended = 1;
 		mutex_unlock(&per_cpu(cpufreq_suspend, cpu).suspend_mutex);
 	}

 	return NOTIFY_DONE;
 }

 static int msm_cpufreq_resume(void)
 {
 	int cpu;

 	for_each_possible_cpu(cpu) {
 		per_cpu(cpufreq_suspend, cpu).device_suspended = 0;
 	}

 	return NOTIFY_DONE;
 }

 static int msm_cpufreq_pm_event(struct notifier_block *this,
 				unsigned long event, void *ptr)
 {
 	switch (event) {
 	case PM_POST_HIBERNATION:
 	case PM_POST_SUSPEND:
 		return msm_cpufreq_resume();
 	case PM_HIBERNATION_PREPARE:
 	case PM_SUSPEND_PREPARE:
 		return msm_cpufreq_suspend();
 	default:
 		return NOTIFY_DONE;
 	}
 }

 static ssize_t store_mfreq(struct sysdev_class *class,
 			struct sysdev_class_attribute *attr,
 			const char *buf, size_t count)
 {
 	u64 val;

 	if (strict_strtoull(buf, 0, &val) < 0) {
 		pr_err("Invalid parameter to mfreq\n");
 		return 0;
 	}
 	if (val)
 		override_cpu = 1;
 	else
 		override_cpu = 0;
 	return count;
 }

 static SYSDEV_CLASS_ATTR(mfreq, 0200, NULL, store_mfreq);

 static struct freq_attr *msm_freq_attr[] = {
 	&cpufreq_freq_attr_scaling_available_freqs,
 	NULL,
 };

 static struct cpufreq_driver msm_cpufreq_driver = {
 	/* lps calculations are handled here. */
 	.flags		= CPUFREQ_STICKY | CPUFREQ_CONST_LOOPS,
 	.init		= msm_cpufreq_init,
 	.verify		= msm_cpufreq_verify,
 	.target		= msm_cpufreq_target,
 	.name		= "msm",
 	.attr		= msm_freq_attr,
 };

 static struct notifier_block msm_cpufreq_pm_notifier = {
 	.notifier_call = msm_cpufreq_pm_event,
 };

 static int __init msm_cpufreq_register(void)
 {
 	int cpu;

 	int err = sysfs_create_file(&cpu_sysdev_class.kset.kobj,
 			&attr_mfreq.attr);
 	if (err)
 		pr_err("Failed to create sysfs mfreq\n");

 	for_each_possible_cpu(cpu) {
 		mutex_init(&(per_cpu(cpufreq_suspend, cpu).suspend_mutex));
 		per_cpu(cpufreq_suspend, cpu).device_suspended = 0;
 	}

 #ifdef CONFIG_SMP
 	msm_cpufreq_wq = create_workqueue("msm-cpufreq");
 #endif

 	register_pm_notifier(&msm_cpufreq_pm_notifier);
 	return cpufreq_register_driver(&msm_cpufreq_driver);
 }

 late_initcall(msm_cpufreq_register);
	/* arch/arm/mach-msm/cpufreq.c
	*
	* MSM architecture cpufreq driver
	*
	* Copyright (C) 2007 Google, Inc.
	* Copyright (c) 2007-2012, Code Aurora Forum. All rights reserved.
	* Author: Mike A. Chan <mikechan@google.com>
	*
	* This software is licensed under the terms of the GNU General Public
	* License version 2, as published by the Free Software Foundation, and
	* may be copied, distributed, and modified under those terms.
	*
	* This program is distributed in the hope that it will be useful,
	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	* GNU General Public License for more details.
	*
	*/

	#include <linux/earlysuspend.h>
	#include <linux/init.h>
	#include <linux/cpufreq.h>
	#include <linux/workqueue.h>
	#include <linux/completion.h>
	#include <linux/cpu.h>
	#include <linux/cpumask.h>
	#include <linux/sched.h>
	#include <linux/suspend.h>
	#include <mach/socinfo.h>

	#include "acpuclock.h"

	#ifdef CONFIG_SMP
	struct cpufreq_work_struct {
	struct work_struct work;
	struct cpufreq_policy *policy;
	struct completion complete;
	int frequency;
	int status;
	};

	static DEFINE_PER_CPU(struct cpufreq_work_struct, cpufreq_work);
	static struct workqueue_struct *msm_cpufreq_wq;
	#endif

	struct cpufreq_suspend_t {
	struct mutex suspend_mutex;
	int device_suspended;
	};

	static DEFINE_PER_CPU(struct cpufreq_suspend_t, cpufreq_suspend);

	static int override_cpu;

	static int set_cpu_freq(struct cpufreq_policy *policy, unsigned int new_freq)
	{
	int ret = 0;
	struct cpufreq_freqs freqs;

	freqs.old = policy->cur;
	if (override_cpu) {
	if (policy->cur == policy->max)
	return 0;
	else
	freqs.new = policy->max;
	} else
	freqs.new = new_freq;
	freqs.cpu = policy->cpu;
	cpufreq_notify_transition(&freqs, CPUFREQ_PRECHANGE);
	ret = acpuclk_set_rate(policy->cpu, new_freq, SETRATE_CPUFREQ);
	if (!ret)
	cpufreq_notify_transition(&freqs, CPUFREQ_POSTCHANGE);

	return ret;
	}

	#ifdef CONFIG_SMP
	static void set_cpu_work(struct work_struct *work)
	{
	struct cpufreq_work_struct *cpu_work =
	container_of(work, struct cpufreq_work_struct, work);

	cpu_work->status = set_cpu_freq(cpu_work->policy, cpu_work->frequency);
	complete(&cpu_work->complete);
	}
	#endif

	static int msm_cpufreq_target(struct cpufreq_policy *policy,
	unsigned int target_freq,
	unsigned int relation)
	{
	int ret = -EFAULT;
	int index;
	struct cpufreq_frequency_table *table;
	#ifdef CONFIG_SMP
	struct cpufreq_work_struct *cpu_work = NULL;
	cpumask_var_t mask;

	if (!alloc_cpumask_var(&mask, GFP_KERNEL))
	return -ENOMEM;

	if (!cpu_active(policy->cpu)) {
	pr_info("cpufreq: cpu %d is not active.\n", policy->cpu);
	return -ENODEV;
	}
	#endif

	mutex_lock(&per_cpu(cpufreq_suspend, policy->cpu).suspend_mutex);

	if (per_cpu(cpufreq_suspend, policy->cpu).device_suspended) {
	pr_debug("cpufreq: cpu%d scheduling frequency change "
	"in suspend.\n", policy->cpu);
	ret = -EFAULT;
	goto done;
	}

	table = cpufreq_frequency_get_table(policy->cpu);
	if (cpufreq_frequency_table_target(policy, table, target_freq, relation,
	&index)) {
	pr_err("cpufreq: invalid target_freq: %d\n", target_freq);
	ret = -EINVAL;
	goto done;
	}

	#ifdef CONFIG_CPU_FREQ_DEBUG
	pr_debug("CPU[%d] target %d relation %d (%d-%d) selected %d\n",
	policy->cpu, target_freq, relation,
	policy->min, policy->max, table[index].frequency);
	#endif

	#ifdef CONFIG_SMP
	cpu_work = &per_cpu(cpufreq_work, policy->cpu);
	cpu_work->policy = policy;
	cpu_work->frequency = table[index].frequency;
	cpu_work->status = -ENODEV;

	cpumask_clear(mask);
	cpumask_set_cpu(policy->cpu, mask);
	if (cpumask_equal(mask, &current->cpus_allowed)) {
	ret = set_cpu_freq(cpu_work->policy, cpu_work->frequency);
	goto done;
	} else {
	cancel_work_sync(&cpu_work->work);
	INIT_COMPLETION(cpu_work->complete);
	queue_work_on(policy->cpu, msm_cpufreq_wq, &cpu_work->work);
	wait_for_completion(&cpu_work->complete);
	}

	free_cpumask_var(mask);
	ret = cpu_work->status;
	#else
	ret = set_cpu_freq(policy, table[index].frequency);
	#endif

	done:
	mutex_unlock(&per_cpu(cpufreq_suspend, policy->cpu).suspend_mutex);
	return ret;
	}

	static int msm_cpufreq_verify(struct cpufreq_policy *policy)
	{
	cpufreq_verify_within_limits(policy, policy->cpuinfo.min_freq,
	policy->cpuinfo.max_freq);
	return 0;
	}

	static int __cpuinit msm_cpufreq_init(struct cpufreq_policy *policy)
	{
	int cur_freq;
	int index;
	struct cpufreq_frequency_table *table;
	#ifdef CONFIG_SMP
	struct cpufreq_work_struct *cpu_work = NULL;
	#endif

	/*
	* In 8625 both cpu core's frequency can not
	* be changed independently. Each cpu is bound to
	* same frequency. Hence set the cpumask to all cpu.
	*/
	if (cpu_is_msm8625())
	cpumask_setall(policy->cpus);

	table = cpufreq_frequency_get_table(policy->cpu);
	if (table == NULL)
	return -ENODEV;
	if (cpufreq_frequency_table_cpuinfo(policy, table)) {
	#ifdef CONFIG_MSM_CPU_FREQ_SET_MIN_MAX
	policy->cpuinfo.min_freq = CONFIG_MSM_CPU_FREQ_MIN;
	policy->cpuinfo.max_freq = CONFIG_MSM_CPU_FREQ_MAX;
	#endif
	}
	#ifdef CONFIG_MSM_CPU_FREQ_SET_MIN_MAX
	policy->min = CONFIG_MSM_CPU_FREQ_MIN;
	policy->max = CONFIG_MSM_CPU_FREQ_MAX;
	#endif

	cur_freq = acpuclk_get_rate(policy->cpu);
	if (cpufreq_frequency_table_target(policy, table, cur_freq,
	CPUFREQ_RELATION_H, &index) &&
	cpufreq_frequency_table_target(policy, table, cur_freq,
	CPUFREQ_RELATION_L, &index)) {
	pr_info("cpufreq: cpu%d at invalid freq: %d\n",
	policy->cpu, cur_freq);
	return -EINVAL;
	}

	if (cur_freq != table[index].frequency) {
	int ret = 0;
	ret = acpuclk_set_rate(policy->cpu, table[index].frequency,
	SETRATE_CPUFREQ);
	if (ret)
	return ret;
	pr_info("cpufreq: cpu%d init at %d switching to %d\n",
	policy->cpu, cur_freq, table[index].frequency);
	cur_freq = table[index].frequency;
	}

	policy->cur = cur_freq;

	policy->cpuinfo.transition_latency =
	acpuclk_get_switch_time() * NSEC_PER_USEC;
	#ifdef CONFIG_SMP
	cpu_work = &per_cpu(cpufreq_work, policy->cpu);
	INIT_WORK(&cpu_work->work, set_cpu_work);
	init_completion(&cpu_work->complete);
	#endif

	return 0;
	}

	static int msm_cpufreq_suspend(void)
	{
	int cpu;

	for_each_possible_cpu(cpu) {
	mutex_lock(&per_cpu(cpufreq_suspend, cpu).suspend_mutex);
	per_cpu(cpufreq_suspend, cpu).device_suspended = 1;
	mutex_unlock(&per_cpu(cpufreq_suspend, cpu).suspend_mutex);
	}

	return NOTIFY_DONE;
	}

	static int msm_cpufreq_resume(void)
	{
	int cpu;

	for_each_possible_cpu(cpu) {
	per_cpu(cpufreq_suspend, cpu).device_suspended = 0;
	}

	return NOTIFY_DONE;
	}

	static int msm_cpufreq_pm_event(struct notifier_block *this,
	unsigned long event, void *ptr)
	{
	switch (event) {
	case PM_POST_HIBERNATION:
	case PM_POST_SUSPEND:
	return msm_cpufreq_resume();
	case PM_HIBERNATION_PREPARE:
	case PM_SUSPEND_PREPARE:
	return msm_cpufreq_suspend();
	default:
	return NOTIFY_DONE;
	}
	}

	static ssize_t store_mfreq(struct sysdev_class *class,
	struct sysdev_class_attribute *attr,
	const char *buf, size_t count)
	{
	u64 val;

	if (strict_strtoull(buf, 0, &val) < 0) {
	pr_err("Invalid parameter to mfreq\n");
	return 0;
	}
	if (val)
	override_cpu = 1;
	else
	override_cpu = 0;
	return count;
	}

	static SYSDEV_CLASS_ATTR(mfreq, 0200, NULL, store_mfreq);

	static struct freq_attr *msm_freq_attr[] = {
	&cpufreq_freq_attr_scaling_available_freqs,
	NULL,
	};

	static struct cpufreq_driver msm_cpufreq_driver = {
	/* lps calculations are handled here. */
	.flags = CPUFREQ_STICKY \| CPUFREQ_CONST_LOOPS,
	.init = msm_cpufreq_init,
	.verify = msm_cpufreq_verify,
	.target = msm_cpufreq_target,
	.name = "msm",
	.attr = msm_freq_attr,
	};

	static struct notifier_block msm_cpufreq_pm_notifier = {
	.notifier_call = msm_cpufreq_pm_event,
	};

	static int __init msm_cpufreq_register(void)
	{
	int cpu;

	int err = sysfs_create_file(&cpu_sysdev_class.kset.kobj,
	&attr_mfreq.attr);
	if (err)
	pr_err("Failed to create sysfs mfreq\n");

	for_each_possible_cpu(cpu) {
	mutex_init(&(per_cpu(cpufreq_suspend, cpu).suspend_mutex));
	per_cpu(cpufreq_suspend, cpu).device_suspended = 0;
	}

	#ifdef CONFIG_SMP
	msm_cpufreq_wq = create_workqueue("msm-cpufreq");
	#endif

	register_pm_notifier(&msm_cpufreq_pm_notifier);
	return cpufreq_register_driver(&msm_cpufreq_driver);
	}

	late_initcall(msm_cpufreq_register);