@@ -19,16 +19,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,
},
};
@@ -43,42 +46,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 = {