Merge branch 'cpufreq/arm/linux-next' of... (b53c7348) · Commits · e / devices / android_kernel_fairphone_FP5

MAINTAINERS

+7 −6

Original line number	Diff line number	Diff line
		@@ -1737,6 +1737,7 @@ F: arch/arm/configs/mvebu_*_defconfig
		F: arch/arm/mach-mvebu/
		F: arch/arm64/boot/dts/marvell/armada*
		F: drivers/cpufreq/armada-37xx-cpufreq.c
		F: drivers/cpufreq/armada-8k-cpufreq.c
		F: drivers/cpufreq/mvebu-cpufreq.c
		F: drivers/irqchip/irq-armada-370-xp.c
		F: drivers/irqchip/irq-mvebu-*
		@@ -3957,7 +3958,7 @@ M: Viresh Kumar <viresh.kumar@linaro.org>
		L: linux-pm@vger.kernel.org
		S: Maintained
		T: git git://git.kernel.org/pub/scm/linux/kernel/git/rafael/linux-pm.git
		T: git git://git.linaro.org/people/vireshk/linux.git (For ARM Updates)
		T: git git://git.kernel.org/pub/scm/linux/kernel/git/vireshk/pm.git (For ARM Updates)
		B: https://bugzilla.kernel.org
		F: Documentation/admin-guide/pm/cpufreq.rst
		F: Documentation/admin-guide/pm/intel_pstate.rst
		@@ -12596,7 +12597,7 @@ F: Documentation/media/v4l-drivers/qcom_camss.rst
		F: drivers/media/platform/qcom/camss/

		QUALCOMM CPUFREQ DRIVER MSM8996/APQ8096
		M: Ilia Lin <ilia.lin@gmail.com>
		M: Ilia Lin <ilia.lin@kernel.org>
		L: linux-pm@vger.kernel.org
		S: Maintained
		F: Documentation/devicetree/bindings/opp/kryo-cpufreq.txt

drivers/cpufreq/Kconfig.arm

+11 −0

Original line number	Diff line number	Diff line
		@@ -25,6 +25,17 @@ config ARM_ARMADA_37XX_CPUFREQ
		This adds the CPUFreq driver support for Marvell Armada 37xx SoCs.
		The Armada 37xx PMU supports 4 frequency and VDD levels.

		config ARM_ARMADA_8K_CPUFREQ
		tristate "Armada 8K CPUFreq driver"
		depends on ARCH_MVEBU && CPUFREQ_DT
		help
		This enables the CPUFreq driver support for Marvell
		Armada8k SOCs.
		Armada8K device has the AP806 which supports scaling
		to any full integer divider.

		If in doubt, say N.

		# big LITTLE core layer and glue drivers
		config ARM_BIG_LITTLE_CPUFREQ
		tristate "Generic ARM big LITTLE CPUfreq driver"

drivers/cpufreq/Makefile

+1 −0

Original line number	Diff line number	Diff line
		@@ -50,6 +50,7 @@ obj-$(CONFIG_X86_SFI_CPUFREQ) += sfi-cpufreq.o
		obj-$(CONFIG_ARM_BIG_LITTLE_CPUFREQ) += arm_big_little.o

		obj-$(CONFIG_ARM_ARMADA_37XX_CPUFREQ) += armada-37xx-cpufreq.o
		obj-$(CONFIG_ARM_ARMADA_8K_CPUFREQ) += armada-8k-cpufreq.o
		obj-$(CONFIG_ARM_BRCMSTB_AVS_CPUFREQ) += brcmstb-avs-cpufreq.o
		obj-$(CONFIG_ACPI_CPPC_CPUFREQ) += cppc_cpufreq.o
		obj-$(CONFIG_ARCH_DAVINCI) += davinci-cpufreq.o

drivers/cpufreq/armada-8k-cpufreq.c

0 → 100644

+204 −0

