[PATCH 09/15] mailbox: mediatek: Add secure CMDQ driver support for CMDQ driver

[Jason-JH . Lin]

CMDQ driver will probe a secure CMDQ driver when has_sec flag
in platform data is true and its device node in dts has defined a
event id of CMDQ_SYNC_TOKEN_SEC_EOF.

Signed-off-by: Jason-JH.Lin <jason-jh....@mediatek.com>
---
 drivers/mailbox/mtk-cmdq-mailbox.c       | 40 ++++++++++++++++++++++--
 include/linux/mailbox/mtk-cmdq-mailbox.h | 11 +++++++
 2 files changed, 49 insertions(+), 2 deletions(-)

diff --git a/drivers/mailbox/mtk-cmdq-mailbox.c 
b/drivers/mailbox/mtk-cmdq-mailbox.c
index a3b831b6bab9..cd4a8f0ef6ad 100644
--- a/drivers/mailbox/mtk-cmdq-mailbox.c
+++ b/drivers/mailbox/mtk-cmdq-mailbox.c
@@ -87,6 +87,7 @@ struct gce_plat {
        u8 shift;
        bool control_by_sw;
        bool sw_ddr_en;
+       bool has_sec;
        u32 gce_num;
 };
 
@@ -566,14 +567,23 @@ static int cmdq_probe(struct platform_device *pdev)
        int alias_id = 0;
        static const char * const clk_name = "gce";
        static const char * const clk_names[] = { "gce0", "gce1" };
+       struct resource *res;
+       struct platform_device *mtk_cmdq_sec;
+       u32 hwid = 0;
 
        cmdq = devm_kzalloc(dev, sizeof(*cmdq), GFP_KERNEL);
        if (!cmdq)
                return -ENOMEM;
 
-       cmdq->base = devm_platform_ioremap_resource(pdev, 0);
-       if (IS_ERR(cmdq->base))
+       res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+       if (!res)
+               return -EINVAL;
+
+       cmdq->base = devm_ioremap_resource(dev, res);
+       if (IS_ERR(cmdq->base)) {
+               dev_err(dev, "failed to ioremap cmdq\n");
                return PTR_ERR(cmdq->base);
+       }
 
        cmdq->irq = platform_get_irq(pdev, 0);
        if (cmdq->irq < 0)
@@ -591,6 +601,8 @@ static int cmdq_probe(struct platform_device *pdev)
                dev, cmdq->base, cmdq->irq);
 
        if (cmdq->pdata->gce_num > 1) {
+               hwid = of_alias_get_id(dev->of_node, clk_name);
+
                for_each_child_of_node(phandle->parent, node) {
                        alias_id = of_alias_get_id(node, clk_name);
                        if (alias_id >= 0 && alias_id < cmdq->pdata->gce_num) {
@@ -659,6 +671,30 @@ static int cmdq_probe(struct platform_device *pdev)
                return err;
        }
 
+       if (cmdq->pdata->has_sec) {
+               struct cmdq_sec_plat gce_sec_plat;
+
+               if (of_property_read_u32_index(dev->of_node, 
"mediatek,gce-events", 0,
+                                              &gce_sec_plat.cmdq_event) == 0) {
+                       gce_sec_plat.gce_dev = dev;
+                       gce_sec_plat.base = cmdq->base;
+                       gce_sec_plat.base_pa = res->start;
+                       gce_sec_plat.hwid = hwid;
+                       gce_sec_plat.gce_num = cmdq->pdata->gce_num;
+                       gce_sec_plat.clocks = cmdq->clocks;
+                       gce_sec_plat.thread_nr = cmdq->pdata->thread_nr;
+
+                       mtk_cmdq_sec = platform_device_register_data(dev, 
"mtk_cmdq_sec",
+                                                                    
PLATFORM_DEVID_AUTO,
+                                                                    
&gce_sec_plat,
+                                                                    
sizeof(gce_sec_plat));
+                       if (IS_ERR(mtk_cmdq_sec)) {
+                               dev_err(dev, "failed to register 
platform_device mtk_cmdq_sec\n");
+                               return PTR_ERR(mtk_cmdq_sec);
+                       }
+               }
+       }
+
        return 0;
 }
 
diff --git a/include/linux/mailbox/mtk-cmdq-mailbox.h 
b/include/linux/mailbox/mtk-cmdq-mailbox.h
index fc663b994b7a..a8f4f78f21d8 100644
--- a/include/linux/mailbox/mtk-cmdq-mailbox.h
+++ b/include/linux/mailbox/mtk-cmdq-mailbox.h
@@ -79,6 +79,17 @@ struct cmdq_pkt {
        bool                    loop;
 };
 
+struct cmdq_sec_plat {
+       struct device *gce_dev;
+       void __iomem *base;
+       dma_addr_t base_pa;
+       u32 hwid;
+       u32 gce_num;
+       struct clk_bulk_data *clocks;
+       u32 thread_nr;
+       u32 cmdq_event;
+};
+
 u8 cmdq_get_shift_pa(struct mbox_chan *chan);
 void cmdq_mbox_stop(struct mbox_chan *chan);
 
-- 
2.18.0