cpufreq: tegra186/tegra194: Handle errors in BPMP response

The return value from tegra_bpmp_transfer indicates the success or
failure of the IPC transaction with BPMP. If the transaction
succeeded, we also need to check the actual command's result code.
Add code to do this.

While at it, explicitly handle missing CPU clusters, which can
occur on floorswept chips. This worked before as well, but
possibly only by accident.

Signed-off-by: Mikko Perttunen <mperttunen@nvidia.com>
Signed-off-by: Viresh Kumar <viresh.kumar@linaro.org>

diff --git a/drivers/cpufreq/tegra186-cpufreq.c b/drivers/cpufreq/tegra186-cpufreq.c
index 5d1943e787b0c14c9094b1fd6cd9806b7f53c359..6c88827f4e6254568eee2b37cc006973d7986f1e 100644 (file)
--- a/drivers/cpufreq/tegra186-cpufreq.c
+++ b/drivers/cpufreq/tegra186-cpufreq.c
@@ -159,6 +159,10 @@ static struct cpufreq_frequency_table *init_vhint_table(
                table = ERR_PTR(err);
                goto free;
        }
+       if (msg.rx.ret) {
+               table = ERR_PTR(-EINVAL);
+               goto free;
+       }
 
        for (i = data->vfloor; i <= data->vceil; i++) {
                u16 ndiv = data->ndiv[i];

diff --git a/drivers/cpufreq/tegra194-cpufreq.c b/drivers/cpufreq/tegra194-cpufreq.c
index a9620e4489aea6e3ece397277d0abd7f74eb4527..ac381db25dbe2a1e64106ecd0fd20a67c18f9581 100644 (file)
--- a/drivers/cpufreq/tegra194-cpufreq.c
+++ b/drivers/cpufreq/tegra194-cpufreq.c
@@ -242,7 +242,7 @@ static int tegra194_cpufreq_init(struct cpufreq_policy *policy)
 
        smp_call_function_single(policy->cpu, get_cpu_cluster, &cl, true);
 
-       if (cl >= data->num_clusters)
+       if (cl >= data->num_clusters || !data->tables[cl])
                return -EINVAL;
 
        /* set same policy for all cpus in a cluster */
@@ -310,6 +310,12 @@ init_freq_table(struct platform_device *pdev, struct tegra_bpmp *bpmp,
        err = tegra_bpmp_transfer(bpmp, &msg);
        if (err)
                return ERR_PTR(err);
+       if (msg.rx.ret == -BPMP_EINVAL) {
+               /* Cluster not available */
+               return NULL;
+       }
+       if (msg.rx.ret)
+               return ERR_PTR(-EINVAL);
 
        /*
         * Make sure frequency table step is a multiple of mdiv to match