samsung update 1

1 files changed, 199 insertions, 0 deletions

diff --git a/arch/arm/mach-exynos/dynamic-nr_running-hotplug.c b/arch/arm/mach-exynos/dynamic-nr_running-hotplug.c
new file mode 100644
index 0000000..233a104
--- /dev/null
+++ b/arch/arm/mach-exynos/dynamic-nr_running-hotplug.c
@@ -0,0 +1,199 @@
+/* linux/arch/arm/mach-exynos/dynamic-nr_running-hotplug.c
+ *
+ * Copyright (c) 2011 Samsung Electronics Co., Ltd.
+ *		http://www.samsung.com/
+ *
+ * EXYNOS - nr_running based dynamic CPU hotplug
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+*/
+
+#include <linux/sched.h>
+#include <linux/cpufreq.h>
+#include <linux/cpu.h>
+#include <linux/err.h>
+#include <linux/notifier.h>
+#include <linux/reboot.h>
+#include <linux/suspend.h>
+#include <plat/cpu.h>
+
+static unsigned int total_num_target_freq;
+static unsigned int ctn_highestlevel_cnt;		/* continuous the highest level count */
+static unsigned int ctn_lowestlevel_cnt;
+static unsigned int ctn_nr_running_over2;
+static unsigned int ctn_nr_running_over3;
+static unsigned int ctn_nr_running_over4;
+static unsigned int ctn_nr_running_under2;
+static unsigned int ctn_nr_running_under3;
+static unsigned int ctn_nr_running_under4;
+static unsigned int freq_max;
+static unsigned int freq_in_trg;
+static unsigned int freq_min;
+static unsigned int can_hotplug;
+
+static void exynos4_integrated_dvfs_hotplug(unsigned int freq_old,
+					unsigned int freq_new)
+{
+	total_num_target_freq++;
+	freq_in_trg = 800000;
+
+	if (nr_running() <= 1) {
+		ctn_nr_running_over2 = 0;
+		ctn_nr_running_over3 = 0;
+		ctn_nr_running_over4 = 0;
+		ctn_nr_running_under2++;
+		ctn_nr_running_under3++;
+		ctn_nr_running_under4++;
+	} else if ((nr_running() > 1) && (nr_running() <= 2)) {
+		ctn_nr_running_over2++;
+		ctn_nr_running_over3 = 0;
+		ctn_nr_running_over4 = 0;
+		ctn_nr_running_under2 = 0;
+		ctn_nr_running_under3++;
+		ctn_nr_running_under4++;
+	} else if ((nr_running() > 2) && (nr_running() <= 3)) {
+		ctn_nr_running_over2++;
+		ctn_nr_running_over3++;
+		ctn_nr_running_over4 = 0;
+		ctn_nr_running_under2 = 0;
+		ctn_nr_running_under3 = 0;
+		ctn_nr_running_under4++;
+	} else if (nr_running() > 3) {
+		ctn_nr_running_over2++;
+		ctn_nr_running_over3++;
+		ctn_nr_running_over4++;
+		ctn_nr_running_under2 = 0;
+		ctn_nr_running_under3 = 0;
+		ctn_nr_running_under4 = 0;
+	}
+
+	if (soc_is_exynos4412()) {
+		if ((cpu_online(3) == 0) && (nr_running() >= 2)) {
+			if (ctn_nr_running_over2 >= 4) {		/* over 400ms, tunnable */
+				cpu_up(3);
+			}
+		} else if ((cpu_online(2) == 0) && (nr_running() >= 3)) {
+			if (ctn_nr_running_over3 >= 4) {		/* over 400ms, tunnable */
+				cpu_up(2);
+			}
+		} else if ((cpu_online(1) == 0) && (nr_running() >= 4)) {
+			if (ctn_nr_running_over4 >= 8) {		/* over 800ms, tunnable */
+				cpu_up(1);
+			}
+		}
+	} else {
+		if (cpu_online(1) == 0) {
+			if (ctn_nr_running_over2 >= 8) {		/* over 800ms, tunnable */
+				cpu_up(1);
+				ctn_nr_running_over2 = 0;
+			}
+		}
+	} /* end of else */
+	if (soc_is_exynos4412()) {
+		if ((cpu_online(1) == 1) && (nr_running() < 4)) {
+			if (ctn_nr_running_under4 >= 8) {		/* over 800ms, tunnable */
+				cpu_down(1);
+			}
+		} else if ((cpu_online(2) == 1) && (nr_running() < 3)) {
+			if (ctn_nr_running_under3 >= 8) {		/* over 800ms, tunnable */
+				cpu_down(2);
+			}
+		} else if ((cpu_online(3) == 1) && (nr_running() < 2)) {
+			if (ctn_nr_running_under2 >= 8) {		/* over 800ms, tunnable */
+				cpu_down(3);
+			}
+		}
+	} else {
+		if (cpu_online(1) == 1) {
+			if (ctn_nr_running_under2 >= 8) {		/* over 800ms, tunnable */
+				cpu_down(1);
+				ctn_nr_running_under2 = 0;
+			}
+		}
+	} /* end of else */
+}
+
+static int hotplug_cpufreq_transition(struct notifier_block *nb,
+					unsigned long val, void *data)
+{
+	struct cpufreq_freqs *freqs = (struct cpufreq_freqs *)data;
+
+	if ((val == CPUFREQ_POSTCHANGE) && can_hotplug)
+		exynos4_integrated_dvfs_hotplug(freqs->old, freqs->new);
+
+	return 0;
+}
+
+static struct notifier_block dvfs_hotplug = {
+	.notifier_call = hotplug_cpufreq_transition,
+};
+
+static int hotplug_pm_transition(struct notifier_block *nb,
+					unsigned long val, void *data)
+{
+	switch (val) {
+	case PM_SUSPEND_PREPARE:
+		can_hotplug = 0;
+		ctn_highestlevel_cnt = 0;
+		ctn_lowestlevel_cnt = 0;
+		break;
+	case PM_POST_RESTORE:
+	case PM_POST_SUSPEND:
+		can_hotplug = 1;
+		break;
+	}
+
+	return 0;
+}
+
+static struct notifier_block pm_hotplug = {
+	.notifier_call = hotplug_pm_transition,
+};
+
+/*
+ * Note : This function should be called after intialization of CPUFreq
+ * driver for exynos4. The cpufreq_frequency_table for exynos4 should be
+ * established before calling this function.
+ */
+static int __init exynos4_integrated_dvfs_hotplug_init(void)
+{
+	int i;
+	struct cpufreq_frequency_table *table;
+	unsigned int freq;
+
+	total_num_target_freq = 0;
+	ctn_highestlevel_cnt = 0;
+	ctn_lowestlevel_cnt = 0;
+	ctn_nr_running_over2 = 0;
+	ctn_nr_running_over3 = 0;
+	ctn_nr_running_over4 = 0;
+	ctn_nr_running_under2 = 0;
+	ctn_nr_running_under3 = 0;
+	ctn_nr_running_under4 = 0;
+
+	can_hotplug = 1;
+
+	table = cpufreq_frequency_get_table(0);
+	if (IS_ERR(table)) {
+		printk(KERN_ERR "%s: Check loading cpufreq before\n", __func__);
+		return PTR_ERR(table);
+	}
+
+	for (i = 0; table[i].frequency != CPUFREQ_TABLE_END; i++) {
+		freq = table[i].frequency;
+
+		if (freq != CPUFREQ_ENTRY_INVALID && freq > freq_max)
+			freq_max = freq;
+		else if (freq != CPUFREQ_ENTRY_INVALID && freq_min > freq)
+			freq_min = freq;
+	}
+
+	register_pm_notifier(&pm_hotplug);
+
+	return cpufreq_register_notifier(&dvfs_hotplug,
+					 CPUFREQ_TRANSITION_NOTIFIER);
+}
+
+late_initcall(exynos4_integrated_dvfs_hotplug_init);