soc: mediatek: PMIC wrap: add a slave specific struct

This patch adds a new struct pwrap_slv_type that we use to store the slave
specific data. The patch adds 2 new helper functions to access the dew
registers. The slave type is looked up via the wrappers child node.

Signed-off-by: John Crispin <blogic@openwrt.org>
Signed-off-by: Matthias Brugger <matthias.bgg@gmail.com>

diff --git a/drivers/soc/mediatek/mtk-pmic-wrap.c b/drivers/soc/mediatek/mtk-pmic-wrap.c
index a2bacda5a65dd3953a3ab8b42e93fa32df51824a..bcc841ebbdc37b8d6bebc18d48f6e8962de1311f 100644 (file)
--- a/drivers/soc/mediatek/mtk-pmic-wrap.c
+++ b/drivers/soc/mediatek/mtk-pmic-wrap.c
@@ -69,33 +69,54 @@
                                          PWRAP_WDT_SRC_EN_HARB_STAUPD_DLE | \
                                          PWRAP_WDT_SRC_EN_HARB_STAUPD_ALE)
 
-/* macro for slave device wrapper registers */
-#define PWRAP_DEW_BASE                 0xbc00
-#define PWRAP_DEW_EVENT_OUT_EN         (PWRAP_DEW_BASE + 0x0)
-#define PWRAP_DEW_DIO_EN               (PWRAP_DEW_BASE + 0x2)
-#define PWRAP_DEW_EVENT_SRC_EN         (PWRAP_DEW_BASE + 0x4)
-#define PWRAP_DEW_EVENT_SRC            (PWRAP_DEW_BASE + 0x6)
-#define PWRAP_DEW_EVENT_FLAG           (PWRAP_DEW_BASE + 0x8)
-#define PWRAP_DEW_READ_TEST            (PWRAP_DEW_BASE + 0xa)
-#define PWRAP_DEW_WRITE_TEST           (PWRAP_DEW_BASE + 0xc)
-#define PWRAP_DEW_CRC_EN               (PWRAP_DEW_BASE + 0xe)
-#define PWRAP_DEW_CRC_VAL              (PWRAP_DEW_BASE + 0x10)
-#define PWRAP_DEW_MON_GRP_SEL          (PWRAP_DEW_BASE + 0x12)
-#define PWRAP_DEW_MON_FLAG_SEL         (PWRAP_DEW_BASE + 0x14)
-#define PWRAP_DEW_EVENT_TEST           (PWRAP_DEW_BASE + 0x16)
-#define PWRAP_DEW_CIPHER_KEY_SEL       (PWRAP_DEW_BASE + 0x18)
-#define PWRAP_DEW_CIPHER_IV_SEL                (PWRAP_DEW_BASE + 0x1a)
-#define PWRAP_DEW_CIPHER_LOAD          (PWRAP_DEW_BASE + 0x1c)
-#define PWRAP_DEW_CIPHER_START         (PWRAP_DEW_BASE + 0x1e)
-#define PWRAP_DEW_CIPHER_RDY           (PWRAP_DEW_BASE + 0x20)
-#define PWRAP_DEW_CIPHER_MODE          (PWRAP_DEW_BASE + 0x22)
-#define PWRAP_DEW_CIPHER_SWRST         (PWRAP_DEW_BASE + 0x24)
-#define PWRAP_MT8173_DEW_CIPHER_IV0    (PWRAP_DEW_BASE + 0x26)
-#define PWRAP_MT8173_DEW_CIPHER_IV1    (PWRAP_DEW_BASE + 0x28)
-#define PWRAP_MT8173_DEW_CIPHER_IV2    (PWRAP_DEW_BASE + 0x2a)
-#define PWRAP_MT8173_DEW_CIPHER_IV3    (PWRAP_DEW_BASE + 0x2c)
-#define PWRAP_MT8173_DEW_CIPHER_IV4    (PWRAP_DEW_BASE + 0x2e)
-#define PWRAP_MT8173_DEW_CIPHER_IV5    (PWRAP_DEW_BASE + 0x30)
+/* defines for slave device wrapper registers */
+enum dew_regs {
+       PWRAP_DEW_BASE,
+       PWRAP_DEW_DIO_EN,
+       PWRAP_DEW_READ_TEST,
+       PWRAP_DEW_WRITE_TEST,
+       PWRAP_DEW_CRC_EN,
+       PWRAP_DEW_CRC_VAL,
+       PWRAP_DEW_MON_GRP_SEL,
+       PWRAP_DEW_CIPHER_KEY_SEL,
+       PWRAP_DEW_CIPHER_IV_SEL,
+       PWRAP_DEW_CIPHER_RDY,
+       PWRAP_DEW_CIPHER_MODE,
+       PWRAP_DEW_CIPHER_SWRST,
+
+       /* MT6397 only regs */
+       PWRAP_DEW_EVENT_OUT_EN,
+       PWRAP_DEW_EVENT_SRC_EN,
+       PWRAP_DEW_EVENT_SRC,
+       PWRAP_DEW_EVENT_FLAG,
+       PWRAP_DEW_MON_FLAG_SEL,
+       PWRAP_DEW_EVENT_TEST,
+       PWRAP_DEW_CIPHER_LOAD,
+       PWRAP_DEW_CIPHER_START,
+};
+
+static const u32 mt6397_regs[] = {
+       [PWRAP_DEW_BASE] =              0xbc00,
+       [PWRAP_DEW_EVENT_OUT_EN] =      0xbc00,
+       [PWRAP_DEW_DIO_EN] =            0xbc02,
+       [PWRAP_DEW_EVENT_SRC_EN] =      0xbc04,
+       [PWRAP_DEW_EVENT_SRC] =         0xbc06,
+       [PWRAP_DEW_EVENT_FLAG] =        0xbc08,
+       [PWRAP_DEW_READ_TEST] =         0xbc0a,
+       [PWRAP_DEW_WRITE_TEST] =        0xbc0c,
+       [PWRAP_DEW_CRC_EN] =            0xbc0e,
+       [PWRAP_DEW_CRC_VAL] =           0xbc10,
+       [PWRAP_DEW_MON_GRP_SEL] =       0xbc12,
+       [PWRAP_DEW_MON_FLAG_SEL] =      0xbc14,
+       [PWRAP_DEW_EVENT_TEST] =        0xbc16,
+       [PWRAP_DEW_CIPHER_KEY_SEL] =    0xbc18,
+       [PWRAP_DEW_CIPHER_IV_SEL] =     0xbc1a,
+       [PWRAP_DEW_CIPHER_LOAD] =       0xbc1c,
+       [PWRAP_DEW_CIPHER_START] =      0xbc1e,
+       [PWRAP_DEW_CIPHER_RDY] =        0xbc20,
+       [PWRAP_DEW_CIPHER_MODE] =       0xbc22,
+       [PWRAP_DEW_CIPHER_SWRST] =      0xbc24,
+};
 
 enum pwrap_regs {
        PWRAP_MUX_SEL,
@@ -349,16 +370,26 @@ static int mt8135_regs[] = {
        [PWRAP_DCM_DBC_PRD] =           0x160,
 };
 
+enum pmic_type {
+       PMIC_MT6397,
+};
+
 enum pwrap_type {
        PWRAP_MT8135,
        PWRAP_MT8173,
 };
 
+struct pwrap_slv_type {
+       const u32 *dew_regs;
+       enum pmic_type type;
+};
+
 struct pmic_wrapper {
        struct device *dev;
        void __iomem *base;
        struct regmap *regmap;
        const struct pmic_wrapper_type *master;
+       const struct pwrap_slv_type *slave;
        struct clk *clk_spi;
        struct clk *clk_wrap;
        struct reset_control *rstc;
@@ -544,7 +575,8 @@ static int pwrap_init_sidly(struct pmic_wrapper *wrp)
 
        for (i = 0; i < 4; i++) {
                pwrap_writel(wrp, i, PWRAP_SIDLY);
-               pwrap_read(wrp, PWRAP_DEW_READ_TEST, &rdata);
+               pwrap_read(wrp, wrp->slave->dew_regs[PWRAP_DEW_READ_TEST],
+                          &rdata);
                if (rdata == PWRAP_DEW_READ_TEST_VAL) {
                        dev_dbg(wrp->dev, "[Read Test] pass, SIDLY=%x\n", i);
                        pass |= 1 << i;
@@ -593,7 +625,8 @@ static bool pwrap_is_pmic_cipher_ready(struct pmic_wrapper *wrp)
        u32 rdata;
        int ret;
 
-       ret = pwrap_read(wrp, PWRAP_DEW_CIPHER_RDY, &rdata);
+       ret = pwrap_read(wrp, wrp->slave->dew_regs[PWRAP_DEW_CIPHER_RDY],
+                        &rdata);
        if (ret)
                return 0;
 
@@ -621,12 +654,12 @@ static int pwrap_init_cipher(struct pmic_wrapper *wrp)
        }
 
        /* Config cipher mode @PMIC */
-       pwrap_write(wrp, PWRAP_DEW_CIPHER_SWRST, 0x1);
-       pwrap_write(wrp, PWRAP_DEW_CIPHER_SWRST, 0x0);
-       pwrap_write(wrp, PWRAP_DEW_CIPHER_KEY_SEL, 0x1);
-       pwrap_write(wrp, PWRAP_DEW_CIPHER_IV_SEL, 0x2);
-       pwrap_write(wrp, PWRAP_DEW_CIPHER_LOAD, 0x1);
-       pwrap_write(wrp, PWRAP_DEW_CIPHER_START, 0x1);
+       pwrap_write(wrp, wrp->slave->dew_regs[PWRAP_DEW_CIPHER_SWRST], 0x1);
+       pwrap_write(wrp, wrp->slave->dew_regs[PWRAP_DEW_CIPHER_SWRST], 0x0);
+       pwrap_write(wrp, wrp->slave->dew_regs[PWRAP_DEW_CIPHER_KEY_SEL], 0x1);
+       pwrap_write(wrp, wrp->slave->dew_regs[PWRAP_DEW_CIPHER_IV_SEL], 0x2);
+       pwrap_write(wrp, wrp->slave->dew_regs[PWRAP_DEW_CIPHER_LOAD], 0x1);
+       pwrap_write(wrp, wrp->slave->dew_regs[PWRAP_DEW_CIPHER_START], 0x1);
 
        /* wait for cipher data ready@AP */
        ret = pwrap_wait_for_state(wrp, pwrap_is_cipher_ready);
@@ -643,7 +676,7 @@ static int pwrap_init_cipher(struct pmic_wrapper *wrp)
        }
 
        /* wait for cipher mode idle */
-       pwrap_write(wrp, PWRAP_DEW_CIPHER_MODE, 0x1);
+       pwrap_write(wrp, wrp->slave->dew_regs[PWRAP_DEW_CIPHER_MODE], 0x1);
        ret = pwrap_wait_for_state(wrp, pwrap_is_fsm_idle_and_sync_idle);
        if (ret) {
                dev_err(wrp->dev, "cipher mode idle fail, ret=%d\n", ret);
@@ -653,9 +686,11 @@ static int pwrap_init_cipher(struct pmic_wrapper *wrp)
        pwrap_writel(wrp, 1, PWRAP_CIPHER_MODE);
 
        /* Write Test */
-       if (pwrap_write(wrp, PWRAP_DEW_WRITE_TEST, PWRAP_DEW_WRITE_TEST_VAL) ||
-           pwrap_read(wrp, PWRAP_DEW_WRITE_TEST, &rdata) ||
-                       (rdata != PWRAP_DEW_WRITE_TEST_VAL)) {
+       if (pwrap_write(wrp, wrp->slave->dew_regs[PWRAP_DEW_WRITE_TEST],
+                       PWRAP_DEW_WRITE_TEST_VAL) ||
+           pwrap_read(wrp, wrp->slave->dew_regs[PWRAP_DEW_WRITE_TEST],
+                      &rdata) ||
+           (rdata != PWRAP_DEW_WRITE_TEST_VAL)) {
                dev_err(wrp->dev, "rdata=0x%04X\n", rdata);
                return -EFAULT;
        }
@@ -677,8 +712,10 @@ static int pwrap_mt8135_init_soc_specific(struct pmic_wrapper *wrp)
        writel(0x7ff, wrp->bridge_base + PWRAP_MT8135_BRIDGE_INT_EN);
 
        /* enable PMIC event out and sources */
-       if (pwrap_write(wrp, PWRAP_DEW_EVENT_OUT_EN, 0x1) ||
-               pwrap_write(wrp, PWRAP_DEW_EVENT_SRC_EN, 0xffff)) {
+       if (pwrap_write(wrp, wrp->slave->dew_regs[PWRAP_DEW_EVENT_OUT_EN],
+                       0x1) ||
+           pwrap_write(wrp, wrp->slave->dew_regs[PWRAP_DEW_EVENT_SRC_EN],
+                       0xffff)) {
                dev_err(wrp->dev, "enable dewrap fail\n");
                return -EFAULT;
        }
@@ -689,8 +726,10 @@ static int pwrap_mt8135_init_soc_specific(struct pmic_wrapper *wrp)
 static int pwrap_mt8173_init_soc_specific(struct pmic_wrapper *wrp)
 {
        /* PMIC_DEWRAP enables */
-       if (pwrap_write(wrp, PWRAP_DEW_EVENT_OUT_EN, 0x1) ||
-               pwrap_write(wrp, PWRAP_DEW_EVENT_SRC_EN, 0xffff)) {
+       if (pwrap_write(wrp, wrp->slave->dew_regs[PWRAP_DEW_EVENT_OUT_EN],
+                       0x1) ||
+           pwrap_write(wrp, wrp->slave->dew_regs[PWRAP_DEW_EVENT_SRC_EN],
+                       0xffff)) {
                dev_err(wrp->dev, "enable dewrap fail\n");
                return -EFAULT;
        }
@@ -734,7 +773,7 @@ static int pwrap_init(struct pmic_wrapper *wrp)
                return ret;
 
        /* Enable dual IO mode */
-       pwrap_write(wrp, PWRAP_DEW_DIO_EN, 1);
+       pwrap_write(wrp, wrp->slave->dew_regs[PWRAP_DEW_DIO_EN], 1);
 
        /* Check IDLE & INIT_DONE in advance */
        ret = pwrap_wait_for_state(wrp, pwrap_is_fsm_idle_and_sync_idle);
@@ -746,7 +785,7 @@ static int pwrap_init(struct pmic_wrapper *wrp)
        pwrap_writel(wrp, 1, PWRAP_DIO_EN);
 
        /* Read Test */
-       pwrap_read(wrp, PWRAP_DEW_READ_TEST, &rdata);
+       pwrap_read(wrp, wrp->slave->dew_regs[PWRAP_DEW_READ_TEST], &rdata);
        if (rdata != PWRAP_DEW_READ_TEST_VAL) {
                dev_err(wrp->dev, "Read test failed after switch to DIO mode: 0x%04x != 0x%04x\n",
                                PWRAP_DEW_READ_TEST_VAL, rdata);
@@ -759,12 +798,13 @@ static int pwrap_init(struct pmic_wrapper *wrp)
                return ret;
 
        /* Signature checking - using CRC */
-       if (pwrap_write(wrp, PWRAP_DEW_CRC_EN, 0x1))
+       if (pwrap_write(wrp, wrp->slave->dew_regs[PWRAP_DEW_CRC_EN], 0x1))
                return -EFAULT;
 
        pwrap_writel(wrp, 0x1, PWRAP_CRC_EN);
        pwrap_writel(wrp, 0x0, PWRAP_SIG_MODE);
-       pwrap_writel(wrp, PWRAP_DEW_CRC_VAL, PWRAP_SIG_ADR);
+       pwrap_writel(wrp, wrp->slave->dew_regs[PWRAP_DEW_CRC_VAL],
+                    PWRAP_SIG_ADR);
        pwrap_writel(wrp, wrp->master->arb_en_all, PWRAP_HIPRIO_ARB_EN);
 
        if (wrp->master->type == PWRAP_MT8135)
@@ -818,6 +858,21 @@ static const struct regmap_config pwrap_regmap_config = {
        .max_register = 0xffff,
 };
 
+static const struct pwrap_slv_type pmic_mt6397 = {
+       .dew_regs = mt6397_regs,
+       .type = PMIC_MT6397,
+};
+
+static const struct of_device_id of_slave_match_tbl[] = {
+       {
+               .compatible = "mediatek,mt6397",
+               .data = &pmic_mt6397,
+       }, {
+               /* sentinel */
+       }
+};
+MODULE_DEVICE_TABLE(of, of_slave_match_tbl);
+
 static struct pmic_wrapper_type pwrap_mt8135 = {
        .regs = mt8135_regs,
        .type = PWRAP_MT8135,
@@ -862,8 +917,17 @@ static int pwrap_probe(struct platform_device *pdev)
        struct device_node *np = pdev->dev.of_node;
        const struct of_device_id *of_id =
                of_match_device(of_pwrap_match_tbl, &pdev->dev);
+       const struct of_device_id *of_slave_id = NULL;
        struct resource *res;
 
+       if (pdev->dev.of_node->child)
+               of_slave_id = of_match_node(of_slave_match_tbl,
+                                           pdev->dev.of_node->child);
+       if (!of_slave_id) {
+               dev_dbg(&pdev->dev, "slave pmic should be defined in dts\n");
+               return -EINVAL;
+       }
+
        wrp = devm_kzalloc(&pdev->dev, sizeof(*wrp), GFP_KERNEL);
        if (!wrp)
                return -ENOMEM;
@@ -871,6 +935,7 @@ static int pwrap_probe(struct platform_device *pdev)
        platform_set_drvdata(pdev, wrp);
 
        wrp->master = of_id->data;
+       wrp->slave = of_slave_id->data;
        wrp->dev = &pdev->dev;
 
        res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "pwrap");