Original line number	Diff line number	Diff line
		// SPDX-License-Identifier: GPL-2.0+
		/*
		* CPUFreq support for Armada 8K
		*
		* Copyright (C) 2018 Marvell
		*
		* Omri Itach <omrii@marvell.com>
		* Gregory Clement <gregory.clement@bootlin.com>
		*/

		#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

		#include <linux/clk.h>
		#include <linux/cpu.h>
		#include <linux/err.h>
		#include <linux/init.h>
		#include <linux/kernel.h>
		#include <linux/module.h>
		#include <linux/of.h>
		#include <linux/platform_device.h>
		#include <linux/pm_opp.h>
		#include <linux/slab.h>

		/*
		* Setup the opps list with the divider for the max frequency, that
		* will be filled at runtime.
		*/
		static const int opps_div[] __initconst = {1, 2, 3, 4};

		static struct platform_device *armada_8k_pdev;

		struct freq_table {
		struct device *cpu_dev;
		unsigned int freq[ARRAY_SIZE(opps_div)];
		};

		/* If the CPUs share the same clock, then they are in the same cluster. */
		static void __init armada_8k_get_sharing_cpus(struct clk *cur_clk,
		struct cpumask *cpumask)
		{
		int cpu;

		for_each_possible_cpu(cpu) {
		struct device *cpu_dev;
		struct clk *clk;

		cpu_dev = get_cpu_device(cpu);
		if (!cpu_dev) {
		pr_warn("Failed to get cpu%d device\n", cpu);
		continue;
		}

		clk = clk_get(cpu_dev, 0);
		if (IS_ERR(clk)) {
		pr_warn("Cannot get clock for CPU %d\n", cpu);
		} else {
		if (clk_is_match(clk, cur_clk))
		cpumask_set_cpu(cpu, cpumask);

		clk_put(clk);
		}
		}
		}

		static int __init armada_8k_add_opp(struct clk clk, struct device cpu_dev,
		struct freq_table *freq_tables,
		int opps_index)
		{
		unsigned int cur_frequency;
		unsigned int freq;
		int i, ret;

		/* Get nominal (current) CPU frequency. */
		cur_frequency = clk_get_rate(clk);
		if (!cur_frequency) {
		dev_err(cpu_dev, "Failed to get clock rate for this CPU\n");
		return -EINVAL;
		}

		freq_tables[opps_index].cpu_dev = cpu_dev;

		for (i = 0; i < ARRAY_SIZE(opps_div); i++) {
		freq = cur_frequency / opps_div[i];

		ret = dev_pm_opp_add(cpu_dev, freq, 0);
		if (ret)
		return ret;

		freq_tables[opps_index].freq[i] = freq;
		}

		return 0;
		}

		static void armada_8k_cpufreq_free_table(struct freq_table *freq_tables)
		{
		int opps_index, nb_cpus = num_possible_cpus();

		for (opps_index = 0 ; opps_index <= nb_cpus; opps_index++) {
		int i;

		/* If cpu_dev is NULL then we reached the end of the array */
		if (!freq_tables[opps_index].cpu_dev)
		break;

		for (i = 0; i < ARRAY_SIZE(opps_div); i++) {
		/*
		* A 0Hz frequency is not valid, this meant
		* that it was not yet initialized so there is
		* no more opp to free
		*/
		if (freq_tables[opps_index].freq[i] == 0)
		break;

		dev_pm_opp_remove(freq_tables[opps_index].cpu_dev,
		freq_tables[opps_index].freq[i]);
		}
		}

		kfree(freq_tables);
		}

		static int __init armada_8k_cpufreq_init(void)
		{
		int ret = 0, opps_index = 0, cpu, nb_cpus;
		struct freq_table *freq_tables;
		struct device_node *node;
		struct cpumask cpus;

		node = of_find_compatible_node(NULL, NULL, "marvell,ap806-cpu-clock");
		if (!node \|\| !of_device_is_available(node))
		return -ENODEV;

		nb_cpus = num_possible_cpus();
		freq_tables = kcalloc(nb_cpus, sizeof(*freq_tables), GFP_KERNEL);
		cpumask_copy(&cpus, cpu_possible_mask);

		/*
		* For each CPU, this loop registers the operating points
		* supported (which are the nominal CPU frequency and full integer
		* divisions of it).
		*/
		for_each_cpu(cpu, &cpus) {
		struct cpumask shared_cpus;
		struct device *cpu_dev;
		struct clk *clk;

		cpu_dev = get_cpu_device(cpu);

		if (!cpu_dev) {
		pr_err("Cannot get CPU %d\n", cpu);
		continue;
		}

		clk = clk_get(cpu_dev, 0);

		if (IS_ERR(clk)) {
		pr_err("Cannot get clock for CPU %d\n", cpu);
		ret = PTR_ERR(clk);
		goto remove_opp;
		}

		ret = armada_8k_add_opp(clk, cpu_dev, freq_tables, opps_index);
		if (ret) {
		clk_put(clk);
		goto remove_opp;
		}

		opps_index++;
		cpumask_clear(&shared_cpus);
		armada_8k_get_sharing_cpus(clk, &shared_cpus);
		dev_pm_opp_set_sharing_cpus(cpu_dev, &shared_cpus);
		cpumask_andnot(&cpus, &cpus, &shared_cpus);
		clk_put(clk);
		}

		armada_8k_pdev = platform_device_register_simple("cpufreq-dt", -1,
		NULL, 0);
		ret = PTR_ERR_OR_ZERO(armada_8k_pdev);
		if (ret)
		goto remove_opp;

		platform_set_drvdata(armada_8k_pdev, freq_tables);

		return 0;

		remove_opp:
		armada_8k_cpufreq_free_table(freq_tables);
		return ret;
		}
		module_init(armada_8k_cpufreq_init);

		static void __exit armada_8k_cpufreq_exit(void)
		{
		struct freq_table *freq_tables = platform_get_drvdata(armada_8k_pdev);

		platform_device_unregister(armada_8k_pdev);
		armada_8k_cpufreq_free_table(freq_tables);
		}
		module_exit(armada_8k_cpufreq_exit);

		MODULE_AUTHOR("Gregory Clement <gregory.clement@bootlin.com>");
		MODULE_DESCRIPTION("Armada 8K cpufreq driver");
		MODULE_LICENSE("GPL");

