clk: scpi: add support for cpufreq virtual device

The clocks for the CPUs are provided by SCP and are managed by this
clock driver. So the cpufreq device needs to be added only after the
clock get registered and removed when this driver is unloaded.

This patch manages the cpufreq virtual device based on the clock
availability.

Signed-off-by: Sudeep Holla <sudeep.holla@arm.com>
Acked-by: Stephen Boyd <sboyd@codeaurora.org>
Cc: Mike Turquette <mturquette@baylibre.com>
Cc: Liviu Dudau <Liviu.Dudau@arm.com>
Cc: Lorenzo Pieralisi <lorenzo.pieralisi@arm.com>
Cc: Jon Medhurst (Tixy) <tixy@linaro.org>
Cc: linux-clk@vger.kernel.org

1 files changed, 13 insertions, 0 deletions

diff --git a/drivers/clk/clk-scpi.c b/drivers/clk/clk-scpi.c
index 72f0486b5de6..0b501a9fef92 100644
--- a/drivers/clk/clk-scpi.c
+++ b/drivers/clk/clk-scpi.c
@@ -34,6 +34,8 @@ struct scpi_clk {
 
 #define to_scpi_clk(clk) container_of(clk, struct scpi_clk, hw)
 
+static struct platform_device *cpufreq_dev;
+
 static unsigned long scpi_clk_recalc_rate(struct clk_hw *hw,
                                           unsigned long parent_rate)
 {
@@ -263,6 +265,11 @@ static int scpi_clocks_remove(struct platform_device *pdev)
         struct device *dev = &pdev->dev;
         struct device_node *child, *np = dev->of_node;
 
+        if (cpufreq_dev) {
+                platform_device_unregister(cpufreq_dev);
+                cpufreq_dev = NULL;
+        }
+
         for_each_available_child_of_node(np, child)
                 of_clk_del_provider(np);
         return 0;
@@ -288,6 +295,12 @@ static int scpi_clocks_probe(struct platform_device *pdev)
                         return ret;
                 }
         }
+        /* Add the virtual cpufreq device */
+        cpufreq_dev = platform_device_register_simple("scpi-cpufreq",
+                                                      -1, NULL, 0);
+        if (!cpufreq_dev)
+                pr_warn("unable to register cpufreq device");
+
         return 0;
 }