[PATCH v5 10/10] media: stm32-dma2d: STM32 DMA2D driver
Dillon Min
dillon.minfei at gmail.com
Mon Oct 18 19:30:01 PDT 2021
Hi Hans
On Mon, 18 Oct 2021 at 18:25, Dillon Min <dillon.minfei at gmail.com> wrote:
>
> Hi Hans
>
> On Mon, 18 Oct 2021 at 17:30, Hans Verkuil <hverkuil-cisco at xs4all.nl> wrote:
> >
> > On 18/10/2021 07:04, dillon.minfei at gmail.com wrote:
> > > From: Dillon Min <dillon.minfei at gmail.com>
> > >
> > > This V4L2 subdev m2m driver enables Chrom-Art Accelerator unit
> > > of STMicroelectronics STM32 SoC series.
> > >
> > > Currently support r2m, m2m, m2m_pfc functions.
> > > - r2m, Filling a part or the whole of a destination image with a specific
> > > color.
> > > - m2m, Copying a part or the whole of a source image into a part or the
> > > whole of a destination.
> > > - m2m_pfc, Copying a part or the whole of a source image into a part or the
> > > whole of a destination image with a pixel format conversion.
> > >
> > > Signed-off-by: Dillon Min <dillon.minfei at gmail.com>
> > > ---
> > > v5:
> > > - remove useless log from dma2d driver.
> > > - update config VIDEO_STM32_DMA2D description.
> > >
> > > drivers/media/platform/Kconfig | 11 +
> > > drivers/media/platform/Makefile | 1 +
> > > drivers/media/platform/stm32/Makefile | 2 +
> > > drivers/media/platform/stm32/dma2d/dma2d-hw.c | 143 +++++
> > > drivers/media/platform/stm32/dma2d/dma2d-regs.h | 113 ++++
> > > drivers/media/platform/stm32/dma2d/dma2d.c | 739 ++++++++++++++++++++++++
> > > drivers/media/platform/stm32/dma2d/dma2d.h | 135 +++++
> > > 7 files changed, 1144 insertions(+)
> > > create mode 100644 drivers/media/platform/stm32/dma2d/dma2d-hw.c
> > > create mode 100644 drivers/media/platform/stm32/dma2d/dma2d-regs.h
> > > create mode 100644 drivers/media/platform/stm32/dma2d/dma2d.c
> > > create mode 100644 drivers/media/platform/stm32/dma2d/dma2d.h
> > >
> > > diff --git a/drivers/media/platform/Kconfig b/drivers/media/platform/Kconfig
> > > index d9f90084c2f6..0b3bdf56b44e 100644
> > > --- a/drivers/media/platform/Kconfig
> > > +++ b/drivers/media/platform/Kconfig
> > > @@ -476,6 +476,17 @@ config VIDEO_STI_DELTA_DRIVER
> > >
> > > endif # VIDEO_STI_DELTA
> > >
> > > +config VIDEO_STM32_DMA2D
> > > + tristate "STM32 Chrom-Art Accelerator (DMA2D)"
> > > + depends on (VIDEO_DEV && VIDEO_V4L2 && ARCH_STM32) || COMPILE_TEST
> > > + select VIDEOBUF2_DMA_CONTIG
> > > + select V4L2_MEM2MEM_DEV
> > > + help
> > > + Enables DMA2D hwarware support on stm32.
> > > +
> > > + The STM32 DMA2D is a memory-to-memory engine for pixel conversion
> > > + and specialized DMA dedicated to image manipulation.
> > > +
> > > config VIDEO_RENESAS_FDP1
> > > tristate "Renesas Fine Display Processor"
> > > depends on VIDEO_DEV && VIDEO_V4L2
> > > diff --git a/drivers/media/platform/Makefile b/drivers/media/platform/Makefile
> > > index 73ce083c2fc6..46f1c05bc576 100644
> > > --- a/drivers/media/platform/Makefile
> > > +++ b/drivers/media/platform/Makefile
> > > @@ -70,6 +70,7 @@ obj-$(CONFIG_VIDEO_ATMEL_ISI) += atmel/
> > > obj-$(CONFIG_VIDEO_ATMEL_XISC) += atmel/
> > >
> > > obj-$(CONFIG_VIDEO_STM32_DCMI) += stm32/
> > > +obj-$(CONFIG_VIDEO_STM32_DMA2D) += stm32/
> > >
> > > obj-$(CONFIG_VIDEO_MEDIATEK_VPU) += mtk-vpu/
> > >
> > > diff --git a/drivers/media/platform/stm32/Makefile b/drivers/media/platform/stm32/Makefile
> > > index 48b36db2c2e2..896ef98a73ab 100644
> > > --- a/drivers/media/platform/stm32/Makefile
> > > +++ b/drivers/media/platform/stm32/Makefile
> > > @@ -1,2 +1,4 @@
> > > # SPDX-License-Identifier: GPL-2.0-only
> > > obj-$(CONFIG_VIDEO_STM32_DCMI) += stm32-dcmi.o
> > > +stm32-dma2d-objs := dma2d/dma2d.o dma2d/dma2d-hw.o
> > > +obj-$(CONFIG_VIDEO_STM32_DMA2D) += stm32-dma2d.o
> > > diff --git a/drivers/media/platform/stm32/dma2d/dma2d-hw.c b/drivers/media/platform/stm32/dma2d/dma2d-hw.c
> > > new file mode 100644
> > > index 000000000000..8c1c664ab13b
> > > --- /dev/null
> > > +++ b/drivers/media/platform/stm32/dma2d/dma2d-hw.c
> > > @@ -0,0 +1,143 @@
> > > +// SPDX-License-Identifier: GPL-2.0-or-later
> > > +/*
> > > + * ST stm32 Chrom-Art - 2D Graphics Accelerator Driver
> > > + *
> > > + * Copyright (c) 2021 Dillon Min
> > > + * Dillon Min, <dillon.minfei at gmail.com>
> > > + *
> > > + * based on s5p-g2d
> > > + *
> > > + * Copyright (c) 2011 Samsung Electronics Co., Ltd.
> > > + * Kamil Debski, <k.debski at samsung.com>
> > > + */
> > > +
> > > +#include <linux/io.h>
> > > +
> > > +#include "dma2d.h"
> > > +#include "dma2d-regs.h"
> > > +
> > > +static inline u32 reg_read(void __iomem *base, u32 reg)
> > > +{
> > > + return readl_relaxed(base + reg);
> > > +}
> > > +
> > > +static inline void reg_write(void __iomem *base, u32 reg, u32 val)
> > > +{
> > > + writel_relaxed(val, base + reg);
> > > +}
> > > +
> > > +static inline void reg_set(void __iomem *base, u32 reg, u32 mask)
> > > +{
> > > + reg_write(base, reg, reg_read(base, reg) | mask);
> > > +}
> > > +
> > > +static inline void reg_clear(void __iomem *base, u32 reg, u32 mask)
> > > +{
> > > + reg_write(base, reg, reg_read(base, reg) & ~mask);
> > > +}
> > > +
> > > +static inline void reg_update_bits(void __iomem *base, u32 reg, u32 mask,
> > > + u32 val)
> > > +{
> > > + reg_write(base, reg, (reg_read(base, reg) & ~mask) | val);
> > > +}
> > > +
> > > +void dma2d_start(struct dma2d_dev *d)
> > > +{
> > > + reg_update_bits(d->regs, DMA2D_CR_REG, CR_START, CR_START);
> > > +}
> > > +
> > > +u32 dma2d_get_int(struct dma2d_dev *d)
> > > +{
> > > + return reg_read(d->regs, DMA2D_ISR_REG);
> > > +}
> > > +
> > > +void dma2d_clear_int(struct dma2d_dev *d)
> > > +{
> > > + u32 isr_val = reg_read(d->regs, DMA2D_ISR_REG);
> > > +
> > > + reg_write(d->regs, DMA2D_IFCR_REG, isr_val & 0x003f);
> > > +}
> > > +
> > > +void dma2d_config_common(struct dma2d_dev *d, enum dma2d_op_mode op_mode,
> > > + u16 width, u16 height)
> > > +{
> > > + reg_update_bits(d->regs, DMA2D_CR_REG, CR_MODE_MASK,
> > > + op_mode << CR_MODE_SHIFT);
> > > +
> > > + reg_write(d->regs, DMA2D_NLR_REG, (width << 16) | height);
> > > +}
> > > +
> > > +void dma2d_config_out(struct dma2d_dev *d, struct dma2d_frame *frm,
> > > + dma_addr_t o_addr)
> > > +{
> > > + reg_update_bits(d->regs, DMA2D_CR_REG, CR_CEIE, CR_CEIE);
> > > + reg_update_bits(d->regs, DMA2D_CR_REG, CR_CTCIE, CR_CTCIE);
> > > + reg_update_bits(d->regs, DMA2D_CR_REG, CR_CAEIE, CR_CAEIE);
> > > + reg_update_bits(d->regs, DMA2D_CR_REG, CR_TCIE, CR_TCIE);
> > > + reg_update_bits(d->regs, DMA2D_CR_REG, CR_TEIE, CR_TEIE);
> > > +
> > > + if (frm->fmt->cmode >= CM_MODE_ARGB8888 &&
> > > + frm->fmt->cmode <= CM_MODE_ARGB4444)
> > > + reg_update_bits(d->regs, DMA2D_OPFCCR_REG, OPFCCR_CM_MASK,
> > > + frm->fmt->cmode);
> > > +
> > > + reg_write(d->regs, DMA2D_OMAR_REG, o_addr);
> > > +
> > > + reg_write(d->regs, DMA2D_OCOLR_REG,
> > > + (frm->a_rgb[3] << 24) |
> > > + (frm->a_rgb[2] << 16) |
> > > + (frm->a_rgb[1] << 8) |
> > > + frm->a_rgb[0]);
> > > +
> > > + reg_update_bits(d->regs, DMA2D_OOR_REG, OOR_LO_MASK,
> > > + frm->line_offset & 0x3fff);
> > > +}
> > > +
> > > +void dma2d_config_fg(struct dma2d_dev *d, struct dma2d_frame *frm,
> > > + dma_addr_t f_addr)
> > > +{
> > > + reg_write(d->regs, DMA2D_FGMAR_REG, f_addr);
> > > + reg_update_bits(d->regs, DMA2D_FGOR_REG, FGOR_LO_MASK,
> > > + frm->line_offset);
> > > +
> > > + if (frm->fmt->cmode >= CM_MODE_ARGB8888 &&
> > > + frm->fmt->cmode <= CM_MODE_A4)
> > > + reg_update_bits(d->regs, DMA2D_FGPFCCR_REG, FGPFCCR_CM_MASK,
> > > + frm->fmt->cmode);
> > > +
> > > + reg_update_bits(d->regs, DMA2D_FGPFCCR_REG, FGPFCCR_AM_MASK,
> > > + (frm->a_mode << 16) & 0x03);
> > > +
> > > + reg_update_bits(d->regs, DMA2D_FGPFCCR_REG, FGPFCCR_ALPHA_MASK,
> > > + frm->a_rgb[3] << 24);
> > > +
> > > + reg_write(d->regs, DMA2D_FGCOLR_REG,
> > > + (frm->a_rgb[2] << 16) |
> > > + (frm->a_rgb[1] << 8) |
> > > + frm->a_rgb[0]);
> > > +}
> > > +
> > > +void dma2d_config_bg(struct dma2d_dev *d, struct dma2d_frame *frm,
> > > + dma_addr_t b_addr)
> > > +{
> > > + reg_write(d->regs, DMA2D_BGMAR_REG, b_addr);
> > > + reg_update_bits(d->regs, DMA2D_BGOR_REG, BGOR_LO_MASK,
> > > + frm->line_offset);
> > > +
> > > + if (frm->fmt->cmode >= CM_MODE_ARGB8888 &&
> > > + frm->fmt->cmode <= CM_MODE_A4)
> > > + reg_update_bits(d->regs, DMA2D_BGPFCCR_REG, BGPFCCR_CM_MASK,
> > > + frm->fmt->cmode);
> > > +
> > > + reg_update_bits(d->regs, DMA2D_BGPFCCR_REG, BGPFCCR_AM_MASK,
> > > + (frm->a_mode << 16) & 0x03);
> > > +
> > > + reg_update_bits(d->regs, DMA2D_BGPFCCR_REG, BGPFCCR_ALPHA_MASK,
> > > + frm->a_rgb[3] << 24);
> > > +
> > > + reg_write(d->regs, DMA2D_BGCOLR_REG,
> > > + (frm->a_rgb[2] << 16) |
> > > + (frm->a_rgb[1] << 8) |
> > > + frm->a_rgb[0]);
> > > +}
> > > diff --git a/drivers/media/platform/stm32/dma2d/dma2d-regs.h b/drivers/media/platform/stm32/dma2d/dma2d-regs.h
> > > new file mode 100644
> > > index 000000000000..2128364406c8
> > > --- /dev/null
> > > +++ b/drivers/media/platform/stm32/dma2d/dma2d-regs.h
> > > @@ -0,0 +1,113 @@
> > > +/* SPDX-License-Identifier: GPL-2.0-or-later */
> > > +/*
> > > + * ST stm32 Chrom-Art - 2D Graphics Accelerator Driver
> > > + *
> > > + * Copyright (c) 2021 Dillon Min
> > > + * Dillon Min, <dillon.minfei at gmail.com>
> > > + *
> > > + * based on s5p-g2d
> > > + *
> > > + * Copyright (c) 2011 Samsung Electronics Co., Ltd.
> > > + * Kamil Debski, <k.debski at samsung.com>
> > > + */
> > > +
> > > +#ifndef __DMA2D_REGS_H__
> > > +#define __DMA2D_REGS_H__
> > > +
> > > +#define DMA2D_CR_REG 0x0000
> > > +#define CR_MODE_MASK GENMASK(17, 16)
> > > +#define CR_MODE_SHIFT 16
> > > +#define CR_M2M 0x0000
> > > +#define CR_M2M_PFC BIT(16)
> > > +#define CR_M2M_BLEND BIT(17)
> > > +#define CR_R2M (BIT(17) | BIT(16))
> > > +#define CR_CEIE BIT(13)
> > > +#define CR_CTCIE BIT(12)
> > > +#define CR_CAEIE BIT(11)
> > > +#define CR_TWIE BIT(10)
> > > +#define CR_TCIE BIT(9)
> > > +#define CR_TEIE BIT(8)
> > > +#define CR_ABORT BIT(2)
> > > +#define CR_SUSP BIT(1)
> > > +#define CR_START BIT(0)
> > > +
> > > +#define DMA2D_ISR_REG 0x0004
> > > +#define ISR_CEIF BIT(5)
> > > +#define ISR_CTCIF BIT(4)
> > > +#define ISR_CAEIF BIT(3)
> > > +#define ISR_TWIF BIT(2)
> > > +#define ISR_TCIF BIT(1)
> > > +#define ISR_TEIF BIT(0)
> > > +
> > > +#define DMA2D_IFCR_REG 0x0008
> > > +#define IFCR_CCEIF BIT(5)
> > > +#define IFCR_CCTCIF BIT(4)
> > > +#define IFCR_CAECIF BIT(3)
> > > +#define IFCR_CTWIF BIT(2)
> > > +#define IFCR_CTCIF BIT(1)
> > > +#define IFCR_CTEIF BIT(0)
> > > +
> > > +#define DMA2D_FGMAR_REG 0x000c
> > > +#define DMA2D_FGOR_REG 0x0010
> > > +#define FGOR_LO_MASK GENMASK(13, 0)
> > > +
> > > +#define DMA2D_BGMAR_REG 0x0014
> > > +#define DMA2D_BGOR_REG 0x0018
> > > +#define BGOR_LO_MASK GENMASK(13, 0)
> > > +
> > > +#define DMA2D_FGPFCCR_REG 0x001c
> > > +#define FGPFCCR_ALPHA_MASK GENMASK(31, 24)
> > > +#define FGPFCCR_AM_MASK GENMASK(17, 16)
> > > +#define FGPFCCR_CS_MASK GENMASK(15, 8)
> > > +#define FGPFCCR_START BIT(5)
> > > +#define FGPFCCR_CCM_RGB888 BIT(4)
> > > +#define FGPFCCR_CM_MASK GENMASK(3, 0)
> > > +
> > > +#define DMA2D_FGCOLR_REG 0x0020
> > > +#define FGCOLR_REG_MASK GENMASK(23, 16)
> > > +#define FGCOLR_GREEN_MASK GENMASK(15, 8)
> > > +#define FGCOLR_BLUE_MASK GENMASK(7, 0)
> > > +
> > > +#define DMA2D_BGPFCCR_REG 0x0024
> > > +#define BGPFCCR_ALPHA_MASK GENMASK(31, 24)
> > > +#define BGPFCCR_AM_MASK GENMASK(17, 16)
> > > +#define BGPFCCR_CS_MASK GENMASK(15, 8)
> > > +#define BGPFCCR_START BIT(5)
> > > +#define BGPFCCR_CCM_RGB888 BIT(4)
> > > +#define BGPFCCR_CM_MASK GENMASK(3, 0)
> > > +
> > > +#define DMA2D_BGCOLR_REG 0x0028
> > > +#define BGCOLR_REG_MASK GENMASK(23, 16)
> > > +#define BGCOLR_GREEN_MASK GENMASK(15, 8)
> > > +#define BGCOLR_BLUE_MASK GENMASK(7, 0)
> > > +
> > > +#define DMA2D_OPFCCR_REG 0x0034
> > > +#define OPFCCR_CM_MASK GENMASK(2, 0)
> > > +
> > > +#define DMA2D_OCOLR_REG 0x0038
> > > +#define OCOLR_ALPHA_MASK GENMASK(31, 24)
> > > +#define OCOLR_RED_MASK GENMASK(23, 16)
> > > +#define OCOLR_GREEN_MASK GENMASK(15, 8)
> > > +#define OCOLR_BLUE_MASK GENMASK(7, 0)
> > > +
> > > +#define DMA2D_OMAR_REG 0x003c
> > > +
> > > +#define DMA2D_OOR_REG 0x0040
> > > +#define OOR_LO_MASK GENMASK(13, 0)
> > > +
> > > +#define DMA2D_NLR_REG 0x0044
> > > +#define NLR_PL_MASK GENMASK(29, 16)
> > > +#define NLR_NL_MASK GENMASK(15, 0)
> > > +
> > > +/* Hardware limits */
> > > +#define MAX_WIDTH 0x3fff
> > > +#define MAX_HEIGHT 0xffff
> >
> > I think these max width/height values are unrealistic. Even though the hardware
> > theoretically supports this, it is causing the memory alloc failures.
>
> Oh, I suppose the memory alloc failures test case was fixed, designed
> by v4l2-compliance , actually it depends on the driver's ability.
>
> >
> > I see that the camera driver has 2592x2592 as the max width/height, so perhaps
> > that should be used? Or alternatively the max resolution of the video output driver,
> > whatever that is?
>
> I will try 2592x2592, and 2048x2048[display driver]. It fits the
> camera's output or display input is a good idea.
Tried 2592x2592 and 2048x2048, both failed on my setup due to the low
memory size. I'd like to send v6 with max 2592x2592 if you prefer?
fail: v4l2-test-buffers.cpp(1349): q.reqbufs(node, 2)
BA24 (32-bit ARGB 8-8-8-8) 2048x2048 -> BA24 (32-bit ARGB
8-8-8-8) 2048x2048: FAIL
fail: v4l2-test-buffers.cpp(1349): q.reqbufs(node, 2)
BA24 (32-bit ARGB 8-8-8-8) 2592x2592 -> BA24 (32-bit ARGB
8-8-8-8) 2592x2592: FAIL
~ # free
total used free shared
buff/cache available
Mem: 15648 4060 8276 0 3312 7648
Thanks & Regards
Dillon
>
> [display driver] drivers/gpu/drm/stm/drv.c
>
> Thanks & Regards
> Dillon
>
> >
> > Regards,
> >
> > Hans
> >
> > > +
> > > +#define DEFAULT_WIDTH 240
> > > +#define DEFAULT_HEIGHT 320
> > > +#define DEFAULT_SIZE 307200
> > > +
> > > +#define CM_MODE_ARGB8888 0x00
> > > +#define CM_MODE_ARGB4444 0x04
> > > +#define CM_MODE_A4 0x0a
> > > +#endif /* __DMA2D_REGS_H__ */
More information about the linux-arm-kernel
mailing list