Register the qoriq cpufreq driver as a cooling device, based on the
thermal device tree framework. When temperature crosses the passive trip
point cpufreq is used to throttle CPUs.

Signed-off-by: Jia Hongtao <hongtao....@freescale.com>
Reviewed-by: Scott Wood <scottw...@freescale.com>
---
This patch depends on following patches from Scott Wood:
http://patchwork.ozlabs.org/patch/519803/
http://patchwork.ozlabs.org/patch/519804/

 drivers/cpufreq/qoriq-cpufreq.c | 24 +++++++++++++++++++++++-
 1 file changed, 23 insertions(+), 1 deletion(-)

diff --git a/drivers/cpufreq/qoriq-cpufreq.c b/drivers/cpufreq/qoriq-cpufreq.c
index 4f53fa2..cb1bc3c 100644
--- a/drivers/cpufreq/qoriq-cpufreq.c
+++ b/drivers/cpufreq/qoriq-cpufreq.c
@@ -12,6 +12,7 @@
 
 #include <linux/clk.h>
 #include <linux/cpufreq.h>
+#include <linux/cpu_cooling.h>
 #include <linux/errno.h>
 #include <linux/init.h>
 #include <linux/kernel.h>
@@ -33,6 +34,7 @@
 struct cpu_data {
        struct clk **pclk;
        struct cpufreq_frequency_table *table;
+       struct thermal_cooling_device *cdev;
 };
 
 /*
@@ -292,7 +294,11 @@ static const struct of_device_id node_matches[] 
__initconst = {
 static int __init qoriq_cpufreq_init(void)
 {
        int ret;
-       struct device_node  *np;
+       struct device_node *np;
+       struct device_node *cpu_np;
+       unsigned int cpu_id;
+       struct cpufreq_policy cpu_policy;
+       struct cpu_data *cpud;
        const struct of_device_id *match;
        const struct soc_data *data;
 
@@ -309,6 +315,22 @@ static int __init qoriq_cpufreq_init(void)
                return -ENODEV;
 
        ret = cpufreq_register_driver(&qoriq_cpufreq_driver);
+
+       /* Register CPU cooling device for QorIQ platform */
+       for_each_node_with_property(cpu_np, "#cooling-cells") {
+               of_property_read_u32(cpu_np, "reg", &cpu_id);
+               cpufreq_get_policy(&cpu_policy, cpu_id);
+
+               cpud = cpu_policy.driver_data;
+               cpud->cdev = of_cpufreq_cooling_register(cpu_np,
+                                               cpu_policy.related_cpus);
+               if (IS_ERR(cpud->cdev) && ERR_PTR(cpud->cdev) != -ENOSYS)
+                       pr_err("Failed to register cooling device cpu%d: %ld\n",
+                              cpu_id, PTR_ERR(cpud->cdev));
+       }
+
+       of_node_put(cpu_np);
+
        if (!ret)
                pr_info("Freescale QorIQ CPU frequency scaling driver\n");
 
-- 
2.1.0.27.g96db324

_______________________________________________
Linuxppc-dev mailing list
Linuxppc-dev@lists.ozlabs.org
https://lists.ozlabs.org/listinfo/linuxppc-dev

Reply via email to