@@ -3,6 +3,8 @@
* Copyright 2024 NXP
*/
+#include <dt-bindings/reset/imx8mp-reset-audiomix.h>
+
#include <linux/auxiliary_bus.h>
#include <linux/device.h>
#include <linux/io.h>
@@ -12,7 +14,24 @@
#include <linux/reset-controller.h>
#define IMX8MP_AUDIOMIX_EARC_OFFSET 0x200
-#define IMX8MP_AUDIOMIX_EARC_RESET_MASK 0x3
+#define IMX8MP_AUDIOMIX_EARC_RESET_MASK BIT(1)
+#define IMX8MP_AUDIOMIX_EARC_PHY_RESET_MASK BIT(2)
+
+struct imx8mp_reset_map {
+ unsigned int offset;
+ unsigned int mask;
+};
+
+static const struct imx8mp_reset_map reset_map[] = {
+ [IMX8MP_AUDIOMIX_EARC] = {
+ .offset = IMX8MP_AUDIOMIX_EARC_OFFSET,
+ .mask = IMX8MP_AUDIOMIX_EARC_RESET_MASK,
+ },
+ [IMX8MP_AUDIOMIX_EARC_PHY] = {
+ .offset = IMX8MP_AUDIOMIX_EARC_OFFSET,
+ .mask = IMX8MP_AUDIOMIX_EARC_PHY_RESET_MASK,
+ },
+};
struct imx8mp_audiomix_reset {
struct reset_controller_dev rcdev;
@@ -30,13 +49,15 @@ static int imx8mp_audiomix_reset_assert(struct reset_controller_dev *rcdev,
{
struct imx8mp_audiomix_reset *priv = to_imx8mp_audiomix_reset(rcdev);
void __iomem *reg_addr = priv->base;
- unsigned int mask, reg;
+ unsigned int mask, offset, reg;
unsigned long flags;
- mask = BIT(id);
+ mask = reset_map[id].mask;
+ offset = reset_map[id].offset;
+
spin_lock_irqsave(&priv->lock, flags);
- reg = readl(reg_addr + IMX8MP_AUDIOMIX_EARC_OFFSET);
- writel(reg & ~mask, reg_addr + IMX8MP_AUDIOMIX_EARC_OFFSET);
+ reg = readl(reg_addr + offset);
+ writel(reg & ~mask, reg_addr + offset);
spin_unlock_irqrestore(&priv->lock, flags);
return 0;
@@ -47,13 +68,15 @@ static int imx8mp_audiomix_reset_deassert(struct reset_controller_dev *rcdev,
{
struct imx8mp_audiomix_reset *priv = to_imx8mp_audiomix_reset(rcdev);
void __iomem *reg_addr = priv->base;
- unsigned int mask, reg;
+ unsigned int mask, offset, reg;
unsigned long flags;
- mask = BIT(id);
+ mask = reset_map[id].mask;
+ offset = reset_map[id].offset;
+
spin_lock_irqsave(&priv->lock, flags);
- reg = readl(reg_addr + IMX8MP_AUDIOMIX_EARC_OFFSET);
- writel(reg | mask, reg_addr + IMX8MP_AUDIOMIX_EARC_OFFSET);
+ reg = readl(reg_addr + offset);
+ writel(reg | mask, reg_addr + offset);
spin_unlock_irqrestore(&priv->lock, flags);
return 0;
@@ -78,7 +101,7 @@ static int imx8mp_audiomix_reset_probe(struct auxiliary_device *adev,
spin_lock_init(&priv->lock);
priv->rcdev.owner = THIS_MODULE;
- priv->rcdev.nr_resets = fls(IMX8MP_AUDIOMIX_EARC_RESET_MASK);
+ priv->rcdev.nr_resets = ARRAY_SIZE(reset_map);
priv->rcdev.ops = &imx8mp_audiomix_reset_ops;
priv->rcdev.of_node = dev->parent->of_node;
priv->rcdev.dev = dev;