For EARC and EARC PHY the reset happens when clearing the reset bits.
Refactor assert/deassert function in order to take into account the
active_low configuration option.

Signed-off-by: Daniel Baluta <daniel.bal...@nxp.com>
Reviewed-by: Philipp Zabel <p.za...@pengutronix.de>
Reviewed-by: Peng Fan <peng....@nxp.com>
Reviewed-by: Frank Li <frank...@nxp.com>
---
 drivers/reset/reset-imx8mp-audiomix.c | 41 ++++++++++++++-------------
 1 file changed, 22 insertions(+), 19 deletions(-)

diff --git a/drivers/reset/reset-imx8mp-audiomix.c 
b/drivers/reset/reset-imx8mp-audiomix.c
index d632bd380053..558da232ed8e 100644
--- a/drivers/reset/reset-imx8mp-audiomix.c
+++ b/drivers/reset/reset-imx8mp-audiomix.c
@@ -20,16 +20,19 @@
 struct imx8mp_reset_map {
        unsigned int offset;
        unsigned int mask;
+       bool active_low;
 };
 
 static const struct imx8mp_reset_map reset_map[] = {
        [IMX8MP_AUDIOMIX_EARC] = {
                .offset = IMX8MP_AUDIOMIX_EARC_OFFSET,
                .mask   = IMX8MP_AUDIOMIX_EARC_RESET_MASK,
+               .active_low = true,
        },
        [IMX8MP_AUDIOMIX_EARC_PHY] = {
                .offset = IMX8MP_AUDIOMIX_EARC_OFFSET,
                .mask   = IMX8MP_AUDIOMIX_EARC_PHY_RESET_MASK,
+               .active_low = true,
        },
 };
 
@@ -44,42 +47,42 @@ static struct imx8mp_audiomix_reset 
*to_imx8mp_audiomix_reset(struct reset_contr
        return container_of(rcdev, struct imx8mp_audiomix_reset, rcdev);
 }
 
-static int imx8mp_audiomix_reset_assert(struct reset_controller_dev *rcdev,
-                                       unsigned long id)
+static int imx8mp_audiomix_update(struct reset_controller_dev *rcdev,
+                                 unsigned long id, bool assert)
 {
        struct imx8mp_audiomix_reset *priv = to_imx8mp_audiomix_reset(rcdev);
        void __iomem *reg_addr = priv->base;
-       unsigned int mask, offset, reg;
-       unsigned long flags;
+       unsigned int mask, offset, active_low;
+       unsigned long reg, flags;
 
        mask = reset_map[id].mask;
        offset = reset_map[id].offset;
+       active_low = reset_map[id].active_low;
 
        spin_lock_irqsave(&priv->lock, flags);
+
        reg = readl(reg_addr + offset);
-       writel(reg & ~mask, reg_addr + offset);
+       if (active_low ^ assert)
+               reg |= mask;
+       else
+               reg &= ~mask;
+       writel(reg, reg_addr + offset);
+
        spin_unlock_irqrestore(&priv->lock, flags);
 
        return 0;
 }
 
+static int imx8mp_audiomix_reset_assert(struct reset_controller_dev *rcdev,
+                                       unsigned long id)
+{
+       return imx8mp_audiomix_update(rcdev, id, true);
+}
+
 static int imx8mp_audiomix_reset_deassert(struct reset_controller_dev *rcdev,
                                          unsigned long id)
 {
-       struct imx8mp_audiomix_reset *priv = to_imx8mp_audiomix_reset(rcdev);
-       void __iomem *reg_addr = priv->base;
-       unsigned int mask, offset, reg;
-       unsigned long flags;
-
-       mask = reset_map[id].mask;
-       offset = reset_map[id].offset;
-
-       spin_lock_irqsave(&priv->lock, flags);
-       reg = readl(reg_addr + offset);
-       writel(reg | mask, reg_addr + offset);
-       spin_unlock_irqrestore(&priv->lock, flags);
-
-       return 0;
+       return imx8mp_audiomix_update(rcdev, id, false);
 }
 
 static const struct reset_control_ops imx8mp_audiomix_reset_ops = {
-- 
2.43.0


Reply via email to