rk30:sdk: store clock request frequency and auto scale frequency when limit clock...

[firefly-linux-kernel-4.4.55.git] / arch / arm / mach-rk30 / dvfs.c

diff --git a/arch/arm/mach-rk30/dvfs.c b/arch/arm/mach-rk30/dvfs.c
index fe6cf1e225f03ed4496283b559a8b1da4ee7b85c..ba21ee29a758e453ed0ab0d6d36039dbd4bd9ac8 100644 (file)
--- a/arch/arm/mach-rk30/dvfs.c
+++ b/arch/arm/mach-rk30/dvfs.c
@@ -102,25 +102,52 @@ struct regulator* dvfs_get_regulator(char *regulator_name)
        return NULL;\r
 }\r
 \r
-int dvfs_clk_enable_limit(struct clk *clk, unsigned int min_rate, unsigned max_rate)\r
+int dvfs_clk_enable_limit(struct clk *clk, unsigned int min_rate, unsigned int max_rate)\r
 {\r
        struct clk_node* dvfs_clk;\r
+       if (!clk->dvfs_info) {\r
+               DVFS_ERR("%s bad dvfs clock\n", __func__);\r
+               return -1;\r
+       }\r
        dvfs_clk = clk->dvfs_info;\r
 \r
        dvfs_clk->freq_limit_en = 1;\r
        dvfs_clk->min_rate = min_rate;\r
        dvfs_clk->max_rate = max_rate;\r
        \r
+       if (!dvfs_clk->enable_dvfs) {\r
+               DVFS_ERR("%s dvfs not enable yet\n", __func__);\r
+               return -1;\r
+       }\r
+\r
+       if (dvfs_clk->req_freq != 0)\r
+               dvfs_set_rate(clk, dvfs_clk->req_freq);\r
+       else\r
+               dvfs_set_rate(clk, dvfs_clk->set_freq);\r
        return 0;\r
 }\r
 \r
 int dvfs_clk_disable_limit(struct clk *clk)\r
 {\r
        struct clk_node* dvfs_clk;\r
+       if (!clk->dvfs_info) {\r
+               DVFS_ERR("%s bad dvfs clock\n", __func__);\r
+               return -1;\r
+       }\r
        dvfs_clk = clk->dvfs_info;\r
        \r
        dvfs_clk->freq_limit_en = 0;\r
        \r
+       if (!dvfs_clk->enable_dvfs) {\r
+               DVFS_ERR("%s dvfs not enable yet\n", __func__);\r
+               return -1;\r
+       }\r
+       \r
+       if (dvfs_clk->req_freq != 0)\r
+               dvfs_set_rate(clk, dvfs_clk->req_freq);\r
+       else\r
+               dvfs_set_rate(clk, dvfs_clk->set_freq);\r
+       \r
        return 0;\r
 }\r
 \r
@@ -543,6 +570,7 @@ static int rk_regist_clk(struct clk_node *dvfs_clk)
                return -1;\r
        mutex_lock(&mutex);\r
        dvfs_clk->enable_dvfs = 0;\r
+       dvfs_clk->req_freq = 0;\r
        dvfs_clk->vd = dvfs_clk->pds[0].pd->vd;\r
        for (i = 0; dvfs_clk->pds[i].pd != NULL; i++) {\r
                child = &(dvfs_clk->pds[i].clk_list);\r
@@ -728,6 +756,7 @@ int dvfs_target_core(struct clk *clk, unsigned long rate_hz)
                return -1;\r
        }\r
        \r
+       dvfs_clk->req_freq = rate_hz;\r
        /* Check limit rate */\r
        if (dvfs_clk->freq_limit_en) {\r
                if (rate_hz < dvfs_clk->min_rate) {\r
@@ -874,6 +903,7 @@ int dvfs_target_cpu(struct clk *clk, unsigned long rate_hz)
                return -1;\r
        }\r
 \r
+       dvfs_clk->req_freq = rate_hz;\r
        /* Check limit rate */\r
        if (dvfs_clk->freq_limit_en) {\r
                if (rate_hz < dvfs_clk->min_rate) {\r