From: Bibby Hsieh <bibby.hs...@mediatek.com>

We can select output component by decive node port.
Main path default output component is DSI.
External path default output component is DPI.

Signed-off-by: Bibby Hsieh <bibby.hs...@mediatek.com>
---
 drivers/gpu/drm/mediatek/mtk_drm_drv.c | 41 ++++++++++++++++++++++----
 drivers/gpu/drm/mediatek/mtk_drm_drv.h |  4 +--
 2 files changed, 37 insertions(+), 8 deletions(-)

diff --git a/drivers/gpu/drm/mediatek/mtk_drm_drv.c 
b/drivers/gpu/drm/mediatek/mtk_drm_drv.c
index 57ce4708ef1b..d3e86426dc65 100644
--- a/drivers/gpu/drm/mediatek/mtk_drm_drv.c
+++ b/drivers/gpu/drm/mediatek/mtk_drm_drv.c
@@ -22,7 +22,9 @@
 #include <drm/drm_probe_helper.h>
 #include <linux/component.h>
 #include <linux/iommu.h>
+#include <linux/of.h>
 #include <linux/of_address.h>
+#include <linux/of_graph.h>
 #include <linux/of_platform.h>
 #include <linux/pm_runtime.h>

@@ -134,7 +136,7 @@ static const struct drm_mode_config_funcs 
mtk_drm_mode_config_funcs = {
        .atomic_commit = mtk_atomic_commit,
 };

-static const enum mtk_ddp_comp_id mt2701_mtk_ddp_main[] = {
+static enum mtk_ddp_comp_id mt2701_mtk_ddp_main[] = {
        DDP_COMPONENT_OVL0,
        DDP_COMPONENT_RDMA0,
        DDP_COMPONENT_COLOR0,
@@ -142,12 +144,12 @@ static const enum mtk_ddp_comp_id mt2701_mtk_ddp_main[] = 
{
        DDP_COMPONENT_DSI0,
 };

-static const enum mtk_ddp_comp_id mt2701_mtk_ddp_ext[] = {
+static enum mtk_ddp_comp_id mt2701_mtk_ddp_ext[] = {
        DDP_COMPONENT_RDMA1,
        DDP_COMPONENT_DPI0,
 };

-static const enum mtk_ddp_comp_id mt2712_mtk_ddp_main[] = {
+static enum mtk_ddp_comp_id mt2712_mtk_ddp_main[] = {
        DDP_COMPONENT_OVL0,
        DDP_COMPONENT_COLOR0,
        DDP_COMPONENT_AAL0,
@@ -157,7 +159,7 @@ static const enum mtk_ddp_comp_id mt2712_mtk_ddp_main[] = {
        DDP_COMPONENT_PWM0,
 };

-static const enum mtk_ddp_comp_id mt2712_mtk_ddp_ext[] = {
+static enum mtk_ddp_comp_id mt2712_mtk_ddp_ext[] = {
        DDP_COMPONENT_OVL1,
        DDP_COMPONENT_COLOR1,
        DDP_COMPONENT_AAL1,
@@ -173,7 +175,7 @@ static const enum mtk_ddp_comp_id mt2712_mtk_ddp_third[] = {
        DDP_COMPONENT_PWM2,
 };

-static const enum mtk_ddp_comp_id mt8173_mtk_ddp_main[] = {
+static enum mtk_ddp_comp_id mt8173_mtk_ddp_main[] = {
        DDP_COMPONENT_OVL0,
        DDP_COMPONENT_COLOR0,
        DDP_COMPONENT_AAL0,
@@ -184,7 +186,7 @@ static const enum mtk_ddp_comp_id mt8173_mtk_ddp_main[] = {
        DDP_COMPONENT_PWM0,
 };

-static const enum mtk_ddp_comp_id mt8173_mtk_ddp_ext[] = {
+static enum mtk_ddp_comp_id mt8173_mtk_ddp_ext[] = {
        DDP_COMPONENT_OVL1,
        DDP_COMPONENT_COLOR1,
        DDP_COMPONENT_GAMMA,
@@ -479,6 +481,7 @@ static int mtk_drm_probe(struct platform_device *pdev)

        /* Iterate over sibling DISP function blocks */
        for_each_child_of_node(dev->of_node->parent, node) {
+               struct device_node *port, *ep, *remote;
                const struct of_device_id *of_id;
                enum mtk_ddp_comp_type comp_type;
                int comp_id;
@@ -538,6 +541,32 @@ static int mtk_drm_probe(struct platform_device *pdev)

                        private->ddp_comp[comp_id] = comp;
                }
+
+               if (comp_type != MTK_DSI && comp_type != MTK_DPI) {
+                       port = of_graph_get_port_by_id(node, 0);
+                       if (!port)
+                               continue;
+                       ep = of_get_child_by_name(port, "endpoint");
+                       of_node_put(port);
+                       if (!ep)
+                               continue;
+                       remote = of_graph_get_remote_port_parent(ep);
+                       of_node_put(ep);
+                       if (!remote)
+                               continue;
+                       of_id = of_match_node(mtk_ddp_comp_dt_ids, remote);
+                       if (!of_id)
+                               continue;
+                       comp_type = (enum mtk_ddp_comp_type)of_id->data;
+                       for (i = 0; i < private->data->main_len - 1; i++)
+                               if (private->data->main_path[i] == comp_id)
+                                       private->data->main_path[i + 1] =
+                                       mtk_ddp_comp_get_id(node, comp_type);
+                       for (i = 0; i < private->data->ext_len - 1; i++)
+                               if (private->data->ext_path[i] == comp_id)
+                                       private->data->ext_path[i + 1] =
+                                       mtk_ddp_comp_get_id(node, comp_type);
+               }
        }

        if (!private->mutex_node) {
diff --git a/drivers/gpu/drm/mediatek/mtk_drm_drv.h 
b/drivers/gpu/drm/mediatek/mtk_drm_drv.h
index ecc00ca3221d..256a3ff2e66e 100644
--- a/drivers/gpu/drm/mediatek/mtk_drm_drv.h
+++ b/drivers/gpu/drm/mediatek/mtk_drm_drv.h
@@ -29,9 +29,9 @@ struct drm_property;
 struct regmap;

 struct mtk_mmsys_driver_data {
-       const enum mtk_ddp_comp_id *main_path;
+       enum mtk_ddp_comp_id *main_path;
        unsigned int main_len;
-       const enum mtk_ddp_comp_id *ext_path;
+       enum mtk_ddp_comp_id *ext_path;
        unsigned int ext_len;
        const enum mtk_ddp_comp_id *third_path;
        unsigned int third_len;
--
2.17.1

Reply via email to