drm/msm/dpu: support binding to the mdp5 devices
authorDmitry Baryshkov <dmitry.baryshkov@linaro.org>
Thu, 8 Feb 2024 15:01:09 +0000 (17:01 +0200)
committerDmitry Baryshkov <dmitry.baryshkov@linaro.org>
Mon, 19 Feb 2024 11:39:39 +0000 (13:39 +0200)
Existing MDP5 devices have slightly different bindings. The main
register region is called `mdp_phys' instead of `mdp'. Also vbif
register regions are a part of the parent, MDSS device. Add support for
handling this binding differences.

Signed-off-by: Dmitry Baryshkov <dmitry.baryshkov@linaro.org>
Reviewed-by: Abhinav Kumar <quic_abhinavk@quicinc.com>
Patchwork: https://patchwork.freedesktop.org/patch/577505/
Link: https://lore.kernel.org/r/20240208-fd-migrate-mdp5-v4-2-945d08ef3fa8@linaro.org
drivers/gpu/drm/msm/disp/dpu1/dpu_kms.c
drivers/gpu/drm/msm/msm_drv.h
drivers/gpu/drm/msm/msm_io_utils.c

index 48728be27e1552f8255384cb6e1878f27562ad2d..0b1c238065906a0f3bd10cce85778ba0fb8625be 100644 (file)
@@ -1200,6 +1200,78 @@ static int dpu_kms_init(struct drm_device *ddev)
        return 0;
 }
 