drivers/cpufreq/qcom-cpufreq-hw.c

+40 −10

Original line number	Diff line number	Diff line
		@@ -10,18 +10,21 @@
		#include <linux/module.h>
		#include <linux/of_address.h>
		#include <linux/of_platform.h>
		#include <linux/pm_opp.h>
		#include <linux/slab.h>

		#define LUT_MAX_ENTRIES 40U
		#define LUT_SRC GENMASK(31, 30)
		#define LUT_L_VAL GENMASK(7, 0)
		#define LUT_CORE_COUNT GENMASK(18, 16)
		#define LUT_VOLT GENMASK(11, 0)
		#define LUT_ROW_SIZE 32
		#define CLK_HW_DIV 2

		/* Register offsets */
		#define REG_ENABLE 0x0
		#define REG_LUT_TABLE 0x110
		#define REG_FREQ_LUT 0x110
		#define REG_VOLT_LUT 0x114
		#define REG_PERF_STATE 0x920

		static unsigned long cpu_hw_rate, xo_rate;
		@@ -70,11 +73,12 @@ static unsigned int qcom_cpufreq_hw_fast_switch(struct cpufreq_policy *policy,
		return policy->freq_table[index].frequency;
		}

		static int qcom_cpufreq_hw_read_lut(struct device *dev,
		static int qcom_cpufreq_hw_read_lut(struct device *cpu_dev,
		struct cpufreq_policy *policy,
		void __iomem *base)
		{
		u32 data, src, lval, i, core_count, prev_cc = 0, prev_freq = 0, freq;
		u32 volt;
		unsigned int max_cores = cpumask_weight(policy->cpus);
		struct cpufreq_frequency_table *table;

		@@ -83,23 +87,28 @@ static int qcom_cpufreq_hw_read_lut(struct device *dev,
		return -ENOMEM;

		for (i = 0; i < LUT_MAX_ENTRIES; i++) {
		data = readl_relaxed(base + REG_LUT_TABLE + i * LUT_ROW_SIZE);
		data = readl_relaxed(base + REG_FREQ_LUT +
		i * LUT_ROW_SIZE);
		src = FIELD_GET(LUT_SRC, data);
		lval = FIELD_GET(LUT_L_VAL, data);
		core_count = FIELD_GET(LUT_CORE_COUNT, data);

		data = readl_relaxed(base + REG_VOLT_LUT +
		i * LUT_ROW_SIZE);
		volt = FIELD_GET(LUT_VOLT, data) * 1000;

		if (src)
		freq = xo_rate * lval / 1000;
		else
		freq = cpu_hw_rate / 1000;

		/* Ignore boosts in the middle of the table */
		if (core_count != max_cores) {
		table[i].frequency = CPUFREQ_ENTRY_INVALID;
		} else {
		if (freq != prev_freq && core_count == max_cores) {
		table[i].frequency = freq;
		dev_dbg(dev, "index=%d freq=%d, core_count %d\n", i,
		dev_pm_opp_add(cpu_dev, freq * 1000, volt);
		dev_dbg(cpu_dev, "index=%d freq=%d, core_count %d\n", i,
		freq, core_count);
		} else {
		table[i].frequency = CPUFREQ_ENTRY_INVALID;
		}

		/*
		@@ -116,6 +125,7 @@ static int qcom_cpufreq_hw_read_lut(struct device *dev,
		if (prev_cc != max_cores) {
		prev->frequency = prev_freq;
		prev->flags = CPUFREQ_BOOST_FREQ;
		dev_pm_opp_add(cpu_dev, prev_freq * 1000, volt);
		}

		break;
		@@ -127,6 +137,7 @@ static int qcom_cpufreq_hw_read_lut(struct device *dev,

		table[i].frequency = CPUFREQ_TABLE_END;
		policy->freq_table = table;
		dev_pm_opp_set_sharing_cpus(cpu_dev, policy->cpus);

		return 0;
		}
		@@ -159,10 +170,18 @@ static int qcom_cpufreq_hw_cpu_init(struct cpufreq_policy *policy)
		struct device *dev = &global_pdev->dev;
		struct of_phandle_args args;
		struct device_node *cpu_np;
		struct device *cpu_dev;
		struct resource *res;
		void __iomem *base;
		int ret, index;

		cpu_dev = get_cpu_device(policy->cpu);
		if (!cpu_dev) {
		pr_err("%s: failed to get cpu%d device\n", __func__,
		policy->cpu);
		return -ENODEV;
		}

		cpu_np = of_cpu_device_node_get(policy->cpu);
		if (!cpu_np)
		return -EINVAL;
		@@ -199,12 +218,21 @@ static int qcom_cpufreq_hw_cpu_init(struct cpufreq_policy *policy)

		policy->driver_data = base + REG_PERF_STATE;

		ret = qcom_cpufreq_hw_read_lut(dev, policy, base);
		ret = qcom_cpufreq_hw_read_lut(cpu_dev, policy, base);
		if (ret) {
		dev_err(dev, "Domain-%d failed to read LUT\n", index);
		goto error;
		}

		ret = dev_pm_opp_get_opp_count(cpu_dev);
		if (ret <= 0) {
		dev_err(cpu_dev, "Failed to add OPPs\n");
		ret = -ENODEV;
		goto error;
		}

		dev_pm_opp_of_register_em(policy->cpus);

		policy->fast_switch_possible = true;

		return 0;
		@@ -215,8 +243,10 @@ static int qcom_cpufreq_hw_cpu_init(struct cpufreq_policy *policy)

		static int qcom_cpufreq_hw_cpu_exit(struct cpufreq_policy *policy)
		{
		struct device *cpu_dev = get_cpu_device(policy->cpu);
		void __iomem *base = policy->driver_data - REG_PERF_STATE;

		dev_pm_opp_remove_all_dynamic(cpu_dev);
		kfree(policy->freq_table);
		devm_iounmap(&global_pdev->dev, base);

		@@ -297,7 +327,7 @@ static int __init qcom_cpufreq_hw_init(void)
		{
		return platform_driver_register(&qcom_cpufreq_hw_driver);
		}
		subsys_initcall(qcom_cpufreq_hw_init);
		device_initcall(qcom_cpufreq_hw_init);

		static void __exit qcom_cpufreq_hw_exit(void)
		{