There is no need to reinvent the wheel for simple read-match-set logic.

Make speedbin discovery and assignment generation independent.

This implicitly removes the bogus 0x80 / BIT(7) speed bin on A5xx,
which has no representation in hardware whatshowever.

Signed-off-by: Konrad Dybcio <konrad.dyb...@linaro.org>
---
 drivers/gpu/drm/msm/adreno/a5xx_gpu.c   | 34 ----------------
 drivers/gpu/drm/msm/adreno/a6xx_gpu.c   | 56 --------------------------
 drivers/gpu/drm/msm/adreno/adreno_gpu.c | 70 +++++++++++++++++++++++++++------
 drivers/gpu/drm/msm/adreno/adreno_gpu.h |  3 --
 drivers/gpu/drm/msm/msm_gpu.c           |  3 --
 5 files changed, 57 insertions(+), 109 deletions(-)

diff --git a/drivers/gpu/drm/msm/adreno/a5xx_gpu.c 
b/drivers/gpu/drm/msm/adreno/a5xx_gpu.c
index c003f970189b..eed6a2eb1731 100644
--- a/drivers/gpu/drm/msm/adreno/a5xx_gpu.c
+++ b/drivers/gpu/drm/msm/adreno/a5xx_gpu.c
@@ -1704,38 +1704,6 @@ static const struct adreno_gpu_funcs funcs = {
        .get_timestamp = a5xx_get_timestamp,
 };
 
-static void check_speed_bin(struct device *dev)
-{
-       struct nvmem_cell *cell;
-       u32 val;
-
-       /*
-        * If the OPP table specifies a opp-supported-hw property then we have
-        * to set something with dev_pm_opp_set_supported_hw() or the table
-        * doesn't get populated so pick an arbitrary value that should
-        * ensure the default frequencies are selected but not conflict with any
-        * actual bins
-        */
-       val = 0x80;
-
-       cell = nvmem_cell_get(dev, "speed_bin");
-
-       if (!IS_ERR(cell)) {
-               void *buf = nvmem_cell_read(cell, NULL);
-
-               if (!IS_ERR(buf)) {
-                       u8 bin = *((u8 *) buf);
-
-                       val = (1 << bin);
-                       kfree(buf);
-               }
-
-               nvmem_cell_put(cell);
-       }
-
-       devm_pm_opp_set_supported_hw(dev, &val, 1);
-}
-
 struct msm_gpu *a5xx_gpu_init(struct drm_device *dev)
 {
        struct msm_drm_private *priv = dev->dev_private;
@@ -1763,8 +1731,6 @@ struct msm_gpu *a5xx_gpu_init(struct drm_device *dev)
 
        a5xx_gpu->lm_leakage = 0x4E001A;
 
-       check_speed_bin(&pdev->dev);
-
        nr_rings = 4;
 
        if (config->info->revn == 510)
diff --git a/drivers/gpu/drm/msm/adreno/a6xx_gpu.c 
b/drivers/gpu/drm/msm/adreno/a6xx_gpu.c
index 60708c23ae4c..1242697d64a7 100644
--- a/drivers/gpu/drm/msm/adreno/a6xx_gpu.c
+++ b/drivers/gpu/drm/msm/adreno/a6xx_gpu.c
@@ -2878,55 +2878,6 @@ static bool a6xx_progress(struct msm_gpu *gpu, struct 
msm_ringbuffer *ring)
        return progress;
 }
 
