From: Stu Hsieh <stu.hs...@mediatek.com>

Test: build pass and run ok

Signed-off-by: Stu Hsieh <stu.hs...@mediatek.com>
---
 drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c | 42 +++++++++++++++++++++
 drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h |  2 +
 2 files changed, 44 insertions(+)

diff --git a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c 
b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c
index 57c88de9a329..a5f2ff6bea93 100644
--- a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c
+++ b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c
@@ -13,6 +13,8 @@
 #include <linux/of_platform.h>
 #include <linux/platform_device.h>
 #include <linux/soc/mediatek/mtk-cmdq.h>
+#include <drm/drm_print.h>
+
 #include "mtk_drm_drv.h"
 #include "mtk_drm_plane.h"
 #include "mtk_drm_ddp_comp.h"
@@ -412,6 +414,22 @@ static const struct mtk_ddp_comp_match 
mtk_ddp_matches[DDP_COMPONENT_ID_MAX] = {
        [DDP_COMPONENT_WDMA1]   = { MTK_DISP_WDMA,      1, NULL },
 };

+static bool mtk_drm_find_comp_in_ddp(struct mtk_ddp_comp ddp_comp,
+                                        const enum mtk_ddp_comp_id *path,
+                                        unsigned int path_len)
+{
+       unsigned int i;
+
+       if (path == NULL)
+               return false;
+
+       for (i = 0U; i < path_len; i++)
+               if (ddp_comp.id == path[i])
+                       return true;
+
+       return false;
+}
+
 int mtk_ddp_comp_get_id(struct device_node *node,
                        enum mtk_ddp_comp_type comp_type)
 {
@@ -427,6 +445,30 @@ int mtk_ddp_comp_get_id(struct device_node *node,
        return -EINVAL;
 }

+unsigned int mtk_drm_find_possible_crtc_by_comp(struct drm_device *drm,
+                                               struct mtk_ddp_comp ddp_comp)
+{
+       struct mtk_drm_private *private = drm->dev_private;
+       unsigned int ret;
+
+       if (mtk_drm_find_comp_in_ddp(ddp_comp, private->data->main_path,
+               private->data->main_len) == true) {
+               ret = BIT(0);
+       } else if (mtk_drm_find_comp_in_ddp(ddp_comp,
+               private->data->ext_path,
+               private->data->ext_len) == true) {
+               ret = BIT(1);
+       } else if (mtk_drm_find_comp_in_ddp(ddp_comp,
+               private->data->third_path,
+               private->data->third_len) == true) {
+               ret = BIT(2);
+       } else {
+               DRM_INFO("Failed to find comp in ddp table\n");
+               ret = 0;
+       }
+       return ret;
+}
+
 int mtk_ddp_comp_init(struct device *dev, struct device_node *node,
                      struct mtk_ddp_comp *comp, enum mtk_ddp_comp_id comp_id,
                      const struct mtk_ddp_comp_funcs *funcs)
diff --git a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h 
b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h
index debe36395fe7..1d9e00b69462 100644
--- a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h
+++ b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h
@@ -202,6 +202,8 @@ static inline void mtk_ddp_ctm_set(struct mtk_ddp_comp 
*comp,

 int mtk_ddp_comp_get_id(struct device_node *node,
                        enum mtk_ddp_comp_type comp_type);
+unsigned int mtk_drm_find_possible_crtc_by_comp(struct drm_device *drm,
+                                               struct mtk_ddp_comp ddp_comp);
 int mtk_ddp_comp_init(struct device *dev, struct device_node *comp_node,
                      struct mtk_ddp_comp *comp, enum mtk_ddp_comp_id comp_id,
                      const struct mtk_ddp_comp_funcs *funcs);
--
2.25.1

_______________________________________________
dri-devel mailing list
dri-devel@lists.freedesktop.org
https://lists.freedesktop.org/mailman/listinfo/dri-devel

Reply via email to