On Sun, Nov 28, 2021 at 6:47 PM Ezequiel Garcia <ezequiel@xxxxxxxxxxxxxxxxxxxx> wrote: > > Hi Benjamin, > > On Thu, Nov 25, 2021 at 04:56:49PM +0100, Benjamin Gaignard wrote: > > In order to be able to share the control hardware block between > > VPUs use a syscon instead a ioremap it in the driver. > > To keep the compatibility with older DT if 'nxp,imx8mq-vpu-ctrl' > > phandle is not found look at 'ctrl' reg-name. > > With the method it becomes useless to provide a list of register > > names so remove it. > > > > Signed-off-by: Benjamin Gaignard <benjamin.gaignard@xxxxxxxxxxxxx> > > Reviewed-by: Philipp Zabel <p.zabel@xxxxxxxxxxxxxx> > > > > Please note that the only purpose of this commit is to allow to test > > G2 hardware block for IMX8MQ until a proper solution isuing power domain > > can be found. Do not merge it. > > It's been too many months waiting for the BLK-CTRL to be solved. > Perhaps we can consider merging this approach instead. If someone wants to send me an imx8mq board, I can attempt to work on the blk-ctrl. I ported it to imx8mn, and I have sent an update for imx8mm. I just don't have any imx8mq hardware. adam > > Thanks, > Ezequiel > > > --- > > drivers/staging/media/hantro/hantro.h | 5 ++- > > drivers/staging/media/hantro/imx8m_vpu_hw.c | 48 +++++++++++++-------- > > 2 files changed, 34 insertions(+), 19 deletions(-) > > > > diff --git a/drivers/staging/media/hantro/hantro.h b/drivers/staging/media/hantro/hantro.h > > index 7da23f7f207a..616b5a6854cd 100644 > > --- a/drivers/staging/media/hantro/hantro.h > > +++ b/drivers/staging/media/hantro/hantro.h > > @@ -13,6 +13,7 @@ > > #define HANTRO_H_ > > > > #include <linux/platform_device.h> > > +#include <linux/regmap.h> > > #include <linux/videodev2.h> > > #include <linux/wait.h> > > #include <linux/clk.h> > > @@ -174,7 +175,7 @@ hantro_vdev_to_func(struct video_device *vdev) > > * @reg_bases: Mapped addresses of VPU registers. > > * @enc_base: Mapped address of VPU encoder register for convenience. > > * @dec_base: Mapped address of VPU decoder register for convenience. > > - * @ctrl_base: Mapped address of VPU control block. > > + * @ctrl_base: Regmap of VPU control block. > > * @vpu_mutex: Mutex to synchronize V4L2 calls. > > * @irqlock: Spinlock to synchronize access to data structures > > * shared with interrupt handlers. > > @@ -193,7 +194,7 @@ struct hantro_dev { > > void __iomem **reg_bases; > > void __iomem *enc_base; > > void __iomem *dec_base; > > - void __iomem *ctrl_base; > > + struct regmap *ctrl_base; > > > > struct mutex vpu_mutex; /* video_device lock */ > > spinlock_t irqlock; > > diff --git a/drivers/staging/media/hantro/imx8m_vpu_hw.c b/drivers/staging/media/hantro/imx8m_vpu_hw.c > > index 1a43f6fceef9..d7a63b41eb0e 100644 > > --- a/drivers/staging/media/hantro/imx8m_vpu_hw.c > > +++ b/drivers/staging/media/hantro/imx8m_vpu_hw.c > > @@ -7,6 +7,7 @@ > > > > #include <linux/clk.h> > > #include <linux/delay.h> > > +#include <linux/mfd/syscon.h> > > > > #include "hantro.h" > > #include "hantro_jpeg.h" > > @@ -25,30 +26,28 @@ > > #define CTRL_G1_PP_FUSE 0x0c > > #define CTRL_G2_DEC_FUSE 0x10 > > > > +static const struct regmap_config ctrl_regmap_ctrl = { > > + .reg_bits = 32, > > + .val_bits = 32, > > + .reg_stride = 0x14, > > +}; > > + > > static void imx8m_soft_reset(struct hantro_dev *vpu, u32 reset_bits) > > { > > - u32 val; > > - > > /* Assert */ > > - val = readl(vpu->ctrl_base + CTRL_SOFT_RESET); > > - val &= ~reset_bits; > > - writel(val, vpu->ctrl_base + CTRL_SOFT_RESET); > > + regmap_update_bits(vpu->ctrl_base, CTRL_SOFT_RESET, reset_bits, 0); > > > > udelay(2); > > > > /* Release */ > > - val = readl(vpu->ctrl_base + CTRL_SOFT_RESET); > > - val |= reset_bits; > > - writel(val, vpu->ctrl_base + CTRL_SOFT_RESET); > > + regmap_update_bits(vpu->ctrl_base, CTRL_SOFT_RESET, > > + reset_bits, reset_bits); > > } > > > > static void imx8m_clk_enable(struct hantro_dev *vpu, u32 clock_bits) > > { > > - u32 val; > > - > > - val = readl(vpu->ctrl_base + CTRL_CLOCK_ENABLE); > > - val |= clock_bits; > > - writel(val, vpu->ctrl_base + CTRL_CLOCK_ENABLE); > > + regmap_update_bits(vpu->ctrl_base, CTRL_CLOCK_ENABLE, > > + clock_bits, clock_bits); > > } > > > > static int imx8mq_runtime_resume(struct hantro_dev *vpu) > > @@ -65,9 +64,9 @@ static int imx8mq_runtime_resume(struct hantro_dev *vpu) > > imx8m_clk_enable(vpu, CLOCK_G1 | CLOCK_G2); > > > > /* Set values of the fuse registers */ > > - writel(0xffffffff, vpu->ctrl_base + CTRL_G1_DEC_FUSE); > > - writel(0xffffffff, vpu->ctrl_base + CTRL_G1_PP_FUSE); > > - writel(0xffffffff, vpu->ctrl_base + CTRL_G2_DEC_FUSE); > > + regmap_write(vpu->ctrl_base, CTRL_G1_DEC_FUSE, 0xffffffff); > > + regmap_write(vpu->ctrl_base, CTRL_G1_PP_FUSE, 0xffffffff); > > + regmap_write(vpu->ctrl_base, CTRL_G2_DEC_FUSE, 0xffffffff); > > > > clk_bulk_disable_unprepare(vpu->variant->num_clocks, vpu->clocks); > > > > @@ -211,7 +210,22 @@ static irqreturn_t imx8m_vpu_g2_irq(int irq, void *dev_id) > > > > static int imx8mq_vpu_hw_init(struct hantro_dev *vpu) > > { > > - vpu->ctrl_base = vpu->reg_bases[vpu->variant->num_regs - 1]; > > + struct device_node *np = vpu->dev->of_node; > > + > > + vpu->ctrl_base = syscon_regmap_lookup_by_phandle(np, "nxp,imx8m-vpu-ctrl"); > > + if (IS_ERR(vpu->ctrl_base)) { > > + struct resource *res; > > + void __iomem *ctrl; > > + > > + res = platform_get_resource_byname(vpu->pdev, IORESOURCE_MEM, "ctrl"); > > + ctrl = devm_ioremap_resource(vpu->dev, res); > > + if (IS_ERR(ctrl)) > > + return PTR_ERR(ctrl); > > + > > + vpu->ctrl_base = devm_regmap_init_mmio(vpu->dev, ctrl, &ctrl_regmap_ctrl); > > + if (IS_ERR(vpu->ctrl_base)) > > + return PTR_ERR(vpu->ctrl_base); > > + } > > > > return 0; > > } > > -- > > 2.30.2 > >