Use function call for setting mmsys ovl mout register

Signed-off-by: Yongqiang Niu <yongqiang....@mediatek.com>
---
 drivers/soc/mediatek/mmsys/mtk-mmsys.c | 20 ++++++++++++++++++++
 include/linux/soc/mediatek/mtk-mmsys.h |  3 +++
 2 files changed, 23 insertions(+)

diff --git a/drivers/soc/mediatek/mmsys/mtk-mmsys.c 
b/drivers/soc/mediatek/mmsys/mtk-mmsys.c
index dae665b..ea36a11 100644
--- a/drivers/soc/mediatek/mmsys/mtk-mmsys.c
+++ b/drivers/soc/mediatek/mmsys/mtk-mmsys.c
@@ -74,6 +74,17 @@ void mtk_mmsys_ddp_connect(struct device *dev,
                reg = readl_relaxed(mmsys->regs + addr) | value;
                writel_relaxed(reg, mmsys->regs + addr);
        }
+
+       if (!funcs->ovl_mout_en)
+               return;
+
+       if (funcs->ovl_mout_en) {
+               value = funcs->ovl_mout_en(cur, next, &addr);
+               if (value) {
+                       reg = readl_relaxed(mmsys->regs + addr) | value;
+                       writel_relaxed(reg, mmsys->regs + addr);
+               }
+       }
 }
 EXPORT_SYMBOL_GPL(mtk_mmsys_ddp_connect);
 
@@ -99,6 +110,15 @@ void mtk_mmsys_ddp_disconnect(struct device *dev,
                reg = readl_relaxed(mmsys->regs + addr) & ~value;
                writel_relaxed(reg, mmsys->regs + addr);
        }
+
+       if (!funcs->ovl_mout_en)
+               return;
+
+       value = funcs->ovl_mout_en(cur, next, &addr);
+       if (value) {
+               reg = readl_relaxed(mmsys->regs + addr) & ~value;
+               writel_relaxed(reg, mmsys->regs + addr);
+       }
 }
 EXPORT_SYMBOL_GPL(mtk_mmsys_ddp_disconnect);
 
diff --git a/include/linux/soc/mediatek/mtk-mmsys.h 
b/include/linux/soc/mediatek/mtk-mmsys.h
index aa4f60e..220203d 100644
--- a/include/linux/soc/mediatek/mtk-mmsys.h
+++ b/include/linux/soc/mediatek/mtk-mmsys.h
@@ -49,6 +49,9 @@ struct mtk_mmsys_conn_funcs {
        u32 (*mout_en)(enum mtk_ddp_comp_id cur,
                       enum mtk_ddp_comp_id next,
                       unsigned int *addr);
+       u32 (*ovl_mout_en)(enum mtk_ddp_comp_id cur,
+                          enum mtk_ddp_comp_id next,
+                          unsigned int *addr);
        u32 (*sel_in)(enum mtk_ddp_comp_id cur,
                      enum mtk_ddp_comp_id next,
                      unsigned int *addr);
-- 
1.8.1.1.dirty

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

Reply via email to