Add drm ovl_adaptor sub driver. Bring up ovl_adaptor sub driver if
the component exists in the path.

Signed-off-by: Nancy.Lin <nancy....@mediatek.com>
---
 drivers/gpu/drm/mediatek/mtk_drm_crtc.c     | 16 ++++----
 drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c | 30 ++++++++++++---
 drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h |  1 +
 drivers/gpu/drm/mediatek/mtk_drm_drv.c      | 41 +++++++++++++++------
 4 files changed, 62 insertions(+), 26 deletions(-)

diff --git a/drivers/gpu/drm/mediatek/mtk_drm_crtc.c 
b/drivers/gpu/drm/mediatek/mtk_drm_crtc.c
index fe2871aca859..62529a954b62 100644
--- a/drivers/gpu/drm/mediatek/mtk_drm_crtc.c
+++ b/drivers/gpu/drm/mediatek/mtk_drm_crtc.c
@@ -877,15 +877,13 @@ int mtk_drm_crtc_create(struct drm_device *drm_dev,
                node = priv->comp_node[comp_id];
                comp = &priv->ddp_comp[comp_id];
 
-               if (!node) {
-                       dev_info(dev,
-                                "Not creating crtc %d because component %d is 
disabled or missing\n",
-                                crtc_i, comp_id);
-                       return 0;
-               }
-
-               if (!comp->dev) {
-                       dev_err(dev, "Component %pOF not initialized\n", node);
+               /* Not all drm components have a DTS device node, such as 
ovl_adaptor,
+                * which is the drm bring up sub driver
+                */
+               if (!node && !comp->dev) {
+                       dev_err(dev,
+                               "Not creating crtc %d because component %d is 
disabled, missing or not initialized\n",
+                               crtc_i, comp_id);
                        return -ENODEV;
                }
        }
diff --git a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c 
b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c
index 26d197da41c0..ce40bab9c56b 100644
--- a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c
+++ b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c
@@ -385,6 +385,18 @@ static const struct mtk_ddp_comp_funcs ddp_ufoe = {
        .start = mtk_ufoe_start,
 };
 
+static const struct mtk_ddp_comp_funcs ddp_ovl_adaptor = {
+       .clk_enable = mtk_ovl_adaptor_clk_enable,
+       .clk_disable = mtk_ovl_adaptor_clk_disable,
+       .config = mtk_ovl_adaptor_config,
+       .start = mtk_ovl_adaptor_start,
+       .stop = mtk_ovl_adaptor_stop,
+       .layer_nr = mtk_ovl_adaptor_layer_nr,
+       .layer_config = mtk_ovl_adaptor_layer_config,
+       .enable_vblank = mtk_ovl_adaptor_enable_vblank,
+       .disable_vblank = mtk_ovl_adaptor_disable_vblank,
+};
+
 static const char * const mtk_ddp_comp_stem[MTK_DDP_COMP_TYPE_MAX] = {
        [MTK_DISP_AAL] = "aal",
        [MTK_DISP_BLS] = "bls",
@@ -398,6 +410,7 @@ static const char * const 
mtk_ddp_comp_stem[MTK_DDP_COMP_TYPE_MAX] = {
        [MTK_DISP_OD] = "od",
        [MTK_DISP_OVL] = "ovl",
        [MTK_DISP_OVL_2L] = "ovl-2l",
+       [MTK_DISP_OVL_ADAPTOR] = "ovl_adaptor",
        [MTK_DISP_POSTMASK] = "postmask",
        [MTK_DISP_PWM] = "pwm",
        [MTK_DISP_RDMA] = "rdma",
@@ -443,6 +456,7 @@ static const struct mtk_ddp_comp_match 
mtk_ddp_matches[DDP_COMPONENT_ID_MAX] = {
        [DDP_COMPONENT_OVL_2L0]         = { MTK_DISP_OVL_2L,    0, &ddp_ovl },
        [DDP_COMPONENT_OVL_2L1]         = { MTK_DISP_OVL_2L,    1, &ddp_ovl },
        [DDP_COMPONENT_OVL_2L2]         = { MTK_DISP_OVL_2L,    2, &ddp_ovl },
+       [DDP_COMPONENT_OVL_ADAPTOR]     = { MTK_DISP_OVL_ADAPTOR,       0, 
&ddp_ovl_adaptor },
        [DDP_COMPONENT_POSTMASK0]       = { MTK_DISP_POSTMASK,  0, 
&ddp_postmask },
        [DDP_COMPONENT_PWM0]            = { MTK_DISP_PWM,       0, NULL },
        [DDP_COMPONENT_PWM1]            = { MTK_DISP_PWM,       1, NULL },
@@ -548,12 +562,17 @@ int mtk_ddp_comp_init(struct device_node *node, struct 
mtk_ddp_comp *comp,
 
        comp->id = comp_id;
        comp->funcs = mtk_ddp_matches[comp_id].funcs;
-       comp_pdev = of_find_device_by_node(node);
-       if (!comp_pdev) {
-               DRM_INFO("Waiting for device %s\n", node->full_name);
-               return -EPROBE_DEFER;
+       /* Not all drm components have a DTS device node, such as ovl_adaptor,
+        * which is the drm bring up sub driver
+        */
+       if (node) {
+               comp_pdev = of_find_device_by_node(node);
+               if (!comp_pdev) {
+                       DRM_INFO("Waiting for device %s\n", node->full_name);
+                       return -EPROBE_DEFER;
+               }
+               comp->dev = &comp_pdev->dev;
        }
-       comp->dev = &comp_pdev->dev;
 
        /* Only DMA capable components need the LARB property */
        if (type == MTK_DISP_OVL ||
@@ -573,6 +592,7 @@ int mtk_ddp_comp_init(struct device_node *node, struct 
mtk_ddp_comp *comp,
            type == MTK_DISP_MERGE ||
            type == MTK_DISP_OVL ||
            type == MTK_DISP_OVL_2L ||
+           type == MTK_DISP_OVL_ADAPTOR ||
            type == MTK_DISP_PWM ||
            type == MTK_DISP_RDMA ||
            type == MTK_DPI ||
diff --git a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h 
b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h
index 221e2e3a3c8d..5e1404dc20c4 100644
--- a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h
+++ b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h
@@ -30,6 +30,7 @@ enum mtk_ddp_comp_type {
        MTK_DISP_OD,
        MTK_DISP_OVL,
        MTK_DISP_OVL_2L,
+       MTK_DISP_OVL_ADAPTOR,
        MTK_DISP_POSTMASK,
        MTK_DISP_PWM,
        MTK_DISP_RDMA,
diff --git a/drivers/gpu/drm/mediatek/mtk_drm_drv.c 
b/drivers/gpu/drm/mediatek/mtk_drm_drv.c
index a05703843af2..36430f956b4f 100644
--- a/drivers/gpu/drm/mediatek/mtk_drm_drv.c
+++ b/drivers/gpu/drm/mediatek/mtk_drm_drv.c
@@ -351,9 +351,7 @@ static int mtk_drm_kms_init(struct drm_device *drm)
 {
        struct mtk_drm_private *private = drm->dev_private;
        struct mtk_drm_private *priv_n;
-       struct platform_device *pdev;
-       struct device_node *np = NULL;
-       struct device *dma_dev;
+       struct device *dma_dev = NULL;
        int ret, i, j;
 
        ret = drmm_mode_config_init(drm);
@@ -400,8 +398,8 @@ static int mtk_drm_kms_init(struct drm_device *drm)
                                if (ret)
                                        goto err_component_unbind;
 
-                               if (!np)
-                                       np = 
priv_n->comp_node[priv_n->data->main_path[0]];
+                               if (!dma_dev)
+                                       dma_dev = 
priv_n->ddp_comp[priv_n->data->main_path[0]].dev;
 
                                continue;
                        } else if (i == 1 && priv_n->data->ext_len) {
@@ -410,8 +408,8 @@ static int mtk_drm_kms_init(struct drm_device *drm)
                                if (ret)
                                        goto err_component_unbind;
 
-                               if (!np)
-                                       np = 
priv_n->comp_node[priv_n->data->ext_path[0]];
+                               if (!dma_dev)
+                                       dma_dev = 
priv_n->ddp_comp[priv_n->data->ext_path[0]].dev;
 
                                continue;
                        } else if (i == 2 && priv_n->data->third_len) {
@@ -420,22 +418,20 @@ static int mtk_drm_kms_init(struct drm_device *drm)
                                if (ret)
                                        goto err_component_unbind;
 
-                               if (!np)
-                                       np = 
priv_n->comp_node[priv_n->data->third_path[0]];
+                               if (!dma_dev)
+                                       dma_dev = 
priv_n->ddp_comp[priv_n->data->third_path[0]].dev;
 
                                continue;
                        }
                }
        }
 
-       pdev = of_find_device_by_node(np);
-       if (!pdev) {
+       if (!dma_dev) {
                ret = -ENODEV;
                dev_err(drm->dev, "Need at least one OVL device\n");
                goto err_component_unbind;
        }
 
-       dma_dev = &pdev->dev;
        for (i = 0; i < private->data->mmsys_dev_num; i++)
                private->all_drm_private[i]->dma_dev = dma_dev;
 
@@ -514,6 +510,11 @@ static int compare_of(struct device *dev, void *data)
        return dev->of_node == data;
 }
 
+static int compare_dev(struct device *dev, void *data)
+{
+       return dev == (struct device *)data;
+}
+
 static int mtk_drm_bind(struct device *dev)
 {
        struct mtk_drm_private *private = dev_get_drvdata(dev);
@@ -702,6 +703,7 @@ static int mtk_drm_probe(struct platform_device *pdev)
        struct mtk_drm_private *private;
        struct device_node *node;
        struct component_match *match = NULL;
+       struct platform_device *ovl_adaptor;
        int ret;
        int i;
 
@@ -727,6 +729,19 @@ static int mtk_drm_probe(struct platform_device *pdev)
                return -ENODEV;
        }
 
+       /* Bringup ovl_adaptor */
+       if (mtk_drm_find_mmsys_comp(private, DDP_COMPONENT_OVL_ADAPTOR)) {
+               ovl_adaptor = platform_device_register_data(dev, 
"mediatek-disp-ovl-adaptor",
+                                                           PLATFORM_DEVID_AUTO,
+                                                           (void 
*)private->mmsys_dev,
+                                                           
sizeof(*private->mmsys_dev));
+               private->ddp_comp[DDP_COMPONENT_OVL_ADAPTOR].dev = 
&ovl_adaptor->dev;
+               private->comp_node[DDP_COMPONENT_OVL_ADAPTOR] = 
ovl_adaptor->dev.of_node;
+               mtk_ddp_comp_init(NULL, 
&private->ddp_comp[DDP_COMPONENT_OVL_ADAPTOR],
+                                 DDP_COMPONENT_OVL_ADAPTOR);
+               component_match_add(dev, &match, compare_dev, 
&ovl_adaptor->dev);
+       }
+
        /* Iterate over sibling DISP function blocks */
        for_each_child_of_node(phandle->parent, node) {
                const struct of_device_id *of_id;
@@ -780,6 +795,7 @@ static int mtk_drm_probe(struct platform_device *pdev)
                    comp_type == MTK_DISP_MERGE ||
                    comp_type == MTK_DISP_OVL ||
                    comp_type == MTK_DISP_OVL_2L ||
+                   comp_type == MTK_DISP_OVL_ADAPTOR ||
                    comp_type == MTK_DISP_RDMA ||
                    comp_type == MTK_DPI ||
                    comp_type == MTK_DSI) {
@@ -882,6 +898,7 @@ static struct platform_driver * const mtk_drm_drivers[] = {
        &mtk_disp_color_driver,
        &mtk_disp_gamma_driver,
        &mtk_disp_merge_driver,
+       &mtk_disp_ovl_adaptor_driver,
        &mtk_disp_ovl_driver,
        &mtk_disp_rdma_driver,
        &mtk_dpi_driver,
-- 
2.18.0

Reply via email to