[PATCH v1, 3/5] mailbox: mediatek: add control_by_sw private data

[Yongqiang Niu]

add control_by_sw private data

Signed-off-by: Yongqiang Niu <yongqiang....@mediatek.com>
---
 drivers/mailbox/mtk-cmdq-mailbox.c | 7 +++++++
 1 file changed, 7 insertions(+)

diff --git a/drivers/mailbox/mtk-cmdq-mailbox.c 
b/drivers/mailbox/mtk-cmdq-mailbox.c
index 5665b6e..1c01fe0 100644
--- a/drivers/mailbox/mtk-cmdq-mailbox.c
+++ b/drivers/mailbox/mtk-cmdq-mailbox.c
@@ -36,6 +36,8 @@
 #define CMDQ_THR_WAIT_TOKEN            0x30
 #define CMDQ_THR_PRIORITY              0x40
 
+#define GCE_GCTL_VALUE                 0x48
+
 #define CMDQ_THR_ACTIVE_SLOT_CYCLES    0x3200
 #define CMDQ_THR_ENABLED               0x1
 #define CMDQ_THR_DISABLED              0x0
@@ -76,11 +78,13 @@ struct cmdq {
        struct clk              *clock;
        bool                    suspended;
        u8                      shift_pa;
+       bool                    control_by_sw;
 };
 
 struct gce_plat {
        u32 thread_nr;
        u8 shift;
+       bool control_by_sw;
 };
 
 u8 cmdq_get_shift_pa(struct mbox_chan *chan)
@@ -121,6 +125,8 @@ static void cmdq_init(struct cmdq *cmdq)
        int i;
 
        WARN_ON(clk_enable(cmdq->clock) < 0);
+       if (cmdq->control_by_sw)
+               writel(0x7, cmdq->base + GCE_GCTL_VALUE);
        writel(CMDQ_THR_ACTIVE_SLOT_CYCLES, cmdq->base + CMDQ_THR_SLOT_CYCLES);
        for (i = 0; i <= CMDQ_MAX_EVENT; i++)
                writel(i, cmdq->base + CMDQ_SYNC_TOKEN_UPDATE);
@@ -536,6 +542,7 @@ static int cmdq_probe(struct platform_device *pdev)
 
        cmdq->thread_nr = plat_data->thread_nr;
        cmdq->shift_pa = plat_data->shift;
+       cmdq->control_by_sw = plat_data->control_by_sw;
        cmdq->irq_mask = GENMASK(cmdq->thread_nr - 1, 0);
        err = devm_request_irq(dev, cmdq->irq, cmdq_irq_handler, IRQF_SHARED,
                               "mtk_cmdq", cmdq);
-- 
1.8.1.1.dirty