-static u32 fuse_to_supp_hw(const struct adreno_info *info, u32 fuse)
-{
-       if (!info->speedbins)
-               return UINT_MAX;
-
-       for (int i = 0; info->speedbins[i].fuse != SHRT_MAX; i++)
-               if (info->speedbins[i].fuse == fuse)
-                       return BIT(info->speedbins[i].speedbin);
-
-       return UINT_MAX;
-}
-
-static int a6xx_set_supported_hw(struct adreno_gpu *adreno_gpu,
-                                struct device *dev,
-                                const struct adreno_info *info)
-{
-       u32 supp_hw;
-       u32 speedbin;
-       int ret;
-
-       ret = adreno_read_speedbin(adreno_gpu, dev, &speedbin);
-       /*
-        * -ENOENT means that the platform doesn't support speedbin which is
-        * fine
-        */
-       if (ret == -ENOENT) {
-               return 0;
-       } else if (ret) {
-               dev_err_probe(dev, ret,
-                             "failed to read speed-bin. Some OPPs may not be 
supported by hardware\n");
-               return ret;
-       }
-
-       supp_hw = fuse_to_supp_hw(info, speedbin);
-
-       if (supp_hw == UINT_MAX) {
-               DRM_DEV_ERROR(dev,
-                       "missing support for speed-bin: %u. Some OPPs may not 
be supported by hardware\n",
-                       speedbin);
-               supp_hw = BIT(0); /* Default */
-       }
-
-       ret = devm_pm_opp_set_supported_hw(dev, &supp_hw, 1);
-       if (ret)
-               return ret;
-
-       return 0;
-}
-
 static const struct adreno_gpu_funcs funcs = {
        .base = {
                .get_param = adreno_get_param,
@@ -3058,13 +3009,6 @@ struct msm_gpu *a6xx_gpu_init(struct drm_device *dev)
 
        a6xx_llc_slices_init(pdev, a6xx_gpu, is_a7xx);
 
-       ret = a6xx_set_supported_hw(adreno_gpu, &pdev->dev, config->info);
-       if (ret) {
-               a6xx_llc_slices_destroy(a6xx_gpu);
-               kfree(a6xx_gpu);
-               return ERR_PTR(ret);
-       }
-
        if (is_a7xx)
                ret = adreno_gpu_init(dev, pdev, adreno_gpu, &funcs_a7xx, 1);
        else if (adreno_has_gmu_wrapper(adreno_gpu))
diff --git a/drivers/gpu/drm/msm/adreno/adreno_gpu.c 
b/drivers/gpu/drm/msm/adreno/adreno_gpu.c
index 58fd70140685..08b2f08e2a14 100644
--- a/drivers/gpu/drm/msm/adreno/adreno_gpu.c
+++ b/drivers/gpu/drm/msm/adreno/adreno_gpu.c
@@ -1060,8 +1060,8 @@ void adreno_gpu_ocmem_cleanup(struct adreno_ocmem 
*adreno_ocmem)
                           adreno_ocmem->hdl);
 }
 
-int adreno_read_speedbin(struct adreno_gpu *adreno_gpu,
-                        struct device *dev, u32 *fuse)
+static int adreno_read_speedbin(struct adreno_gpu *adreno_gpu,
+                               struct device *dev, u32 *fuse)
 {
        u32 fcode;
        int ret;
@@ -1095,6 +1095,46 @@ int adreno_read_speedbin(struct adreno_gpu *adreno_gpu,
        return 0;
 }
 
+#define ADRENO_SPEEDBIN_FUSE_NODATA    0xFFFF /* Made-up large value, expected 
by mesa */
+static int adreno_set_speedbin(struct adreno_gpu *adreno_gpu, struct device 
*dev)
+{
+       const struct adreno_info *info = adreno_gpu->info;
+       u32 fuse = ADRENO_SPEEDBIN_FUSE_NODATA;
+       u32 supp_hw = UINT_MAX;
+       int ret;
+
+       /* No speedbins defined for this GPU SKU => allow all defined OPPs */
+       if (!info->speedbins) {
+               adreno_gpu->speedbin = ADRENO_SPEEDBIN_FUSE_NODATA;
+               return devm_pm_opp_set_supported_hw(dev, &supp_hw, 1);
+       }
+
+       /*
+        * If a real error (not counting older devicetrees having no nvmem 
references)
+        * occurs when trying to get the fuse value, bail out.
+        */
+       ret = adreno_read_speedbin(adreno_gpu, dev, &fuse);
+       if (ret) {
+               return ret;
+       } else if (fuse == ADRENO_SPEEDBIN_FUSE_NODATA) {
+               /* The info struct has speedbin data, but the DT is too old => 
allow all OPPs */
+               DRM_DEV_INFO(dev, "No GPU speed bin fuse, please update your 
device tree\n");
+               return devm_pm_opp_set_supported_hw(dev, &supp_hw, 1);
+       }
+
+       adreno_gpu->speedbin = fuse;
+
+       /* Traverse the known speedbins */
+       for (int i = 0; info->speedbins[i].fuse != SHRT_MAX; i++) {
+               if (info->speedbins[i].fuse == fuse) {
+                       supp_hw = BIT(info->speedbins[i].speedbin);
+                       return devm_pm_opp_set_supported_hw(dev, &supp_hw, 1);
+               }
+       }
+
+       return dev_err_probe(dev, -EINVAL, "Unknown speed bin fuse value: 
0x%x\n", fuse);
+}
+
 int adreno_gpu_init(struct drm_device *drm, struct platform_device *pdev,
                struct adreno_gpu *adreno_gpu,
                const struct adreno_gpu_funcs *funcs, int nr_rings)
@@ -1104,7 +1144,6 @@ int adreno_gpu_init(struct drm_device *drm, struct 
platform_device *pdev,
        struct msm_gpu_config adreno_gpu_config  = { 0 };
        struct msm_gpu *gpu = &adreno_gpu->base;
        const char *gpu_name;
-       u32 speedbin;
        int ret;
 
        adreno_gpu->funcs = funcs;
@@ -1131,29 +1170,34 @@ int adreno_gpu_init(struct drm_device *drm, struct 
platform_device *pdev,
                        devm_pm_opp_set_clkname(dev, "core");
        }
 
-       if (adreno_read_speedbin(adreno_gpu, dev, &speedbin) || !speedbin)
-               speedbin = 0xffff;
-       adreno_gpu->speedbin = speedbin;
-
        gpu_name = devm_kasprintf(dev, GFP_KERNEL, "%"ADRENO_CHIPID_FMT,
                        ADRENO_CHIPID_ARGS(config->chip_id));
        if (!gpu_name)
                return -ENOMEM;
 
        adreno_gpu_config.ioname = "kgsl_3d0_reg_memory";
-
        adreno_gpu_config.nr_rings = nr_rings;
 
+       pm_runtime_set_autosuspend_delay(dev, 
adreno_gpu->info->inactive_period);
+       pm_runtime_use_autosuspend(dev);
+
+       ret = msm_gpu_init(drm, pdev, &adreno_gpu->base, &funcs->base,
+                          gpu_name, &adreno_gpu_config);
+       if (ret)
+               return ret;
+
+       ret = adreno_set_speedbin(adreno_gpu, dev);
+       if (ret)
+               return ret;
+
        ret = adreno_get_pwrlevels(dev, gpu);
        if (ret)
                return ret;
 
-       pm_runtime_set_autosuspend_delay(dev,
-               adreno_gpu->info->inactive_period);
-       pm_runtime_use_autosuspend(dev);
+       /* Devfreq can only be initialized after OPP */
+       msm_devfreq_init(gpu);
 
-       return msm_gpu_init(drm, pdev, &adreno_gpu->base, &funcs->base,
-                       gpu_name, &adreno_gpu_config);
+       return 0;
 }
 
 void adreno_gpu_cleanup(struct adreno_gpu *adreno_gpu)
diff --git a/drivers/gpu/drm/msm/adreno/adreno_gpu.h 
b/drivers/gpu/drm/msm/adreno/adreno_gpu.h
index 8f2b70eaf6ad..30e8b9919adb 100644
--- a/drivers/gpu/drm/msm/adreno/adreno_gpu.h
+++ b/drivers/gpu/drm/msm/adreno/adreno_gpu.h
@@ -524,9 +524,6 @@ int adreno_fault_handler(struct msm_gpu *gpu, unsigned long 
iova, int flags,
                         struct adreno_smmu_fault_info *info, const char *block,
                         u32 scratch[4]);
 
-int adreno_read_speedbin(struct adreno_gpu *adreno_gpu,
-                        struct device *dev, u32 *speedbin);
-
 /*
  * For a5xx and a6xx targets load the zap shader that is used to pull the GPU
  * out of secure mode
diff --git a/drivers/gpu/drm/msm/msm_gpu.c b/drivers/gpu/drm/msm/msm_gpu.c
index 655002b21b0d..8504eaab8ef6 100644
--- a/drivers/gpu/drm/msm/msm_gpu.c
+++ b/drivers/gpu/drm/msm/msm_gpu.c
@@ -932,9 +932,6 @@ int msm_gpu_init(struct drm_device *drm, struct 
platform_device *pdev,
        gpu->pdev = pdev;
        platform_set_drvdata(pdev, &gpu->adreno_smmu);
 
-       msm_devfreq_init(gpu);
-
-
        gpu->aspace = gpu->funcs->create_address_space(gpu, pdev);
 
        if (gpu->aspace == NULL)

-- 
2.44.0

Reply via email to