Message ID | 20250219192102.423850-6-daniel.baluta@nxp.com (mailing list archive) |
---|---|
State | New |
Headers | show |
Series | imx8mp: Add support to Run/Stall DSP via reset API | expand |
On Wed, Feb 19, 2025 at 09:20:59PM +0200, Daniel Baluta wrote: > Current code supports EARC PHY Software Reset and EARC Software > Reset but it is not easily extensible to more reset bits. > > So, refactor the code in order to easily allow more reset bits > in the future. If respin patch, please wrap at 75 char. > > Signed-off-by: Daniel Baluta <daniel.baluta@nxp.com> > --- > drivers/reset/reset-imx8mp-audiomix.c | 42 ++++++++++++++++++++------- > 1 file changed, 32 insertions(+), 10 deletions(-) > > diff --git a/drivers/reset/reset-imx8mp-audiomix.c b/drivers/reset/reset-imx8mp-audiomix.c > index 1fe21980a66c..17f78ccc7820 100644 > --- a/drivers/reset/reset-imx8mp-audiomix.c > +++ b/drivers/reset/reset-imx8mp-audiomix.c > @@ -3,6 +3,7 @@ > * Copyright 2024 NXP > */ > > +#include <dt-bindings/reset/imx8mp-reset-audiomix.h> Add empty line here Reviewed-by: Frank Li <Frank.Li@nxp.com> > #include <linux/auxiliary_bus.h> > #include <linux/device.h> > #include <linux/io.h> > @@ -12,7 +13,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 +48,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 +67,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 +100,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; > -- > 2.25.1 >
diff --git a/drivers/reset/reset-imx8mp-audiomix.c b/drivers/reset/reset-imx8mp-audiomix.c index 1fe21980a66c..17f78ccc7820 100644 --- a/drivers/reset/reset-imx8mp-audiomix.c +++ b/drivers/reset/reset-imx8mp-audiomix.c @@ -3,6 +3,7 @@ * 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 +13,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 +48,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 +67,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 +100,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;
Current code supports EARC PHY Software Reset and EARC Software Reset but it is not easily extensible to more reset bits. So, refactor the code in order to easily allow more reset bits in the future. Signed-off-by: Daniel Baluta <daniel.baluta@nxp.com> --- drivers/reset/reset-imx8mp-audiomix.c | 42 ++++++++++++++++++++------- 1 file changed, 32 insertions(+), 10 deletions(-)