+static int dpu_kms_mmap_mdp5(struct dpu_kms *dpu_kms)
+{
+       struct platform_device *pdev = dpu_kms->pdev;
+       struct platform_device *mdss_dev;
+       int ret;
+
+       if (!dev_is_platform(dpu_kms->pdev->dev.parent))
+               return -EINVAL;
+
+       mdss_dev = to_platform_device(dpu_kms->pdev->dev.parent);
+
+       dpu_kms->mmio = msm_ioremap(pdev, "mdp_phys");
+       if (IS_ERR(dpu_kms->mmio)) {
+               ret = PTR_ERR(dpu_kms->mmio);
+               DPU_ERROR("mdp register memory map failed: %d\n", ret);
+               dpu_kms->mmio = NULL;
+               return ret;
+       }
+       DRM_DEBUG("mapped dpu address space @%pK\n", dpu_kms->mmio);
+
+       dpu_kms->vbif[VBIF_RT] = msm_ioremap_mdss(mdss_dev,
+                                                 dpu_kms->pdev,
+                                                 "vbif_phys");
+       if (IS_ERR(dpu_kms->vbif[VBIF_RT])) {
+               ret = PTR_ERR(dpu_kms->vbif[VBIF_RT]);
+               DPU_ERROR("vbif register memory map failed: %d\n", ret);
+               dpu_kms->vbif[VBIF_RT] = NULL;
+               return ret;
+       }
+
+       dpu_kms->vbif[VBIF_NRT] = msm_ioremap_mdss(mdss_dev,
+                                                  dpu_kms->pdev,
+                                                  "vbif_nrt_phys");
+       if (IS_ERR(dpu_kms->vbif[VBIF_NRT])) {
+               dpu_kms->vbif[VBIF_NRT] = NULL;
+               DPU_DEBUG("VBIF NRT is not defined");
+       }
+
+       return 0;
+}
+
+static int dpu_kms_mmap_dpu(struct dpu_kms *dpu_kms)
+{
+       struct platform_device *pdev = dpu_kms->pdev;
+       int ret;
+
+       dpu_kms->mmio = msm_ioremap(pdev, "mdp");
+       if (IS_ERR(dpu_kms->mmio)) {
+               ret = PTR_ERR(dpu_kms->mmio);
+               DPU_ERROR("mdp register memory map failed: %d\n", ret);
+               dpu_kms->mmio = NULL;
+               return ret;
+       }
+       DRM_DEBUG("mapped dpu address space @%pK\n", dpu_kms->mmio);
+
+       dpu_kms->vbif[VBIF_RT] = msm_ioremap(pdev, "vbif");
+       if (IS_ERR(dpu_kms->vbif[VBIF_RT])) {
+               ret = PTR_ERR(dpu_kms->vbif[VBIF_RT]);
+               DPU_ERROR("vbif register memory map failed: %d\n", ret);
+               dpu_kms->vbif[VBIF_RT] = NULL;
+               return ret;
+       }
+
+       dpu_kms->vbif[VBIF_NRT] = msm_ioremap_quiet(pdev, "vbif_nrt");
+       if (IS_ERR(dpu_kms->vbif[VBIF_NRT])) {
+               dpu_kms->vbif[VBIF_NRT] = NULL;
+               DPU_DEBUG("VBIF NRT is not defined");
+       }
+
+       return 0;
+}
+
 static int dpu_dev_probe(struct platform_device *pdev)
 {
        struct device *dev = &pdev->dev;
@@ -1233,28 +1305,12 @@ static int dpu_dev_probe(struct platform_device *pdev)
 
        dpu_kms->base.irq = irq;
 
-       dpu_kms->mmio = msm_ioremap(pdev, "mdp");
-       if (IS_ERR(dpu_kms->mmio)) {
-               ret = PTR_ERR(dpu_kms->mmio);
-               DPU_ERROR("mdp register memory map failed: %d\n", ret);
-               dpu_kms->mmio = NULL;
-               return ret;
-       }
-       DRM_DEBUG("mapped dpu address space @%pK\n", dpu_kms->mmio);
-
-       dpu_kms->vbif[VBIF_RT] = msm_ioremap(pdev, "vbif");
-       if (IS_ERR(dpu_kms->vbif[VBIF_RT])) {
-               ret = PTR_ERR(dpu_kms->vbif[VBIF_RT]);
-               DPU_ERROR("vbif register memory map failed: %d\n", ret);
-               dpu_kms->vbif[VBIF_RT] = NULL;
+       if (of_device_is_compatible(dpu_kms->pdev->dev.of_node, "qcom,mdp5"))
+               ret = dpu_kms_mmap_mdp5(dpu_kms);
+       else
+               ret = dpu_kms_mmap_dpu(dpu_kms);
+       if (ret)
                return ret;
-       }
-
-       dpu_kms->vbif[VBIF_NRT] = msm_ioremap_quiet(pdev, "vbif_nrt");
-       if (IS_ERR(dpu_kms->vbif[VBIF_NRT])) {
-               dpu_kms->vbif[VBIF_NRT] = NULL;
-               DPU_DEBUG("VBIF NRT is not defined");
-       }
 
        ret = dpu_kms_parse_data_bus_icc_path(dpu_kms);
        if (ret)
index 16a7cbc0b7dd8b1934d9337243673051c7e22384..01e783130054e25018072e2cf05138e4ea602ec6 100644 (file)
@@ -476,6 +476,9 @@ void __iomem *msm_ioremap(struct platform_device *pdev, const char *name);
 void __iomem *msm_ioremap_size(struct platform_device *pdev, const char *name,
                phys_addr_t *size);
 void __iomem *msm_ioremap_quiet(struct platform_device *pdev, const char *name);
+void __iomem *msm_ioremap_mdss(struct platform_device *mdss_pdev,
+                              struct platform_device *dev,
+                              const char *name);
 
 struct icc_path *msm_icc_get(struct device *dev, const char *name);
 
index 59d2788c451049296e0738ac82f1903cfdf07c79..afedd61c3e28865535d6b73a6c4c10bdb2670446 100644 (file)
@@ -50,6 +50,19 @@ struct clk *msm_clk_get(struct platform_device *pdev, const char *name)
        return clk;
 }
 
+void __iomem *msm_ioremap_mdss(struct platform_device *mdss_pdev,
+                              struct platform_device *pdev,
+                              const char *name)
+{
+       struct resource *res;
+
+       res = platform_get_resource_byname(mdss_pdev, IORESOURCE_MEM, name);
+       if (!res)
+               return ERR_PTR(-EINVAL);
+
+       return devm_ioremap_resource(&pdev->dev, res);
+}
+
 static void __iomem *_msm_ioremap(struct platform_device *pdev, const char *name,
                                  bool quiet, phys_addr_t *psize)
 {