diff mbox series

[3/5] drm/imx: Add initial support for DCSS on iMX8MQ

Message ID 1569248002-2485-4-git-send-email-laurentiu.palcu@nxp.com (mailing list archive)
State New, archived
Headers show
Series Add support for iMX8MQ Display Controller Subsystem | expand

Commit Message

Laurentiu Palcu Sept. 23, 2019, 2:13 p.m. UTC
This adds initial support for iMX8MQ's Display Controller Subsystem (DCSS).
Some of its capabilities include:
 * 4K@60fps;
 * HDR10;
 * one graphics and 2 video pipelines;
 * on-the-fly decompression of compressed video and graphics;

The reference manual can be found here:
https://www.nxp.com/webapp/Download?colCode=IMX8MDQLQRM

The current patch adds only basic functionality: one primary plane for
graphics, linear, tiled and super-tiled buffers support (no graphics
decompression yet), no HDR10 and no video planes.

Video planes support and HDR10 will be added in subsequent patches once
per-plane de-gamma/CSC/gamma support is in.

Signed-off-by: Laurentiu Palcu <laurentiu.palcu@nxp.com>
---
 drivers/gpu/drm/imx/Kconfig            |   2 +
 drivers/gpu/drm/imx/Makefile           |   1 +
 drivers/gpu/drm/imx/dcss/Kconfig       |   7 +
 drivers/gpu/drm/imx/dcss/Makefile      |   6 +
 drivers/gpu/drm/imx/dcss/dcss-blkctl.c |  75 +++
 drivers/gpu/drm/imx/dcss/dcss-crtc.c   | 223 +++++++++
 drivers/gpu/drm/imx/dcss/dcss-ctxld.c  | 447 ++++++++++++++++++
 drivers/gpu/drm/imx/dcss/dcss-dev.c    | 286 ++++++++++++
 drivers/gpu/drm/imx/dcss/dcss-dev.h    | 195 ++++++++
 drivers/gpu/drm/imx/dcss/dcss-dpr.c    | 552 ++++++++++++++++++++++
 drivers/gpu/drm/imx/dcss/dcss-drv.c    | 182 ++++++++
 drivers/gpu/drm/imx/dcss/dcss-dtg.c    | 438 +++++++++++++++++
 drivers/gpu/drm/imx/dcss/dcss-kms.c    | 321 +++++++++++++
 drivers/gpu/drm/imx/dcss/dcss-kms.h    |  52 +++
 drivers/gpu/drm/imx/dcss/dcss-plane.c  | 418 +++++++++++++++++
 drivers/gpu/drm/imx/dcss/dcss-scaler.c | 830 +++++++++++++++++++++++++++++++++
 drivers/gpu/drm/imx/dcss/dcss-ss.c     | 179 +++++++
 17 files changed, 4214 insertions(+)
 create mode 100644 drivers/gpu/drm/imx/dcss/Kconfig
 create mode 100644 drivers/gpu/drm/imx/dcss/Makefile
 create mode 100644 drivers/gpu/drm/imx/dcss/dcss-blkctl.c
 create mode 100644 drivers/gpu/drm/imx/dcss/dcss-crtc.c
 create mode 100644 drivers/gpu/drm/imx/dcss/dcss-ctxld.c
 create mode 100644 drivers/gpu/drm/imx/dcss/dcss-dev.c
 create mode 100644 drivers/gpu/drm/imx/dcss/dcss-dev.h
 create mode 100644 drivers/gpu/drm/imx/dcss/dcss-dpr.c
 create mode 100644 drivers/gpu/drm/imx/dcss/dcss-drv.c
 create mode 100644 drivers/gpu/drm/imx/dcss/dcss-dtg.c
 create mode 100644 drivers/gpu/drm/imx/dcss/dcss-kms.c
 create mode 100644 drivers/gpu/drm/imx/dcss/dcss-kms.h
 create mode 100644 drivers/gpu/drm/imx/dcss/dcss-plane.c
 create mode 100644 drivers/gpu/drm/imx/dcss/dcss-scaler.c
 create mode 100644 drivers/gpu/drm/imx/dcss/dcss-ss.c

Comments

Ying Liu Sept. 24, 2019, 3:56 a.m. UTC | #1
Hi,

On Mon, Sep 23, 2019 at 10:22 PM Laurentiu Palcu
<laurentiu.palcu@nxp.com> wrote:
>
> This adds initial support for iMX8MQ's Display Controller Subsystem (DCSS).
> Some of its capabilities include:
>  * 4K@60fps;
>  * HDR10;
>  * one graphics and 2 video pipelines;
>  * on-the-fly decompression of compressed video and graphics;
>
> The reference manual can be found here:
> https://www.nxp.com/webapp/Download?colCode=IMX8MDQLQRM
>
> The current patch adds only basic functionality: one primary plane for
> graphics, linear, tiled and super-tiled buffers support (no graphics
> decompression yet), no HDR10 and no video planes.
>
> Video planes support and HDR10 will be added in subsequent patches once
> per-plane de-gamma/CSC/gamma support is in.
>
> Signed-off-by: Laurentiu Palcu <laurentiu.palcu@nxp.com>
> ---
>  drivers/gpu/drm/imx/Kconfig            |   2 +
>  drivers/gpu/drm/imx/Makefile           |   1 +
>  drivers/gpu/drm/imx/dcss/Kconfig       |   7 +
>  drivers/gpu/drm/imx/dcss/Makefile      |   6 +
>  drivers/gpu/drm/imx/dcss/dcss-blkctl.c |  75 +++
>  drivers/gpu/drm/imx/dcss/dcss-crtc.c   | 223 +++++++++
>  drivers/gpu/drm/imx/dcss/dcss-ctxld.c  | 447 ++++++++++++++++++
>  drivers/gpu/drm/imx/dcss/dcss-dev.c    | 286 ++++++++++++
>  drivers/gpu/drm/imx/dcss/dcss-dev.h    | 195 ++++++++
>  drivers/gpu/drm/imx/dcss/dcss-dpr.c    | 552 ++++++++++++++++++++++
>  drivers/gpu/drm/imx/dcss/dcss-drv.c    | 182 ++++++++
>  drivers/gpu/drm/imx/dcss/dcss-dtg.c    | 438 +++++++++++++++++
>  drivers/gpu/drm/imx/dcss/dcss-kms.c    | 321 +++++++++++++
>  drivers/gpu/drm/imx/dcss/dcss-kms.h    |  52 +++
>  drivers/gpu/drm/imx/dcss/dcss-plane.c  | 418 +++++++++++++++++
>  drivers/gpu/drm/imx/dcss/dcss-scaler.c | 830 +++++++++++++++++++++++++++++++++
>  drivers/gpu/drm/imx/dcss/dcss-ss.c     | 179 +++++++
>  17 files changed, 4214 insertions(+)
>  create mode 100644 drivers/gpu/drm/imx/dcss/Kconfig
>  create mode 100644 drivers/gpu/drm/imx/dcss/Makefile
>  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-blkctl.c
>  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-crtc.c
>  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-ctxld.c
>  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-dev.c
>  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-dev.h
>  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-dpr.c

DPR embedded in i.MX8QM & i.MX8QXP SoCs has
compatible register definitions with the one in i.MX8MQ.
Together with PRG(Prefetch Resolve Gasket), DPR serves
the display controller DPU of i.MX8QM & i.MX8QXP SoCs
as the prefetch engine.  IMHO, there should be a separate
DPR driver which stands out side of the dcss directory and
has DT compatible strings for i.MX8MQ, i.MX8QM and
i.MX8QXP SoCs.

>  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-drv.c
>  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-dtg.c
>  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-kms.c
>  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-kms.h
>  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-plane.c
>  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-scaler.c
>  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-ss.c
>
> diff --git a/drivers/gpu/drm/imx/Kconfig b/drivers/gpu/drm/imx/Kconfig
> index 207bf74..6231048 100644
> --- a/drivers/gpu/drm/imx/Kconfig
> +++ b/drivers/gpu/drm/imx/Kconfig
> @@ -39,3 +39,5 @@ config DRM_IMX_HDMI
>         depends on DRM_IMX
>         help
>           Choose this if you want to use HDMI on i.MX6.
> +
> +source "drivers/gpu/drm/imx/dcss/Kconfig"
> diff --git a/drivers/gpu/drm/imx/Makefile b/drivers/gpu/drm/imx/Makefile
> index 21cdcc2..b644def 100644
> --- a/drivers/gpu/drm/imx/Makefile
> +++ b/drivers/gpu/drm/imx/Makefile
> @@ -9,3 +9,4 @@ obj-$(CONFIG_DRM_IMX_TVE) += imx-tve.o
>  obj-$(CONFIG_DRM_IMX_LDB) += imx-ldb.o
>
>  obj-$(CONFIG_DRM_IMX_HDMI) += dw_hdmi-imx.o
> +obj-$(CONFIG_DRM_IMX_DCSS) += dcss/
> diff --git a/drivers/gpu/drm/imx/dcss/Kconfig b/drivers/gpu/drm/imx/dcss/Kconfig
> new file mode 100644
> index 00000000..6399c12
> --- /dev/null
> +++ b/drivers/gpu/drm/imx/dcss/Kconfig
> @@ -0,0 +1,7 @@
> +config DRM_IMX_DCSS
> +       tristate "i.MX8MQ DCSS"
> +       select RESET_CONTROLLER
> +       select IMX_IRQSTEER
> +       help
> +         Choose this if you have a NXP i.MX8MQ based system and want to use the
> +         Display Controller Subsystem. This option enables DCSS support.
> diff --git a/drivers/gpu/drm/imx/dcss/Makefile b/drivers/gpu/drm/imx/dcss/Makefile
> new file mode 100644
> index 00000000..8c7c8da
> --- /dev/null
> +++ b/drivers/gpu/drm/imx/dcss/Makefile
> @@ -0,0 +1,6 @@
> +imx-dcss-objs := dcss-drv.o dcss-dev.o dcss-blkctl.o dcss-ctxld.o dcss-dtg.o \
> +                                dcss-ss.o dcss-dpr.o dcss-scaler.o dcss-kms.o dcss-crtc.o \
> +                                dcss-plane.o
> +
> +obj-$(CONFIG_DRM_IMX_DCSS) += imx-dcss.o
> +
> diff --git a/drivers/gpu/drm/imx/dcss/dcss-blkctl.c b/drivers/gpu/drm/imx/dcss/dcss-blkctl.c
> new file mode 100644
> index 00000000..ee7ffa1
> --- /dev/null
> +++ b/drivers/gpu/drm/imx/dcss/dcss-blkctl.c
> @@ -0,0 +1,75 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * Copyright 2019 NXP.
> + */
> +
> +#include <linux/device.h>
> +#include <linux/of.h>
> +
> +#include "dcss-dev.h"
> +
> +#define DCSS_BLKCTL_RESET_CTRL         0x00
> +#define   B_CLK_RESETN                 BIT(0)
> +#define   APB_CLK_RESETN               BIT(1)
> +#define   P_CLK_RESETN                 BIT(2)
> +#define   RTR_CLK_RESETN               BIT(3)
> +#define DCSS_BLKCTL_CONTROL0           0x10
> +#define   HDMI_MIPI_CLK_SEL            BIT(0)
> +#define   DISPMIX_REFCLK_SEL_POS       4
> +#define   DISPMIX_REFCLK_SEL_MASK      GENMASK(5, 4)
> +#define   DISPMIX_PIXCLK_SEL           BIT(8)
> +#define   HDMI_SRC_SECURE_EN           BIT(16)
> +
> +struct dcss_blkctl {
> +       struct device *dev;
> +       void __iomem *base_reg;
> +
> +       bool hdmi_output;
> +};
> +
> +void dcss_blkctl_cfg(struct dcss_blkctl *blkctl)
> +{
> +       if (blkctl->hdmi_output)
> +               dcss_writel(0, blkctl->base_reg + DCSS_BLKCTL_CONTROL0);
> +       else
> +               dcss_writel(DISPMIX_PIXCLK_SEL,
> +                           blkctl->base_reg + DCSS_BLKCTL_CONTROL0);
> +
> +       dcss_set(B_CLK_RESETN | APB_CLK_RESETN | P_CLK_RESETN | RTR_CLK_RESETN,
> +                blkctl->base_reg + DCSS_BLKCTL_RESET_CTRL);
> +}
> +
> +int dcss_blkctl_init(struct dcss_dev *dcss, unsigned long blkctl_base)
> +{
> +       struct dcss_blkctl *blkctl;
> +
> +       blkctl = devm_kzalloc(dcss->dev, sizeof(*blkctl), GFP_KERNEL);
> +       if (!blkctl)
> +               return -ENOMEM;
> +
> +       blkctl->base_reg = devm_ioremap(dcss->dev, blkctl_base, SZ_4K);
> +       if (!blkctl->base_reg) {
> +               dev_err(dcss->dev, "unable to remap BLK CTRL base\n");
> +               devm_kfree(dcss->dev, blkctl);
> +               return -ENOMEM;
> +       }
> +
> +       dcss->blkctl = blkctl;
> +       blkctl->dev = dcss->dev;
> +       blkctl->hdmi_output = dcss->hdmi_output;
> +
> +       dcss_blkctl_cfg(blkctl);
> +
> +       return 0;
> +}
> +
> +void dcss_blkctl_exit(struct dcss_blkctl *blkctl)
> +{
> +       dcss_clr(P_CLK_RESETN | RTR_CLK_RESETN,
> +                blkctl->base_reg + DCSS_BLKCTL_RESET_CTRL);
> +
> +       if (blkctl->base_reg)
> +               devm_iounmap(blkctl->dev, blkctl->base_reg);
> +
> +       devm_kfree(blkctl->dev, blkctl);
> +}
> diff --git a/drivers/gpu/drm/imx/dcss/dcss-crtc.c b/drivers/gpu/drm/imx/dcss/dcss-crtc.c
> new file mode 100644
> index 00000000..6abb40c
> --- /dev/null
> +++ b/drivers/gpu/drm/imx/dcss/dcss-crtc.c
> @@ -0,0 +1,223 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * Copyright 2019 NXP.
> + */
> +
> +#include <drm/drmP.h>
> +#include <drm/drm_atomic_helper.h>
> +#include <linux/pm_runtime.h>
> +
> +#include "dcss-dev.h"
> +#include "dcss-kms.h"
> +
> +static int dcss_enable_vblank(struct drm_crtc *crtc)
> +{
> +       struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
> +                                                  base);
> +       struct dcss_dev *dcss = crtc->dev->dev_private;
> +
> +       if (dcss_crtc->irq_enabled)
> +               return 0;
> +
> +       dcss_crtc->irq_enabled = true;
> +
> +       dcss_dtg_vblank_irq_enable(dcss->dtg, true);
> +
> +       dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, true);
> +
> +       enable_irq(dcss_crtc->irq);
> +
> +       return 0;
> +}
> +
> +static void dcss_disable_vblank(struct drm_crtc *crtc)
> +{
> +       struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
> +                                                  base);
> +       struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
> +
> +       disable_irq_nosync(dcss_crtc->irq);
> +
> +       dcss_dtg_vblank_irq_enable(dcss->dtg, false);
> +
> +       dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, false);
> +
> +       dcss_crtc->irq_enabled = false;
> +}
> +
> +static const struct drm_crtc_funcs dcss_crtc_funcs = {
> +       .set_config = drm_atomic_helper_set_config,
> +       .destroy = drm_crtc_cleanup,
> +       .page_flip = drm_atomic_helper_page_flip,
> +       .reset = drm_atomic_helper_crtc_reset,
> +       .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
> +       .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
> +       .enable_vblank = dcss_enable_vblank,
> +       .disable_vblank = dcss_disable_vblank,
> +};
> +
> +static void dcss_crtc_atomic_begin(struct drm_crtc *crtc,
> +                                  struct drm_crtc_state *old_crtc_state)
> +{
> +       drm_crtc_vblank_on(crtc);
> +
> +       spin_lock_irq(&crtc->dev->event_lock);
> +       if (crtc->state->event) {
> +               WARN_ON(drm_crtc_vblank_get(crtc));
> +               drm_crtc_arm_vblank_event(crtc, crtc->state->event);
> +               crtc->state->event = NULL;
> +       }
> +       spin_unlock_irq(&crtc->dev->event_lock);
> +}
> +
> +static void dcss_crtc_atomic_flush(struct drm_crtc *crtc,
> +                                  struct drm_crtc_state *old_crtc_state)
> +{
> +       struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
> +                                                  base);
> +       struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
> +
> +       if (dcss_dtg_is_enabled(dcss->dtg))
> +               dcss_ctxld_enable(dcss->ctxld);
> +}
> +
> +static void dcss_crtc_atomic_enable(struct drm_crtc *crtc,
> +                                   struct drm_crtc_state *old_crtc_state)
> +{
> +       struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
> +                                                  base);
> +       struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
> +       struct drm_display_mode *mode = &crtc->state->adjusted_mode;
> +       struct videomode vm;
> +
> +       drm_display_mode_to_videomode(mode, &vm);
> +
> +       pm_runtime_get_sync(dcss->dev);
> +
> +       dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, true);
> +
> +       vm.pixelclock = mode->crtc_clock * 1000;
> +
> +       dcss_dtg_sync_set(dcss->dtg, &vm);
> +
> +       dcss_ss_subsam_set(dcss->ss);
> +       dcss_ss_sync_set(dcss->ss, &vm, mode->flags & DRM_MODE_FLAG_PHSYNC,
> +                        mode->flags & DRM_MODE_FLAG_PVSYNC);
> +
> +       dcss_dtg_css_set(dcss->dtg);
> +
> +       dcss_ss_enable(dcss->ss);
> +       dcss_dtg_enable(dcss->dtg, true, NULL);
> +       dcss_ctxld_enable(dcss->ctxld);
> +
> +       reinit_completion(&dcss_crtc->en_completion);
> +       wait_for_completion_timeout(&dcss_crtc->en_completion,
> +                                   msecs_to_jiffies(500));
> +}
> +
> +static void dcss_crtc_atomic_disable(struct drm_crtc *crtc,
> +                                    struct drm_crtc_state *old_crtc_state)
> +{
> +       struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
> +                                                  base);
> +       struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
> +
> +       drm_atomic_helper_disable_planes_on_crtc(old_crtc_state, false);
> +
> +       spin_lock_irq(&crtc->dev->event_lock);
> +       if (crtc->state->event) {
> +               drm_crtc_send_vblank_event(crtc, crtc->state->event);
> +               crtc->state->event = NULL;
> +       }
> +       spin_unlock_irq(&crtc->dev->event_lock);
> +
> +       dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, true);
> +
> +       dcss_ss_disable(dcss->ss);
> +       dcss_dtg_enable(dcss->dtg, false, &dcss_crtc->dis_completion);
> +       dcss_ctxld_enable(dcss->ctxld);
> +
> +       reinit_completion(&dcss_crtc->dis_completion);
> +       wait_for_completion_timeout(&dcss_crtc->dis_completion,
> +                                   msecs_to_jiffies(100));
> +
> +       drm_crtc_vblank_off(crtc);
> +
> +       dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, false);
> +
> +       pm_runtime_put_sync(dcss->dev);
> +}
> +
> +static const struct drm_crtc_helper_funcs dcss_helper_funcs = {
> +       .atomic_begin = dcss_crtc_atomic_begin,
> +       .atomic_flush = dcss_crtc_atomic_flush,
> +       .atomic_enable = dcss_crtc_atomic_enable,
> +       .atomic_disable = dcss_crtc_atomic_disable,
> +};
> +
> +static irqreturn_t dcss_crtc_irq_handler(int irq, void *dev_id)
> +{
> +       struct dcss_crtc *dcss_crtc = dev_id;
> +       struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
> +
> +       if (!dcss_dtg_vblank_irq_valid(dcss->dtg))
> +               return IRQ_HANDLED;
> +
> +       complete(&dcss_crtc->en_completion);
> +
> +       if (dcss_ctxld_is_flushed(dcss->ctxld))
> +               drm_crtc_handle_vblank(&dcss_crtc->base);
> +
> +       dcss_dtg_vblank_irq_clear(dcss->dtg);
> +
> +       return IRQ_HANDLED;
> +}
> +
> +int dcss_crtc_init(struct dcss_crtc *crtc, struct drm_device *drm)
> +{
> +       struct dcss_dev *dcss = drm->dev_private;
> +       struct platform_device *pdev = to_platform_device(dcss->dev);
> +       int ret;
> +
> +       crtc->plane[0] = dcss_plane_init(drm, drm_crtc_mask(&crtc->base),
> +                                        DRM_PLANE_TYPE_PRIMARY, 0);
> +       if (IS_ERR(crtc->plane[0]))
> +               return PTR_ERR(crtc->plane[0]);
> +
> +       crtc->base.port = dcss->of_port;
> +
> +       drm_crtc_helper_add(&crtc->base, &dcss_helper_funcs);
> +       ret = drm_crtc_init_with_planes(drm, &crtc->base, &crtc->plane[0]->base,
> +                                       NULL, &dcss_crtc_funcs, NULL);
> +       if (ret) {
> +               dev_err(dcss->dev, "failed to init crtc\n");
> +               return ret;
> +       }
> +
> +       crtc->irq = platform_get_irq_byname(pdev, "vblank");
> +       if (crtc->irq < 0) {
> +               dev_err(dcss->dev, "unable to get vblank interrupt\n");
> +               return crtc->irq;
> +       }
> +
> +       init_completion(&crtc->en_completion);
> +       init_completion(&crtc->dis_completion);
> +
> +       ret = devm_request_irq(dcss->dev, crtc->irq, dcss_crtc_irq_handler,
> +                              IRQF_TRIGGER_RISING, "dcss_drm", crtc);
> +       if (ret) {
> +               dev_err(dcss->dev, "irq request failed with %d.\n", ret);
> +               return ret;
> +       }
> +
> +       disable_irq(crtc->irq);
> +
> +       return 0;
> +}
> +
> +void dcss_crtc_deinit(struct dcss_crtc *crtc, struct drm_device *drm)
> +{
> +       struct dcss_dev *dcss = drm->dev_private;
> +
> +       devm_free_irq(dcss->dev, crtc->irq, crtc);
> +}
> diff --git a/drivers/gpu/drm/imx/dcss/dcss-ctxld.c b/drivers/gpu/drm/imx/dcss/dcss-ctxld.c
> new file mode 100644
> index 00000000..4fe35b2b
> --- /dev/null
> +++ b/drivers/gpu/drm/imx/dcss/dcss-ctxld.c
> @@ -0,0 +1,447 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * Copyright 2019 NXP.
> + */
> +
> +#include <linux/delay.h>
> +#include <linux/dma-mapping.h>
> +#include <linux/interrupt.h>
> +#include <linux/platform_device.h>
> +
> +#include "dcss-dev.h"
> +
> +#define DCSS_CTXLD_DEVNAME             "dcss_ctxld"
> +
> +#define DCSS_CTXLD_CONTROL_STATUS      0x0
> +#define   CTXLD_ENABLE                 BIT(0)
> +#define   ARB_SEL                      BIT(1)
> +#define   RD_ERR_EN                    BIT(2)
> +#define   DB_COMP_EN                   BIT(3)
> +#define   SB_HP_COMP_EN                        BIT(4)
> +#define   SB_LP_COMP_EN                        BIT(5)
> +#define   DB_PEND_SB_REC_EN            BIT(6)
> +#define   SB_PEND_DISP_ACTIVE_EN       BIT(7)
> +#define   AHB_ERR_EN                   BIT(8)
> +#define   RD_ERR                       BIT(16)
> +#define   DB_COMP                      BIT(17)
> +#define   SB_HP_COMP                   BIT(18)
> +#define   SB_LP_COMP                   BIT(19)
> +#define   DB_PEND_SB_REC               BIT(20)
> +#define   SB_PEND_DISP_ACTIVE          BIT(21)
> +#define   AHB_ERR                      BIT(22)
> +#define DCSS_CTXLD_DB_BASE_ADDR                0x10
> +#define DCSS_CTXLD_DB_COUNT            0x14
> +#define DCSS_CTXLD_SB_BASE_ADDR                0x18
> +#define DCSS_CTXLD_SB_COUNT            0x1C
> +#define   SB_HP_COUNT_POS              0
> +#define   SB_HP_COUNT_MASK             0xffff
> +#define   SB_LP_COUNT_POS              16
> +#define   SB_LP_COUNT_MASK             0xffff0000
> +#define DCSS_AHB_ERR_ADDR              0x20
> +
> +#define CTXLD_IRQ_NAME                 "ctx_ld"
> +#define CTXLD_IRQ_COMPLETION           (DB_COMP | SB_HP_COMP | SB_LP_COMP)
> +#define CTXLD_IRQ_ERROR                        (RD_ERR | DB_PEND_SB_REC | AHB_ERR)
> +
> +/* The following sizes are in context loader entries, 8 bytes each. */
> +#define CTXLD_DB_CTX_ENTRIES           1024    /* max 65536 */
> +#define CTXLD_SB_LP_CTX_ENTRIES                10240   /* max 65536 */
> +#define CTXLD_SB_HP_CTX_ENTRIES                20000   /* max 65536 */
> +#define CTXLD_SB_CTX_ENTRIES           (CTXLD_SB_LP_CTX_ENTRIES + \
> +                                        CTXLD_SB_HP_CTX_ENTRIES)
> +
> +/* Sizes, in entries, of the DB, SB_HP and SB_LP context regions. */
> +static u16 dcss_ctxld_ctx_size[3] = {
> +       CTXLD_DB_CTX_ENTRIES,
> +       CTXLD_SB_HP_CTX_ENTRIES,
> +       CTXLD_SB_LP_CTX_ENTRIES
> +};
> +
> +/* this represents an entry in the context loader map */
> +struct dcss_ctxld_item {
> +       u32 val;
> +       u32 ofs;
> +};
> +
> +#define CTX_ITEM_SIZE                  sizeof(struct dcss_ctxld_item)
> +
> +struct dcss_ctxld {
> +       struct device *dev;
> +       void __iomem *ctxld_reg;
> +       int irq;
> +       bool irq_en;
> +
> +       struct dcss_ctxld_item *db[2];
> +       struct dcss_ctxld_item *sb_hp[2];
> +       struct dcss_ctxld_item *sb_lp[2];
> +
> +       dma_addr_t db_paddr[2];
> +       dma_addr_t sb_paddr[2];
> +
> +       u16 ctx_size[2][3]; /* holds the sizes of DB, SB_HP and SB_LP ctx */
> +       u8 current_ctx;
> +
> +       bool in_use;
> +       bool armed;
> +
> +       spinlock_t lock; /* protects concurent access to private data */
> +
> +       void (*dtg_disable_cb)(void *data);
> +       void *dtg_disable_data;
> +};
> +
> +static int __dcss_ctxld_enable(struct dcss_ctxld *ctxld);
> +
> +static irqreturn_t dcss_ctxld_irq_handler(int irq, void *data)
> +{
> +       struct dcss_ctxld *ctxld = data;
> +       u32 irq_status;
> +
> +       irq_status = dcss_readl(ctxld->ctxld_reg + DCSS_CTXLD_CONTROL_STATUS);
> +
> +       if (irq_status & CTXLD_IRQ_COMPLETION &&
> +           !(irq_status & CTXLD_ENABLE) && ctxld->in_use) {
> +               ctxld->in_use = false;
> +
> +               if (ctxld->dtg_disable_cb) {
> +                       ctxld->dtg_disable_cb(ctxld->dtg_disable_data);
> +                       ctxld->dtg_disable_cb = NULL;
> +                       ctxld->dtg_disable_data = NULL;
> +               }
> +       } else if (irq_status & CTXLD_IRQ_ERROR) {
> +               /*
> +                * Except for throwing an error message and clearing the status
> +                * register, there's not much we can do here.
> +                */
> +               dev_err(ctxld->dev, "ctxld: error encountered: %08x\n",
> +                       irq_status);
> +               dev_err(ctxld->dev, "ctxld: db=%d, sb_hp=%d, sb_lp=%d\n",
> +                       ctxld->ctx_size[ctxld->current_ctx ^ 1][CTX_DB],
> +                       ctxld->ctx_size[ctxld->current_ctx ^ 1][CTX_SB_HP],
> +                       ctxld->ctx_size[ctxld->current_ctx ^ 1][CTX_SB_LP]);
> +       }
> +
> +       dcss_clr(irq_status & (CTXLD_IRQ_ERROR | CTXLD_IRQ_COMPLETION),
> +                ctxld->ctxld_reg + DCSS_CTXLD_CONTROL_STATUS);
> +
> +       return IRQ_HANDLED;
> +}
> +
> +static int dcss_ctxld_irq_config(struct dcss_ctxld *ctxld,
> +                                struct platform_device *pdev)
> +{
> +       int ret;
> +
> +       ctxld->irq = platform_get_irq_byname(pdev, CTXLD_IRQ_NAME);
> +       if (ctxld->irq < 0) {
> +               dev_err(ctxld->dev, "ctxld: can't get irq number\n");
> +               return ctxld->irq;
> +       }
> +
> +       ret = devm_request_irq(ctxld->dev, ctxld->irq,
> +                              dcss_ctxld_irq_handler,
> +                              IRQF_ONESHOT | IRQF_TRIGGER_HIGH,
> +                              DCSS_CTXLD_DEVNAME, ctxld);
> +       if (ret) {
> +               dev_err(ctxld->dev, "ctxld: irq request failed.\n");
> +               return ret;
> +       }
> +
> +       ctxld->irq_en = true;
> +
> +       return 0;
> +}
> +
> +void dcss_ctxld_hw_cfg(struct dcss_ctxld *ctxld)
> +{
> +       dcss_writel(RD_ERR_EN | SB_HP_COMP_EN |
> +                   DB_PEND_SB_REC_EN | AHB_ERR_EN | RD_ERR | AHB_ERR,
> +                   ctxld->ctxld_reg + DCSS_CTXLD_CONTROL_STATUS);
> +}
> +
> +static void dcss_ctxld_free_ctx(struct dcss_ctxld *ctxld)
> +{
> +       struct dcss_ctxld_item *ctx;
> +       int i;
> +
> +       for (i = 0; i < 2; i++) {
> +               if (ctxld->db[i]) {
> +                       dmam_free_coherent(ctxld->dev,
> +                                          CTXLD_DB_CTX_ENTRIES * sizeof(*ctx),
> +                                          ctxld->db[i], ctxld->db_paddr[i]);
> +                       ctxld->db[i] = NULL;
> +                       ctxld->db_paddr[i] = 0;
> +               }
> +
> +               if (ctxld->sb_hp[i]) {
> +                       dmam_free_coherent(ctxld->dev,
> +                                          CTXLD_SB_CTX_ENTRIES * sizeof(*ctx),
> +                                          ctxld->sb_hp[i], ctxld->sb_paddr[i]);
> +                       ctxld->sb_hp[i] = NULL;
> +                       ctxld->sb_paddr[i] = 0;
> +               }
> +       }
> +}
> +
> +static int dcss_ctxld_alloc_ctx(struct dcss_ctxld *ctxld)
> +{
> +       struct dcss_ctxld_item *ctx;
> +       int i;
> +       dma_addr_t dma_handle;
> +
> +       for (i = 0; i < 2; i++) {
> +               ctx = dmam_alloc_coherent(ctxld->dev,
> +                                         CTXLD_DB_CTX_ENTRIES * sizeof(*ctx),
> +                                         &dma_handle, GFP_KERNEL);
> +               if (!ctx)
> +                       return -ENOMEM;
> +
> +               ctxld->db[i] = ctx;
> +               ctxld->db_paddr[i] = dma_handle;
> +
> +               ctx = dmam_alloc_coherent(ctxld->dev,
> +                                         CTXLD_SB_CTX_ENTRIES * sizeof(*ctx),
> +                                         &dma_handle, GFP_KERNEL);
> +               if (!ctx)
> +                       return -ENOMEM;
> +
> +               ctxld->sb_hp[i] = ctx;
> +               ctxld->sb_lp[i] = ctx + CTXLD_SB_HP_CTX_ENTRIES;
> +
> +               ctxld->sb_paddr[i] = dma_handle;
> +       }
> +
> +       return 0;
> +}
> +
> +int dcss_ctxld_init(struct dcss_dev *dcss, unsigned long ctxld_base)
> +{
> +       struct dcss_ctxld *ctxld;
> +       int ret;
> +
> +       ctxld = devm_kzalloc(dcss->dev, sizeof(struct dcss_ctxld),
> +                            GFP_KERNEL);
> +       if (!ctxld)
> +               return -ENOMEM;
> +
> +       dcss->ctxld = ctxld;
> +       ctxld->dev = dcss->dev;
> +
> +       spin_lock_init(&ctxld->lock);
> +
> +       ret = dcss_ctxld_alloc_ctx(ctxld);
> +       if (ret) {
> +               dev_err(dcss->dev, "ctxld: cannot allocate context memory.\n");
> +               goto err;
> +       }
> +
> +       ctxld->ctxld_reg = devm_ioremap(dcss->dev, ctxld_base, SZ_4K);
> +       if (!ctxld->ctxld_reg) {
> +               dev_err(dcss->dev, "ctxld: unable to remap ctxld base\n");
> +               ret = -ENOMEM;
> +               goto err;
> +       }
> +
> +       ret = dcss_ctxld_irq_config(ctxld, to_platform_device(dcss->dev));
> +       if (ret)
> +               goto err_irq;
> +
> +       dcss_ctxld_hw_cfg(ctxld);
> +
> +       return 0;
> +
> +err_irq:
> +       devm_iounmap(ctxld->dev, ctxld->ctxld_reg);
> +
> +err:
> +       dcss_ctxld_free_ctx(ctxld);
> +       devm_kfree(ctxld->dev, ctxld);
> +
> +       return ret;
> +}
> +
> +void dcss_ctxld_exit(struct dcss_ctxld *ctxld)
> +{
> +       devm_free_irq(ctxld->dev, ctxld->irq, ctxld);
> +
> +       if (ctxld->ctxld_reg)
> +               devm_iounmap(ctxld->dev, ctxld->ctxld_reg);
> +
> +       dcss_ctxld_free_ctx(ctxld);
> +       devm_kfree(ctxld->dev, ctxld);
> +}
> +
> +static int __dcss_ctxld_enable(struct dcss_ctxld *ctxld)
> +{
> +       int curr_ctx = ctxld->current_ctx;
> +       u32 db_base, sb_base, sb_count;
> +       u32 sb_hp_cnt, sb_lp_cnt, db_cnt;
> +       struct dcss_dev *dcss = dcss_drv_dev_to_dcss(ctxld->dev);
> +
> +       dcss_dpr_write_sysctrl(dcss->dpr);
> +
> +       dcss_scaler_write_sclctrl(dcss->scaler);
> +
> +       sb_hp_cnt = ctxld->ctx_size[curr_ctx][CTX_SB_HP];
> +       sb_lp_cnt = ctxld->ctx_size[curr_ctx][CTX_SB_LP];
> +       db_cnt = ctxld->ctx_size[curr_ctx][CTX_DB];
> +
> +       /* make sure SB_LP context area comes after SB_HP */
> +       if (sb_lp_cnt &&
> +           ctxld->sb_lp[curr_ctx] != ctxld->sb_hp[curr_ctx] + sb_hp_cnt) {
> +               struct dcss_ctxld_item *sb_lp_adjusted;
> +
> +               sb_lp_adjusted = ctxld->sb_hp[curr_ctx] + sb_hp_cnt;
> +
> +               memcpy(sb_lp_adjusted, ctxld->sb_lp[curr_ctx],
> +                      sb_lp_cnt * CTX_ITEM_SIZE);
> +       }
> +
> +       db_base = db_cnt ? ctxld->db_paddr[curr_ctx] : 0;
> +
> +       dcss_writel(db_base, ctxld->ctxld_reg + DCSS_CTXLD_DB_BASE_ADDR);
> +       dcss_writel(db_cnt, ctxld->ctxld_reg + DCSS_CTXLD_DB_COUNT);
> +
> +       if (sb_hp_cnt)
> +               sb_count = ((sb_hp_cnt << SB_HP_COUNT_POS) & SB_HP_COUNT_MASK) |
> +                          ((sb_lp_cnt << SB_LP_COUNT_POS) & SB_LP_COUNT_MASK);
> +       else
> +               sb_count = (sb_lp_cnt << SB_HP_COUNT_POS) & SB_HP_COUNT_MASK;
> +
> +       sb_base = sb_count ? ctxld->sb_paddr[curr_ctx] : 0;
> +
> +       dcss_writel(sb_base, ctxld->ctxld_reg + DCSS_CTXLD_SB_BASE_ADDR);
> +       dcss_writel(sb_count, ctxld->ctxld_reg + DCSS_CTXLD_SB_COUNT);
> +
> +       /* enable the context loader */
> +       dcss_set(CTXLD_ENABLE, ctxld->ctxld_reg + DCSS_CTXLD_CONTROL_STATUS);
> +
> +       ctxld->in_use = true;
> +
> +       /*
> +        * Toggle the current context to the alternate one so that any updates
> +        * in the modules' settings take place there.
> +        */
> +       ctxld->current_ctx ^= 1;
> +
> +       ctxld->ctx_size[ctxld->current_ctx][CTX_DB] = 0;
> +       ctxld->ctx_size[ctxld->current_ctx][CTX_SB_HP] = 0;
> +       ctxld->ctx_size[ctxld->current_ctx][CTX_SB_LP] = 0;
> +
> +       return 0;
> +}
> +
> +int dcss_ctxld_enable(struct dcss_ctxld *ctxld)
> +{
> +       unsigned long flags;
> +
> +       spin_lock_irqsave(&ctxld->lock, flags);
> +       ctxld->armed = true;
> +       spin_unlock_irqrestore(&ctxld->lock, flags);
> +
> +       return 0;
> +}
> +
> +void dcss_ctxld_kick(struct dcss_ctxld *ctxld)
> +{
> +       unsigned long flags;
> +
> +       spin_lock_irqsave(&ctxld->lock, flags);
> +       if (ctxld->armed && !ctxld->in_use) {
> +               ctxld->armed = false;
> +               __dcss_ctxld_enable(ctxld);
> +       }
> +       spin_unlock_irqrestore(&ctxld->lock, flags);
> +}
> +
> +void dcss_ctxld_write_irqsafe(struct dcss_ctxld *ctxld, u32 ctx_id, u32 val,
> +                             u32 reg_ofs)
> +{
> +       int curr_ctx = ctxld->current_ctx;
> +       struct dcss_ctxld_item *ctx[] = {
> +               [CTX_DB] = ctxld->db[curr_ctx],
> +               [CTX_SB_HP] = ctxld->sb_hp[curr_ctx],
> +               [CTX_SB_LP] = ctxld->sb_lp[curr_ctx]
> +       };
> +       int item_idx = ctxld->ctx_size[curr_ctx][ctx_id];
> +
> +       if (item_idx + 1 > dcss_ctxld_ctx_size[ctx_id]) {
> +               WARN_ON(1);
> +               return;
> +       }
> +
> +       ctx[ctx_id][item_idx].val = val;
> +       ctx[ctx_id][item_idx].ofs = reg_ofs;
> +       ctxld->ctx_size[curr_ctx][ctx_id] += 1;
> +}
> +
> +void dcss_ctxld_write(struct dcss_ctxld *ctxld, u32 ctx_id,
> +                     u32 val, u32 reg_ofs)
> +{
> +       unsigned long flags;
> +
> +       spin_lock_irqsave(&ctxld->lock, flags);
> +       dcss_ctxld_write_irqsafe(ctxld, ctx_id, val, reg_ofs);
> +       spin_unlock_irqrestore(&ctxld->lock, flags);
> +}
> +
> +bool dcss_ctxld_is_flushed(struct dcss_ctxld *ctxld)
> +{
> +       return ctxld->ctx_size[ctxld->current_ctx][CTX_DB] == 0 &&
> +               ctxld->ctx_size[ctxld->current_ctx][CTX_SB_HP] == 0 &&
> +               ctxld->ctx_size[ctxld->current_ctx][CTX_SB_LP] == 0;
> +}
> +
> +int dcss_ctxld_resume(struct dcss_ctxld *ctxld)
> +{
> +       dcss_ctxld_hw_cfg(ctxld);
> +
> +       if (!ctxld->irq_en) {
> +               enable_irq(ctxld->irq);
> +               ctxld->irq_en = true;
> +       }
> +
> +       return 0;
> +}
> +
> +int dcss_ctxld_suspend(struct dcss_ctxld *ctxld)
> +{
> +       int ret = 0;
> +       int wait_time_ms = 0;
> +       unsigned long flags;
> +
> +       dcss_ctxld_kick(ctxld);
> +
> +       while (ctxld->in_use && wait_time_ms < 500) {
> +               msleep(20);
> +               wait_time_ms += 20;
> +       }
> +
> +       if (wait_time_ms > 500)
> +               return -ETIMEDOUT;
> +
> +       spin_lock_irqsave(&ctxld->lock, flags);
> +
> +       if (ctxld->irq_en) {
> +               disable_irq_nosync(ctxld->irq);
> +               ctxld->irq_en = false;
> +       }
> +
> +       /* reset context region and sizes */
> +       ctxld->current_ctx = 0;
> +       ctxld->ctx_size[0][CTX_DB] = 0;
> +       ctxld->ctx_size[0][CTX_SB_HP] = 0;
> +       ctxld->ctx_size[0][CTX_SB_LP] = 0;
> +
> +       spin_unlock_irqrestore(&ctxld->lock, flags);
> +
> +       return ret;
> +}
> +
> +void dcss_ctxld_register_dtg_disable_cb(struct dcss_ctxld *ctxld,
> +                                       void (*cb)(void *),
> +                                       void *data)
> +{
> +       ctxld->dtg_disable_cb = cb;
> +       ctxld->dtg_disable_data = data;
> +}
> diff --git a/drivers/gpu/drm/imx/dcss/dcss-dev.c b/drivers/gpu/drm/imx/dcss/dcss-dev.c
> new file mode 100644
> index 00000000..265bf3c
> --- /dev/null
> +++ b/drivers/gpu/drm/imx/dcss/dcss-dev.c
> @@ -0,0 +1,286 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * Copyright 2019 NXP.
> + */
> +
> +#include <linux/clk.h>
> +#include <linux/of_device.h>
> +#include <linux/of_graph.h>
> +#include <linux/pm_runtime.h>
> +#include <drm/drm_modeset_helper.h>
> +
> +#include "dcss-dev.h"
> +
> +static void dcss_clocks_enable(struct dcss_dev *dcss)
> +{
> +       if (dcss->clks_on)
> +               return;
> +
> +       clk_prepare_enable(dcss->axi_clk);
> +       clk_prepare_enable(dcss->apb_clk);
> +       clk_prepare_enable(dcss->rtrm_clk);
> +       clk_prepare_enable(dcss->dtrc_clk);
> +       clk_prepare_enable(dcss->pix_clk);
> +
> +       dcss->clks_on = true;
> +}
> +
> +static void dcss_clocks_disable(struct dcss_dev *dcss)
> +{
> +       if (!dcss->clks_on)
> +               return;
> +
> +       clk_disable_unprepare(dcss->pix_clk);
> +       clk_disable_unprepare(dcss->dtrc_clk);
> +       clk_disable_unprepare(dcss->rtrm_clk);
> +       clk_disable_unprepare(dcss->apb_clk);
> +       clk_disable_unprepare(dcss->axi_clk);
> +
> +       dcss->clks_on = false;
> +}
> +
> +static int dcss_submodules_init(struct dcss_dev *dcss)
> +{
> +       int ret = 0;
> +       u32 base_addr = dcss->start_addr;
> +       const struct dcss_type_data *devtype = dcss->devtype;
> +
> +       dcss_clocks_enable(dcss);
> +
> +       ret = dcss_blkctl_init(dcss, base_addr + devtype->blkctl_ofs);
> +       if (ret)
> +               return ret;
> +
> +       ret = dcss_ctxld_init(dcss, base_addr + devtype->ctxld_ofs);
> +       if (ret)
> +               goto ctxld_err;
> +
> +       ret = dcss_dtg_init(dcss, base_addr + devtype->dtg_ofs);
> +       if (ret)
> +               goto dtg_err;
> +
> +       ret = dcss_ss_init(dcss, base_addr + devtype->ss_ofs);
> +       if (ret)
> +               goto ss_err;
> +
> +       ret = dcss_dpr_init(dcss, base_addr + devtype->dpr_ofs);
> +       if (ret)
> +               goto dpr_err;
> +
> +       ret = dcss_scaler_init(dcss, base_addr + devtype->scaler_ofs);
> +       if (ret)
> +               goto scaler_err;
> +
> +       return 0;
> +
> +scaler_err:
> +       dcss_dpr_exit(dcss->dpr);
> +
> +dpr_err:
> +       dcss_ss_exit(dcss->ss);
> +
> +ss_err:
> +       dcss_dtg_exit(dcss->dtg);
> +
> +dtg_err:
> +       dcss_ctxld_exit(dcss->ctxld);
> +
> +ctxld_err:
> +       dcss_blkctl_exit(dcss->blkctl);
> +
> +       dcss_clocks_disable(dcss);
> +
> +       return ret;
> +}
> +
> +static void dcss_submodules_stop(struct dcss_dev *dcss)
> +{
> +       dcss_clocks_enable(dcss);
> +       dcss_scaler_exit(dcss->scaler);
> +       dcss_dpr_exit(dcss->dpr);
> +       dcss_ss_exit(dcss->ss);
> +       dcss_dtg_exit(dcss->dtg);
> +       dcss_ctxld_exit(dcss->ctxld);
> +       dcss_blkctl_exit(dcss->blkctl);
> +       dcss_clocks_disable(dcss);
> +}
> +
> +static int dcss_clks_init(struct dcss_dev *dcss)
> +{
> +       int i;
> +       struct {
> +               const char *id;
> +               struct clk **clk;
> +       } clks[] = {
> +               {"apb",   &dcss->apb_clk},
> +               {"axi",   &dcss->axi_clk},
> +               {"pix",   &dcss->pix_clk},
> +               {"rtrm",  &dcss->rtrm_clk},
> +               {"dtrc",  &dcss->dtrc_clk},
> +       };
> +
> +       for (i = 0; i < ARRAY_SIZE(clks); i++) {
> +               *clks[i].clk = devm_clk_get(dcss->dev, clks[i].id);
> +               if (IS_ERR(*clks[i].clk)) {
> +                       dev_err(dcss->dev, "failed to get %s clock\n",
> +                               clks[i].id);
> +                       return PTR_ERR(*clks[i].clk);
> +               }
> +       }
> +
> +       dcss->clks_on = false;
> +
> +       return 0;
> +}
> +
> +static void dcss_clks_release(struct dcss_dev *dcss)
> +{
> +       devm_clk_put(dcss->dev, dcss->dtrc_clk);
> +       devm_clk_put(dcss->dev, dcss->rtrm_clk);
> +       devm_clk_put(dcss->dev, dcss->pix_clk);
> +       devm_clk_put(dcss->dev, dcss->axi_clk);
> +       devm_clk_put(dcss->dev, dcss->apb_clk);
> +}
> +
> +struct dcss_dev *dcss_dev_create(struct device *dev, bool hdmi_output)
> +{
> +       struct platform_device *pdev = to_platform_device(dev);
> +       int ret;
> +       struct resource *res;
> +       struct dcss_dev *dcss;
> +       const struct dcss_type_data *devtype;
> +
> +       devtype = of_device_get_match_data(dev);
> +       if (!devtype) {
> +               dev_err(dev, "no device match found\n");
> +               return ERR_PTR(-ENODEV);
> +       }
> +
> +       res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
> +       if (!res) {
> +               dev_err(dev, "cannot get memory resource\n");
> +               return ERR_PTR(-EINVAL);
> +       }
> +
> +       dcss = devm_kzalloc(dev, sizeof(struct dcss_dev), GFP_KERNEL);
> +       if (!dcss)
> +               return ERR_PTR(-ENOMEM);
> +
> +       dcss->dev = dev;
> +       dcss->devtype = devtype;
> +       dcss->hdmi_output = hdmi_output;
> +
> +       ret = dcss_clks_init(dcss);
> +       if (ret) {
> +               dev_err(dev, "clocks initialization failed\n");
> +               goto err;
> +       }
> +
> +       dcss->of_port = of_graph_get_port_by_id(dev->of_node, 0);
> +       if (!dcss->of_port) {
> +               dev_err(dev, "no port@0 node in %s\n", dev->of_node->full_name);
> +               ret = -ENODEV;
> +               goto clks_err;
> +       }
> +
> +       dcss->start_addr = res->start;
> +
> +       ret = dcss_submodules_init(dcss);
> +       if (ret) {
> +               dev_err(dev, "submodules initialization failed\n");
> +               goto clks_err;
> +       }
> +
> +       pm_runtime_enable(dev);
> +
> +       return dcss;
> +
> +clks_err:
> +       dcss_clks_release(dcss);
> +
> +err:
> +       devm_kfree(dcss->dev, dcss);
> +
> +       return ERR_PTR(ret);
> +}
> +
> +void dcss_dev_destroy(struct dcss_dev *dcss)
> +{
> +       pm_runtime_disable(dcss->dev);
> +
> +       dcss_submodules_stop(dcss);
> +
> +       dcss_clks_release(dcss);
> +
> +       devm_kfree(dcss->dev, dcss);
> +}
> +
> +#ifdef CONFIG_PM_SLEEP
> +int dcss_dev_suspend(struct device *dev)
> +{
> +       struct dcss_dev *dcss = dcss_drv_dev_to_dcss(dev);
> +       int ret;
> +
> +       drm_mode_config_helper_suspend(dcss_drv_dev_to_drm(dev));
> +
> +       if (pm_runtime_suspended(dev))
> +               return 0;
> +
> +       ret = dcss_ctxld_suspend(dcss->ctxld);
> +       if (ret)
> +               return ret;
> +
> +       dcss_clocks_disable(dcss);
> +
> +       return 0;
> +}
> +
> +int dcss_dev_resume(struct device *dev)
> +{
> +       struct dcss_dev *dcss = dcss_drv_dev_to_dcss(dev);
> +
> +       if (pm_runtime_suspended(dev)) {
> +               drm_mode_config_helper_resume(dcss_drv_dev_to_drm(dev));
> +               return 0;
> +       }
> +
> +       dcss_clocks_enable(dcss);
> +
> +       dcss_blkctl_cfg(dcss->blkctl);
> +
> +       dcss_ctxld_resume(dcss->ctxld);
> +
> +       drm_mode_config_helper_resume(dcss_drv_dev_to_drm(dev));
> +
> +       return 0;
> +}
> +#endif /* CONFIG_PM_SLEEP */
> +
> +#ifdef CONFIG_PM
> +int dcss_dev_runtime_suspend(struct device *dev)
> +{
> +       struct dcss_dev *dcss = dcss_drv_dev_to_dcss(dev);
> +       int ret;
> +
> +       ret = dcss_ctxld_suspend(dcss->ctxld);
> +       if (ret)
> +               return ret;
> +
> +       dcss_clocks_disable(dcss);
> +
> +       return 0;
> +}
> +
> +int dcss_dev_runtime_resume(struct device *dev)
> +{
> +       struct dcss_dev *dcss = dcss_drv_dev_to_dcss(dev);
> +
> +       dcss_clocks_enable(dcss);
> +
> +       dcss_blkctl_cfg(dcss->blkctl);
> +
> +       dcss_ctxld_resume(dcss->ctxld);
> +
> +       return 0;
> +}
> +#endif /* CONFIG_PM */
> diff --git a/drivers/gpu/drm/imx/dcss/dcss-dev.h b/drivers/gpu/drm/imx/dcss/dcss-dev.h
> new file mode 100644
> index 00000000..15c5de3
> --- /dev/null
> +++ b/drivers/gpu/drm/imx/dcss/dcss-dev.h
> @@ -0,0 +1,195 @@
> +/* SPDX-License-Identifier: GPL-2.0 */
> +/*
> + * Copyright 2019 NXP.
> + */
> +
> +#ifndef __DCSS_PRV_H__
> +#define __DCSS_PRV_H__
> +
> +#include <drm/drm_fourcc.h>
> +#include <linux/io.h>
> +#include <video/videomode.h>
> +
> +#define SET                    0x04
> +#define CLR                    0x08
> +#define TGL                    0x0C
> +
> +#define dcss_writel(v, c)      writel((v), (c))
> +#define dcss_readl(c)          readl(c)
> +#define dcss_set(v, c)         writel((v), (c) + SET)
> +#define dcss_clr(v, c)         writel((v), (c) + CLR)
> +#define dcss_toggle(v, c)      writel((v), (c) + TGL)
> +
> +static inline void dcss_update(u32 v, u32 m, void __iomem *c)
> +{
> +       writel((readl(c) & ~(m)) | (v), (c));
> +}
> +
> +#define DCSS_DBG_REG(reg)      {.name = #reg, .ofs = reg}
> +
> +enum {
> +       DCSS_IMX8MQ = 0,
> +};
> +
> +struct dcss_type_data {
> +       const char *name;
> +       u32 blkctl_ofs;
> +       u32 ctxld_ofs;
> +       u32 rdsrc_ofs;
> +       u32 wrscl_ofs;
> +       u32 dtg_ofs;
> +       u32 scaler_ofs;
> +       u32 ss_ofs;
> +       u32 dpr_ofs;
> +       u32 dtrc_ofs;
> +       u32 dec400d_ofs;
> +       u32 hdr10_ofs;
> +};
> +
> +struct dcss_debug_reg {
> +       char *name;
> +       u32 ofs;
> +};
> +
> +enum dcss_ctxld_ctx_type {
> +       CTX_DB,
> +       CTX_SB_HP, /* high-priority */
> +       CTX_SB_LP, /* low-priority  */
> +};
> +
> +struct dcss_dev {
> +       struct device *dev;
> +       const struct dcss_type_data *devtype;
> +       struct device_node *of_port;
> +
> +       u32 start_addr;
> +
> +       struct dcss_blkctl *blkctl;
> +       struct dcss_ctxld *ctxld;
> +       struct dcss_dpr *dpr;
> +       struct dcss_dtg *dtg;
> +       struct dcss_ss *ss;
> +       struct dcss_hdr10 *hdr10;
> +       struct dcss_scaler *scaler;
> +       struct dcss_dtrc *dtrc;
> +       struct dcss_dec400d *dec400d;
> +       struct dcss_wrscl *wrscl;
> +       struct dcss_rdsrc *rdsrc;
> +
> +       struct clk *apb_clk;
> +       struct clk *axi_clk;
> +       struct clk *pix_clk;
> +       struct clk *rtrm_clk;
> +       struct clk *dtrc_clk;
> +       struct clk *pll_src_clk;
> +       struct clk *pll_phy_ref_clk;
> +
> +       void (*dcss_disable_callback)(void *data);
> +
> +       bool clks_on;
> +       bool hdmi_output;
> +};
> +
> +enum dcss_color_space {
> +       DCSS_COLORSPACE_RGB,
> +       DCSS_COLORSPACE_YUV,
> +       DCSS_COLORSPACE_UNKNOWN,
> +};
> +
> +struct dcss_dev *dcss_drv_dev_to_dcss(struct device *dev);
> +struct drm_device *dcss_drv_dev_to_drm(struct device *dev);
> +struct dcss_dev *dcss_dev_create(struct device *dev, bool mipi_output);
> +void dcss_dev_destroy(struct dcss_dev *dcss);
> +int dcss_dev_runtime_suspend(struct device *dev);
> +int dcss_dev_runtime_resume(struct device *dev);
> +int dcss_dev_suspend(struct device *dev);
> +int dcss_dev_resume(struct device *dev);
> +
> +/* BLKCTL */
> +int dcss_blkctl_init(struct dcss_dev *dcss, unsigned long blkctl_base);
> +void dcss_blkctl_cfg(struct dcss_blkctl *blkctl);
> +void dcss_blkctl_exit(struct dcss_blkctl *blkctl);
> +
> +/* CTXLD */
> +int dcss_ctxld_init(struct dcss_dev *dcss, unsigned long ctxld_base);
> +void dcss_ctxld_exit(struct dcss_ctxld *ctxld);
> +void dcss_ctxld_write(struct dcss_ctxld *ctxld, u32 ctx_id,
> +                     u32 val, u32 reg_idx);
> +int dcss_ctxld_resume(struct dcss_ctxld *dcss_ctxld);
> +int dcss_ctxld_suspend(struct dcss_ctxld *dcss_ctxld);
> +void dcss_ctxld_write_irqsafe(struct dcss_ctxld *ctlxd, u32 ctx_id, u32 val,
> +                             u32 reg_ofs);
> +void dcss_ctxld_kick(struct dcss_ctxld *ctxld);
> +bool dcss_ctxld_is_flushed(struct dcss_ctxld *ctxld);
> +int dcss_ctxld_enable(struct dcss_ctxld *ctxld);
> +void dcss_ctxld_register_dtg_disable_cb(struct dcss_ctxld *ctxld,
> +                                       void (*cb)(void *),
> +                                       void *data);
> +
> +/* DPR */
> +enum dcss_tile_type {
> +       TILE_LINEAR = 0,
> +       TILE_GPU_STANDARD,
> +       TILE_GPU_SUPER,
> +       TILE_VPU_YUV420,
> +       TILE_VPU_VP9,
> +};
> +
> +enum dcss_pix_size {
> +       PIX_SIZE_8,
> +       PIX_SIZE_16,
> +       PIX_SIZE_32,
> +};
> +
> +int dcss_dpr_init(struct dcss_dev *dcss, unsigned long dpr_base);
> +void dcss_dpr_exit(struct dcss_dpr *dpr);
> +void dcss_dpr_write_sysctrl(struct dcss_dpr *dpr);
> +void dcss_dpr_set_res(struct dcss_dpr *dpr, int ch_num, u32 xres, u32 yres);
> +void dcss_dpr_addr_set(struct dcss_dpr *dpr, int ch_num, u32 luma_base_addr,
> +                      u32 chroma_base_addr, u16 pitch);
> +void dcss_dpr_enable(struct dcss_dpr *dpr, int ch_num, bool en);
> +void dcss_dpr_format_set(struct dcss_dpr *dpr, int ch_num,
> +                        const struct drm_format_info *format, u64 modifier);
> +void dcss_dpr_set_rotation(struct dcss_dpr *dpr, int ch_num, u32 rotation);
> +
> +/* DTG */
> +int dcss_dtg_init(struct dcss_dev *dcss, unsigned long dtg_base);
> +void dcss_dtg_exit(struct dcss_dtg *dtg);
> +bool dcss_dtg_vblank_irq_valid(struct dcss_dtg *dtg);
> +void dcss_dtg_vblank_irq_enable(struct dcss_dtg *dtg, bool en);
> +void dcss_dtg_vblank_irq_clear(struct dcss_dtg *dtg);
> +void dcss_dtg_sync_set(struct dcss_dtg *dtg, struct videomode *vm);
> +void dcss_dtg_css_set(struct dcss_dtg *dtg);
> +void dcss_dtg_enable(struct dcss_dtg *dtg, bool en,
> +                    struct completion *dis_completion);
> +bool dcss_dtg_is_enabled(struct dcss_dtg *dtg);
> +void dcss_dtg_ctxld_kick_irq_enable(struct dcss_dtg *dtg, bool en);
> +bool dcss_dtg_global_alpha_changed(struct dcss_dtg *dtg, int ch_num, int alpha);
> +void dcss_dtg_plane_alpha_set(struct dcss_dtg *dtg, int ch_num,
> +                             const struct drm_format_info *format, int alpha);
> +void dcss_dtg_plane_pos_set(struct dcss_dtg *dtg, int ch_num,
> +                           int px, int py, int pw, int ph);
> +void dcss_dtg_ch_enable(struct dcss_dtg *dtg, int ch_num, bool en);
> +
> +/* SUBSAM */
> +int dcss_ss_init(struct dcss_dev *dcss, unsigned long subsam_base);
> +void dcss_ss_exit(struct dcss_ss *ss);
> +void dcss_ss_enable(struct dcss_ss *ss);
> +void dcss_ss_disable(struct dcss_ss *ss);
> +void dcss_ss_subsam_set(struct dcss_ss *ss);
> +void dcss_ss_sync_set(struct dcss_ss *ss, struct videomode *vm,
> +                     bool phsync, bool pvsync);
> +
> +/* SCALER */
> +int dcss_scaler_init(struct dcss_dev *dcss, unsigned long scaler_base);
> +void dcss_scaler_exit(struct dcss_scaler *scl);
> +void dcss_scaler_setup(struct dcss_scaler *scl, int ch_num,
> +                      const struct drm_format_info *format,
> +                      int src_xres, int src_yres, int dst_xres, int dst_yres,
> +                      u32 vrefresh_hz);
> +void dcss_scaler_ch_enable(struct dcss_scaler *scl, int ch_num, bool en);
> +int dcss_scaler_get_min_max_ratios(struct dcss_scaler *scl, int ch_num,
> +                                  int *min, int *max);
> +void dcss_scaler_write_sclctrl(struct dcss_scaler *scl);
> +
> +#endif /* __DCSS_PRV_H__ */
> diff --git a/drivers/gpu/drm/imx/dcss/dcss-dpr.c b/drivers/gpu/drm/imx/dcss/dcss-dpr.c
> new file mode 100644
> index 00000000..dbc7169
> --- /dev/null
> +++ b/drivers/gpu/drm/imx/dcss/dcss-dpr.c
> @@ -0,0 +1,552 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * Copyright 2019 NXP.
> + */
> +
> +#include <linux/device.h>
> +
> +#include "dcss-dev.h"
> +
> +#define DCSS_DPR_SYSTEM_CTRL0                  0x000
> +#define   RUN_EN                               BIT(0)
> +#define   SOFT_RESET                           BIT(1)
> +#define   REPEAT_EN                            BIT(2)
> +#define   SHADOW_LOAD_EN                       BIT(3)
> +#define   SW_SHADOW_LOAD_SEL                   BIT(4)
> +#define   BCMD2AXI_MSTR_ID_CTRL                        BIT(16)
> +#define DCSS_DPR_IRQ_MASK                      0x020
> +#define DCSS_DPR_IRQ_MASK_STATUS               0x030
> +#define DCSS_DPR_IRQ_NONMASK_STATUS            0x040
> +#define   IRQ_DPR_CTRL_DONE                    BIT(0)
> +#define   IRQ_DPR_RUN                          BIT(1)
> +#define   IRQ_DPR_SHADOW_LOADED                        BIT(2)
> +#define   IRQ_AXI_READ_ERR                     BIT(3)
> +#define   DPR2RTR_YRGB_FIFO_OVFL               BIT(4)
> +#define   DPR2RTR_UV_FIFO_OVFL                 BIT(5)
> +#define   DPR2RTR_FIFO_LD_BUF_RDY_YRGB_ERR     BIT(6)
> +#define   DPR2RTR_FIFO_LD_BUF_RDY_UV_ERR       BIT(7)
> +#define DCSS_DPR_MODE_CTRL0                    0x050
> +#define   RTR_3BUF_EN                          BIT(0)
> +#define   RTR_4LINE_BUF_EN                     BIT(1)
> +#define   TILE_TYPE_POS                                2
> +#define   TILE_TYPE_MASK                       GENMASK(4, 2)
> +#define   YUV_EN                               BIT(6)
> +#define   COMP_2PLANE_EN                       BIT(7)
> +#define   PIX_SIZE_POS                         8
> +#define   PIX_SIZE_MASK                                GENMASK(9, 8)
> +#define   PIX_LUMA_UV_SWAP                     BIT(10)
> +#define   PIX_UV_SWAP                          BIT(11)
> +#define   B_COMP_SEL_POS                       12
> +#define   B_COMP_SEL_MASK                      GENMASK(13, 12)
> +#define   G_COMP_SEL_POS                       14
> +#define   G_COMP_SEL_MASK                      GENMASK(15, 14)
> +#define   R_COMP_SEL_POS                       16
> +#define   R_COMP_SEL_MASK                      GENMASK(17, 16)
> +#define   A_COMP_SEL_POS                       18
> +#define   A_COMP_SEL_MASK                      GENMASK(19, 18)
> +#define DCSS_DPR_FRAME_CTRL0                   0x070
> +#define   HFLIP_EN                             BIT(0)
> +#define   VFLIP_EN                             BIT(1)
> +#define   ROT_ENC_POS                          2
> +#define   ROT_ENC_MASK                         GENMASK(3, 2)
> +#define   ROT_FLIP_ORDER_EN                    BIT(4)
> +#define   PITCH_POS                            16
> +#define   PITCH_MASK                           GENMASK(31, 16)
> +#define DCSS_DPR_FRAME_1P_CTRL0                        0x090
> +#define DCSS_DPR_FRAME_1P_PIX_X_CTRL           0x0A0
> +#define DCSS_DPR_FRAME_1P_PIX_Y_CTRL           0x0B0
> +#define DCSS_DPR_FRAME_1P_BASE_ADDR            0x0C0
> +#define DCSS_DPR_FRAME_2P_CTRL0                        0x0E0
> +#define DCSS_DPR_FRAME_2P_PIX_X_CTRL           0x0F0
> +#define DCSS_DPR_FRAME_2P_PIX_Y_CTRL           0x100
> +#define DCSS_DPR_FRAME_2P_BASE_ADDR            0x110
> +#define DCSS_DPR_STATUS_CTRL0                  0x130
> +#define   STATUS_MUX_SEL_MASK                  GENMASK(2, 0)
> +#define   STATUS_SRC_SEL_POS                   16
> +#define   STATUS_SRC_SEL_MASK                  GENMASK(18, 16)
> +#define DCSS_DPR_STATUS_CTRL1                  0x140
> +#define DCSS_DPR_RTRAM_CTRL0                   0x200
> +#define   NUM_ROWS_ACTIVE                      BIT(0)
> +#define   THRES_HIGH_POS                       1
> +#define   THRES_HIGH_MASK                      GENMASK(3, 1)
> +#define   THRES_LOW_POS                                4
> +#define   THRES_LOW_MASK                       GENMASK(6, 4)
> +#define   ABORT_SEL                            BIT(7)
> +
> +struct dcss_dpr_ch {
> +       struct dcss_dpr *dpr;
> +       void __iomem *base_reg;
> +       u32 base_ofs;
> +
> +       struct drm_format_info format;
> +       enum dcss_pix_size pix_size;
> +       enum dcss_tile_type tile;
> +       bool rtram_4line_en;
> +       bool rtram_3buf_en;
> +
> +       u32 frame_ctrl;
> +       u32 mode_ctrl;
> +       u32 sys_ctrl;
> +       u32 rtram_ctrl;
> +
> +       bool sys_ctrl_chgd;
> +
> +       u32 pitch;
> +
> +       int ch_num;
> +       int irq;
> +};
> +
> +struct dcss_dpr {
> +       struct device *dev;
> +       struct dcss_ctxld *ctxld;
> +       u32  ctx_id;
> +
> +       struct dcss_dpr_ch ch[3];
> +};
> +
> +static void dcss_dpr_write(struct dcss_dpr_ch *ch, u32 val, u32 ofs)
> +{
> +       struct dcss_dpr *dpr = ch->dpr;
> +
> +       dcss_ctxld_write(dpr->ctxld, dpr->ctx_id, val, ch->base_ofs + ofs);
> +}
> +
> +static int dcss_dpr_ch_init_all(struct dcss_dpr *dpr, unsigned long dpr_base)
> +{
> +       struct dcss_dpr_ch *ch;
> +       int i;
> +
> +       for (i = 0; i < 3; i++) {
> +               ch = &dpr->ch[i];
> +
> +               ch->base_ofs = dpr_base + i * 0x1000;

Same with i.MX8QM & i.MX8QXP, every DPR instance has three channels.
Each channel has it's own register space.
For i.MX8QM & i.MX8QXP SoCs, the connection between DPR channel
and PRG(s) can be reflected in device tree.  So, it would be good if the
DPR driver wraps one single DPR channel only.

Regards,
Liu Ying

> +
> +               ch->base_reg = devm_ioremap(dpr->dev, ch->base_ofs, SZ_4K);
> +               if (!ch->base_reg) {
> +                       dev_err(dpr->dev, "dpr: unable to remap ch %d base\n",
> +                               i);
> +                       return -ENOMEM;
> +               }
> +
> +               ch->dpr = dpr;
> +               ch->ch_num = i;
> +       }
> +
> +       return 0;
> +}
> +
> +int dcss_dpr_init(struct dcss_dev *dcss, unsigned long dpr_base)
> +{
> +       struct dcss_dpr *dpr;
> +
> +       dpr = devm_kzalloc(dcss->dev, sizeof(struct dcss_dpr), GFP_KERNEL);
> +       if (!dpr)
> +               return -ENOMEM;
> +
> +       dcss->dpr = dpr;
> +       dpr->dev = dcss->dev;
> +       dpr->ctxld = dcss->ctxld;
> +       dpr->ctx_id = CTX_SB_HP;
> +
> +       if (dcss_dpr_ch_init_all(dpr, dpr_base)) {
> +               int i;
> +
> +               for (i = 0; i < 3; i++) {
> +                       if (dpr->ch[i].base_reg)
> +                               devm_iounmap(dpr->dev, dpr->ch[i].base_reg);
> +               }
> +
> +               devm_kfree(dpr->dev, dpr);
> +
> +               return -ENOMEM;
> +       }
> +
> +       return 0;
> +}
> +
> +void dcss_dpr_exit(struct dcss_dpr *dpr)
> +{
> +       int ch_no;
> +
> +       /* stop DPR on all channels */
> +       for (ch_no = 0; ch_no < 3; ch_no++) {
> +               struct dcss_dpr_ch *ch = &dpr->ch[ch_no];
> +
> +               dcss_writel(0, ch->base_reg + DCSS_DPR_SYSTEM_CTRL0);
> +
> +               if (ch->base_reg)
> +                       devm_iounmap(dpr->dev, ch->base_reg);
> +       }
> +
> +       devm_kfree(dpr->dev, dpr);
> +}
> +
> +static u32 dcss_dpr_x_pix_wide_adjust(struct dcss_dpr_ch *ch, u32 pix_wide,
> +                                     u32 pix_format)
> +{
> +       u8 pix_in_64byte_map[3][5] = {
> +               /* LIN, GPU_STD, GPU_SUP, VPU_YUV420, VPU_VP9 */
> +               {   64,       8,       8,          8,     16}, /* PIX_SIZE_8  */
> +               {   32,       8,       8,          8,      8}, /* PIX_SIZE_16 */
> +               {   16,       4,       4,          8,      8}, /* PIX_SIZE_32 */
> +       };
> +       u32 offset;
> +       u32 div_64byte_mod, pix_in_64byte;
> +
> +       pix_in_64byte = pix_in_64byte_map[ch->pix_size][ch->tile];
> +
> +       if (pix_format == DRM_FORMAT_P010)
> +               pix_wide = pix_wide * 10 / 8;
> +
> +       div_64byte_mod = pix_wide % pix_in_64byte;
> +       offset = (div_64byte_mod == 0) ? 0 : (pix_in_64byte - div_64byte_mod);
> +
> +       return pix_wide + offset;
> +}
> +
> +static u32 dcss_dpr_y_pix_high_adjust(struct dcss_dpr_ch *ch, u32 pix_high,
> +                                     u32 pix_format)
> +{
> +       u8 num_rows_buf = ch->rtram_4line_en ? 4 : 8;
> +       u32 offset, pix_y_mod;
> +
> +       pix_y_mod = pix_high % num_rows_buf;
> +       offset = pix_y_mod ? (num_rows_buf - pix_y_mod) : 0;
> +
> +       return pix_high + offset;
> +}
> +
> +void dcss_dpr_set_res(struct dcss_dpr *dpr, int ch_num, u32 xres, u32 yres)
> +{
> +       struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
> +       u32 pix_format = ch->format.format;
> +       u32 gap = DCSS_DPR_FRAME_2P_BASE_ADDR - DCSS_DPR_FRAME_1P_BASE_ADDR;
> +       int plane, max_planes = 1;
> +       u32 pix_x_wide, pix_y_high;
> +
> +       if (pix_format == DRM_FORMAT_NV12 ||
> +           pix_format == DRM_FORMAT_NV21)
> +               max_planes = 2;
> +
> +       for (plane = 0; plane < max_planes; plane++) {
> +               yres = plane == 1 ? yres >> 1 : yres;
> +
> +               pix_x_wide = dcss_dpr_x_pix_wide_adjust(ch, xres, pix_format);
> +               pix_y_high = dcss_dpr_y_pix_high_adjust(ch, yres, pix_format);
> +
> +               if (plane == 0)
> +                       ch->pitch = pix_x_wide;
> +
> +               dcss_dpr_write(ch, pix_x_wide,
> +                              DCSS_DPR_FRAME_1P_PIX_X_CTRL + plane * gap);
> +               dcss_dpr_write(ch, pix_y_high,
> +                              DCSS_DPR_FRAME_1P_PIX_Y_CTRL + plane * gap);
> +
> +               dcss_dpr_write(ch, 2, DCSS_DPR_FRAME_1P_CTRL0 + plane * gap);
> +       }
> +}
> +
> +void dcss_dpr_addr_set(struct dcss_dpr *dpr, int ch_num, u32 luma_base_addr,
> +                      u32 chroma_base_addr, u16 pitch)
> +{
> +       struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
> +
> +       dcss_dpr_write(ch, luma_base_addr, DCSS_DPR_FRAME_1P_BASE_ADDR);
> +
> +       dcss_dpr_write(ch, chroma_base_addr, DCSS_DPR_FRAME_2P_BASE_ADDR);
> +
> +       ch->frame_ctrl &= ~PITCH_MASK;
> +       ch->frame_ctrl |= (((u32)pitch << PITCH_POS) & PITCH_MASK);
> +}
> +
> +static void dcss_dpr_argb_comp_sel(struct dcss_dpr_ch *ch, int a_sel, int r_sel,
> +                                  int g_sel, int b_sel)
> +{
> +       u32 sel;
> +
> +       sel = ((a_sel << A_COMP_SEL_POS) & A_COMP_SEL_MASK) |
> +             ((r_sel << R_COMP_SEL_POS) & R_COMP_SEL_MASK) |
> +             ((g_sel << G_COMP_SEL_POS) & G_COMP_SEL_MASK) |
> +             ((b_sel << B_COMP_SEL_POS) & B_COMP_SEL_MASK);
> +
> +       ch->mode_ctrl &= ~(A_COMP_SEL_MASK | R_COMP_SEL_MASK |
> +                          G_COMP_SEL_MASK | B_COMP_SEL_MASK);
> +       ch->mode_ctrl |= sel;
> +}
> +
> +static void dcss_dpr_pix_size_set(struct dcss_dpr_ch *ch,
> +                                 const struct drm_format_info *format)
> +{
> +       u32 val;
> +
> +       switch (format->format) {
> +       case DRM_FORMAT_NV12:
> +       case DRM_FORMAT_NV21:
> +               val = 0;
> +               break;
> +
> +       case DRM_FORMAT_UYVY:
> +       case DRM_FORMAT_VYUY:
> +       case DRM_FORMAT_YUYV:
> +       case DRM_FORMAT_YVYU:
> +               val = 1;
> +               break;
> +
> +       default:
> +               val = 2;
> +               break;
> +       }
> +
> +       ch->pix_size = val;
> +
> +       ch->mode_ctrl &= ~PIX_SIZE_MASK;
> +       ch->mode_ctrl |= ((val << PIX_SIZE_POS) & PIX_SIZE_MASK);
> +}
> +
> +static void dcss_dpr_uv_swap(struct dcss_dpr_ch *ch, bool swap)
> +{
> +       ch->mode_ctrl &= ~PIX_UV_SWAP;
> +       ch->mode_ctrl |= (swap ? PIX_UV_SWAP : 0);
> +}
> +
> +static void dcss_dpr_y_uv_swap(struct dcss_dpr_ch *ch, bool swap)
> +{
> +       ch->mode_ctrl &= ~PIX_LUMA_UV_SWAP;
> +       ch->mode_ctrl |= (swap ? PIX_LUMA_UV_SWAP : 0);
> +}
> +
> +static void dcss_dpr_2plane_en(struct dcss_dpr_ch *ch, bool en)
> +{
> +       ch->mode_ctrl &= ~COMP_2PLANE_EN;
> +       ch->mode_ctrl |= (en ? COMP_2PLANE_EN : 0);
> +}
> +
> +static void dcss_dpr_yuv_en(struct dcss_dpr_ch *ch, bool en)
> +{
> +       ch->mode_ctrl &= ~YUV_EN;
> +       ch->mode_ctrl |= (en ? YUV_EN : 0);
> +}
> +
> +void dcss_dpr_enable(struct dcss_dpr *dpr, int ch_num, bool en)
> +{
> +       struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
> +       u32 sys_ctrl;
> +
> +       sys_ctrl = (en ? REPEAT_EN | RUN_EN : 0);
> +
> +       if (en) {
> +               dcss_dpr_write(ch, ch->mode_ctrl, DCSS_DPR_MODE_CTRL0);
> +               dcss_dpr_write(ch, ch->frame_ctrl, DCSS_DPR_FRAME_CTRL0);
> +               dcss_dpr_write(ch, ch->rtram_ctrl, DCSS_DPR_RTRAM_CTRL0);
> +       }
> +
> +       if (ch->sys_ctrl != sys_ctrl)
> +               ch->sys_ctrl_chgd = true;
> +
> +       ch->sys_ctrl = sys_ctrl;
> +}
> +
> +struct rgb_comp_sel {
> +       u32 drm_format;
> +       int a_sel;
> +       int r_sel;
> +       int g_sel;
> +       int b_sel;
> +};
> +
> +static struct rgb_comp_sel comp_sel_map[] = {
> +       {DRM_FORMAT_ARGB8888, 3, 2, 1, 0},
> +       {DRM_FORMAT_XRGB8888, 3, 2, 1, 0},
> +       {DRM_FORMAT_ABGR8888, 3, 0, 1, 2},
> +       {DRM_FORMAT_XBGR8888, 3, 0, 1, 2},
> +       {DRM_FORMAT_RGBA8888, 0, 3, 2, 1},
> +       {DRM_FORMAT_RGBX8888, 0, 3, 2, 1},
> +       {DRM_FORMAT_BGRA8888, 0, 1, 2, 3},
> +       {DRM_FORMAT_BGRX8888, 0, 1, 2, 3},
> +};
> +
> +static int to_comp_sel(u32 pix_fmt, int *a_sel, int *r_sel, int *g_sel,
> +                      int *b_sel)
> +{
> +       int i;
> +
> +       for (i = 0; i < ARRAY_SIZE(comp_sel_map); i++) {
> +               if (comp_sel_map[i].drm_format == pix_fmt) {
> +                       *a_sel = comp_sel_map[i].a_sel;
> +                       *r_sel = comp_sel_map[i].r_sel;
> +                       *g_sel = comp_sel_map[i].g_sel;
> +                       *b_sel = comp_sel_map[i].b_sel;
> +
> +                       return 0;
> +               }
> +       }
> +
> +       return -1;
> +}
> +
> +static void dcss_dpr_rtram_set(struct dcss_dpr_ch *ch, u32 pix_format)
> +{
> +       u32 val, mask;
> +
> +       switch (pix_format) {
> +       case DRM_FORMAT_NV21:
> +       case DRM_FORMAT_NV12:
> +       case DRM_FORMAT_P010:
> +               ch->rtram_3buf_en = true;
> +               ch->rtram_4line_en = false;
> +               break;
> +
> +       default:
> +               ch->rtram_3buf_en = true;
> +               ch->rtram_4line_en = true;
> +               break;
> +       }
> +
> +       val = (ch->rtram_4line_en ? RTR_4LINE_BUF_EN : 0);
> +       val |= (ch->rtram_3buf_en ? RTR_3BUF_EN : 0);
> +       mask = RTR_4LINE_BUF_EN | RTR_3BUF_EN;
> +
> +       ch->mode_ctrl &= ~mask;
> +       ch->mode_ctrl |= (val & mask);
> +
> +       val = (ch->rtram_4line_en ? 0 : NUM_ROWS_ACTIVE);
> +       val |= (3 << THRES_LOW_POS) & THRES_LOW_MASK;
> +       val |= (4 << THRES_HIGH_POS) & THRES_HIGH_MASK;
> +       mask = THRES_LOW_MASK | THRES_HIGH_MASK | NUM_ROWS_ACTIVE;
> +
> +       ch->rtram_ctrl &= ~mask;
> +       ch->rtram_ctrl |= (val & mask);
> +}
> +
> +static void dcss_dpr_setup_components(struct dcss_dpr_ch *ch,
> +                                     const struct drm_format_info *format)
> +{
> +       int a_sel, r_sel, g_sel, b_sel;
> +       bool uv_swap, y_uv_swap;
> +
> +       switch (format->format) {
> +       case DRM_FORMAT_YVYU:
> +               uv_swap = true;
> +               y_uv_swap = true;
> +               break;
> +
> +       case DRM_FORMAT_VYUY:
> +       case DRM_FORMAT_NV21:
> +               uv_swap = true;
> +               y_uv_swap = false;
> +               break;
> +
> +       case DRM_FORMAT_YUYV:
> +               uv_swap = false;
> +               y_uv_swap = true;
> +               break;
> +
> +       default:
> +               uv_swap = false;
> +               y_uv_swap = false;
> +               break;
> +       }
> +
> +       dcss_dpr_uv_swap(ch, uv_swap);
> +
> +       dcss_dpr_y_uv_swap(ch, y_uv_swap);
> +
> +       if (!format->is_yuv) {
> +               if (!to_comp_sel(format->format, &a_sel, &r_sel,
> +                                &g_sel, &b_sel)) {
> +                       dcss_dpr_argb_comp_sel(ch, a_sel, r_sel, g_sel, b_sel);
> +               } else {
> +                       dcss_dpr_argb_comp_sel(ch, 3, 2, 1, 0);
> +               }
> +       } else {
> +               dcss_dpr_argb_comp_sel(ch, 0, 0, 0, 0);
> +       }
> +}
> +
> +static void dcss_dpr_tile_set(struct dcss_dpr_ch *ch, uint64_t modifier)
> +{
> +       switch (ch->ch_num) {
> +       case 0:
> +               switch (modifier) {
> +               case DRM_FORMAT_MOD_LINEAR:
> +                       ch->tile = TILE_LINEAR;
> +                       break;
> +               case DRM_FORMAT_MOD_VIVANTE_TILED:
> +                       ch->tile = TILE_GPU_STANDARD;
> +                       break;
> +               case DRM_FORMAT_MOD_VIVANTE_SUPER_TILED:
> +                       ch->tile = TILE_GPU_SUPER;
> +                       break;
> +               default:
> +                       WARN_ON(1);
> +                       break;
> +               }
> +               break;
> +       case 1:
> +       case 2:
> +               ch->tile = TILE_LINEAR;
> +               break;
> +       default:
> +               WARN_ON(1);
> +               return;
> +       }
> +
> +       ch->mode_ctrl &= ~TILE_TYPE_MASK;
> +       ch->mode_ctrl |= ((ch->tile << TILE_TYPE_POS) & TILE_TYPE_MASK);
> +}
> +
> +void dcss_dpr_format_set(struct dcss_dpr *dpr, int ch_num,
> +                        const struct drm_format_info *format, u64 modifier)
> +{
> +       struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
> +
> +       ch->format = *format;
> +
> +       dcss_dpr_yuv_en(ch, format->is_yuv);
> +
> +       dcss_dpr_pix_size_set(ch, format);
> +
> +       dcss_dpr_setup_components(ch, format);
> +
> +       dcss_dpr_2plane_en(ch, format->num_planes == 2);
> +
> +       dcss_dpr_rtram_set(ch, format->format);
> +
> +       dcss_dpr_tile_set(ch, modifier);
> +}
> +
> +/* This function will be called from interrupt context. */
> +void dcss_dpr_write_sysctrl(struct dcss_dpr *dpr)
> +{
> +       int chnum;
> +
> +       for (chnum = 0; chnum < 3; chnum++) {
> +               struct dcss_dpr_ch *ch = &dpr->ch[chnum];
> +
> +               if (ch->sys_ctrl_chgd) {
> +                       dcss_ctxld_write_irqsafe(dpr->ctxld, dpr->ctx_id,
> +                                                ch->sys_ctrl,
> +                                                ch->base_ofs +
> +                                                DCSS_DPR_SYSTEM_CTRL0);
> +                       ch->sys_ctrl_chgd = false;
> +               }
> +       }
> +}
> +
> +void dcss_dpr_set_rotation(struct dcss_dpr *dpr, int ch_num, u32 rotation)
> +{
> +       struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
> +
> +       ch->frame_ctrl &= ~(HFLIP_EN | VFLIP_EN | ROT_ENC_MASK);
> +
> +       ch->frame_ctrl |= rotation & DRM_MODE_REFLECT_X ? HFLIP_EN : 0;
> +       ch->frame_ctrl |= rotation & DRM_MODE_REFLECT_Y ? VFLIP_EN : 0;
> +
> +       if (rotation & DRM_MODE_ROTATE_90)
> +               ch->frame_ctrl |= 1 << ROT_ENC_POS;
> +       else if (rotation & DRM_MODE_ROTATE_180)
> +               ch->frame_ctrl |= 2 << ROT_ENC_POS;
> +       else if (rotation & DRM_MODE_ROTATE_270)
> +               ch->frame_ctrl |= 3 << ROT_ENC_POS;
> +}
> diff --git a/drivers/gpu/drm/imx/dcss/dcss-drv.c b/drivers/gpu/drm/imx/dcss/dcss-drv.c
> new file mode 100644
> index 00000000..7ea131d
> --- /dev/null
> +++ b/drivers/gpu/drm/imx/dcss/dcss-drv.c
> @@ -0,0 +1,182 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * Copyright 2019 NXP.
> + */
> +
> +#include <linux/module.h>
> +#include <linux/kernel.h>
> +#include <linux/platform_device.h>
> +#include <linux/component.h>
> +#include <drm/drm_of.h>
> +#include <drm/drmP.h>
> +
> +#include "dcss-dev.h"
> +#include "dcss-kms.h"
> +
> +struct dcss_drv {
> +       struct dcss_dev *dcss;
> +       struct dcss_kms_dev *kms;
> +
> +       bool is_componentized;
> +};
> +
> +struct dcss_dev *dcss_drv_dev_to_dcss(struct device *dev)
> +{
> +       struct dcss_drv *mdrv = dev_get_drvdata(dev);
> +
> +       return mdrv ? mdrv->dcss : NULL;
> +}
> +
> +struct drm_device *dcss_drv_dev_to_drm(struct device *dev)
> +{
> +       struct dcss_drv *mdrv = dev_get_drvdata(dev);
> +
> +       return mdrv ? &mdrv->kms->base : NULL;
> +}
> +
> +static int dcss_drv_init(struct device *dev, bool componentized)
> +{
> +       struct dcss_drv *mdrv;
> +       int err = 0;
> +
> +       mdrv = devm_kzalloc(dev, sizeof(*mdrv), GFP_KERNEL);
> +       if (!mdrv)
> +               return -ENOMEM;
> +
> +       mdrv->is_componentized = componentized;
> +
> +       mdrv->dcss = dcss_dev_create(dev, componentized);
> +       if (IS_ERR(mdrv->dcss)) {
> +               err = PTR_ERR(mdrv->dcss);
> +               goto err;
> +       }
> +
> +       dev_set_drvdata(dev, mdrv);
> +
> +       mdrv->kms = dcss_kms_attach(mdrv->dcss, componentized);
> +       if (IS_ERR(mdrv->kms)) {
> +               err = PTR_ERR(mdrv->kms);
> +               goto dcss_shutoff;
> +       }
> +
> +       return 0;
> +
> +dcss_shutoff:
> +       dcss_dev_destroy(mdrv->dcss);
> +
> +       dev_set_drvdata(dev, NULL);
> +
> +err:
> +       devm_kfree(dev, mdrv);
> +       return err;
> +}
> +
> +static void dcss_drv_deinit(struct device *dev, bool componentized)
> +{
> +       struct dcss_drv *mdrv = dev_get_drvdata(dev);
> +
> +       if (!mdrv)
> +               return;
> +
> +       dcss_kms_detach(mdrv->kms, componentized);
> +       dcss_dev_destroy(mdrv->dcss);
> +
> +       dev_set_drvdata(dev, NULL);
> +}
> +
> +static int dcss_drv_bind(struct device *dev)
> +{
> +       return dcss_drv_init(dev, true);
> +}
> +
> +static void dcss_drv_unbind(struct device *dev)
> +{
> +       return dcss_drv_deinit(dev, true);
> +}
> +
> +static const struct component_master_ops dcss_master_ops = {
> +       .bind   = dcss_drv_bind,
> +       .unbind = dcss_drv_unbind,
> +};
> +
> +static int compare_of(struct device *dev, void *data)
> +{
> +       return dev->of_node == data;
> +}
> +
> +static int dcss_drv_platform_probe(struct platform_device *pdev)
> +{
> +       struct device *dev = &pdev->dev;
> +       struct component_match *match = NULL;
> +       struct device_node *remote;
> +
> +       if (!dev->of_node)
> +               return -ENODEV;
> +
> +       remote = of_graph_get_remote_node(dev->of_node, 0, 0);
> +       if (!remote)
> +               return -ENODEV;
> +
> +       if (of_device_is_compatible(remote, "fsl,imx8mq-nwl-dsi")) {
> +               of_node_put(remote);
> +               return dcss_drv_init(dev, false);
> +       }
> +
> +       drm_of_component_match_add(dev, &match, compare_of, remote);
> +       of_node_put(remote);
> +
> +       return component_master_add_with_match(dev, &dcss_master_ops, match);
> +}
> +
> +static int dcss_drv_platform_remove(struct platform_device *pdev)
> +{
> +       struct dcss_drv *mdrv = dev_get_drvdata(&pdev->dev);
> +
> +       if (mdrv->is_componentized)
> +               component_master_del(&pdev->dev, &dcss_master_ops);
> +       else
> +               dcss_drv_deinit(&pdev->dev, false);
> +
> +       return 0;
> +}
> +
> +static struct dcss_type_data dcss_types[] = {
> +       [DCSS_IMX8MQ] = {
> +               .name = "DCSS_IMX8MQ",
> +               .blkctl_ofs = 0x2F000,
> +               .ctxld_ofs = 0x23000,
> +               .dtg_ofs = 0x20000,
> +               .scaler_ofs = 0x1C000,
> +               .ss_ofs = 0x1B000,
> +               .dpr_ofs = 0x18000,
> +       },
> +};
> +
> +static const struct of_device_id dcss_of_match[] = {
> +       { .compatible = "nxp,imx8mq-dcss", .data = &dcss_types[DCSS_IMX8MQ], },
> +       {},
> +};
> +
> +MODULE_DEVICE_TABLE(of, dcss_of_match);
> +
> +static const struct dev_pm_ops dcss_dev_pm = {
> +       SET_SYSTEM_SLEEP_PM_OPS(dcss_dev_suspend, dcss_dev_resume)
> +       SET_RUNTIME_PM_OPS(dcss_dev_runtime_suspend,
> +                          dcss_dev_runtime_resume, NULL)
> +};
> +
> +static struct platform_driver dcss_platform_driver = {
> +       .probe  = dcss_drv_platform_probe,
> +       .remove = dcss_drv_platform_remove,
> +       .driver = {
> +               .name = "imx-dcss",
> +               .of_match_table = dcss_of_match,
> +               .pm = &dcss_dev_pm,
> +       },
> +};
> +
> +module_platform_driver(dcss_platform_driver);
> +
> +MODULE_AUTHOR("Laurentiu Palcu <laurentiu.palcu@nxp.com>");
> +MODULE_DESCRIPTION("DCSS driver for i.MX8MQ");
> +MODULE_LICENSE("GPL v2");
> diff --git a/drivers/gpu/drm/imx/dcss/dcss-dtg.c b/drivers/gpu/drm/imx/dcss/dcss-dtg.c
> new file mode 100644
> index 00000000..c83b3bb
> --- /dev/null
> +++ b/drivers/gpu/drm/imx/dcss/dcss-dtg.c
> @@ -0,0 +1,438 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * Copyright 2019 NXP.
> + */
> +
> +#include <linux/clk.h>
> +#include <linux/delay.h>
> +#include <linux/interrupt.h>
> +#include <linux/of.h>
> +#include <linux/platform_device.h>
> +
> +#include "dcss-dev.h"
> +
> +#define DCSS_DTG_TC_CONTROL_STATUS                     0x00
> +#define   CH3_EN                                       BIT(0)
> +#define   CH2_EN                                       BIT(1)
> +#define   CH1_EN                                       BIT(2)
> +#define   OVL_DATA_MODE                                        BIT(3)
> +#define   BLENDER_VIDEO_ALPHA_SEL                      BIT(7)
> +#define   DTG_START                                    BIT(8)
> +#define   DBY_MODE_EN                                  BIT(9)
> +#define   CH1_ALPHA_SEL                                        BIT(10)
> +#define   CSS_PIX_COMP_SWAP_POS                                12
> +#define   CSS_PIX_COMP_SWAP_MASK                       GENMASK(14, 12)
> +#define   DEFAULT_FG_ALPHA_POS                         24
> +#define   DEFAULT_FG_ALPHA_MASK                                GENMASK(31, 24)
> +#define DCSS_DTG_TC_DTG                                        0x04
> +#define DCSS_DTG_TC_DISP_TOP                           0x08
> +#define DCSS_DTG_TC_DISP_BOT                           0x0C
> +#define DCSS_DTG_TC_CH1_TOP                            0x10
> +#define DCSS_DTG_TC_CH1_BOT                            0x14
> +#define DCSS_DTG_TC_CH2_TOP                            0x18
> +#define DCSS_DTG_TC_CH2_BOT                            0x1C
> +#define DCSS_DTG_TC_CH3_TOP                            0x20
> +#define DCSS_DTG_TC_CH3_BOT                            0x24
> +#define   TC_X_POS                                     0
> +#define   TC_X_MASK                                    GENMASK(12, 0)
> +#define   TC_Y_POS                                     16
> +#define   TC_Y_MASK                                    GENMASK(28, 16)
> +#define DCSS_DTG_TC_CTXLD                              0x28
> +#define   TC_CTXLD_DB_Y_POS                            0
> +#define   TC_CTXLD_DB_Y_MASK                           GENMASK(12, 0)
> +#define   TC_CTXLD_SB_Y_POS                            16
> +#define   TC_CTXLD_SB_Y_MASK                           GENMASK(28, 16)
> +#define DCSS_DTG_TC_CH1_BKRND                          0x2C
> +#define DCSS_DTG_TC_CH2_BKRND                          0x30
> +#define   BKRND_R_Y_COMP_POS                           20
> +#define   BKRND_R_Y_COMP_MASK                          GENMASK(29, 20)
> +#define   BKRND_G_U_COMP_POS                           10
> +#define   BKRND_G_U_COMP_MASK                          GENMASK(19, 10)
> +#define   BKRND_B_V_COMP_POS                           0
> +#define   BKRND_B_V_COMP_MASK                          GENMASK(9, 0)
> +#define DCSS_DTG_BLENDER_DBY_RANGEINV                  0x38
> +#define DCSS_DTG_BLENDER_DBY_RANGEMIN                  0x3C
> +#define DCSS_DTG_BLENDER_DBY_BDP                       0x40
> +#define DCSS_DTG_BLENDER_BKRND_I                       0x44
> +#define DCSS_DTG_BLENDER_BKRND_P                       0x48
> +#define DCSS_DTG_BLENDER_BKRND_T                       0x4C
> +#define DCSS_DTG_LINE0_INT                             0x50
> +#define DCSS_DTG_LINE1_INT                             0x54
> +#define DCSS_DTG_BG_ALPHA_DEFAULT                      0x58
> +#define DCSS_DTG_INT_STATUS                            0x5C
> +#define DCSS_DTG_INT_CONTROL                           0x60
> +#define DCSS_DTG_TC_CH3_BKRND                          0x64
> +#define DCSS_DTG_INT_MASK                              0x68
> +#define   LINE0_IRQ                                    BIT(0)
> +#define   LINE1_IRQ                                    BIT(1)
> +#define   LINE2_IRQ                                    BIT(2)
> +#define   LINE3_IRQ                                    BIT(3)
> +#define DCSS_DTG_LINE2_INT                             0x6C
> +#define DCSS_DTG_LINE3_INT                             0x70
> +#define DCSS_DTG_DBY_OL                                        0x74
> +#define DCSS_DTG_DBY_BL                                        0x78
> +#define DCSS_DTG_DBY_EL                                        0x7C
> +
> +struct dcss_dtg {
> +       struct device *dev;
> +       struct dcss_ctxld *ctxld;
> +       void __iomem *base_reg;
> +       u32 base_ofs;
> +
> +       u32 ctx_id;
> +
> +       bool in_use;
> +
> +       u32 dis_ulc_x;
> +       u32 dis_ulc_y;
> +
> +       u32 control_status;
> +       u32 alpha;
> +
> +       int ctxld_kick_irq;
> +       bool ctxld_kick_irq_en;
> +
> +       struct clk *pix_clk;
> +       struct clk *pll_src_clk;
> +       struct clk *pll_phy_ref_clk;
> +
> +       /*
> +        * This will be passed on by DRM CRTC so that we can signal when DTG has
> +        * been successfully stopped. Otherwise, any modesetting while DTG is
> +        * still ON may result in unpredictable behavior.
> +        */
> +       struct completion *dis_completion;
> +};
> +
> +static void dcss_dtg_write(struct dcss_dtg *dtg, u32 val, u32 ofs)
> +{
> +       if (!dtg->in_use)
> +               dcss_writel(val, dtg->base_reg + ofs);
> +
> +       dcss_ctxld_write(dtg->ctxld, dtg->ctx_id, val, dtg->base_ofs + ofs);
> +}
> +
> +static irqreturn_t dcss_dtg_irq_handler(int irq, void *data)
> +{
> +       struct dcss_dtg *dtg = data;
> +       u32 status;
> +
> +       status = dcss_readl(dtg->base_reg + DCSS_DTG_INT_STATUS);
> +
> +       if (!(status & LINE0_IRQ))
> +               return IRQ_HANDLED;
> +
> +       dcss_ctxld_kick(dtg->ctxld);
> +
> +       dcss_writel(status & LINE0_IRQ, dtg->base_reg + DCSS_DTG_INT_CONTROL);
> +
> +       return IRQ_HANDLED;
> +}
> +
> +static int dcss_dtg_irq_config(struct dcss_dtg *dtg,
> +                              struct platform_device *pdev)
> +{
> +       int ret;
> +
> +       dtg->ctxld_kick_irq = platform_get_irq_byname(pdev, "ctxld_kick");
> +       if (dtg->ctxld_kick_irq < 0) {
> +               dev_err(dtg->dev, "dtg: can't get line2 irq number\n");
> +               return dtg->ctxld_kick_irq;
> +       }
> +
> +       ret = devm_request_irq(dtg->dev, dtg->ctxld_kick_irq,
> +                              dcss_dtg_irq_handler,
> +                              IRQF_TRIGGER_HIGH,
> +                              "dcss_ctxld_kick", dtg);
> +       if (ret) {
> +               dev_err(dtg->dev, "dtg: irq request failed.\n");
> +               return ret;
> +       }
> +
> +       disable_irq(dtg->ctxld_kick_irq);
> +
> +       dtg->ctxld_kick_irq_en = false;
> +
> +       dcss_update(LINE0_IRQ, LINE0_IRQ, dtg->base_reg + DCSS_DTG_INT_MASK);
> +
> +       return 0;
> +}
> +
> +int dcss_dtg_init(struct dcss_dev *dcss, unsigned long dtg_base)
> +{
> +       int ret = 0;
> +       struct dcss_dtg *dtg;
> +
> +       dtg = devm_kzalloc(dcss->dev, sizeof(*dtg), GFP_KERNEL);
> +       if (!dtg)
> +               return -ENOMEM;
> +
> +       dcss->dtg = dtg;
> +       dtg->dev = dcss->dev;
> +       dtg->ctxld = dcss->ctxld;
> +
> +       dtg->base_reg = devm_ioremap(dcss->dev, dtg_base, SZ_4K);
> +       if (!dtg->base_reg) {
> +               dev_err(dcss->dev, "dtg: unable to remap dtg base\n");
> +               ret = -ENOMEM;
> +               goto err_ioremap;
> +       }
> +
> +       dtg->base_ofs = dtg_base;
> +       dtg->ctx_id = CTX_DB;
> +
> +       dtg->pix_clk = dcss->pix_clk;
> +       dtg->pll_src_clk = dcss->pll_src_clk;
> +       dtg->pll_phy_ref_clk = dcss->pll_phy_ref_clk;
> +
> +       dtg->alpha = 255;
> +
> +       dtg->control_status |= OVL_DATA_MODE | BLENDER_VIDEO_ALPHA_SEL |
> +               ((dtg->alpha << DEFAULT_FG_ALPHA_POS) & DEFAULT_FG_ALPHA_MASK);
> +
> +       ret = dcss_dtg_irq_config(dtg, to_platform_device(dcss->dev));
> +       if (ret)
> +               goto err_irq;
> +
> +       return 0;
> +
> +err_irq:
> +       devm_iounmap(dtg->dev, dtg->base_reg);
> +
> +err_ioremap:
> +       devm_kfree(dtg->dev, dtg);
> +
> +       return ret;
> +}
> +
> +void dcss_dtg_exit(struct dcss_dtg *dtg)
> +{
> +       /* stop DTG */
> +       dcss_writel(DTG_START, dtg->base_reg + DCSS_DTG_TC_CONTROL_STATUS);
> +
> +       devm_free_irq(dtg->dev, dtg->ctxld_kick_irq, dtg);
> +
> +       if (dtg->base_reg)
> +               devm_iounmap(dtg->dev, dtg->base_reg);
> +
> +       devm_kfree(dtg->dev, dtg);
> +}
> +
> +void dcss_dtg_sync_set(struct dcss_dtg *dtg, struct videomode *vm)
> +{
> +       u16 dtg_lrc_x, dtg_lrc_y;
> +       u16 dis_ulc_x, dis_ulc_y;
> +       u16 dis_lrc_x, dis_lrc_y;
> +       u32 sb_ctxld_trig, db_ctxld_trig;
> +       u32 pixclock = vm->pixelclock;
> +       u32 actual_clk;
> +
> +       dtg_lrc_x = vm->hfront_porch + vm->hback_porch + vm->hsync_len +
> +                   vm->hactive - 1;
> +       dtg_lrc_y = vm->vfront_porch + vm->vback_porch + vm->vsync_len +
> +                   vm->vactive - 1;
> +       dis_ulc_x = vm->hsync_len + vm->hback_porch - 1;
> +       dis_ulc_y = vm->vsync_len + vm->vfront_porch + vm->vback_porch - 1;
> +       dis_lrc_x = vm->hsync_len + vm->hback_porch + vm->hactive - 1;
> +       dis_lrc_y = vm->vsync_len + vm->vfront_porch + vm->vback_porch +
> +                   vm->vactive - 1;
> +
> +       clk_disable_unprepare(dtg->pix_clk);
> +       clk_set_rate(dtg->pix_clk, vm->pixelclock);
> +       clk_prepare_enable(dtg->pix_clk);
> +
> +       actual_clk = clk_get_rate(dtg->pix_clk);
> +       if (pixclock != actual_clk) {
> +               dev_info(dtg->dev,
> +                        "Pixel clock set to %u kHz instead of %u kHz.\n",
> +                        (actual_clk / 1000), (pixclock / 1000));
> +       }
> +
> +       msleep(50);
> +
> +       dcss_dtg_write(dtg, ((dtg_lrc_y << TC_Y_POS) | dtg_lrc_x),
> +                      DCSS_DTG_TC_DTG);
> +       dcss_dtg_write(dtg, ((dis_ulc_y << TC_Y_POS) | dis_ulc_x),
> +                      DCSS_DTG_TC_DISP_TOP);
> +       dcss_dtg_write(dtg, ((dis_lrc_y << TC_Y_POS) | dis_lrc_x),
> +                      DCSS_DTG_TC_DISP_BOT);
> +
> +       dtg->dis_ulc_x = dis_ulc_x;
> +       dtg->dis_ulc_y = dis_ulc_y;
> +
> +       sb_ctxld_trig = ((0 * dis_lrc_y / 100) << TC_CTXLD_SB_Y_POS) &
> +                                                       TC_CTXLD_SB_Y_MASK;
> +       db_ctxld_trig = ((99 * dis_lrc_y / 100) << TC_CTXLD_DB_Y_POS) &
> +                                                       TC_CTXLD_DB_Y_MASK;
> +
> +       dcss_dtg_write(dtg, sb_ctxld_trig | db_ctxld_trig, DCSS_DTG_TC_CTXLD);
> +
> +       /* vblank trigger */
> +       dcss_dtg_write(dtg, 0, DCSS_DTG_LINE1_INT);
> +
> +       /* CTXLD trigger */
> +       dcss_dtg_write(dtg, ((90 * dis_lrc_y) / 100) << 16, DCSS_DTG_LINE0_INT);
> +}
> +
> +void dcss_dtg_plane_pos_set(struct dcss_dtg *dtg, int ch_num,
> +                           int px, int py, int pw, int ph)
> +{
> +       u16 p_ulc_x, p_ulc_y;
> +       u16 p_lrc_x, p_lrc_y;
> +
> +       p_ulc_x = dtg->dis_ulc_x + px;
> +       p_ulc_y = dtg->dis_ulc_y + py;
> +       p_lrc_x = p_ulc_x + pw;
> +       p_lrc_y = p_ulc_y + ph;
> +
> +       if (!px && !py && !pw && !ph) {
> +               dcss_dtg_write(dtg, 0, DCSS_DTG_TC_CH1_TOP + 0x8 * ch_num);
> +               dcss_dtg_write(dtg, 0, DCSS_DTG_TC_CH1_BOT + 0x8 * ch_num);
> +       } else {
> +               dcss_dtg_write(dtg, ((p_ulc_y << TC_Y_POS) | p_ulc_x),
> +                              DCSS_DTG_TC_CH1_TOP + 0x8 * ch_num);
> +               dcss_dtg_write(dtg, ((p_lrc_y << TC_Y_POS) | p_lrc_x),
> +                              DCSS_DTG_TC_CH1_BOT + 0x8 * ch_num);
> +       }
> +}
> +
> +bool dcss_dtg_global_alpha_changed(struct dcss_dtg *dtg, int ch_num, int alpha)
> +{
> +       if (ch_num)
> +               return false;
> +
> +       return alpha != dtg->alpha;
> +}
> +
> +void dcss_dtg_plane_alpha_set(struct dcss_dtg *dtg, int ch_num,
> +                             const struct drm_format_info *format, int alpha)
> +{
> +       u32 alpha_val;
> +
> +       /* we care about alpha only when channel 0 is concerned */
> +       if (ch_num)
> +               return;
> +
> +       alpha_val = (alpha << DEFAULT_FG_ALPHA_POS) & DEFAULT_FG_ALPHA_MASK;
> +
> +       /*
> +        * Use global alpha if pixel format does not have alpha channel or the
> +        * user explicitly chose to use global alpha (i.e. alpha is not OPAQUE).
> +        */
> +       if (!format->has_alpha || alpha != 255) {
> +               dtg->control_status &= ~(CH1_ALPHA_SEL | DEFAULT_FG_ALPHA_MASK);
> +               dtg->control_status |= alpha_val;
> +       } else { /* use per-pixel alpha otherwise */
> +               dtg->control_status |= CH1_ALPHA_SEL;
> +       }
> +
> +       dtg->alpha = alpha;
> +}
> +
> +void dcss_dtg_css_set(struct dcss_dtg *dtg)
> +{
> +       dtg->control_status |=
> +                       (0x5 << CSS_PIX_COMP_SWAP_POS) & CSS_PIX_COMP_SWAP_MASK;
> +}
> +
> +static void dcss_dtg_disable_callback(void *data)
> +{
> +       struct dcss_dtg *dtg = data;
> +
> +       dtg->control_status &= ~DTG_START;
> +
> +       dcss_writel(dtg->control_status,
> +                   dtg->base_reg + DCSS_DTG_TC_CONTROL_STATUS);
> +
> +       dtg->in_use = false;
> +
> +       complete(dtg->dis_completion);
> +}
> +
> +void dcss_dtg_enable(struct dcss_dtg *dtg, bool en,
> +                    struct completion *dis_completion)
> +{
> +       if (!en) {
> +               dtg->dis_completion = dis_completion;
> +               dcss_ctxld_register_dtg_disable_cb(dtg->ctxld,
> +                                                  dcss_dtg_disable_callback,
> +                                                  dtg);
> +               return;
> +       }
> +
> +       dtg->dis_completion = NULL;
> +
> +       dtg->control_status |= DTG_START;
> +
> +       dcss_dtg_write(dtg, dtg->control_status, DCSS_DTG_TC_CONTROL_STATUS);
> +
> +       dtg->in_use = true;
> +}
> +
> +bool dcss_dtg_is_enabled(struct dcss_dtg *dtg)
> +{
> +       return dtg->in_use;
> +}
> +
> +void dcss_dtg_ch_enable(struct dcss_dtg *dtg, int ch_num, bool en)
> +{
> +       u32 ch_en_map[] = {CH1_EN, CH2_EN, CH3_EN};
> +       u32 control_status;
> +
> +       control_status = dtg->control_status & ~ch_en_map[ch_num];
> +       control_status |= en ? ch_en_map[ch_num] : 0;
> +
> +       if (dtg->control_status != control_status)
> +               dcss_dtg_write(dtg, control_status, DCSS_DTG_TC_CONTROL_STATUS);
> +
> +       dtg->control_status = control_status;
> +}
> +
> +void dcss_dtg_vblank_irq_enable(struct dcss_dtg *dtg, bool en)
> +{
> +       u32 status;
> +
> +       dcss_update(LINE1_IRQ, LINE1_IRQ, dtg->base_reg + DCSS_DTG_INT_MASK);
> +
> +       if (en) {
> +               status = dcss_readl(dtg->base_reg + DCSS_DTG_INT_STATUS);
> +               dcss_writel(status & LINE1_IRQ,
> +                           dtg->base_reg + DCSS_DTG_INT_CONTROL);
> +       }
> +}
> +
> +void dcss_dtg_ctxld_kick_irq_enable(struct dcss_dtg *dtg, bool en)
> +{
> +       u32 status;
> +
> +       if (en) {
> +               status = dcss_readl(dtg->base_reg + DCSS_DTG_INT_STATUS);
> +
> +               if (!dtg->ctxld_kick_irq_en) {
> +                       dcss_writel(status & LINE0_IRQ,
> +                                   dtg->base_reg + DCSS_DTG_INT_CONTROL);
> +                       enable_irq(dtg->ctxld_kick_irq);
> +                       dtg->ctxld_kick_irq_en = true;
> +                       return;
> +               }
> +
> +               return;
> +       }
> +
> +       if (!dtg->ctxld_kick_irq_en)
> +               return;
> +
> +       disable_irq_nosync(dtg->ctxld_kick_irq);
> +       dtg->ctxld_kick_irq_en = false;
> +}
> +
> +void dcss_dtg_vblank_irq_clear(struct dcss_dtg *dtg)
> +{
> +       dcss_update(LINE1_IRQ, LINE1_IRQ, dtg->base_reg + DCSS_DTG_INT_CONTROL);
> +}
> +
> +bool dcss_dtg_vblank_irq_valid(struct dcss_dtg *dtg)
> +{
> +       return !!(dcss_readl(dtg->base_reg + DCSS_DTG_INT_STATUS) & LINE1_IRQ);
> +}
> +
> diff --git a/drivers/gpu/drm/imx/dcss/dcss-kms.c b/drivers/gpu/drm/imx/dcss/dcss-kms.c
> new file mode 100644
> index 00000000..d3bc889
> --- /dev/null
> +++ b/drivers/gpu/drm/imx/dcss/dcss-kms.c
> @@ -0,0 +1,321 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * Copyright 2019 NXP.
> + */
> +
> +#include <drm/drm_atomic.h>
> +#include <drm/drm_atomic_helper.h>
> +#include <drm/drm_fb_helper.h>
> +#include <drm/drm_gem_cma_helper.h>
> +#include <drm/drm_gem_framebuffer_helper.h>
> +#include <drm/drm_of.h>
> +#include <drm/drm_probe_helper.h>
> +#include <drm/drmP.h>
> +#include <linux/component.h>
> +
> +#include "dcss-dev.h"
> +#include "dcss-kms.h"
> +
> +DEFINE_DRM_GEM_CMA_FOPS(dcss_cma_fops);
> +
> +struct dcss_drm_commit {
> +       struct work_struct work;
> +       struct drm_device *drm;
> +       struct drm_atomic_state *state;
> +};
> +
> +static void dcss_drm_atomic_commit_tail(struct dcss_drm_commit *commit)
> +{
> +       struct drm_atomic_state *state = commit->state;
> +       struct drm_device *drm = commit->drm;
> +       struct dcss_kms_dev *kms = container_of(drm, struct dcss_kms_dev, base);
> +
> +       drm_atomic_helper_wait_for_fences(drm, state, false);
> +
> +       drm_atomic_helper_wait_for_dependencies(state);
> +
> +       drm_atomic_helper_commit_modeset_disables(drm, state);
> +
> +       drm_atomic_helper_commit_modeset_enables(drm, state);
> +
> +       drm_atomic_helper_commit_planes(drm, state,
> +                                       DRM_PLANE_COMMIT_ACTIVE_ONLY);
> +
> +       drm_atomic_helper_commit_hw_done(state);
> +
> +       drm_atomic_helper_wait_for_vblanks(drm, state);
> +
> +       drm_atomic_helper_cleanup_planes(drm, state);
> +
> +       drm_atomic_helper_commit_cleanup_done(state);
> +
> +       drm_atomic_state_put(state);
> +
> +       spin_lock(&kms->commit.wait.lock);
> +       kms->commit.pending = false;
> +       wake_up_all_locked(&kms->commit.wait);
> +       spin_unlock(&kms->commit.wait.lock);
> +
> +       kfree(commit);
> +}
> +
> +static void dcss_commit_work(struct work_struct *work)
> +{
> +       struct dcss_drm_commit *commit = container_of(work,
> +                                                     struct dcss_drm_commit,
> +                                                     work);
> +
> +       dcss_drm_atomic_commit_tail(commit);
> +}
> +
> +static int dcss_drm_atomic_commit(struct drm_device *drm,
> +                                 struct drm_atomic_state *state,
> +                                 bool nonblock)
> +{
> +       int ret;
> +       struct dcss_kms_dev *kms = container_of(drm, struct dcss_kms_dev, base);
> +       struct dcss_drm_commit *commit;
> +
> +       if (state->async_update) {
> +               ret = drm_atomic_helper_prepare_planes(drm, state);
> +               if (ret)
> +                       return ret;
> +
> +               drm_atomic_helper_async_commit(drm, state);
> +               drm_atomic_helper_cleanup_planes(drm, state);
> +
> +               return 0;
> +       }
> +
> +       commit = kzalloc(sizeof(*commit), GFP_KERNEL);
> +       if (!commit)
> +               return -ENOMEM;
> +
> +       commit->drm = drm;
> +       commit->state = state;
> +
> +       ret = drm_atomic_helper_setup_commit(state, nonblock);
> +       if (ret)
> +               goto err_free;
> +
> +       INIT_WORK(&commit->work, dcss_commit_work);
> +
> +       ret = drm_atomic_helper_prepare_planes(drm, state);
> +       if (ret)
> +               goto err_free;
> +
> +       if (!nonblock) {
> +               ret = drm_atomic_helper_wait_for_fences(drm, state, true);
> +               if (ret)
> +                       goto err;
> +       }
> +
> +       spin_lock(&kms->commit.wait.lock);
> +       ret = wait_event_interruptible_locked(kms->commit.wait,
> +                                             !kms->commit.pending);
> +       if (ret == 0)
> +               kms->commit.pending = true;
> +       spin_unlock(&kms->commit.wait.lock);
> +
> +       if (ret)
> +               goto err;
> +
> +       ret = drm_atomic_helper_swap_state(state, true);
> +       if (ret)
> +               goto err;
> +
> +       drm_atomic_state_get(state);
> +       if (nonblock)
> +               queue_work(kms->commit_wq, &commit->work);
> +       else
> +               dcss_drm_atomic_commit_tail(commit);
> +
> +       return 0;
> +
> +err:
> +       drm_atomic_helper_cleanup_planes(drm, state);
> +
> +err_free:
> +       kfree(commit);
> +       return ret;
> +}
> +
> +const struct drm_mode_config_funcs dcss_drm_mode_config_funcs = {
> +       .fb_create = drm_gem_fb_create,
> +       .output_poll_changed = drm_fb_helper_output_poll_changed,
> +       .atomic_check = drm_atomic_helper_check,
> +       .atomic_commit = dcss_drm_atomic_commit,
> +};
> +
> +static struct drm_driver dcss_kms_driver = {
> +       .driver_features        = DRIVER_MODESET | DRIVER_GEM | DRIVER_ATOMIC,
> +       .gem_free_object_unlocked = drm_gem_cma_free_object,
> +       .gem_vm_ops             = &drm_gem_cma_vm_ops,
> +       .dumb_create            = drm_gem_cma_dumb_create,
> +
> +       .prime_handle_to_fd     = drm_gem_prime_handle_to_fd,
> +       .prime_fd_to_handle     = drm_gem_prime_fd_to_handle,
> +       .gem_prime_import       = drm_gem_prime_import,
> +       .gem_prime_export       = drm_gem_prime_export,
> +       .gem_prime_get_sg_table = drm_gem_cma_prime_get_sg_table,
> +       .gem_prime_import_sg_table = drm_gem_cma_prime_import_sg_table,
> +       .gem_prime_vmap         = drm_gem_cma_prime_vmap,
> +       .gem_prime_vunmap       = drm_gem_cma_prime_vunmap,
> +       .gem_prime_mmap         = drm_gem_cma_prime_mmap,
> +       .fops                   = &dcss_cma_fops,
> +       .name                   = "imx-dcss",
> +       .desc                   = "i.MX8MQ Display Subsystem",
> +       .date                   = "20190917",
> +       .major                  = 1,
> +       .minor                  = 0,
> +       .patchlevel             = 0,
> +};
> +
> +static const struct drm_mode_config_helper_funcs dcss_mode_config_helpers = {
> +       .atomic_commit_tail = drm_atomic_helper_commit_tail_rpm,
> +};
> +
> +static void dcss_kms_mode_config_init(struct dcss_kms_dev *kms)
> +{
> +       struct drm_mode_config *config = &kms->base.mode_config;
> +
> +       drm_mode_config_init(&kms->base);
> +
> +       config->min_width = 1;
> +       config->min_height = 1;
> +       config->max_width = 4096;
> +       config->max_height = 4096;
> +       config->allow_fb_modifiers = true;
> +       config->normalize_zpos = true;
> +
> +       config->funcs = &dcss_drm_mode_config_funcs;
> +       config->helper_private = &dcss_mode_config_helpers;
> +}
> +
> +static const struct drm_encoder_funcs dcss_kms_simple_encoder_funcs = {
> +       .destroy = drm_encoder_cleanup,
> +};
> +
> +static int dcss_kms_setup_encoder(struct dcss_kms_dev *kms)
> +{
> +       struct drm_device *ddev = &kms->base;
> +       struct drm_encoder *encoder = &kms->encoder;
> +       struct drm_crtc *crtc = (struct drm_crtc *)&kms->crtc;
> +       struct drm_panel *panel;
> +       struct drm_bridge *bridge;
> +       int ret;
> +
> +       ret = drm_of_find_panel_or_bridge(ddev->dev->of_node, 0, 0,
> +                                         &panel, &bridge);
> +       if (ret)
> +               return ret;
> +
> +       if (!bridge) {
> +               dev_err(ddev->dev, "No bridge found %d.\n", ret);
> +               return -ENODEV;
> +       }
> +
> +       encoder->possible_crtcs = drm_crtc_mask(crtc);
> +
> +       ret = drm_encoder_init(&kms->base, encoder,
> +                              &dcss_kms_simple_encoder_funcs,
> +                              DRM_MODE_ENCODER_NONE, NULL);
> +       if (ret) {
> +               dev_err(ddev->dev, "Failed initializing encoder %d.\n", ret);
> +               return ret;
> +       }
> +
> +       return drm_bridge_attach(encoder, bridge, NULL);
> +}
> +
> +struct dcss_kms_dev *dcss_kms_attach(struct dcss_dev *dcss, bool componentized)
> +{
> +       struct dcss_kms_dev *kms = kzalloc(sizeof(*kms), GFP_KERNEL);
> +       struct drm_device *drm;
> +       struct dcss_crtc *crtc;
> +       int ret;
> +
> +       if (!kms)
> +               return ERR_PTR(-ENOMEM);
> +
> +       drm = &kms->base;
> +       crtc = &kms->crtc;
> +       ret = drm_dev_init(drm, &dcss_kms_driver, dcss->dev);
> +       if (ret)
> +               goto free_kms;
> +
> +       drm->dev_private = dcss;
> +
> +       dcss_kms_mode_config_init(kms);
> +
> +       ret = drm_vblank_init(drm, 1);
> +       if (ret)
> +               goto cleanup_mode_config;
> +
> +       drm->irq_enabled = true;
> +
> +       ret = dcss_crtc_init(crtc, drm);
> +       if (ret)
> +               goto cleanup_mode_config;
> +
> +       kms->commit_wq = alloc_ordered_workqueue("dcss_nonblock_commit_wq", 0);
> +       if (!kms->commit_wq) {
> +               ret = -ENOMEM;
> +               goto cleanup_crtc;
> +       }
> +
> +       init_waitqueue_head(&kms->commit.wait);
> +
> +       if (componentized)
> +               ret = component_bind_all(dcss->dev, kms);
> +       else
> +               ret = dcss_kms_setup_encoder(kms);
> +
> +       if (ret)
> +               goto cleanup_wq;
> +
> +       drm_mode_config_reset(drm);
> +
> +       drm_kms_helper_poll_init(drm);
> +
> +       ret = drm_dev_register(drm, 0);
> +       if (ret)
> +               goto cleanup_wq;
> +
> +       drm_fbdev_generic_setup(drm, 32);
> +
> +       return kms;
> +
> +cleanup_wq:
> +       drm_kms_helper_poll_fini(drm);
> +       destroy_workqueue(kms->commit_wq);
> +
> +cleanup_crtc:
> +       dcss_crtc_deinit(crtc, drm);
> +
> +cleanup_mode_config:
> +       drm_mode_config_cleanup(drm);
> +
> +free_kms:
> +       kfree(kms);
> +       return ERR_PTR(ret);
> +}
> +
> +void dcss_kms_detach(struct dcss_kms_dev *kms, bool componentized)
> +{
> +       struct drm_device *drm = &kms->base;
> +       struct dcss_dev *dcss = drm->dev_private;
> +
> +       drm_dev_unregister(drm);
> +       drm_kms_helper_poll_fini(drm);
> +       drm_atomic_helper_shutdown(drm);
> +       drm_crtc_vblank_off(&kms->crtc.base);
> +       drm->irq_enabled = false;
> +       drm_mode_config_cleanup(drm);
> +       destroy_workqueue(kms->commit_wq);
> +       dcss_crtc_deinit(&kms->crtc, drm);
> +       if (componentized)
> +               component_unbind_all(dcss->dev, drm);
> +       drm->dev_private = NULL;
> +       drm_dev_put(drm);
> +}
> diff --git a/drivers/gpu/drm/imx/dcss/dcss-kms.h b/drivers/gpu/drm/imx/dcss/dcss-kms.h
> new file mode 100644
> index 00000000..6297005
> --- /dev/null
> +++ b/drivers/gpu/drm/imx/dcss/dcss-kms.h
> @@ -0,0 +1,52 @@
> +/* SPDX-License-Identifier: GPL-2.0 */
> +/*
> + * Copyright 2019 NXP.
> + */
> +
> +#ifndef _DCSS_KMS_H_
> +#define _DCSS_KMS_H_
> +
> +#include <drm/drm_encoder.h>
> +
> +struct dcss_plane {
> +       struct drm_plane base;
> +
> +       int ch_num;
> +};
> +
> +struct dcss_crtc {
> +       struct drm_crtc         base;
> +       struct drm_crtc_state   *state;
> +
> +       struct dcss_plane       *plane[3];
> +
> +       int                     irq;
> +       bool                    irq_enabled;
> +
> +       struct completion en_completion;
> +       struct completion dis_completion;
> +};
> +
> +struct commit {
> +       wait_queue_head_t wait;
> +       bool pending;
> +};
> +
> +struct dcss_kms_dev {
> +       struct drm_device base;
> +       struct dcss_crtc crtc;
> +       struct drm_encoder encoder;
> +       struct workqueue_struct *commit_wq;
> +       struct commit commit;
> +};
> +
> +struct dcss_kms_dev *dcss_kms_attach(struct dcss_dev *dcss, bool componentized);
> +void dcss_kms_detach(struct dcss_kms_dev *kms, bool componentized);
> +int dcss_crtc_init(struct dcss_crtc *crtc, struct drm_device *drm);
> +void dcss_crtc_deinit(struct dcss_crtc *crtc, struct drm_device *drm);
> +struct dcss_plane *dcss_plane_init(struct drm_device *drm,
> +                                  unsigned int possible_crtcs,
> +                                  enum drm_plane_type type,
> +                                  unsigned int zpos);
> +
> +#endif
> diff --git a/drivers/gpu/drm/imx/dcss/dcss-plane.c b/drivers/gpu/drm/imx/dcss/dcss-plane.c
> new file mode 100644
> index 00000000..cb18c3e
> --- /dev/null
> +++ b/drivers/gpu/drm/imx/dcss/dcss-plane.c
> @@ -0,0 +1,418 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * Copyright 2019 NXP.
> + */
> +
> +#include <drm/drm_atomic.h>
> +#include <drm/drm_atomic_helper.h>
> +#include <drm/drm_fb_cma_helper.h>
> +#include <drm/drm_gem_framebuffer_helper.h>
> +#include <drm/drm_gem_cma_helper.h>
> +
> +#include "dcss-dev.h"
> +#include "dcss-kms.h"
> +
> +static const u32 dcss_common_formats[] = {
> +       /* RGB */
> +       DRM_FORMAT_ARGB8888,
> +       DRM_FORMAT_XRGB8888,
> +       DRM_FORMAT_ABGR8888,
> +       DRM_FORMAT_XBGR8888,
> +       DRM_FORMAT_RGBA8888,
> +       DRM_FORMAT_RGBX8888,
> +       DRM_FORMAT_BGRA8888,
> +       DRM_FORMAT_BGRX8888,
> +       DRM_FORMAT_XRGB2101010,
> +       DRM_FORMAT_XBGR2101010,
> +       DRM_FORMAT_RGBX1010102,
> +       DRM_FORMAT_BGRX1010102,
> +       DRM_FORMAT_ARGB2101010,
> +       DRM_FORMAT_ABGR2101010,
> +       DRM_FORMAT_RGBA1010102,
> +       DRM_FORMAT_BGRA1010102,
> +
> +       /* YUV444 */
> +       DRM_FORMAT_AYUV,
> +
> +       /* YUV422 */
> +       DRM_FORMAT_UYVY,
> +       DRM_FORMAT_VYUY,
> +       DRM_FORMAT_YUYV,
> +       DRM_FORMAT_YVYU,
> +
> +       /* YUV420 */
> +       DRM_FORMAT_NV12,
> +       DRM_FORMAT_NV21,
> +};
> +
> +static const u64 dcss_video_format_modifiers[] = {
> +       DRM_FORMAT_MOD_LINEAR,
> +       DRM_FORMAT_MOD_INVALID,
> +};
> +
> +static const u64 dcss_graphics_format_modifiers[] = {
> +       DRM_FORMAT_MOD_VIVANTE_TILED,
> +       DRM_FORMAT_MOD_VIVANTE_SUPER_TILED,
> +       DRM_FORMAT_MOD_LINEAR,
> +       DRM_FORMAT_MOD_INVALID,
> +};
> +
> +static inline struct dcss_plane *to_dcss_plane(struct drm_plane *p)
> +{
> +       return container_of(p, struct dcss_plane, base);
> +}
> +
> +static inline bool dcss_plane_fb_is_linear(const struct drm_framebuffer *fb)
> +{
> +       return ((fb->flags & DRM_MODE_FB_MODIFIERS) == 0) ||
> +              ((fb->flags & DRM_MODE_FB_MODIFIERS) != 0 &&
> +               fb->modifier == DRM_FORMAT_MOD_LINEAR);
> +}
> +
> +static void dcss_plane_destroy(struct drm_plane *plane)
> +{
> +       struct dcss_plane *dcss_plane = container_of(plane, struct dcss_plane,
> +                                                    base);
> +
> +       drm_plane_cleanup(plane);
> +       kfree(dcss_plane);
> +}
> +
> +static bool dcss_plane_format_mod_supported(struct drm_plane *plane,
> +                                           u32 format,
> +                                           u64 modifier)
> +{
> +       switch (plane->type) {
> +       case DRM_PLANE_TYPE_PRIMARY:
> +               switch (format) {
> +               case DRM_FORMAT_ARGB8888:
> +               case DRM_FORMAT_XRGB8888:
> +               case DRM_FORMAT_ARGB2101010:
> +                       return modifier == DRM_FORMAT_MOD_LINEAR ||
> +                              modifier == DRM_FORMAT_MOD_VIVANTE_TILED ||
> +                              modifier == DRM_FORMAT_MOD_VIVANTE_SUPER_TILED;
> +               default:
> +                       return modifier == DRM_FORMAT_MOD_LINEAR;
> +               }
> +               break;
> +       case DRM_PLANE_TYPE_OVERLAY:
> +               return modifier == DRM_FORMAT_MOD_LINEAR;
> +       default:
> +               return false;
> +       }
> +}
> +
> +static const struct drm_plane_funcs dcss_plane_funcs = {
> +       .update_plane           = drm_atomic_helper_update_plane,
> +       .disable_plane          = drm_atomic_helper_disable_plane,
> +       .destroy                = dcss_plane_destroy,
> +       .reset                  = drm_atomic_helper_plane_reset,
> +       .atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state,
> +       .atomic_destroy_state   = drm_atomic_helper_plane_destroy_state,
> +       .format_mod_supported   = dcss_plane_format_mod_supported,
> +};
> +
> +static bool dcss_plane_can_rotate(const struct drm_format_info *format,
> +                                 bool mod_present, u64 modifier,
> +                                 unsigned int rotation)
> +{
> +       bool linear_format = !mod_present ||
> +                            (mod_present && modifier == DRM_FORMAT_MOD_LINEAR);
> +       u32 supported_rotation = DRM_MODE_ROTATE_0;
> +
> +       if (!format->is_yuv && linear_format)
> +               supported_rotation = DRM_MODE_ROTATE_0 | DRM_MODE_ROTATE_180 |
> +                                    DRM_MODE_REFLECT_MASK;
> +       else if (!format->is_yuv &&
> +                modifier == DRM_FORMAT_MOD_VIVANTE_TILED)
> +               supported_rotation = DRM_MODE_ROTATE_MASK |
> +                                    DRM_MODE_REFLECT_MASK;
> +       else if (format->is_yuv && linear_format &&
> +                (format->format == DRM_FORMAT_NV12 ||
> +                 format->format == DRM_FORMAT_NV21))
> +               supported_rotation = DRM_MODE_ROTATE_0 | DRM_MODE_ROTATE_180 |
> +                                    DRM_MODE_REFLECT_MASK;
> +
> +       return !!(rotation & supported_rotation);
> +}
> +
> +static bool dcss_plane_is_source_size_allowed(u16 src_w, u16 src_h, u32 pix_fmt)
> +{
> +       if (src_w < 64 &&
> +           (pix_fmt == DRM_FORMAT_NV12 || pix_fmt == DRM_FORMAT_NV21))
> +               return false;
> +       else if (src_w < 32 &&
> +                (pix_fmt == DRM_FORMAT_UYVY || pix_fmt == DRM_FORMAT_VYUY ||
> +                 pix_fmt == DRM_FORMAT_YUYV || pix_fmt == DRM_FORMAT_YVYU))
> +               return false;
> +
> +       return src_w >= 16 && src_h >= 8;
> +}
> +
> +static int dcss_plane_atomic_check(struct drm_plane *plane,
> +                                  struct drm_plane_state *state)
> +{
> +       struct dcss_plane *dcss_plane = to_dcss_plane(plane);
> +       struct dcss_dev *dcss = plane->dev->dev_private;
> +       struct drm_framebuffer *fb = state->fb;
> +       bool is_primary_plane = plane->type == DRM_PLANE_TYPE_PRIMARY;
> +       struct drm_gem_cma_object *cma_obj;
> +       struct drm_crtc_state *crtc_state;
> +       int hdisplay, vdisplay;
> +       int min, max;
> +       int ret;
> +
> +       if (!fb || !state->crtc)
> +               return 0;
> +
> +       cma_obj = drm_fb_cma_get_gem_obj(fb, 0);
> +       WARN_ON(!cma_obj);
> +
> +       crtc_state = drm_atomic_get_existing_crtc_state(state->state,
> +                                                       state->crtc);
> +
> +       hdisplay = crtc_state->adjusted_mode.hdisplay;
> +       vdisplay = crtc_state->adjusted_mode.vdisplay;
> +
> +       if (!dcss_plane_is_source_size_allowed(state->src_w >> 16,
> +                                              state->src_h >> 16,
> +                                              fb->format->format)) {
> +               DRM_DEBUG_KMS("Source plane size is not allowed!\n");
> +               return -EINVAL;
> +       }
> +
> +       dcss_scaler_get_min_max_ratios(dcss->scaler, dcss_plane->ch_num,
> +                                      &min, &max);
> +
> +       ret = drm_atomic_helper_check_plane_state(state, crtc_state,
> +                                                 min, max, !is_primary_plane,
> +                                                 false);
> +       if (ret)
> +               return ret;
> +
> +       if (!state->visible)
> +               return 0;
> +
> +       if (!dcss_plane_can_rotate(fb->format,
> +                                  !!(fb->flags & DRM_MODE_FB_MODIFIERS),
> +                                  fb->modifier,
> +                                  state->rotation)) {
> +               DRM_DEBUG_KMS("requested rotation is not allowed!\n");
> +               return -EINVAL;
> +       }
> +
> +       if ((state->crtc_x < 0 || state->crtc_y < 0 ||
> +            state->crtc_x + state->crtc_w > hdisplay ||
> +            state->crtc_y + state->crtc_h > vdisplay) &&
> +           !dcss_plane_fb_is_linear(fb)) {
> +               DRM_DEBUG_KMS("requested cropping operation is not allowed!\n");
> +               return -EINVAL;
> +       }
> +
> +       if ((fb->flags & DRM_MODE_FB_MODIFIERS) &&
> +           !plane->funcs->format_mod_supported(plane,
> +                               fb->format->format,
> +                               fb->modifier)) {
> +               DRM_DEBUG_KMS("Invalid modifier: %llx", fb->modifier);
> +               return -EINVAL;
> +       }
> +
> +       return 0;
> +}
> +
> +static void dcss_plane_atomic_set_base(struct dcss_plane *dcss_plane)
> +{
> +       struct drm_plane *plane = &dcss_plane->base;
> +       struct drm_plane_state *state = plane->state;
> +       struct dcss_dev *dcss = plane->dev->dev_private;
> +       struct drm_framebuffer *fb = state->fb;
> +       const struct drm_format_info *format = fb->format;
> +       struct drm_gem_cma_object *cma_obj = drm_fb_cma_get_gem_obj(fb, 0);
> +       unsigned long p1_ba = 0, p2_ba = 0;
> +
> +       if (!format->is_yuv ||
> +           format->format == DRM_FORMAT_NV12 ||
> +           format->format == DRM_FORMAT_NV21)
> +               p1_ba = cma_obj->paddr + fb->offsets[0] +
> +                       fb->pitches[0] * (state->src.y1 >> 16) +
> +                       format->char_per_block[0] * (state->src.x1 >> 16);
> +       else if (format->format == DRM_FORMAT_UYVY ||
> +                format->format == DRM_FORMAT_VYUY ||
> +                format->format == DRM_FORMAT_YUYV ||
> +                format->format == DRM_FORMAT_YVYU)
> +               p1_ba = cma_obj->paddr + fb->offsets[0] +
> +                       fb->pitches[0] * (state->src.y1 >> 16) +
> +                       2 * format->char_per_block[0] * (state->src.x1 >> 17);
> +
> +       if (format->format == DRM_FORMAT_NV12 ||
> +           format->format == DRM_FORMAT_NV21)
> +               p2_ba = cma_obj->paddr + fb->offsets[1] +
> +                       (((fb->pitches[1] >> 1) * (state->src.y1 >> 17) +
> +                       (state->src.x1 >> 17)) << 1);
> +
> +       dcss_dpr_addr_set(dcss->dpr, dcss_plane->ch_num, p1_ba, p2_ba,
> +                         fb->pitches[0]);
> +}
> +
> +static bool dcss_plane_needs_setup(struct drm_plane_state *state,
> +                                  struct drm_plane_state *old_state)
> +{
> +       struct drm_framebuffer *fb = state->fb;
> +       struct drm_framebuffer *old_fb = old_state->fb;
> +
> +       return state->crtc_x != old_state->crtc_x ||
> +              state->crtc_y != old_state->crtc_y ||
> +              state->crtc_w != old_state->crtc_w ||
> +              state->crtc_h != old_state->crtc_h ||
> +              state->src_x  != old_state->src_x  ||
> +              state->src_y  != old_state->src_y  ||
> +              state->src_w  != old_state->src_w  ||
> +              state->src_h  != old_state->src_h  ||
> +              fb->format->format != old_fb->format->format ||
> +              fb->modifier  != old_fb->modifier ||
> +              state->rotation != old_state->rotation;
> +}
> +
> +static void dcss_plane_atomic_update(struct drm_plane *plane,
> +                                    struct drm_plane_state *old_state)
> +{
> +       struct drm_plane_state *state = plane->state;
> +       struct dcss_plane *dcss_plane = to_dcss_plane(plane);
> +       struct dcss_dev *dcss = plane->dev->dev_private;
> +       struct drm_framebuffer *fb = state->fb;
> +       u32 pixel_format;
> +       struct drm_crtc_state *crtc_state;
> +       bool modifiers_present;
> +       u32 src_w, src_h, dst_w, dst_h;
> +       struct drm_rect src, dst;
> +       bool enable = true;
> +
> +       if (!fb || !state->crtc || !state->visible)
> +               return;
> +
> +       pixel_format = state->fb->format->format;
> +       crtc_state = state->crtc->state;
> +       modifiers_present = !!(fb->flags & DRM_MODE_FB_MODIFIERS);
> +
> +       if (old_state->fb && !drm_atomic_crtc_needs_modeset(crtc_state) &&
> +           !dcss_plane_needs_setup(state, old_state)) {
> +               dcss_plane_atomic_set_base(dcss_plane);
> +               return;
> +       }
> +
> +       src = plane->state->src;
> +       dst = plane->state->dst;
> +
> +       /*
> +        * The width and height after clipping.
> +        */
> +       src_w = drm_rect_width(&src) >> 16;
> +       src_h = drm_rect_height(&src) >> 16;
> +       dst_w = drm_rect_width(&dst);
> +       dst_h = drm_rect_height(&dst);
> +
> +       if (plane->type == DRM_PLANE_TYPE_OVERLAY &&
> +           modifiers_present && fb->modifier == DRM_FORMAT_MOD_LINEAR)
> +               modifiers_present = false;
> +
> +       dcss_dpr_format_set(dcss->dpr, dcss_plane->ch_num, state->fb->format,
> +                           modifiers_present ? fb->modifier :
> +                                               DRM_FORMAT_MOD_LINEAR);
> +       dcss_dpr_set_res(dcss->dpr, dcss_plane->ch_num, src_w, src_h);
> +       dcss_dpr_set_rotation(dcss->dpr, dcss_plane->ch_num,
> +                             state->rotation);
> +
> +       dcss_plane_atomic_set_base(dcss_plane);
> +
> +       dcss_scaler_setup(dcss->scaler, dcss_plane->ch_num,
> +                         state->fb->format, src_w, src_h,
> +                         dst_w, dst_h,
> +                         drm_mode_vrefresh(&crtc_state->mode));
> +
> +       dcss_dtg_plane_pos_set(dcss->dtg, dcss_plane->ch_num,
> +                              dst.x1, dst.y1, dst_w, dst_h);
> +       dcss_dtg_plane_alpha_set(dcss->dtg, dcss_plane->ch_num,
> +                                fb->format, state->alpha >> 8);
> +
> +       if (!dcss_plane->ch_num && (state->alpha >> 8) == 0)
> +               enable = false;
> +
> +       dcss_dpr_enable(dcss->dpr, dcss_plane->ch_num, enable);
> +       dcss_scaler_ch_enable(dcss->scaler, dcss_plane->ch_num, enable);
> +
> +       if (!enable)
> +               dcss_dtg_plane_pos_set(dcss->dtg, dcss_plane->ch_num,
> +                                      0, 0, 0, 0);
> +
> +       dcss_dtg_ch_enable(dcss->dtg, dcss_plane->ch_num, enable);
> +}
> +
> +static void dcss_plane_atomic_disable(struct drm_plane *plane,
> +                                     struct drm_plane_state *old_state)
> +{
> +       struct dcss_plane *dcss_plane = to_dcss_plane(plane);
> +       struct dcss_dev *dcss = plane->dev->dev_private;
> +
> +       dcss_dpr_enable(dcss->dpr, dcss_plane->ch_num, false);
> +       dcss_scaler_ch_enable(dcss->scaler, dcss_plane->ch_num, false);
> +       dcss_dtg_plane_pos_set(dcss->dtg, dcss_plane->ch_num, 0, 0, 0, 0);
> +       dcss_dtg_ch_enable(dcss->dtg, dcss_plane->ch_num, false);
> +}
> +
> +static const struct drm_plane_helper_funcs dcss_plane_helper_funcs = {
> +       .prepare_fb = drm_gem_fb_prepare_fb,
> +       .atomic_check = dcss_plane_atomic_check,
> +       .atomic_update = dcss_plane_atomic_update,
> +       .atomic_disable = dcss_plane_atomic_disable,
> +};
> +
> +struct dcss_plane *dcss_plane_init(struct drm_device *drm,
> +                                  unsigned int possible_crtcs,
> +                                  enum drm_plane_type type,
> +                                  unsigned int zpos)
> +{
> +       struct dcss_plane *dcss_plane;
> +       const u64 *format_modifiers = dcss_video_format_modifiers;
> +       int ret;
> +
> +       if (zpos > 2)
> +               return ERR_PTR(-EINVAL);
> +
> +       dcss_plane = kzalloc(sizeof(*dcss_plane), GFP_KERNEL);
> +       if (!dcss_plane) {
> +               DRM_ERROR("failed to allocate plane\n");
> +               return ERR_PTR(-ENOMEM);
> +       }
> +
> +       if (type == DRM_PLANE_TYPE_PRIMARY)
> +               format_modifiers = dcss_graphics_format_modifiers;
> +
> +       ret = drm_universal_plane_init(drm, &dcss_plane->base, possible_crtcs,
> +                                      &dcss_plane_funcs, dcss_common_formats,
> +                                      ARRAY_SIZE(dcss_common_formats),
> +                                      format_modifiers, type, NULL);
> +       if (ret) {
> +               DRM_ERROR("failed to initialize plane\n");
> +               kfree(dcss_plane);
> +               return ERR_PTR(ret);
> +       }
> +
> +       drm_plane_helper_add(&dcss_plane->base, &dcss_plane_helper_funcs);
> +
> +       ret = drm_plane_create_zpos_immutable_property(&dcss_plane->base, zpos);
> +       if (ret)
> +               return ERR_PTR(ret);
> +
> +       drm_plane_create_rotation_property(&dcss_plane->base,
> +                                          DRM_MODE_ROTATE_0,
> +                                          DRM_MODE_ROTATE_0   |
> +                                          DRM_MODE_ROTATE_90  |
> +                                          DRM_MODE_ROTATE_180 |
> +                                          DRM_MODE_ROTATE_270 |
> +                                          DRM_MODE_REFLECT_X  |
> +                                          DRM_MODE_REFLECT_Y);
> +
> +       dcss_plane->ch_num = zpos;
> +
> +       return dcss_plane;
> +}
> diff --git a/drivers/gpu/drm/imx/dcss/dcss-scaler.c b/drivers/gpu/drm/imx/dcss/dcss-scaler.c
> new file mode 100644
> index 00000000..3e317f4
> --- /dev/null
> +++ b/drivers/gpu/drm/imx/dcss/dcss-scaler.c
> @@ -0,0 +1,830 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * Copyright 2019 NXP.
> + *
> + * Scaling algorithms were contributed by Dzung Hoang <dzung.hoang@nxp.com>
> + */
> +
> +#include <linux/device.h>
> +
> +#include "dcss-dev.h"
> +
> +#define DCSS_SCALER_CTRL                       0x00
> +#define   SCALER_EN                            BIT(0)
> +#define   REPEAT_EN                            BIT(4)
> +#define   SCALE2MEM_EN                         BIT(8)
> +#define   MEM2OFIFO_EN                         BIT(12)
> +#define DCSS_SCALER_OFIFO_CTRL                 0x04
> +#define   OFIFO_LOW_THRES_POS                  0
> +#define   OFIFO_LOW_THRES_MASK                 GENMASK(9, 0)
> +#define   OFIFO_HIGH_THRES_POS                 16
> +#define   OFIFO_HIGH_THRES_MASK                        GENMASK(25, 16)
> +#define   UNDERRUN_DETECT_CLR                  BIT(26)
> +#define   LOW_THRES_DETECT_CLR                 BIT(27)
> +#define   HIGH_THRES_DETECT_CLR                        BIT(28)
> +#define   UNDERRUN_DETECT_EN                   BIT(29)
> +#define   LOW_THRES_DETECT_EN                  BIT(30)
> +#define   HIGH_THRES_DETECT_EN                 BIT(31)
> +#define DCSS_SCALER_SDATA_CTRL                 0x08
> +#define   YUV_EN                               BIT(0)
> +#define   RTRAM_8LINES                         BIT(1)
> +#define   Y_UV_BYTE_SWAP                       BIT(4)
> +#define   A2R10G10B10_FORMAT_POS               8
> +#define   A2R10G10B10_FORMAT_MASK              GENMASK(11, 8)
> +#define DCSS_SCALER_BIT_DEPTH                  0x0C
> +#define   LUM_BIT_DEPTH_POS                    0
> +#define   LUM_BIT_DEPTH_MASK                   GENMASK(1, 0)
> +#define   CHR_BIT_DEPTH_POS                    4
> +#define   CHR_BIT_DEPTH_MASK                   GENMASK(5, 4)
> +#define DCSS_SCALER_SRC_FORMAT                 0x10
> +#define DCSS_SCALER_DST_FORMAT                 0x14
> +#define   FORMAT_MASK                          GENMASK(1, 0)
> +#define DCSS_SCALER_SRC_LUM_RES                        0x18
> +#define DCSS_SCALER_SRC_CHR_RES                        0x1C
> +#define DCSS_SCALER_DST_LUM_RES                        0x20
> +#define DCSS_SCALER_DST_CHR_RES                        0x24
> +#define   WIDTH_POS                            0
> +#define   WIDTH_MASK                           GENMASK(11, 0)
> +#define   HEIGHT_POS                           16
> +#define   HEIGHT_MASK                          GENMASK(27, 16)
> +#define DCSS_SCALER_V_LUM_START                        0x48
> +#define   V_START_MASK                         GENMASK(15, 0)
> +#define DCSS_SCALER_V_LUM_INC                  0x4C
> +#define   V_INC_MASK                           GENMASK(15, 0)
> +#define DCSS_SCALER_H_LUM_START                        0x50
> +#define   H_START_MASK                         GENMASK(18, 0)
> +#define DCSS_SCALER_H_LUM_INC                  0x54
> +#define   H_INC_MASK                           GENMASK(15, 0)
> +#define DCSS_SCALER_V_CHR_START                        0x58
> +#define DCSS_SCALER_V_CHR_INC                  0x5C
> +#define DCSS_SCALER_H_CHR_START                        0x60
> +#define DCSS_SCALER_H_CHR_INC                  0x64
> +#define DCSS_SCALER_COEF_VLUM                  0x80
> +#define DCSS_SCALER_COEF_HLUM                  0x140
> +#define DCSS_SCALER_COEF_VCHR                  0x200
> +#define DCSS_SCALER_COEF_HCHR                  0x300
> +
> +struct dcss_scaler_ch {
> +       void __iomem *base_reg;
> +       u32 base_ofs;
> +       struct dcss_scaler *scl;
> +
> +       u32 sdata_ctrl;
> +       u32 scaler_ctrl;
> +
> +       bool scaler_ctrl_chgd;
> +
> +       u32 c_vstart;
> +       u32 c_hstart;
> +};
> +
> +struct dcss_scaler {
> +       struct device *dev;
> +
> +       struct dcss_ctxld *ctxld;
> +       u32 ctx_id;
> +
> +       struct dcss_scaler_ch ch[3];
> +};
> +
> +/* scaler coefficients generator */
> +#define PSC_FRAC_BITS 30
> +#define PSC_FRAC_SCALE BIT(PSC_FRAC_BITS)
> +#define PSC_BITS_FOR_PHASE 4
> +#define PSC_NUM_PHASES 16
> +#define PSC_STORED_PHASES (PSC_NUM_PHASES / 2 + 1)
> +#define PSC_NUM_TAPS 7
> +#define PSC_NUM_TAPS_RGBA 5
> +#define PSC_COEFF_PRECISION 10
> +#define PSC_PHASE_FRACTION_BITS 13
> +#define PSC_PHASE_MASK (PSC_NUM_PHASES - 1)
> +#define PSC_Q_FRACTION 19
> +#define PSC_Q_ROUND_OFFSET (1 << (PSC_Q_FRACTION - 1))
> +
> +/**
> + * mult_q() - Performs fixed-point multiplication.
> + * @A: multiplier
> + * @B: multiplicand
> + */
> +static int mult_q(int A, int B)
> +{
> +       int result;
> +       s64 temp;
> +
> +       temp = (int64_t)A * (int64_t)B;
> +       temp += PSC_Q_ROUND_OFFSET;
> +       result = (int)(temp >> PSC_Q_FRACTION);
> +       return result;
> +}
> +
> +/**
> + * div_q() - Performs fixed-point division.
> + * @A: dividend
> + * @B: divisor
> + */
> +static int div_q(int A, int B)
> +{
> +       int result;
> +       s64 temp;
> +
> +       temp = (int64_t)A << PSC_Q_FRACTION;
> +       if ((temp >= 0 && B >= 0) || (temp < 0 && B < 0))
> +               temp += B / 2;
> +       else
> +               temp -= B / 2;
> +
> +       result = (int)(temp / B);
> +       return result;
> +}
> +
> +/**
> + * exp_approx_q() - Compute approximation to exp(x) function using Taylor
> + *                 series.
> + * @x: fixed-point argument of exp function
> + */
> +static int exp_approx_q(int x)
> +{
> +       int sum = 1 << PSC_Q_FRACTION;
> +       int term = 1 << PSC_Q_FRACTION;
> +
> +       term = mult_q(term, div_q(x, 1 << PSC_Q_FRACTION));
> +       sum += term;
> +       term = mult_q(term, div_q(x, 2 << PSC_Q_FRACTION));
> +       sum += term;
> +       term = mult_q(term, div_q(x, 3 << PSC_Q_FRACTION));
> +       sum += term;
> +       term = mult_q(term, div_q(x, 4 << PSC_Q_FRACTION));
> +       sum += term;
> +
> +       return sum;
> +}
> +
> +/**
> + * dcss_scaler_gaussian_filter() - Generate gaussian prototype filter.
> + * @fc_q: fixed-point cutoff frequency normalized to range [0, 1]
> + * @use_5_taps: indicates whether to use 5 taps or 7 taps
> + * @coef: output filter coefficients
> + */
> +static void dcss_scaler_gaussian_filter(int fc_q, bool use_5_taps,
> +                                       bool phase0_identity,
> +                                       int coef[][PSC_NUM_TAPS])
> +{
> +       int sigma_q, g0_q, g1_q, g2_q;
> +       int tap_cnt1, tap_cnt2, tap_idx, phase_cnt;
> +       int mid;
> +       int phase;
> +       int i;
> +       int taps;
> +
> +       if (use_5_taps)
> +               for (phase = 0; phase < PSC_STORED_PHASES; phase++) {
> +                       coef[phase][0] = 0;
> +                       coef[phase][PSC_NUM_TAPS - 1] = 0;
> +               }
> +
> +       /* seed coefficient scanner */
> +       taps = use_5_taps ? PSC_NUM_TAPS_RGBA : PSC_NUM_TAPS;
> +       mid = (PSC_NUM_PHASES * taps) / 2 - 1;
> +       phase_cnt = (PSC_NUM_PHASES * (PSC_NUM_TAPS + 1)) / 2;
> +       tap_cnt1 = (PSC_NUM_PHASES * PSC_NUM_TAPS) / 2;
> +       tap_cnt2 = (PSC_NUM_PHASES * PSC_NUM_TAPS) / 2;
> +
> +       /* seed gaussian filter generator */
> +       sigma_q = div_q(PSC_Q_ROUND_OFFSET, fc_q);
> +       g0_q = 1 << PSC_Q_FRACTION;
> +       g1_q = exp_approx_q(div_q(-PSC_Q_ROUND_OFFSET,
> +                                 mult_q(sigma_q, sigma_q)));
> +       g2_q = mult_q(g1_q, g1_q);
> +       coef[phase_cnt & PSC_PHASE_MASK][tap_cnt1 >> PSC_BITS_FOR_PHASE] = g0_q;
> +
> +       for (i = 0; i < mid; i++) {
> +               phase_cnt++;
> +               tap_cnt1--;
> +               tap_cnt2++;
> +
> +               g0_q = mult_q(g0_q, g1_q);
> +               g1_q = mult_q(g1_q, g2_q);
> +
> +               if ((phase_cnt & PSC_PHASE_MASK) <= 8) {
> +                       tap_idx = tap_cnt1 >> PSC_BITS_FOR_PHASE;
> +                       coef[phase_cnt & PSC_PHASE_MASK][tap_idx] = g0_q;
> +               }
> +               if (((-phase_cnt) & PSC_PHASE_MASK) <= 8) {
> +                       tap_idx = tap_cnt2 >> PSC_BITS_FOR_PHASE;
> +                       coef[(-phase_cnt) & PSC_PHASE_MASK][tap_idx] = g0_q;
> +               }
> +       }
> +
> +       phase_cnt++;
> +       tap_cnt1--;
> +       coef[phase_cnt & PSC_PHASE_MASK][tap_cnt1 >> PSC_BITS_FOR_PHASE] = 0;
> +
> +       /* override phase 0 with identity filter if specified */
> +       if (phase0_identity)
> +               for (i = 0; i < PSC_NUM_TAPS; i++)
> +                       coef[0][i] = i == (PSC_NUM_TAPS >> 1) ?
> +                                               (1 << PSC_COEFF_PRECISION) : 0;
> +
> +       /* normalize coef */
> +       for (phase = 0; phase < PSC_STORED_PHASES; phase++) {
> +               int sum = 0;
> +               s64 ll_temp;
> +
> +               for (i = 0; i < PSC_NUM_TAPS; i++)
> +                       sum += coef[phase][i];
> +               for (i = 0; i < PSC_NUM_TAPS; i++) {
> +                       ll_temp = coef[phase][i];
> +                       ll_temp <<= PSC_COEFF_PRECISION;
> +                       ll_temp += sum >> 1;
> +                       ll_temp /= sum;
> +                       coef[phase][i] = (int)ll_temp;
> +               }
> +       }
> +}
> +
> +/**
> + * dcss_scaler_filter_design() - Compute filter coefficients using
> + *                              Gaussian filter.
> + * @src_length: length of input
> + * @dst_length: length of output
> + * @use_5_taps: 0 for 7 taps per phase, 1 for 5 taps
> + * @coef: output coefficients
> + */
> +static void dcss_scaler_filter_design(int src_length, int dst_length,
> +                                     bool use_5_taps, bool phase0_identity,
> +                                     int coef[][PSC_NUM_TAPS])
> +{
> +       int fc_q;
> +
> +       /* compute cutoff frequency */
> +       if (dst_length >= src_length)
> +               fc_q = div_q(1, PSC_NUM_PHASES);
> +       else
> +               fc_q = div_q(dst_length, src_length * PSC_NUM_PHASES);
> +
> +       /* compute gaussian filter coefficients */
> +       dcss_scaler_gaussian_filter(fc_q, use_5_taps, phase0_identity, coef);
> +}
> +
> +static void dcss_scaler_write(struct dcss_scaler_ch *ch, u32 val, u32 ofs)
> +{
> +       struct dcss_scaler *scl = ch->scl;
> +
> +       dcss_ctxld_write(scl->ctxld, scl->ctx_id, val, ch->base_ofs + ofs);
> +}
> +
> +static int dcss_scaler_ch_init_all(struct dcss_scaler *scl,
> +                                  unsigned long scaler_base)
> +{
> +       struct dcss_scaler_ch *ch;
> +       int i;
> +
> +       for (i = 0; i < 3; i++) {
> +               ch = &scl->ch[i];
> +
> +               ch->base_ofs = scaler_base + i * 0x400;
> +
> +               ch->base_reg = devm_ioremap(scl->dev, ch->base_ofs, SZ_4K);
> +               if (!ch->base_reg) {
> +                       dev_err(scl->dev, "scaler: unable to remap ch base\n");
> +                       return -ENOMEM;
> +               }
> +
> +               ch->scl = scl;
> +       }
> +
> +       return 0;
> +}
> +
> +int dcss_scaler_init(struct dcss_dev *dcss, unsigned long scaler_base)
> +{
> +       struct dcss_scaler *scaler;
> +
> +       scaler = devm_kzalloc(dcss->dev, sizeof(*scaler), GFP_KERNEL);
> +       if (!scaler)
> +               return -ENOMEM;
> +
> +       dcss->scaler = scaler;
> +       scaler->dev = dcss->dev;
> +       scaler->ctxld = dcss->ctxld;
> +       scaler->ctx_id = CTX_SB_HP;
> +
> +       if (dcss_scaler_ch_init_all(scaler, scaler_base)) {
> +               int i;
> +
> +               for (i = 0; i < 3; i++) {
> +                       if (scaler->ch[i].base_reg)
> +                               devm_iounmap(scaler->dev,
> +                                            scaler->ch[i].base_reg);
> +               }
> +
> +               devm_kfree(scaler->dev, scaler);
> +
> +               return -ENOMEM;
> +       }
> +
> +       return 0;
> +}
> +
> +void dcss_scaler_exit(struct dcss_scaler *scl)
> +{
> +       int ch_no;
> +
> +       for (ch_no = 0; ch_no < 3; ch_no++) {
> +               struct dcss_scaler_ch *ch = &scl->ch[ch_no];
> +
> +               dcss_writel(0, ch->base_reg + DCSS_SCALER_CTRL);
> +
> +               if (ch->base_reg)
> +                       devm_iounmap(scl->dev, ch->base_reg);
> +       }
> +
> +       devm_kfree(scl->dev, scl);
> +}
> +
> +void dcss_scaler_ch_enable(struct dcss_scaler *scl, int ch_num, bool en)
> +{
> +       struct dcss_scaler_ch *ch = &scl->ch[ch_num];
> +       u32 scaler_ctrl;
> +
> +       scaler_ctrl = en ? SCALER_EN | REPEAT_EN : 0;
> +
> +       if (en)
> +               dcss_scaler_write(ch, ch->sdata_ctrl, DCSS_SCALER_SDATA_CTRL);
> +
> +       if (ch->scaler_ctrl != scaler_ctrl)
> +               ch->scaler_ctrl_chgd = true;
> +
> +       ch->scaler_ctrl = scaler_ctrl;
> +}
> +
> +static void dcss_scaler_yuv_enable(struct dcss_scaler_ch *ch, bool en)
> +{
> +       ch->sdata_ctrl &= ~YUV_EN;
> +       ch->sdata_ctrl |= en ? YUV_EN : 0;
> +}
> +
> +static void dcss_scaler_rtr_8lines_enable(struct dcss_scaler_ch *ch, bool en)
> +{
> +       ch->sdata_ctrl &= ~RTRAM_8LINES;
> +       ch->sdata_ctrl |= en ? RTRAM_8LINES : 0;
> +}
> +
> +static void dcss_scaler_bit_depth_set(struct dcss_scaler_ch *ch, int depth)
> +{
> +       u32 val;
> +
> +       val = depth == 30 ? 2 : 0;
> +
> +       dcss_scaler_write(ch,
> +                         ((val << CHR_BIT_DEPTH_POS) & CHR_BIT_DEPTH_MASK) |
> +                         ((val << LUM_BIT_DEPTH_POS) & LUM_BIT_DEPTH_MASK),
> +                         DCSS_SCALER_BIT_DEPTH);
> +}
> +
> +enum buffer_format {
> +       BUF_FMT_YUV420,
> +       BUF_FMT_YUV422,
> +       BUF_FMT_ARGB8888_YUV444,
> +};
> +
> +enum chroma_location {
> +       PSC_LOC_HORZ_0_VERT_1_OVER_4 = 0,
> +       PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_4 = 1,
> +       PSC_LOC_HORZ_0_VERT_0 = 2,
> +       PSC_LOC_HORZ_1_OVER_4_VERT_0 = 3,
> +       PSC_LOC_HORZ_0_VERT_1_OVER_2 = 4,
> +       PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_2 = 5
> +};
> +
> +static void dcss_scaler_format_set(struct dcss_scaler_ch *ch,
> +                                  enum buffer_format src_fmt,
> +                                  enum buffer_format dst_fmt)
> +{
> +       dcss_scaler_write(ch, src_fmt, DCSS_SCALER_SRC_FORMAT);
> +       dcss_scaler_write(ch, dst_fmt, DCSS_SCALER_DST_FORMAT);
> +}
> +
> +static void dcss_scaler_res_set(struct dcss_scaler_ch *ch,
> +                               int src_xres, int src_yres,
> +                               int dst_xres, int dst_yres,
> +                               u32 pix_format, enum buffer_format dst_format)
> +{
> +       u32 lsrc_xres, lsrc_yres, csrc_xres, csrc_yres;
> +       u32 ldst_xres, ldst_yres, cdst_xres, cdst_yres;
> +       bool src_is_444 = true;
> +
> +       lsrc_xres = src_xres;
> +       csrc_xres = src_xres;
> +       lsrc_yres = src_yres;
> +       csrc_yres = src_yres;
> +       ldst_xres = dst_xres;
> +       cdst_xres = dst_xres;
> +       ldst_yres = dst_yres;
> +       cdst_yres = dst_yres;
> +
> +       if (pix_format == DRM_FORMAT_UYVY || pix_format == DRM_FORMAT_VYUY ||
> +           pix_format == DRM_FORMAT_YUYV || pix_format == DRM_FORMAT_YVYU) {
> +               csrc_xres >>= 1;
> +               src_is_444 = false;
> +       } else if (pix_format == DRM_FORMAT_NV12 ||
> +                  pix_format == DRM_FORMAT_NV21) {
> +               csrc_xres >>= 1;
> +               csrc_yres >>= 1;
> +               src_is_444 = false;
> +       }
> +
> +       if (dst_format == BUF_FMT_YUV422)
> +               cdst_xres >>= 1;
> +
> +       /* for 4:4:4 to 4:2:2 conversion, source height should be 1 less */
> +       if (src_is_444 && dst_format == BUF_FMT_YUV422) {
> +               lsrc_yres--;
> +               csrc_yres--;
> +       }
> +
> +       dcss_scaler_write(ch, (((lsrc_yres - 1) << HEIGHT_POS) & HEIGHT_MASK) |
> +                              (((lsrc_xres - 1) << WIDTH_POS) & WIDTH_MASK),
> +                         DCSS_SCALER_SRC_LUM_RES);
> +       dcss_scaler_write(ch, (((csrc_yres - 1) << HEIGHT_POS) & HEIGHT_MASK) |
> +                              (((csrc_xres - 1) << WIDTH_POS) & WIDTH_MASK),
> +                         DCSS_SCALER_SRC_CHR_RES);
> +       dcss_scaler_write(ch, (((ldst_yres - 1) << HEIGHT_POS) & HEIGHT_MASK) |
> +                              (((ldst_xres - 1) << WIDTH_POS) & WIDTH_MASK),
> +                         DCSS_SCALER_DST_LUM_RES);
> +       dcss_scaler_write(ch, (((cdst_yres - 1) << HEIGHT_POS) & HEIGHT_MASK) |
> +                              (((cdst_xres - 1) << WIDTH_POS) & WIDTH_MASK),
> +                         DCSS_SCALER_DST_CHR_RES);
> +}
> +
> +#define max_downscale(ratio)           ((ratio) << 16)
> +#define max_upscale(ratio)             ((1 << 16) / (ratio))
> +
> +struct dcss_scaler_ratios {
> +       int downscale;
> +       int upscale;
> +};
> +
> +static const struct dcss_scaler_ratios dcss_scaler_ratios[] = {
> +       {max_downscale(3), max_upscale(8)},
> +       {max_downscale(5), max_upscale(8)},
> +       {max_downscale(5), max_upscale(8)},
> +};
> +
> +static void dcss_scaler_fractions_set(struct dcss_scaler_ch *ch,
> +                                     int src_xres, int src_yres,
> +                                     int dst_xres, int dst_yres,
> +                                     u32 src_format, u32 dst_format,
> +                                     enum chroma_location src_chroma_loc)
> +{
> +       int src_c_xres, src_c_yres, dst_c_xres, dst_c_yres;
> +       u32 l_vinc, l_hinc, c_vinc, c_hinc;
> +       u32 c_vstart, c_hstart;
> +
> +       src_c_xres = src_xres;
> +       src_c_yres = src_yres;
> +       dst_c_xres = dst_xres;
> +       dst_c_yres = dst_yres;
> +
> +       c_vstart = 0;
> +       c_hstart = 0;
> +
> +       /* adjustments for source chroma location */
> +       if (src_format == BUF_FMT_YUV420) {
> +               /* vertical input chroma position adjustment */
> +               switch (src_chroma_loc) {
> +               case PSC_LOC_HORZ_0_VERT_1_OVER_4:
> +               case PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_4:
> +                       /*
> +                        * move chroma up to first luma line
> +                        * (1/4 chroma input line spacing)
> +                        */
> +                       c_vstart -= (1 << (PSC_PHASE_FRACTION_BITS - 2));
> +                       break;
> +               case PSC_LOC_HORZ_0_VERT_1_OVER_2:
> +               case PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_2:
> +                       /*
> +                        * move chroma up to first luma line
> +                        * (1/2 chroma input line spacing)
> +                        */
> +                       c_vstart -= (1 << (PSC_PHASE_FRACTION_BITS - 1));
> +                       break;
> +               default:
> +                       break;
> +               }
> +               /* horizontal input chroma position adjustment */
> +               switch (src_chroma_loc) {
> +               case PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_4:
> +               case PSC_LOC_HORZ_1_OVER_4_VERT_0:
> +               case PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_2:
> +                       /* move chroma left 1/4 chroma input sample spacing */
> +                       c_hstart -= (1 << (PSC_PHASE_FRACTION_BITS - 2));
> +                       break;
> +               default:
> +                       break;
> +               }
> +       }
> +
> +       /* adjustments to chroma resolution */
> +       if (src_format == BUF_FMT_YUV420) {
> +               src_c_xres >>= 1;
> +               src_c_yres >>= 1;
> +       } else if (src_format == BUF_FMT_YUV422) {
> +               src_c_xres >>= 1;
> +       }
> +
> +       if (dst_format == BUF_FMT_YUV422)
> +               dst_c_xres >>= 1;
> +
> +       l_vinc = ((src_yres << 13) + (dst_yres >> 1)) / dst_yres;
> +       c_vinc = ((src_c_yres << 13) + (dst_c_yres >> 1)) / dst_c_yres;
> +       l_hinc = ((src_xres << 13) + (dst_xres >> 1)) / dst_xres;
> +       c_hinc = ((src_c_xres << 13) + (dst_c_xres >> 1)) / dst_c_xres;
> +
> +       /* save chroma start phase */
> +       ch->c_vstart = c_vstart;
> +       ch->c_hstart = c_hstart;
> +
> +       dcss_scaler_write(ch, 0, DCSS_SCALER_V_LUM_START);
> +       dcss_scaler_write(ch, l_vinc, DCSS_SCALER_V_LUM_INC);
> +
> +       dcss_scaler_write(ch, 0, DCSS_SCALER_H_LUM_START);
> +       dcss_scaler_write(ch, l_hinc, DCSS_SCALER_H_LUM_INC);
> +
> +       dcss_scaler_write(ch, c_vstart, DCSS_SCALER_V_CHR_START);
> +       dcss_scaler_write(ch, c_vinc, DCSS_SCALER_V_CHR_INC);
> +
> +       dcss_scaler_write(ch, c_hstart, DCSS_SCALER_H_CHR_START);
> +       dcss_scaler_write(ch, c_hinc, DCSS_SCALER_H_CHR_INC);
> +}
> +
> +int dcss_scaler_get_min_max_ratios(struct dcss_scaler *scl, int ch_num,
> +                                  int *min, int *max)
> +{
> +       *min = dcss_scaler_ratios[ch_num].upscale;
> +       *max = dcss_scaler_ratios[ch_num].downscale;
> +
> +       return 0;
> +}
> +
> +static void dcss_scaler_program_5_coef_set(struct dcss_scaler_ch *ch,
> +                                          int base_addr,
> +                                          int coef[][PSC_NUM_TAPS])
> +{
> +       int i, phase;
> +
> +       for (i = 0; i < PSC_STORED_PHASES; i++) {
> +               dcss_scaler_write(ch, ((coef[i][1] & 0xfff) << 16 |
> +                                      (coef[i][2] & 0xfff) << 4  |
> +                                      (coef[i][3] & 0xf00) >> 8),
> +                                 base_addr + i * sizeof(u32));
> +               dcss_scaler_write(ch, ((coef[i][3] & 0x0ff) << 20 |
> +                                      (coef[i][4] & 0xfff) << 8  |
> +                                      (coef[i][5] & 0xff0) >> 4),
> +                                 base_addr + 0x40 + i * sizeof(u32));
> +               dcss_scaler_write(ch, ((coef[i][5] & 0x00f) << 24),
> +                                 base_addr + 0x80 + i * sizeof(u32));
> +       }
> +
> +       /* reverse both phase and tap orderings */
> +       for (phase = (PSC_NUM_PHASES >> 1) - 1;
> +                       i < PSC_NUM_PHASES; i++, phase--) {
> +               dcss_scaler_write(ch, ((coef[phase][5] & 0xfff) << 16 |
> +                                      (coef[phase][4] & 0xfff) << 4  |
> +                                      (coef[phase][3] & 0xf00) >> 8),
> +                                 base_addr + i * sizeof(u32));
> +               dcss_scaler_write(ch, ((coef[phase][3] & 0x0ff) << 20 |
> +                                      (coef[phase][2] & 0xfff) << 8  |
> +                                      (coef[phase][1] & 0xff0) >> 4),
> +                                 base_addr + 0x40 + i * sizeof(u32));
> +               dcss_scaler_write(ch, ((coef[phase][1] & 0x00f) << 24),
> +                                 base_addr + 0x80 + i * sizeof(u32));
> +       }
> +}
> +
> +static void dcss_scaler_program_7_coef_set(struct dcss_scaler_ch *ch,
> +                                          int base_addr,
> +                                          int coef[][PSC_NUM_TAPS])
> +{
> +       int i, phase;
> +
> +       for (i = 0; i < PSC_STORED_PHASES; i++) {
> +               dcss_scaler_write(ch, ((coef[i][0] & 0xfff) << 16 |
> +                                      (coef[i][1] & 0xfff) << 4  |
> +                                      (coef[i][2] & 0xf00) >> 8),
> +                                 base_addr + i * sizeof(u32));
> +               dcss_scaler_write(ch, ((coef[i][2] & 0x0ff) << 20 |
> +                                      (coef[i][3] & 0xfff) << 8  |
> +                                      (coef[i][4] & 0xff0) >> 4),
> +                                 base_addr + 0x40 + i * sizeof(u32));
> +               dcss_scaler_write(ch, ((coef[i][4] & 0x00f) << 24 |
> +                                      (coef[i][5] & 0xfff) << 12 |
> +                                      (coef[i][6] & 0xfff)),
> +                                 base_addr + 0x80 + i * sizeof(u32));
> +       }
> +
> +       /* reverse both phase and tap orderings */
> +       for (phase = (PSC_NUM_PHASES >> 1) - 1;
> +                       i < PSC_NUM_PHASES; i++, phase--) {
> +               dcss_scaler_write(ch, ((coef[phase][6] & 0xfff) << 16 |
> +                                      (coef[phase][5] & 0xfff) << 4  |
> +                                      (coef[phase][4] & 0xf00) >> 8),
> +                                 base_addr + i * sizeof(u32));
> +               dcss_scaler_write(ch, ((coef[phase][4] & 0x0ff) << 20 |
> +                                      (coef[phase][3] & 0xfff) << 8  |
> +                                      (coef[phase][2] & 0xff0) >> 4),
> +                                 base_addr + 0x40 + i * sizeof(u32));
> +               dcss_scaler_write(ch, ((coef[phase][2] & 0x00f) << 24 |
> +                                      (coef[phase][1] & 0xfff) << 12 |
> +                                      (coef[phase][0] & 0xfff)),
> +                                 base_addr + 0x80 + i * sizeof(u32));
> +       }
> +}
> +
> +static void dcss_scaler_yuv_coef_set(struct dcss_scaler_ch *ch,
> +                                    enum buffer_format src_format,
> +                                    enum buffer_format dst_format,
> +                                    bool use_5_taps,
> +                                    int src_xres, int src_yres, int dst_xres,
> +                                    int dst_yres)
> +{
> +       int coef[PSC_STORED_PHASES][PSC_NUM_TAPS];
> +       bool program_5_taps = use_5_taps ||
> +                             (dst_format == BUF_FMT_YUV422 &&
> +                              src_format == BUF_FMT_ARGB8888_YUV444);
> +
> +       /* horizontal luma */
> +       dcss_scaler_filter_design(src_xres, dst_xres, false,
> +                                 src_xres == dst_xres, coef);
> +       dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_HLUM, coef);
> +
> +       /* vertical luma */
> +       dcss_scaler_filter_design(src_yres, dst_yres, program_5_taps,
> +                                 src_yres == dst_yres, coef);
> +
> +       if (program_5_taps)
> +               dcss_scaler_program_5_coef_set(ch, DCSS_SCALER_COEF_VLUM, coef);
> +       else
> +               dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_VLUM, coef);
> +
> +       /* adjust chroma resolution */
> +       if (src_format != BUF_FMT_ARGB8888_YUV444)
> +               src_xres >>= 1;
> +       if (src_format == BUF_FMT_YUV420)
> +               src_yres >>= 1;
> +       if (dst_format != BUF_FMT_ARGB8888_YUV444)
> +               dst_xres >>= 1;
> +       if (dst_format == BUF_FMT_YUV420) /* should not happen */
> +               dst_yres >>= 1;
> +
> +       /* horizontal chroma */
> +       dcss_scaler_filter_design(src_xres, dst_xres, false,
> +                                 (src_xres == dst_xres) && (ch->c_hstart == 0),
> +                                 coef);
> +
> +       dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_HCHR, coef);
> +
> +       /* vertical chroma */
> +       dcss_scaler_filter_design(src_yres, dst_yres, program_5_taps,
> +                                 (src_yres == dst_yres) && (ch->c_vstart == 0),
> +                                 coef);
> +       if (program_5_taps)
> +               dcss_scaler_program_5_coef_set(ch, DCSS_SCALER_COEF_VCHR, coef);
> +       else
> +               dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_VCHR, coef);
> +}
> +
> +static void dcss_scaler_rgb_coef_set(struct dcss_scaler_ch *ch,
> +                                    int src_xres, int src_yres, int dst_xres,
> +                                    int dst_yres)
> +{
> +       int coef[PSC_STORED_PHASES][PSC_NUM_TAPS];
> +
> +       /* horizontal RGB */
> +       dcss_scaler_filter_design(src_xres, dst_xres, false,
> +                                 src_xres == dst_xres, coef);
> +       dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_HLUM, coef);
> +
> +       /* vertical RGB */
> +       dcss_scaler_filter_design(src_yres, dst_yres, false,
> +                                 src_yres == dst_yres, coef);
> +       dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_VLUM, coef);
> +}
> +
> +static void dcss_scaler_set_rgb10_order(struct dcss_scaler_ch *ch,
> +                                       const struct drm_format_info *format)
> +{
> +       u32 a2r10g10b10_format;
> +
> +       if (format->is_yuv)
> +               return;
> +
> +       ch->sdata_ctrl &= ~A2R10G10B10_FORMAT_MASK;
> +
> +       if (format->depth != 30)
> +               return;
> +
> +       switch (format->format) {
> +       case DRM_FORMAT_ARGB2101010:
> +       case DRM_FORMAT_XRGB2101010:
> +               a2r10g10b10_format = 0;
> +               break;
> +
> +       case DRM_FORMAT_ABGR2101010:
> +       case DRM_FORMAT_XBGR2101010:
> +               a2r10g10b10_format = 5;
> +               break;
> +
> +       case DRM_FORMAT_RGBA1010102:
> +       case DRM_FORMAT_RGBX1010102:
> +               a2r10g10b10_format = 6;
> +               break;
> +
> +       case DRM_FORMAT_BGRA1010102:
> +       case DRM_FORMAT_BGRX1010102:
> +               a2r10g10b10_format = 11;
> +               break;
> +
> +       default:
> +               a2r10g10b10_format = 0;
> +               break;
> +       }
> +
> +       ch->sdata_ctrl |= a2r10g10b10_format << A2R10G10B10_FORMAT_POS;
> +}
> +
> +void dcss_scaler_setup(struct dcss_scaler *scl, int ch_num,
> +                      const struct drm_format_info *format,
> +                      int src_xres, int src_yres, int dst_xres, int dst_yres,
> +                      u32 vrefresh_hz)
> +{
> +       struct dcss_scaler_ch *ch = &scl->ch[ch_num];
> +       unsigned int pixel_depth = 0;
> +       bool rtr_8line_en = false;
> +       bool use_5_taps = false;
> +       enum buffer_format src_format = BUF_FMT_ARGB8888_YUV444;
> +       enum buffer_format dst_format = BUF_FMT_ARGB8888_YUV444;
> +       u32 pix_format = format->format;
> +
> +       if (format->is_yuv) {
> +               dcss_scaler_yuv_enable(ch, true);
> +
> +               if (pix_format == DRM_FORMAT_NV12 ||
> +                   pix_format == DRM_FORMAT_NV21 ||
> +                   pix_format == DRM_FORMAT_P010) {
> +                       rtr_8line_en = true;
> +                       src_format = BUF_FMT_YUV420;
> +               } else if (pix_format == DRM_FORMAT_UYVY ||
> +                          pix_format == DRM_FORMAT_VYUY ||
> +                          pix_format == DRM_FORMAT_YUYV ||
> +                          pix_format == DRM_FORMAT_YVYU) {
> +                       src_format = BUF_FMT_YUV422;
> +               }
> +
> +               use_5_taps = !rtr_8line_en;
> +               if (pix_format == DRM_FORMAT_P010)
> +                       pixel_depth = 30;
> +
> +       } else {
> +               dcss_scaler_yuv_enable(ch, false);
> +
> +               pixel_depth = format->depth;
> +       }
> +
> +       dcss_scaler_fractions_set(ch, src_xres, src_yres, dst_xres,
> +                                 dst_yres, src_format, dst_format,
> +                                 PSC_LOC_HORZ_0_VERT_1_OVER_4);
> +
> +       if (format->is_yuv)
> +               dcss_scaler_yuv_coef_set(ch, src_format, dst_format,
> +                                        use_5_taps, src_xres, src_yres,
> +                                        dst_xres, dst_yres);
> +       else
> +               dcss_scaler_rgb_coef_set(ch, src_xres, src_yres,
> +                                        dst_xres, dst_yres);
> +
> +       dcss_scaler_rtr_8lines_enable(ch, rtr_8line_en);
> +       dcss_scaler_bit_depth_set(ch, pixel_depth);
> +       dcss_scaler_set_rgb10_order(ch, format);
> +       dcss_scaler_format_set(ch, src_format, dst_format);
> +       dcss_scaler_res_set(ch, src_xres, src_yres, dst_xres, dst_yres,
> +                           pix_format, dst_format);
> +}
> +
> +/* This function will be called from interrupt context. */
> +void dcss_scaler_write_sclctrl(struct dcss_scaler *scl)
> +{
> +       int chnum;
> +
> +       for (chnum = 0; chnum < 3; chnum++) {
> +               struct dcss_scaler_ch *ch = &scl->ch[chnum];
> +
> +               if (ch->scaler_ctrl_chgd) {
> +                       dcss_ctxld_write_irqsafe(scl->ctxld, scl->ctx_id,
> +                                                ch->scaler_ctrl,
> +                                                ch->base_ofs +
> +                                                DCSS_SCALER_CTRL);
> +                       ch->scaler_ctrl_chgd = false;
> +               }
> +       }
> +}
> diff --git a/drivers/gpu/drm/imx/dcss/dcss-ss.c b/drivers/gpu/drm/imx/dcss/dcss-ss.c
> new file mode 100644
> index 00000000..65a05c2
> --- /dev/null
> +++ b/drivers/gpu/drm/imx/dcss/dcss-ss.c
> @@ -0,0 +1,179 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * Copyright 2019 NXP.
> + */
> +
> +#include <linux/device.h>
> +
> +#include "dcss-dev.h"
> +
> +#define DCSS_SS_SYS_CTRL                       0x00
> +#define   RUN_EN                               BIT(0)
> +#define DCSS_SS_DISPLAY                                0x10
> +#define   LRC_X_POS                            0
> +#define   LRC_X_MASK                           GENMASK(12, 0)
> +#define   LRC_Y_POS                            16
> +#define   LRC_Y_MASK                           GENMASK(28, 16)
> +#define DCSS_SS_HSYNC                          0x20
> +#define DCSS_SS_VSYNC                          0x30
> +#define   SYNC_START_POS                       0
> +#define   SYNC_START_MASK                      GENMASK(12, 0)
> +#define   SYNC_END_POS                         16
> +#define   SYNC_END_MASK                                GENMASK(28, 16)
> +#define   SYNC_POL                             BIT(31)
> +#define DCSS_SS_DE_ULC                         0x40
> +#define   ULC_X_POS                            0
> +#define   ULC_X_MASK                           GENMASK(12, 0)
> +#define   ULC_Y_POS                            16
> +#define   ULC_Y_MASK                           GENMASK(28, 16)
> +#define   ULC_POL                              BIT(31)
> +#define DCSS_SS_DE_LRC                         0x50
> +#define DCSS_SS_MODE                           0x60
> +#define   PIPE_MODE_POS                                0
> +#define   PIPE_MODE_MASK                       GENMASK(1, 0)
> +#define DCSS_SS_COEFF                          0x70
> +#define   HORIZ_A_POS                          0
> +#define   HORIZ_A_MASK                         GENMASK(3, 0)
> +#define   HORIZ_B_POS                          4
> +#define   HORIZ_B_MASK                         GENMASK(7, 4)
> +#define   HORIZ_C_POS                          8
> +#define   HORIZ_C_MASK                         GENMASK(11, 8)
> +#define   HORIZ_H_NORM_POS                     12
> +#define   HORIZ_H_NORM_MASK                    GENMASK(14, 12)
> +#define   VERT_A_POS                           16
> +#define   VERT_A_MASK                          GENMASK(19, 16)
> +#define   VERT_B_POS                           20
> +#define   VERT_B_MASK                          GENMASK(23, 20)
> +#define   VERT_C_POS                           24
> +#define   VERT_C_MASK                          GENMASK(27, 24)
> +#define   VERT_H_NORM_POS                      28
> +#define   VERT_H_NORM_MASK                     GENMASK(30, 28)
> +#define DCSS_SS_CLIP_CB                                0x80
> +#define DCSS_SS_CLIP_CR                                0x90
> +#define   CLIP_MIN_POS                         0
> +#define   CLIP_MIN_MASK                                GENMASK(9, 0)
> +#define   CLIP_MAX_POS                         0
> +#define   CLIP_MAX_MASK                                GENMASK(23, 16)
> +#define DCSS_SS_INTER_MODE                     0xA0
> +#define   INT_EN                               BIT(0)
> +#define   VSYNC_SHIFT                          BIT(1)
> +
> +struct dcss_ss {
> +       struct device *dev;
> +       void __iomem *base_reg;
> +       u32 base_ofs;
> +
> +       struct dcss_ctxld *ctxld;
> +       u32 ctx_id;
> +
> +       bool in_use;
> +};
> +
> +static void dcss_ss_write(struct dcss_ss *ss, u32 val, u32 ofs)
> +{
> +       if (!ss->in_use)
> +               dcss_writel(val, ss->base_reg + ofs);
> +
> +       dcss_ctxld_write(ss->ctxld, ss->ctx_id, val,
> +                        ss->base_ofs + ofs);
> +}
> +
> +int dcss_ss_init(struct dcss_dev *dcss, unsigned long ss_base)
> +{
> +       struct dcss_ss *ss;
> +
> +       ss = devm_kzalloc(dcss->dev, sizeof(*ss), GFP_KERNEL);
> +       if (!ss)
> +               return -ENOMEM;
> +
> +       dcss->ss = ss;
> +       ss->dev = dcss->dev;
> +       ss->ctxld = dcss->ctxld;
> +
> +       ss->base_reg = devm_ioremap(dcss->dev, ss_base, SZ_4K);
> +       if (!ss->base_reg) {
> +               dev_err(dcss->dev, "ss: unable to remap ss base\n");
> +               devm_kfree(ss->dev, ss);
> +               return -ENOMEM;
> +       }
> +
> +       ss->base_ofs = ss_base;
> +       ss->ctx_id = CTX_SB_HP;
> +
> +       return 0;
> +}
> +
> +void dcss_ss_exit(struct dcss_ss *ss)
> +{
> +       /* stop SS */
> +       dcss_writel(0, ss->base_reg + DCSS_SS_SYS_CTRL);
> +
> +       if (ss->base_reg)
> +               devm_iounmap(ss->dev, ss->base_reg);
> +
> +       devm_kfree(ss->dev, ss);
> +}
> +
> +void dcss_ss_subsam_set(struct dcss_ss *ss)
> +{
> +       dcss_ss_write(ss, 0x41614161, DCSS_SS_COEFF);
> +       dcss_ss_write(ss, 0, DCSS_SS_MODE);
> +       dcss_ss_write(ss, 0x03ff0000, DCSS_SS_CLIP_CB);
> +       dcss_ss_write(ss, 0x03ff0000, DCSS_SS_CLIP_CR);
> +}
> +
> +void dcss_ss_sync_set(struct dcss_ss *ss, struct videomode *vm,
> +                     bool phsync, bool pvsync)
> +{
> +       u16 lrc_x, lrc_y;
> +       u16 hsync_start, hsync_end;
> +       u16 vsync_start, vsync_end;
> +       u16 de_ulc_x, de_ulc_y;
> +       u16 de_lrc_x, de_lrc_y;
> +
> +       lrc_x = vm->hfront_porch + vm->hback_porch + vm->hsync_len +
> +               vm->hactive - 1;
> +       lrc_y = vm->vfront_porch + vm->vback_porch + vm->vsync_len +
> +               vm->vactive - 1;
> +
> +       dcss_ss_write(ss, (lrc_y << LRC_Y_POS) | lrc_x, DCSS_SS_DISPLAY);
> +
> +       hsync_start = vm->hfront_porch + vm->hback_porch + vm->hsync_len +
> +                     vm->hactive - 1;
> +       hsync_end = vm->hsync_len - 1;
> +
> +       dcss_ss_write(ss, (phsync ? SYNC_POL : 0) |
> +                     ((u32)hsync_end << SYNC_END_POS) | hsync_start,
> +                     DCSS_SS_HSYNC);
> +
> +       vsync_start = vm->vfront_porch - 1;
> +       vsync_end = vm->vfront_porch + vm->vsync_len - 1;
> +
> +       dcss_ss_write(ss, (pvsync ? SYNC_POL : 0) |
> +                     ((u32)vsync_end << SYNC_END_POS) | vsync_start,
> +                     DCSS_SS_VSYNC);
> +
> +       de_ulc_x = vm->hsync_len + vm->hback_porch - 1;
> +       de_ulc_y = vm->vsync_len + vm->vfront_porch + vm->vback_porch;
> +
> +       dcss_ss_write(ss, SYNC_POL | ((u32)de_ulc_y << ULC_Y_POS) | de_ulc_x,
> +                     DCSS_SS_DE_ULC);
> +
> +       de_lrc_x = vm->hsync_len + vm->hback_porch + vm->hactive - 1;
> +       de_lrc_y = vm->vsync_len + vm->vfront_porch + vm->vback_porch +
> +                  vm->vactive - 1;
> +
> +       dcss_ss_write(ss, (de_lrc_y << LRC_Y_POS) | de_lrc_x, DCSS_SS_DE_LRC);
> +}
> +
> +void dcss_ss_enable(struct dcss_ss *ss)
> +{
> +       dcss_ss_write(ss, RUN_EN, DCSS_SS_SYS_CTRL);
> +       ss->in_use = true;
> +}
> +
> +void dcss_ss_disable(struct dcss_ss *ss)
> +{
> +       dcss_ss_write(ss, 0, DCSS_SS_SYS_CTRL);
> +       ss->in_use = false;
> +}

> --
> 2.7.4
>
> _______________________________________________
> dri-devel mailing list
> dri-devel@lists.freedesktop.org
> https://lists.freedesktop.org/mailman/listinfo/dri-devel
Laurentiu Palcu Sept. 24, 2019, 8:03 a.m. UTC | #2
Hi,

On Tue, Sep 24, 2019 at 11:56:07AM +0800, Ying Liu wrote:
> Hi,
> 
> On Mon, Sep 23, 2019 at 10:22 PM Laurentiu Palcu
> <laurentiu.palcu@nxp.com> wrote:
> >
> > This adds initial support for iMX8MQ's Display Controller Subsystem (DCSS).
> > Some of its capabilities include:
> >  * 4K@60fps;
> >  * HDR10;
> >  * one graphics and 2 video pipelines;
> >  * on-the-fly decompression of compressed video and graphics;
> >
> > The reference manual can be found here:
> > https://eur01.safelinks.protection.outlook.com/?url=https%3A%2F%2Fwww.nxp.com%2Fwebapp%2FDownload%3FcolCode%3DIMX8MDQLQRM&amp;data=02%7C01%7Claurentiu.palcu%40nxp.com%7C94b752dadd2e413c70d008d740a32979%7C686ea1d3bc2b4c6fa92cd99c5c301635%7C0%7C0%7C637048941849367464&amp;sdata=rsFNo5MGwdFGTAheU8YrJeRLvThpwbGG9bC9hKxCsm0%3D&amp;reserved=0
> >
> > The current patch adds only basic functionality: one primary plane for
> > graphics, linear, tiled and super-tiled buffers support (no graphics
> > decompression yet), no HDR10 and no video planes.
> >
> > Video planes support and HDR10 will be added in subsequent patches once
> > per-plane de-gamma/CSC/gamma support is in.
> >
> > Signed-off-by: Laurentiu Palcu <laurentiu.palcu@nxp.com>
> > ---
> >  drivers/gpu/drm/imx/Kconfig            |   2 +
> >  drivers/gpu/drm/imx/Makefile           |   1 +
> >  drivers/gpu/drm/imx/dcss/Kconfig       |   7 +
> >  drivers/gpu/drm/imx/dcss/Makefile      |   6 +
> >  drivers/gpu/drm/imx/dcss/dcss-blkctl.c |  75 +++
> >  drivers/gpu/drm/imx/dcss/dcss-crtc.c   | 223 +++++++++
> >  drivers/gpu/drm/imx/dcss/dcss-ctxld.c  | 447 ++++++++++++++++++
> >  drivers/gpu/drm/imx/dcss/dcss-dev.c    | 286 ++++++++++++
> >  drivers/gpu/drm/imx/dcss/dcss-dev.h    | 195 ++++++++
> >  drivers/gpu/drm/imx/dcss/dcss-dpr.c    | 552 ++++++++++++++++++++++
> >  drivers/gpu/drm/imx/dcss/dcss-drv.c    | 182 ++++++++
> >  drivers/gpu/drm/imx/dcss/dcss-dtg.c    | 438 +++++++++++++++++
> >  drivers/gpu/drm/imx/dcss/dcss-kms.c    | 321 +++++++++++++
> >  drivers/gpu/drm/imx/dcss/dcss-kms.h    |  52 +++
> >  drivers/gpu/drm/imx/dcss/dcss-plane.c  | 418 +++++++++++++++++
> >  drivers/gpu/drm/imx/dcss/dcss-scaler.c | 830 +++++++++++++++++++++++++++++++++
> >  drivers/gpu/drm/imx/dcss/dcss-ss.c     | 179 +++++++
> >  17 files changed, 4214 insertions(+)
> >  create mode 100644 drivers/gpu/drm/imx/dcss/Kconfig
> >  create mode 100644 drivers/gpu/drm/imx/dcss/Makefile
> >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-blkctl.c
> >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-crtc.c
> >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-ctxld.c
> >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-dev.c
> >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-dev.h
> >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-dpr.c
> 
> DPR embedded in i.MX8QM & i.MX8QXP SoCs has
> compatible register definitions with the one in i.MX8MQ.
> Together with PRG(Prefetch Resolve Gasket), DPR serves
> the display controller DPU of i.MX8QM & i.MX8QXP SoCs
> as the prefetch engine.  IMHO, there should be a separate
> DPR driver which stands out side of the dcss directory and
> has DT compatible strings for i.MX8MQ, i.MX8QM and
> i.MX8QXP SoCs.

Yes, DPR is pretty much the same for those platforms, register wise.
However, DCSS will do all DPR programming through the context loader
engine (DCSS specific), whereas DPU does not. DPU's DPR can handle VPU
tiled formats, whereas DCSS's does not. For that, DCSS has a DTRC
(decompression and tile to raster conversion) module in front of DPR,
hence the DPR programming needs some adjustments when
tiled/tiled-compressed video buffers are used.

Your idea is great, when it comes to removing some code duplication.
But if, after this process, we end up with an overly complicated piece
of code that needs to address different platform particularities, I'd
prefer to keep things separate. The code will be easier to read and
maintain.

Thanks,
laurentiu


> 
> >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-drv.c
> >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-dtg.c
> >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-kms.c
> >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-kms.h
> >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-plane.c
> >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-scaler.c
> >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-ss.c
> >
> > diff --git a/drivers/gpu/drm/imx/Kconfig b/drivers/gpu/drm/imx/Kconfig
> > index 207bf74..6231048 100644
> > --- a/drivers/gpu/drm/imx/Kconfig
> > +++ b/drivers/gpu/drm/imx/Kconfig
> > @@ -39,3 +39,5 @@ config DRM_IMX_HDMI
> >         depends on DRM_IMX
> >         help
> >           Choose this if you want to use HDMI on i.MX6.
> > +
> > +source "drivers/gpu/drm/imx/dcss/Kconfig"
> > diff --git a/drivers/gpu/drm/imx/Makefile b/drivers/gpu/drm/imx/Makefile
> > index 21cdcc2..b644def 100644
> > --- a/drivers/gpu/drm/imx/Makefile
> > +++ b/drivers/gpu/drm/imx/Makefile
> > @@ -9,3 +9,4 @@ obj-$(CONFIG_DRM_IMX_TVE) += imx-tve.o
> >  obj-$(CONFIG_DRM_IMX_LDB) += imx-ldb.o
> >
> >  obj-$(CONFIG_DRM_IMX_HDMI) += dw_hdmi-imx.o
> > +obj-$(CONFIG_DRM_IMX_DCSS) += dcss/
> > diff --git a/drivers/gpu/drm/imx/dcss/Kconfig b/drivers/gpu/drm/imx/dcss/Kconfig
> > new file mode 100644
> > index 00000000..6399c12
> > --- /dev/null
> > +++ b/drivers/gpu/drm/imx/dcss/Kconfig
> > @@ -0,0 +1,7 @@
> > +config DRM_IMX_DCSS
> > +       tristate "i.MX8MQ DCSS"
> > +       select RESET_CONTROLLER
> > +       select IMX_IRQSTEER
> > +       help
> > +         Choose this if you have a NXP i.MX8MQ based system and want to use the
> > +         Display Controller Subsystem. This option enables DCSS support.
> > diff --git a/drivers/gpu/drm/imx/dcss/Makefile b/drivers/gpu/drm/imx/dcss/Makefile
> > new file mode 100644
> > index 00000000..8c7c8da
> > --- /dev/null
> > +++ b/drivers/gpu/drm/imx/dcss/Makefile
> > @@ -0,0 +1,6 @@
> > +imx-dcss-objs := dcss-drv.o dcss-dev.o dcss-blkctl.o dcss-ctxld.o dcss-dtg.o \
> > +                                dcss-ss.o dcss-dpr.o dcss-scaler.o dcss-kms.o dcss-crtc.o \
> > +                                dcss-plane.o
> > +
> > +obj-$(CONFIG_DRM_IMX_DCSS) += imx-dcss.o
> > +
> > diff --git a/drivers/gpu/drm/imx/dcss/dcss-blkctl.c b/drivers/gpu/drm/imx/dcss/dcss-blkctl.c
> > new file mode 100644
> > index 00000000..ee7ffa1
> > --- /dev/null
> > +++ b/drivers/gpu/drm/imx/dcss/dcss-blkctl.c
> > @@ -0,0 +1,75 @@
> > +// SPDX-License-Identifier: GPL-2.0
> > +/*
> > + * Copyright 2019 NXP.
> > + */
> > +
> > +#include <linux/device.h>
> > +#include <linux/of.h>
> > +
> > +#include "dcss-dev.h"
> > +
> > +#define DCSS_BLKCTL_RESET_CTRL         0x00
> > +#define   B_CLK_RESETN                 BIT(0)
> > +#define   APB_CLK_RESETN               BIT(1)
> > +#define   P_CLK_RESETN                 BIT(2)
> > +#define   RTR_CLK_RESETN               BIT(3)
> > +#define DCSS_BLKCTL_CONTROL0           0x10
> > +#define   HDMI_MIPI_CLK_SEL            BIT(0)
> > +#define   DISPMIX_REFCLK_SEL_POS       4
> > +#define   DISPMIX_REFCLK_SEL_MASK      GENMASK(5, 4)
> > +#define   DISPMIX_PIXCLK_SEL           BIT(8)
> > +#define   HDMI_SRC_SECURE_EN           BIT(16)
> > +
> > +struct dcss_blkctl {
> > +       struct device *dev;
> > +       void __iomem *base_reg;
> > +
> > +       bool hdmi_output;
> > +};
> > +
> > +void dcss_blkctl_cfg(struct dcss_blkctl *blkctl)
> > +{
> > +       if (blkctl->hdmi_output)
> > +               dcss_writel(0, blkctl->base_reg + DCSS_BLKCTL_CONTROL0);
> > +       else
> > +               dcss_writel(DISPMIX_PIXCLK_SEL,
> > +                           blkctl->base_reg + DCSS_BLKCTL_CONTROL0);
> > +
> > +       dcss_set(B_CLK_RESETN | APB_CLK_RESETN | P_CLK_RESETN | RTR_CLK_RESETN,
> > +                blkctl->base_reg + DCSS_BLKCTL_RESET_CTRL);
> > +}
> > +
> > +int dcss_blkctl_init(struct dcss_dev *dcss, unsigned long blkctl_base)
> > +{
> > +       struct dcss_blkctl *blkctl;
> > +
> > +       blkctl = devm_kzalloc(dcss->dev, sizeof(*blkctl), GFP_KERNEL);
> > +       if (!blkctl)
> > +               return -ENOMEM;
> > +
> > +       blkctl->base_reg = devm_ioremap(dcss->dev, blkctl_base, SZ_4K);
> > +       if (!blkctl->base_reg) {
> > +               dev_err(dcss->dev, "unable to remap BLK CTRL base\n");
> > +               devm_kfree(dcss->dev, blkctl);
> > +               return -ENOMEM;
> > +       }
> > +
> > +       dcss->blkctl = blkctl;
> > +       blkctl->dev = dcss->dev;
> > +       blkctl->hdmi_output = dcss->hdmi_output;
> > +
> > +       dcss_blkctl_cfg(blkctl);
> > +
> > +       return 0;
> > +}
> > +
> > +void dcss_blkctl_exit(struct dcss_blkctl *blkctl)
> > +{
> > +       dcss_clr(P_CLK_RESETN | RTR_CLK_RESETN,
> > +                blkctl->base_reg + DCSS_BLKCTL_RESET_CTRL);
> > +
> > +       if (blkctl->base_reg)
> > +               devm_iounmap(blkctl->dev, blkctl->base_reg);
> > +
> > +       devm_kfree(blkctl->dev, blkctl);
> > +}
> > diff --git a/drivers/gpu/drm/imx/dcss/dcss-crtc.c b/drivers/gpu/drm/imx/dcss/dcss-crtc.c
> > new file mode 100644
> > index 00000000..6abb40c
> > --- /dev/null
> > +++ b/drivers/gpu/drm/imx/dcss/dcss-crtc.c
> > @@ -0,0 +1,223 @@
> > +// SPDX-License-Identifier: GPL-2.0
> > +/*
> > + * Copyright 2019 NXP.
> > + */
> > +
> > +#include <drm/drmP.h>
> > +#include <drm/drm_atomic_helper.h>
> > +#include <linux/pm_runtime.h>
> > +
> > +#include "dcss-dev.h"
> > +#include "dcss-kms.h"
> > +
> > +static int dcss_enable_vblank(struct drm_crtc *crtc)
> > +{
> > +       struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
> > +                                                  base);
> > +       struct dcss_dev *dcss = crtc->dev->dev_private;
> > +
> > +       if (dcss_crtc->irq_enabled)
> > +               return 0;
> > +
> > +       dcss_crtc->irq_enabled = true;
> > +
> > +       dcss_dtg_vblank_irq_enable(dcss->dtg, true);
> > +
> > +       dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, true);
> > +
> > +       enable_irq(dcss_crtc->irq);
> > +
> > +       return 0;
> > +}
> > +
> > +static void dcss_disable_vblank(struct drm_crtc *crtc)
> > +{
> > +       struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
> > +                                                  base);
> > +       struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
> > +
> > +       disable_irq_nosync(dcss_crtc->irq);
> > +
> > +       dcss_dtg_vblank_irq_enable(dcss->dtg, false);
> > +
> > +       dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, false);
> > +
> > +       dcss_crtc->irq_enabled = false;
> > +}
> > +
> > +static const struct drm_crtc_funcs dcss_crtc_funcs = {
> > +       .set_config = drm_atomic_helper_set_config,
> > +       .destroy = drm_crtc_cleanup,
> > +       .page_flip = drm_atomic_helper_page_flip,
> > +       .reset = drm_atomic_helper_crtc_reset,
> > +       .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
> > +       .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
> > +       .enable_vblank = dcss_enable_vblank,
> > +       .disable_vblank = dcss_disable_vblank,
> > +};
> > +
> > +static void dcss_crtc_atomic_begin(struct drm_crtc *crtc,
> > +                                  struct drm_crtc_state *old_crtc_state)
> > +{
> > +       drm_crtc_vblank_on(crtc);
> > +
> > +       spin_lock_irq(&crtc->dev->event_lock);
> > +       if (crtc->state->event) {
> > +               WARN_ON(drm_crtc_vblank_get(crtc));
> > +               drm_crtc_arm_vblank_event(crtc, crtc->state->event);
> > +               crtc->state->event = NULL;
> > +       }
> > +       spin_unlock_irq(&crtc->dev->event_lock);
> > +}
> > +
> > +static void dcss_crtc_atomic_flush(struct drm_crtc *crtc,
> > +                                  struct drm_crtc_state *old_crtc_state)
> > +{
> > +       struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
> > +                                                  base);
> > +       struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
> > +
> > +       if (dcss_dtg_is_enabled(dcss->dtg))
> > +               dcss_ctxld_enable(dcss->ctxld);
> > +}
> > +
> > +static void dcss_crtc_atomic_enable(struct drm_crtc *crtc,
> > +                                   struct drm_crtc_state *old_crtc_state)
> > +{
> > +       struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
> > +                                                  base);
> > +       struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
> > +       struct drm_display_mode *mode = &crtc->state->adjusted_mode;
> > +       struct videomode vm;
> > +
> > +       drm_display_mode_to_videomode(mode, &vm);
> > +
> > +       pm_runtime_get_sync(dcss->dev);
> > +
> > +       dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, true);
> > +
> > +       vm.pixelclock = mode->crtc_clock * 1000;
> > +
> > +       dcss_dtg_sync_set(dcss->dtg, &vm);
> > +
> > +       dcss_ss_subsam_set(dcss->ss);
> > +       dcss_ss_sync_set(dcss->ss, &vm, mode->flags & DRM_MODE_FLAG_PHSYNC,
> > +                        mode->flags & DRM_MODE_FLAG_PVSYNC);
> > +
> > +       dcss_dtg_css_set(dcss->dtg);
> > +
> > +       dcss_ss_enable(dcss->ss);
> > +       dcss_dtg_enable(dcss->dtg, true, NULL);
> > +       dcss_ctxld_enable(dcss->ctxld);
> > +
> > +       reinit_completion(&dcss_crtc->en_completion);
> > +       wait_for_completion_timeout(&dcss_crtc->en_completion,
> > +                                   msecs_to_jiffies(500));
> > +}
> > +
> > +static void dcss_crtc_atomic_disable(struct drm_crtc *crtc,
> > +                                    struct drm_crtc_state *old_crtc_state)
> > +{
> > +       struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
> > +                                                  base);
> > +       struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
> > +
> > +       drm_atomic_helper_disable_planes_on_crtc(old_crtc_state, false);
> > +
> > +       spin_lock_irq(&crtc->dev->event_lock);
> > +       if (crtc->state->event) {
> > +               drm_crtc_send_vblank_event(crtc, crtc->state->event);
> > +               crtc->state->event = NULL;
> > +       }
> > +       spin_unlock_irq(&crtc->dev->event_lock);
> > +
> > +       dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, true);
> > +
> > +       dcss_ss_disable(dcss->ss);
> > +       dcss_dtg_enable(dcss->dtg, false, &dcss_crtc->dis_completion);
> > +       dcss_ctxld_enable(dcss->ctxld);
> > +
> > +       reinit_completion(&dcss_crtc->dis_completion);
> > +       wait_for_completion_timeout(&dcss_crtc->dis_completion,
> > +                                   msecs_to_jiffies(100));
> > +
> > +       drm_crtc_vblank_off(crtc);
> > +
> > +       dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, false);
> > +
> > +       pm_runtime_put_sync(dcss->dev);
> > +}
> > +
> > +static const struct drm_crtc_helper_funcs dcss_helper_funcs = {
> > +       .atomic_begin = dcss_crtc_atomic_begin,
> > +       .atomic_flush = dcss_crtc_atomic_flush,
> > +       .atomic_enable = dcss_crtc_atomic_enable,
> > +       .atomic_disable = dcss_crtc_atomic_disable,
> > +};
> > +
> > +static irqreturn_t dcss_crtc_irq_handler(int irq, void *dev_id)
> > +{
> > +       struct dcss_crtc *dcss_crtc = dev_id;
> > +       struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
> > +
> > +       if (!dcss_dtg_vblank_irq_valid(dcss->dtg))
> > +               return IRQ_HANDLED;
> > +
> > +       complete(&dcss_crtc->en_completion);
> > +
> > +       if (dcss_ctxld_is_flushed(dcss->ctxld))
> > +               drm_crtc_handle_vblank(&dcss_crtc->base);
> > +
> > +       dcss_dtg_vblank_irq_clear(dcss->dtg);
> > +
> > +       return IRQ_HANDLED;
> > +}
> > +
> > +int dcss_crtc_init(struct dcss_crtc *crtc, struct drm_device *drm)
> > +{
> > +       struct dcss_dev *dcss = drm->dev_private;
> > +       struct platform_device *pdev = to_platform_device(dcss->dev);
> > +       int ret;
> > +
> > +       crtc->plane[0] = dcss_plane_init(drm, drm_crtc_mask(&crtc->base),
> > +                                        DRM_PLANE_TYPE_PRIMARY, 0);
> > +       if (IS_ERR(crtc->plane[0]))
> > +               return PTR_ERR(crtc->plane[0]);
> > +
> > +       crtc->base.port = dcss->of_port;
> > +
> > +       drm_crtc_helper_add(&crtc->base, &dcss_helper_funcs);
> > +       ret = drm_crtc_init_with_planes(drm, &crtc->base, &crtc->plane[0]->base,
> > +                                       NULL, &dcss_crtc_funcs, NULL);
> > +       if (ret) {
> > +               dev_err(dcss->dev, "failed to init crtc\n");
> > +               return ret;
> > +       }
> > +
> > +       crtc->irq = platform_get_irq_byname(pdev, "vblank");
> > +       if (crtc->irq < 0) {
> > +               dev_err(dcss->dev, "unable to get vblank interrupt\n");
> > +               return crtc->irq;
> > +       }
> > +
> > +       init_completion(&crtc->en_completion);
> > +       init_completion(&crtc->dis_completion);
> > +
> > +       ret = devm_request_irq(dcss->dev, crtc->irq, dcss_crtc_irq_handler,
> > +                              IRQF_TRIGGER_RISING, "dcss_drm", crtc);
> > +       if (ret) {
> > +               dev_err(dcss->dev, "irq request failed with %d.\n", ret);
> > +               return ret;
> > +       }
> > +
> > +       disable_irq(crtc->irq);
> > +
> > +       return 0;
> > +}
> > +
> > +void dcss_crtc_deinit(struct dcss_crtc *crtc, struct drm_device *drm)
> > +{
> > +       struct dcss_dev *dcss = drm->dev_private;
> > +
> > +       devm_free_irq(dcss->dev, crtc->irq, crtc);
> > +}
> > diff --git a/drivers/gpu/drm/imx/dcss/dcss-ctxld.c b/drivers/gpu/drm/imx/dcss/dcss-ctxld.c
> > new file mode 100644
> > index 00000000..4fe35b2b
> > --- /dev/null
> > +++ b/drivers/gpu/drm/imx/dcss/dcss-ctxld.c
> > @@ -0,0 +1,447 @@
> > +// SPDX-License-Identifier: GPL-2.0
> > +/*
> > + * Copyright 2019 NXP.
> > + */
> > +
> > +#include <linux/delay.h>
> > +#include <linux/dma-mapping.h>
> > +#include <linux/interrupt.h>
> > +#include <linux/platform_device.h>
> > +
> > +#include "dcss-dev.h"
> > +
> > +#define DCSS_CTXLD_DEVNAME             "dcss_ctxld"
> > +
> > +#define DCSS_CTXLD_CONTROL_STATUS      0x0
> > +#define   CTXLD_ENABLE                 BIT(0)
> > +#define   ARB_SEL                      BIT(1)
> > +#define   RD_ERR_EN                    BIT(2)
> > +#define   DB_COMP_EN                   BIT(3)
> > +#define   SB_HP_COMP_EN                        BIT(4)
> > +#define   SB_LP_COMP_EN                        BIT(5)
> > +#define   DB_PEND_SB_REC_EN            BIT(6)
> > +#define   SB_PEND_DISP_ACTIVE_EN       BIT(7)
> > +#define   AHB_ERR_EN                   BIT(8)
> > +#define   RD_ERR                       BIT(16)
> > +#define   DB_COMP                      BIT(17)
> > +#define   SB_HP_COMP                   BIT(18)
> > +#define   SB_LP_COMP                   BIT(19)
> > +#define   DB_PEND_SB_REC               BIT(20)
> > +#define   SB_PEND_DISP_ACTIVE          BIT(21)
> > +#define   AHB_ERR                      BIT(22)
> > +#define DCSS_CTXLD_DB_BASE_ADDR                0x10
> > +#define DCSS_CTXLD_DB_COUNT            0x14
> > +#define DCSS_CTXLD_SB_BASE_ADDR                0x18
> > +#define DCSS_CTXLD_SB_COUNT            0x1C
> > +#define   SB_HP_COUNT_POS              0
> > +#define   SB_HP_COUNT_MASK             0xffff
> > +#define   SB_LP_COUNT_POS              16
> > +#define   SB_LP_COUNT_MASK             0xffff0000
> > +#define DCSS_AHB_ERR_ADDR              0x20
> > +
> > +#define CTXLD_IRQ_NAME                 "ctx_ld"
> > +#define CTXLD_IRQ_COMPLETION           (DB_COMP | SB_HP_COMP | SB_LP_COMP)
> > +#define CTXLD_IRQ_ERROR                        (RD_ERR | DB_PEND_SB_REC | AHB_ERR)
> > +
> > +/* The following sizes are in context loader entries, 8 bytes each. */
> > +#define CTXLD_DB_CTX_ENTRIES           1024    /* max 65536 */
> > +#define CTXLD_SB_LP_CTX_ENTRIES                10240   /* max 65536 */
> > +#define CTXLD_SB_HP_CTX_ENTRIES                20000   /* max 65536 */
> > +#define CTXLD_SB_CTX_ENTRIES           (CTXLD_SB_LP_CTX_ENTRIES + \
> > +                                        CTXLD_SB_HP_CTX_ENTRIES)
> > +
> > +/* Sizes, in entries, of the DB, SB_HP and SB_LP context regions. */
> > +static u16 dcss_ctxld_ctx_size[3] = {
> > +       CTXLD_DB_CTX_ENTRIES,
> > +       CTXLD_SB_HP_CTX_ENTRIES,
> > +       CTXLD_SB_LP_CTX_ENTRIES
> > +};
> > +
> > +/* this represents an entry in the context loader map */
> > +struct dcss_ctxld_item {
> > +       u32 val;
> > +       u32 ofs;
> > +};
> > +
> > +#define CTX_ITEM_SIZE                  sizeof(struct dcss_ctxld_item)
> > +
> > +struct dcss_ctxld {
> > +       struct device *dev;
> > +       void __iomem *ctxld_reg;
> > +       int irq;
> > +       bool irq_en;
> > +
> > +       struct dcss_ctxld_item *db[2];
> > +       struct dcss_ctxld_item *sb_hp[2];
> > +       struct dcss_ctxld_item *sb_lp[2];
> > +
> > +       dma_addr_t db_paddr[2];
> > +       dma_addr_t sb_paddr[2];
> > +
> > +       u16 ctx_size[2][3]; /* holds the sizes of DB, SB_HP and SB_LP ctx */
> > +       u8 current_ctx;
> > +
> > +       bool in_use;
> > +       bool armed;
> > +
> > +       spinlock_t lock; /* protects concurent access to private data */
> > +
> > +       void (*dtg_disable_cb)(void *data);
> > +       void *dtg_disable_data;
> > +};
> > +
> > +static int __dcss_ctxld_enable(struct dcss_ctxld *ctxld);
> > +
> > +static irqreturn_t dcss_ctxld_irq_handler(int irq, void *data)
> > +{
> > +       struct dcss_ctxld *ctxld = data;
> > +       u32 irq_status;
> > +
> > +       irq_status = dcss_readl(ctxld->ctxld_reg + DCSS_CTXLD_CONTROL_STATUS);
> > +
> > +       if (irq_status & CTXLD_IRQ_COMPLETION &&
> > +           !(irq_status & CTXLD_ENABLE) && ctxld->in_use) {
> > +               ctxld->in_use = false;
> > +
> > +               if (ctxld->dtg_disable_cb) {
> > +                       ctxld->dtg_disable_cb(ctxld->dtg_disable_data);
> > +                       ctxld->dtg_disable_cb = NULL;
> > +                       ctxld->dtg_disable_data = NULL;
> > +               }
> > +       } else if (irq_status & CTXLD_IRQ_ERROR) {
> > +               /*
> > +                * Except for throwing an error message and clearing the status
> > +                * register, there's not much we can do here.
> > +                */
> > +               dev_err(ctxld->dev, "ctxld: error encountered: %08x\n",
> > +                       irq_status);
> > +               dev_err(ctxld->dev, "ctxld: db=%d, sb_hp=%d, sb_lp=%d\n",
> > +                       ctxld->ctx_size[ctxld->current_ctx ^ 1][CTX_DB],
> > +                       ctxld->ctx_size[ctxld->current_ctx ^ 1][CTX_SB_HP],
> > +                       ctxld->ctx_size[ctxld->current_ctx ^ 1][CTX_SB_LP]);
> > +       }
> > +
> > +       dcss_clr(irq_status & (CTXLD_IRQ_ERROR | CTXLD_IRQ_COMPLETION),
> > +                ctxld->ctxld_reg + DCSS_CTXLD_CONTROL_STATUS);
> > +
> > +       return IRQ_HANDLED;
> > +}
> > +
> > +static int dcss_ctxld_irq_config(struct dcss_ctxld *ctxld,
> > +                                struct platform_device *pdev)
> > +{
> > +       int ret;
> > +
> > +       ctxld->irq = platform_get_irq_byname(pdev, CTXLD_IRQ_NAME);
> > +       if (ctxld->irq < 0) {
> > +               dev_err(ctxld->dev, "ctxld: can't get irq number\n");
> > +               return ctxld->irq;
> > +       }
> > +
> > +       ret = devm_request_irq(ctxld->dev, ctxld->irq,
> > +                              dcss_ctxld_irq_handler,
> > +                              IRQF_ONESHOT | IRQF_TRIGGER_HIGH,
> > +                              DCSS_CTXLD_DEVNAME, ctxld);
> > +       if (ret) {
> > +               dev_err(ctxld->dev, "ctxld: irq request failed.\n");
> > +               return ret;
> > +       }
> > +
> > +       ctxld->irq_en = true;
> > +
> > +       return 0;
> > +}
> > +
> > +void dcss_ctxld_hw_cfg(struct dcss_ctxld *ctxld)
> > +{
> > +       dcss_writel(RD_ERR_EN | SB_HP_COMP_EN |
> > +                   DB_PEND_SB_REC_EN | AHB_ERR_EN | RD_ERR | AHB_ERR,
> > +                   ctxld->ctxld_reg + DCSS_CTXLD_CONTROL_STATUS);
> > +}
> > +
> > +static void dcss_ctxld_free_ctx(struct dcss_ctxld *ctxld)
> > +{
> > +       struct dcss_ctxld_item *ctx;
> > +       int i;
> > +
> > +       for (i = 0; i < 2; i++) {
> > +               if (ctxld->db[i]) {
> > +                       dmam_free_coherent(ctxld->dev,
> > +                                          CTXLD_DB_CTX_ENTRIES * sizeof(*ctx),
> > +                                          ctxld->db[i], ctxld->db_paddr[i]);
> > +                       ctxld->db[i] = NULL;
> > +                       ctxld->db_paddr[i] = 0;
> > +               }
> > +
> > +               if (ctxld->sb_hp[i]) {
> > +                       dmam_free_coherent(ctxld->dev,
> > +                                          CTXLD_SB_CTX_ENTRIES * sizeof(*ctx),
> > +                                          ctxld->sb_hp[i], ctxld->sb_paddr[i]);
> > +                       ctxld->sb_hp[i] = NULL;
> > +                       ctxld->sb_paddr[i] = 0;
> > +               }
> > +       }
> > +}
> > +
> > +static int dcss_ctxld_alloc_ctx(struct dcss_ctxld *ctxld)
> > +{
> > +       struct dcss_ctxld_item *ctx;
> > +       int i;
> > +       dma_addr_t dma_handle;
> > +
> > +       for (i = 0; i < 2; i++) {
> > +               ctx = dmam_alloc_coherent(ctxld->dev,
> > +                                         CTXLD_DB_CTX_ENTRIES * sizeof(*ctx),
> > +                                         &dma_handle, GFP_KERNEL);
> > +               if (!ctx)
> > +                       return -ENOMEM;
> > +
> > +               ctxld->db[i] = ctx;
> > +               ctxld->db_paddr[i] = dma_handle;
> > +
> > +               ctx = dmam_alloc_coherent(ctxld->dev,
> > +                                         CTXLD_SB_CTX_ENTRIES * sizeof(*ctx),
> > +                                         &dma_handle, GFP_KERNEL);
> > +               if (!ctx)
> > +                       return -ENOMEM;
> > +
> > +               ctxld->sb_hp[i] = ctx;
> > +               ctxld->sb_lp[i] = ctx + CTXLD_SB_HP_CTX_ENTRIES;
> > +
> > +               ctxld->sb_paddr[i] = dma_handle;
> > +       }
> > +
> > +       return 0;
> > +}
> > +
> > +int dcss_ctxld_init(struct dcss_dev *dcss, unsigned long ctxld_base)
> > +{
> > +       struct dcss_ctxld *ctxld;
> > +       int ret;
> > +
> > +       ctxld = devm_kzalloc(dcss->dev, sizeof(struct dcss_ctxld),
> > +                            GFP_KERNEL);
> > +       if (!ctxld)
> > +               return -ENOMEM;
> > +
> > +       dcss->ctxld = ctxld;
> > +       ctxld->dev = dcss->dev;
> > +
> > +       spin_lock_init(&ctxld->lock);
> > +
> > +       ret = dcss_ctxld_alloc_ctx(ctxld);
> > +       if (ret) {
> > +               dev_err(dcss->dev, "ctxld: cannot allocate context memory.\n");
> > +               goto err;
> > +       }
> > +
> > +       ctxld->ctxld_reg = devm_ioremap(dcss->dev, ctxld_base, SZ_4K);
> > +       if (!ctxld->ctxld_reg) {
> > +               dev_err(dcss->dev, "ctxld: unable to remap ctxld base\n");
> > +               ret = -ENOMEM;
> > +               goto err;
> > +       }
> > +
> > +       ret = dcss_ctxld_irq_config(ctxld, to_platform_device(dcss->dev));
> > +       if (ret)
> > +               goto err_irq;
> > +
> > +       dcss_ctxld_hw_cfg(ctxld);
> > +
> > +       return 0;
> > +
> > +err_irq:
> > +       devm_iounmap(ctxld->dev, ctxld->ctxld_reg);
> > +
> > +err:
> > +       dcss_ctxld_free_ctx(ctxld);
> > +       devm_kfree(ctxld->dev, ctxld);
> > +
> > +       return ret;
> > +}
> > +
> > +void dcss_ctxld_exit(struct dcss_ctxld *ctxld)
> > +{
> > +       devm_free_irq(ctxld->dev, ctxld->irq, ctxld);
> > +
> > +       if (ctxld->ctxld_reg)
> > +               devm_iounmap(ctxld->dev, ctxld->ctxld_reg);
> > +
> > +       dcss_ctxld_free_ctx(ctxld);
> > +       devm_kfree(ctxld->dev, ctxld);
> > +}
> > +
> > +static int __dcss_ctxld_enable(struct dcss_ctxld *ctxld)
> > +{
> > +       int curr_ctx = ctxld->current_ctx;
> > +       u32 db_base, sb_base, sb_count;
> > +       u32 sb_hp_cnt, sb_lp_cnt, db_cnt;
> > +       struct dcss_dev *dcss = dcss_drv_dev_to_dcss(ctxld->dev);
> > +
> > +       dcss_dpr_write_sysctrl(dcss->dpr);
> > +
> > +       dcss_scaler_write_sclctrl(dcss->scaler);
> > +
> > +       sb_hp_cnt = ctxld->ctx_size[curr_ctx][CTX_SB_HP];
> > +       sb_lp_cnt = ctxld->ctx_size[curr_ctx][CTX_SB_LP];
> > +       db_cnt = ctxld->ctx_size[curr_ctx][CTX_DB];
> > +
> > +       /* make sure SB_LP context area comes after SB_HP */
> > +       if (sb_lp_cnt &&
> > +           ctxld->sb_lp[curr_ctx] != ctxld->sb_hp[curr_ctx] + sb_hp_cnt) {
> > +               struct dcss_ctxld_item *sb_lp_adjusted;
> > +
> > +               sb_lp_adjusted = ctxld->sb_hp[curr_ctx] + sb_hp_cnt;
> > +
> > +               memcpy(sb_lp_adjusted, ctxld->sb_lp[curr_ctx],
> > +                      sb_lp_cnt * CTX_ITEM_SIZE);
> > +       }
> > +
> > +       db_base = db_cnt ? ctxld->db_paddr[curr_ctx] : 0;
> > +
> > +       dcss_writel(db_base, ctxld->ctxld_reg + DCSS_CTXLD_DB_BASE_ADDR);
> > +       dcss_writel(db_cnt, ctxld->ctxld_reg + DCSS_CTXLD_DB_COUNT);
> > +
> > +       if (sb_hp_cnt)
> > +               sb_count = ((sb_hp_cnt << SB_HP_COUNT_POS) & SB_HP_COUNT_MASK) |
> > +                          ((sb_lp_cnt << SB_LP_COUNT_POS) & SB_LP_COUNT_MASK);
> > +       else
> > +               sb_count = (sb_lp_cnt << SB_HP_COUNT_POS) & SB_HP_COUNT_MASK;
> > +
> > +       sb_base = sb_count ? ctxld->sb_paddr[curr_ctx] : 0;
> > +
> > +       dcss_writel(sb_base, ctxld->ctxld_reg + DCSS_CTXLD_SB_BASE_ADDR);
> > +       dcss_writel(sb_count, ctxld->ctxld_reg + DCSS_CTXLD_SB_COUNT);
> > +
> > +       /* enable the context loader */
> > +       dcss_set(CTXLD_ENABLE, ctxld->ctxld_reg + DCSS_CTXLD_CONTROL_STATUS);
> > +
> > +       ctxld->in_use = true;
> > +
> > +       /*
> > +        * Toggle the current context to the alternate one so that any updates
> > +        * in the modules' settings take place there.
> > +        */
> > +       ctxld->current_ctx ^= 1;
> > +
> > +       ctxld->ctx_size[ctxld->current_ctx][CTX_DB] = 0;
> > +       ctxld->ctx_size[ctxld->current_ctx][CTX_SB_HP] = 0;
> > +       ctxld->ctx_size[ctxld->current_ctx][CTX_SB_LP] = 0;
> > +
> > +       return 0;
> > +}
> > +
> > +int dcss_ctxld_enable(struct dcss_ctxld *ctxld)
> > +{
> > +       unsigned long flags;
> > +
> > +       spin_lock_irqsave(&ctxld->lock, flags);
> > +       ctxld->armed = true;
> > +       spin_unlock_irqrestore(&ctxld->lock, flags);
> > +
> > +       return 0;
> > +}
> > +
> > +void dcss_ctxld_kick(struct dcss_ctxld *ctxld)
> > +{
> > +       unsigned long flags;
> > +
> > +       spin_lock_irqsave(&ctxld->lock, flags);
> > +       if (ctxld->armed && !ctxld->in_use) {
> > +               ctxld->armed = false;
> > +               __dcss_ctxld_enable(ctxld);
> > +       }
> > +       spin_unlock_irqrestore(&ctxld->lock, flags);
> > +}
> > +
> > +void dcss_ctxld_write_irqsafe(struct dcss_ctxld *ctxld, u32 ctx_id, u32 val,
> > +                             u32 reg_ofs)
> > +{
> > +       int curr_ctx = ctxld->current_ctx;
> > +       struct dcss_ctxld_item *ctx[] = {
> > +               [CTX_DB] = ctxld->db[curr_ctx],
> > +               [CTX_SB_HP] = ctxld->sb_hp[curr_ctx],
> > +               [CTX_SB_LP] = ctxld->sb_lp[curr_ctx]
> > +       };
> > +       int item_idx = ctxld->ctx_size[curr_ctx][ctx_id];
> > +
> > +       if (item_idx + 1 > dcss_ctxld_ctx_size[ctx_id]) {
> > +               WARN_ON(1);
> > +               return;
> > +       }
> > +
> > +       ctx[ctx_id][item_idx].val = val;
> > +       ctx[ctx_id][item_idx].ofs = reg_ofs;
> > +       ctxld->ctx_size[curr_ctx][ctx_id] += 1;
> > +}
> > +
> > +void dcss_ctxld_write(struct dcss_ctxld *ctxld, u32 ctx_id,
> > +                     u32 val, u32 reg_ofs)
> > +{
> > +       unsigned long flags;
> > +
> > +       spin_lock_irqsave(&ctxld->lock, flags);
> > +       dcss_ctxld_write_irqsafe(ctxld, ctx_id, val, reg_ofs);
> > +       spin_unlock_irqrestore(&ctxld->lock, flags);
> > +}
> > +
> > +bool dcss_ctxld_is_flushed(struct dcss_ctxld *ctxld)
> > +{
> > +       return ctxld->ctx_size[ctxld->current_ctx][CTX_DB] == 0 &&
> > +               ctxld->ctx_size[ctxld->current_ctx][CTX_SB_HP] == 0 &&
> > +               ctxld->ctx_size[ctxld->current_ctx][CTX_SB_LP] == 0;
> > +}
> > +
> > +int dcss_ctxld_resume(struct dcss_ctxld *ctxld)
> > +{
> > +       dcss_ctxld_hw_cfg(ctxld);
> > +
> > +       if (!ctxld->irq_en) {
> > +               enable_irq(ctxld->irq);
> > +               ctxld->irq_en = true;
> > +       }
> > +
> > +       return 0;
> > +}
> > +
> > +int dcss_ctxld_suspend(struct dcss_ctxld *ctxld)
> > +{
> > +       int ret = 0;
> > +       int wait_time_ms = 0;
> > +       unsigned long flags;
> > +
> > +       dcss_ctxld_kick(ctxld);
> > +
> > +       while (ctxld->in_use && wait_time_ms < 500) {
> > +               msleep(20);
> > +               wait_time_ms += 20;
> > +       }
> > +
> > +       if (wait_time_ms > 500)
> > +               return -ETIMEDOUT;
> > +
> > +       spin_lock_irqsave(&ctxld->lock, flags);
> > +
> > +       if (ctxld->irq_en) {
> > +               disable_irq_nosync(ctxld->irq);
> > +               ctxld->irq_en = false;
> > +       }
> > +
> > +       /* reset context region and sizes */
> > +       ctxld->current_ctx = 0;
> > +       ctxld->ctx_size[0][CTX_DB] = 0;
> > +       ctxld->ctx_size[0][CTX_SB_HP] = 0;
> > +       ctxld->ctx_size[0][CTX_SB_LP] = 0;
> > +
> > +       spin_unlock_irqrestore(&ctxld->lock, flags);
> > +
> > +       return ret;
> > +}
> > +
> > +void dcss_ctxld_register_dtg_disable_cb(struct dcss_ctxld *ctxld,
> > +                                       void (*cb)(void *),
> > +                                       void *data)
> > +{
> > +       ctxld->dtg_disable_cb = cb;
> > +       ctxld->dtg_disable_data = data;
> > +}
> > diff --git a/drivers/gpu/drm/imx/dcss/dcss-dev.c b/drivers/gpu/drm/imx/dcss/dcss-dev.c
> > new file mode 100644
> > index 00000000..265bf3c
> > --- /dev/null
> > +++ b/drivers/gpu/drm/imx/dcss/dcss-dev.c
> > @@ -0,0 +1,286 @@
> > +// SPDX-License-Identifier: GPL-2.0
> > +/*
> > + * Copyright 2019 NXP.
> > + */
> > +
> > +#include <linux/clk.h>
> > +#include <linux/of_device.h>
> > +#include <linux/of_graph.h>
> > +#include <linux/pm_runtime.h>
> > +#include <drm/drm_modeset_helper.h>
> > +
> > +#include "dcss-dev.h"
> > +
> > +static void dcss_clocks_enable(struct dcss_dev *dcss)
> > +{
> > +       if (dcss->clks_on)
> > +               return;
> > +
> > +       clk_prepare_enable(dcss->axi_clk);
> > +       clk_prepare_enable(dcss->apb_clk);
> > +       clk_prepare_enable(dcss->rtrm_clk);
> > +       clk_prepare_enable(dcss->dtrc_clk);
> > +       clk_prepare_enable(dcss->pix_clk);
> > +
> > +       dcss->clks_on = true;
> > +}
> > +
> > +static void dcss_clocks_disable(struct dcss_dev *dcss)
> > +{
> > +       if (!dcss->clks_on)
> > +               return;
> > +
> > +       clk_disable_unprepare(dcss->pix_clk);
> > +       clk_disable_unprepare(dcss->dtrc_clk);
> > +       clk_disable_unprepare(dcss->rtrm_clk);
> > +       clk_disable_unprepare(dcss->apb_clk);
> > +       clk_disable_unprepare(dcss->axi_clk);
> > +
> > +       dcss->clks_on = false;
> > +}
> > +
> > +static int dcss_submodules_init(struct dcss_dev *dcss)
> > +{
> > +       int ret = 0;
> > +       u32 base_addr = dcss->start_addr;
> > +       const struct dcss_type_data *devtype = dcss->devtype;
> > +
> > +       dcss_clocks_enable(dcss);
> > +
> > +       ret = dcss_blkctl_init(dcss, base_addr + devtype->blkctl_ofs);
> > +       if (ret)
> > +               return ret;
> > +
> > +       ret = dcss_ctxld_init(dcss, base_addr + devtype->ctxld_ofs);
> > +       if (ret)
> > +               goto ctxld_err;
> > +
> > +       ret = dcss_dtg_init(dcss, base_addr + devtype->dtg_ofs);
> > +       if (ret)
> > +               goto dtg_err;
> > +
> > +       ret = dcss_ss_init(dcss, base_addr + devtype->ss_ofs);
> > +       if (ret)
> > +               goto ss_err;
> > +
> > +       ret = dcss_dpr_init(dcss, base_addr + devtype->dpr_ofs);
> > +       if (ret)
> > +               goto dpr_err;
> > +
> > +       ret = dcss_scaler_init(dcss, base_addr + devtype->scaler_ofs);
> > +       if (ret)
> > +               goto scaler_err;
> > +
> > +       return 0;
> > +
> > +scaler_err:
> > +       dcss_dpr_exit(dcss->dpr);
> > +
> > +dpr_err:
> > +       dcss_ss_exit(dcss->ss);
> > +
> > +ss_err:
> > +       dcss_dtg_exit(dcss->dtg);
> > +
> > +dtg_err:
> > +       dcss_ctxld_exit(dcss->ctxld);
> > +
> > +ctxld_err:
> > +       dcss_blkctl_exit(dcss->blkctl);
> > +
> > +       dcss_clocks_disable(dcss);
> > +
> > +       return ret;
> > +}
> > +
> > +static void dcss_submodules_stop(struct dcss_dev *dcss)
> > +{
> > +       dcss_clocks_enable(dcss);
> > +       dcss_scaler_exit(dcss->scaler);
> > +       dcss_dpr_exit(dcss->dpr);
> > +       dcss_ss_exit(dcss->ss);
> > +       dcss_dtg_exit(dcss->dtg);
> > +       dcss_ctxld_exit(dcss->ctxld);
> > +       dcss_blkctl_exit(dcss->blkctl);
> > +       dcss_clocks_disable(dcss);
> > +}
> > +
> > +static int dcss_clks_init(struct dcss_dev *dcss)
> > +{
> > +       int i;
> > +       struct {
> > +               const char *id;
> > +               struct clk **clk;
> > +       } clks[] = {
> > +               {"apb",   &dcss->apb_clk},
> > +               {"axi",   &dcss->axi_clk},
> > +               {"pix",   &dcss->pix_clk},
> > +               {"rtrm",  &dcss->rtrm_clk},
> > +               {"dtrc",  &dcss->dtrc_clk},
> > +       };
> > +
> > +       for (i = 0; i < ARRAY_SIZE(clks); i++) {
> > +               *clks[i].clk = devm_clk_get(dcss->dev, clks[i].id);
> > +               if (IS_ERR(*clks[i].clk)) {
> > +                       dev_err(dcss->dev, "failed to get %s clock\n",
> > +                               clks[i].id);
> > +                       return PTR_ERR(*clks[i].clk);
> > +               }
> > +       }
> > +
> > +       dcss->clks_on = false;
> > +
> > +       return 0;
> > +}
> > +
> > +static void dcss_clks_release(struct dcss_dev *dcss)
> > +{
> > +       devm_clk_put(dcss->dev, dcss->dtrc_clk);
> > +       devm_clk_put(dcss->dev, dcss->rtrm_clk);
> > +       devm_clk_put(dcss->dev, dcss->pix_clk);
> > +       devm_clk_put(dcss->dev, dcss->axi_clk);
> > +       devm_clk_put(dcss->dev, dcss->apb_clk);
> > +}
> > +
> > +struct dcss_dev *dcss_dev_create(struct device *dev, bool hdmi_output)
> > +{
> > +       struct platform_device *pdev = to_platform_device(dev);
> > +       int ret;
> > +       struct resource *res;
> > +       struct dcss_dev *dcss;
> > +       const struct dcss_type_data *devtype;
> > +
> > +       devtype = of_device_get_match_data(dev);
> > +       if (!devtype) {
> > +               dev_err(dev, "no device match found\n");
> > +               return ERR_PTR(-ENODEV);
> > +       }
> > +
> > +       res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
> > +       if (!res) {
> > +               dev_err(dev, "cannot get memory resource\n");
> > +               return ERR_PTR(-EINVAL);
> > +       }
> > +
> > +       dcss = devm_kzalloc(dev, sizeof(struct dcss_dev), GFP_KERNEL);
> > +       if (!dcss)
> > +               return ERR_PTR(-ENOMEM);
> > +
> > +       dcss->dev = dev;
> > +       dcss->devtype = devtype;
> > +       dcss->hdmi_output = hdmi_output;
> > +
> > +       ret = dcss_clks_init(dcss);
> > +       if (ret) {
> > +               dev_err(dev, "clocks initialization failed\n");
> > +               goto err;
> > +       }
> > +
> > +       dcss->of_port = of_graph_get_port_by_id(dev->of_node, 0);
> > +       if (!dcss->of_port) {
> > +               dev_err(dev, "no port@0 node in %s\n", dev->of_node->full_name);
> > +               ret = -ENODEV;
> > +               goto clks_err;
> > +       }
> > +
> > +       dcss->start_addr = res->start;
> > +
> > +       ret = dcss_submodules_init(dcss);
> > +       if (ret) {
> > +               dev_err(dev, "submodules initialization failed\n");
> > +               goto clks_err;
> > +       }
> > +
> > +       pm_runtime_enable(dev);
> > +
> > +       return dcss;
> > +
> > +clks_err:
> > +       dcss_clks_release(dcss);
> > +
> > +err:
> > +       devm_kfree(dcss->dev, dcss);
> > +
> > +       return ERR_PTR(ret);
> > +}
> > +
> > +void dcss_dev_destroy(struct dcss_dev *dcss)
> > +{
> > +       pm_runtime_disable(dcss->dev);
> > +
> > +       dcss_submodules_stop(dcss);
> > +
> > +       dcss_clks_release(dcss);
> > +
> > +       devm_kfree(dcss->dev, dcss);
> > +}
> > +
> > +#ifdef CONFIG_PM_SLEEP
> > +int dcss_dev_suspend(struct device *dev)
> > +{
> > +       struct dcss_dev *dcss = dcss_drv_dev_to_dcss(dev);
> > +       int ret;
> > +
> > +       drm_mode_config_helper_suspend(dcss_drv_dev_to_drm(dev));
> > +
> > +       if (pm_runtime_suspended(dev))
> > +               return 0;
> > +
> > +       ret = dcss_ctxld_suspend(dcss->ctxld);
> > +       if (ret)
> > +               return ret;
> > +
> > +       dcss_clocks_disable(dcss);
> > +
> > +       return 0;
> > +}
> > +
> > +int dcss_dev_resume(struct device *dev)
> > +{
> > +       struct dcss_dev *dcss = dcss_drv_dev_to_dcss(dev);
> > +
> > +       if (pm_runtime_suspended(dev)) {
> > +               drm_mode_config_helper_resume(dcss_drv_dev_to_drm(dev));
> > +               return 0;
> > +       }
> > +
> > +       dcss_clocks_enable(dcss);
> > +
> > +       dcss_blkctl_cfg(dcss->blkctl);
> > +
> > +       dcss_ctxld_resume(dcss->ctxld);
> > +
> > +       drm_mode_config_helper_resume(dcss_drv_dev_to_drm(dev));
> > +
> > +       return 0;
> > +}
> > +#endif /* CONFIG_PM_SLEEP */
> > +
> > +#ifdef CONFIG_PM
> > +int dcss_dev_runtime_suspend(struct device *dev)
> > +{
> > +       struct dcss_dev *dcss = dcss_drv_dev_to_dcss(dev);
> > +       int ret;
> > +
> > +       ret = dcss_ctxld_suspend(dcss->ctxld);
> > +       if (ret)
> > +               return ret;
> > +
> > +       dcss_clocks_disable(dcss);
> > +
> > +       return 0;
> > +}
> > +
> > +int dcss_dev_runtime_resume(struct device *dev)
> > +{
> > +       struct dcss_dev *dcss = dcss_drv_dev_to_dcss(dev);
> > +
> > +       dcss_clocks_enable(dcss);
> > +
> > +       dcss_blkctl_cfg(dcss->blkctl);
> > +
> > +       dcss_ctxld_resume(dcss->ctxld);
> > +
> > +       return 0;
> > +}
> > +#endif /* CONFIG_PM */
> > diff --git a/drivers/gpu/drm/imx/dcss/dcss-dev.h b/drivers/gpu/drm/imx/dcss/dcss-dev.h
> > new file mode 100644
> > index 00000000..15c5de3
> > --- /dev/null
> > +++ b/drivers/gpu/drm/imx/dcss/dcss-dev.h
> > @@ -0,0 +1,195 @@
> > +/* SPDX-License-Identifier: GPL-2.0 */
> > +/*
> > + * Copyright 2019 NXP.
> > + */
> > +
> > +#ifndef __DCSS_PRV_H__
> > +#define __DCSS_PRV_H__
> > +
> > +#include <drm/drm_fourcc.h>
> > +#include <linux/io.h>
> > +#include <video/videomode.h>
> > +
> > +#define SET                    0x04
> > +#define CLR                    0x08
> > +#define TGL                    0x0C
> > +
> > +#define dcss_writel(v, c)      writel((v), (c))
> > +#define dcss_readl(c)          readl(c)
> > +#define dcss_set(v, c)         writel((v), (c) + SET)
> > +#define dcss_clr(v, c)         writel((v), (c) + CLR)
> > +#define dcss_toggle(v, c)      writel((v), (c) + TGL)
> > +
> > +static inline void dcss_update(u32 v, u32 m, void __iomem *c)
> > +{
> > +       writel((readl(c) & ~(m)) | (v), (c));
> > +}
> > +
> > +#define DCSS_DBG_REG(reg)      {.name = #reg, .ofs = reg}
> > +
> > +enum {
> > +       DCSS_IMX8MQ = 0,
> > +};
> > +
> > +struct dcss_type_data {
> > +       const char *name;
> > +       u32 blkctl_ofs;
> > +       u32 ctxld_ofs;
> > +       u32 rdsrc_ofs;
> > +       u32 wrscl_ofs;
> > +       u32 dtg_ofs;
> > +       u32 scaler_ofs;
> > +       u32 ss_ofs;
> > +       u32 dpr_ofs;
> > +       u32 dtrc_ofs;
> > +       u32 dec400d_ofs;
> > +       u32 hdr10_ofs;
> > +};
> > +
> > +struct dcss_debug_reg {
> > +       char *name;
> > +       u32 ofs;
> > +};
> > +
> > +enum dcss_ctxld_ctx_type {
> > +       CTX_DB,
> > +       CTX_SB_HP, /* high-priority */
> > +       CTX_SB_LP, /* low-priority  */
> > +};
> > +
> > +struct dcss_dev {
> > +       struct device *dev;
> > +       const struct dcss_type_data *devtype;
> > +       struct device_node *of_port;
> > +
> > +       u32 start_addr;
> > +
> > +       struct dcss_blkctl *blkctl;
> > +       struct dcss_ctxld *ctxld;
> > +       struct dcss_dpr *dpr;
> > +       struct dcss_dtg *dtg;
> > +       struct dcss_ss *ss;
> > +       struct dcss_hdr10 *hdr10;
> > +       struct dcss_scaler *scaler;
> > +       struct dcss_dtrc *dtrc;
> > +       struct dcss_dec400d *dec400d;
> > +       struct dcss_wrscl *wrscl;
> > +       struct dcss_rdsrc *rdsrc;
> > +
> > +       struct clk *apb_clk;
> > +       struct clk *axi_clk;
> > +       struct clk *pix_clk;
> > +       struct clk *rtrm_clk;
> > +       struct clk *dtrc_clk;
> > +       struct clk *pll_src_clk;
> > +       struct clk *pll_phy_ref_clk;
> > +
> > +       void (*dcss_disable_callback)(void *data);
> > +
> > +       bool clks_on;
> > +       bool hdmi_output;
> > +};
> > +
> > +enum dcss_color_space {
> > +       DCSS_COLORSPACE_RGB,
> > +       DCSS_COLORSPACE_YUV,
> > +       DCSS_COLORSPACE_UNKNOWN,
> > +};
> > +
> > +struct dcss_dev *dcss_drv_dev_to_dcss(struct device *dev);
> > +struct drm_device *dcss_drv_dev_to_drm(struct device *dev);
> > +struct dcss_dev *dcss_dev_create(struct device *dev, bool mipi_output);
> > +void dcss_dev_destroy(struct dcss_dev *dcss);
> > +int dcss_dev_runtime_suspend(struct device *dev);
> > +int dcss_dev_runtime_resume(struct device *dev);
> > +int dcss_dev_suspend(struct device *dev);
> > +int dcss_dev_resume(struct device *dev);
> > +
> > +/* BLKCTL */
> > +int dcss_blkctl_init(struct dcss_dev *dcss, unsigned long blkctl_base);
> > +void dcss_blkctl_cfg(struct dcss_blkctl *blkctl);
> > +void dcss_blkctl_exit(struct dcss_blkctl *blkctl);
> > +
> > +/* CTXLD */
> > +int dcss_ctxld_init(struct dcss_dev *dcss, unsigned long ctxld_base);
> > +void dcss_ctxld_exit(struct dcss_ctxld *ctxld);
> > +void dcss_ctxld_write(struct dcss_ctxld *ctxld, u32 ctx_id,
> > +                     u32 val, u32 reg_idx);
> > +int dcss_ctxld_resume(struct dcss_ctxld *dcss_ctxld);
> > +int dcss_ctxld_suspend(struct dcss_ctxld *dcss_ctxld);
> > +void dcss_ctxld_write_irqsafe(struct dcss_ctxld *ctlxd, u32 ctx_id, u32 val,
> > +                             u32 reg_ofs);
> > +void dcss_ctxld_kick(struct dcss_ctxld *ctxld);
> > +bool dcss_ctxld_is_flushed(struct dcss_ctxld *ctxld);
> > +int dcss_ctxld_enable(struct dcss_ctxld *ctxld);
> > +void dcss_ctxld_register_dtg_disable_cb(struct dcss_ctxld *ctxld,
> > +                                       void (*cb)(void *),
> > +                                       void *data);
> > +
> > +/* DPR */
> > +enum dcss_tile_type {
> > +       TILE_LINEAR = 0,
> > +       TILE_GPU_STANDARD,
> > +       TILE_GPU_SUPER,
> > +       TILE_VPU_YUV420,
> > +       TILE_VPU_VP9,
> > +};
> > +
> > +enum dcss_pix_size {
> > +       PIX_SIZE_8,
> > +       PIX_SIZE_16,
> > +       PIX_SIZE_32,
> > +};
> > +
> > +int dcss_dpr_init(struct dcss_dev *dcss, unsigned long dpr_base);
> > +void dcss_dpr_exit(struct dcss_dpr *dpr);
> > +void dcss_dpr_write_sysctrl(struct dcss_dpr *dpr);
> > +void dcss_dpr_set_res(struct dcss_dpr *dpr, int ch_num, u32 xres, u32 yres);
> > +void dcss_dpr_addr_set(struct dcss_dpr *dpr, int ch_num, u32 luma_base_addr,
> > +                      u32 chroma_base_addr, u16 pitch);
> > +void dcss_dpr_enable(struct dcss_dpr *dpr, int ch_num, bool en);
> > +void dcss_dpr_format_set(struct dcss_dpr *dpr, int ch_num,
> > +                        const struct drm_format_info *format, u64 modifier);
> > +void dcss_dpr_set_rotation(struct dcss_dpr *dpr, int ch_num, u32 rotation);
> > +
> > +/* DTG */
> > +int dcss_dtg_init(struct dcss_dev *dcss, unsigned long dtg_base);
> > +void dcss_dtg_exit(struct dcss_dtg *dtg);
> > +bool dcss_dtg_vblank_irq_valid(struct dcss_dtg *dtg);
> > +void dcss_dtg_vblank_irq_enable(struct dcss_dtg *dtg, bool en);
> > +void dcss_dtg_vblank_irq_clear(struct dcss_dtg *dtg);
> > +void dcss_dtg_sync_set(struct dcss_dtg *dtg, struct videomode *vm);
> > +void dcss_dtg_css_set(struct dcss_dtg *dtg);
> > +void dcss_dtg_enable(struct dcss_dtg *dtg, bool en,
> > +                    struct completion *dis_completion);
> > +bool dcss_dtg_is_enabled(struct dcss_dtg *dtg);
> > +void dcss_dtg_ctxld_kick_irq_enable(struct dcss_dtg *dtg, bool en);
> > +bool dcss_dtg_global_alpha_changed(struct dcss_dtg *dtg, int ch_num, int alpha);
> > +void dcss_dtg_plane_alpha_set(struct dcss_dtg *dtg, int ch_num,
> > +                             const struct drm_format_info *format, int alpha);
> > +void dcss_dtg_plane_pos_set(struct dcss_dtg *dtg, int ch_num,
> > +                           int px, int py, int pw, int ph);
> > +void dcss_dtg_ch_enable(struct dcss_dtg *dtg, int ch_num, bool en);
> > +
> > +/* SUBSAM */
> > +int dcss_ss_init(struct dcss_dev *dcss, unsigned long subsam_base);
> > +void dcss_ss_exit(struct dcss_ss *ss);
> > +void dcss_ss_enable(struct dcss_ss *ss);
> > +void dcss_ss_disable(struct dcss_ss *ss);
> > +void dcss_ss_subsam_set(struct dcss_ss *ss);
> > +void dcss_ss_sync_set(struct dcss_ss *ss, struct videomode *vm,
> > +                     bool phsync, bool pvsync);
> > +
> > +/* SCALER */
> > +int dcss_scaler_init(struct dcss_dev *dcss, unsigned long scaler_base);
> > +void dcss_scaler_exit(struct dcss_scaler *scl);
> > +void dcss_scaler_setup(struct dcss_scaler *scl, int ch_num,
> > +                      const struct drm_format_info *format,
> > +                      int src_xres, int src_yres, int dst_xres, int dst_yres,
> > +                      u32 vrefresh_hz);
> > +void dcss_scaler_ch_enable(struct dcss_scaler *scl, int ch_num, bool en);
> > +int dcss_scaler_get_min_max_ratios(struct dcss_scaler *scl, int ch_num,
> > +                                  int *min, int *max);
> > +void dcss_scaler_write_sclctrl(struct dcss_scaler *scl);
> > +
> > +#endif /* __DCSS_PRV_H__ */
> > diff --git a/drivers/gpu/drm/imx/dcss/dcss-dpr.c b/drivers/gpu/drm/imx/dcss/dcss-dpr.c
> > new file mode 100644
> > index 00000000..dbc7169
> > --- /dev/null
> > +++ b/drivers/gpu/drm/imx/dcss/dcss-dpr.c
> > @@ -0,0 +1,552 @@
> > +// SPDX-License-Identifier: GPL-2.0
> > +/*
> > + * Copyright 2019 NXP.
> > + */
> > +
> > +#include <linux/device.h>
> > +
> > +#include "dcss-dev.h"
> > +
> > +#define DCSS_DPR_SYSTEM_CTRL0                  0x000
> > +#define   RUN_EN                               BIT(0)
> > +#define   SOFT_RESET                           BIT(1)
> > +#define   REPEAT_EN                            BIT(2)
> > +#define   SHADOW_LOAD_EN                       BIT(3)
> > +#define   SW_SHADOW_LOAD_SEL                   BIT(4)
> > +#define   BCMD2AXI_MSTR_ID_CTRL                        BIT(16)
> > +#define DCSS_DPR_IRQ_MASK                      0x020
> > +#define DCSS_DPR_IRQ_MASK_STATUS               0x030
> > +#define DCSS_DPR_IRQ_NONMASK_STATUS            0x040
> > +#define   IRQ_DPR_CTRL_DONE                    BIT(0)
> > +#define   IRQ_DPR_RUN                          BIT(1)
> > +#define   IRQ_DPR_SHADOW_LOADED                        BIT(2)
> > +#define   IRQ_AXI_READ_ERR                     BIT(3)
> > +#define   DPR2RTR_YRGB_FIFO_OVFL               BIT(4)
> > +#define   DPR2RTR_UV_FIFO_OVFL                 BIT(5)
> > +#define   DPR2RTR_FIFO_LD_BUF_RDY_YRGB_ERR     BIT(6)
> > +#define   DPR2RTR_FIFO_LD_BUF_RDY_UV_ERR       BIT(7)
> > +#define DCSS_DPR_MODE_CTRL0                    0x050
> > +#define   RTR_3BUF_EN                          BIT(0)
> > +#define   RTR_4LINE_BUF_EN                     BIT(1)
> > +#define   TILE_TYPE_POS                                2
> > +#define   TILE_TYPE_MASK                       GENMASK(4, 2)
> > +#define   YUV_EN                               BIT(6)
> > +#define   COMP_2PLANE_EN                       BIT(7)
> > +#define   PIX_SIZE_POS                         8
> > +#define   PIX_SIZE_MASK                                GENMASK(9, 8)
> > +#define   PIX_LUMA_UV_SWAP                     BIT(10)
> > +#define   PIX_UV_SWAP                          BIT(11)
> > +#define   B_COMP_SEL_POS                       12
> > +#define   B_COMP_SEL_MASK                      GENMASK(13, 12)
> > +#define   G_COMP_SEL_POS                       14
> > +#define   G_COMP_SEL_MASK                      GENMASK(15, 14)
> > +#define   R_COMP_SEL_POS                       16
> > +#define   R_COMP_SEL_MASK                      GENMASK(17, 16)
> > +#define   A_COMP_SEL_POS                       18
> > +#define   A_COMP_SEL_MASK                      GENMASK(19, 18)
> > +#define DCSS_DPR_FRAME_CTRL0                   0x070
> > +#define   HFLIP_EN                             BIT(0)
> > +#define   VFLIP_EN                             BIT(1)
> > +#define   ROT_ENC_POS                          2
> > +#define   ROT_ENC_MASK                         GENMASK(3, 2)
> > +#define   ROT_FLIP_ORDER_EN                    BIT(4)
> > +#define   PITCH_POS                            16
> > +#define   PITCH_MASK                           GENMASK(31, 16)
> > +#define DCSS_DPR_FRAME_1P_CTRL0                        0x090
> > +#define DCSS_DPR_FRAME_1P_PIX_X_CTRL           0x0A0
> > +#define DCSS_DPR_FRAME_1P_PIX_Y_CTRL           0x0B0
> > +#define DCSS_DPR_FRAME_1P_BASE_ADDR            0x0C0
> > +#define DCSS_DPR_FRAME_2P_CTRL0                        0x0E0
> > +#define DCSS_DPR_FRAME_2P_PIX_X_CTRL           0x0F0
> > +#define DCSS_DPR_FRAME_2P_PIX_Y_CTRL           0x100
> > +#define DCSS_DPR_FRAME_2P_BASE_ADDR            0x110
> > +#define DCSS_DPR_STATUS_CTRL0                  0x130
> > +#define   STATUS_MUX_SEL_MASK                  GENMASK(2, 0)
> > +#define   STATUS_SRC_SEL_POS                   16
> > +#define   STATUS_SRC_SEL_MASK                  GENMASK(18, 16)
> > +#define DCSS_DPR_STATUS_CTRL1                  0x140
> > +#define DCSS_DPR_RTRAM_CTRL0                   0x200
> > +#define   NUM_ROWS_ACTIVE                      BIT(0)
> > +#define   THRES_HIGH_POS                       1
> > +#define   THRES_HIGH_MASK                      GENMASK(3, 1)
> > +#define   THRES_LOW_POS                                4
> > +#define   THRES_LOW_MASK                       GENMASK(6, 4)
> > +#define   ABORT_SEL                            BIT(7)
> > +
> > +struct dcss_dpr_ch {
> > +       struct dcss_dpr *dpr;
> > +       void __iomem *base_reg;
> > +       u32 base_ofs;
> > +
> > +       struct drm_format_info format;
> > +       enum dcss_pix_size pix_size;
> > +       enum dcss_tile_type tile;
> > +       bool rtram_4line_en;
> > +       bool rtram_3buf_en;
> > +
> > +       u32 frame_ctrl;
> > +       u32 mode_ctrl;
> > +       u32 sys_ctrl;
> > +       u32 rtram_ctrl;
> > +
> > +       bool sys_ctrl_chgd;
> > +
> > +       u32 pitch;
> > +
> > +       int ch_num;
> > +       int irq;
> > +};
> > +
> > +struct dcss_dpr {
> > +       struct device *dev;
> > +       struct dcss_ctxld *ctxld;
> > +       u32  ctx_id;
> > +
> > +       struct dcss_dpr_ch ch[3];
> > +};
> > +
> > +static void dcss_dpr_write(struct dcss_dpr_ch *ch, u32 val, u32 ofs)
> > +{
> > +       struct dcss_dpr *dpr = ch->dpr;
> > +
> > +       dcss_ctxld_write(dpr->ctxld, dpr->ctx_id, val, ch->base_ofs + ofs);
> > +}
> > +
> > +static int dcss_dpr_ch_init_all(struct dcss_dpr *dpr, unsigned long dpr_base)
> > +{
> > +       struct dcss_dpr_ch *ch;
> > +       int i;
> > +
> > +       for (i = 0; i < 3; i++) {
> > +               ch = &dpr->ch[i];
> > +
> > +               ch->base_ofs = dpr_base + i * 0x1000;
> 
> Same with i.MX8QM & i.MX8QXP, every DPR instance has three channels.
> Each channel has it's own register space.
> For i.MX8QM & i.MX8QXP SoCs, the connection between DPR channel
> and PRG(s) can be reflected in device tree.  So, it would be good if the
> DPR driver wraps one single DPR channel only.
> 
> Regards,
> Liu Ying
> 
> > +
> > +               ch->base_reg = devm_ioremap(dpr->dev, ch->base_ofs, SZ_4K);
> > +               if (!ch->base_reg) {
> > +                       dev_err(dpr->dev, "dpr: unable to remap ch %d base\n",
> > +                               i);
> > +                       return -ENOMEM;
> > +               }
> > +
> > +               ch->dpr = dpr;
> > +               ch->ch_num = i;
> > +       }
> > +
> > +       return 0;
> > +}
> > +
> > +int dcss_dpr_init(struct dcss_dev *dcss, unsigned long dpr_base)
> > +{
> > +       struct dcss_dpr *dpr;
> > +
> > +       dpr = devm_kzalloc(dcss->dev, sizeof(struct dcss_dpr), GFP_KERNEL);
> > +       if (!dpr)
> > +               return -ENOMEM;
> > +
> > +       dcss->dpr = dpr;
> > +       dpr->dev = dcss->dev;
> > +       dpr->ctxld = dcss->ctxld;
> > +       dpr->ctx_id = CTX_SB_HP;
> > +
> > +       if (dcss_dpr_ch_init_all(dpr, dpr_base)) {
> > +               int i;
> > +
> > +               for (i = 0; i < 3; i++) {
> > +                       if (dpr->ch[i].base_reg)
> > +                               devm_iounmap(dpr->dev, dpr->ch[i].base_reg);
> > +               }
> > +
> > +               devm_kfree(dpr->dev, dpr);
> > +
> > +               return -ENOMEM;
> > +       }
> > +
> > +       return 0;
> > +}
> > +
> > +void dcss_dpr_exit(struct dcss_dpr *dpr)
> > +{
> > +       int ch_no;
> > +
> > +       /* stop DPR on all channels */
> > +       for (ch_no = 0; ch_no < 3; ch_no++) {
> > +               struct dcss_dpr_ch *ch = &dpr->ch[ch_no];
> > +
> > +               dcss_writel(0, ch->base_reg + DCSS_DPR_SYSTEM_CTRL0);
> > +
> > +               if (ch->base_reg)
> > +                       devm_iounmap(dpr->dev, ch->base_reg);
> > +       }
> > +
> > +       devm_kfree(dpr->dev, dpr);
> > +}
> > +
> > +static u32 dcss_dpr_x_pix_wide_adjust(struct dcss_dpr_ch *ch, u32 pix_wide,
> > +                                     u32 pix_format)
> > +{
> > +       u8 pix_in_64byte_map[3][5] = {
> > +               /* LIN, GPU_STD, GPU_SUP, VPU_YUV420, VPU_VP9 */
> > +               {   64,       8,       8,          8,     16}, /* PIX_SIZE_8  */
> > +               {   32,       8,       8,          8,      8}, /* PIX_SIZE_16 */
> > +               {   16,       4,       4,          8,      8}, /* PIX_SIZE_32 */
> > +       };
> > +       u32 offset;
> > +       u32 div_64byte_mod, pix_in_64byte;
> > +
> > +       pix_in_64byte = pix_in_64byte_map[ch->pix_size][ch->tile];
> > +
> > +       if (pix_format == DRM_FORMAT_P010)
> > +               pix_wide = pix_wide * 10 / 8;
> > +
> > +       div_64byte_mod = pix_wide % pix_in_64byte;
> > +       offset = (div_64byte_mod == 0) ? 0 : (pix_in_64byte - div_64byte_mod);
> > +
> > +       return pix_wide + offset;
> > +}
> > +
> > +static u32 dcss_dpr_y_pix_high_adjust(struct dcss_dpr_ch *ch, u32 pix_high,
> > +                                     u32 pix_format)
> > +{
> > +       u8 num_rows_buf = ch->rtram_4line_en ? 4 : 8;
> > +       u32 offset, pix_y_mod;
> > +
> > +       pix_y_mod = pix_high % num_rows_buf;
> > +       offset = pix_y_mod ? (num_rows_buf - pix_y_mod) : 0;
> > +
> > +       return pix_high + offset;
> > +}
> > +
> > +void dcss_dpr_set_res(struct dcss_dpr *dpr, int ch_num, u32 xres, u32 yres)
> > +{
> > +       struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
> > +       u32 pix_format = ch->format.format;
> > +       u32 gap = DCSS_DPR_FRAME_2P_BASE_ADDR - DCSS_DPR_FRAME_1P_BASE_ADDR;
> > +       int plane, max_planes = 1;
> > +       u32 pix_x_wide, pix_y_high;
> > +
> > +       if (pix_format == DRM_FORMAT_NV12 ||
> > +           pix_format == DRM_FORMAT_NV21)
> > +               max_planes = 2;
> > +
> > +       for (plane = 0; plane < max_planes; plane++) {
> > +               yres = plane == 1 ? yres >> 1 : yres;
> > +
> > +               pix_x_wide = dcss_dpr_x_pix_wide_adjust(ch, xres, pix_format);
> > +               pix_y_high = dcss_dpr_y_pix_high_adjust(ch, yres, pix_format);
> > +
> > +               if (plane == 0)
> > +                       ch->pitch = pix_x_wide;
> > +
> > +               dcss_dpr_write(ch, pix_x_wide,
> > +                              DCSS_DPR_FRAME_1P_PIX_X_CTRL + plane * gap);
> > +               dcss_dpr_write(ch, pix_y_high,
> > +                              DCSS_DPR_FRAME_1P_PIX_Y_CTRL + plane * gap);
> > +
> > +               dcss_dpr_write(ch, 2, DCSS_DPR_FRAME_1P_CTRL0 + plane * gap);
> > +       }
> > +}
> > +
> > +void dcss_dpr_addr_set(struct dcss_dpr *dpr, int ch_num, u32 luma_base_addr,
> > +                      u32 chroma_base_addr, u16 pitch)
> > +{
> > +       struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
> > +
> > +       dcss_dpr_write(ch, luma_base_addr, DCSS_DPR_FRAME_1P_BASE_ADDR);
> > +
> > +       dcss_dpr_write(ch, chroma_base_addr, DCSS_DPR_FRAME_2P_BASE_ADDR);
> > +
> > +       ch->frame_ctrl &= ~PITCH_MASK;
> > +       ch->frame_ctrl |= (((u32)pitch << PITCH_POS) & PITCH_MASK);
> > +}
> > +
> > +static void dcss_dpr_argb_comp_sel(struct dcss_dpr_ch *ch, int a_sel, int r_sel,
> > +                                  int g_sel, int b_sel)
> > +{
> > +       u32 sel;
> > +
> > +       sel = ((a_sel << A_COMP_SEL_POS) & A_COMP_SEL_MASK) |
> > +             ((r_sel << R_COMP_SEL_POS) & R_COMP_SEL_MASK) |
> > +             ((g_sel << G_COMP_SEL_POS) & G_COMP_SEL_MASK) |
> > +             ((b_sel << B_COMP_SEL_POS) & B_COMP_SEL_MASK);
> > +
> > +       ch->mode_ctrl &= ~(A_COMP_SEL_MASK | R_COMP_SEL_MASK |
> > +                          G_COMP_SEL_MASK | B_COMP_SEL_MASK);
> > +       ch->mode_ctrl |= sel;
> > +}
> > +
> > +static void dcss_dpr_pix_size_set(struct dcss_dpr_ch *ch,
> > +                                 const struct drm_format_info *format)
> > +{
> > +       u32 val;
> > +
> > +       switch (format->format) {
> > +       case DRM_FORMAT_NV12:
> > +       case DRM_FORMAT_NV21:
> > +               val = 0;
> > +               break;
> > +
> > +       case DRM_FORMAT_UYVY:
> > +       case DRM_FORMAT_VYUY:
> > +       case DRM_FORMAT_YUYV:
> > +       case DRM_FORMAT_YVYU:
> > +               val = 1;
> > +               break;
> > +
> > +       default:
> > +               val = 2;
> > +               break;
> > +       }
> > +
> > +       ch->pix_size = val;
> > +
> > +       ch->mode_ctrl &= ~PIX_SIZE_MASK;
> > +       ch->mode_ctrl |= ((val << PIX_SIZE_POS) & PIX_SIZE_MASK);
> > +}
> > +
> > +static void dcss_dpr_uv_swap(struct dcss_dpr_ch *ch, bool swap)
> > +{
> > +       ch->mode_ctrl &= ~PIX_UV_SWAP;
> > +       ch->mode_ctrl |= (swap ? PIX_UV_SWAP : 0);
> > +}
> > +
> > +static void dcss_dpr_y_uv_swap(struct dcss_dpr_ch *ch, bool swap)
> > +{
> > +       ch->mode_ctrl &= ~PIX_LUMA_UV_SWAP;
> > +       ch->mode_ctrl |= (swap ? PIX_LUMA_UV_SWAP : 0);
> > +}
> > +
> > +static void dcss_dpr_2plane_en(struct dcss_dpr_ch *ch, bool en)
> > +{
> > +       ch->mode_ctrl &= ~COMP_2PLANE_EN;
> > +       ch->mode_ctrl |= (en ? COMP_2PLANE_EN : 0);
> > +}
> > +
> > +static void dcss_dpr_yuv_en(struct dcss_dpr_ch *ch, bool en)
> > +{
> > +       ch->mode_ctrl &= ~YUV_EN;
> > +       ch->mode_ctrl |= (en ? YUV_EN : 0);
> > +}
> > +
> > +void dcss_dpr_enable(struct dcss_dpr *dpr, int ch_num, bool en)
> > +{
> > +       struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
> > +       u32 sys_ctrl;
> > +
> > +       sys_ctrl = (en ? REPEAT_EN | RUN_EN : 0);
> > +
> > +       if (en) {
> > +               dcss_dpr_write(ch, ch->mode_ctrl, DCSS_DPR_MODE_CTRL0);
> > +               dcss_dpr_write(ch, ch->frame_ctrl, DCSS_DPR_FRAME_CTRL0);
> > +               dcss_dpr_write(ch, ch->rtram_ctrl, DCSS_DPR_RTRAM_CTRL0);
> > +       }
> > +
> > +       if (ch->sys_ctrl != sys_ctrl)
> > +               ch->sys_ctrl_chgd = true;
> > +
> > +       ch->sys_ctrl = sys_ctrl;
> > +}
> > +
> > +struct rgb_comp_sel {
> > +       u32 drm_format;
> > +       int a_sel;
> > +       int r_sel;
> > +       int g_sel;
> > +       int b_sel;
> > +};
> > +
> > +static struct rgb_comp_sel comp_sel_map[] = {
> > +       {DRM_FORMAT_ARGB8888, 3, 2, 1, 0},
> > +       {DRM_FORMAT_XRGB8888, 3, 2, 1, 0},
> > +       {DRM_FORMAT_ABGR8888, 3, 0, 1, 2},
> > +       {DRM_FORMAT_XBGR8888, 3, 0, 1, 2},
> > +       {DRM_FORMAT_RGBA8888, 0, 3, 2, 1},
> > +       {DRM_FORMAT_RGBX8888, 0, 3, 2, 1},
> > +       {DRM_FORMAT_BGRA8888, 0, 1, 2, 3},
> > +       {DRM_FORMAT_BGRX8888, 0, 1, 2, 3},
> > +};
> > +
> > +static int to_comp_sel(u32 pix_fmt, int *a_sel, int *r_sel, int *g_sel,
> > +                      int *b_sel)
> > +{
> > +       int i;
> > +
> > +       for (i = 0; i < ARRAY_SIZE(comp_sel_map); i++) {
> > +               if (comp_sel_map[i].drm_format == pix_fmt) {
> > +                       *a_sel = comp_sel_map[i].a_sel;
> > +                       *r_sel = comp_sel_map[i].r_sel;
> > +                       *g_sel = comp_sel_map[i].g_sel;
> > +                       *b_sel = comp_sel_map[i].b_sel;
> > +
> > +                       return 0;
> > +               }
> > +       }
> > +
> > +       return -1;
> > +}
> > +
> > +static void dcss_dpr_rtram_set(struct dcss_dpr_ch *ch, u32 pix_format)
> > +{
> > +       u32 val, mask;
> > +
> > +       switch (pix_format) {
> > +       case DRM_FORMAT_NV21:
> > +       case DRM_FORMAT_NV12:
> > +       case DRM_FORMAT_P010:
> > +               ch->rtram_3buf_en = true;
> > +               ch->rtram_4line_en = false;
> > +               break;
> > +
> > +       default:
> > +               ch->rtram_3buf_en = true;
> > +               ch->rtram_4line_en = true;
> > +               break;
> > +       }
> > +
> > +       val = (ch->rtram_4line_en ? RTR_4LINE_BUF_EN : 0);
> > +       val |= (ch->rtram_3buf_en ? RTR_3BUF_EN : 0);
> > +       mask = RTR_4LINE_BUF_EN | RTR_3BUF_EN;
> > +
> > +       ch->mode_ctrl &= ~mask;
> > +       ch->mode_ctrl |= (val & mask);
> > +
> > +       val = (ch->rtram_4line_en ? 0 : NUM_ROWS_ACTIVE);
> > +       val |= (3 << THRES_LOW_POS) & THRES_LOW_MASK;
> > +       val |= (4 << THRES_HIGH_POS) & THRES_HIGH_MASK;
> > +       mask = THRES_LOW_MASK | THRES_HIGH_MASK | NUM_ROWS_ACTIVE;
> > +
> > +       ch->rtram_ctrl &= ~mask;
> > +       ch->rtram_ctrl |= (val & mask);
> > +}
> > +
> > +static void dcss_dpr_setup_components(struct dcss_dpr_ch *ch,
> > +                                     const struct drm_format_info *format)
> > +{
> > +       int a_sel, r_sel, g_sel, b_sel;
> > +       bool uv_swap, y_uv_swap;
> > +
> > +       switch (format->format) {
> > +       case DRM_FORMAT_YVYU:
> > +               uv_swap = true;
> > +               y_uv_swap = true;
> > +               break;
> > +
> > +       case DRM_FORMAT_VYUY:
> > +       case DRM_FORMAT_NV21:
> > +               uv_swap = true;
> > +               y_uv_swap = false;
> > +               break;
> > +
> > +       case DRM_FORMAT_YUYV:
> > +               uv_swap = false;
> > +               y_uv_swap = true;
> > +               break;
> > +
> > +       default:
> > +               uv_swap = false;
> > +               y_uv_swap = false;
> > +               break;
> > +       }
> > +
> > +       dcss_dpr_uv_swap(ch, uv_swap);
> > +
> > +       dcss_dpr_y_uv_swap(ch, y_uv_swap);
> > +
> > +       if (!format->is_yuv) {
> > +               if (!to_comp_sel(format->format, &a_sel, &r_sel,
> > +                                &g_sel, &b_sel)) {
> > +                       dcss_dpr_argb_comp_sel(ch, a_sel, r_sel, g_sel, b_sel);
> > +               } else {
> > +                       dcss_dpr_argb_comp_sel(ch, 3, 2, 1, 0);
> > +               }
> > +       } else {
> > +               dcss_dpr_argb_comp_sel(ch, 0, 0, 0, 0);
> > +       }
> > +}
> > +
> > +static void dcss_dpr_tile_set(struct dcss_dpr_ch *ch, uint64_t modifier)
> > +{
> > +       switch (ch->ch_num) {
> > +       case 0:
> > +               switch (modifier) {
> > +               case DRM_FORMAT_MOD_LINEAR:
> > +                       ch->tile = TILE_LINEAR;
> > +                       break;
> > +               case DRM_FORMAT_MOD_VIVANTE_TILED:
> > +                       ch->tile = TILE_GPU_STANDARD;
> > +                       break;
> > +               case DRM_FORMAT_MOD_VIVANTE_SUPER_TILED:
> > +                       ch->tile = TILE_GPU_SUPER;
> > +                       break;
> > +               default:
> > +                       WARN_ON(1);
> > +                       break;
> > +               }
> > +               break;
> > +       case 1:
> > +       case 2:
> > +               ch->tile = TILE_LINEAR;
> > +               break;
> > +       default:
> > +               WARN_ON(1);
> > +               return;
> > +       }
> > +
> > +       ch->mode_ctrl &= ~TILE_TYPE_MASK;
> > +       ch->mode_ctrl |= ((ch->tile << TILE_TYPE_POS) & TILE_TYPE_MASK);
> > +}
> > +
> > +void dcss_dpr_format_set(struct dcss_dpr *dpr, int ch_num,
> > +                        const struct drm_format_info *format, u64 modifier)
> > +{
> > +       struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
> > +
> > +       ch->format = *format;
> > +
> > +       dcss_dpr_yuv_en(ch, format->is_yuv);
> > +
> > +       dcss_dpr_pix_size_set(ch, format);
> > +
> > +       dcss_dpr_setup_components(ch, format);
> > +
> > +       dcss_dpr_2plane_en(ch, format->num_planes == 2);
> > +
> > +       dcss_dpr_rtram_set(ch, format->format);
> > +
> > +       dcss_dpr_tile_set(ch, modifier);
> > +}
> > +
> > +/* This function will be called from interrupt context. */
> > +void dcss_dpr_write_sysctrl(struct dcss_dpr *dpr)
> > +{
> > +       int chnum;
> > +
> > +       for (chnum = 0; chnum < 3; chnum++) {
> > +               struct dcss_dpr_ch *ch = &dpr->ch[chnum];
> > +
> > +               if (ch->sys_ctrl_chgd) {
> > +                       dcss_ctxld_write_irqsafe(dpr->ctxld, dpr->ctx_id,
> > +                                                ch->sys_ctrl,
> > +                                                ch->base_ofs +
> > +                                                DCSS_DPR_SYSTEM_CTRL0);
> > +                       ch->sys_ctrl_chgd = false;
> > +               }
> > +       }
> > +}
> > +
> > +void dcss_dpr_set_rotation(struct dcss_dpr *dpr, int ch_num, u32 rotation)
> > +{
> > +       struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
> > +
> > +       ch->frame_ctrl &= ~(HFLIP_EN | VFLIP_EN | ROT_ENC_MASK);
> > +
> > +       ch->frame_ctrl |= rotation & DRM_MODE_REFLECT_X ? HFLIP_EN : 0;
> > +       ch->frame_ctrl |= rotation & DRM_MODE_REFLECT_Y ? VFLIP_EN : 0;
> > +
> > +       if (rotation & DRM_MODE_ROTATE_90)
> > +               ch->frame_ctrl |= 1 << ROT_ENC_POS;
> > +       else if (rotation & DRM_MODE_ROTATE_180)
> > +               ch->frame_ctrl |= 2 << ROT_ENC_POS;
> > +       else if (rotation & DRM_MODE_ROTATE_270)
> > +               ch->frame_ctrl |= 3 << ROT_ENC_POS;
> > +}
> > diff --git a/drivers/gpu/drm/imx/dcss/dcss-drv.c b/drivers/gpu/drm/imx/dcss/dcss-drv.c
> > new file mode 100644
> > index 00000000..7ea131d
> > --- /dev/null
> > +++ b/drivers/gpu/drm/imx/dcss/dcss-drv.c
> > @@ -0,0 +1,182 @@
> > +// SPDX-License-Identifier: GPL-2.0
> > +/*
> > + * Copyright 2019 NXP.
> > + */
> > +
> > +#include <linux/module.h>
> > +#include <linux/kernel.h>
> > +#include <linux/platform_device.h>
> > +#include <linux/component.h>
> > +#include <drm/drm_of.h>
> > +#include <drm/drmP.h>
> > +
> > +#include "dcss-dev.h"
> > +#include "dcss-kms.h"
> > +
> > +struct dcss_drv {
> > +       struct dcss_dev *dcss;
> > +       struct dcss_kms_dev *kms;
> > +
> > +       bool is_componentized;
> > +};
> > +
> > +struct dcss_dev *dcss_drv_dev_to_dcss(struct device *dev)
> > +{
> > +       struct dcss_drv *mdrv = dev_get_drvdata(dev);
> > +
> > +       return mdrv ? mdrv->dcss : NULL;
> > +}
> > +
> > +struct drm_device *dcss_drv_dev_to_drm(struct device *dev)
> > +{
> > +       struct dcss_drv *mdrv = dev_get_drvdata(dev);
> > +
> > +       return mdrv ? &mdrv->kms->base : NULL;
> > +}
> > +
> > +static int dcss_drv_init(struct device *dev, bool componentized)
> > +{
> > +       struct dcss_drv *mdrv;
> > +       int err = 0;
> > +
> > +       mdrv = devm_kzalloc(dev, sizeof(*mdrv), GFP_KERNEL);
> > +       if (!mdrv)
> > +               return -ENOMEM;
> > +
> > +       mdrv->is_componentized = componentized;
> > +
> > +       mdrv->dcss = dcss_dev_create(dev, componentized);
> > +       if (IS_ERR(mdrv->dcss)) {
> > +               err = PTR_ERR(mdrv->dcss);
> > +               goto err;
> > +       }
> > +
> > +       dev_set_drvdata(dev, mdrv);
> > +
> > +       mdrv->kms = dcss_kms_attach(mdrv->dcss, componentized);
> > +       if (IS_ERR(mdrv->kms)) {
> > +               err = PTR_ERR(mdrv->kms);
> > +               goto dcss_shutoff;
> > +       }
> > +
> > +       return 0;
> > +
> > +dcss_shutoff:
> > +       dcss_dev_destroy(mdrv->dcss);
> > +
> > +       dev_set_drvdata(dev, NULL);
> > +
> > +err:
> > +       devm_kfree(dev, mdrv);
> > +       return err;
> > +}
> > +
> > +static void dcss_drv_deinit(struct device *dev, bool componentized)
> > +{
> > +       struct dcss_drv *mdrv = dev_get_drvdata(dev);
> > +
> > +       if (!mdrv)
> > +               return;
> > +
> > +       dcss_kms_detach(mdrv->kms, componentized);
> > +       dcss_dev_destroy(mdrv->dcss);
> > +
> > +       dev_set_drvdata(dev, NULL);
> > +}
> > +
> > +static int dcss_drv_bind(struct device *dev)
> > +{
> > +       return dcss_drv_init(dev, true);
> > +}
> > +
> > +static void dcss_drv_unbind(struct device *dev)
> > +{
> > +       return dcss_drv_deinit(dev, true);
> > +}
> > +
> > +static const struct component_master_ops dcss_master_ops = {
> > +       .bind   = dcss_drv_bind,
> > +       .unbind = dcss_drv_unbind,
> > +};
> > +
> > +static int compare_of(struct device *dev, void *data)
> > +{
> > +       return dev->of_node == data;
> > +}
> > +
> > +static int dcss_drv_platform_probe(struct platform_device *pdev)
> > +{
> > +       struct device *dev = &pdev->dev;
> > +       struct component_match *match = NULL;
> > +       struct device_node *remote;
> > +
> > +       if (!dev->of_node)
> > +               return -ENODEV;
> > +
> > +       remote = of_graph_get_remote_node(dev->of_node, 0, 0);
> > +       if (!remote)
> > +               return -ENODEV;
> > +
> > +       if (of_device_is_compatible(remote, "fsl,imx8mq-nwl-dsi")) {
> > +               of_node_put(remote);
> > +               return dcss_drv_init(dev, false);
> > +       }
> > +
> > +       drm_of_component_match_add(dev, &match, compare_of, remote);
> > +       of_node_put(remote);
> > +
> > +       return component_master_add_with_match(dev, &dcss_master_ops, match);
> > +}
> > +
> > +static int dcss_drv_platform_remove(struct platform_device *pdev)
> > +{
> > +       struct dcss_drv *mdrv = dev_get_drvdata(&pdev->dev);
> > +
> > +       if (mdrv->is_componentized)
> > +               component_master_del(&pdev->dev, &dcss_master_ops);
> > +       else
> > +               dcss_drv_deinit(&pdev->dev, false);
> > +
> > +       return 0;
> > +}
> > +
> > +static struct dcss_type_data dcss_types[] = {
> > +       [DCSS_IMX8MQ] = {
> > +               .name = "DCSS_IMX8MQ",
> > +               .blkctl_ofs = 0x2F000,
> > +               .ctxld_ofs = 0x23000,
> > +               .dtg_ofs = 0x20000,
> > +               .scaler_ofs = 0x1C000,
> > +               .ss_ofs = 0x1B000,
> > +               .dpr_ofs = 0x18000,
> > +       },
> > +};
> > +
> > +static const struct of_device_id dcss_of_match[] = {
> > +       { .compatible = "nxp,imx8mq-dcss", .data = &dcss_types[DCSS_IMX8MQ], },
> > +       {},
> > +};
> > +
> > +MODULE_DEVICE_TABLE(of, dcss_of_match);
> > +
> > +static const struct dev_pm_ops dcss_dev_pm = {
> > +       SET_SYSTEM_SLEEP_PM_OPS(dcss_dev_suspend, dcss_dev_resume)
> > +       SET_RUNTIME_PM_OPS(dcss_dev_runtime_suspend,
> > +                          dcss_dev_runtime_resume, NULL)
> > +};
> > +
> > +static struct platform_driver dcss_platform_driver = {
> > +       .probe  = dcss_drv_platform_probe,
> > +       .remove = dcss_drv_platform_remove,
> > +       .driver = {
> > +               .name = "imx-dcss",
> > +               .of_match_table = dcss_of_match,
> > +               .pm = &dcss_dev_pm,
> > +       },
> > +};
> > +
> > +module_platform_driver(dcss_platform_driver);
> > +
> > +MODULE_AUTHOR("Laurentiu Palcu <laurentiu.palcu@nxp.com>");
> > +MODULE_DESCRIPTION("DCSS driver for i.MX8MQ");
> > +MODULE_LICENSE("GPL v2");
> > diff --git a/drivers/gpu/drm/imx/dcss/dcss-dtg.c b/drivers/gpu/drm/imx/dcss/dcss-dtg.c
> > new file mode 100644
> > index 00000000..c83b3bb
> > --- /dev/null
> > +++ b/drivers/gpu/drm/imx/dcss/dcss-dtg.c
> > @@ -0,0 +1,438 @@
> > +// SPDX-License-Identifier: GPL-2.0
> > +/*
> > + * Copyright 2019 NXP.
> > + */
> > +
> > +#include <linux/clk.h>
> > +#include <linux/delay.h>
> > +#include <linux/interrupt.h>
> > +#include <linux/of.h>
> > +#include <linux/platform_device.h>
> > +
> > +#include "dcss-dev.h"
> > +
> > +#define DCSS_DTG_TC_CONTROL_STATUS                     0x00
> > +#define   CH3_EN                                       BIT(0)
> > +#define   CH2_EN                                       BIT(1)
> > +#define   CH1_EN                                       BIT(2)
> > +#define   OVL_DATA_MODE                                        BIT(3)
> > +#define   BLENDER_VIDEO_ALPHA_SEL                      BIT(7)
> > +#define   DTG_START                                    BIT(8)
> > +#define   DBY_MODE_EN                                  BIT(9)
> > +#define   CH1_ALPHA_SEL                                        BIT(10)
> > +#define   CSS_PIX_COMP_SWAP_POS                                12
> > +#define   CSS_PIX_COMP_SWAP_MASK                       GENMASK(14, 12)
> > +#define   DEFAULT_FG_ALPHA_POS                         24
> > +#define   DEFAULT_FG_ALPHA_MASK                                GENMASK(31, 24)
> > +#define DCSS_DTG_TC_DTG                                        0x04
> > +#define DCSS_DTG_TC_DISP_TOP                           0x08
> > +#define DCSS_DTG_TC_DISP_BOT                           0x0C
> > +#define DCSS_DTG_TC_CH1_TOP                            0x10
> > +#define DCSS_DTG_TC_CH1_BOT                            0x14
> > +#define DCSS_DTG_TC_CH2_TOP                            0x18
> > +#define DCSS_DTG_TC_CH2_BOT                            0x1C
> > +#define DCSS_DTG_TC_CH3_TOP                            0x20
> > +#define DCSS_DTG_TC_CH3_BOT                            0x24
> > +#define   TC_X_POS                                     0
> > +#define   TC_X_MASK                                    GENMASK(12, 0)
> > +#define   TC_Y_POS                                     16
> > +#define   TC_Y_MASK                                    GENMASK(28, 16)
> > +#define DCSS_DTG_TC_CTXLD                              0x28
> > +#define   TC_CTXLD_DB_Y_POS                            0
> > +#define   TC_CTXLD_DB_Y_MASK                           GENMASK(12, 0)
> > +#define   TC_CTXLD_SB_Y_POS                            16
> > +#define   TC_CTXLD_SB_Y_MASK                           GENMASK(28, 16)
> > +#define DCSS_DTG_TC_CH1_BKRND                          0x2C
> > +#define DCSS_DTG_TC_CH2_BKRND                          0x30
> > +#define   BKRND_R_Y_COMP_POS                           20
> > +#define   BKRND_R_Y_COMP_MASK                          GENMASK(29, 20)
> > +#define   BKRND_G_U_COMP_POS                           10
> > +#define   BKRND_G_U_COMP_MASK                          GENMASK(19, 10)
> > +#define   BKRND_B_V_COMP_POS                           0
> > +#define   BKRND_B_V_COMP_MASK                          GENMASK(9, 0)
> > +#define DCSS_DTG_BLENDER_DBY_RANGEINV                  0x38
> > +#define DCSS_DTG_BLENDER_DBY_RANGEMIN                  0x3C
> > +#define DCSS_DTG_BLENDER_DBY_BDP                       0x40
> > +#define DCSS_DTG_BLENDER_BKRND_I                       0x44
> > +#define DCSS_DTG_BLENDER_BKRND_P                       0x48
> > +#define DCSS_DTG_BLENDER_BKRND_T                       0x4C
> > +#define DCSS_DTG_LINE0_INT                             0x50
> > +#define DCSS_DTG_LINE1_INT                             0x54
> > +#define DCSS_DTG_BG_ALPHA_DEFAULT                      0x58
> > +#define DCSS_DTG_INT_STATUS                            0x5C
> > +#define DCSS_DTG_INT_CONTROL                           0x60
> > +#define DCSS_DTG_TC_CH3_BKRND                          0x64
> > +#define DCSS_DTG_INT_MASK                              0x68
> > +#define   LINE0_IRQ                                    BIT(0)
> > +#define   LINE1_IRQ                                    BIT(1)
> > +#define   LINE2_IRQ                                    BIT(2)
> > +#define   LINE3_IRQ                                    BIT(3)
> > +#define DCSS_DTG_LINE2_INT                             0x6C
> > +#define DCSS_DTG_LINE3_INT                             0x70
> > +#define DCSS_DTG_DBY_OL                                        0x74
> > +#define DCSS_DTG_DBY_BL                                        0x78
> > +#define DCSS_DTG_DBY_EL                                        0x7C
> > +
> > +struct dcss_dtg {
> > +       struct device *dev;
> > +       struct dcss_ctxld *ctxld;
> > +       void __iomem *base_reg;
> > +       u32 base_ofs;
> > +
> > +       u32 ctx_id;
> > +
> > +       bool in_use;
> > +
> > +       u32 dis_ulc_x;
> > +       u32 dis_ulc_y;
> > +
> > +       u32 control_status;
> > +       u32 alpha;
> > +
> > +       int ctxld_kick_irq;
> > +       bool ctxld_kick_irq_en;
> > +
> > +       struct clk *pix_clk;
> > +       struct clk *pll_src_clk;
> > +       struct clk *pll_phy_ref_clk;
> > +
> > +       /*
> > +        * This will be passed on by DRM CRTC so that we can signal when DTG has
> > +        * been successfully stopped. Otherwise, any modesetting while DTG is
> > +        * still ON may result in unpredictable behavior.
> > +        */
> > +       struct completion *dis_completion;
> > +};
> > +
> > +static void dcss_dtg_write(struct dcss_dtg *dtg, u32 val, u32 ofs)
> > +{
> > +       if (!dtg->in_use)
> > +               dcss_writel(val, dtg->base_reg + ofs);
> > +
> > +       dcss_ctxld_write(dtg->ctxld, dtg->ctx_id, val, dtg->base_ofs + ofs);
> > +}
> > +
> > +static irqreturn_t dcss_dtg_irq_handler(int irq, void *data)
> > +{
> > +       struct dcss_dtg *dtg = data;
> > +       u32 status;
> > +
> > +       status = dcss_readl(dtg->base_reg + DCSS_DTG_INT_STATUS);
> > +
> > +       if (!(status & LINE0_IRQ))
> > +               return IRQ_HANDLED;
> > +
> > +       dcss_ctxld_kick(dtg->ctxld);
> > +
> > +       dcss_writel(status & LINE0_IRQ, dtg->base_reg + DCSS_DTG_INT_CONTROL);
> > +
> > +       return IRQ_HANDLED;
> > +}
> > +
> > +static int dcss_dtg_irq_config(struct dcss_dtg *dtg,
> > +                              struct platform_device *pdev)
> > +{
> > +       int ret;
> > +
> > +       dtg->ctxld_kick_irq = platform_get_irq_byname(pdev, "ctxld_kick");
> > +       if (dtg->ctxld_kick_irq < 0) {
> > +               dev_err(dtg->dev, "dtg: can't get line2 irq number\n");
> > +               return dtg->ctxld_kick_irq;
> > +       }
> > +
> > +       ret = devm_request_irq(dtg->dev, dtg->ctxld_kick_irq,
> > +                              dcss_dtg_irq_handler,
> > +                              IRQF_TRIGGER_HIGH,
> > +                              "dcss_ctxld_kick", dtg);
> > +       if (ret) {
> > +               dev_err(dtg->dev, "dtg: irq request failed.\n");
> > +               return ret;
> > +       }
> > +
> > +       disable_irq(dtg->ctxld_kick_irq);
> > +
> > +       dtg->ctxld_kick_irq_en = false;
> > +
> > +       dcss_update(LINE0_IRQ, LINE0_IRQ, dtg->base_reg + DCSS_DTG_INT_MASK);
> > +
> > +       return 0;
> > +}
> > +
> > +int dcss_dtg_init(struct dcss_dev *dcss, unsigned long dtg_base)
> > +{
> > +       int ret = 0;
> > +       struct dcss_dtg *dtg;
> > +
> > +       dtg = devm_kzalloc(dcss->dev, sizeof(*dtg), GFP_KERNEL);
> > +       if (!dtg)
> > +               return -ENOMEM;
> > +
> > +       dcss->dtg = dtg;
> > +       dtg->dev = dcss->dev;
> > +       dtg->ctxld = dcss->ctxld;
> > +
> > +       dtg->base_reg = devm_ioremap(dcss->dev, dtg_base, SZ_4K);
> > +       if (!dtg->base_reg) {
> > +               dev_err(dcss->dev, "dtg: unable to remap dtg base\n");
> > +               ret = -ENOMEM;
> > +               goto err_ioremap;
> > +       }
> > +
> > +       dtg->base_ofs = dtg_base;
> > +       dtg->ctx_id = CTX_DB;
> > +
> > +       dtg->pix_clk = dcss->pix_clk;
> > +       dtg->pll_src_clk = dcss->pll_src_clk;
> > +       dtg->pll_phy_ref_clk = dcss->pll_phy_ref_clk;
> > +
> > +       dtg->alpha = 255;
> > +
> > +       dtg->control_status |= OVL_DATA_MODE | BLENDER_VIDEO_ALPHA_SEL |
> > +               ((dtg->alpha << DEFAULT_FG_ALPHA_POS) & DEFAULT_FG_ALPHA_MASK);
> > +
> > +       ret = dcss_dtg_irq_config(dtg, to_platform_device(dcss->dev));
> > +       if (ret)
> > +               goto err_irq;
> > +
> > +       return 0;
> > +
> > +err_irq:
> > +       devm_iounmap(dtg->dev, dtg->base_reg);
> > +
> > +err_ioremap:
> > +       devm_kfree(dtg->dev, dtg);
> > +
> > +       return ret;
> > +}
> > +
> > +void dcss_dtg_exit(struct dcss_dtg *dtg)
> > +{
> > +       /* stop DTG */
> > +       dcss_writel(DTG_START, dtg->base_reg + DCSS_DTG_TC_CONTROL_STATUS);
> > +
> > +       devm_free_irq(dtg->dev, dtg->ctxld_kick_irq, dtg);
> > +
> > +       if (dtg->base_reg)
> > +               devm_iounmap(dtg->dev, dtg->base_reg);
> > +
> > +       devm_kfree(dtg->dev, dtg);
> > +}
> > +
> > +void dcss_dtg_sync_set(struct dcss_dtg *dtg, struct videomode *vm)
> > +{
> > +       u16 dtg_lrc_x, dtg_lrc_y;
> > +       u16 dis_ulc_x, dis_ulc_y;
> > +       u16 dis_lrc_x, dis_lrc_y;
> > +       u32 sb_ctxld_trig, db_ctxld_trig;
> > +       u32 pixclock = vm->pixelclock;
> > +       u32 actual_clk;
> > +
> > +       dtg_lrc_x = vm->hfront_porch + vm->hback_porch + vm->hsync_len +
> > +                   vm->hactive - 1;
> > +       dtg_lrc_y = vm->vfront_porch + vm->vback_porch + vm->vsync_len +
> > +                   vm->vactive - 1;
> > +       dis_ulc_x = vm->hsync_len + vm->hback_porch - 1;
> > +       dis_ulc_y = vm->vsync_len + vm->vfront_porch + vm->vback_porch - 1;
> > +       dis_lrc_x = vm->hsync_len + vm->hback_porch + vm->hactive - 1;
> > +       dis_lrc_y = vm->vsync_len + vm->vfront_porch + vm->vback_porch +
> > +                   vm->vactive - 1;
> > +
> > +       clk_disable_unprepare(dtg->pix_clk);
> > +       clk_set_rate(dtg->pix_clk, vm->pixelclock);
> > +       clk_prepare_enable(dtg->pix_clk);
> > +
> > +       actual_clk = clk_get_rate(dtg->pix_clk);
> > +       if (pixclock != actual_clk) {
> > +               dev_info(dtg->dev,
> > +                        "Pixel clock set to %u kHz instead of %u kHz.\n",
> > +                        (actual_clk / 1000), (pixclock / 1000));
> > +       }
> > +
> > +       msleep(50);
> > +
> > +       dcss_dtg_write(dtg, ((dtg_lrc_y << TC_Y_POS) | dtg_lrc_x),
> > +                      DCSS_DTG_TC_DTG);
> > +       dcss_dtg_write(dtg, ((dis_ulc_y << TC_Y_POS) | dis_ulc_x),
> > +                      DCSS_DTG_TC_DISP_TOP);
> > +       dcss_dtg_write(dtg, ((dis_lrc_y << TC_Y_POS) | dis_lrc_x),
> > +                      DCSS_DTG_TC_DISP_BOT);
> > +
> > +       dtg->dis_ulc_x = dis_ulc_x;
> > +       dtg->dis_ulc_y = dis_ulc_y;
> > +
> > +       sb_ctxld_trig = ((0 * dis_lrc_y / 100) << TC_CTXLD_SB_Y_POS) &
> > +                                                       TC_CTXLD_SB_Y_MASK;
> > +       db_ctxld_trig = ((99 * dis_lrc_y / 100) << TC_CTXLD_DB_Y_POS) &
> > +                                                       TC_CTXLD_DB_Y_MASK;
> > +
> > +       dcss_dtg_write(dtg, sb_ctxld_trig | db_ctxld_trig, DCSS_DTG_TC_CTXLD);
> > +
> > +       /* vblank trigger */
> > +       dcss_dtg_write(dtg, 0, DCSS_DTG_LINE1_INT);
> > +
> > +       /* CTXLD trigger */
> > +       dcss_dtg_write(dtg, ((90 * dis_lrc_y) / 100) << 16, DCSS_DTG_LINE0_INT);
> > +}
> > +
> > +void dcss_dtg_plane_pos_set(struct dcss_dtg *dtg, int ch_num,
> > +                           int px, int py, int pw, int ph)
> > +{
> > +       u16 p_ulc_x, p_ulc_y;
> > +       u16 p_lrc_x, p_lrc_y;
> > +
> > +       p_ulc_x = dtg->dis_ulc_x + px;
> > +       p_ulc_y = dtg->dis_ulc_y + py;
> > +       p_lrc_x = p_ulc_x + pw;
> > +       p_lrc_y = p_ulc_y + ph;
> > +
> > +       if (!px && !py && !pw && !ph) {
> > +               dcss_dtg_write(dtg, 0, DCSS_DTG_TC_CH1_TOP + 0x8 * ch_num);
> > +               dcss_dtg_write(dtg, 0, DCSS_DTG_TC_CH1_BOT + 0x8 * ch_num);
> > +       } else {
> > +               dcss_dtg_write(dtg, ((p_ulc_y << TC_Y_POS) | p_ulc_x),
> > +                              DCSS_DTG_TC_CH1_TOP + 0x8 * ch_num);
> > +               dcss_dtg_write(dtg, ((p_lrc_y << TC_Y_POS) | p_lrc_x),
> > +                              DCSS_DTG_TC_CH1_BOT + 0x8 * ch_num);
> > +       }
> > +}
> > +
> > +bool dcss_dtg_global_alpha_changed(struct dcss_dtg *dtg, int ch_num, int alpha)
> > +{
> > +       if (ch_num)
> > +               return false;
> > +
> > +       return alpha != dtg->alpha;
> > +}
> > +
> > +void dcss_dtg_plane_alpha_set(struct dcss_dtg *dtg, int ch_num,
> > +                             const struct drm_format_info *format, int alpha)
> > +{
> > +       u32 alpha_val;
> > +
> > +       /* we care about alpha only when channel 0 is concerned */
> > +       if (ch_num)
> > +               return;
> > +
> > +       alpha_val = (alpha << DEFAULT_FG_ALPHA_POS) & DEFAULT_FG_ALPHA_MASK;
> > +
> > +       /*
> > +        * Use global alpha if pixel format does not have alpha channel or the
> > +        * user explicitly chose to use global alpha (i.e. alpha is not OPAQUE).
> > +        */
> > +       if (!format->has_alpha || alpha != 255) {
> > +               dtg->control_status &= ~(CH1_ALPHA_SEL | DEFAULT_FG_ALPHA_MASK);
> > +               dtg->control_status |= alpha_val;
> > +       } else { /* use per-pixel alpha otherwise */
> > +               dtg->control_status |= CH1_ALPHA_SEL;
> > +       }
> > +
> > +       dtg->alpha = alpha;
> > +}
> > +
> > +void dcss_dtg_css_set(struct dcss_dtg *dtg)
> > +{
> > +       dtg->control_status |=
> > +                       (0x5 << CSS_PIX_COMP_SWAP_POS) & CSS_PIX_COMP_SWAP_MASK;
> > +}
> > +
> > +static void dcss_dtg_disable_callback(void *data)
> > +{
> > +       struct dcss_dtg *dtg = data;
> > +
> > +       dtg->control_status &= ~DTG_START;
> > +
> > +       dcss_writel(dtg->control_status,
> > +                   dtg->base_reg + DCSS_DTG_TC_CONTROL_STATUS);
> > +
> > +       dtg->in_use = false;
> > +
> > +       complete(dtg->dis_completion);
> > +}
> > +
> > +void dcss_dtg_enable(struct dcss_dtg *dtg, bool en,
> > +                    struct completion *dis_completion)
> > +{
> > +       if (!en) {
> > +               dtg->dis_completion = dis_completion;
> > +               dcss_ctxld_register_dtg_disable_cb(dtg->ctxld,
> > +                                                  dcss_dtg_disable_callback,
> > +                                                  dtg);
> > +               return;
> > +       }
> > +
> > +       dtg->dis_completion = NULL;
> > +
> > +       dtg->control_status |= DTG_START;
> > +
> > +       dcss_dtg_write(dtg, dtg->control_status, DCSS_DTG_TC_CONTROL_STATUS);
> > +
> > +       dtg->in_use = true;
> > +}
> > +
> > +bool dcss_dtg_is_enabled(struct dcss_dtg *dtg)
> > +{
> > +       return dtg->in_use;
> > +}
> > +
> > +void dcss_dtg_ch_enable(struct dcss_dtg *dtg, int ch_num, bool en)
> > +{
> > +       u32 ch_en_map[] = {CH1_EN, CH2_EN, CH3_EN};
> > +       u32 control_status;
> > +
> > +       control_status = dtg->control_status & ~ch_en_map[ch_num];
> > +       control_status |= en ? ch_en_map[ch_num] : 0;
> > +
> > +       if (dtg->control_status != control_status)
> > +               dcss_dtg_write(dtg, control_status, DCSS_DTG_TC_CONTROL_STATUS);
> > +
> > +       dtg->control_status = control_status;
> > +}
> > +
> > +void dcss_dtg_vblank_irq_enable(struct dcss_dtg *dtg, bool en)
> > +{
> > +       u32 status;
> > +
> > +       dcss_update(LINE1_IRQ, LINE1_IRQ, dtg->base_reg + DCSS_DTG_INT_MASK);
> > +
> > +       if (en) {
> > +               status = dcss_readl(dtg->base_reg + DCSS_DTG_INT_STATUS);
> > +               dcss_writel(status & LINE1_IRQ,
> > +                           dtg->base_reg + DCSS_DTG_INT_CONTROL);
> > +       }
> > +}
> > +
> > +void dcss_dtg_ctxld_kick_irq_enable(struct dcss_dtg *dtg, bool en)
> > +{
> > +       u32 status;
> > +
> > +       if (en) {
> > +               status = dcss_readl(dtg->base_reg + DCSS_DTG_INT_STATUS);
> > +
> > +               if (!dtg->ctxld_kick_irq_en) {
> > +                       dcss_writel(status & LINE0_IRQ,
> > +                                   dtg->base_reg + DCSS_DTG_INT_CONTROL);
> > +                       enable_irq(dtg->ctxld_kick_irq);
> > +                       dtg->ctxld_kick_irq_en = true;
> > +                       return;
> > +               }
> > +
> > +               return;
> > +       }
> > +
> > +       if (!dtg->ctxld_kick_irq_en)
> > +               return;
> > +
> > +       disable_irq_nosync(dtg->ctxld_kick_irq);
> > +       dtg->ctxld_kick_irq_en = false;
> > +}
> > +
> > +void dcss_dtg_vblank_irq_clear(struct dcss_dtg *dtg)
> > +{
> > +       dcss_update(LINE1_IRQ, LINE1_IRQ, dtg->base_reg + DCSS_DTG_INT_CONTROL);
> > +}
> > +
> > +bool dcss_dtg_vblank_irq_valid(struct dcss_dtg *dtg)
> > +{
> > +       return !!(dcss_readl(dtg->base_reg + DCSS_DTG_INT_STATUS) & LINE1_IRQ);
> > +}
> > +
> > diff --git a/drivers/gpu/drm/imx/dcss/dcss-kms.c b/drivers/gpu/drm/imx/dcss/dcss-kms.c
> > new file mode 100644
> > index 00000000..d3bc889
> > --- /dev/null
> > +++ b/drivers/gpu/drm/imx/dcss/dcss-kms.c
> > @@ -0,0 +1,321 @@
> > +// SPDX-License-Identifier: GPL-2.0
> > +/*
> > + * Copyright 2019 NXP.
> > + */
> > +
> > +#include <drm/drm_atomic.h>
> > +#include <drm/drm_atomic_helper.h>
> > +#include <drm/drm_fb_helper.h>
> > +#include <drm/drm_gem_cma_helper.h>
> > +#include <drm/drm_gem_framebuffer_helper.h>
> > +#include <drm/drm_of.h>
> > +#include <drm/drm_probe_helper.h>
> > +#include <drm/drmP.h>
> > +#include <linux/component.h>
> > +
> > +#include "dcss-dev.h"
> > +#include "dcss-kms.h"
> > +
> > +DEFINE_DRM_GEM_CMA_FOPS(dcss_cma_fops);
> > +
> > +struct dcss_drm_commit {
> > +       struct work_struct work;
> > +       struct drm_device *drm;
> > +       struct drm_atomic_state *state;
> > +};
> > +
> > +static void dcss_drm_atomic_commit_tail(struct dcss_drm_commit *commit)
> > +{
> > +       struct drm_atomic_state *state = commit->state;
> > +       struct drm_device *drm = commit->drm;
> > +       struct dcss_kms_dev *kms = container_of(drm, struct dcss_kms_dev, base);
> > +
> > +       drm_atomic_helper_wait_for_fences(drm, state, false);
> > +
> > +       drm_atomic_helper_wait_for_dependencies(state);
> > +
> > +       drm_atomic_helper_commit_modeset_disables(drm, state);
> > +
> > +       drm_atomic_helper_commit_modeset_enables(drm, state);
> > +
> > +       drm_atomic_helper_commit_planes(drm, state,
> > +                                       DRM_PLANE_COMMIT_ACTIVE_ONLY);
> > +
> > +       drm_atomic_helper_commit_hw_done(state);
> > +
> > +       drm_atomic_helper_wait_for_vblanks(drm, state);
> > +
> > +       drm_atomic_helper_cleanup_planes(drm, state);
> > +
> > +       drm_atomic_helper_commit_cleanup_done(state);
> > +
> > +       drm_atomic_state_put(state);
> > +
> > +       spin_lock(&kms->commit.wait.lock);
> > +       kms->commit.pending = false;
> > +       wake_up_all_locked(&kms->commit.wait);
> > +       spin_unlock(&kms->commit.wait.lock);
> > +
> > +       kfree(commit);
> > +}
> > +
> > +static void dcss_commit_work(struct work_struct *work)
> > +{
> > +       struct dcss_drm_commit *commit = container_of(work,
> > +                                                     struct dcss_drm_commit,
> > +                                                     work);
> > +
> > +       dcss_drm_atomic_commit_tail(commit);
> > +}
> > +
> > +static int dcss_drm_atomic_commit(struct drm_device *drm,
> > +                                 struct drm_atomic_state *state,
> > +                                 bool nonblock)
> > +{
> > +       int ret;
> > +       struct dcss_kms_dev *kms = container_of(drm, struct dcss_kms_dev, base);
> > +       struct dcss_drm_commit *commit;
> > +
> > +       if (state->async_update) {
> > +               ret = drm_atomic_helper_prepare_planes(drm, state);
> > +               if (ret)
> > +                       return ret;
> > +
> > +               drm_atomic_helper_async_commit(drm, state);
> > +               drm_atomic_helper_cleanup_planes(drm, state);
> > +
> > +               return 0;
> > +       }
> > +
> > +       commit = kzalloc(sizeof(*commit), GFP_KERNEL);
> > +       if (!commit)
> > +               return -ENOMEM;
> > +
> > +       commit->drm = drm;
> > +       commit->state = state;
> > +
> > +       ret = drm_atomic_helper_setup_commit(state, nonblock);
> > +       if (ret)
> > +               goto err_free;
> > +
> > +       INIT_WORK(&commit->work, dcss_commit_work);
> > +
> > +       ret = drm_atomic_helper_prepare_planes(drm, state);
> > +       if (ret)
> > +               goto err_free;
> > +
> > +       if (!nonblock) {
> > +               ret = drm_atomic_helper_wait_for_fences(drm, state, true);
> > +               if (ret)
> > +                       goto err;
> > +       }
> > +
> > +       spin_lock(&kms->commit.wait.lock);
> > +       ret = wait_event_interruptible_locked(kms->commit.wait,
> > +                                             !kms->commit.pending);
> > +       if (ret == 0)
> > +               kms->commit.pending = true;
> > +       spin_unlock(&kms->commit.wait.lock);
> > +
> > +       if (ret)
> > +               goto err;
> > +
> > +       ret = drm_atomic_helper_swap_state(state, true);
> > +       if (ret)
> > +               goto err;
> > +
> > +       drm_atomic_state_get(state);
> > +       if (nonblock)
> > +               queue_work(kms->commit_wq, &commit->work);
> > +       else
> > +               dcss_drm_atomic_commit_tail(commit);
> > +
> > +       return 0;
> > +
> > +err:
> > +       drm_atomic_helper_cleanup_planes(drm, state);
> > +
> > +err_free:
> > +       kfree(commit);
> > +       return ret;
> > +}
> > +
> > +const struct drm_mode_config_funcs dcss_drm_mode_config_funcs = {
> > +       .fb_create = drm_gem_fb_create,
> > +       .output_poll_changed = drm_fb_helper_output_poll_changed,
> > +       .atomic_check = drm_atomic_helper_check,
> > +       .atomic_commit = dcss_drm_atomic_commit,
> > +};
> > +
> > +static struct drm_driver dcss_kms_driver = {
> > +       .driver_features        = DRIVER_MODESET | DRIVER_GEM | DRIVER_ATOMIC,
> > +       .gem_free_object_unlocked = drm_gem_cma_free_object,
> > +       .gem_vm_ops             = &drm_gem_cma_vm_ops,
> > +       .dumb_create            = drm_gem_cma_dumb_create,
> > +
> > +       .prime_handle_to_fd     = drm_gem_prime_handle_to_fd,
> > +       .prime_fd_to_handle     = drm_gem_prime_fd_to_handle,
> > +       .gem_prime_import       = drm_gem_prime_import,
> > +       .gem_prime_export       = drm_gem_prime_export,
> > +       .gem_prime_get_sg_table = drm_gem_cma_prime_get_sg_table,
> > +       .gem_prime_import_sg_table = drm_gem_cma_prime_import_sg_table,
> > +       .gem_prime_vmap         = drm_gem_cma_prime_vmap,
> > +       .gem_prime_vunmap       = drm_gem_cma_prime_vunmap,
> > +       .gem_prime_mmap         = drm_gem_cma_prime_mmap,
> > +       .fops                   = &dcss_cma_fops,
> > +       .name                   = "imx-dcss",
> > +       .desc                   = "i.MX8MQ Display Subsystem",
> > +       .date                   = "20190917",
> > +       .major                  = 1,
> > +       .minor                  = 0,
> > +       .patchlevel             = 0,
> > +};
> > +
> > +static const struct drm_mode_config_helper_funcs dcss_mode_config_helpers = {
> > +       .atomic_commit_tail = drm_atomic_helper_commit_tail_rpm,
> > +};
> > +
> > +static void dcss_kms_mode_config_init(struct dcss_kms_dev *kms)
> > +{
> > +       struct drm_mode_config *config = &kms->base.mode_config;
> > +
> > +       drm_mode_config_init(&kms->base);
> > +
> > +       config->min_width = 1;
> > +       config->min_height = 1;
> > +       config->max_width = 4096;
> > +       config->max_height = 4096;
> > +       config->allow_fb_modifiers = true;
> > +       config->normalize_zpos = true;
> > +
> > +       config->funcs = &dcss_drm_mode_config_funcs;
> > +       config->helper_private = &dcss_mode_config_helpers;
> > +}
> > +
> > +static const struct drm_encoder_funcs dcss_kms_simple_encoder_funcs = {
> > +       .destroy = drm_encoder_cleanup,
> > +};
> > +
> > +static int dcss_kms_setup_encoder(struct dcss_kms_dev *kms)
> > +{
> > +       struct drm_device *ddev = &kms->base;
> > +       struct drm_encoder *encoder = &kms->encoder;
> > +       struct drm_crtc *crtc = (struct drm_crtc *)&kms->crtc;
> > +       struct drm_panel *panel;
> > +       struct drm_bridge *bridge;
> > +       int ret;
> > +
> > +       ret = drm_of_find_panel_or_bridge(ddev->dev->of_node, 0, 0,
> > +                                         &panel, &bridge);
> > +       if (ret)
> > +               return ret;
> > +
> > +       if (!bridge) {
> > +               dev_err(ddev->dev, "No bridge found %d.\n", ret);
> > +               return -ENODEV;
> > +       }
> > +
> > +       encoder->possible_crtcs = drm_crtc_mask(crtc);
> > +
> > +       ret = drm_encoder_init(&kms->base, encoder,
> > +                              &dcss_kms_simple_encoder_funcs,
> > +                              DRM_MODE_ENCODER_NONE, NULL);
> > +       if (ret) {
> > +               dev_err(ddev->dev, "Failed initializing encoder %d.\n", ret);
> > +               return ret;
> > +       }
> > +
> > +       return drm_bridge_attach(encoder, bridge, NULL);
> > +}
> > +
> > +struct dcss_kms_dev *dcss_kms_attach(struct dcss_dev *dcss, bool componentized)
> > +{
> > +       struct dcss_kms_dev *kms = kzalloc(sizeof(*kms), GFP_KERNEL);
> > +       struct drm_device *drm;
> > +       struct dcss_crtc *crtc;
> > +       int ret;
> > +
> > +       if (!kms)
> > +               return ERR_PTR(-ENOMEM);
> > +
> > +       drm = &kms->base;
> > +       crtc = &kms->crtc;
> > +       ret = drm_dev_init(drm, &dcss_kms_driver, dcss->dev);
> > +       if (ret)
> > +               goto free_kms;
> > +
> > +       drm->dev_private = dcss;
> > +
> > +       dcss_kms_mode_config_init(kms);
> > +
> > +       ret = drm_vblank_init(drm, 1);
> > +       if (ret)
> > +               goto cleanup_mode_config;
> > +
> > +       drm->irq_enabled = true;
> > +
> > +       ret = dcss_crtc_init(crtc, drm);
> > +       if (ret)
> > +               goto cleanup_mode_config;
> > +
> > +       kms->commit_wq = alloc_ordered_workqueue("dcss_nonblock_commit_wq", 0);
> > +       if (!kms->commit_wq) {
> > +               ret = -ENOMEM;
> > +               goto cleanup_crtc;
> > +       }
> > +
> > +       init_waitqueue_head(&kms->commit.wait);
> > +
> > +       if (componentized)
> > +               ret = component_bind_all(dcss->dev, kms);
> > +       else
> > +               ret = dcss_kms_setup_encoder(kms);
> > +
> > +       if (ret)
> > +               goto cleanup_wq;
> > +
> > +       drm_mode_config_reset(drm);
> > +
> > +       drm_kms_helper_poll_init(drm);
> > +
> > +       ret = drm_dev_register(drm, 0);
> > +       if (ret)
> > +               goto cleanup_wq;
> > +
> > +       drm_fbdev_generic_setup(drm, 32);
> > +
> > +       return kms;
> > +
> > +cleanup_wq:
> > +       drm_kms_helper_poll_fini(drm);
> > +       destroy_workqueue(kms->commit_wq);
> > +
> > +cleanup_crtc:
> > +       dcss_crtc_deinit(crtc, drm);
> > +
> > +cleanup_mode_config:
> > +       drm_mode_config_cleanup(drm);
> > +
> > +free_kms:
> > +       kfree(kms);
> > +       return ERR_PTR(ret);
> > +}
> > +
> > +void dcss_kms_detach(struct dcss_kms_dev *kms, bool componentized)
> > +{
> > +       struct drm_device *drm = &kms->base;
> > +       struct dcss_dev *dcss = drm->dev_private;
> > +
> > +       drm_dev_unregister(drm);
> > +       drm_kms_helper_poll_fini(drm);
> > +       drm_atomic_helper_shutdown(drm);
> > +       drm_crtc_vblank_off(&kms->crtc.base);
> > +       drm->irq_enabled = false;
> > +       drm_mode_config_cleanup(drm);
> > +       destroy_workqueue(kms->commit_wq);
> > +       dcss_crtc_deinit(&kms->crtc, drm);
> > +       if (componentized)
> > +               component_unbind_all(dcss->dev, drm);
> > +       drm->dev_private = NULL;
> > +       drm_dev_put(drm);
> > +}
> > diff --git a/drivers/gpu/drm/imx/dcss/dcss-kms.h b/drivers/gpu/drm/imx/dcss/dcss-kms.h
> > new file mode 100644
> > index 00000000..6297005
> > --- /dev/null
> > +++ b/drivers/gpu/drm/imx/dcss/dcss-kms.h
> > @@ -0,0 +1,52 @@
> > +/* SPDX-License-Identifier: GPL-2.0 */
> > +/*
> > + * Copyright 2019 NXP.
> > + */
> > +
> > +#ifndef _DCSS_KMS_H_
> > +#define _DCSS_KMS_H_
> > +
> > +#include <drm/drm_encoder.h>
> > +
> > +struct dcss_plane {
> > +       struct drm_plane base;
> > +
> > +       int ch_num;
> > +};
> > +
> > +struct dcss_crtc {
> > +       struct drm_crtc         base;
> > +       struct drm_crtc_state   *state;
> > +
> > +       struct dcss_plane       *plane[3];
> > +
> > +       int                     irq;
> > +       bool                    irq_enabled;
> > +
> > +       struct completion en_completion;
> > +       struct completion dis_completion;
> > +};
> > +
> > +struct commit {
> > +       wait_queue_head_t wait;
> > +       bool pending;
> > +};
> > +
> > +struct dcss_kms_dev {
> > +       struct drm_device base;
> > +       struct dcss_crtc crtc;
> > +       struct drm_encoder encoder;
> > +       struct workqueue_struct *commit_wq;
> > +       struct commit commit;
> > +};
> > +
> > +struct dcss_kms_dev *dcss_kms_attach(struct dcss_dev *dcss, bool componentized);
> > +void dcss_kms_detach(struct dcss_kms_dev *kms, bool componentized);
> > +int dcss_crtc_init(struct dcss_crtc *crtc, struct drm_device *drm);
> > +void dcss_crtc_deinit(struct dcss_crtc *crtc, struct drm_device *drm);
> > +struct dcss_plane *dcss_plane_init(struct drm_device *drm,
> > +                                  unsigned int possible_crtcs,
> > +                                  enum drm_plane_type type,
> > +                                  unsigned int zpos);
> > +
> > +#endif
> > diff --git a/drivers/gpu/drm/imx/dcss/dcss-plane.c b/drivers/gpu/drm/imx/dcss/dcss-plane.c
> > new file mode 100644
> > index 00000000..cb18c3e
> > --- /dev/null
> > +++ b/drivers/gpu/drm/imx/dcss/dcss-plane.c
> > @@ -0,0 +1,418 @@
> > +// SPDX-License-Identifier: GPL-2.0
> > +/*
> > + * Copyright 2019 NXP.
> > + */
> > +
> > +#include <drm/drm_atomic.h>
> > +#include <drm/drm_atomic_helper.h>
> > +#include <drm/drm_fb_cma_helper.h>
> > +#include <drm/drm_gem_framebuffer_helper.h>
> > +#include <drm/drm_gem_cma_helper.h>
> > +
> > +#include "dcss-dev.h"
> > +#include "dcss-kms.h"
> > +
> > +static const u32 dcss_common_formats[] = {
> > +       /* RGB */
> > +       DRM_FORMAT_ARGB8888,
> > +       DRM_FORMAT_XRGB8888,
> > +       DRM_FORMAT_ABGR8888,
> > +       DRM_FORMAT_XBGR8888,
> > +       DRM_FORMAT_RGBA8888,
> > +       DRM_FORMAT_RGBX8888,
> > +       DRM_FORMAT_BGRA8888,
> > +       DRM_FORMAT_BGRX8888,
> > +       DRM_FORMAT_XRGB2101010,
> > +       DRM_FORMAT_XBGR2101010,
> > +       DRM_FORMAT_RGBX1010102,
> > +       DRM_FORMAT_BGRX1010102,
> > +       DRM_FORMAT_ARGB2101010,
> > +       DRM_FORMAT_ABGR2101010,
> > +       DRM_FORMAT_RGBA1010102,
> > +       DRM_FORMAT_BGRA1010102,
> > +
> > +       /* YUV444 */
> > +       DRM_FORMAT_AYUV,
> > +
> > +       /* YUV422 */
> > +       DRM_FORMAT_UYVY,
> > +       DRM_FORMAT_VYUY,
> > +       DRM_FORMAT_YUYV,
> > +       DRM_FORMAT_YVYU,
> > +
> > +       /* YUV420 */
> > +       DRM_FORMAT_NV12,
> > +       DRM_FORMAT_NV21,
> > +};
> > +
> > +static const u64 dcss_video_format_modifiers[] = {
> > +       DRM_FORMAT_MOD_LINEAR,
> > +       DRM_FORMAT_MOD_INVALID,
> > +};
> > +
> > +static const u64 dcss_graphics_format_modifiers[] = {
> > +       DRM_FORMAT_MOD_VIVANTE_TILED,
> > +       DRM_FORMAT_MOD_VIVANTE_SUPER_TILED,
> > +       DRM_FORMAT_MOD_LINEAR,
> > +       DRM_FORMAT_MOD_INVALID,
> > +};
> > +
> > +static inline struct dcss_plane *to_dcss_plane(struct drm_plane *p)
> > +{
> > +       return container_of(p, struct dcss_plane, base);
> > +}
> > +
> > +static inline bool dcss_plane_fb_is_linear(const struct drm_framebuffer *fb)
> > +{
> > +       return ((fb->flags & DRM_MODE_FB_MODIFIERS) == 0) ||
> > +              ((fb->flags & DRM_MODE_FB_MODIFIERS) != 0 &&
> > +               fb->modifier == DRM_FORMAT_MOD_LINEAR);
> > +}
> > +
> > +static void dcss_plane_destroy(struct drm_plane *plane)
> > +{
> > +       struct dcss_plane *dcss_plane = container_of(plane, struct dcss_plane,
> > +                                                    base);
> > +
> > +       drm_plane_cleanup(plane);
> > +       kfree(dcss_plane);
> > +}
> > +
> > +static bool dcss_plane_format_mod_supported(struct drm_plane *plane,
> > +                                           u32 format,
> > +                                           u64 modifier)
> > +{
> > +       switch (plane->type) {
> > +       case DRM_PLANE_TYPE_PRIMARY:
> > +               switch (format) {
> > +               case DRM_FORMAT_ARGB8888:
> > +               case DRM_FORMAT_XRGB8888:
> > +               case DRM_FORMAT_ARGB2101010:
> > +                       return modifier == DRM_FORMAT_MOD_LINEAR ||
> > +                              modifier == DRM_FORMAT_MOD_VIVANTE_TILED ||
> > +                              modifier == DRM_FORMAT_MOD_VIVANTE_SUPER_TILED;
> > +               default:
> > +                       return modifier == DRM_FORMAT_MOD_LINEAR;
> > +               }
> > +               break;
> > +       case DRM_PLANE_TYPE_OVERLAY:
> > +               return modifier == DRM_FORMAT_MOD_LINEAR;
> > +       default:
> > +               return false;
> > +       }
> > +}
> > +
> > +static const struct drm_plane_funcs dcss_plane_funcs = {
> > +       .update_plane           = drm_atomic_helper_update_plane,
> > +       .disable_plane          = drm_atomic_helper_disable_plane,
> > +       .destroy                = dcss_plane_destroy,
> > +       .reset                  = drm_atomic_helper_plane_reset,
> > +       .atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state,
> > +       .atomic_destroy_state   = drm_atomic_helper_plane_destroy_state,
> > +       .format_mod_supported   = dcss_plane_format_mod_supported,
> > +};
> > +
> > +static bool dcss_plane_can_rotate(const struct drm_format_info *format,
> > +                                 bool mod_present, u64 modifier,
> > +                                 unsigned int rotation)
> > +{
> > +       bool linear_format = !mod_present ||
> > +                            (mod_present && modifier == DRM_FORMAT_MOD_LINEAR);
> > +       u32 supported_rotation = DRM_MODE_ROTATE_0;
> > +
> > +       if (!format->is_yuv && linear_format)
> > +               supported_rotation = DRM_MODE_ROTATE_0 | DRM_MODE_ROTATE_180 |
> > +                                    DRM_MODE_REFLECT_MASK;
> > +       else if (!format->is_yuv &&
> > +                modifier == DRM_FORMAT_MOD_VIVANTE_TILED)
> > +               supported_rotation = DRM_MODE_ROTATE_MASK |
> > +                                    DRM_MODE_REFLECT_MASK;
> > +       else if (format->is_yuv && linear_format &&
> > +                (format->format == DRM_FORMAT_NV12 ||
> > +                 format->format == DRM_FORMAT_NV21))
> > +               supported_rotation = DRM_MODE_ROTATE_0 | DRM_MODE_ROTATE_180 |
> > +                                    DRM_MODE_REFLECT_MASK;
> > +
> > +       return !!(rotation & supported_rotation);
> > +}
> > +
> > +static bool dcss_plane_is_source_size_allowed(u16 src_w, u16 src_h, u32 pix_fmt)
> > +{
> > +       if (src_w < 64 &&
> > +           (pix_fmt == DRM_FORMAT_NV12 || pix_fmt == DRM_FORMAT_NV21))
> > +               return false;
> > +       else if (src_w < 32 &&
> > +                (pix_fmt == DRM_FORMAT_UYVY || pix_fmt == DRM_FORMAT_VYUY ||
> > +                 pix_fmt == DRM_FORMAT_YUYV || pix_fmt == DRM_FORMAT_YVYU))
> > +               return false;
> > +
> > +       return src_w >= 16 && src_h >= 8;
> > +}
> > +
> > +static int dcss_plane_atomic_check(struct drm_plane *plane,
> > +                                  struct drm_plane_state *state)
> > +{
> > +       struct dcss_plane *dcss_plane = to_dcss_plane(plane);
> > +       struct dcss_dev *dcss = plane->dev->dev_private;
> > +       struct drm_framebuffer *fb = state->fb;
> > +       bool is_primary_plane = plane->type == DRM_PLANE_TYPE_PRIMARY;
> > +       struct drm_gem_cma_object *cma_obj;
> > +       struct drm_crtc_state *crtc_state;
> > +       int hdisplay, vdisplay;
> > +       int min, max;
> > +       int ret;
> > +
> > +       if (!fb || !state->crtc)
> > +               return 0;
> > +
> > +       cma_obj = drm_fb_cma_get_gem_obj(fb, 0);
> > +       WARN_ON(!cma_obj);
> > +
> > +       crtc_state = drm_atomic_get_existing_crtc_state(state->state,
> > +                                                       state->crtc);
> > +
> > +       hdisplay = crtc_state->adjusted_mode.hdisplay;
> > +       vdisplay = crtc_state->adjusted_mode.vdisplay;
> > +
> > +       if (!dcss_plane_is_source_size_allowed(state->src_w >> 16,
> > +                                              state->src_h >> 16,
> > +                                              fb->format->format)) {
> > +               DRM_DEBUG_KMS("Source plane size is not allowed!\n");
> > +               return -EINVAL;
> > +       }
> > +
> > +       dcss_scaler_get_min_max_ratios(dcss->scaler, dcss_plane->ch_num,
> > +                                      &min, &max);
> > +
> > +       ret = drm_atomic_helper_check_plane_state(state, crtc_state,
> > +                                                 min, max, !is_primary_plane,
> > +                                                 false);
> > +       if (ret)
> > +               return ret;
> > +
> > +       if (!state->visible)
> > +               return 0;
> > +
> > +       if (!dcss_plane_can_rotate(fb->format,
> > +                                  !!(fb->flags & DRM_MODE_FB_MODIFIERS),
> > +                                  fb->modifier,
> > +                                  state->rotation)) {
> > +               DRM_DEBUG_KMS("requested rotation is not allowed!\n");
> > +               return -EINVAL;
> > +       }
> > +
> > +       if ((state->crtc_x < 0 || state->crtc_y < 0 ||
> > +            state->crtc_x + state->crtc_w > hdisplay ||
> > +            state->crtc_y + state->crtc_h > vdisplay) &&
> > +           !dcss_plane_fb_is_linear(fb)) {
> > +               DRM_DEBUG_KMS("requested cropping operation is not allowed!\n");
> > +               return -EINVAL;
> > +       }
> > +
> > +       if ((fb->flags & DRM_MODE_FB_MODIFIERS) &&
> > +           !plane->funcs->format_mod_supported(plane,
> > +                               fb->format->format,
> > +                               fb->modifier)) {
> > +               DRM_DEBUG_KMS("Invalid modifier: %llx", fb->modifier);
> > +               return -EINVAL;
> > +       }
> > +
> > +       return 0;
> > +}
> > +
> > +static void dcss_plane_atomic_set_base(struct dcss_plane *dcss_plane)
> > +{
> > +       struct drm_plane *plane = &dcss_plane->base;
> > +       struct drm_plane_state *state = plane->state;
> > +       struct dcss_dev *dcss = plane->dev->dev_private;
> > +       struct drm_framebuffer *fb = state->fb;
> > +       const struct drm_format_info *format = fb->format;
> > +       struct drm_gem_cma_object *cma_obj = drm_fb_cma_get_gem_obj(fb, 0);
> > +       unsigned long p1_ba = 0, p2_ba = 0;
> > +
> > +       if (!format->is_yuv ||
> > +           format->format == DRM_FORMAT_NV12 ||
> > +           format->format == DRM_FORMAT_NV21)
> > +               p1_ba = cma_obj->paddr + fb->offsets[0] +
> > +                       fb->pitches[0] * (state->src.y1 >> 16) +
> > +                       format->char_per_block[0] * (state->src.x1 >> 16);
> > +       else if (format->format == DRM_FORMAT_UYVY ||
> > +                format->format == DRM_FORMAT_VYUY ||
> > +                format->format == DRM_FORMAT_YUYV ||
> > +                format->format == DRM_FORMAT_YVYU)
> > +               p1_ba = cma_obj->paddr + fb->offsets[0] +
> > +                       fb->pitches[0] * (state->src.y1 >> 16) +
> > +                       2 * format->char_per_block[0] * (state->src.x1 >> 17);
> > +
> > +       if (format->format == DRM_FORMAT_NV12 ||
> > +           format->format == DRM_FORMAT_NV21)
> > +               p2_ba = cma_obj->paddr + fb->offsets[1] +
> > +                       (((fb->pitches[1] >> 1) * (state->src.y1 >> 17) +
> > +                       (state->src.x1 >> 17)) << 1);
> > +
> > +       dcss_dpr_addr_set(dcss->dpr, dcss_plane->ch_num, p1_ba, p2_ba,
> > +                         fb->pitches[0]);
> > +}
> > +
> > +static bool dcss_plane_needs_setup(struct drm_plane_state *state,
> > +                                  struct drm_plane_state *old_state)
> > +{
> > +       struct drm_framebuffer *fb = state->fb;
> > +       struct drm_framebuffer *old_fb = old_state->fb;
> > +
> > +       return state->crtc_x != old_state->crtc_x ||
> > +              state->crtc_y != old_state->crtc_y ||
> > +              state->crtc_w != old_state->crtc_w ||
> > +              state->crtc_h != old_state->crtc_h ||
> > +              state->src_x  != old_state->src_x  ||
> > +              state->src_y  != old_state->src_y  ||
> > +              state->src_w  != old_state->src_w  ||
> > +              state->src_h  != old_state->src_h  ||
> > +              fb->format->format != old_fb->format->format ||
> > +              fb->modifier  != old_fb->modifier ||
> > +              state->rotation != old_state->rotation;
> > +}
> > +
> > +static void dcss_plane_atomic_update(struct drm_plane *plane,
> > +                                    struct drm_plane_state *old_state)
> > +{
> > +       struct drm_plane_state *state = plane->state;
> > +       struct dcss_plane *dcss_plane = to_dcss_plane(plane);
> > +       struct dcss_dev *dcss = plane->dev->dev_private;
> > +       struct drm_framebuffer *fb = state->fb;
> > +       u32 pixel_format;
> > +       struct drm_crtc_state *crtc_state;
> > +       bool modifiers_present;
> > +       u32 src_w, src_h, dst_w, dst_h;
> > +       struct drm_rect src, dst;
> > +       bool enable = true;
> > +
> > +       if (!fb || !state->crtc || !state->visible)
> > +               return;
> > +
> > +       pixel_format = state->fb->format->format;
> > +       crtc_state = state->crtc->state;
> > +       modifiers_present = !!(fb->flags & DRM_MODE_FB_MODIFIERS);
> > +
> > +       if (old_state->fb && !drm_atomic_crtc_needs_modeset(crtc_state) &&
> > +           !dcss_plane_needs_setup(state, old_state)) {
> > +               dcss_plane_atomic_set_base(dcss_plane);
> > +               return;
> > +       }
> > +
> > +       src = plane->state->src;
> > +       dst = plane->state->dst;
> > +
> > +       /*
> > +        * The width and height after clipping.
> > +        */
> > +       src_w = drm_rect_width(&src) >> 16;
> > +       src_h = drm_rect_height(&src) >> 16;
> > +       dst_w = drm_rect_width(&dst);
> > +       dst_h = drm_rect_height(&dst);
> > +
> > +       if (plane->type == DRM_PLANE_TYPE_OVERLAY &&
> > +           modifiers_present && fb->modifier == DRM_FORMAT_MOD_LINEAR)
> > +               modifiers_present = false;
> > +
> > +       dcss_dpr_format_set(dcss->dpr, dcss_plane->ch_num, state->fb->format,
> > +                           modifiers_present ? fb->modifier :
> > +                                               DRM_FORMAT_MOD_LINEAR);
> > +       dcss_dpr_set_res(dcss->dpr, dcss_plane->ch_num, src_w, src_h);
> > +       dcss_dpr_set_rotation(dcss->dpr, dcss_plane->ch_num,
> > +                             state->rotation);
> > +
> > +       dcss_plane_atomic_set_base(dcss_plane);
> > +
> > +       dcss_scaler_setup(dcss->scaler, dcss_plane->ch_num,
> > +                         state->fb->format, src_w, src_h,
> > +                         dst_w, dst_h,
> > +                         drm_mode_vrefresh(&crtc_state->mode));
> > +
> > +       dcss_dtg_plane_pos_set(dcss->dtg, dcss_plane->ch_num,
> > +                              dst.x1, dst.y1, dst_w, dst_h);
> > +       dcss_dtg_plane_alpha_set(dcss->dtg, dcss_plane->ch_num,
> > +                                fb->format, state->alpha >> 8);
> > +
> > +       if (!dcss_plane->ch_num && (state->alpha >> 8) == 0)
> > +               enable = false;
> > +
> > +       dcss_dpr_enable(dcss->dpr, dcss_plane->ch_num, enable);
> > +       dcss_scaler_ch_enable(dcss->scaler, dcss_plane->ch_num, enable);
> > +
> > +       if (!enable)
> > +               dcss_dtg_plane_pos_set(dcss->dtg, dcss_plane->ch_num,
> > +                                      0, 0, 0, 0);
> > +
> > +       dcss_dtg_ch_enable(dcss->dtg, dcss_plane->ch_num, enable);
> > +}
> > +
> > +static void dcss_plane_atomic_disable(struct drm_plane *plane,
> > +                                     struct drm_plane_state *old_state)
> > +{
> > +       struct dcss_plane *dcss_plane = to_dcss_plane(plane);
> > +       struct dcss_dev *dcss = plane->dev->dev_private;
> > +
> > +       dcss_dpr_enable(dcss->dpr, dcss_plane->ch_num, false);
> > +       dcss_scaler_ch_enable(dcss->scaler, dcss_plane->ch_num, false);
> > +       dcss_dtg_plane_pos_set(dcss->dtg, dcss_plane->ch_num, 0, 0, 0, 0);
> > +       dcss_dtg_ch_enable(dcss->dtg, dcss_plane->ch_num, false);
> > +}
> > +
> > +static const struct drm_plane_helper_funcs dcss_plane_helper_funcs = {
> > +       .prepare_fb = drm_gem_fb_prepare_fb,
> > +       .atomic_check = dcss_plane_atomic_check,
> > +       .atomic_update = dcss_plane_atomic_update,
> > +       .atomic_disable = dcss_plane_atomic_disable,
> > +};
> > +
> > +struct dcss_plane *dcss_plane_init(struct drm_device *drm,
> > +                                  unsigned int possible_crtcs,
> > +                                  enum drm_plane_type type,
> > +                                  unsigned int zpos)
> > +{
> > +       struct dcss_plane *dcss_plane;
> > +       const u64 *format_modifiers = dcss_video_format_modifiers;
> > +       int ret;
> > +
> > +       if (zpos > 2)
> > +               return ERR_PTR(-EINVAL);
> > +
> > +       dcss_plane = kzalloc(sizeof(*dcss_plane), GFP_KERNEL);
> > +       if (!dcss_plane) {
> > +               DRM_ERROR("failed to allocate plane\n");
> > +               return ERR_PTR(-ENOMEM);
> > +       }
> > +
> > +       if (type == DRM_PLANE_TYPE_PRIMARY)
> > +               format_modifiers = dcss_graphics_format_modifiers;
> > +
> > +       ret = drm_universal_plane_init(drm, &dcss_plane->base, possible_crtcs,
> > +                                      &dcss_plane_funcs, dcss_common_formats,
> > +                                      ARRAY_SIZE(dcss_common_formats),
> > +                                      format_modifiers, type, NULL);
> > +       if (ret) {
> > +               DRM_ERROR("failed to initialize plane\n");
> > +               kfree(dcss_plane);
> > +               return ERR_PTR(ret);
> > +       }
> > +
> > +       drm_plane_helper_add(&dcss_plane->base, &dcss_plane_helper_funcs);
> > +
> > +       ret = drm_plane_create_zpos_immutable_property(&dcss_plane->base, zpos);
> > +       if (ret)
> > +               return ERR_PTR(ret);
> > +
> > +       drm_plane_create_rotation_property(&dcss_plane->base,
> > +                                          DRM_MODE_ROTATE_0,
> > +                                          DRM_MODE_ROTATE_0   |
> > +                                          DRM_MODE_ROTATE_90  |
> > +                                          DRM_MODE_ROTATE_180 |
> > +                                          DRM_MODE_ROTATE_270 |
> > +                                          DRM_MODE_REFLECT_X  |
> > +                                          DRM_MODE_REFLECT_Y);
> > +
> > +       dcss_plane->ch_num = zpos;
> > +
> > +       return dcss_plane;
> > +}
> > diff --git a/drivers/gpu/drm/imx/dcss/dcss-scaler.c b/drivers/gpu/drm/imx/dcss/dcss-scaler.c
> > new file mode 100644
> > index 00000000..3e317f4
> > --- /dev/null
> > +++ b/drivers/gpu/drm/imx/dcss/dcss-scaler.c
> > @@ -0,0 +1,830 @@
> > +// SPDX-License-Identifier: GPL-2.0
> > +/*
> > + * Copyright 2019 NXP.
> > + *
> > + * Scaling algorithms were contributed by Dzung Hoang <dzung.hoang@nxp.com>
> > + */
> > +
> > +#include <linux/device.h>
> > +
> > +#include "dcss-dev.h"
> > +
> > +#define DCSS_SCALER_CTRL                       0x00
> > +#define   SCALER_EN                            BIT(0)
> > +#define   REPEAT_EN                            BIT(4)
> > +#define   SCALE2MEM_EN                         BIT(8)
> > +#define   MEM2OFIFO_EN                         BIT(12)
> > +#define DCSS_SCALER_OFIFO_CTRL                 0x04
> > +#define   OFIFO_LOW_THRES_POS                  0
> > +#define   OFIFO_LOW_THRES_MASK                 GENMASK(9, 0)
> > +#define   OFIFO_HIGH_THRES_POS                 16
> > +#define   OFIFO_HIGH_THRES_MASK                        GENMASK(25, 16)
> > +#define   UNDERRUN_DETECT_CLR                  BIT(26)
> > +#define   LOW_THRES_DETECT_CLR                 BIT(27)
> > +#define   HIGH_THRES_DETECT_CLR                        BIT(28)
> > +#define   UNDERRUN_DETECT_EN                   BIT(29)
> > +#define   LOW_THRES_DETECT_EN                  BIT(30)
> > +#define   HIGH_THRES_DETECT_EN                 BIT(31)
> > +#define DCSS_SCALER_SDATA_CTRL                 0x08
> > +#define   YUV_EN                               BIT(0)
> > +#define   RTRAM_8LINES                         BIT(1)
> > +#define   Y_UV_BYTE_SWAP                       BIT(4)
> > +#define   A2R10G10B10_FORMAT_POS               8
> > +#define   A2R10G10B10_FORMAT_MASK              GENMASK(11, 8)
> > +#define DCSS_SCALER_BIT_DEPTH                  0x0C
> > +#define   LUM_BIT_DEPTH_POS                    0
> > +#define   LUM_BIT_DEPTH_MASK                   GENMASK(1, 0)
> > +#define   CHR_BIT_DEPTH_POS                    4
> > +#define   CHR_BIT_DEPTH_MASK                   GENMASK(5, 4)
> > +#define DCSS_SCALER_SRC_FORMAT                 0x10
> > +#define DCSS_SCALER_DST_FORMAT                 0x14
> > +#define   FORMAT_MASK                          GENMASK(1, 0)
> > +#define DCSS_SCALER_SRC_LUM_RES                        0x18
> > +#define DCSS_SCALER_SRC_CHR_RES                        0x1C
> > +#define DCSS_SCALER_DST_LUM_RES                        0x20
> > +#define DCSS_SCALER_DST_CHR_RES                        0x24
> > +#define   WIDTH_POS                            0
> > +#define   WIDTH_MASK                           GENMASK(11, 0)
> > +#define   HEIGHT_POS                           16
> > +#define   HEIGHT_MASK                          GENMASK(27, 16)
> > +#define DCSS_SCALER_V_LUM_START                        0x48
> > +#define   V_START_MASK                         GENMASK(15, 0)
> > +#define DCSS_SCALER_V_LUM_INC                  0x4C
> > +#define   V_INC_MASK                           GENMASK(15, 0)
> > +#define DCSS_SCALER_H_LUM_START                        0x50
> > +#define   H_START_MASK                         GENMASK(18, 0)
> > +#define DCSS_SCALER_H_LUM_INC                  0x54
> > +#define   H_INC_MASK                           GENMASK(15, 0)
> > +#define DCSS_SCALER_V_CHR_START                        0x58
> > +#define DCSS_SCALER_V_CHR_INC                  0x5C
> > +#define DCSS_SCALER_H_CHR_START                        0x60
> > +#define DCSS_SCALER_H_CHR_INC                  0x64
> > +#define DCSS_SCALER_COEF_VLUM                  0x80
> > +#define DCSS_SCALER_COEF_HLUM                  0x140
> > +#define DCSS_SCALER_COEF_VCHR                  0x200
> > +#define DCSS_SCALER_COEF_HCHR                  0x300
> > +
> > +struct dcss_scaler_ch {
> > +       void __iomem *base_reg;
> > +       u32 base_ofs;
> > +       struct dcss_scaler *scl;
> > +
> > +       u32 sdata_ctrl;
> > +       u32 scaler_ctrl;
> > +
> > +       bool scaler_ctrl_chgd;
> > +
> > +       u32 c_vstart;
> > +       u32 c_hstart;
> > +};
> > +
> > +struct dcss_scaler {
> > +       struct device *dev;
> > +
> > +       struct dcss_ctxld *ctxld;
> > +       u32 ctx_id;
> > +
> > +       struct dcss_scaler_ch ch[3];
> > +};
> > +
> > +/* scaler coefficients generator */
> > +#define PSC_FRAC_BITS 30
> > +#define PSC_FRAC_SCALE BIT(PSC_FRAC_BITS)
> > +#define PSC_BITS_FOR_PHASE 4
> > +#define PSC_NUM_PHASES 16
> > +#define PSC_STORED_PHASES (PSC_NUM_PHASES / 2 + 1)
> > +#define PSC_NUM_TAPS 7
> > +#define PSC_NUM_TAPS_RGBA 5
> > +#define PSC_COEFF_PRECISION 10
> > +#define PSC_PHASE_FRACTION_BITS 13
> > +#define PSC_PHASE_MASK (PSC_NUM_PHASES - 1)
> > +#define PSC_Q_FRACTION 19
> > +#define PSC_Q_ROUND_OFFSET (1 << (PSC_Q_FRACTION - 1))
> > +
> > +/**
> > + * mult_q() - Performs fixed-point multiplication.
> > + * @A: multiplier
> > + * @B: multiplicand
> > + */
> > +static int mult_q(int A, int B)
> > +{
> > +       int result;
> > +       s64 temp;
> > +
> > +       temp = (int64_t)A * (int64_t)B;
> > +       temp += PSC_Q_ROUND_OFFSET;
> > +       result = (int)(temp >> PSC_Q_FRACTION);
> > +       return result;
> > +}
> > +
> > +/**
> > + * div_q() - Performs fixed-point division.
> > + * @A: dividend
> > + * @B: divisor
> > + */
> > +static int div_q(int A, int B)
> > +{
> > +       int result;
> > +       s64 temp;
> > +
> > +       temp = (int64_t)A << PSC_Q_FRACTION;
> > +       if ((temp >= 0 && B >= 0) || (temp < 0 && B < 0))
> > +               temp += B / 2;
> > +       else
> > +               temp -= B / 2;
> > +
> > +       result = (int)(temp / B);
> > +       return result;
> > +}
> > +
> > +/**
> > + * exp_approx_q() - Compute approximation to exp(x) function using Taylor
> > + *                 series.
> > + * @x: fixed-point argument of exp function
> > + */
> > +static int exp_approx_q(int x)
> > +{
> > +       int sum = 1 << PSC_Q_FRACTION;
> > +       int term = 1 << PSC_Q_FRACTION;
> > +
> > +       term = mult_q(term, div_q(x, 1 << PSC_Q_FRACTION));
> > +       sum += term;
> > +       term = mult_q(term, div_q(x, 2 << PSC_Q_FRACTION));
> > +       sum += term;
> > +       term = mult_q(term, div_q(x, 3 << PSC_Q_FRACTION));
> > +       sum += term;
> > +       term = mult_q(term, div_q(x, 4 << PSC_Q_FRACTION));
> > +       sum += term;
> > +
> > +       return sum;
> > +}
> > +
> > +/**
> > + * dcss_scaler_gaussian_filter() - Generate gaussian prototype filter.
> > + * @fc_q: fixed-point cutoff frequency normalized to range [0, 1]
> > + * @use_5_taps: indicates whether to use 5 taps or 7 taps
> > + * @coef: output filter coefficients
> > + */
> > +static void dcss_scaler_gaussian_filter(int fc_q, bool use_5_taps,
> > +                                       bool phase0_identity,
> > +                                       int coef[][PSC_NUM_TAPS])
> > +{
> > +       int sigma_q, g0_q, g1_q, g2_q;
> > +       int tap_cnt1, tap_cnt2, tap_idx, phase_cnt;
> > +       int mid;
> > +       int phase;
> > +       int i;
> > +       int taps;
> > +
> > +       if (use_5_taps)
> > +               for (phase = 0; phase < PSC_STORED_PHASES; phase++) {
> > +                       coef[phase][0] = 0;
> > +                       coef[phase][PSC_NUM_TAPS - 1] = 0;
> > +               }
> > +
> > +       /* seed coefficient scanner */
> > +       taps = use_5_taps ? PSC_NUM_TAPS_RGBA : PSC_NUM_TAPS;
> > +       mid = (PSC_NUM_PHASES * taps) / 2 - 1;
> > +       phase_cnt = (PSC_NUM_PHASES * (PSC_NUM_TAPS + 1)) / 2;
> > +       tap_cnt1 = (PSC_NUM_PHASES * PSC_NUM_TAPS) / 2;
> > +       tap_cnt2 = (PSC_NUM_PHASES * PSC_NUM_TAPS) / 2;
> > +
> > +       /* seed gaussian filter generator */
> > +       sigma_q = div_q(PSC_Q_ROUND_OFFSET, fc_q);
> > +       g0_q = 1 << PSC_Q_FRACTION;
> > +       g1_q = exp_approx_q(div_q(-PSC_Q_ROUND_OFFSET,
> > +                                 mult_q(sigma_q, sigma_q)));
> > +       g2_q = mult_q(g1_q, g1_q);
> > +       coef[phase_cnt & PSC_PHASE_MASK][tap_cnt1 >> PSC_BITS_FOR_PHASE] = g0_q;
> > +
> > +       for (i = 0; i < mid; i++) {
> > +               phase_cnt++;
> > +               tap_cnt1--;
> > +               tap_cnt2++;
> > +
> > +               g0_q = mult_q(g0_q, g1_q);
> > +               g1_q = mult_q(g1_q, g2_q);
> > +
> > +               if ((phase_cnt & PSC_PHASE_MASK) <= 8) {
> > +                       tap_idx = tap_cnt1 >> PSC_BITS_FOR_PHASE;
> > +                       coef[phase_cnt & PSC_PHASE_MASK][tap_idx] = g0_q;
> > +               }
> > +               if (((-phase_cnt) & PSC_PHASE_MASK) <= 8) {
> > +                       tap_idx = tap_cnt2 >> PSC_BITS_FOR_PHASE;
> > +                       coef[(-phase_cnt) & PSC_PHASE_MASK][tap_idx] = g0_q;
> > +               }
> > +       }
> > +
> > +       phase_cnt++;
> > +       tap_cnt1--;
> > +       coef[phase_cnt & PSC_PHASE_MASK][tap_cnt1 >> PSC_BITS_FOR_PHASE] = 0;
> > +
> > +       /* override phase 0 with identity filter if specified */
> > +       if (phase0_identity)
> > +               for (i = 0; i < PSC_NUM_TAPS; i++)
> > +                       coef[0][i] = i == (PSC_NUM_TAPS >> 1) ?
> > +                                               (1 << PSC_COEFF_PRECISION) : 0;
> > +
> > +       /* normalize coef */
> > +       for (phase = 0; phase < PSC_STORED_PHASES; phase++) {
> > +               int sum = 0;
> > +               s64 ll_temp;
> > +
> > +               for (i = 0; i < PSC_NUM_TAPS; i++)
> > +                       sum += coef[phase][i];
> > +               for (i = 0; i < PSC_NUM_TAPS; i++) {
> > +                       ll_temp = coef[phase][i];
> > +                       ll_temp <<= PSC_COEFF_PRECISION;
> > +                       ll_temp += sum >> 1;
> > +                       ll_temp /= sum;
> > +                       coef[phase][i] = (int)ll_temp;
> > +               }
> > +       }
> > +}
> > +
> > +/**
> > + * dcss_scaler_filter_design() - Compute filter coefficients using
> > + *                              Gaussian filter.
> > + * @src_length: length of input
> > + * @dst_length: length of output
> > + * @use_5_taps: 0 for 7 taps per phase, 1 for 5 taps
> > + * @coef: output coefficients
> > + */
> > +static void dcss_scaler_filter_design(int src_length, int dst_length,
> > +                                     bool use_5_taps, bool phase0_identity,
> > +                                     int coef[][PSC_NUM_TAPS])
> > +{
> > +       int fc_q;
> > +
> > +       /* compute cutoff frequency */
> > +       if (dst_length >= src_length)
> > +               fc_q = div_q(1, PSC_NUM_PHASES);
> > +       else
> > +               fc_q = div_q(dst_length, src_length * PSC_NUM_PHASES);
> > +
> > +       /* compute gaussian filter coefficients */
> > +       dcss_scaler_gaussian_filter(fc_q, use_5_taps, phase0_identity, coef);
> > +}
> > +
> > +static void dcss_scaler_write(struct dcss_scaler_ch *ch, u32 val, u32 ofs)
> > +{
> > +       struct dcss_scaler *scl = ch->scl;
> > +
> > +       dcss_ctxld_write(scl->ctxld, scl->ctx_id, val, ch->base_ofs + ofs);
> > +}
> > +
> > +static int dcss_scaler_ch_init_all(struct dcss_scaler *scl,
> > +                                  unsigned long scaler_base)
> > +{
> > +       struct dcss_scaler_ch *ch;
> > +       int i;
> > +
> > +       for (i = 0; i < 3; i++) {
> > +               ch = &scl->ch[i];
> > +
> > +               ch->base_ofs = scaler_base + i * 0x400;
> > +
> > +               ch->base_reg = devm_ioremap(scl->dev, ch->base_ofs, SZ_4K);
> > +               if (!ch->base_reg) {
> > +                       dev_err(scl->dev, "scaler: unable to remap ch base\n");
> > +                       return -ENOMEM;
> > +               }
> > +
> > +               ch->scl = scl;
> > +       }
> > +
> > +       return 0;
> > +}
> > +
> > +int dcss_scaler_init(struct dcss_dev *dcss, unsigned long scaler_base)
> > +{
> > +       struct dcss_scaler *scaler;
> > +
> > +       scaler = devm_kzalloc(dcss->dev, sizeof(*scaler), GFP_KERNEL);
> > +       if (!scaler)
> > +               return -ENOMEM;
> > +
> > +       dcss->scaler = scaler;
> > +       scaler->dev = dcss->dev;
> > +       scaler->ctxld = dcss->ctxld;
> > +       scaler->ctx_id = CTX_SB_HP;
> > +
> > +       if (dcss_scaler_ch_init_all(scaler, scaler_base)) {
> > +               int i;
> > +
> > +               for (i = 0; i < 3; i++) {
> > +                       if (scaler->ch[i].base_reg)
> > +                               devm_iounmap(scaler->dev,
> > +                                            scaler->ch[i].base_reg);
> > +               }
> > +
> > +               devm_kfree(scaler->dev, scaler);
> > +
> > +               return -ENOMEM;
> > +       }
> > +
> > +       return 0;
> > +}
> > +
> > +void dcss_scaler_exit(struct dcss_scaler *scl)
> > +{
> > +       int ch_no;
> > +
> > +       for (ch_no = 0; ch_no < 3; ch_no++) {
> > +               struct dcss_scaler_ch *ch = &scl->ch[ch_no];
> > +
> > +               dcss_writel(0, ch->base_reg + DCSS_SCALER_CTRL);
> > +
> > +               if (ch->base_reg)
> > +                       devm_iounmap(scl->dev, ch->base_reg);
> > +       }
> > +
> > +       devm_kfree(scl->dev, scl);
> > +}
> > +
> > +void dcss_scaler_ch_enable(struct dcss_scaler *scl, int ch_num, bool en)
> > +{
> > +       struct dcss_scaler_ch *ch = &scl->ch[ch_num];
> > +       u32 scaler_ctrl;
> > +
> > +       scaler_ctrl = en ? SCALER_EN | REPEAT_EN : 0;
> > +
> > +       if (en)
> > +               dcss_scaler_write(ch, ch->sdata_ctrl, DCSS_SCALER_SDATA_CTRL);
> > +
> > +       if (ch->scaler_ctrl != scaler_ctrl)
> > +               ch->scaler_ctrl_chgd = true;
> > +
> > +       ch->scaler_ctrl = scaler_ctrl;
> > +}
> > +
> > +static void dcss_scaler_yuv_enable(struct dcss_scaler_ch *ch, bool en)
> > +{
> > +       ch->sdata_ctrl &= ~YUV_EN;
> > +       ch->sdata_ctrl |= en ? YUV_EN : 0;
> > +}
> > +
> > +static void dcss_scaler_rtr_8lines_enable(struct dcss_scaler_ch *ch, bool en)
> > +{
> > +       ch->sdata_ctrl &= ~RTRAM_8LINES;
> > +       ch->sdata_ctrl |= en ? RTRAM_8LINES : 0;
> > +}
> > +
> > +static void dcss_scaler_bit_depth_set(struct dcss_scaler_ch *ch, int depth)
> > +{
> > +       u32 val;
> > +
> > +       val = depth == 30 ? 2 : 0;
> > +
> > +       dcss_scaler_write(ch,
> > +                         ((val << CHR_BIT_DEPTH_POS) & CHR_BIT_DEPTH_MASK) |
> > +                         ((val << LUM_BIT_DEPTH_POS) & LUM_BIT_DEPTH_MASK),
> > +                         DCSS_SCALER_BIT_DEPTH);
> > +}
> > +
> > +enum buffer_format {
> > +       BUF_FMT_YUV420,
> > +       BUF_FMT_YUV422,
> > +       BUF_FMT_ARGB8888_YUV444,
> > +};
> > +
> > +enum chroma_location {
> > +       PSC_LOC_HORZ_0_VERT_1_OVER_4 = 0,
> > +       PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_4 = 1,
> > +       PSC_LOC_HORZ_0_VERT_0 = 2,
> > +       PSC_LOC_HORZ_1_OVER_4_VERT_0 = 3,
> > +       PSC_LOC_HORZ_0_VERT_1_OVER_2 = 4,
> > +       PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_2 = 5
> > +};
> > +
> > +static void dcss_scaler_format_set(struct dcss_scaler_ch *ch,
> > +                                  enum buffer_format src_fmt,
> > +                                  enum buffer_format dst_fmt)
> > +{
> > +       dcss_scaler_write(ch, src_fmt, DCSS_SCALER_SRC_FORMAT);
> > +       dcss_scaler_write(ch, dst_fmt, DCSS_SCALER_DST_FORMAT);
> > +}
> > +
> > +static void dcss_scaler_res_set(struct dcss_scaler_ch *ch,
> > +                               int src_xres, int src_yres,
> > +                               int dst_xres, int dst_yres,
> > +                               u32 pix_format, enum buffer_format dst_format)
> > +{
> > +       u32 lsrc_xres, lsrc_yres, csrc_xres, csrc_yres;
> > +       u32 ldst_xres, ldst_yres, cdst_xres, cdst_yres;
> > +       bool src_is_444 = true;
> > +
> > +       lsrc_xres = src_xres;
> > +       csrc_xres = src_xres;
> > +       lsrc_yres = src_yres;
> > +       csrc_yres = src_yres;
> > +       ldst_xres = dst_xres;
> > +       cdst_xres = dst_xres;
> > +       ldst_yres = dst_yres;
> > +       cdst_yres = dst_yres;
> > +
> > +       if (pix_format == DRM_FORMAT_UYVY || pix_format == DRM_FORMAT_VYUY ||
> > +           pix_format == DRM_FORMAT_YUYV || pix_format == DRM_FORMAT_YVYU) {
> > +               csrc_xres >>= 1;
> > +               src_is_444 = false;
> > +       } else if (pix_format == DRM_FORMAT_NV12 ||
> > +                  pix_format == DRM_FORMAT_NV21) {
> > +               csrc_xres >>= 1;
> > +               csrc_yres >>= 1;
> > +               src_is_444 = false;
> > +       }
> > +
> > +       if (dst_format == BUF_FMT_YUV422)
> > +               cdst_xres >>= 1;
> > +
> > +       /* for 4:4:4 to 4:2:2 conversion, source height should be 1 less */
> > +       if (src_is_444 && dst_format == BUF_FMT_YUV422) {
> > +               lsrc_yres--;
> > +               csrc_yres--;
> > +       }
> > +
> > +       dcss_scaler_write(ch, (((lsrc_yres - 1) << HEIGHT_POS) & HEIGHT_MASK) |
> > +                              (((lsrc_xres - 1) << WIDTH_POS) & WIDTH_MASK),
> > +                         DCSS_SCALER_SRC_LUM_RES);
> > +       dcss_scaler_write(ch, (((csrc_yres - 1) << HEIGHT_POS) & HEIGHT_MASK) |
> > +                              (((csrc_xres - 1) << WIDTH_POS) & WIDTH_MASK),
> > +                         DCSS_SCALER_SRC_CHR_RES);
> > +       dcss_scaler_write(ch, (((ldst_yres - 1) << HEIGHT_POS) & HEIGHT_MASK) |
> > +                              (((ldst_xres - 1) << WIDTH_POS) & WIDTH_MASK),
> > +                         DCSS_SCALER_DST_LUM_RES);
> > +       dcss_scaler_write(ch, (((cdst_yres - 1) << HEIGHT_POS) & HEIGHT_MASK) |
> > +                              (((cdst_xres - 1) << WIDTH_POS) & WIDTH_MASK),
> > +                         DCSS_SCALER_DST_CHR_RES);
> > +}
> > +
> > +#define max_downscale(ratio)           ((ratio) << 16)
> > +#define max_upscale(ratio)             ((1 << 16) / (ratio))
> > +
> > +struct dcss_scaler_ratios {
> > +       int downscale;
> > +       int upscale;
> > +};
> > +
> > +static const struct dcss_scaler_ratios dcss_scaler_ratios[] = {
> > +       {max_downscale(3), max_upscale(8)},
> > +       {max_downscale(5), max_upscale(8)},
> > +       {max_downscale(5), max_upscale(8)},
> > +};
> > +
> > +static void dcss_scaler_fractions_set(struct dcss_scaler_ch *ch,
> > +                                     int src_xres, int src_yres,
> > +                                     int dst_xres, int dst_yres,
> > +                                     u32 src_format, u32 dst_format,
> > +                                     enum chroma_location src_chroma_loc)
> > +{
> > +       int src_c_xres, src_c_yres, dst_c_xres, dst_c_yres;
> > +       u32 l_vinc, l_hinc, c_vinc, c_hinc;
> > +       u32 c_vstart, c_hstart;
> > +
> > +       src_c_xres = src_xres;
> > +       src_c_yres = src_yres;
> > +       dst_c_xres = dst_xres;
> > +       dst_c_yres = dst_yres;
> > +
> > +       c_vstart = 0;
> > +       c_hstart = 0;
> > +
> > +       /* adjustments for source chroma location */
> > +       if (src_format == BUF_FMT_YUV420) {
> > +               /* vertical input chroma position adjustment */
> > +               switch (src_chroma_loc) {
> > +               case PSC_LOC_HORZ_0_VERT_1_OVER_4:
> > +               case PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_4:
> > +                       /*
> > +                        * move chroma up to first luma line
> > +                        * (1/4 chroma input line spacing)
> > +                        */
> > +                       c_vstart -= (1 << (PSC_PHASE_FRACTION_BITS - 2));
> > +                       break;
> > +               case PSC_LOC_HORZ_0_VERT_1_OVER_2:
> > +               case PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_2:
> > +                       /*
> > +                        * move chroma up to first luma line
> > +                        * (1/2 chroma input line spacing)
> > +                        */
> > +                       c_vstart -= (1 << (PSC_PHASE_FRACTION_BITS - 1));
> > +                       break;
> > +               default:
> > +                       break;
> > +               }
> > +               /* horizontal input chroma position adjustment */
> > +               switch (src_chroma_loc) {
> > +               case PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_4:
> > +               case PSC_LOC_HORZ_1_OVER_4_VERT_0:
> > +               case PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_2:
> > +                       /* move chroma left 1/4 chroma input sample spacing */
> > +                       c_hstart -= (1 << (PSC_PHASE_FRACTION_BITS - 2));
> > +                       break;
> > +               default:
> > +                       break;
> > +               }
> > +       }
> > +
> > +       /* adjustments to chroma resolution */
> > +       if (src_format == BUF_FMT_YUV420) {
> > +               src_c_xres >>= 1;
> > +               src_c_yres >>= 1;
> > +       } else if (src_format == BUF_FMT_YUV422) {
> > +               src_c_xres >>= 1;
> > +       }
> > +
> > +       if (dst_format == BUF_FMT_YUV422)
> > +               dst_c_xres >>= 1;
> > +
> > +       l_vinc = ((src_yres << 13) + (dst_yres >> 1)) / dst_yres;
> > +       c_vinc = ((src_c_yres << 13) + (dst_c_yres >> 1)) / dst_c_yres;
> > +       l_hinc = ((src_xres << 13) + (dst_xres >> 1)) / dst_xres;
> > +       c_hinc = ((src_c_xres << 13) + (dst_c_xres >> 1)) / dst_c_xres;
> > +
> > +       /* save chroma start phase */
> > +       ch->c_vstart = c_vstart;
> > +       ch->c_hstart = c_hstart;
> > +
> > +       dcss_scaler_write(ch, 0, DCSS_SCALER_V_LUM_START);
> > +       dcss_scaler_write(ch, l_vinc, DCSS_SCALER_V_LUM_INC);
> > +
> > +       dcss_scaler_write(ch, 0, DCSS_SCALER_H_LUM_START);
> > +       dcss_scaler_write(ch, l_hinc, DCSS_SCALER_H_LUM_INC);
> > +
> > +       dcss_scaler_write(ch, c_vstart, DCSS_SCALER_V_CHR_START);
> > +       dcss_scaler_write(ch, c_vinc, DCSS_SCALER_V_CHR_INC);
> > +
> > +       dcss_scaler_write(ch, c_hstart, DCSS_SCALER_H_CHR_START);
> > +       dcss_scaler_write(ch, c_hinc, DCSS_SCALER_H_CHR_INC);
> > +}
> > +
> > +int dcss_scaler_get_min_max_ratios(struct dcss_scaler *scl, int ch_num,
> > +                                  int *min, int *max)
> > +{
> > +       *min = dcss_scaler_ratios[ch_num].upscale;
> > +       *max = dcss_scaler_ratios[ch_num].downscale;
> > +
> > +       return 0;
> > +}
> > +
> > +static void dcss_scaler_program_5_coef_set(struct dcss_scaler_ch *ch,
> > +                                          int base_addr,
> > +                                          int coef[][PSC_NUM_TAPS])
> > +{
> > +       int i, phase;
> > +
> > +       for (i = 0; i < PSC_STORED_PHASES; i++) {
> > +               dcss_scaler_write(ch, ((coef[i][1] & 0xfff) << 16 |
> > +                                      (coef[i][2] & 0xfff) << 4  |
> > +                                      (coef[i][3] & 0xf00) >> 8),
> > +                                 base_addr + i * sizeof(u32));
> > +               dcss_scaler_write(ch, ((coef[i][3] & 0x0ff) << 20 |
> > +                                      (coef[i][4] & 0xfff) << 8  |
> > +                                      (coef[i][5] & 0xff0) >> 4),
> > +                                 base_addr + 0x40 + i * sizeof(u32));
> > +               dcss_scaler_write(ch, ((coef[i][5] & 0x00f) << 24),
> > +                                 base_addr + 0x80 + i * sizeof(u32));
> > +       }
> > +
> > +       /* reverse both phase and tap orderings */
> > +       for (phase = (PSC_NUM_PHASES >> 1) - 1;
> > +                       i < PSC_NUM_PHASES; i++, phase--) {
> > +               dcss_scaler_write(ch, ((coef[phase][5] & 0xfff) << 16 |
> > +                                      (coef[phase][4] & 0xfff) << 4  |
> > +                                      (coef[phase][3] & 0xf00) >> 8),
> > +                                 base_addr + i * sizeof(u32));
> > +               dcss_scaler_write(ch, ((coef[phase][3] & 0x0ff) << 20 |
> > +                                      (coef[phase][2] & 0xfff) << 8  |
> > +                                      (coef[phase][1] & 0xff0) >> 4),
> > +                                 base_addr + 0x40 + i * sizeof(u32));
> > +               dcss_scaler_write(ch, ((coef[phase][1] & 0x00f) << 24),
> > +                                 base_addr + 0x80 + i * sizeof(u32));
> > +       }
> > +}
> > +
> > +static void dcss_scaler_program_7_coef_set(struct dcss_scaler_ch *ch,
> > +                                          int base_addr,
> > +                                          int coef[][PSC_NUM_TAPS])
> > +{
> > +       int i, phase;
> > +
> > +       for (i = 0; i < PSC_STORED_PHASES; i++) {
> > +               dcss_scaler_write(ch, ((coef[i][0] & 0xfff) << 16 |
> > +                                      (coef[i][1] & 0xfff) << 4  |
> > +                                      (coef[i][2] & 0xf00) >> 8),
> > +                                 base_addr + i * sizeof(u32));
> > +               dcss_scaler_write(ch, ((coef[i][2] & 0x0ff) << 20 |
> > +                                      (coef[i][3] & 0xfff) << 8  |
> > +                                      (coef[i][4] & 0xff0) >> 4),
> > +                                 base_addr + 0x40 + i * sizeof(u32));
> > +               dcss_scaler_write(ch, ((coef[i][4] & 0x00f) << 24 |
> > +                                      (coef[i][5] & 0xfff) << 12 |
> > +                                      (coef[i][6] & 0xfff)),
> > +                                 base_addr + 0x80 + i * sizeof(u32));
> > +       }
> > +
> > +       /* reverse both phase and tap orderings */
> > +       for (phase = (PSC_NUM_PHASES >> 1) - 1;
> > +                       i < PSC_NUM_PHASES; i++, phase--) {
> > +               dcss_scaler_write(ch, ((coef[phase][6] & 0xfff) << 16 |
> > +                                      (coef[phase][5] & 0xfff) << 4  |
> > +                                      (coef[phase][4] & 0xf00) >> 8),
> > +                                 base_addr + i * sizeof(u32));
> > +               dcss_scaler_write(ch, ((coef[phase][4] & 0x0ff) << 20 |
> > +                                      (coef[phase][3] & 0xfff) << 8  |
> > +                                      (coef[phase][2] & 0xff0) >> 4),
> > +                                 base_addr + 0x40 + i * sizeof(u32));
> > +               dcss_scaler_write(ch, ((coef[phase][2] & 0x00f) << 24 |
> > +                                      (coef[phase][1] & 0xfff) << 12 |
> > +                                      (coef[phase][0] & 0xfff)),
> > +                                 base_addr + 0x80 + i * sizeof(u32));
> > +       }
> > +}
> > +
> > +static void dcss_scaler_yuv_coef_set(struct dcss_scaler_ch *ch,
> > +                                    enum buffer_format src_format,
> > +                                    enum buffer_format dst_format,
> > +                                    bool use_5_taps,
> > +                                    int src_xres, int src_yres, int dst_xres,
> > +                                    int dst_yres)
> > +{
> > +       int coef[PSC_STORED_PHASES][PSC_NUM_TAPS];
> > +       bool program_5_taps = use_5_taps ||
> > +                             (dst_format == BUF_FMT_YUV422 &&
> > +                              src_format == BUF_FMT_ARGB8888_YUV444);
> > +
> > +       /* horizontal luma */
> > +       dcss_scaler_filter_design(src_xres, dst_xres, false,
> > +                                 src_xres == dst_xres, coef);
> > +       dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_HLUM, coef);
> > +
> > +       /* vertical luma */
> > +       dcss_scaler_filter_design(src_yres, dst_yres, program_5_taps,
> > +                                 src_yres == dst_yres, coef);
> > +
> > +       if (program_5_taps)
> > +               dcss_scaler_program_5_coef_set(ch, DCSS_SCALER_COEF_VLUM, coef);
> > +       else
> > +               dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_VLUM, coef);
> > +
> > +       /* adjust chroma resolution */
> > +       if (src_format != BUF_FMT_ARGB8888_YUV444)
> > +               src_xres >>= 1;
> > +       if (src_format == BUF_FMT_YUV420)
> > +               src_yres >>= 1;
> > +       if (dst_format != BUF_FMT_ARGB8888_YUV444)
> > +               dst_xres >>= 1;
> > +       if (dst_format == BUF_FMT_YUV420) /* should not happen */
> > +               dst_yres >>= 1;
> > +
> > +       /* horizontal chroma */
> > +       dcss_scaler_filter_design(src_xres, dst_xres, false,
> > +                                 (src_xres == dst_xres) && (ch->c_hstart == 0),
> > +                                 coef);
> > +
> > +       dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_HCHR, coef);
> > +
> > +       /* vertical chroma */
> > +       dcss_scaler_filter_design(src_yres, dst_yres, program_5_taps,
> > +                                 (src_yres == dst_yres) && (ch->c_vstart == 0),
> > +                                 coef);
> > +       if (program_5_taps)
> > +               dcss_scaler_program_5_coef_set(ch, DCSS_SCALER_COEF_VCHR, coef);
> > +       else
> > +               dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_VCHR, coef);
> > +}
> > +
> > +static void dcss_scaler_rgb_coef_set(struct dcss_scaler_ch *ch,
> > +                                    int src_xres, int src_yres, int dst_xres,
> > +                                    int dst_yres)
> > +{
> > +       int coef[PSC_STORED_PHASES][PSC_NUM_TAPS];
> > +
> > +       /* horizontal RGB */
> > +       dcss_scaler_filter_design(src_xres, dst_xres, false,
> > +                                 src_xres == dst_xres, coef);
> > +       dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_HLUM, coef);
> > +
> > +       /* vertical RGB */
> > +       dcss_scaler_filter_design(src_yres, dst_yres, false,
> > +                                 src_yres == dst_yres, coef);
> > +       dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_VLUM, coef);
> > +}
> > +
> > +static void dcss_scaler_set_rgb10_order(struct dcss_scaler_ch *ch,
> > +                                       const struct drm_format_info *format)
> > +{
> > +       u32 a2r10g10b10_format;
> > +
> > +       if (format->is_yuv)
> > +               return;
> > +
> > +       ch->sdata_ctrl &= ~A2R10G10B10_FORMAT_MASK;
> > +
> > +       if (format->depth != 30)
> > +               return;
> > +
> > +       switch (format->format) {
> > +       case DRM_FORMAT_ARGB2101010:
> > +       case DRM_FORMAT_XRGB2101010:
> > +               a2r10g10b10_format = 0;
> > +               break;
> > +
> > +       case DRM_FORMAT_ABGR2101010:
> > +       case DRM_FORMAT_XBGR2101010:
> > +               a2r10g10b10_format = 5;
> > +               break;
> > +
> > +       case DRM_FORMAT_RGBA1010102:
> > +       case DRM_FORMAT_RGBX1010102:
> > +               a2r10g10b10_format = 6;
> > +               break;
> > +
> > +       case DRM_FORMAT_BGRA1010102:
> > +       case DRM_FORMAT_BGRX1010102:
> > +               a2r10g10b10_format = 11;
> > +               break;
> > +
> > +       default:
> > +               a2r10g10b10_format = 0;
> > +               break;
> > +       }
> > +
> > +       ch->sdata_ctrl |= a2r10g10b10_format << A2R10G10B10_FORMAT_POS;
> > +}
> > +
> > +void dcss_scaler_setup(struct dcss_scaler *scl, int ch_num,
> > +                      const struct drm_format_info *format,
> > +                      int src_xres, int src_yres, int dst_xres, int dst_yres,
> > +                      u32 vrefresh_hz)
> > +{
> > +       struct dcss_scaler_ch *ch = &scl->ch[ch_num];
> > +       unsigned int pixel_depth = 0;
> > +       bool rtr_8line_en = false;
> > +       bool use_5_taps = false;
> > +       enum buffer_format src_format = BUF_FMT_ARGB8888_YUV444;
> > +       enum buffer_format dst_format = BUF_FMT_ARGB8888_YUV444;
> > +       u32 pix_format = format->format;
> > +
> > +       if (format->is_yuv) {
> > +               dcss_scaler_yuv_enable(ch, true);
> > +
> > +               if (pix_format == DRM_FORMAT_NV12 ||
> > +                   pix_format == DRM_FORMAT_NV21 ||
> > +                   pix_format == DRM_FORMAT_P010) {
> > +                       rtr_8line_en = true;
> > +                       src_format = BUF_FMT_YUV420;
> > +               } else if (pix_format == DRM_FORMAT_UYVY ||
> > +                          pix_format == DRM_FORMAT_VYUY ||
> > +                          pix_format == DRM_FORMAT_YUYV ||
> > +                          pix_format == DRM_FORMAT_YVYU) {
> > +                       src_format = BUF_FMT_YUV422;
> > +               }
> > +
> > +               use_5_taps = !rtr_8line_en;
> > +               if (pix_format == DRM_FORMAT_P010)
> > +                       pixel_depth = 30;
> > +
> > +       } else {
> > +               dcss_scaler_yuv_enable(ch, false);
> > +
> > +               pixel_depth = format->depth;
> > +       }
> > +
> > +       dcss_scaler_fractions_set(ch, src_xres, src_yres, dst_xres,
> > +                                 dst_yres, src_format, dst_format,
> > +                                 PSC_LOC_HORZ_0_VERT_1_OVER_4);
> > +
> > +       if (format->is_yuv)
> > +               dcss_scaler_yuv_coef_set(ch, src_format, dst_format,
> > +                                        use_5_taps, src_xres, src_yres,
> > +                                        dst_xres, dst_yres);
> > +       else
> > +               dcss_scaler_rgb_coef_set(ch, src_xres, src_yres,
> > +                                        dst_xres, dst_yres);
> > +
> > +       dcss_scaler_rtr_8lines_enable(ch, rtr_8line_en);
> > +       dcss_scaler_bit_depth_set(ch, pixel_depth);
> > +       dcss_scaler_set_rgb10_order(ch, format);
> > +       dcss_scaler_format_set(ch, src_format, dst_format);
> > +       dcss_scaler_res_set(ch, src_xres, src_yres, dst_xres, dst_yres,
> > +                           pix_format, dst_format);
> > +}
> > +
> > +/* This function will be called from interrupt context. */
> > +void dcss_scaler_write_sclctrl(struct dcss_scaler *scl)
> > +{
> > +       int chnum;
> > +
> > +       for (chnum = 0; chnum < 3; chnum++) {
> > +               struct dcss_scaler_ch *ch = &scl->ch[chnum];
> > +
> > +               if (ch->scaler_ctrl_chgd) {
> > +                       dcss_ctxld_write_irqsafe(scl->ctxld, scl->ctx_id,
> > +                                                ch->scaler_ctrl,
> > +                                                ch->base_ofs +
> > +                                                DCSS_SCALER_CTRL);
> > +                       ch->scaler_ctrl_chgd = false;
> > +               }
> > +       }
> > +}
> > diff --git a/drivers/gpu/drm/imx/dcss/dcss-ss.c b/drivers/gpu/drm/imx/dcss/dcss-ss.c
> > new file mode 100644
> > index 00000000..65a05c2
> > --- /dev/null
> > +++ b/drivers/gpu/drm/imx/dcss/dcss-ss.c
> > @@ -0,0 +1,179 @@
> > +// SPDX-License-Identifier: GPL-2.0
> > +/*
> > + * Copyright 2019 NXP.
> > + */
> > +
> > +#include <linux/device.h>
> > +
> > +#include "dcss-dev.h"
> > +
> > +#define DCSS_SS_SYS_CTRL                       0x00
> > +#define   RUN_EN                               BIT(0)
> > +#define DCSS_SS_DISPLAY                                0x10
> > +#define   LRC_X_POS                            0
> > +#define   LRC_X_MASK                           GENMASK(12, 0)
> > +#define   LRC_Y_POS                            16
> > +#define   LRC_Y_MASK                           GENMASK(28, 16)
> > +#define DCSS_SS_HSYNC                          0x20
> > +#define DCSS_SS_VSYNC                          0x30
> > +#define   SYNC_START_POS                       0
> > +#define   SYNC_START_MASK                      GENMASK(12, 0)
> > +#define   SYNC_END_POS                         16
> > +#define   SYNC_END_MASK                                GENMASK(28, 16)
> > +#define   SYNC_POL                             BIT(31)
> > +#define DCSS_SS_DE_ULC                         0x40
> > +#define   ULC_X_POS                            0
> > +#define   ULC_X_MASK                           GENMASK(12, 0)
> > +#define   ULC_Y_POS                            16
> > +#define   ULC_Y_MASK                           GENMASK(28, 16)
> > +#define   ULC_POL                              BIT(31)
> > +#define DCSS_SS_DE_LRC                         0x50
> > +#define DCSS_SS_MODE                           0x60
> > +#define   PIPE_MODE_POS                                0
> > +#define   PIPE_MODE_MASK                       GENMASK(1, 0)
> > +#define DCSS_SS_COEFF                          0x70
> > +#define   HORIZ_A_POS                          0
> > +#define   HORIZ_A_MASK                         GENMASK(3, 0)
> > +#define   HORIZ_B_POS                          4
> > +#define   HORIZ_B_MASK                         GENMASK(7, 4)
> > +#define   HORIZ_C_POS                          8
> > +#define   HORIZ_C_MASK                         GENMASK(11, 8)
> > +#define   HORIZ_H_NORM_POS                     12
> > +#define   HORIZ_H_NORM_MASK                    GENMASK(14, 12)
> > +#define   VERT_A_POS                           16
> > +#define   VERT_A_MASK                          GENMASK(19, 16)
> > +#define   VERT_B_POS                           20
> > +#define   VERT_B_MASK                          GENMASK(23, 20)
> > +#define   VERT_C_POS                           24
> > +#define   VERT_C_MASK                          GENMASK(27, 24)
> > +#define   VERT_H_NORM_POS                      28
> > +#define   VERT_H_NORM_MASK                     GENMASK(30, 28)
> > +#define DCSS_SS_CLIP_CB                                0x80
> > +#define DCSS_SS_CLIP_CR                                0x90
> > +#define   CLIP_MIN_POS                         0
> > +#define   CLIP_MIN_MASK                                GENMASK(9, 0)
> > +#define   CLIP_MAX_POS                         0
> > +#define   CLIP_MAX_MASK                                GENMASK(23, 16)
> > +#define DCSS_SS_INTER_MODE                     0xA0
> > +#define   INT_EN                               BIT(0)
> > +#define   VSYNC_SHIFT                          BIT(1)
> > +
> > +struct dcss_ss {
> > +       struct device *dev;
> > +       void __iomem *base_reg;
> > +       u32 base_ofs;
> > +
> > +       struct dcss_ctxld *ctxld;
> > +       u32 ctx_id;
> > +
> > +       bool in_use;
> > +};
> > +
> > +static void dcss_ss_write(struct dcss_ss *ss, u32 val, u32 ofs)
> > +{
> > +       if (!ss->in_use)
> > +               dcss_writel(val, ss->base_reg + ofs);
> > +
> > +       dcss_ctxld_write(ss->ctxld, ss->ctx_id, val,
> > +                        ss->base_ofs + ofs);
> > +}
> > +
> > +int dcss_ss_init(struct dcss_dev *dcss, unsigned long ss_base)
> > +{
> > +       struct dcss_ss *ss;
> > +
> > +       ss = devm_kzalloc(dcss->dev, sizeof(*ss), GFP_KERNEL);
> > +       if (!ss)
> > +               return -ENOMEM;
> > +
> > +       dcss->ss = ss;
> > +       ss->dev = dcss->dev;
> > +       ss->ctxld = dcss->ctxld;
> > +
> > +       ss->base_reg = devm_ioremap(dcss->dev, ss_base, SZ_4K);
> > +       if (!ss->base_reg) {
> > +               dev_err(dcss->dev, "ss: unable to remap ss base\n");
> > +               devm_kfree(ss->dev, ss);
> > +               return -ENOMEM;
> > +       }
> > +
> > +       ss->base_ofs = ss_base;
> > +       ss->ctx_id = CTX_SB_HP;
> > +
> > +       return 0;
> > +}
> > +
> > +void dcss_ss_exit(struct dcss_ss *ss)
> > +{
> > +       /* stop SS */
> > +       dcss_writel(0, ss->base_reg + DCSS_SS_SYS_CTRL);
> > +
> > +       if (ss->base_reg)
> > +               devm_iounmap(ss->dev, ss->base_reg);
> > +
> > +       devm_kfree(ss->dev, ss);
> > +}
> > +
> > +void dcss_ss_subsam_set(struct dcss_ss *ss)
> > +{
> > +       dcss_ss_write(ss, 0x41614161, DCSS_SS_COEFF);
> > +       dcss_ss_write(ss, 0, DCSS_SS_MODE);
> > +       dcss_ss_write(ss, 0x03ff0000, DCSS_SS_CLIP_CB);
> > +       dcss_ss_write(ss, 0x03ff0000, DCSS_SS_CLIP_CR);
> > +}
> > +
> > +void dcss_ss_sync_set(struct dcss_ss *ss, struct videomode *vm,
> > +                     bool phsync, bool pvsync)
> > +{
> > +       u16 lrc_x, lrc_y;
> > +       u16 hsync_start, hsync_end;
> > +       u16 vsync_start, vsync_end;
> > +       u16 de_ulc_x, de_ulc_y;
> > +       u16 de_lrc_x, de_lrc_y;
> > +
> > +       lrc_x = vm->hfront_porch + vm->hback_porch + vm->hsync_len +
> > +               vm->hactive - 1;
> > +       lrc_y = vm->vfront_porch + vm->vback_porch + vm->vsync_len +
> > +               vm->vactive - 1;
> > +
> > +       dcss_ss_write(ss, (lrc_y << LRC_Y_POS) | lrc_x, DCSS_SS_DISPLAY);
> > +
> > +       hsync_start = vm->hfront_porch + vm->hback_porch + vm->hsync_len +
> > +                     vm->hactive - 1;
> > +       hsync_end = vm->hsync_len - 1;
> > +
> > +       dcss_ss_write(ss, (phsync ? SYNC_POL : 0) |
> > +                     ((u32)hsync_end << SYNC_END_POS) | hsync_start,
> > +                     DCSS_SS_HSYNC);
> > +
> > +       vsync_start = vm->vfront_porch - 1;
> > +       vsync_end = vm->vfront_porch + vm->vsync_len - 1;
> > +
> > +       dcss_ss_write(ss, (pvsync ? SYNC_POL : 0) |
> > +                     ((u32)vsync_end << SYNC_END_POS) | vsync_start,
> > +                     DCSS_SS_VSYNC);
> > +
> > +       de_ulc_x = vm->hsync_len + vm->hback_porch - 1;
> > +       de_ulc_y = vm->vsync_len + vm->vfront_porch + vm->vback_porch;
> > +
> > +       dcss_ss_write(ss, SYNC_POL | ((u32)de_ulc_y << ULC_Y_POS) | de_ulc_x,
> > +                     DCSS_SS_DE_ULC);
> > +
> > +       de_lrc_x = vm->hsync_len + vm->hback_porch + vm->hactive - 1;
> > +       de_lrc_y = vm->vsync_len + vm->vfront_porch + vm->vback_porch +
> > +                  vm->vactive - 1;
> > +
> > +       dcss_ss_write(ss, (de_lrc_y << LRC_Y_POS) | de_lrc_x, DCSS_SS_DE_LRC);
> > +}
> > +
> > +void dcss_ss_enable(struct dcss_ss *ss)
> > +{
> > +       dcss_ss_write(ss, RUN_EN, DCSS_SS_SYS_CTRL);
> > +       ss->in_use = true;
> > +}
> > +
> > +void dcss_ss_disable(struct dcss_ss *ss)
> > +{
> > +       dcss_ss_write(ss, 0, DCSS_SS_SYS_CTRL);
> > +       ss->in_use = false;
> > +}
> 
> > --
> > 2.7.4
> >
> > _______________________________________________
> > dri-devel mailing list
> > dri-devel@lists.freedesktop.org
> > https://eur01.safelinks.protection.outlook.com/?url=https%3A%2F%2Flists.freedesktop.org%2Fmailman%2Flistinfo%2Fdri-devel&amp;data=02%7C01%7Claurentiu.palcu%40nxp.com%7C94b752dadd2e413c70d008d740a32979%7C686ea1d3bc2b4c6fa92cd99c5c301635%7C0%7C0%7C637048941849367464&amp;sdata=eLdnYtMSu7o86geKr2wwIlfReLX9EmnGDQXNSuBGebU%3D&amp;reserved=0
Ying Liu Sept. 24, 2019, 8:56 a.m. UTC | #3
On Tue, Sep 24, 2019 at 4:04 PM Laurentiu Palcu <laurentiu.palcu@nxp.com> wrote:
>
> Hi,
>
> On Tue, Sep 24, 2019 at 11:56:07AM +0800, Ying Liu wrote:
> > Hi,
> >
> > On Mon, Sep 23, 2019 at 10:22 PM Laurentiu Palcu
> > <laurentiu.palcu@nxp.com> wrote:
> > >
> > > This adds initial support for iMX8MQ's Display Controller Subsystem (DCSS).
> > > Some of its capabilities include:
> > >  * 4K@60fps;
> > >  * HDR10;
> > >  * one graphics and 2 video pipelines;
> > >  * on-the-fly decompression of compressed video and graphics;
> > >
> > > The reference manual can be found here:
> > > https://eur01.safelinks.protection.outlook.com/?url=https%3A%2F%2Fwww.nxp.com%2Fwebapp%2FDownload%3FcolCode%3DIMX8MDQLQRM&amp;data=02%7C01%7Claurentiu.palcu%40nxp.com%7C94b752dadd2e413c70d008d740a32979%7C686ea1d3bc2b4c6fa92cd99c5c301635%7C0%7C0%7C637048941849367464&amp;sdata=rsFNo5MGwdFGTAheU8YrJeRLvThpwbGG9bC9hKxCsm0%3D&amp;reserved=0
> > >
> > > The current patch adds only basic functionality: one primary plane for
> > > graphics, linear, tiled and super-tiled buffers support (no graphics
> > > decompression yet), no HDR10 and no video planes.
> > >
> > > Video planes support and HDR10 will be added in subsequent patches once
> > > per-plane de-gamma/CSC/gamma support is in.
> > >
> > > Signed-off-by: Laurentiu Palcu <laurentiu.palcu@nxp.com>
> > > ---
> > >  drivers/gpu/drm/imx/Kconfig            |   2 +
> > >  drivers/gpu/drm/imx/Makefile           |   1 +
> > >  drivers/gpu/drm/imx/dcss/Kconfig       |   7 +
> > >  drivers/gpu/drm/imx/dcss/Makefile      |   6 +
> > >  drivers/gpu/drm/imx/dcss/dcss-blkctl.c |  75 +++
> > >  drivers/gpu/drm/imx/dcss/dcss-crtc.c   | 223 +++++++++
> > >  drivers/gpu/drm/imx/dcss/dcss-ctxld.c  | 447 ++++++++++++++++++
> > >  drivers/gpu/drm/imx/dcss/dcss-dev.c    | 286 ++++++++++++
> > >  drivers/gpu/drm/imx/dcss/dcss-dev.h    | 195 ++++++++
> > >  drivers/gpu/drm/imx/dcss/dcss-dpr.c    | 552 ++++++++++++++++++++++
> > >  drivers/gpu/drm/imx/dcss/dcss-drv.c    | 182 ++++++++
> > >  drivers/gpu/drm/imx/dcss/dcss-dtg.c    | 438 +++++++++++++++++
> > >  drivers/gpu/drm/imx/dcss/dcss-kms.c    | 321 +++++++++++++
> > >  drivers/gpu/drm/imx/dcss/dcss-kms.h    |  52 +++
> > >  drivers/gpu/drm/imx/dcss/dcss-plane.c  | 418 +++++++++++++++++
> > >  drivers/gpu/drm/imx/dcss/dcss-scaler.c | 830 +++++++++++++++++++++++++++++++++
> > >  drivers/gpu/drm/imx/dcss/dcss-ss.c     | 179 +++++++
> > >  17 files changed, 4214 insertions(+)
> > >  create mode 100644 drivers/gpu/drm/imx/dcss/Kconfig
> > >  create mode 100644 drivers/gpu/drm/imx/dcss/Makefile
> > >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-blkctl.c
> > >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-crtc.c
> > >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-ctxld.c
> > >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-dev.c
> > >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-dev.h
> > >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-dpr.c
> >
> > DPR embedded in i.MX8QM & i.MX8QXP SoCs has
> > compatible register definitions with the one in i.MX8MQ.
> > Together with PRG(Prefetch Resolve Gasket), DPR serves
> > the display controller DPU of i.MX8QM & i.MX8QXP SoCs
> > as the prefetch engine.  IMHO, there should be a separate
> > DPR driver which stands out side of the dcss directory and
> > has DT compatible strings for i.MX8MQ, i.MX8QM and
> > i.MX8QXP SoCs.
>
> Yes, DPR is pretty much the same for those platforms, register wise.
> However, DCSS will do all DPR programming through the context loader
> engine (DCSS specific), whereas DPU does not. DPU's DPR can handle VPU

The different ways of accessing register can be wrapped by some
helpers, so it doesn't seem to bring much code for platform sense.

> tiled formats, whereas DCSS's does not. For that, DCSS has a DTRC
> (decompression and tile to raster conversion) module in front of DPR,
> hence the DPR programming needs some adjustments when
> tiled/tiled-compressed video buffers are used.

What kind of adjustments?
Is it complicated enough to break the idea of one DPR driver solution?

>
> Your idea is great, when it comes to removing some code duplication.
> But if, after this process, we end up with an overly complicated piece
> of code that needs to address different platform particularities, I'd
> prefer to keep things separate. The code will be easier to read and
> maintain.

Understand.  But, it's worth evaluating how complicated it can be.

>
> Thanks,
> laurentiu
>
>
> >
> > >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-drv.c
> > >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-dtg.c
> > >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-kms.c
> > >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-kms.h
> > >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-plane.c
> > >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-scaler.c
> > >  create mode 100644 drivers/gpu/drm/imx/dcss/dcss-ss.c
> > >
> > > diff --git a/drivers/gpu/drm/imx/Kconfig b/drivers/gpu/drm/imx/Kconfig
> > > index 207bf74..6231048 100644
> > > --- a/drivers/gpu/drm/imx/Kconfig
> > > +++ b/drivers/gpu/drm/imx/Kconfig
> > > @@ -39,3 +39,5 @@ config DRM_IMX_HDMI
> > >         depends on DRM_IMX
> > >         help
> > >           Choose this if you want to use HDMI on i.MX6.
> > > +
> > > +source "drivers/gpu/drm/imx/dcss/Kconfig"
> > > diff --git a/drivers/gpu/drm/imx/Makefile b/drivers/gpu/drm/imx/Makefile
> > > index 21cdcc2..b644def 100644
> > > --- a/drivers/gpu/drm/imx/Makefile
> > > +++ b/drivers/gpu/drm/imx/Makefile
> > > @@ -9,3 +9,4 @@ obj-$(CONFIG_DRM_IMX_TVE) += imx-tve.o
> > >  obj-$(CONFIG_DRM_IMX_LDB) += imx-ldb.o
> > >
> > >  obj-$(CONFIG_DRM_IMX_HDMI) += dw_hdmi-imx.o
> > > +obj-$(CONFIG_DRM_IMX_DCSS) += dcss/
> > > diff --git a/drivers/gpu/drm/imx/dcss/Kconfig b/drivers/gpu/drm/imx/dcss/Kconfig
> > > new file mode 100644
> > > index 00000000..6399c12
> > > --- /dev/null
> > > +++ b/drivers/gpu/drm/imx/dcss/Kconfig
> > > @@ -0,0 +1,7 @@
> > > +config DRM_IMX_DCSS
> > > +       tristate "i.MX8MQ DCSS"
> > > +       select RESET_CONTROLLER
> > > +       select IMX_IRQSTEER
> > > +       help
> > > +         Choose this if you have a NXP i.MX8MQ based system and want to use the
> > > +         Display Controller Subsystem. This option enables DCSS support.
> > > diff --git a/drivers/gpu/drm/imx/dcss/Makefile b/drivers/gpu/drm/imx/dcss/Makefile
> > > new file mode 100644
> > > index 00000000..8c7c8da
> > > --- /dev/null
> > > +++ b/drivers/gpu/drm/imx/dcss/Makefile
> > > @@ -0,0 +1,6 @@
> > > +imx-dcss-objs := dcss-drv.o dcss-dev.o dcss-blkctl.o dcss-ctxld.o dcss-dtg.o \
> > > +                                dcss-ss.o dcss-dpr.o dcss-scaler.o dcss-kms.o dcss-crtc.o \
> > > +                                dcss-plane.o
> > > +
> > > +obj-$(CONFIG_DRM_IMX_DCSS) += imx-dcss.o
> > > +
> > > diff --git a/drivers/gpu/drm/imx/dcss/dcss-blkctl.c b/drivers/gpu/drm/imx/dcss/dcss-blkctl.c
> > > new file mode 100644
> > > index 00000000..ee7ffa1
> > > --- /dev/null
> > > +++ b/drivers/gpu/drm/imx/dcss/dcss-blkctl.c
> > > @@ -0,0 +1,75 @@
> > > +// SPDX-License-Identifier: GPL-2.0
> > > +/*
> > > + * Copyright 2019 NXP.
> > > + */
> > > +
> > > +#include <linux/device.h>
> > > +#include <linux/of.h>
> > > +
> > > +#include "dcss-dev.h"
> > > +
> > > +#define DCSS_BLKCTL_RESET_CTRL         0x00
> > > +#define   B_CLK_RESETN                 BIT(0)
> > > +#define   APB_CLK_RESETN               BIT(1)
> > > +#define   P_CLK_RESETN                 BIT(2)
> > > +#define   RTR_CLK_RESETN               BIT(3)
> > > +#define DCSS_BLKCTL_CONTROL0           0x10
> > > +#define   HDMI_MIPI_CLK_SEL            BIT(0)
> > > +#define   DISPMIX_REFCLK_SEL_POS       4
> > > +#define   DISPMIX_REFCLK_SEL_MASK      GENMASK(5, 4)
> > > +#define   DISPMIX_PIXCLK_SEL           BIT(8)
> > > +#define   HDMI_SRC_SECURE_EN           BIT(16)
> > > +
> > > +struct dcss_blkctl {
> > > +       struct device *dev;
> > > +       void __iomem *base_reg;
> > > +
> > > +       bool hdmi_output;
> > > +};
> > > +
> > > +void dcss_blkctl_cfg(struct dcss_blkctl *blkctl)
> > > +{
> > > +       if (blkctl->hdmi_output)
> > > +               dcss_writel(0, blkctl->base_reg + DCSS_BLKCTL_CONTROL0);
> > > +       else
> > > +               dcss_writel(DISPMIX_PIXCLK_SEL,
> > > +                           blkctl->base_reg + DCSS_BLKCTL_CONTROL0);
> > > +
> > > +       dcss_set(B_CLK_RESETN | APB_CLK_RESETN | P_CLK_RESETN | RTR_CLK_RESETN,
> > > +                blkctl->base_reg + DCSS_BLKCTL_RESET_CTRL);
> > > +}
> > > +
> > > +int dcss_blkctl_init(struct dcss_dev *dcss, unsigned long blkctl_base)
> > > +{
> > > +       struct dcss_blkctl *blkctl;
> > > +
> > > +       blkctl = devm_kzalloc(dcss->dev, sizeof(*blkctl), GFP_KERNEL);
> > > +       if (!blkctl)
> > > +               return -ENOMEM;
> > > +
> > > +       blkctl->base_reg = devm_ioremap(dcss->dev, blkctl_base, SZ_4K);
> > > +       if (!blkctl->base_reg) {
> > > +               dev_err(dcss->dev, "unable to remap BLK CTRL base\n");
> > > +               devm_kfree(dcss->dev, blkctl);
> > > +               return -ENOMEM;
> > > +       }
> > > +
> > > +       dcss->blkctl = blkctl;
> > > +       blkctl->dev = dcss->dev;
> > > +       blkctl->hdmi_output = dcss->hdmi_output;
> > > +
> > > +       dcss_blkctl_cfg(blkctl);
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +void dcss_blkctl_exit(struct dcss_blkctl *blkctl)
> > > +{
> > > +       dcss_clr(P_CLK_RESETN | RTR_CLK_RESETN,
> > > +                blkctl->base_reg + DCSS_BLKCTL_RESET_CTRL);
> > > +
> > > +       if (blkctl->base_reg)
> > > +               devm_iounmap(blkctl->dev, blkctl->base_reg);
> > > +
> > > +       devm_kfree(blkctl->dev, blkctl);
> > > +}
> > > diff --git a/drivers/gpu/drm/imx/dcss/dcss-crtc.c b/drivers/gpu/drm/imx/dcss/dcss-crtc.c
> > > new file mode 100644
> > > index 00000000..6abb40c
> > > --- /dev/null
> > > +++ b/drivers/gpu/drm/imx/dcss/dcss-crtc.c
> > > @@ -0,0 +1,223 @@
> > > +// SPDX-License-Identifier: GPL-2.0
> > > +/*
> > > + * Copyright 2019 NXP.
> > > + */
> > > +
> > > +#include <drm/drmP.h>
> > > +#include <drm/drm_atomic_helper.h>
> > > +#include <linux/pm_runtime.h>
> > > +
> > > +#include "dcss-dev.h"
> > > +#include "dcss-kms.h"
> > > +
> > > +static int dcss_enable_vblank(struct drm_crtc *crtc)
> > > +{
> > > +       struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
> > > +                                                  base);
> > > +       struct dcss_dev *dcss = crtc->dev->dev_private;
> > > +
> > > +       if (dcss_crtc->irq_enabled)
> > > +               return 0;
> > > +
> > > +       dcss_crtc->irq_enabled = true;
> > > +
> > > +       dcss_dtg_vblank_irq_enable(dcss->dtg, true);
> > > +
> > > +       dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, true);
> > > +
> > > +       enable_irq(dcss_crtc->irq);
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +static void dcss_disable_vblank(struct drm_crtc *crtc)
> > > +{
> > > +       struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
> > > +                                                  base);
> > > +       struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
> > > +
> > > +       disable_irq_nosync(dcss_crtc->irq);
> > > +
> > > +       dcss_dtg_vblank_irq_enable(dcss->dtg, false);
> > > +
> > > +       dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, false);
> > > +
> > > +       dcss_crtc->irq_enabled = false;
> > > +}
> > > +
> > > +static const struct drm_crtc_funcs dcss_crtc_funcs = {
> > > +       .set_config = drm_atomic_helper_set_config,
> > > +       .destroy = drm_crtc_cleanup,
> > > +       .page_flip = drm_atomic_helper_page_flip,
> > > +       .reset = drm_atomic_helper_crtc_reset,
> > > +       .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
> > > +       .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
> > > +       .enable_vblank = dcss_enable_vblank,
> > > +       .disable_vblank = dcss_disable_vblank,
> > > +};
> > > +
> > > +static void dcss_crtc_atomic_begin(struct drm_crtc *crtc,
> > > +                                  struct drm_crtc_state *old_crtc_state)
> > > +{
> > > +       drm_crtc_vblank_on(crtc);
> > > +
> > > +       spin_lock_irq(&crtc->dev->event_lock);
> > > +       if (crtc->state->event) {
> > > +               WARN_ON(drm_crtc_vblank_get(crtc));
> > > +               drm_crtc_arm_vblank_event(crtc, crtc->state->event);
> > > +               crtc->state->event = NULL;
> > > +       }
> > > +       spin_unlock_irq(&crtc->dev->event_lock);
> > > +}
> > > +
> > > +static void dcss_crtc_atomic_flush(struct drm_crtc *crtc,
> > > +                                  struct drm_crtc_state *old_crtc_state)
> > > +{
> > > +       struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
> > > +                                                  base);
> > > +       struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
> > > +
> > > +       if (dcss_dtg_is_enabled(dcss->dtg))
> > > +               dcss_ctxld_enable(dcss->ctxld);
> > > +}
> > > +
> > > +static void dcss_crtc_atomic_enable(struct drm_crtc *crtc,
> > > +                                   struct drm_crtc_state *old_crtc_state)
> > > +{
> > > +       struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
> > > +                                                  base);
> > > +       struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
> > > +       struct drm_display_mode *mode = &crtc->state->adjusted_mode;
> > > +       struct videomode vm;
> > > +
> > > +       drm_display_mode_to_videomode(mode, &vm);
> > > +
> > > +       pm_runtime_get_sync(dcss->dev);
> > > +
> > > +       dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, true);
> > > +
> > > +       vm.pixelclock = mode->crtc_clock * 1000;
> > > +
> > > +       dcss_dtg_sync_set(dcss->dtg, &vm);
> > > +
> > > +       dcss_ss_subsam_set(dcss->ss);
> > > +       dcss_ss_sync_set(dcss->ss, &vm, mode->flags & DRM_MODE_FLAG_PHSYNC,
> > > +                        mode->flags & DRM_MODE_FLAG_PVSYNC);
> > > +
> > > +       dcss_dtg_css_set(dcss->dtg);
> > > +
> > > +       dcss_ss_enable(dcss->ss);
> > > +       dcss_dtg_enable(dcss->dtg, true, NULL);
> > > +       dcss_ctxld_enable(dcss->ctxld);
> > > +
> > > +       reinit_completion(&dcss_crtc->en_completion);
> > > +       wait_for_completion_timeout(&dcss_crtc->en_completion,
> > > +                                   msecs_to_jiffies(500));
> > > +}
> > > +
> > > +static void dcss_crtc_atomic_disable(struct drm_crtc *crtc,
> > > +                                    struct drm_crtc_state *old_crtc_state)
> > > +{
> > > +       struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
> > > +                                                  base);
> > > +       struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
> > > +
> > > +       drm_atomic_helper_disable_planes_on_crtc(old_crtc_state, false);
> > > +
> > > +       spin_lock_irq(&crtc->dev->event_lock);
> > > +       if (crtc->state->event) {
> > > +               drm_crtc_send_vblank_event(crtc, crtc->state->event);
> > > +               crtc->state->event = NULL;
> > > +       }
> > > +       spin_unlock_irq(&crtc->dev->event_lock);
> > > +
> > > +       dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, true);
> > > +
> > > +       dcss_ss_disable(dcss->ss);
> > > +       dcss_dtg_enable(dcss->dtg, false, &dcss_crtc->dis_completion);
> > > +       dcss_ctxld_enable(dcss->ctxld);
> > > +
> > > +       reinit_completion(&dcss_crtc->dis_completion);
> > > +       wait_for_completion_timeout(&dcss_crtc->dis_completion,
> > > +                                   msecs_to_jiffies(100));
> > > +
> > > +       drm_crtc_vblank_off(crtc);
> > > +
> > > +       dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, false);
> > > +
> > > +       pm_runtime_put_sync(dcss->dev);
> > > +}
> > > +
> > > +static const struct drm_crtc_helper_funcs dcss_helper_funcs = {
> > > +       .atomic_begin = dcss_crtc_atomic_begin,
> > > +       .atomic_flush = dcss_crtc_atomic_flush,
> > > +       .atomic_enable = dcss_crtc_atomic_enable,
> > > +       .atomic_disable = dcss_crtc_atomic_disable,
> > > +};
> > > +
> > > +static irqreturn_t dcss_crtc_irq_handler(int irq, void *dev_id)
> > > +{
> > > +       struct dcss_crtc *dcss_crtc = dev_id;
> > > +       struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
> > > +
> > > +       if (!dcss_dtg_vblank_irq_valid(dcss->dtg))
> > > +               return IRQ_HANDLED;
> > > +
> > > +       complete(&dcss_crtc->en_completion);
> > > +
> > > +       if (dcss_ctxld_is_flushed(dcss->ctxld))
> > > +               drm_crtc_handle_vblank(&dcss_crtc->base);
> > > +
> > > +       dcss_dtg_vblank_irq_clear(dcss->dtg);
> > > +
> > > +       return IRQ_HANDLED;
> > > +}
> > > +
> > > +int dcss_crtc_init(struct dcss_crtc *crtc, struct drm_device *drm)
> > > +{
> > > +       struct dcss_dev *dcss = drm->dev_private;
> > > +       struct platform_device *pdev = to_platform_device(dcss->dev);
> > > +       int ret;
> > > +
> > > +       crtc->plane[0] = dcss_plane_init(drm, drm_crtc_mask(&crtc->base),
> > > +                                        DRM_PLANE_TYPE_PRIMARY, 0);
> > > +       if (IS_ERR(crtc->plane[0]))
> > > +               return PTR_ERR(crtc->plane[0]);
> > > +
> > > +       crtc->base.port = dcss->of_port;
> > > +
> > > +       drm_crtc_helper_add(&crtc->base, &dcss_helper_funcs);
> > > +       ret = drm_crtc_init_with_planes(drm, &crtc->base, &crtc->plane[0]->base,
> > > +                                       NULL, &dcss_crtc_funcs, NULL);
> > > +       if (ret) {
> > > +               dev_err(dcss->dev, "failed to init crtc\n");
> > > +               return ret;
> > > +       }
> > > +
> > > +       crtc->irq = platform_get_irq_byname(pdev, "vblank");
> > > +       if (crtc->irq < 0) {
> > > +               dev_err(dcss->dev, "unable to get vblank interrupt\n");
> > > +               return crtc->irq;
> > > +       }
> > > +
> > > +       init_completion(&crtc->en_completion);
> > > +       init_completion(&crtc->dis_completion);
> > > +
> > > +       ret = devm_request_irq(dcss->dev, crtc->irq, dcss_crtc_irq_handler,
> > > +                              IRQF_TRIGGER_RISING, "dcss_drm", crtc);
> > > +       if (ret) {
> > > +               dev_err(dcss->dev, "irq request failed with %d.\n", ret);
> > > +               return ret;
> > > +       }
> > > +
> > > +       disable_irq(crtc->irq);
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +void dcss_crtc_deinit(struct dcss_crtc *crtc, struct drm_device *drm)
> > > +{
> > > +       struct dcss_dev *dcss = drm->dev_private;
> > > +
> > > +       devm_free_irq(dcss->dev, crtc->irq, crtc);
> > > +}
> > > diff --git a/drivers/gpu/drm/imx/dcss/dcss-ctxld.c b/drivers/gpu/drm/imx/dcss/dcss-ctxld.c
> > > new file mode 100644
> > > index 00000000..4fe35b2b
> > > --- /dev/null
> > > +++ b/drivers/gpu/drm/imx/dcss/dcss-ctxld.c
> > > @@ -0,0 +1,447 @@
> > > +// SPDX-License-Identifier: GPL-2.0
> > > +/*
> > > + * Copyright 2019 NXP.
> > > + */
> > > +
> > > +#include <linux/delay.h>
> > > +#include <linux/dma-mapping.h>
> > > +#include <linux/interrupt.h>
> > > +#include <linux/platform_device.h>
> > > +
> > > +#include "dcss-dev.h"
> > > +
> > > +#define DCSS_CTXLD_DEVNAME             "dcss_ctxld"
> > > +
> > > +#define DCSS_CTXLD_CONTROL_STATUS      0x0
> > > +#define   CTXLD_ENABLE                 BIT(0)
> > > +#define   ARB_SEL                      BIT(1)
> > > +#define   RD_ERR_EN                    BIT(2)
> > > +#define   DB_COMP_EN                   BIT(3)
> > > +#define   SB_HP_COMP_EN                        BIT(4)
> > > +#define   SB_LP_COMP_EN                        BIT(5)
> > > +#define   DB_PEND_SB_REC_EN            BIT(6)
> > > +#define   SB_PEND_DISP_ACTIVE_EN       BIT(7)
> > > +#define   AHB_ERR_EN                   BIT(8)
> > > +#define   RD_ERR                       BIT(16)
> > > +#define   DB_COMP                      BIT(17)
> > > +#define   SB_HP_COMP                   BIT(18)
> > > +#define   SB_LP_COMP                   BIT(19)
> > > +#define   DB_PEND_SB_REC               BIT(20)
> > > +#define   SB_PEND_DISP_ACTIVE          BIT(21)
> > > +#define   AHB_ERR                      BIT(22)
> > > +#define DCSS_CTXLD_DB_BASE_ADDR                0x10
> > > +#define DCSS_CTXLD_DB_COUNT            0x14
> > > +#define DCSS_CTXLD_SB_BASE_ADDR                0x18
> > > +#define DCSS_CTXLD_SB_COUNT            0x1C
> > > +#define   SB_HP_COUNT_POS              0
> > > +#define   SB_HP_COUNT_MASK             0xffff
> > > +#define   SB_LP_COUNT_POS              16
> > > +#define   SB_LP_COUNT_MASK             0xffff0000
> > > +#define DCSS_AHB_ERR_ADDR              0x20
> > > +
> > > +#define CTXLD_IRQ_NAME                 "ctx_ld"
> > > +#define CTXLD_IRQ_COMPLETION           (DB_COMP | SB_HP_COMP | SB_LP_COMP)
> > > +#define CTXLD_IRQ_ERROR                        (RD_ERR | DB_PEND_SB_REC | AHB_ERR)
> > > +
> > > +/* The following sizes are in context loader entries, 8 bytes each. */
> > > +#define CTXLD_DB_CTX_ENTRIES           1024    /* max 65536 */
> > > +#define CTXLD_SB_LP_CTX_ENTRIES                10240   /* max 65536 */
> > > +#define CTXLD_SB_HP_CTX_ENTRIES                20000   /* max 65536 */
> > > +#define CTXLD_SB_CTX_ENTRIES           (CTXLD_SB_LP_CTX_ENTRIES + \
> > > +                                        CTXLD_SB_HP_CTX_ENTRIES)
> > > +
> > > +/* Sizes, in entries, of the DB, SB_HP and SB_LP context regions. */
> > > +static u16 dcss_ctxld_ctx_size[3] = {
> > > +       CTXLD_DB_CTX_ENTRIES,
> > > +       CTXLD_SB_HP_CTX_ENTRIES,
> > > +       CTXLD_SB_LP_CTX_ENTRIES
> > > +};
> > > +
> > > +/* this represents an entry in the context loader map */
> > > +struct dcss_ctxld_item {
> > > +       u32 val;
> > > +       u32 ofs;
> > > +};
> > > +
> > > +#define CTX_ITEM_SIZE                  sizeof(struct dcss_ctxld_item)
> > > +
> > > +struct dcss_ctxld {
> > > +       struct device *dev;
> > > +       void __iomem *ctxld_reg;
> > > +       int irq;
> > > +       bool irq_en;
> > > +
> > > +       struct dcss_ctxld_item *db[2];
> > > +       struct dcss_ctxld_item *sb_hp[2];
> > > +       struct dcss_ctxld_item *sb_lp[2];
> > > +
> > > +       dma_addr_t db_paddr[2];
> > > +       dma_addr_t sb_paddr[2];
> > > +
> > > +       u16 ctx_size[2][3]; /* holds the sizes of DB, SB_HP and SB_LP ctx */
> > > +       u8 current_ctx;
> > > +
> > > +       bool in_use;
> > > +       bool armed;
> > > +
> > > +       spinlock_t lock; /* protects concurent access to private data */
> > > +
> > > +       void (*dtg_disable_cb)(void *data);
> > > +       void *dtg_disable_data;
> > > +};
> > > +
> > > +static int __dcss_ctxld_enable(struct dcss_ctxld *ctxld);
> > > +
> > > +static irqreturn_t dcss_ctxld_irq_handler(int irq, void *data)
> > > +{
> > > +       struct dcss_ctxld *ctxld = data;
> > > +       u32 irq_status;
> > > +
> > > +       irq_status = dcss_readl(ctxld->ctxld_reg + DCSS_CTXLD_CONTROL_STATUS);
> > > +
> > > +       if (irq_status & CTXLD_IRQ_COMPLETION &&
> > > +           !(irq_status & CTXLD_ENABLE) && ctxld->in_use) {
> > > +               ctxld->in_use = false;
> > > +
> > > +               if (ctxld->dtg_disable_cb) {
> > > +                       ctxld->dtg_disable_cb(ctxld->dtg_disable_data);
> > > +                       ctxld->dtg_disable_cb = NULL;
> > > +                       ctxld->dtg_disable_data = NULL;
> > > +               }
> > > +       } else if (irq_status & CTXLD_IRQ_ERROR) {
> > > +               /*
> > > +                * Except for throwing an error message and clearing the status
> > > +                * register, there's not much we can do here.
> > > +                */
> > > +               dev_err(ctxld->dev, "ctxld: error encountered: %08x\n",
> > > +                       irq_status);
> > > +               dev_err(ctxld->dev, "ctxld: db=%d, sb_hp=%d, sb_lp=%d\n",
> > > +                       ctxld->ctx_size[ctxld->current_ctx ^ 1][CTX_DB],
> > > +                       ctxld->ctx_size[ctxld->current_ctx ^ 1][CTX_SB_HP],
> > > +                       ctxld->ctx_size[ctxld->current_ctx ^ 1][CTX_SB_LP]);
> > > +       }
> > > +
> > > +       dcss_clr(irq_status & (CTXLD_IRQ_ERROR | CTXLD_IRQ_COMPLETION),
> > > +                ctxld->ctxld_reg + DCSS_CTXLD_CONTROL_STATUS);
> > > +
> > > +       return IRQ_HANDLED;
> > > +}
> > > +
> > > +static int dcss_ctxld_irq_config(struct dcss_ctxld *ctxld,
> > > +                                struct platform_device *pdev)
> > > +{
> > > +       int ret;
> > > +
> > > +       ctxld->irq = platform_get_irq_byname(pdev, CTXLD_IRQ_NAME);
> > > +       if (ctxld->irq < 0) {
> > > +               dev_err(ctxld->dev, "ctxld: can't get irq number\n");
> > > +               return ctxld->irq;
> > > +       }
> > > +
> > > +       ret = devm_request_irq(ctxld->dev, ctxld->irq,
> > > +                              dcss_ctxld_irq_handler,
> > > +                              IRQF_ONESHOT | IRQF_TRIGGER_HIGH,
> > > +                              DCSS_CTXLD_DEVNAME, ctxld);
> > > +       if (ret) {
> > > +               dev_err(ctxld->dev, "ctxld: irq request failed.\n");
> > > +               return ret;
> > > +       }
> > > +
> > > +       ctxld->irq_en = true;
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +void dcss_ctxld_hw_cfg(struct dcss_ctxld *ctxld)
> > > +{
> > > +       dcss_writel(RD_ERR_EN | SB_HP_COMP_EN |
> > > +                   DB_PEND_SB_REC_EN | AHB_ERR_EN | RD_ERR | AHB_ERR,
> > > +                   ctxld->ctxld_reg + DCSS_CTXLD_CONTROL_STATUS);
> > > +}
> > > +
> > > +static void dcss_ctxld_free_ctx(struct dcss_ctxld *ctxld)
> > > +{
> > > +       struct dcss_ctxld_item *ctx;
> > > +       int i;
> > > +
> > > +       for (i = 0; i < 2; i++) {
> > > +               if (ctxld->db[i]) {
> > > +                       dmam_free_coherent(ctxld->dev,
> > > +                                          CTXLD_DB_CTX_ENTRIES * sizeof(*ctx),
> > > +                                          ctxld->db[i], ctxld->db_paddr[i]);
> > > +                       ctxld->db[i] = NULL;
> > > +                       ctxld->db_paddr[i] = 0;
> > > +               }
> > > +
> > > +               if (ctxld->sb_hp[i]) {
> > > +                       dmam_free_coherent(ctxld->dev,
> > > +                                          CTXLD_SB_CTX_ENTRIES * sizeof(*ctx),
> > > +                                          ctxld->sb_hp[i], ctxld->sb_paddr[i]);
> > > +                       ctxld->sb_hp[i] = NULL;
> > > +                       ctxld->sb_paddr[i] = 0;
> > > +               }
> > > +       }
> > > +}
> > > +
> > > +static int dcss_ctxld_alloc_ctx(struct dcss_ctxld *ctxld)
> > > +{
> > > +       struct dcss_ctxld_item *ctx;
> > > +       int i;
> > > +       dma_addr_t dma_handle;
> > > +
> > > +       for (i = 0; i < 2; i++) {
> > > +               ctx = dmam_alloc_coherent(ctxld->dev,
> > > +                                         CTXLD_DB_CTX_ENTRIES * sizeof(*ctx),
> > > +                                         &dma_handle, GFP_KERNEL);
> > > +               if (!ctx)
> > > +                       return -ENOMEM;
> > > +
> > > +               ctxld->db[i] = ctx;
> > > +               ctxld->db_paddr[i] = dma_handle;
> > > +
> > > +               ctx = dmam_alloc_coherent(ctxld->dev,
> > > +                                         CTXLD_SB_CTX_ENTRIES * sizeof(*ctx),
> > > +                                         &dma_handle, GFP_KERNEL);
> > > +               if (!ctx)
> > > +                       return -ENOMEM;
> > > +
> > > +               ctxld->sb_hp[i] = ctx;
> > > +               ctxld->sb_lp[i] = ctx + CTXLD_SB_HP_CTX_ENTRIES;
> > > +
> > > +               ctxld->sb_paddr[i] = dma_handle;
> > > +       }
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +int dcss_ctxld_init(struct dcss_dev *dcss, unsigned long ctxld_base)
> > > +{
> > > +       struct dcss_ctxld *ctxld;
> > > +       int ret;
> > > +
> > > +       ctxld = devm_kzalloc(dcss->dev, sizeof(struct dcss_ctxld),
> > > +                            GFP_KERNEL);
> > > +       if (!ctxld)
> > > +               return -ENOMEM;
> > > +
> > > +       dcss->ctxld = ctxld;
> > > +       ctxld->dev = dcss->dev;
> > > +
> > > +       spin_lock_init(&ctxld->lock);
> > > +
> > > +       ret = dcss_ctxld_alloc_ctx(ctxld);
> > > +       if (ret) {
> > > +               dev_err(dcss->dev, "ctxld: cannot allocate context memory.\n");
> > > +               goto err;
> > > +       }
> > > +
> > > +       ctxld->ctxld_reg = devm_ioremap(dcss->dev, ctxld_base, SZ_4K);
> > > +       if (!ctxld->ctxld_reg) {
> > > +               dev_err(dcss->dev, "ctxld: unable to remap ctxld base\n");
> > > +               ret = -ENOMEM;
> > > +               goto err;
> > > +       }
> > > +
> > > +       ret = dcss_ctxld_irq_config(ctxld, to_platform_device(dcss->dev));
> > > +       if (ret)
> > > +               goto err_irq;
> > > +
> > > +       dcss_ctxld_hw_cfg(ctxld);
> > > +
> > > +       return 0;
> > > +
> > > +err_irq:
> > > +       devm_iounmap(ctxld->dev, ctxld->ctxld_reg);
> > > +
> > > +err:
> > > +       dcss_ctxld_free_ctx(ctxld);
> > > +       devm_kfree(ctxld->dev, ctxld);
> > > +
> > > +       return ret;
> > > +}
> > > +
> > > +void dcss_ctxld_exit(struct dcss_ctxld *ctxld)
> > > +{
> > > +       devm_free_irq(ctxld->dev, ctxld->irq, ctxld);
> > > +
> > > +       if (ctxld->ctxld_reg)
> > > +               devm_iounmap(ctxld->dev, ctxld->ctxld_reg);
> > > +
> > > +       dcss_ctxld_free_ctx(ctxld);
> > > +       devm_kfree(ctxld->dev, ctxld);
> > > +}
> > > +
> > > +static int __dcss_ctxld_enable(struct dcss_ctxld *ctxld)
> > > +{
> > > +       int curr_ctx = ctxld->current_ctx;
> > > +       u32 db_base, sb_base, sb_count;
> > > +       u32 sb_hp_cnt, sb_lp_cnt, db_cnt;
> > > +       struct dcss_dev *dcss = dcss_drv_dev_to_dcss(ctxld->dev);
> > > +
> > > +       dcss_dpr_write_sysctrl(dcss->dpr);
> > > +
> > > +       dcss_scaler_write_sclctrl(dcss->scaler);
> > > +
> > > +       sb_hp_cnt = ctxld->ctx_size[curr_ctx][CTX_SB_HP];
> > > +       sb_lp_cnt = ctxld->ctx_size[curr_ctx][CTX_SB_LP];
> > > +       db_cnt = ctxld->ctx_size[curr_ctx][CTX_DB];
> > > +
> > > +       /* make sure SB_LP context area comes after SB_HP */
> > > +       if (sb_lp_cnt &&
> > > +           ctxld->sb_lp[curr_ctx] != ctxld->sb_hp[curr_ctx] + sb_hp_cnt) {
> > > +               struct dcss_ctxld_item *sb_lp_adjusted;
> > > +
> > > +               sb_lp_adjusted = ctxld->sb_hp[curr_ctx] + sb_hp_cnt;
> > > +
> > > +               memcpy(sb_lp_adjusted, ctxld->sb_lp[curr_ctx],
> > > +                      sb_lp_cnt * CTX_ITEM_SIZE);
> > > +       }
> > > +
> > > +       db_base = db_cnt ? ctxld->db_paddr[curr_ctx] : 0;
> > > +
> > > +       dcss_writel(db_base, ctxld->ctxld_reg + DCSS_CTXLD_DB_BASE_ADDR);
> > > +       dcss_writel(db_cnt, ctxld->ctxld_reg + DCSS_CTXLD_DB_COUNT);
> > > +
> > > +       if (sb_hp_cnt)
> > > +               sb_count = ((sb_hp_cnt << SB_HP_COUNT_POS) & SB_HP_COUNT_MASK) |
> > > +                          ((sb_lp_cnt << SB_LP_COUNT_POS) & SB_LP_COUNT_MASK);
> > > +       else
> > > +               sb_count = (sb_lp_cnt << SB_HP_COUNT_POS) & SB_HP_COUNT_MASK;
> > > +
> > > +       sb_base = sb_count ? ctxld->sb_paddr[curr_ctx] : 0;
> > > +
> > > +       dcss_writel(sb_base, ctxld->ctxld_reg + DCSS_CTXLD_SB_BASE_ADDR);
> > > +       dcss_writel(sb_count, ctxld->ctxld_reg + DCSS_CTXLD_SB_COUNT);
> > > +
> > > +       /* enable the context loader */
> > > +       dcss_set(CTXLD_ENABLE, ctxld->ctxld_reg + DCSS_CTXLD_CONTROL_STATUS);
> > > +
> > > +       ctxld->in_use = true;
> > > +
> > > +       /*
> > > +        * Toggle the current context to the alternate one so that any updates
> > > +        * in the modules' settings take place there.
> > > +        */
> > > +       ctxld->current_ctx ^= 1;
> > > +
> > > +       ctxld->ctx_size[ctxld->current_ctx][CTX_DB] = 0;
> > > +       ctxld->ctx_size[ctxld->current_ctx][CTX_SB_HP] = 0;
> > > +       ctxld->ctx_size[ctxld->current_ctx][CTX_SB_LP] = 0;
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +int dcss_ctxld_enable(struct dcss_ctxld *ctxld)
> > > +{
> > > +       unsigned long flags;
> > > +
> > > +       spin_lock_irqsave(&ctxld->lock, flags);
> > > +       ctxld->armed = true;
> > > +       spin_unlock_irqrestore(&ctxld->lock, flags);
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +void dcss_ctxld_kick(struct dcss_ctxld *ctxld)
> > > +{
> > > +       unsigned long flags;
> > > +
> > > +       spin_lock_irqsave(&ctxld->lock, flags);
> > > +       if (ctxld->armed && !ctxld->in_use) {
> > > +               ctxld->armed = false;
> > > +               __dcss_ctxld_enable(ctxld);
> > > +       }
> > > +       spin_unlock_irqrestore(&ctxld->lock, flags);
> > > +}
> > > +
> > > +void dcss_ctxld_write_irqsafe(struct dcss_ctxld *ctxld, u32 ctx_id, u32 val,
> > > +                             u32 reg_ofs)
> > > +{
> > > +       int curr_ctx = ctxld->current_ctx;
> > > +       struct dcss_ctxld_item *ctx[] = {
> > > +               [CTX_DB] = ctxld->db[curr_ctx],
> > > +               [CTX_SB_HP] = ctxld->sb_hp[curr_ctx],
> > > +               [CTX_SB_LP] = ctxld->sb_lp[curr_ctx]
> > > +       };
> > > +       int item_idx = ctxld->ctx_size[curr_ctx][ctx_id];
> > > +
> > > +       if (item_idx + 1 > dcss_ctxld_ctx_size[ctx_id]) {
> > > +               WARN_ON(1);
> > > +               return;
> > > +       }
> > > +
> > > +       ctx[ctx_id][item_idx].val = val;
> > > +       ctx[ctx_id][item_idx].ofs = reg_ofs;
> > > +       ctxld->ctx_size[curr_ctx][ctx_id] += 1;
> > > +}
> > > +
> > > +void dcss_ctxld_write(struct dcss_ctxld *ctxld, u32 ctx_id,
> > > +                     u32 val, u32 reg_ofs)
> > > +{
> > > +       unsigned long flags;
> > > +
> > > +       spin_lock_irqsave(&ctxld->lock, flags);
> > > +       dcss_ctxld_write_irqsafe(ctxld, ctx_id, val, reg_ofs);
> > > +       spin_unlock_irqrestore(&ctxld->lock, flags);
> > > +}
> > > +
> > > +bool dcss_ctxld_is_flushed(struct dcss_ctxld *ctxld)
> > > +{
> > > +       return ctxld->ctx_size[ctxld->current_ctx][CTX_DB] == 0 &&
> > > +               ctxld->ctx_size[ctxld->current_ctx][CTX_SB_HP] == 0 &&
> > > +               ctxld->ctx_size[ctxld->current_ctx][CTX_SB_LP] == 0;
> > > +}
> > > +
> > > +int dcss_ctxld_resume(struct dcss_ctxld *ctxld)
> > > +{
> > > +       dcss_ctxld_hw_cfg(ctxld);
> > > +
> > > +       if (!ctxld->irq_en) {
> > > +               enable_irq(ctxld->irq);
> > > +               ctxld->irq_en = true;
> > > +       }
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +int dcss_ctxld_suspend(struct dcss_ctxld *ctxld)
> > > +{
> > > +       int ret = 0;
> > > +       int wait_time_ms = 0;
> > > +       unsigned long flags;
> > > +
> > > +       dcss_ctxld_kick(ctxld);
> > > +
> > > +       while (ctxld->in_use && wait_time_ms < 500) {
> > > +               msleep(20);
> > > +               wait_time_ms += 20;
> > > +       }
> > > +
> > > +       if (wait_time_ms > 500)
> > > +               return -ETIMEDOUT;
> > > +
> > > +       spin_lock_irqsave(&ctxld->lock, flags);
> > > +
> > > +       if (ctxld->irq_en) {
> > > +               disable_irq_nosync(ctxld->irq);
> > > +               ctxld->irq_en = false;
> > > +       }
> > > +
> > > +       /* reset context region and sizes */
> > > +       ctxld->current_ctx = 0;
> > > +       ctxld->ctx_size[0][CTX_DB] = 0;
> > > +       ctxld->ctx_size[0][CTX_SB_HP] = 0;
> > > +       ctxld->ctx_size[0][CTX_SB_LP] = 0;
> > > +
> > > +       spin_unlock_irqrestore(&ctxld->lock, flags);
> > > +
> > > +       return ret;
> > > +}
> > > +
> > > +void dcss_ctxld_register_dtg_disable_cb(struct dcss_ctxld *ctxld,
> > > +                                       void (*cb)(void *),
> > > +                                       void *data)
> > > +{
> > > +       ctxld->dtg_disable_cb = cb;
> > > +       ctxld->dtg_disable_data = data;
> > > +}
> > > diff --git a/drivers/gpu/drm/imx/dcss/dcss-dev.c b/drivers/gpu/drm/imx/dcss/dcss-dev.c
> > > new file mode 100644
> > > index 00000000..265bf3c
> > > --- /dev/null
> > > +++ b/drivers/gpu/drm/imx/dcss/dcss-dev.c
> > > @@ -0,0 +1,286 @@
> > > +// SPDX-License-Identifier: GPL-2.0
> > > +/*
> > > + * Copyright 2019 NXP.
> > > + */
> > > +
> > > +#include <linux/clk.h>
> > > +#include <linux/of_device.h>
> > > +#include <linux/of_graph.h>
> > > +#include <linux/pm_runtime.h>
> > > +#include <drm/drm_modeset_helper.h>
> > > +
> > > +#include "dcss-dev.h"
> > > +
> > > +static void dcss_clocks_enable(struct dcss_dev *dcss)
> > > +{
> > > +       if (dcss->clks_on)
> > > +               return;
> > > +
> > > +       clk_prepare_enable(dcss->axi_clk);
> > > +       clk_prepare_enable(dcss->apb_clk);
> > > +       clk_prepare_enable(dcss->rtrm_clk);
> > > +       clk_prepare_enable(dcss->dtrc_clk);
> > > +       clk_prepare_enable(dcss->pix_clk);
> > > +
> > > +       dcss->clks_on = true;
> > > +}
> > > +
> > > +static void dcss_clocks_disable(struct dcss_dev *dcss)
> > > +{
> > > +       if (!dcss->clks_on)
> > > +               return;
> > > +
> > > +       clk_disable_unprepare(dcss->pix_clk);
> > > +       clk_disable_unprepare(dcss->dtrc_clk);
> > > +       clk_disable_unprepare(dcss->rtrm_clk);
> > > +       clk_disable_unprepare(dcss->apb_clk);
> > > +       clk_disable_unprepare(dcss->axi_clk);
> > > +
> > > +       dcss->clks_on = false;
> > > +}
> > > +
> > > +static int dcss_submodules_init(struct dcss_dev *dcss)
> > > +{
> > > +       int ret = 0;
> > > +       u32 base_addr = dcss->start_addr;
> > > +       const struct dcss_type_data *devtype = dcss->devtype;
> > > +
> > > +       dcss_clocks_enable(dcss);
> > > +
> > > +       ret = dcss_blkctl_init(dcss, base_addr + devtype->blkctl_ofs);
> > > +       if (ret)
> > > +               return ret;
> > > +
> > > +       ret = dcss_ctxld_init(dcss, base_addr + devtype->ctxld_ofs);
> > > +       if (ret)
> > > +               goto ctxld_err;
> > > +
> > > +       ret = dcss_dtg_init(dcss, base_addr + devtype->dtg_ofs);
> > > +       if (ret)
> > > +               goto dtg_err;
> > > +
> > > +       ret = dcss_ss_init(dcss, base_addr + devtype->ss_ofs);
> > > +       if (ret)
> > > +               goto ss_err;
> > > +
> > > +       ret = dcss_dpr_init(dcss, base_addr + devtype->dpr_ofs);
> > > +       if (ret)
> > > +               goto dpr_err;
> > > +
> > > +       ret = dcss_scaler_init(dcss, base_addr + devtype->scaler_ofs);
> > > +       if (ret)
> > > +               goto scaler_err;
> > > +
> > > +       return 0;
> > > +
> > > +scaler_err:
> > > +       dcss_dpr_exit(dcss->dpr);
> > > +
> > > +dpr_err:
> > > +       dcss_ss_exit(dcss->ss);
> > > +
> > > +ss_err:
> > > +       dcss_dtg_exit(dcss->dtg);
> > > +
> > > +dtg_err:
> > > +       dcss_ctxld_exit(dcss->ctxld);
> > > +
> > > +ctxld_err:
> > > +       dcss_blkctl_exit(dcss->blkctl);
> > > +
> > > +       dcss_clocks_disable(dcss);
> > > +
> > > +       return ret;
> > > +}
> > > +
> > > +static void dcss_submodules_stop(struct dcss_dev *dcss)
> > > +{
> > > +       dcss_clocks_enable(dcss);
> > > +       dcss_scaler_exit(dcss->scaler);
> > > +       dcss_dpr_exit(dcss->dpr);
> > > +       dcss_ss_exit(dcss->ss);
> > > +       dcss_dtg_exit(dcss->dtg);
> > > +       dcss_ctxld_exit(dcss->ctxld);
> > > +       dcss_blkctl_exit(dcss->blkctl);
> > > +       dcss_clocks_disable(dcss);
> > > +}
> > > +
> > > +static int dcss_clks_init(struct dcss_dev *dcss)
> > > +{
> > > +       int i;
> > > +       struct {
> > > +               const char *id;
> > > +               struct clk **clk;
> > > +       } clks[] = {
> > > +               {"apb",   &dcss->apb_clk},
> > > +               {"axi",   &dcss->axi_clk},
> > > +               {"pix",   &dcss->pix_clk},
> > > +               {"rtrm",  &dcss->rtrm_clk},
> > > +               {"dtrc",  &dcss->dtrc_clk},
> > > +       };
> > > +
> > > +       for (i = 0; i < ARRAY_SIZE(clks); i++) {
> > > +               *clks[i].clk = devm_clk_get(dcss->dev, clks[i].id);
> > > +               if (IS_ERR(*clks[i].clk)) {
> > > +                       dev_err(dcss->dev, "failed to get %s clock\n",
> > > +                               clks[i].id);
> > > +                       return PTR_ERR(*clks[i].clk);
> > > +               }
> > > +       }
> > > +
> > > +       dcss->clks_on = false;
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +static void dcss_clks_release(struct dcss_dev *dcss)
> > > +{
> > > +       devm_clk_put(dcss->dev, dcss->dtrc_clk);
> > > +       devm_clk_put(dcss->dev, dcss->rtrm_clk);
> > > +       devm_clk_put(dcss->dev, dcss->pix_clk);
> > > +       devm_clk_put(dcss->dev, dcss->axi_clk);
> > > +       devm_clk_put(dcss->dev, dcss->apb_clk);
> > > +}
> > > +
> > > +struct dcss_dev *dcss_dev_create(struct device *dev, bool hdmi_output)
> > > +{
> > > +       struct platform_device *pdev = to_platform_device(dev);
> > > +       int ret;
> > > +       struct resource *res;
> > > +       struct dcss_dev *dcss;
> > > +       const struct dcss_type_data *devtype;
> > > +
> > > +       devtype = of_device_get_match_data(dev);
> > > +       if (!devtype) {
> > > +               dev_err(dev, "no device match found\n");
> > > +               return ERR_PTR(-ENODEV);
> > > +       }
> > > +
> > > +       res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
> > > +       if (!res) {
> > > +               dev_err(dev, "cannot get memory resource\n");
> > > +               return ERR_PTR(-EINVAL);
> > > +       }
> > > +
> > > +       dcss = devm_kzalloc(dev, sizeof(struct dcss_dev), GFP_KERNEL);
> > > +       if (!dcss)
> > > +               return ERR_PTR(-ENOMEM);
> > > +
> > > +       dcss->dev = dev;
> > > +       dcss->devtype = devtype;
> > > +       dcss->hdmi_output = hdmi_output;
> > > +
> > > +       ret = dcss_clks_init(dcss);
> > > +       if (ret) {
> > > +               dev_err(dev, "clocks initialization failed\n");
> > > +               goto err;
> > > +       }
> > > +
> > > +       dcss->of_port = of_graph_get_port_by_id(dev->of_node, 0);
> > > +       if (!dcss->of_port) {
> > > +               dev_err(dev, "no port@0 node in %s\n", dev->of_node->full_name);
> > > +               ret = -ENODEV;
> > > +               goto clks_err;
> > > +       }
> > > +
> > > +       dcss->start_addr = res->start;
> > > +
> > > +       ret = dcss_submodules_init(dcss);
> > > +       if (ret) {
> > > +               dev_err(dev, "submodules initialization failed\n");
> > > +               goto clks_err;
> > > +       }
> > > +
> > > +       pm_runtime_enable(dev);
> > > +
> > > +       return dcss;
> > > +
> > > +clks_err:
> > > +       dcss_clks_release(dcss);
> > > +
> > > +err:
> > > +       devm_kfree(dcss->dev, dcss);
> > > +
> > > +       return ERR_PTR(ret);
> > > +}
> > > +
> > > +void dcss_dev_destroy(struct dcss_dev *dcss)
> > > +{
> > > +       pm_runtime_disable(dcss->dev);
> > > +
> > > +       dcss_submodules_stop(dcss);
> > > +
> > > +       dcss_clks_release(dcss);
> > > +
> > > +       devm_kfree(dcss->dev, dcss);
> > > +}
> > > +
> > > +#ifdef CONFIG_PM_SLEEP
> > > +int dcss_dev_suspend(struct device *dev)
> > > +{
> > > +       struct dcss_dev *dcss = dcss_drv_dev_to_dcss(dev);
> > > +       int ret;
> > > +
> > > +       drm_mode_config_helper_suspend(dcss_drv_dev_to_drm(dev));
> > > +
> > > +       if (pm_runtime_suspended(dev))
> > > +               return 0;
> > > +
> > > +       ret = dcss_ctxld_suspend(dcss->ctxld);
> > > +       if (ret)
> > > +               return ret;
> > > +
> > > +       dcss_clocks_disable(dcss);
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +int dcss_dev_resume(struct device *dev)
> > > +{
> > > +       struct dcss_dev *dcss = dcss_drv_dev_to_dcss(dev);
> > > +
> > > +       if (pm_runtime_suspended(dev)) {
> > > +               drm_mode_config_helper_resume(dcss_drv_dev_to_drm(dev));
> > > +               return 0;
> > > +       }
> > > +
> > > +       dcss_clocks_enable(dcss);
> > > +
> > > +       dcss_blkctl_cfg(dcss->blkctl);
> > > +
> > > +       dcss_ctxld_resume(dcss->ctxld);
> > > +
> > > +       drm_mode_config_helper_resume(dcss_drv_dev_to_drm(dev));
> > > +
> > > +       return 0;
> > > +}
> > > +#endif /* CONFIG_PM_SLEEP */
> > > +
> > > +#ifdef CONFIG_PM
> > > +int dcss_dev_runtime_suspend(struct device *dev)
> > > +{
> > > +       struct dcss_dev *dcss = dcss_drv_dev_to_dcss(dev);
> > > +       int ret;
> > > +
> > > +       ret = dcss_ctxld_suspend(dcss->ctxld);
> > > +       if (ret)
> > > +               return ret;
> > > +
> > > +       dcss_clocks_disable(dcss);
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +int dcss_dev_runtime_resume(struct device *dev)
> > > +{
> > > +       struct dcss_dev *dcss = dcss_drv_dev_to_dcss(dev);
> > > +
> > > +       dcss_clocks_enable(dcss);
> > > +
> > > +       dcss_blkctl_cfg(dcss->blkctl);
> > > +
> > > +       dcss_ctxld_resume(dcss->ctxld);
> > > +
> > > +       return 0;
> > > +}
> > > +#endif /* CONFIG_PM */
> > > diff --git a/drivers/gpu/drm/imx/dcss/dcss-dev.h b/drivers/gpu/drm/imx/dcss/dcss-dev.h
> > > new file mode 100644
> > > index 00000000..15c5de3
> > > --- /dev/null
> > > +++ b/drivers/gpu/drm/imx/dcss/dcss-dev.h
> > > @@ -0,0 +1,195 @@
> > > +/* SPDX-License-Identifier: GPL-2.0 */
> > > +/*
> > > + * Copyright 2019 NXP.
> > > + */
> > > +
> > > +#ifndef __DCSS_PRV_H__
> > > +#define __DCSS_PRV_H__
> > > +
> > > +#include <drm/drm_fourcc.h>
> > > +#include <linux/io.h>
> > > +#include <video/videomode.h>
> > > +
> > > +#define SET                    0x04
> > > +#define CLR                    0x08
> > > +#define TGL                    0x0C
> > > +
> > > +#define dcss_writel(v, c)      writel((v), (c))
> > > +#define dcss_readl(c)          readl(c)
> > > +#define dcss_set(v, c)         writel((v), (c) + SET)
> > > +#define dcss_clr(v, c)         writel((v), (c) + CLR)
> > > +#define dcss_toggle(v, c)      writel((v), (c) + TGL)
> > > +
> > > +static inline void dcss_update(u32 v, u32 m, void __iomem *c)
> > > +{
> > > +       writel((readl(c) & ~(m)) | (v), (c));
> > > +}
> > > +
> > > +#define DCSS_DBG_REG(reg)      {.name = #reg, .ofs = reg}
> > > +
> > > +enum {
> > > +       DCSS_IMX8MQ = 0,
> > > +};
> > > +
> > > +struct dcss_type_data {
> > > +       const char *name;
> > > +       u32 blkctl_ofs;
> > > +       u32 ctxld_ofs;
> > > +       u32 rdsrc_ofs;
> > > +       u32 wrscl_ofs;
> > > +       u32 dtg_ofs;
> > > +       u32 scaler_ofs;
> > > +       u32 ss_ofs;
> > > +       u32 dpr_ofs;
> > > +       u32 dtrc_ofs;
> > > +       u32 dec400d_ofs;
> > > +       u32 hdr10_ofs;
> > > +};
> > > +
> > > +struct dcss_debug_reg {
> > > +       char *name;
> > > +       u32 ofs;
> > > +};
> > > +
> > > +enum dcss_ctxld_ctx_type {
> > > +       CTX_DB,
> > > +       CTX_SB_HP, /* high-priority */
> > > +       CTX_SB_LP, /* low-priority  */
> > > +};
> > > +
> > > +struct dcss_dev {
> > > +       struct device *dev;
> > > +       const struct dcss_type_data *devtype;
> > > +       struct device_node *of_port;
> > > +
> > > +       u32 start_addr;
> > > +
> > > +       struct dcss_blkctl *blkctl;
> > > +       struct dcss_ctxld *ctxld;
> > > +       struct dcss_dpr *dpr;
> > > +       struct dcss_dtg *dtg;
> > > +       struct dcss_ss *ss;
> > > +       struct dcss_hdr10 *hdr10;
> > > +       struct dcss_scaler *scaler;
> > > +       struct dcss_dtrc *dtrc;
> > > +       struct dcss_dec400d *dec400d;
> > > +       struct dcss_wrscl *wrscl;
> > > +       struct dcss_rdsrc *rdsrc;
> > > +
> > > +       struct clk *apb_clk;
> > > +       struct clk *axi_clk;
> > > +       struct clk *pix_clk;
> > > +       struct clk *rtrm_clk;
> > > +       struct clk *dtrc_clk;
> > > +       struct clk *pll_src_clk;
> > > +       struct clk *pll_phy_ref_clk;
> > > +
> > > +       void (*dcss_disable_callback)(void *data);
> > > +
> > > +       bool clks_on;
> > > +       bool hdmi_output;
> > > +};
> > > +
> > > +enum dcss_color_space {
> > > +       DCSS_COLORSPACE_RGB,
> > > +       DCSS_COLORSPACE_YUV,
> > > +       DCSS_COLORSPACE_UNKNOWN,
> > > +};
> > > +
> > > +struct dcss_dev *dcss_drv_dev_to_dcss(struct device *dev);
> > > +struct drm_device *dcss_drv_dev_to_drm(struct device *dev);
> > > +struct dcss_dev *dcss_dev_create(struct device *dev, bool mipi_output);
> > > +void dcss_dev_destroy(struct dcss_dev *dcss);
> > > +int dcss_dev_runtime_suspend(struct device *dev);
> > > +int dcss_dev_runtime_resume(struct device *dev);
> > > +int dcss_dev_suspend(struct device *dev);
> > > +int dcss_dev_resume(struct device *dev);
> > > +
> > > +/* BLKCTL */
> > > +int dcss_blkctl_init(struct dcss_dev *dcss, unsigned long blkctl_base);
> > > +void dcss_blkctl_cfg(struct dcss_blkctl *blkctl);
> > > +void dcss_blkctl_exit(struct dcss_blkctl *blkctl);
> > > +
> > > +/* CTXLD */
> > > +int dcss_ctxld_init(struct dcss_dev *dcss, unsigned long ctxld_base);
> > > +void dcss_ctxld_exit(struct dcss_ctxld *ctxld);
> > > +void dcss_ctxld_write(struct dcss_ctxld *ctxld, u32 ctx_id,
> > > +                     u32 val, u32 reg_idx);
> > > +int dcss_ctxld_resume(struct dcss_ctxld *dcss_ctxld);
> > > +int dcss_ctxld_suspend(struct dcss_ctxld *dcss_ctxld);
> > > +void dcss_ctxld_write_irqsafe(struct dcss_ctxld *ctlxd, u32 ctx_id, u32 val,
> > > +                             u32 reg_ofs);
> > > +void dcss_ctxld_kick(struct dcss_ctxld *ctxld);
> > > +bool dcss_ctxld_is_flushed(struct dcss_ctxld *ctxld);
> > > +int dcss_ctxld_enable(struct dcss_ctxld *ctxld);
> > > +void dcss_ctxld_register_dtg_disable_cb(struct dcss_ctxld *ctxld,
> > > +                                       void (*cb)(void *),
> > > +                                       void *data);
> > > +
> > > +/* DPR */
> > > +enum dcss_tile_type {
> > > +       TILE_LINEAR = 0,
> > > +       TILE_GPU_STANDARD,
> > > +       TILE_GPU_SUPER,
> > > +       TILE_VPU_YUV420,
> > > +       TILE_VPU_VP9,
> > > +};
> > > +
> > > +enum dcss_pix_size {
> > > +       PIX_SIZE_8,
> > > +       PIX_SIZE_16,
> > > +       PIX_SIZE_32,
> > > +};
> > > +
> > > +int dcss_dpr_init(struct dcss_dev *dcss, unsigned long dpr_base);
> > > +void dcss_dpr_exit(struct dcss_dpr *dpr);
> > > +void dcss_dpr_write_sysctrl(struct dcss_dpr *dpr);
> > > +void dcss_dpr_set_res(struct dcss_dpr *dpr, int ch_num, u32 xres, u32 yres);
> > > +void dcss_dpr_addr_set(struct dcss_dpr *dpr, int ch_num, u32 luma_base_addr,
> > > +                      u32 chroma_base_addr, u16 pitch);
> > > +void dcss_dpr_enable(struct dcss_dpr *dpr, int ch_num, bool en);
> > > +void dcss_dpr_format_set(struct dcss_dpr *dpr, int ch_num,
> > > +                        const struct drm_format_info *format, u64 modifier);
> > > +void dcss_dpr_set_rotation(struct dcss_dpr *dpr, int ch_num, u32 rotation);
> > > +
> > > +/* DTG */
> > > +int dcss_dtg_init(struct dcss_dev *dcss, unsigned long dtg_base);
> > > +void dcss_dtg_exit(struct dcss_dtg *dtg);
> > > +bool dcss_dtg_vblank_irq_valid(struct dcss_dtg *dtg);
> > > +void dcss_dtg_vblank_irq_enable(struct dcss_dtg *dtg, bool en);
> > > +void dcss_dtg_vblank_irq_clear(struct dcss_dtg *dtg);
> > > +void dcss_dtg_sync_set(struct dcss_dtg *dtg, struct videomode *vm);
> > > +void dcss_dtg_css_set(struct dcss_dtg *dtg);
> > > +void dcss_dtg_enable(struct dcss_dtg *dtg, bool en,
> > > +                    struct completion *dis_completion);
> > > +bool dcss_dtg_is_enabled(struct dcss_dtg *dtg);
> > > +void dcss_dtg_ctxld_kick_irq_enable(struct dcss_dtg *dtg, bool en);
> > > +bool dcss_dtg_global_alpha_changed(struct dcss_dtg *dtg, int ch_num, int alpha);
> > > +void dcss_dtg_plane_alpha_set(struct dcss_dtg *dtg, int ch_num,
> > > +                             const struct drm_format_info *format, int alpha);
> > > +void dcss_dtg_plane_pos_set(struct dcss_dtg *dtg, int ch_num,
> > > +                           int px, int py, int pw, int ph);
> > > +void dcss_dtg_ch_enable(struct dcss_dtg *dtg, int ch_num, bool en);
> > > +
> > > +/* SUBSAM */
> > > +int dcss_ss_init(struct dcss_dev *dcss, unsigned long subsam_base);
> > > +void dcss_ss_exit(struct dcss_ss *ss);
> > > +void dcss_ss_enable(struct dcss_ss *ss);
> > > +void dcss_ss_disable(struct dcss_ss *ss);
> > > +void dcss_ss_subsam_set(struct dcss_ss *ss);
> > > +void dcss_ss_sync_set(struct dcss_ss *ss, struct videomode *vm,
> > > +                     bool phsync, bool pvsync);
> > > +
> > > +/* SCALER */
> > > +int dcss_scaler_init(struct dcss_dev *dcss, unsigned long scaler_base);
> > > +void dcss_scaler_exit(struct dcss_scaler *scl);
> > > +void dcss_scaler_setup(struct dcss_scaler *scl, int ch_num,
> > > +                      const struct drm_format_info *format,
> > > +                      int src_xres, int src_yres, int dst_xres, int dst_yres,
> > > +                      u32 vrefresh_hz);
> > > +void dcss_scaler_ch_enable(struct dcss_scaler *scl, int ch_num, bool en);
> > > +int dcss_scaler_get_min_max_ratios(struct dcss_scaler *scl, int ch_num,
> > > +                                  int *min, int *max);
> > > +void dcss_scaler_write_sclctrl(struct dcss_scaler *scl);
> > > +
> > > +#endif /* __DCSS_PRV_H__ */
> > > diff --git a/drivers/gpu/drm/imx/dcss/dcss-dpr.c b/drivers/gpu/drm/imx/dcss/dcss-dpr.c
> > > new file mode 100644
> > > index 00000000..dbc7169
> > > --- /dev/null
> > > +++ b/drivers/gpu/drm/imx/dcss/dcss-dpr.c
> > > @@ -0,0 +1,552 @@
> > > +// SPDX-License-Identifier: GPL-2.0
> > > +/*
> > > + * Copyright 2019 NXP.
> > > + */
> > > +
> > > +#include <linux/device.h>
> > > +
> > > +#include "dcss-dev.h"
> > > +
> > > +#define DCSS_DPR_SYSTEM_CTRL0                  0x000
> > > +#define   RUN_EN                               BIT(0)
> > > +#define   SOFT_RESET                           BIT(1)
> > > +#define   REPEAT_EN                            BIT(2)
> > > +#define   SHADOW_LOAD_EN                       BIT(3)
> > > +#define   SW_SHADOW_LOAD_SEL                   BIT(4)
> > > +#define   BCMD2AXI_MSTR_ID_CTRL                        BIT(16)
> > > +#define DCSS_DPR_IRQ_MASK                      0x020
> > > +#define DCSS_DPR_IRQ_MASK_STATUS               0x030
> > > +#define DCSS_DPR_IRQ_NONMASK_STATUS            0x040
> > > +#define   IRQ_DPR_CTRL_DONE                    BIT(0)
> > > +#define   IRQ_DPR_RUN                          BIT(1)
> > > +#define   IRQ_DPR_SHADOW_LOADED                        BIT(2)
> > > +#define   IRQ_AXI_READ_ERR                     BIT(3)
> > > +#define   DPR2RTR_YRGB_FIFO_OVFL               BIT(4)
> > > +#define   DPR2RTR_UV_FIFO_OVFL                 BIT(5)
> > > +#define   DPR2RTR_FIFO_LD_BUF_RDY_YRGB_ERR     BIT(6)
> > > +#define   DPR2RTR_FIFO_LD_BUF_RDY_UV_ERR       BIT(7)
> > > +#define DCSS_DPR_MODE_CTRL0                    0x050
> > > +#define   RTR_3BUF_EN                          BIT(0)
> > > +#define   RTR_4LINE_BUF_EN                     BIT(1)
> > > +#define   TILE_TYPE_POS                                2
> > > +#define   TILE_TYPE_MASK                       GENMASK(4, 2)
> > > +#define   YUV_EN                               BIT(6)
> > > +#define   COMP_2PLANE_EN                       BIT(7)
> > > +#define   PIX_SIZE_POS                         8
> > > +#define   PIX_SIZE_MASK                                GENMASK(9, 8)
> > > +#define   PIX_LUMA_UV_SWAP                     BIT(10)
> > > +#define   PIX_UV_SWAP                          BIT(11)
> > > +#define   B_COMP_SEL_POS                       12
> > > +#define   B_COMP_SEL_MASK                      GENMASK(13, 12)
> > > +#define   G_COMP_SEL_POS                       14
> > > +#define   G_COMP_SEL_MASK                      GENMASK(15, 14)
> > > +#define   R_COMP_SEL_POS                       16
> > > +#define   R_COMP_SEL_MASK                      GENMASK(17, 16)
> > > +#define   A_COMP_SEL_POS                       18
> > > +#define   A_COMP_SEL_MASK                      GENMASK(19, 18)
> > > +#define DCSS_DPR_FRAME_CTRL0                   0x070
> > > +#define   HFLIP_EN                             BIT(0)
> > > +#define   VFLIP_EN                             BIT(1)
> > > +#define   ROT_ENC_POS                          2
> > > +#define   ROT_ENC_MASK                         GENMASK(3, 2)
> > > +#define   ROT_FLIP_ORDER_EN                    BIT(4)
> > > +#define   PITCH_POS                            16
> > > +#define   PITCH_MASK                           GENMASK(31, 16)
> > > +#define DCSS_DPR_FRAME_1P_CTRL0                        0x090
> > > +#define DCSS_DPR_FRAME_1P_PIX_X_CTRL           0x0A0
> > > +#define DCSS_DPR_FRAME_1P_PIX_Y_CTRL           0x0B0
> > > +#define DCSS_DPR_FRAME_1P_BASE_ADDR            0x0C0
> > > +#define DCSS_DPR_FRAME_2P_CTRL0                        0x0E0
> > > +#define DCSS_DPR_FRAME_2P_PIX_X_CTRL           0x0F0
> > > +#define DCSS_DPR_FRAME_2P_PIX_Y_CTRL           0x100
> > > +#define DCSS_DPR_FRAME_2P_BASE_ADDR            0x110
> > > +#define DCSS_DPR_STATUS_CTRL0                  0x130
> > > +#define   STATUS_MUX_SEL_MASK                  GENMASK(2, 0)
> > > +#define   STATUS_SRC_SEL_POS                   16
> > > +#define   STATUS_SRC_SEL_MASK                  GENMASK(18, 16)
> > > +#define DCSS_DPR_STATUS_CTRL1                  0x140
> > > +#define DCSS_DPR_RTRAM_CTRL0                   0x200
> > > +#define   NUM_ROWS_ACTIVE                      BIT(0)
> > > +#define   THRES_HIGH_POS                       1
> > > +#define   THRES_HIGH_MASK                      GENMASK(3, 1)
> > > +#define   THRES_LOW_POS                                4
> > > +#define   THRES_LOW_MASK                       GENMASK(6, 4)
> > > +#define   ABORT_SEL                            BIT(7)
> > > +
> > > +struct dcss_dpr_ch {
> > > +       struct dcss_dpr *dpr;
> > > +       void __iomem *base_reg;
> > > +       u32 base_ofs;
> > > +
> > > +       struct drm_format_info format;
> > > +       enum dcss_pix_size pix_size;
> > > +       enum dcss_tile_type tile;
> > > +       bool rtram_4line_en;
> > > +       bool rtram_3buf_en;
> > > +
> > > +       u32 frame_ctrl;
> > > +       u32 mode_ctrl;
> > > +       u32 sys_ctrl;
> > > +       u32 rtram_ctrl;
> > > +
> > > +       bool sys_ctrl_chgd;
> > > +
> > > +       u32 pitch;
> > > +
> > > +       int ch_num;
> > > +       int irq;
> > > +};
> > > +
> > > +struct dcss_dpr {
> > > +       struct device *dev;
> > > +       struct dcss_ctxld *ctxld;
> > > +       u32  ctx_id;
> > > +
> > > +       struct dcss_dpr_ch ch[3];
> > > +};
> > > +
> > > +static void dcss_dpr_write(struct dcss_dpr_ch *ch, u32 val, u32 ofs)
> > > +{
> > > +       struct dcss_dpr *dpr = ch->dpr;
> > > +
> > > +       dcss_ctxld_write(dpr->ctxld, dpr->ctx_id, val, ch->base_ofs + ofs);
> > > +}
> > > +
> > > +static int dcss_dpr_ch_init_all(struct dcss_dpr *dpr, unsigned long dpr_base)
> > > +{
> > > +       struct dcss_dpr_ch *ch;
> > > +       int i;
> > > +
> > > +       for (i = 0; i < 3; i++) {
> > > +               ch = &dpr->ch[i];
> > > +
> > > +               ch->base_ofs = dpr_base + i * 0x1000;
> >
> > Same with i.MX8QM & i.MX8QXP, every DPR instance has three channels.
> > Each channel has it's own register space.
> > For i.MX8QM & i.MX8QXP SoCs, the connection between DPR channel
> > and PRG(s) can be reflected in device tree.  So, it would be good if the
> > DPR driver wraps one single DPR channel only.
> >
> > Regards,
> > Liu Ying
> >
> > > +
> > > +               ch->base_reg = devm_ioremap(dpr->dev, ch->base_ofs, SZ_4K);
> > > +               if (!ch->base_reg) {
> > > +                       dev_err(dpr->dev, "dpr: unable to remap ch %d base\n",
> > > +                               i);
> > > +                       return -ENOMEM;
> > > +               }
> > > +
> > > +               ch->dpr = dpr;
> > > +               ch->ch_num = i;
> > > +       }
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +int dcss_dpr_init(struct dcss_dev *dcss, unsigned long dpr_base)
> > > +{
> > > +       struct dcss_dpr *dpr;
> > > +
> > > +       dpr = devm_kzalloc(dcss->dev, sizeof(struct dcss_dpr), GFP_KERNEL);
> > > +       if (!dpr)
> > > +               return -ENOMEM;
> > > +
> > > +       dcss->dpr = dpr;
> > > +       dpr->dev = dcss->dev;
> > > +       dpr->ctxld = dcss->ctxld;
> > > +       dpr->ctx_id = CTX_SB_HP;
> > > +
> > > +       if (dcss_dpr_ch_init_all(dpr, dpr_base)) {
> > > +               int i;
> > > +
> > > +               for (i = 0; i < 3; i++) {
> > > +                       if (dpr->ch[i].base_reg)
> > > +                               devm_iounmap(dpr->dev, dpr->ch[i].base_reg);
> > > +               }
> > > +
> > > +               devm_kfree(dpr->dev, dpr);
> > > +
> > > +               return -ENOMEM;
> > > +       }
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +void dcss_dpr_exit(struct dcss_dpr *dpr)
> > > +{
> > > +       int ch_no;
> > > +
> > > +       /* stop DPR on all channels */
> > > +       for (ch_no = 0; ch_no < 3; ch_no++) {
> > > +               struct dcss_dpr_ch *ch = &dpr->ch[ch_no];
> > > +
> > > +               dcss_writel(0, ch->base_reg + DCSS_DPR_SYSTEM_CTRL0);
> > > +
> > > +               if (ch->base_reg)
> > > +                       devm_iounmap(dpr->dev, ch->base_reg);
> > > +       }
> > > +
> > > +       devm_kfree(dpr->dev, dpr);
> > > +}
> > > +
> > > +static u32 dcss_dpr_x_pix_wide_adjust(struct dcss_dpr_ch *ch, u32 pix_wide,
> > > +                                     u32 pix_format)
> > > +{
> > > +       u8 pix_in_64byte_map[3][5] = {
> > > +               /* LIN, GPU_STD, GPU_SUP, VPU_YUV420, VPU_VP9 */
> > > +               {   64,       8,       8,          8,     16}, /* PIX_SIZE_8  */
> > > +               {   32,       8,       8,          8,      8}, /* PIX_SIZE_16 */
> > > +               {   16,       4,       4,          8,      8}, /* PIX_SIZE_32 */
> > > +       };
> > > +       u32 offset;
> > > +       u32 div_64byte_mod, pix_in_64byte;
> > > +
> > > +       pix_in_64byte = pix_in_64byte_map[ch->pix_size][ch->tile];
> > > +
> > > +       if (pix_format == DRM_FORMAT_P010)
> > > +               pix_wide = pix_wide * 10 / 8;
> > > +
> > > +       div_64byte_mod = pix_wide % pix_in_64byte;
> > > +       offset = (div_64byte_mod == 0) ? 0 : (pix_in_64byte - div_64byte_mod);
> > > +
> > > +       return pix_wide + offset;
> > > +}
> > > +
> > > +static u32 dcss_dpr_y_pix_high_adjust(struct dcss_dpr_ch *ch, u32 pix_high,
> > > +                                     u32 pix_format)
> > > +{
> > > +       u8 num_rows_buf = ch->rtram_4line_en ? 4 : 8;
> > > +       u32 offset, pix_y_mod;
> > > +
> > > +       pix_y_mod = pix_high % num_rows_buf;
> > > +       offset = pix_y_mod ? (num_rows_buf - pix_y_mod) : 0;
> > > +
> > > +       return pix_high + offset;
> > > +}
> > > +
> > > +void dcss_dpr_set_res(struct dcss_dpr *dpr, int ch_num, u32 xres, u32 yres)
> > > +{
> > > +       struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
> > > +       u32 pix_format = ch->format.format;
> > > +       u32 gap = DCSS_DPR_FRAME_2P_BASE_ADDR - DCSS_DPR_FRAME_1P_BASE_ADDR;
> > > +       int plane, max_planes = 1;
> > > +       u32 pix_x_wide, pix_y_high;
> > > +
> > > +       if (pix_format == DRM_FORMAT_NV12 ||
> > > +           pix_format == DRM_FORMAT_NV21)
> > > +               max_planes = 2;
> > > +
> > > +       for (plane = 0; plane < max_planes; plane++) {
> > > +               yres = plane == 1 ? yres >> 1 : yres;
> > > +
> > > +               pix_x_wide = dcss_dpr_x_pix_wide_adjust(ch, xres, pix_format);
> > > +               pix_y_high = dcss_dpr_y_pix_high_adjust(ch, yres, pix_format);
> > > +
> > > +               if (plane == 0)
> > > +                       ch->pitch = pix_x_wide;
> > > +
> > > +               dcss_dpr_write(ch, pix_x_wide,
> > > +                              DCSS_DPR_FRAME_1P_PIX_X_CTRL + plane * gap);
> > > +               dcss_dpr_write(ch, pix_y_high,
> > > +                              DCSS_DPR_FRAME_1P_PIX_Y_CTRL + plane * gap);
> > > +
> > > +               dcss_dpr_write(ch, 2, DCSS_DPR_FRAME_1P_CTRL0 + plane * gap);
> > > +       }
> > > +}
> > > +
> > > +void dcss_dpr_addr_set(struct dcss_dpr *dpr, int ch_num, u32 luma_base_addr,
> > > +                      u32 chroma_base_addr, u16 pitch)
> > > +{
> > > +       struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
> > > +
> > > +       dcss_dpr_write(ch, luma_base_addr, DCSS_DPR_FRAME_1P_BASE_ADDR);
> > > +
> > > +       dcss_dpr_write(ch, chroma_base_addr, DCSS_DPR_FRAME_2P_BASE_ADDR);
> > > +
> > > +       ch->frame_ctrl &= ~PITCH_MASK;
> > > +       ch->frame_ctrl |= (((u32)pitch << PITCH_POS) & PITCH_MASK);
> > > +}
> > > +
> > > +static void dcss_dpr_argb_comp_sel(struct dcss_dpr_ch *ch, int a_sel, int r_sel,
> > > +                                  int g_sel, int b_sel)
> > > +{
> > > +       u32 sel;
> > > +
> > > +       sel = ((a_sel << A_COMP_SEL_POS) & A_COMP_SEL_MASK) |
> > > +             ((r_sel << R_COMP_SEL_POS) & R_COMP_SEL_MASK) |
> > > +             ((g_sel << G_COMP_SEL_POS) & G_COMP_SEL_MASK) |
> > > +             ((b_sel << B_COMP_SEL_POS) & B_COMP_SEL_MASK);
> > > +
> > > +       ch->mode_ctrl &= ~(A_COMP_SEL_MASK | R_COMP_SEL_MASK |
> > > +                          G_COMP_SEL_MASK | B_COMP_SEL_MASK);
> > > +       ch->mode_ctrl |= sel;
> > > +}
> > > +
> > > +static void dcss_dpr_pix_size_set(struct dcss_dpr_ch *ch,
> > > +                                 const struct drm_format_info *format)
> > > +{
> > > +       u32 val;
> > > +
> > > +       switch (format->format) {
> > > +       case DRM_FORMAT_NV12:
> > > +       case DRM_FORMAT_NV21:
> > > +               val = 0;
> > > +               break;
> > > +
> > > +       case DRM_FORMAT_UYVY:
> > > +       case DRM_FORMAT_VYUY:
> > > +       case DRM_FORMAT_YUYV:
> > > +       case DRM_FORMAT_YVYU:
> > > +               val = 1;
> > > +               break;
> > > +
> > > +       default:
> > > +               val = 2;
> > > +               break;
> > > +       }
> > > +
> > > +       ch->pix_size = val;
> > > +
> > > +       ch->mode_ctrl &= ~PIX_SIZE_MASK;
> > > +       ch->mode_ctrl |= ((val << PIX_SIZE_POS) & PIX_SIZE_MASK);
> > > +}
> > > +
> > > +static void dcss_dpr_uv_swap(struct dcss_dpr_ch *ch, bool swap)
> > > +{
> > > +       ch->mode_ctrl &= ~PIX_UV_SWAP;
> > > +       ch->mode_ctrl |= (swap ? PIX_UV_SWAP : 0);
> > > +}
> > > +
> > > +static void dcss_dpr_y_uv_swap(struct dcss_dpr_ch *ch, bool swap)
> > > +{
> > > +       ch->mode_ctrl &= ~PIX_LUMA_UV_SWAP;
> > > +       ch->mode_ctrl |= (swap ? PIX_LUMA_UV_SWAP : 0);
> > > +}
> > > +
> > > +static void dcss_dpr_2plane_en(struct dcss_dpr_ch *ch, bool en)
> > > +{
> > > +       ch->mode_ctrl &= ~COMP_2PLANE_EN;
> > > +       ch->mode_ctrl |= (en ? COMP_2PLANE_EN : 0);
> > > +}
> > > +
> > > +static void dcss_dpr_yuv_en(struct dcss_dpr_ch *ch, bool en)
> > > +{
> > > +       ch->mode_ctrl &= ~YUV_EN;
> > > +       ch->mode_ctrl |= (en ? YUV_EN : 0);
> > > +}
> > > +
> > > +void dcss_dpr_enable(struct dcss_dpr *dpr, int ch_num, bool en)
> > > +{
> > > +       struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
> > > +       u32 sys_ctrl;
> > > +
> > > +       sys_ctrl = (en ? REPEAT_EN | RUN_EN : 0);
> > > +
> > > +       if (en) {
> > > +               dcss_dpr_write(ch, ch->mode_ctrl, DCSS_DPR_MODE_CTRL0);
> > > +               dcss_dpr_write(ch, ch->frame_ctrl, DCSS_DPR_FRAME_CTRL0);
> > > +               dcss_dpr_write(ch, ch->rtram_ctrl, DCSS_DPR_RTRAM_CTRL0);
> > > +       }
> > > +
> > > +       if (ch->sys_ctrl != sys_ctrl)
> > > +               ch->sys_ctrl_chgd = true;
> > > +
> > > +       ch->sys_ctrl = sys_ctrl;
> > > +}
> > > +
> > > +struct rgb_comp_sel {
> > > +       u32 drm_format;
> > > +       int a_sel;
> > > +       int r_sel;
> > > +       int g_sel;
> > > +       int b_sel;
> > > +};
> > > +
> > > +static struct rgb_comp_sel comp_sel_map[] = {
> > > +       {DRM_FORMAT_ARGB8888, 3, 2, 1, 0},
> > > +       {DRM_FORMAT_XRGB8888, 3, 2, 1, 0},
> > > +       {DRM_FORMAT_ABGR8888, 3, 0, 1, 2},
> > > +       {DRM_FORMAT_XBGR8888, 3, 0, 1, 2},
> > > +       {DRM_FORMAT_RGBA8888, 0, 3, 2, 1},
> > > +       {DRM_FORMAT_RGBX8888, 0, 3, 2, 1},
> > > +       {DRM_FORMAT_BGRA8888, 0, 1, 2, 3},
> > > +       {DRM_FORMAT_BGRX8888, 0, 1, 2, 3},
> > > +};
> > > +
> > > +static int to_comp_sel(u32 pix_fmt, int *a_sel, int *r_sel, int *g_sel,
> > > +                      int *b_sel)
> > > +{
> > > +       int i;
> > > +
> > > +       for (i = 0; i < ARRAY_SIZE(comp_sel_map); i++) {
> > > +               if (comp_sel_map[i].drm_format == pix_fmt) {
> > > +                       *a_sel = comp_sel_map[i].a_sel;
> > > +                       *r_sel = comp_sel_map[i].r_sel;
> > > +                       *g_sel = comp_sel_map[i].g_sel;
> > > +                       *b_sel = comp_sel_map[i].b_sel;
> > > +
> > > +                       return 0;
> > > +               }
> > > +       }
> > > +
> > > +       return -1;
> > > +}
> > > +
> > > +static void dcss_dpr_rtram_set(struct dcss_dpr_ch *ch, u32 pix_format)
> > > +{
> > > +       u32 val, mask;
> > > +
> > > +       switch (pix_format) {
> > > +       case DRM_FORMAT_NV21:
> > > +       case DRM_FORMAT_NV12:
> > > +       case DRM_FORMAT_P010:
> > > +               ch->rtram_3buf_en = true;
> > > +               ch->rtram_4line_en = false;
> > > +               break;
> > > +
> > > +       default:
> > > +               ch->rtram_3buf_en = true;
> > > +               ch->rtram_4line_en = true;
> > > +               break;
> > > +       }
> > > +
> > > +       val = (ch->rtram_4line_en ? RTR_4LINE_BUF_EN : 0);
> > > +       val |= (ch->rtram_3buf_en ? RTR_3BUF_EN : 0);
> > > +       mask = RTR_4LINE_BUF_EN | RTR_3BUF_EN;
> > > +
> > > +       ch->mode_ctrl &= ~mask;
> > > +       ch->mode_ctrl |= (val & mask);
> > > +
> > > +       val = (ch->rtram_4line_en ? 0 : NUM_ROWS_ACTIVE);
> > > +       val |= (3 << THRES_LOW_POS) & THRES_LOW_MASK;
> > > +       val |= (4 << THRES_HIGH_POS) & THRES_HIGH_MASK;
> > > +       mask = THRES_LOW_MASK | THRES_HIGH_MASK | NUM_ROWS_ACTIVE;
> > > +
> > > +       ch->rtram_ctrl &= ~mask;
> > > +       ch->rtram_ctrl |= (val & mask);
> > > +}
> > > +
> > > +static void dcss_dpr_setup_components(struct dcss_dpr_ch *ch,
> > > +                                     const struct drm_format_info *format)
> > > +{
> > > +       int a_sel, r_sel, g_sel, b_sel;
> > > +       bool uv_swap, y_uv_swap;
> > > +
> > > +       switch (format->format) {
> > > +       case DRM_FORMAT_YVYU:
> > > +               uv_swap = true;
> > > +               y_uv_swap = true;
> > > +               break;
> > > +
> > > +       case DRM_FORMAT_VYUY:
> > > +       case DRM_FORMAT_NV21:
> > > +               uv_swap = true;
> > > +               y_uv_swap = false;
> > > +               break;
> > > +
> > > +       case DRM_FORMAT_YUYV:
> > > +               uv_swap = false;
> > > +               y_uv_swap = true;
> > > +               break;
> > > +
> > > +       default:
> > > +               uv_swap = false;
> > > +               y_uv_swap = false;
> > > +               break;
> > > +       }
> > > +
> > > +       dcss_dpr_uv_swap(ch, uv_swap);
> > > +
> > > +       dcss_dpr_y_uv_swap(ch, y_uv_swap);
> > > +
> > > +       if (!format->is_yuv) {
> > > +               if (!to_comp_sel(format->format, &a_sel, &r_sel,
> > > +                                &g_sel, &b_sel)) {
> > > +                       dcss_dpr_argb_comp_sel(ch, a_sel, r_sel, g_sel, b_sel);
> > > +               } else {
> > > +                       dcss_dpr_argb_comp_sel(ch, 3, 2, 1, 0);
> > > +               }
> > > +       } else {
> > > +               dcss_dpr_argb_comp_sel(ch, 0, 0, 0, 0);
> > > +       }
> > > +}
> > > +
> > > +static void dcss_dpr_tile_set(struct dcss_dpr_ch *ch, uint64_t modifier)
> > > +{
> > > +       switch (ch->ch_num) {
> > > +       case 0:
> > > +               switch (modifier) {
> > > +               case DRM_FORMAT_MOD_LINEAR:
> > > +                       ch->tile = TILE_LINEAR;
> > > +                       break;
> > > +               case DRM_FORMAT_MOD_VIVANTE_TILED:
> > > +                       ch->tile = TILE_GPU_STANDARD;
> > > +                       break;
> > > +               case DRM_FORMAT_MOD_VIVANTE_SUPER_TILED:
> > > +                       ch->tile = TILE_GPU_SUPER;
> > > +                       break;
> > > +               default:
> > > +                       WARN_ON(1);
> > > +                       break;
> > > +               }
> > > +               break;
> > > +       case 1:
> > > +       case 2:
> > > +               ch->tile = TILE_LINEAR;
> > > +               break;
> > > +       default:
> > > +               WARN_ON(1);
> > > +               return;
> > > +       }
> > > +
> > > +       ch->mode_ctrl &= ~TILE_TYPE_MASK;
> > > +       ch->mode_ctrl |= ((ch->tile << TILE_TYPE_POS) & TILE_TYPE_MASK);
> > > +}
> > > +
> > > +void dcss_dpr_format_set(struct dcss_dpr *dpr, int ch_num,
> > > +                        const struct drm_format_info *format, u64 modifier)
> > > +{
> > > +       struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
> > > +
> > > +       ch->format = *format;
> > > +
> > > +       dcss_dpr_yuv_en(ch, format->is_yuv);
> > > +
> > > +       dcss_dpr_pix_size_set(ch, format);
> > > +
> > > +       dcss_dpr_setup_components(ch, format);
> > > +
> > > +       dcss_dpr_2plane_en(ch, format->num_planes == 2);
> > > +
> > > +       dcss_dpr_rtram_set(ch, format->format);
> > > +
> > > +       dcss_dpr_tile_set(ch, modifier);
> > > +}
> > > +
> > > +/* This function will be called from interrupt context. */
> > > +void dcss_dpr_write_sysctrl(struct dcss_dpr *dpr)
> > > +{
> > > +       int chnum;
> > > +
> > > +       for (chnum = 0; chnum < 3; chnum++) {
> > > +               struct dcss_dpr_ch *ch = &dpr->ch[chnum];
> > > +
> > > +               if (ch->sys_ctrl_chgd) {
> > > +                       dcss_ctxld_write_irqsafe(dpr->ctxld, dpr->ctx_id,
> > > +                                                ch->sys_ctrl,
> > > +                                                ch->base_ofs +
> > > +                                                DCSS_DPR_SYSTEM_CTRL0);
> > > +                       ch->sys_ctrl_chgd = false;
> > > +               }
> > > +       }
> > > +}
> > > +
> > > +void dcss_dpr_set_rotation(struct dcss_dpr *dpr, int ch_num, u32 rotation)
> > > +{
> > > +       struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
> > > +
> > > +       ch->frame_ctrl &= ~(HFLIP_EN | VFLIP_EN | ROT_ENC_MASK);
> > > +
> > > +       ch->frame_ctrl |= rotation & DRM_MODE_REFLECT_X ? HFLIP_EN : 0;
> > > +       ch->frame_ctrl |= rotation & DRM_MODE_REFLECT_Y ? VFLIP_EN : 0;
> > > +
> > > +       if (rotation & DRM_MODE_ROTATE_90)
> > > +               ch->frame_ctrl |= 1 << ROT_ENC_POS;
> > > +       else if (rotation & DRM_MODE_ROTATE_180)
> > > +               ch->frame_ctrl |= 2 << ROT_ENC_POS;
> > > +       else if (rotation & DRM_MODE_ROTATE_270)
> > > +               ch->frame_ctrl |= 3 << ROT_ENC_POS;
> > > +}
> > > diff --git a/drivers/gpu/drm/imx/dcss/dcss-drv.c b/drivers/gpu/drm/imx/dcss/dcss-drv.c
> > > new file mode 100644
> > > index 00000000..7ea131d
> > > --- /dev/null
> > > +++ b/drivers/gpu/drm/imx/dcss/dcss-drv.c
> > > @@ -0,0 +1,182 @@
> > > +// SPDX-License-Identifier: GPL-2.0
> > > +/*
> > > + * Copyright 2019 NXP.
> > > + */
> > > +
> > > +#include <linux/module.h>
> > > +#include <linux/kernel.h>
> > > +#include <linux/platform_device.h>
> > > +#include <linux/component.h>
> > > +#include <drm/drm_of.h>
> > > +#include <drm/drmP.h>
> > > +
> > > +#include "dcss-dev.h"
> > > +#include "dcss-kms.h"
> > > +
> > > +struct dcss_drv {
> > > +       struct dcss_dev *dcss;
> > > +       struct dcss_kms_dev *kms;
> > > +
> > > +       bool is_componentized;
> > > +};
> > > +
> > > +struct dcss_dev *dcss_drv_dev_to_dcss(struct device *dev)
> > > +{
> > > +       struct dcss_drv *mdrv = dev_get_drvdata(dev);
> > > +
> > > +       return mdrv ? mdrv->dcss : NULL;
> > > +}
> > > +
> > > +struct drm_device *dcss_drv_dev_to_drm(struct device *dev)
> > > +{
> > > +       struct dcss_drv *mdrv = dev_get_drvdata(dev);
> > > +
> > > +       return mdrv ? &mdrv->kms->base : NULL;
> > > +}
> > > +
> > > +static int dcss_drv_init(struct device *dev, bool componentized)
> > > +{
> > > +       struct dcss_drv *mdrv;
> > > +       int err = 0;
> > > +
> > > +       mdrv = devm_kzalloc(dev, sizeof(*mdrv), GFP_KERNEL);
> > > +       if (!mdrv)
> > > +               return -ENOMEM;
> > > +
> > > +       mdrv->is_componentized = componentized;
> > > +
> > > +       mdrv->dcss = dcss_dev_create(dev, componentized);
> > > +       if (IS_ERR(mdrv->dcss)) {
> > > +               err = PTR_ERR(mdrv->dcss);
> > > +               goto err;
> > > +       }
> > > +
> > > +       dev_set_drvdata(dev, mdrv);
> > > +
> > > +       mdrv->kms = dcss_kms_attach(mdrv->dcss, componentized);
> > > +       if (IS_ERR(mdrv->kms)) {
> > > +               err = PTR_ERR(mdrv->kms);
> > > +               goto dcss_shutoff;
> > > +       }
> > > +
> > > +       return 0;
> > > +
> > > +dcss_shutoff:
> > > +       dcss_dev_destroy(mdrv->dcss);
> > > +
> > > +       dev_set_drvdata(dev, NULL);
> > > +
> > > +err:
> > > +       devm_kfree(dev, mdrv);
> > > +       return err;
> > > +}
> > > +
> > > +static void dcss_drv_deinit(struct device *dev, bool componentized)
> > > +{
> > > +       struct dcss_drv *mdrv = dev_get_drvdata(dev);
> > > +
> > > +       if (!mdrv)
> > > +               return;
> > > +
> > > +       dcss_kms_detach(mdrv->kms, componentized);
> > > +       dcss_dev_destroy(mdrv->dcss);
> > > +
> > > +       dev_set_drvdata(dev, NULL);
> > > +}
> > > +
> > > +static int dcss_drv_bind(struct device *dev)
> > > +{
> > > +       return dcss_drv_init(dev, true);
> > > +}
> > > +
> > > +static void dcss_drv_unbind(struct device *dev)
> > > +{
> > > +       return dcss_drv_deinit(dev, true);
> > > +}
> > > +
> > > +static const struct component_master_ops dcss_master_ops = {
> > > +       .bind   = dcss_drv_bind,
> > > +       .unbind = dcss_drv_unbind,
> > > +};
> > > +
> > > +static int compare_of(struct device *dev, void *data)
> > > +{
> > > +       return dev->of_node == data;
> > > +}
> > > +
> > > +static int dcss_drv_platform_probe(struct platform_device *pdev)
> > > +{
> > > +       struct device *dev = &pdev->dev;
> > > +       struct component_match *match = NULL;
> > > +       struct device_node *remote;
> > > +
> > > +       if (!dev->of_node)
> > > +               return -ENODEV;
> > > +
> > > +       remote = of_graph_get_remote_node(dev->of_node, 0, 0);
> > > +       if (!remote)
> > > +               return -ENODEV;
> > > +
> > > +       if (of_device_is_compatible(remote, "fsl,imx8mq-nwl-dsi")) {
> > > +               of_node_put(remote);
> > > +               return dcss_drv_init(dev, false);
> > > +       }
> > > +
> > > +       drm_of_component_match_add(dev, &match, compare_of, remote);
> > > +       of_node_put(remote);
> > > +
> > > +       return component_master_add_with_match(dev, &dcss_master_ops, match);
> > > +}
> > > +
> > > +static int dcss_drv_platform_remove(struct platform_device *pdev)
> > > +{
> > > +       struct dcss_drv *mdrv = dev_get_drvdata(&pdev->dev);
> > > +
> > > +       if (mdrv->is_componentized)
> > > +               component_master_del(&pdev->dev, &dcss_master_ops);
> > > +       else
> > > +               dcss_drv_deinit(&pdev->dev, false);
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +static struct dcss_type_data dcss_types[] = {
> > > +       [DCSS_IMX8MQ] = {
> > > +               .name = "DCSS_IMX8MQ",
> > > +               .blkctl_ofs = 0x2F000,
> > > +               .ctxld_ofs = 0x23000,
> > > +               .dtg_ofs = 0x20000,
> > > +               .scaler_ofs = 0x1C000,
> > > +               .ss_ofs = 0x1B000,
> > > +               .dpr_ofs = 0x18000,
> > > +       },
> > > +};
> > > +
> > > +static const struct of_device_id dcss_of_match[] = {
> > > +       { .compatible = "nxp,imx8mq-dcss", .data = &dcss_types[DCSS_IMX8MQ], },
> > > +       {},
> > > +};
> > > +
> > > +MODULE_DEVICE_TABLE(of, dcss_of_match);
> > > +
> > > +static const struct dev_pm_ops dcss_dev_pm = {
> > > +       SET_SYSTEM_SLEEP_PM_OPS(dcss_dev_suspend, dcss_dev_resume)
> > > +       SET_RUNTIME_PM_OPS(dcss_dev_runtime_suspend,
> > > +                          dcss_dev_runtime_resume, NULL)
> > > +};
> > > +
> > > +static struct platform_driver dcss_platform_driver = {
> > > +       .probe  = dcss_drv_platform_probe,
> > > +       .remove = dcss_drv_platform_remove,
> > > +       .driver = {
> > > +               .name = "imx-dcss",
> > > +               .of_match_table = dcss_of_match,
> > > +               .pm = &dcss_dev_pm,
> > > +       },
> > > +};
> > > +
> > > +module_platform_driver(dcss_platform_driver);
> > > +
> > > +MODULE_AUTHOR("Laurentiu Palcu <laurentiu.palcu@nxp.com>");
> > > +MODULE_DESCRIPTION("DCSS driver for i.MX8MQ");
> > > +MODULE_LICENSE("GPL v2");
> > > diff --git a/drivers/gpu/drm/imx/dcss/dcss-dtg.c b/drivers/gpu/drm/imx/dcss/dcss-dtg.c
> > > new file mode 100644
> > > index 00000000..c83b3bb
> > > --- /dev/null
> > > +++ b/drivers/gpu/drm/imx/dcss/dcss-dtg.c
> > > @@ -0,0 +1,438 @@
> > > +// SPDX-License-Identifier: GPL-2.0
> > > +/*
> > > + * Copyright 2019 NXP.
> > > + */
> > > +
> > > +#include <linux/clk.h>
> > > +#include <linux/delay.h>
> > > +#include <linux/interrupt.h>
> > > +#include <linux/of.h>
> > > +#include <linux/platform_device.h>
> > > +
> > > +#include "dcss-dev.h"
> > > +
> > > +#define DCSS_DTG_TC_CONTROL_STATUS                     0x00
> > > +#define   CH3_EN                                       BIT(0)
> > > +#define   CH2_EN                                       BIT(1)
> > > +#define   CH1_EN                                       BIT(2)
> > > +#define   OVL_DATA_MODE                                        BIT(3)
> > > +#define   BLENDER_VIDEO_ALPHA_SEL                      BIT(7)
> > > +#define   DTG_START                                    BIT(8)
> > > +#define   DBY_MODE_EN                                  BIT(9)
> > > +#define   CH1_ALPHA_SEL                                        BIT(10)
> > > +#define   CSS_PIX_COMP_SWAP_POS                                12
> > > +#define   CSS_PIX_COMP_SWAP_MASK                       GENMASK(14, 12)
> > > +#define   DEFAULT_FG_ALPHA_POS                         24
> > > +#define   DEFAULT_FG_ALPHA_MASK                                GENMASK(31, 24)
> > > +#define DCSS_DTG_TC_DTG                                        0x04
> > > +#define DCSS_DTG_TC_DISP_TOP                           0x08
> > > +#define DCSS_DTG_TC_DISP_BOT                           0x0C
> > > +#define DCSS_DTG_TC_CH1_TOP                            0x10
> > > +#define DCSS_DTG_TC_CH1_BOT                            0x14
> > > +#define DCSS_DTG_TC_CH2_TOP                            0x18
> > > +#define DCSS_DTG_TC_CH2_BOT                            0x1C
> > > +#define DCSS_DTG_TC_CH3_TOP                            0x20
> > > +#define DCSS_DTG_TC_CH3_BOT                            0x24
> > > +#define   TC_X_POS                                     0
> > > +#define   TC_X_MASK                                    GENMASK(12, 0)
> > > +#define   TC_Y_POS                                     16
> > > +#define   TC_Y_MASK                                    GENMASK(28, 16)
> > > +#define DCSS_DTG_TC_CTXLD                              0x28
> > > +#define   TC_CTXLD_DB_Y_POS                            0
> > > +#define   TC_CTXLD_DB_Y_MASK                           GENMASK(12, 0)
> > > +#define   TC_CTXLD_SB_Y_POS                            16
> > > +#define   TC_CTXLD_SB_Y_MASK                           GENMASK(28, 16)
> > > +#define DCSS_DTG_TC_CH1_BKRND                          0x2C
> > > +#define DCSS_DTG_TC_CH2_BKRND                          0x30
> > > +#define   BKRND_R_Y_COMP_POS                           20
> > > +#define   BKRND_R_Y_COMP_MASK                          GENMASK(29, 20)
> > > +#define   BKRND_G_U_COMP_POS                           10
> > > +#define   BKRND_G_U_COMP_MASK                          GENMASK(19, 10)
> > > +#define   BKRND_B_V_COMP_POS                           0
> > > +#define   BKRND_B_V_COMP_MASK                          GENMASK(9, 0)
> > > +#define DCSS_DTG_BLENDER_DBY_RANGEINV                  0x38
> > > +#define DCSS_DTG_BLENDER_DBY_RANGEMIN                  0x3C
> > > +#define DCSS_DTG_BLENDER_DBY_BDP                       0x40
> > > +#define DCSS_DTG_BLENDER_BKRND_I                       0x44
> > > +#define DCSS_DTG_BLENDER_BKRND_P                       0x48
> > > +#define DCSS_DTG_BLENDER_BKRND_T                       0x4C
> > > +#define DCSS_DTG_LINE0_INT                             0x50
> > > +#define DCSS_DTG_LINE1_INT                             0x54
> > > +#define DCSS_DTG_BG_ALPHA_DEFAULT                      0x58
> > > +#define DCSS_DTG_INT_STATUS                            0x5C
> > > +#define DCSS_DTG_INT_CONTROL                           0x60
> > > +#define DCSS_DTG_TC_CH3_BKRND                          0x64
> > > +#define DCSS_DTG_INT_MASK                              0x68
> > > +#define   LINE0_IRQ                                    BIT(0)
> > > +#define   LINE1_IRQ                                    BIT(1)
> > > +#define   LINE2_IRQ                                    BIT(2)
> > > +#define   LINE3_IRQ                                    BIT(3)
> > > +#define DCSS_DTG_LINE2_INT                             0x6C
> > > +#define DCSS_DTG_LINE3_INT                             0x70
> > > +#define DCSS_DTG_DBY_OL                                        0x74
> > > +#define DCSS_DTG_DBY_BL                                        0x78
> > > +#define DCSS_DTG_DBY_EL                                        0x7C
> > > +
> > > +struct dcss_dtg {
> > > +       struct device *dev;
> > > +       struct dcss_ctxld *ctxld;
> > > +       void __iomem *base_reg;
> > > +       u32 base_ofs;
> > > +
> > > +       u32 ctx_id;
> > > +
> > > +       bool in_use;
> > > +
> > > +       u32 dis_ulc_x;
> > > +       u32 dis_ulc_y;
> > > +
> > > +       u32 control_status;
> > > +       u32 alpha;
> > > +
> > > +       int ctxld_kick_irq;
> > > +       bool ctxld_kick_irq_en;
> > > +
> > > +       struct clk *pix_clk;
> > > +       struct clk *pll_src_clk;
> > > +       struct clk *pll_phy_ref_clk;
> > > +
> > > +       /*
> > > +        * This will be passed on by DRM CRTC so that we can signal when DTG has
> > > +        * been successfully stopped. Otherwise, any modesetting while DTG is
> > > +        * still ON may result in unpredictable behavior.
> > > +        */
> > > +       struct completion *dis_completion;
> > > +};
> > > +
> > > +static void dcss_dtg_write(struct dcss_dtg *dtg, u32 val, u32 ofs)
> > > +{
> > > +       if (!dtg->in_use)
> > > +               dcss_writel(val, dtg->base_reg + ofs);
> > > +
> > > +       dcss_ctxld_write(dtg->ctxld, dtg->ctx_id, val, dtg->base_ofs + ofs);
> > > +}
> > > +
> > > +static irqreturn_t dcss_dtg_irq_handler(int irq, void *data)
> > > +{
> > > +       struct dcss_dtg *dtg = data;
> > > +       u32 status;
> > > +
> > > +       status = dcss_readl(dtg->base_reg + DCSS_DTG_INT_STATUS);
> > > +
> > > +       if (!(status & LINE0_IRQ))
> > > +               return IRQ_HANDLED;
> > > +
> > > +       dcss_ctxld_kick(dtg->ctxld);
> > > +
> > > +       dcss_writel(status & LINE0_IRQ, dtg->base_reg + DCSS_DTG_INT_CONTROL);
> > > +
> > > +       return IRQ_HANDLED;
> > > +}
> > > +
> > > +static int dcss_dtg_irq_config(struct dcss_dtg *dtg,
> > > +                              struct platform_device *pdev)
> > > +{
> > > +       int ret;
> > > +
> > > +       dtg->ctxld_kick_irq = platform_get_irq_byname(pdev, "ctxld_kick");
> > > +       if (dtg->ctxld_kick_irq < 0) {
> > > +               dev_err(dtg->dev, "dtg: can't get line2 irq number\n");
> > > +               return dtg->ctxld_kick_irq;
> > > +       }
> > > +
> > > +       ret = devm_request_irq(dtg->dev, dtg->ctxld_kick_irq,
> > > +                              dcss_dtg_irq_handler,
> > > +                              IRQF_TRIGGER_HIGH,
> > > +                              "dcss_ctxld_kick", dtg);
> > > +       if (ret) {
> > > +               dev_err(dtg->dev, "dtg: irq request failed.\n");
> > > +               return ret;
> > > +       }
> > > +
> > > +       disable_irq(dtg->ctxld_kick_irq);
> > > +
> > > +       dtg->ctxld_kick_irq_en = false;
> > > +
> > > +       dcss_update(LINE0_IRQ, LINE0_IRQ, dtg->base_reg + DCSS_DTG_INT_MASK);
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +int dcss_dtg_init(struct dcss_dev *dcss, unsigned long dtg_base)
> > > +{
> > > +       int ret = 0;
> > > +       struct dcss_dtg *dtg;
> > > +
> > > +       dtg = devm_kzalloc(dcss->dev, sizeof(*dtg), GFP_KERNEL);
> > > +       if (!dtg)
> > > +               return -ENOMEM;
> > > +
> > > +       dcss->dtg = dtg;
> > > +       dtg->dev = dcss->dev;
> > > +       dtg->ctxld = dcss->ctxld;
> > > +
> > > +       dtg->base_reg = devm_ioremap(dcss->dev, dtg_base, SZ_4K);
> > > +       if (!dtg->base_reg) {
> > > +               dev_err(dcss->dev, "dtg: unable to remap dtg base\n");
> > > +               ret = -ENOMEM;
> > > +               goto err_ioremap;
> > > +       }
> > > +
> > > +       dtg->base_ofs = dtg_base;
> > > +       dtg->ctx_id = CTX_DB;
> > > +
> > > +       dtg->pix_clk = dcss->pix_clk;
> > > +       dtg->pll_src_clk = dcss->pll_src_clk;
> > > +       dtg->pll_phy_ref_clk = dcss->pll_phy_ref_clk;
> > > +
> > > +       dtg->alpha = 255;
> > > +
> > > +       dtg->control_status |= OVL_DATA_MODE | BLENDER_VIDEO_ALPHA_SEL |
> > > +               ((dtg->alpha << DEFAULT_FG_ALPHA_POS) & DEFAULT_FG_ALPHA_MASK);
> > > +
> > > +       ret = dcss_dtg_irq_config(dtg, to_platform_device(dcss->dev));
> > > +       if (ret)
> > > +               goto err_irq;
> > > +
> > > +       return 0;
> > > +
> > > +err_irq:
> > > +       devm_iounmap(dtg->dev, dtg->base_reg);
> > > +
> > > +err_ioremap:
> > > +       devm_kfree(dtg->dev, dtg);
> > > +
> > > +       return ret;
> > > +}
> > > +
> > > +void dcss_dtg_exit(struct dcss_dtg *dtg)
> > > +{
> > > +       /* stop DTG */
> > > +       dcss_writel(DTG_START, dtg->base_reg + DCSS_DTG_TC_CONTROL_STATUS);
> > > +
> > > +       devm_free_irq(dtg->dev, dtg->ctxld_kick_irq, dtg);
> > > +
> > > +       if (dtg->base_reg)
> > > +               devm_iounmap(dtg->dev, dtg->base_reg);
> > > +
> > > +       devm_kfree(dtg->dev, dtg);
> > > +}
> > > +
> > > +void dcss_dtg_sync_set(struct dcss_dtg *dtg, struct videomode *vm)
> > > +{
> > > +       u16 dtg_lrc_x, dtg_lrc_y;
> > > +       u16 dis_ulc_x, dis_ulc_y;
> > > +       u16 dis_lrc_x, dis_lrc_y;
> > > +       u32 sb_ctxld_trig, db_ctxld_trig;
> > > +       u32 pixclock = vm->pixelclock;
> > > +       u32 actual_clk;
> > > +
> > > +       dtg_lrc_x = vm->hfront_porch + vm->hback_porch + vm->hsync_len +
> > > +                   vm->hactive - 1;
> > > +       dtg_lrc_y = vm->vfront_porch + vm->vback_porch + vm->vsync_len +
> > > +                   vm->vactive - 1;
> > > +       dis_ulc_x = vm->hsync_len + vm->hback_porch - 1;
> > > +       dis_ulc_y = vm->vsync_len + vm->vfront_porch + vm->vback_porch - 1;
> > > +       dis_lrc_x = vm->hsync_len + vm->hback_porch + vm->hactive - 1;
> > > +       dis_lrc_y = vm->vsync_len + vm->vfront_porch + vm->vback_porch +
> > > +                   vm->vactive - 1;
> > > +
> > > +       clk_disable_unprepare(dtg->pix_clk);
> > > +       clk_set_rate(dtg->pix_clk, vm->pixelclock);
> > > +       clk_prepare_enable(dtg->pix_clk);
> > > +
> > > +       actual_clk = clk_get_rate(dtg->pix_clk);
> > > +       if (pixclock != actual_clk) {
> > > +               dev_info(dtg->dev,
> > > +                        "Pixel clock set to %u kHz instead of %u kHz.\n",
> > > +                        (actual_clk / 1000), (pixclock / 1000));
> > > +       }
> > > +
> > > +       msleep(50);
> > > +
> > > +       dcss_dtg_write(dtg, ((dtg_lrc_y << TC_Y_POS) | dtg_lrc_x),
> > > +                      DCSS_DTG_TC_DTG);
> > > +       dcss_dtg_write(dtg, ((dis_ulc_y << TC_Y_POS) | dis_ulc_x),
> > > +                      DCSS_DTG_TC_DISP_TOP);
> > > +       dcss_dtg_write(dtg, ((dis_lrc_y << TC_Y_POS) | dis_lrc_x),
> > > +                      DCSS_DTG_TC_DISP_BOT);
> > > +
> > > +       dtg->dis_ulc_x = dis_ulc_x;
> > > +       dtg->dis_ulc_y = dis_ulc_y;
> > > +
> > > +       sb_ctxld_trig = ((0 * dis_lrc_y / 100) << TC_CTXLD_SB_Y_POS) &
> > > +                                                       TC_CTXLD_SB_Y_MASK;
> > > +       db_ctxld_trig = ((99 * dis_lrc_y / 100) << TC_CTXLD_DB_Y_POS) &
> > > +                                                       TC_CTXLD_DB_Y_MASK;
> > > +
> > > +       dcss_dtg_write(dtg, sb_ctxld_trig | db_ctxld_trig, DCSS_DTG_TC_CTXLD);
> > > +
> > > +       /* vblank trigger */
> > > +       dcss_dtg_write(dtg, 0, DCSS_DTG_LINE1_INT);
> > > +
> > > +       /* CTXLD trigger */
> > > +       dcss_dtg_write(dtg, ((90 * dis_lrc_y) / 100) << 16, DCSS_DTG_LINE0_INT);
> > > +}
> > > +
> > > +void dcss_dtg_plane_pos_set(struct dcss_dtg *dtg, int ch_num,
> > > +                           int px, int py, int pw, int ph)
> > > +{
> > > +       u16 p_ulc_x, p_ulc_y;
> > > +       u16 p_lrc_x, p_lrc_y;
> > > +
> > > +       p_ulc_x = dtg->dis_ulc_x + px;
> > > +       p_ulc_y = dtg->dis_ulc_y + py;
> > > +       p_lrc_x = p_ulc_x + pw;
> > > +       p_lrc_y = p_ulc_y + ph;
> > > +
> > > +       if (!px && !py && !pw && !ph) {
> > > +               dcss_dtg_write(dtg, 0, DCSS_DTG_TC_CH1_TOP + 0x8 * ch_num);
> > > +               dcss_dtg_write(dtg, 0, DCSS_DTG_TC_CH1_BOT + 0x8 * ch_num);
> > > +       } else {
> > > +               dcss_dtg_write(dtg, ((p_ulc_y << TC_Y_POS) | p_ulc_x),
> > > +                              DCSS_DTG_TC_CH1_TOP + 0x8 * ch_num);
> > > +               dcss_dtg_write(dtg, ((p_lrc_y << TC_Y_POS) | p_lrc_x),
> > > +                              DCSS_DTG_TC_CH1_BOT + 0x8 * ch_num);
> > > +       }
> > > +}
> > > +
> > > +bool dcss_dtg_global_alpha_changed(struct dcss_dtg *dtg, int ch_num, int alpha)
> > > +{
> > > +       if (ch_num)
> > > +               return false;
> > > +
> > > +       return alpha != dtg->alpha;
> > > +}
> > > +
> > > +void dcss_dtg_plane_alpha_set(struct dcss_dtg *dtg, int ch_num,
> > > +                             const struct drm_format_info *format, int alpha)
> > > +{
> > > +       u32 alpha_val;
> > > +
> > > +       /* we care about alpha only when channel 0 is concerned */
> > > +       if (ch_num)
> > > +               return;
> > > +
> > > +       alpha_val = (alpha << DEFAULT_FG_ALPHA_POS) & DEFAULT_FG_ALPHA_MASK;
> > > +
> > > +       /*
> > > +        * Use global alpha if pixel format does not have alpha channel or the
> > > +        * user explicitly chose to use global alpha (i.e. alpha is not OPAQUE).
> > > +        */
> > > +       if (!format->has_alpha || alpha != 255) {
> > > +               dtg->control_status &= ~(CH1_ALPHA_SEL | DEFAULT_FG_ALPHA_MASK);
> > > +               dtg->control_status |= alpha_val;
> > > +       } else { /* use per-pixel alpha otherwise */
> > > +               dtg->control_status |= CH1_ALPHA_SEL;
> > > +       }
> > > +
> > > +       dtg->alpha = alpha;
> > > +}
> > > +
> > > +void dcss_dtg_css_set(struct dcss_dtg *dtg)
> > > +{
> > > +       dtg->control_status |=
> > > +                       (0x5 << CSS_PIX_COMP_SWAP_POS) & CSS_PIX_COMP_SWAP_MASK;
> > > +}
> > > +
> > > +static void dcss_dtg_disable_callback(void *data)
> > > +{
> > > +       struct dcss_dtg *dtg = data;
> > > +
> > > +       dtg->control_status &= ~DTG_START;
> > > +
> > > +       dcss_writel(dtg->control_status,
> > > +                   dtg->base_reg + DCSS_DTG_TC_CONTROL_STATUS);
> > > +
> > > +       dtg->in_use = false;
> > > +
> > > +       complete(dtg->dis_completion);
> > > +}
> > > +
> > > +void dcss_dtg_enable(struct dcss_dtg *dtg, bool en,
> > > +                    struct completion *dis_completion)
> > > +{
> > > +       if (!en) {
> > > +               dtg->dis_completion = dis_completion;
> > > +               dcss_ctxld_register_dtg_disable_cb(dtg->ctxld,
> > > +                                                  dcss_dtg_disable_callback,
> > > +                                                  dtg);
> > > +               return;
> > > +       }
> > > +
> > > +       dtg->dis_completion = NULL;
> > > +
> > > +       dtg->control_status |= DTG_START;
> > > +
> > > +       dcss_dtg_write(dtg, dtg->control_status, DCSS_DTG_TC_CONTROL_STATUS);
> > > +
> > > +       dtg->in_use = true;
> > > +}
> > > +
> > > +bool dcss_dtg_is_enabled(struct dcss_dtg *dtg)
> > > +{
> > > +       return dtg->in_use;
> > > +}
> > > +
> > > +void dcss_dtg_ch_enable(struct dcss_dtg *dtg, int ch_num, bool en)
> > > +{
> > > +       u32 ch_en_map[] = {CH1_EN, CH2_EN, CH3_EN};
> > > +       u32 control_status;
> > > +
> > > +       control_status = dtg->control_status & ~ch_en_map[ch_num];
> > > +       control_status |= en ? ch_en_map[ch_num] : 0;
> > > +
> > > +       if (dtg->control_status != control_status)
> > > +               dcss_dtg_write(dtg, control_status, DCSS_DTG_TC_CONTROL_STATUS);
> > > +
> > > +       dtg->control_status = control_status;
> > > +}
> > > +
> > > +void dcss_dtg_vblank_irq_enable(struct dcss_dtg *dtg, bool en)
> > > +{
> > > +       u32 status;
> > > +
> > > +       dcss_update(LINE1_IRQ, LINE1_IRQ, dtg->base_reg + DCSS_DTG_INT_MASK);
> > > +
> > > +       if (en) {
> > > +               status = dcss_readl(dtg->base_reg + DCSS_DTG_INT_STATUS);
> > > +               dcss_writel(status & LINE1_IRQ,
> > > +                           dtg->base_reg + DCSS_DTG_INT_CONTROL);
> > > +       }
> > > +}
> > > +
> > > +void dcss_dtg_ctxld_kick_irq_enable(struct dcss_dtg *dtg, bool en)
> > > +{
> > > +       u32 status;
> > > +
> > > +       if (en) {
> > > +               status = dcss_readl(dtg->base_reg + DCSS_DTG_INT_STATUS);
> > > +
> > > +               if (!dtg->ctxld_kick_irq_en) {
> > > +                       dcss_writel(status & LINE0_IRQ,
> > > +                                   dtg->base_reg + DCSS_DTG_INT_CONTROL);
> > > +                       enable_irq(dtg->ctxld_kick_irq);
> > > +                       dtg->ctxld_kick_irq_en = true;
> > > +                       return;
> > > +               }
> > > +
> > > +               return;
> > > +       }
> > > +
> > > +       if (!dtg->ctxld_kick_irq_en)
> > > +               return;
> > > +
> > > +       disable_irq_nosync(dtg->ctxld_kick_irq);
> > > +       dtg->ctxld_kick_irq_en = false;
> > > +}
> > > +
> > > +void dcss_dtg_vblank_irq_clear(struct dcss_dtg *dtg)
> > > +{
> > > +       dcss_update(LINE1_IRQ, LINE1_IRQ, dtg->base_reg + DCSS_DTG_INT_CONTROL);
> > > +}
> > > +
> > > +bool dcss_dtg_vblank_irq_valid(struct dcss_dtg *dtg)
> > > +{
> > > +       return !!(dcss_readl(dtg->base_reg + DCSS_DTG_INT_STATUS) & LINE1_IRQ);
> > > +}
> > > +
> > > diff --git a/drivers/gpu/drm/imx/dcss/dcss-kms.c b/drivers/gpu/drm/imx/dcss/dcss-kms.c
> > > new file mode 100644
> > > index 00000000..d3bc889
> > > --- /dev/null
> > > +++ b/drivers/gpu/drm/imx/dcss/dcss-kms.c
> > > @@ -0,0 +1,321 @@
> > > +// SPDX-License-Identifier: GPL-2.0
> > > +/*
> > > + * Copyright 2019 NXP.
> > > + */
> > > +
> > > +#include <drm/drm_atomic.h>
> > > +#include <drm/drm_atomic_helper.h>
> > > +#include <drm/drm_fb_helper.h>
> > > +#include <drm/drm_gem_cma_helper.h>
> > > +#include <drm/drm_gem_framebuffer_helper.h>
> > > +#include <drm/drm_of.h>
> > > +#include <drm/drm_probe_helper.h>
> > > +#include <drm/drmP.h>
> > > +#include <linux/component.h>
> > > +
> > > +#include "dcss-dev.h"
> > > +#include "dcss-kms.h"
> > > +
> > > +DEFINE_DRM_GEM_CMA_FOPS(dcss_cma_fops);
> > > +
> > > +struct dcss_drm_commit {
> > > +       struct work_struct work;
> > > +       struct drm_device *drm;
> > > +       struct drm_atomic_state *state;
> > > +};
> > > +
> > > +static void dcss_drm_atomic_commit_tail(struct dcss_drm_commit *commit)
> > > +{
> > > +       struct drm_atomic_state *state = commit->state;
> > > +       struct drm_device *drm = commit->drm;
> > > +       struct dcss_kms_dev *kms = container_of(drm, struct dcss_kms_dev, base);
> > > +
> > > +       drm_atomic_helper_wait_for_fences(drm, state, false);
> > > +
> > > +       drm_atomic_helper_wait_for_dependencies(state);
> > > +
> > > +       drm_atomic_helper_commit_modeset_disables(drm, state);
> > > +
> > > +       drm_atomic_helper_commit_modeset_enables(drm, state);
> > > +
> > > +       drm_atomic_helper_commit_planes(drm, state,
> > > +                                       DRM_PLANE_COMMIT_ACTIVE_ONLY);
> > > +
> > > +       drm_atomic_helper_commit_hw_done(state);
> > > +
> > > +       drm_atomic_helper_wait_for_vblanks(drm, state);
> > > +
> > > +       drm_atomic_helper_cleanup_planes(drm, state);
> > > +
> > > +       drm_atomic_helper_commit_cleanup_done(state);
> > > +
> > > +       drm_atomic_state_put(state);
> > > +
> > > +       spin_lock(&kms->commit.wait.lock);
> > > +       kms->commit.pending = false;
> > > +       wake_up_all_locked(&kms->commit.wait);
> > > +       spin_unlock(&kms->commit.wait.lock);
> > > +
> > > +       kfree(commit);
> > > +}
> > > +
> > > +static void dcss_commit_work(struct work_struct *work)
> > > +{
> > > +       struct dcss_drm_commit *commit = container_of(work,
> > > +                                                     struct dcss_drm_commit,
> > > +                                                     work);
> > > +
> > > +       dcss_drm_atomic_commit_tail(commit);
> > > +}
> > > +
> > > +static int dcss_drm_atomic_commit(struct drm_device *drm,
> > > +                                 struct drm_atomic_state *state,
> > > +                                 bool nonblock)
> > > +{
> > > +       int ret;
> > > +       struct dcss_kms_dev *kms = container_of(drm, struct dcss_kms_dev, base);
> > > +       struct dcss_drm_commit *commit;
> > > +
> > > +       if (state->async_update) {
> > > +               ret = drm_atomic_helper_prepare_planes(drm, state);
> > > +               if (ret)
> > > +                       return ret;
> > > +
> > > +               drm_atomic_helper_async_commit(drm, state);
> > > +               drm_atomic_helper_cleanup_planes(drm, state);
> > > +
> > > +               return 0;
> > > +       }
> > > +
> > > +       commit = kzalloc(sizeof(*commit), GFP_KERNEL);
> > > +       if (!commit)
> > > +               return -ENOMEM;
> > > +
> > > +       commit->drm = drm;
> > > +       commit->state = state;
> > > +
> > > +       ret = drm_atomic_helper_setup_commit(state, nonblock);
> > > +       if (ret)
> > > +               goto err_free;
> > > +
> > > +       INIT_WORK(&commit->work, dcss_commit_work);
> > > +
> > > +       ret = drm_atomic_helper_prepare_planes(drm, state);
> > > +       if (ret)
> > > +               goto err_free;
> > > +
> > > +       if (!nonblock) {
> > > +               ret = drm_atomic_helper_wait_for_fences(drm, state, true);
> > > +               if (ret)
> > > +                       goto err;
> > > +       }
> > > +
> > > +       spin_lock(&kms->commit.wait.lock);
> > > +       ret = wait_event_interruptible_locked(kms->commit.wait,
> > > +                                             !kms->commit.pending);
> > > +       if (ret == 0)
> > > +               kms->commit.pending = true;
> > > +       spin_unlock(&kms->commit.wait.lock);
> > > +
> > > +       if (ret)
> > > +               goto err;
> > > +
> > > +       ret = drm_atomic_helper_swap_state(state, true);
> > > +       if (ret)
> > > +               goto err;
> > > +
> > > +       drm_atomic_state_get(state);
> > > +       if (nonblock)
> > > +               queue_work(kms->commit_wq, &commit->work);
> > > +       else
> > > +               dcss_drm_atomic_commit_tail(commit);
> > > +
> > > +       return 0;
> > > +
> > > +err:
> > > +       drm_atomic_helper_cleanup_planes(drm, state);
> > > +
> > > +err_free:
> > > +       kfree(commit);
> > > +       return ret;
> > > +}
> > > +
> > > +const struct drm_mode_config_funcs dcss_drm_mode_config_funcs = {
> > > +       .fb_create = drm_gem_fb_create,
> > > +       .output_poll_changed = drm_fb_helper_output_poll_changed,
> > > +       .atomic_check = drm_atomic_helper_check,
> > > +       .atomic_commit = dcss_drm_atomic_commit,
> > > +};
> > > +
> > > +static struct drm_driver dcss_kms_driver = {
> > > +       .driver_features        = DRIVER_MODESET | DRIVER_GEM | DRIVER_ATOMIC,
> > > +       .gem_free_object_unlocked = drm_gem_cma_free_object,
> > > +       .gem_vm_ops             = &drm_gem_cma_vm_ops,
> > > +       .dumb_create            = drm_gem_cma_dumb_create,
> > > +
> > > +       .prime_handle_to_fd     = drm_gem_prime_handle_to_fd,
> > > +       .prime_fd_to_handle     = drm_gem_prime_fd_to_handle,
> > > +       .gem_prime_import       = drm_gem_prime_import,
> > > +       .gem_prime_export       = drm_gem_prime_export,
> > > +       .gem_prime_get_sg_table = drm_gem_cma_prime_get_sg_table,
> > > +       .gem_prime_import_sg_table = drm_gem_cma_prime_import_sg_table,
> > > +       .gem_prime_vmap         = drm_gem_cma_prime_vmap,
> > > +       .gem_prime_vunmap       = drm_gem_cma_prime_vunmap,
> > > +       .gem_prime_mmap         = drm_gem_cma_prime_mmap,
> > > +       .fops                   = &dcss_cma_fops,
> > > +       .name                   = "imx-dcss",
> > > +       .desc                   = "i.MX8MQ Display Subsystem",
> > > +       .date                   = "20190917",
> > > +       .major                  = 1,
> > > +       .minor                  = 0,
> > > +       .patchlevel             = 0,
> > > +};
> > > +
> > > +static const struct drm_mode_config_helper_funcs dcss_mode_config_helpers = {
> > > +       .atomic_commit_tail = drm_atomic_helper_commit_tail_rpm,
> > > +};
> > > +
> > > +static void dcss_kms_mode_config_init(struct dcss_kms_dev *kms)
> > > +{
> > > +       struct drm_mode_config *config = &kms->base.mode_config;
> > > +
> > > +       drm_mode_config_init(&kms->base);
> > > +
> > > +       config->min_width = 1;
> > > +       config->min_height = 1;
> > > +       config->max_width = 4096;
> > > +       config->max_height = 4096;
> > > +       config->allow_fb_modifiers = true;
> > > +       config->normalize_zpos = true;
> > > +
> > > +       config->funcs = &dcss_drm_mode_config_funcs;
> > > +       config->helper_private = &dcss_mode_config_helpers;
> > > +}
> > > +
> > > +static const struct drm_encoder_funcs dcss_kms_simple_encoder_funcs = {
> > > +       .destroy = drm_encoder_cleanup,
> > > +};
> > > +
> > > +static int dcss_kms_setup_encoder(struct dcss_kms_dev *kms)
> > > +{
> > > +       struct drm_device *ddev = &kms->base;
> > > +       struct drm_encoder *encoder = &kms->encoder;
> > > +       struct drm_crtc *crtc = (struct drm_crtc *)&kms->crtc;
> > > +       struct drm_panel *panel;
> > > +       struct drm_bridge *bridge;
> > > +       int ret;
> > > +
> > > +       ret = drm_of_find_panel_or_bridge(ddev->dev->of_node, 0, 0,
> > > +                                         &panel, &bridge);
> > > +       if (ret)
> > > +               return ret;
> > > +
> > > +       if (!bridge) {
> > > +               dev_err(ddev->dev, "No bridge found %d.\n", ret);
> > > +               return -ENODEV;
> > > +       }
> > > +
> > > +       encoder->possible_crtcs = drm_crtc_mask(crtc);
> > > +
> > > +       ret = drm_encoder_init(&kms->base, encoder,
> > > +                              &dcss_kms_simple_encoder_funcs,
> > > +                              DRM_MODE_ENCODER_NONE, NULL);
> > > +       if (ret) {
> > > +               dev_err(ddev->dev, "Failed initializing encoder %d.\n", ret);
> > > +               return ret;
> > > +       }
> > > +
> > > +       return drm_bridge_attach(encoder, bridge, NULL);
> > > +}
> > > +
> > > +struct dcss_kms_dev *dcss_kms_attach(struct dcss_dev *dcss, bool componentized)
> > > +{
> > > +       struct dcss_kms_dev *kms = kzalloc(sizeof(*kms), GFP_KERNEL);
> > > +       struct drm_device *drm;
> > > +       struct dcss_crtc *crtc;
> > > +       int ret;
> > > +
> > > +       if (!kms)
> > > +               return ERR_PTR(-ENOMEM);
> > > +
> > > +       drm = &kms->base;
> > > +       crtc = &kms->crtc;
> > > +       ret = drm_dev_init(drm, &dcss_kms_driver, dcss->dev);
> > > +       if (ret)
> > > +               goto free_kms;
> > > +
> > > +       drm->dev_private = dcss;
> > > +
> > > +       dcss_kms_mode_config_init(kms);
> > > +
> > > +       ret = drm_vblank_init(drm, 1);
> > > +       if (ret)
> > > +               goto cleanup_mode_config;
> > > +
> > > +       drm->irq_enabled = true;
> > > +
> > > +       ret = dcss_crtc_init(crtc, drm);
> > > +       if (ret)
> > > +               goto cleanup_mode_config;
> > > +
> > > +       kms->commit_wq = alloc_ordered_workqueue("dcss_nonblock_commit_wq", 0);
> > > +       if (!kms->commit_wq) {
> > > +               ret = -ENOMEM;
> > > +               goto cleanup_crtc;
> > > +       }
> > > +
> > > +       init_waitqueue_head(&kms->commit.wait);
> > > +
> > > +       if (componentized)
> > > +               ret = component_bind_all(dcss->dev, kms);
> > > +       else
> > > +               ret = dcss_kms_setup_encoder(kms);
> > > +
> > > +       if (ret)
> > > +               goto cleanup_wq;
> > > +
> > > +       drm_mode_config_reset(drm);
> > > +
> > > +       drm_kms_helper_poll_init(drm);
> > > +
> > > +       ret = drm_dev_register(drm, 0);
> > > +       if (ret)
> > > +               goto cleanup_wq;
> > > +
> > > +       drm_fbdev_generic_setup(drm, 32);
> > > +
> > > +       return kms;
> > > +
> > > +cleanup_wq:
> > > +       drm_kms_helper_poll_fini(drm);
> > > +       destroy_workqueue(kms->commit_wq);
> > > +
> > > +cleanup_crtc:
> > > +       dcss_crtc_deinit(crtc, drm);
> > > +
> > > +cleanup_mode_config:
> > > +       drm_mode_config_cleanup(drm);
> > > +
> > > +free_kms:
> > > +       kfree(kms);
> > > +       return ERR_PTR(ret);
> > > +}
> > > +
> > > +void dcss_kms_detach(struct dcss_kms_dev *kms, bool componentized)
> > > +{
> > > +       struct drm_device *drm = &kms->base;
> > > +       struct dcss_dev *dcss = drm->dev_private;
> > > +
> > > +       drm_dev_unregister(drm);
> > > +       drm_kms_helper_poll_fini(drm);
> > > +       drm_atomic_helper_shutdown(drm);
> > > +       drm_crtc_vblank_off(&kms->crtc.base);
> > > +       drm->irq_enabled = false;
> > > +       drm_mode_config_cleanup(drm);
> > > +       destroy_workqueue(kms->commit_wq);
> > > +       dcss_crtc_deinit(&kms->crtc, drm);
> > > +       if (componentized)
> > > +               component_unbind_all(dcss->dev, drm);
> > > +       drm->dev_private = NULL;
> > > +       drm_dev_put(drm);
> > > +}
> > > diff --git a/drivers/gpu/drm/imx/dcss/dcss-kms.h b/drivers/gpu/drm/imx/dcss/dcss-kms.h
> > > new file mode 100644
> > > index 00000000..6297005
> > > --- /dev/null
> > > +++ b/drivers/gpu/drm/imx/dcss/dcss-kms.h
> > > @@ -0,0 +1,52 @@
> > > +/* SPDX-License-Identifier: GPL-2.0 */
> > > +/*
> > > + * Copyright 2019 NXP.
> > > + */
> > > +
> > > +#ifndef _DCSS_KMS_H_
> > > +#define _DCSS_KMS_H_
> > > +
> > > +#include <drm/drm_encoder.h>
> > > +
> > > +struct dcss_plane {
> > > +       struct drm_plane base;
> > > +
> > > +       int ch_num;
> > > +};
> > > +
> > > +struct dcss_crtc {
> > > +       struct drm_crtc         base;
> > > +       struct drm_crtc_state   *state;
> > > +
> > > +       struct dcss_plane       *plane[3];
> > > +
> > > +       int                     irq;
> > > +       bool                    irq_enabled;
> > > +
> > > +       struct completion en_completion;
> > > +       struct completion dis_completion;
> > > +};
> > > +
> > > +struct commit {
> > > +       wait_queue_head_t wait;
> > > +       bool pending;
> > > +};
> > > +
> > > +struct dcss_kms_dev {
> > > +       struct drm_device base;
> > > +       struct dcss_crtc crtc;
> > > +       struct drm_encoder encoder;
> > > +       struct workqueue_struct *commit_wq;
> > > +       struct commit commit;
> > > +};
> > > +
> > > +struct dcss_kms_dev *dcss_kms_attach(struct dcss_dev *dcss, bool componentized);
> > > +void dcss_kms_detach(struct dcss_kms_dev *kms, bool componentized);
> > > +int dcss_crtc_init(struct dcss_crtc *crtc, struct drm_device *drm);
> > > +void dcss_crtc_deinit(struct dcss_crtc *crtc, struct drm_device *drm);
> > > +struct dcss_plane *dcss_plane_init(struct drm_device *drm,
> > > +                                  unsigned int possible_crtcs,
> > > +                                  enum drm_plane_type type,
> > > +                                  unsigned int zpos);
> > > +
> > > +#endif
> > > diff --git a/drivers/gpu/drm/imx/dcss/dcss-plane.c b/drivers/gpu/drm/imx/dcss/dcss-plane.c
> > > new file mode 100644
> > > index 00000000..cb18c3e
> > > --- /dev/null
> > > +++ b/drivers/gpu/drm/imx/dcss/dcss-plane.c
> > > @@ -0,0 +1,418 @@
> > > +// SPDX-License-Identifier: GPL-2.0
> > > +/*
> > > + * Copyright 2019 NXP.
> > > + */
> > > +
> > > +#include <drm/drm_atomic.h>
> > > +#include <drm/drm_atomic_helper.h>
> > > +#include <drm/drm_fb_cma_helper.h>
> > > +#include <drm/drm_gem_framebuffer_helper.h>
> > > +#include <drm/drm_gem_cma_helper.h>
> > > +
> > > +#include "dcss-dev.h"
> > > +#include "dcss-kms.h"
> > > +
> > > +static const u32 dcss_common_formats[] = {
> > > +       /* RGB */
> > > +       DRM_FORMAT_ARGB8888,
> > > +       DRM_FORMAT_XRGB8888,
> > > +       DRM_FORMAT_ABGR8888,
> > > +       DRM_FORMAT_XBGR8888,
> > > +       DRM_FORMAT_RGBA8888,
> > > +       DRM_FORMAT_RGBX8888,
> > > +       DRM_FORMAT_BGRA8888,
> > > +       DRM_FORMAT_BGRX8888,
> > > +       DRM_FORMAT_XRGB2101010,
> > > +       DRM_FORMAT_XBGR2101010,
> > > +       DRM_FORMAT_RGBX1010102,
> > > +       DRM_FORMAT_BGRX1010102,
> > > +       DRM_FORMAT_ARGB2101010,
> > > +       DRM_FORMAT_ABGR2101010,
> > > +       DRM_FORMAT_RGBA1010102,
> > > +       DRM_FORMAT_BGRA1010102,
> > > +
> > > +       /* YUV444 */
> > > +       DRM_FORMAT_AYUV,
> > > +
> > > +       /* YUV422 */
> > > +       DRM_FORMAT_UYVY,
> > > +       DRM_FORMAT_VYUY,
> > > +       DRM_FORMAT_YUYV,
> > > +       DRM_FORMAT_YVYU,
> > > +
> > > +       /* YUV420 */
> > > +       DRM_FORMAT_NV12,
> > > +       DRM_FORMAT_NV21,
> > > +};
> > > +
> > > +static const u64 dcss_video_format_modifiers[] = {
> > > +       DRM_FORMAT_MOD_LINEAR,
> > > +       DRM_FORMAT_MOD_INVALID,
> > > +};
> > > +
> > > +static const u64 dcss_graphics_format_modifiers[] = {
> > > +       DRM_FORMAT_MOD_VIVANTE_TILED,
> > > +       DRM_FORMAT_MOD_VIVANTE_SUPER_TILED,
> > > +       DRM_FORMAT_MOD_LINEAR,
> > > +       DRM_FORMAT_MOD_INVALID,
> > > +};
> > > +
> > > +static inline struct dcss_plane *to_dcss_plane(struct drm_plane *p)
> > > +{
> > > +       return container_of(p, struct dcss_plane, base);
> > > +}
> > > +
> > > +static inline bool dcss_plane_fb_is_linear(const struct drm_framebuffer *fb)
> > > +{
> > > +       return ((fb->flags & DRM_MODE_FB_MODIFIERS) == 0) ||
> > > +              ((fb->flags & DRM_MODE_FB_MODIFIERS) != 0 &&
> > > +               fb->modifier == DRM_FORMAT_MOD_LINEAR);
> > > +}
> > > +
> > > +static void dcss_plane_destroy(struct drm_plane *plane)
> > > +{
> > > +       struct dcss_plane *dcss_plane = container_of(plane, struct dcss_plane,
> > > +                                                    base);
> > > +
> > > +       drm_plane_cleanup(plane);
> > > +       kfree(dcss_plane);
> > > +}
> > > +
> > > +static bool dcss_plane_format_mod_supported(struct drm_plane *plane,
> > > +                                           u32 format,
> > > +                                           u64 modifier)
> > > +{
> > > +       switch (plane->type) {
> > > +       case DRM_PLANE_TYPE_PRIMARY:
> > > +               switch (format) {
> > > +               case DRM_FORMAT_ARGB8888:
> > > +               case DRM_FORMAT_XRGB8888:
> > > +               case DRM_FORMAT_ARGB2101010:
> > > +                       return modifier == DRM_FORMAT_MOD_LINEAR ||
> > > +                              modifier == DRM_FORMAT_MOD_VIVANTE_TILED ||
> > > +                              modifier == DRM_FORMAT_MOD_VIVANTE_SUPER_TILED;
> > > +               default:
> > > +                       return modifier == DRM_FORMAT_MOD_LINEAR;
> > > +               }
> > > +               break;
> > > +       case DRM_PLANE_TYPE_OVERLAY:
> > > +               return modifier == DRM_FORMAT_MOD_LINEAR;
> > > +       default:
> > > +               return false;
> > > +       }
> > > +}
> > > +
> > > +static const struct drm_plane_funcs dcss_plane_funcs = {
> > > +       .update_plane           = drm_atomic_helper_update_plane,
> > > +       .disable_plane          = drm_atomic_helper_disable_plane,
> > > +       .destroy                = dcss_plane_destroy,
> > > +       .reset                  = drm_atomic_helper_plane_reset,
> > > +       .atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state,
> > > +       .atomic_destroy_state   = drm_atomic_helper_plane_destroy_state,
> > > +       .format_mod_supported   = dcss_plane_format_mod_supported,
> > > +};
> > > +
> > > +static bool dcss_plane_can_rotate(const struct drm_format_info *format,
> > > +                                 bool mod_present, u64 modifier,
> > > +                                 unsigned int rotation)
> > > +{
> > > +       bool linear_format = !mod_present ||
> > > +                            (mod_present && modifier == DRM_FORMAT_MOD_LINEAR);
> > > +       u32 supported_rotation = DRM_MODE_ROTATE_0;
> > > +
> > > +       if (!format->is_yuv && linear_format)
> > > +               supported_rotation = DRM_MODE_ROTATE_0 | DRM_MODE_ROTATE_180 |
> > > +                                    DRM_MODE_REFLECT_MASK;
> > > +       else if (!format->is_yuv &&
> > > +                modifier == DRM_FORMAT_MOD_VIVANTE_TILED)
> > > +               supported_rotation = DRM_MODE_ROTATE_MASK |
> > > +                                    DRM_MODE_REFLECT_MASK;
> > > +       else if (format->is_yuv && linear_format &&
> > > +                (format->format == DRM_FORMAT_NV12 ||
> > > +                 format->format == DRM_FORMAT_NV21))
> > > +               supported_rotation = DRM_MODE_ROTATE_0 | DRM_MODE_ROTATE_180 |
> > > +                                    DRM_MODE_REFLECT_MASK;
> > > +
> > > +       return !!(rotation & supported_rotation);
> > > +}
> > > +
> > > +static bool dcss_plane_is_source_size_allowed(u16 src_w, u16 src_h, u32 pix_fmt)
> > > +{
> > > +       if (src_w < 64 &&
> > > +           (pix_fmt == DRM_FORMAT_NV12 || pix_fmt == DRM_FORMAT_NV21))
> > > +               return false;
> > > +       else if (src_w < 32 &&
> > > +                (pix_fmt == DRM_FORMAT_UYVY || pix_fmt == DRM_FORMAT_VYUY ||
> > > +                 pix_fmt == DRM_FORMAT_YUYV || pix_fmt == DRM_FORMAT_YVYU))
> > > +               return false;
> > > +
> > > +       return src_w >= 16 && src_h >= 8;
> > > +}
> > > +
> > > +static int dcss_plane_atomic_check(struct drm_plane *plane,
> > > +                                  struct drm_plane_state *state)
> > > +{
> > > +       struct dcss_plane *dcss_plane = to_dcss_plane(plane);
> > > +       struct dcss_dev *dcss = plane->dev->dev_private;
> > > +       struct drm_framebuffer *fb = state->fb;
> > > +       bool is_primary_plane = plane->type == DRM_PLANE_TYPE_PRIMARY;
> > > +       struct drm_gem_cma_object *cma_obj;
> > > +       struct drm_crtc_state *crtc_state;
> > > +       int hdisplay, vdisplay;
> > > +       int min, max;
> > > +       int ret;
> > > +
> > > +       if (!fb || !state->crtc)
> > > +               return 0;
> > > +
> > > +       cma_obj = drm_fb_cma_get_gem_obj(fb, 0);
> > > +       WARN_ON(!cma_obj);
> > > +
> > > +       crtc_state = drm_atomic_get_existing_crtc_state(state->state,
> > > +                                                       state->crtc);
> > > +
> > > +       hdisplay = crtc_state->adjusted_mode.hdisplay;
> > > +       vdisplay = crtc_state->adjusted_mode.vdisplay;
> > > +
> > > +       if (!dcss_plane_is_source_size_allowed(state->src_w >> 16,
> > > +                                              state->src_h >> 16,
> > > +                                              fb->format->format)) {
> > > +               DRM_DEBUG_KMS("Source plane size is not allowed!\n");
> > > +               return -EINVAL;
> > > +       }
> > > +
> > > +       dcss_scaler_get_min_max_ratios(dcss->scaler, dcss_plane->ch_num,
> > > +                                      &min, &max);
> > > +
> > > +       ret = drm_atomic_helper_check_plane_state(state, crtc_state,
> > > +                                                 min, max, !is_primary_plane,
> > > +                                                 false);
> > > +       if (ret)
> > > +               return ret;
> > > +
> > > +       if (!state->visible)
> > > +               return 0;
> > > +
> > > +       if (!dcss_plane_can_rotate(fb->format,
> > > +                                  !!(fb->flags & DRM_MODE_FB_MODIFIERS),
> > > +                                  fb->modifier,
> > > +                                  state->rotation)) {
> > > +               DRM_DEBUG_KMS("requested rotation is not allowed!\n");
> > > +               return -EINVAL;
> > > +       }
> > > +
> > > +       if ((state->crtc_x < 0 || state->crtc_y < 0 ||
> > > +            state->crtc_x + state->crtc_w > hdisplay ||
> > > +            state->crtc_y + state->crtc_h > vdisplay) &&
> > > +           !dcss_plane_fb_is_linear(fb)) {
> > > +               DRM_DEBUG_KMS("requested cropping operation is not allowed!\n");
> > > +               return -EINVAL;
> > > +       }
> > > +
> > > +       if ((fb->flags & DRM_MODE_FB_MODIFIERS) &&
> > > +           !plane->funcs->format_mod_supported(plane,
> > > +                               fb->format->format,
> > > +                               fb->modifier)) {
> > > +               DRM_DEBUG_KMS("Invalid modifier: %llx", fb->modifier);
> > > +               return -EINVAL;
> > > +       }
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +static void dcss_plane_atomic_set_base(struct dcss_plane *dcss_plane)
> > > +{
> > > +       struct drm_plane *plane = &dcss_plane->base;
> > > +       struct drm_plane_state *state = plane->state;
> > > +       struct dcss_dev *dcss = plane->dev->dev_private;
> > > +       struct drm_framebuffer *fb = state->fb;
> > > +       const struct drm_format_info *format = fb->format;
> > > +       struct drm_gem_cma_object *cma_obj = drm_fb_cma_get_gem_obj(fb, 0);
> > > +       unsigned long p1_ba = 0, p2_ba = 0;
> > > +
> > > +       if (!format->is_yuv ||
> > > +           format->format == DRM_FORMAT_NV12 ||
> > > +           format->format == DRM_FORMAT_NV21)
> > > +               p1_ba = cma_obj->paddr + fb->offsets[0] +
> > > +                       fb->pitches[0] * (state->src.y1 >> 16) +
> > > +                       format->char_per_block[0] * (state->src.x1 >> 16);
> > > +       else if (format->format == DRM_FORMAT_UYVY ||
> > > +                format->format == DRM_FORMAT_VYUY ||
> > > +                format->format == DRM_FORMAT_YUYV ||
> > > +                format->format == DRM_FORMAT_YVYU)
> > > +               p1_ba = cma_obj->paddr + fb->offsets[0] +
> > > +                       fb->pitches[0] * (state->src.y1 >> 16) +
> > > +                       2 * format->char_per_block[0] * (state->src.x1 >> 17);
> > > +
> > > +       if (format->format == DRM_FORMAT_NV12 ||
> > > +           format->format == DRM_FORMAT_NV21)
> > > +               p2_ba = cma_obj->paddr + fb->offsets[1] +
> > > +                       (((fb->pitches[1] >> 1) * (state->src.y1 >> 17) +
> > > +                       (state->src.x1 >> 17)) << 1);
> > > +
> > > +       dcss_dpr_addr_set(dcss->dpr, dcss_plane->ch_num, p1_ba, p2_ba,
> > > +                         fb->pitches[0]);
> > > +}
> > > +
> > > +static bool dcss_plane_needs_setup(struct drm_plane_state *state,
> > > +                                  struct drm_plane_state *old_state)
> > > +{
> > > +       struct drm_framebuffer *fb = state->fb;
> > > +       struct drm_framebuffer *old_fb = old_state->fb;
> > > +
> > > +       return state->crtc_x != old_state->crtc_x ||
> > > +              state->crtc_y != old_state->crtc_y ||
> > > +              state->crtc_w != old_state->crtc_w ||
> > > +              state->crtc_h != old_state->crtc_h ||
> > > +              state->src_x  != old_state->src_x  ||
> > > +              state->src_y  != old_state->src_y  ||
> > > +              state->src_w  != old_state->src_w  ||
> > > +              state->src_h  != old_state->src_h  ||
> > > +              fb->format->format != old_fb->format->format ||
> > > +              fb->modifier  != old_fb->modifier ||
> > > +              state->rotation != old_state->rotation;
> > > +}
> > > +
> > > +static void dcss_plane_atomic_update(struct drm_plane *plane,
> > > +                                    struct drm_plane_state *old_state)
> > > +{
> > > +       struct drm_plane_state *state = plane->state;
> > > +       struct dcss_plane *dcss_plane = to_dcss_plane(plane);
> > > +       struct dcss_dev *dcss = plane->dev->dev_private;
> > > +       struct drm_framebuffer *fb = state->fb;
> > > +       u32 pixel_format;
> > > +       struct drm_crtc_state *crtc_state;
> > > +       bool modifiers_present;
> > > +       u32 src_w, src_h, dst_w, dst_h;
> > > +       struct drm_rect src, dst;
> > > +       bool enable = true;
> > > +
> > > +       if (!fb || !state->crtc || !state->visible)
> > > +               return;
> > > +
> > > +       pixel_format = state->fb->format->format;
> > > +       crtc_state = state->crtc->state;
> > > +       modifiers_present = !!(fb->flags & DRM_MODE_FB_MODIFIERS);
> > > +
> > > +       if (old_state->fb && !drm_atomic_crtc_needs_modeset(crtc_state) &&
> > > +           !dcss_plane_needs_setup(state, old_state)) {
> > > +               dcss_plane_atomic_set_base(dcss_plane);
> > > +               return;
> > > +       }
> > > +
> > > +       src = plane->state->src;
> > > +       dst = plane->state->dst;
> > > +
> > > +       /*
> > > +        * The width and height after clipping.
> > > +        */
> > > +       src_w = drm_rect_width(&src) >> 16;
> > > +       src_h = drm_rect_height(&src) >> 16;
> > > +       dst_w = drm_rect_width(&dst);
> > > +       dst_h = drm_rect_height(&dst);
> > > +
> > > +       if (plane->type == DRM_PLANE_TYPE_OVERLAY &&
> > > +           modifiers_present && fb->modifier == DRM_FORMAT_MOD_LINEAR)
> > > +               modifiers_present = false;
> > > +
> > > +       dcss_dpr_format_set(dcss->dpr, dcss_plane->ch_num, state->fb->format,
> > > +                           modifiers_present ? fb->modifier :
> > > +                                               DRM_FORMAT_MOD_LINEAR);
> > > +       dcss_dpr_set_res(dcss->dpr, dcss_plane->ch_num, src_w, src_h);
> > > +       dcss_dpr_set_rotation(dcss->dpr, dcss_plane->ch_num,
> > > +                             state->rotation);
> > > +
> > > +       dcss_plane_atomic_set_base(dcss_plane);
> > > +
> > > +       dcss_scaler_setup(dcss->scaler, dcss_plane->ch_num,
> > > +                         state->fb->format, src_w, src_h,
> > > +                         dst_w, dst_h,
> > > +                         drm_mode_vrefresh(&crtc_state->mode));
> > > +
> > > +       dcss_dtg_plane_pos_set(dcss->dtg, dcss_plane->ch_num,
> > > +                              dst.x1, dst.y1, dst_w, dst_h);
> > > +       dcss_dtg_plane_alpha_set(dcss->dtg, dcss_plane->ch_num,
> > > +                                fb->format, state->alpha >> 8);
> > > +
> > > +       if (!dcss_plane->ch_num && (state->alpha >> 8) == 0)
> > > +               enable = false;
> > > +
> > > +       dcss_dpr_enable(dcss->dpr, dcss_plane->ch_num, enable);
> > > +       dcss_scaler_ch_enable(dcss->scaler, dcss_plane->ch_num, enable);
> > > +
> > > +       if (!enable)
> > > +               dcss_dtg_plane_pos_set(dcss->dtg, dcss_plane->ch_num,
> > > +                                      0, 0, 0, 0);
> > > +
> > > +       dcss_dtg_ch_enable(dcss->dtg, dcss_plane->ch_num, enable);
> > > +}
> > > +
> > > +static void dcss_plane_atomic_disable(struct drm_plane *plane,
> > > +                                     struct drm_plane_state *old_state)
> > > +{
> > > +       struct dcss_plane *dcss_plane = to_dcss_plane(plane);
> > > +       struct dcss_dev *dcss = plane->dev->dev_private;
> > > +
> > > +       dcss_dpr_enable(dcss->dpr, dcss_plane->ch_num, false);
> > > +       dcss_scaler_ch_enable(dcss->scaler, dcss_plane->ch_num, false);
> > > +       dcss_dtg_plane_pos_set(dcss->dtg, dcss_plane->ch_num, 0, 0, 0, 0);
> > > +       dcss_dtg_ch_enable(dcss->dtg, dcss_plane->ch_num, false);
> > > +}
> > > +
> > > +static const struct drm_plane_helper_funcs dcss_plane_helper_funcs = {
> > > +       .prepare_fb = drm_gem_fb_prepare_fb,
> > > +       .atomic_check = dcss_plane_atomic_check,
> > > +       .atomic_update = dcss_plane_atomic_update,
> > > +       .atomic_disable = dcss_plane_atomic_disable,
> > > +};
> > > +
> > > +struct dcss_plane *dcss_plane_init(struct drm_device *drm,
> > > +                                  unsigned int possible_crtcs,
> > > +                                  enum drm_plane_type type,
> > > +                                  unsigned int zpos)
> > > +{
> > > +       struct dcss_plane *dcss_plane;
> > > +       const u64 *format_modifiers = dcss_video_format_modifiers;
> > > +       int ret;
> > > +
> > > +       if (zpos > 2)
> > > +               return ERR_PTR(-EINVAL);
> > > +
> > > +       dcss_plane = kzalloc(sizeof(*dcss_plane), GFP_KERNEL);
> > > +       if (!dcss_plane) {
> > > +               DRM_ERROR("failed to allocate plane\n");
> > > +               return ERR_PTR(-ENOMEM);
> > > +       }
> > > +
> > > +       if (type == DRM_PLANE_TYPE_PRIMARY)
> > > +               format_modifiers = dcss_graphics_format_modifiers;
> > > +
> > > +       ret = drm_universal_plane_init(drm, &dcss_plane->base, possible_crtcs,
> > > +                                      &dcss_plane_funcs, dcss_common_formats,
> > > +                                      ARRAY_SIZE(dcss_common_formats),
> > > +                                      format_modifiers, type, NULL);
> > > +       if (ret) {
> > > +               DRM_ERROR("failed to initialize plane\n");
> > > +               kfree(dcss_plane);
> > > +               return ERR_PTR(ret);
> > > +       }
> > > +
> > > +       drm_plane_helper_add(&dcss_plane->base, &dcss_plane_helper_funcs);
> > > +
> > > +       ret = drm_plane_create_zpos_immutable_property(&dcss_plane->base, zpos);
> > > +       if (ret)
> > > +               return ERR_PTR(ret);
> > > +
> > > +       drm_plane_create_rotation_property(&dcss_plane->base,
> > > +                                          DRM_MODE_ROTATE_0,
> > > +                                          DRM_MODE_ROTATE_0   |
> > > +                                          DRM_MODE_ROTATE_90  |
> > > +                                          DRM_MODE_ROTATE_180 |
> > > +                                          DRM_MODE_ROTATE_270 |
> > > +                                          DRM_MODE_REFLECT_X  |
> > > +                                          DRM_MODE_REFLECT_Y);
> > > +
> > > +       dcss_plane->ch_num = zpos;
> > > +
> > > +       return dcss_plane;
> > > +}
> > > diff --git a/drivers/gpu/drm/imx/dcss/dcss-scaler.c b/drivers/gpu/drm/imx/dcss/dcss-scaler.c
> > > new file mode 100644
> > > index 00000000..3e317f4
> > > --- /dev/null
> > > +++ b/drivers/gpu/drm/imx/dcss/dcss-scaler.c
> > > @@ -0,0 +1,830 @@
> > > +// SPDX-License-Identifier: GPL-2.0
> > > +/*
> > > + * Copyright 2019 NXP.
> > > + *
> > > + * Scaling algorithms were contributed by Dzung Hoang <dzung.hoang@nxp.com>
> > > + */
> > > +
> > > +#include <linux/device.h>
> > > +
> > > +#include "dcss-dev.h"
> > > +
> > > +#define DCSS_SCALER_CTRL                       0x00
> > > +#define   SCALER_EN                            BIT(0)
> > > +#define   REPEAT_EN                            BIT(4)
> > > +#define   SCALE2MEM_EN                         BIT(8)
> > > +#define   MEM2OFIFO_EN                         BIT(12)
> > > +#define DCSS_SCALER_OFIFO_CTRL                 0x04
> > > +#define   OFIFO_LOW_THRES_POS                  0
> > > +#define   OFIFO_LOW_THRES_MASK                 GENMASK(9, 0)
> > > +#define   OFIFO_HIGH_THRES_POS                 16
> > > +#define   OFIFO_HIGH_THRES_MASK                        GENMASK(25, 16)
> > > +#define   UNDERRUN_DETECT_CLR                  BIT(26)
> > > +#define   LOW_THRES_DETECT_CLR                 BIT(27)
> > > +#define   HIGH_THRES_DETECT_CLR                        BIT(28)
> > > +#define   UNDERRUN_DETECT_EN                   BIT(29)
> > > +#define   LOW_THRES_DETECT_EN                  BIT(30)
> > > +#define   HIGH_THRES_DETECT_EN                 BIT(31)
> > > +#define DCSS_SCALER_SDATA_CTRL                 0x08
> > > +#define   YUV_EN                               BIT(0)
> > > +#define   RTRAM_8LINES                         BIT(1)
> > > +#define   Y_UV_BYTE_SWAP                       BIT(4)
> > > +#define   A2R10G10B10_FORMAT_POS               8
> > > +#define   A2R10G10B10_FORMAT_MASK              GENMASK(11, 8)
> > > +#define DCSS_SCALER_BIT_DEPTH                  0x0C
> > > +#define   LUM_BIT_DEPTH_POS                    0
> > > +#define   LUM_BIT_DEPTH_MASK                   GENMASK(1, 0)
> > > +#define   CHR_BIT_DEPTH_POS                    4
> > > +#define   CHR_BIT_DEPTH_MASK                   GENMASK(5, 4)
> > > +#define DCSS_SCALER_SRC_FORMAT                 0x10
> > > +#define DCSS_SCALER_DST_FORMAT                 0x14
> > > +#define   FORMAT_MASK                          GENMASK(1, 0)
> > > +#define DCSS_SCALER_SRC_LUM_RES                        0x18
> > > +#define DCSS_SCALER_SRC_CHR_RES                        0x1C
> > > +#define DCSS_SCALER_DST_LUM_RES                        0x20
> > > +#define DCSS_SCALER_DST_CHR_RES                        0x24
> > > +#define   WIDTH_POS                            0
> > > +#define   WIDTH_MASK                           GENMASK(11, 0)
> > > +#define   HEIGHT_POS                           16
> > > +#define   HEIGHT_MASK                          GENMASK(27, 16)
> > > +#define DCSS_SCALER_V_LUM_START                        0x48
> > > +#define   V_START_MASK                         GENMASK(15, 0)
> > > +#define DCSS_SCALER_V_LUM_INC                  0x4C
> > > +#define   V_INC_MASK                           GENMASK(15, 0)
> > > +#define DCSS_SCALER_H_LUM_START                        0x50
> > > +#define   H_START_MASK                         GENMASK(18, 0)
> > > +#define DCSS_SCALER_H_LUM_INC                  0x54
> > > +#define   H_INC_MASK                           GENMASK(15, 0)
> > > +#define DCSS_SCALER_V_CHR_START                        0x58
> > > +#define DCSS_SCALER_V_CHR_INC                  0x5C
> > > +#define DCSS_SCALER_H_CHR_START                        0x60
> > > +#define DCSS_SCALER_H_CHR_INC                  0x64
> > > +#define DCSS_SCALER_COEF_VLUM                  0x80
> > > +#define DCSS_SCALER_COEF_HLUM                  0x140
> > > +#define DCSS_SCALER_COEF_VCHR                  0x200
> > > +#define DCSS_SCALER_COEF_HCHR                  0x300
> > > +
> > > +struct dcss_scaler_ch {
> > > +       void __iomem *base_reg;
> > > +       u32 base_ofs;
> > > +       struct dcss_scaler *scl;
> > > +
> > > +       u32 sdata_ctrl;
> > > +       u32 scaler_ctrl;
> > > +
> > > +       bool scaler_ctrl_chgd;
> > > +
> > > +       u32 c_vstart;
> > > +       u32 c_hstart;
> > > +};
> > > +
> > > +struct dcss_scaler {
> > > +       struct device *dev;
> > > +
> > > +       struct dcss_ctxld *ctxld;
> > > +       u32 ctx_id;
> > > +
> > > +       struct dcss_scaler_ch ch[3];
> > > +};
> > > +
> > > +/* scaler coefficients generator */
> > > +#define PSC_FRAC_BITS 30
> > > +#define PSC_FRAC_SCALE BIT(PSC_FRAC_BITS)
> > > +#define PSC_BITS_FOR_PHASE 4
> > > +#define PSC_NUM_PHASES 16
> > > +#define PSC_STORED_PHASES (PSC_NUM_PHASES / 2 + 1)
> > > +#define PSC_NUM_TAPS 7
> > > +#define PSC_NUM_TAPS_RGBA 5
> > > +#define PSC_COEFF_PRECISION 10
> > > +#define PSC_PHASE_FRACTION_BITS 13
> > > +#define PSC_PHASE_MASK (PSC_NUM_PHASES - 1)
> > > +#define PSC_Q_FRACTION 19
> > > +#define PSC_Q_ROUND_OFFSET (1 << (PSC_Q_FRACTION - 1))
> > > +
> > > +/**
> > > + * mult_q() - Performs fixed-point multiplication.
> > > + * @A: multiplier
> > > + * @B: multiplicand
> > > + */
> > > +static int mult_q(int A, int B)
> > > +{
> > > +       int result;
> > > +       s64 temp;
> > > +
> > > +       temp = (int64_t)A * (int64_t)B;
> > > +       temp += PSC_Q_ROUND_OFFSET;
> > > +       result = (int)(temp >> PSC_Q_FRACTION);
> > > +       return result;
> > > +}
> > > +
> > > +/**
> > > + * div_q() - Performs fixed-point division.
> > > + * @A: dividend
> > > + * @B: divisor
> > > + */
> > > +static int div_q(int A, int B)
> > > +{
> > > +       int result;
> > > +       s64 temp;
> > > +
> > > +       temp = (int64_t)A << PSC_Q_FRACTION;
> > > +       if ((temp >= 0 && B >= 0) || (temp < 0 && B < 0))
> > > +               temp += B / 2;
> > > +       else
> > > +               temp -= B / 2;
> > > +
> > > +       result = (int)(temp / B);
> > > +       return result;
> > > +}
> > > +
> > > +/**
> > > + * exp_approx_q() - Compute approximation to exp(x) function using Taylor
> > > + *                 series.
> > > + * @x: fixed-point argument of exp function
> > > + */
> > > +static int exp_approx_q(int x)
> > > +{
> > > +       int sum = 1 << PSC_Q_FRACTION;
> > > +       int term = 1 << PSC_Q_FRACTION;
> > > +
> > > +       term = mult_q(term, div_q(x, 1 << PSC_Q_FRACTION));
> > > +       sum += term;
> > > +       term = mult_q(term, div_q(x, 2 << PSC_Q_FRACTION));
> > > +       sum += term;
> > > +       term = mult_q(term, div_q(x, 3 << PSC_Q_FRACTION));
> > > +       sum += term;
> > > +       term = mult_q(term, div_q(x, 4 << PSC_Q_FRACTION));
> > > +       sum += term;
> > > +
> > > +       return sum;
> > > +}
> > > +
> > > +/**
> > > + * dcss_scaler_gaussian_filter() - Generate gaussian prototype filter.
> > > + * @fc_q: fixed-point cutoff frequency normalized to range [0, 1]
> > > + * @use_5_taps: indicates whether to use 5 taps or 7 taps
> > > + * @coef: output filter coefficients
> > > + */
> > > +static void dcss_scaler_gaussian_filter(int fc_q, bool use_5_taps,
> > > +                                       bool phase0_identity,
> > > +                                       int coef[][PSC_NUM_TAPS])
> > > +{
> > > +       int sigma_q, g0_q, g1_q, g2_q;
> > > +       int tap_cnt1, tap_cnt2, tap_idx, phase_cnt;
> > > +       int mid;
> > > +       int phase;
> > > +       int i;
> > > +       int taps;
> > > +
> > > +       if (use_5_taps)
> > > +               for (phase = 0; phase < PSC_STORED_PHASES; phase++) {
> > > +                       coef[phase][0] = 0;
> > > +                       coef[phase][PSC_NUM_TAPS - 1] = 0;
> > > +               }
> > > +
> > > +       /* seed coefficient scanner */
> > > +       taps = use_5_taps ? PSC_NUM_TAPS_RGBA : PSC_NUM_TAPS;
> > > +       mid = (PSC_NUM_PHASES * taps) / 2 - 1;
> > > +       phase_cnt = (PSC_NUM_PHASES * (PSC_NUM_TAPS + 1)) / 2;
> > > +       tap_cnt1 = (PSC_NUM_PHASES * PSC_NUM_TAPS) / 2;
> > > +       tap_cnt2 = (PSC_NUM_PHASES * PSC_NUM_TAPS) / 2;
> > > +
> > > +       /* seed gaussian filter generator */
> > > +       sigma_q = div_q(PSC_Q_ROUND_OFFSET, fc_q);
> > > +       g0_q = 1 << PSC_Q_FRACTION;
> > > +       g1_q = exp_approx_q(div_q(-PSC_Q_ROUND_OFFSET,
> > > +                                 mult_q(sigma_q, sigma_q)));
> > > +       g2_q = mult_q(g1_q, g1_q);
> > > +       coef[phase_cnt & PSC_PHASE_MASK][tap_cnt1 >> PSC_BITS_FOR_PHASE] = g0_q;
> > > +
> > > +       for (i = 0; i < mid; i++) {
> > > +               phase_cnt++;
> > > +               tap_cnt1--;
> > > +               tap_cnt2++;
> > > +
> > > +               g0_q = mult_q(g0_q, g1_q);
> > > +               g1_q = mult_q(g1_q, g2_q);
> > > +
> > > +               if ((phase_cnt & PSC_PHASE_MASK) <= 8) {
> > > +                       tap_idx = tap_cnt1 >> PSC_BITS_FOR_PHASE;
> > > +                       coef[phase_cnt & PSC_PHASE_MASK][tap_idx] = g0_q;
> > > +               }
> > > +               if (((-phase_cnt) & PSC_PHASE_MASK) <= 8) {
> > > +                       tap_idx = tap_cnt2 >> PSC_BITS_FOR_PHASE;
> > > +                       coef[(-phase_cnt) & PSC_PHASE_MASK][tap_idx] = g0_q;
> > > +               }
> > > +       }
> > > +
> > > +       phase_cnt++;
> > > +       tap_cnt1--;
> > > +       coef[phase_cnt & PSC_PHASE_MASK][tap_cnt1 >> PSC_BITS_FOR_PHASE] = 0;
> > > +
> > > +       /* override phase 0 with identity filter if specified */
> > > +       if (phase0_identity)
> > > +               for (i = 0; i < PSC_NUM_TAPS; i++)
> > > +                       coef[0][i] = i == (PSC_NUM_TAPS >> 1) ?
> > > +                                               (1 << PSC_COEFF_PRECISION) : 0;
> > > +
> > > +       /* normalize coef */
> > > +       for (phase = 0; phase < PSC_STORED_PHASES; phase++) {
> > > +               int sum = 0;
> > > +               s64 ll_temp;
> > > +
> > > +               for (i = 0; i < PSC_NUM_TAPS; i++)
> > > +                       sum += coef[phase][i];
> > > +               for (i = 0; i < PSC_NUM_TAPS; i++) {
> > > +                       ll_temp = coef[phase][i];
> > > +                       ll_temp <<= PSC_COEFF_PRECISION;
> > > +                       ll_temp += sum >> 1;
> > > +                       ll_temp /= sum;
> > > +                       coef[phase][i] = (int)ll_temp;
> > > +               }
> > > +       }
> > > +}
> > > +
> > > +/**
> > > + * dcss_scaler_filter_design() - Compute filter coefficients using
> > > + *                              Gaussian filter.
> > > + * @src_length: length of input
> > > + * @dst_length: length of output
> > > + * @use_5_taps: 0 for 7 taps per phase, 1 for 5 taps
> > > + * @coef: output coefficients
> > > + */
> > > +static void dcss_scaler_filter_design(int src_length, int dst_length,
> > > +                                     bool use_5_taps, bool phase0_identity,
> > > +                                     int coef[][PSC_NUM_TAPS])
> > > +{
> > > +       int fc_q;
> > > +
> > > +       /* compute cutoff frequency */
> > > +       if (dst_length >= src_length)
> > > +               fc_q = div_q(1, PSC_NUM_PHASES);
> > > +       else
> > > +               fc_q = div_q(dst_length, src_length * PSC_NUM_PHASES);
> > > +
> > > +       /* compute gaussian filter coefficients */
> > > +       dcss_scaler_gaussian_filter(fc_q, use_5_taps, phase0_identity, coef);
> > > +}
> > > +
> > > +static void dcss_scaler_write(struct dcss_scaler_ch *ch, u32 val, u32 ofs)
> > > +{
> > > +       struct dcss_scaler *scl = ch->scl;
> > > +
> > > +       dcss_ctxld_write(scl->ctxld, scl->ctx_id, val, ch->base_ofs + ofs);
> > > +}
> > > +
> > > +static int dcss_scaler_ch_init_all(struct dcss_scaler *scl,
> > > +                                  unsigned long scaler_base)
> > > +{
> > > +       struct dcss_scaler_ch *ch;
> > > +       int i;
> > > +
> > > +       for (i = 0; i < 3; i++) {
> > > +               ch = &scl->ch[i];
> > > +
> > > +               ch->base_ofs = scaler_base + i * 0x400;
> > > +
> > > +               ch->base_reg = devm_ioremap(scl->dev, ch->base_ofs, SZ_4K);
> > > +               if (!ch->base_reg) {
> > > +                       dev_err(scl->dev, "scaler: unable to remap ch base\n");
> > > +                       return -ENOMEM;
> > > +               }
> > > +
> > > +               ch->scl = scl;
> > > +       }
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +int dcss_scaler_init(struct dcss_dev *dcss, unsigned long scaler_base)
> > > +{
> > > +       struct dcss_scaler *scaler;
> > > +
> > > +       scaler = devm_kzalloc(dcss->dev, sizeof(*scaler), GFP_KERNEL);
> > > +       if (!scaler)
> > > +               return -ENOMEM;
> > > +
> > > +       dcss->scaler = scaler;
> > > +       scaler->dev = dcss->dev;
> > > +       scaler->ctxld = dcss->ctxld;
> > > +       scaler->ctx_id = CTX_SB_HP;
> > > +
> > > +       if (dcss_scaler_ch_init_all(scaler, scaler_base)) {
> > > +               int i;
> > > +
> > > +               for (i = 0; i < 3; i++) {
> > > +                       if (scaler->ch[i].base_reg)
> > > +                               devm_iounmap(scaler->dev,
> > > +                                            scaler->ch[i].base_reg);
> > > +               }
> > > +
> > > +               devm_kfree(scaler->dev, scaler);
> > > +
> > > +               return -ENOMEM;
> > > +       }
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +void dcss_scaler_exit(struct dcss_scaler *scl)
> > > +{
> > > +       int ch_no;
> > > +
> > > +       for (ch_no = 0; ch_no < 3; ch_no++) {
> > > +               struct dcss_scaler_ch *ch = &scl->ch[ch_no];
> > > +
> > > +               dcss_writel(0, ch->base_reg + DCSS_SCALER_CTRL);
> > > +
> > > +               if (ch->base_reg)
> > > +                       devm_iounmap(scl->dev, ch->base_reg);
> > > +       }
> > > +
> > > +       devm_kfree(scl->dev, scl);
> > > +}
> > > +
> > > +void dcss_scaler_ch_enable(struct dcss_scaler *scl, int ch_num, bool en)
> > > +{
> > > +       struct dcss_scaler_ch *ch = &scl->ch[ch_num];
> > > +       u32 scaler_ctrl;
> > > +
> > > +       scaler_ctrl = en ? SCALER_EN | REPEAT_EN : 0;
> > > +
> > > +       if (en)
> > > +               dcss_scaler_write(ch, ch->sdata_ctrl, DCSS_SCALER_SDATA_CTRL);
> > > +
> > > +       if (ch->scaler_ctrl != scaler_ctrl)
> > > +               ch->scaler_ctrl_chgd = true;
> > > +
> > > +       ch->scaler_ctrl = scaler_ctrl;
> > > +}
> > > +
> > > +static void dcss_scaler_yuv_enable(struct dcss_scaler_ch *ch, bool en)
> > > +{
> > > +       ch->sdata_ctrl &= ~YUV_EN;
> > > +       ch->sdata_ctrl |= en ? YUV_EN : 0;
> > > +}
> > > +
> > > +static void dcss_scaler_rtr_8lines_enable(struct dcss_scaler_ch *ch, bool en)
> > > +{
> > > +       ch->sdata_ctrl &= ~RTRAM_8LINES;
> > > +       ch->sdata_ctrl |= en ? RTRAM_8LINES : 0;
> > > +}
> > > +
> > > +static void dcss_scaler_bit_depth_set(struct dcss_scaler_ch *ch, int depth)
> > > +{
> > > +       u32 val;
> > > +
> > > +       val = depth == 30 ? 2 : 0;
> > > +
> > > +       dcss_scaler_write(ch,
> > > +                         ((val << CHR_BIT_DEPTH_POS) & CHR_BIT_DEPTH_MASK) |
> > > +                         ((val << LUM_BIT_DEPTH_POS) & LUM_BIT_DEPTH_MASK),
> > > +                         DCSS_SCALER_BIT_DEPTH);
> > > +}
> > > +
> > > +enum buffer_format {
> > > +       BUF_FMT_YUV420,
> > > +       BUF_FMT_YUV422,
> > > +       BUF_FMT_ARGB8888_YUV444,
> > > +};
> > > +
> > > +enum chroma_location {
> > > +       PSC_LOC_HORZ_0_VERT_1_OVER_4 = 0,
> > > +       PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_4 = 1,
> > > +       PSC_LOC_HORZ_0_VERT_0 = 2,
> > > +       PSC_LOC_HORZ_1_OVER_4_VERT_0 = 3,
> > > +       PSC_LOC_HORZ_0_VERT_1_OVER_2 = 4,
> > > +       PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_2 = 5
> > > +};
> > > +
> > > +static void dcss_scaler_format_set(struct dcss_scaler_ch *ch,
> > > +                                  enum buffer_format src_fmt,
> > > +                                  enum buffer_format dst_fmt)
> > > +{
> > > +       dcss_scaler_write(ch, src_fmt, DCSS_SCALER_SRC_FORMAT);
> > > +       dcss_scaler_write(ch, dst_fmt, DCSS_SCALER_DST_FORMAT);
> > > +}
> > > +
> > > +static void dcss_scaler_res_set(struct dcss_scaler_ch *ch,
> > > +                               int src_xres, int src_yres,
> > > +                               int dst_xres, int dst_yres,
> > > +                               u32 pix_format, enum buffer_format dst_format)
> > > +{
> > > +       u32 lsrc_xres, lsrc_yres, csrc_xres, csrc_yres;
> > > +       u32 ldst_xres, ldst_yres, cdst_xres, cdst_yres;
> > > +       bool src_is_444 = true;
> > > +
> > > +       lsrc_xres = src_xres;
> > > +       csrc_xres = src_xres;
> > > +       lsrc_yres = src_yres;
> > > +       csrc_yres = src_yres;
> > > +       ldst_xres = dst_xres;
> > > +       cdst_xres = dst_xres;
> > > +       ldst_yres = dst_yres;
> > > +       cdst_yres = dst_yres;
> > > +
> > > +       if (pix_format == DRM_FORMAT_UYVY || pix_format == DRM_FORMAT_VYUY ||
> > > +           pix_format == DRM_FORMAT_YUYV || pix_format == DRM_FORMAT_YVYU) {
> > > +               csrc_xres >>= 1;
> > > +               src_is_444 = false;
> > > +       } else if (pix_format == DRM_FORMAT_NV12 ||
> > > +                  pix_format == DRM_FORMAT_NV21) {
> > > +               csrc_xres >>= 1;
> > > +               csrc_yres >>= 1;
> > > +               src_is_444 = false;
> > > +       }
> > > +
> > > +       if (dst_format == BUF_FMT_YUV422)
> > > +               cdst_xres >>= 1;
> > > +
> > > +       /* for 4:4:4 to 4:2:2 conversion, source height should be 1 less */
> > > +       if (src_is_444 && dst_format == BUF_FMT_YUV422) {
> > > +               lsrc_yres--;
> > > +               csrc_yres--;
> > > +       }
> > > +
> > > +       dcss_scaler_write(ch, (((lsrc_yres - 1) << HEIGHT_POS) & HEIGHT_MASK) |
> > > +                              (((lsrc_xres - 1) << WIDTH_POS) & WIDTH_MASK),
> > > +                         DCSS_SCALER_SRC_LUM_RES);
> > > +       dcss_scaler_write(ch, (((csrc_yres - 1) << HEIGHT_POS) & HEIGHT_MASK) |
> > > +                              (((csrc_xres - 1) << WIDTH_POS) & WIDTH_MASK),
> > > +                         DCSS_SCALER_SRC_CHR_RES);
> > > +       dcss_scaler_write(ch, (((ldst_yres - 1) << HEIGHT_POS) & HEIGHT_MASK) |
> > > +                              (((ldst_xres - 1) << WIDTH_POS) & WIDTH_MASK),
> > > +                         DCSS_SCALER_DST_LUM_RES);
> > > +       dcss_scaler_write(ch, (((cdst_yres - 1) << HEIGHT_POS) & HEIGHT_MASK) |
> > > +                              (((cdst_xres - 1) << WIDTH_POS) & WIDTH_MASK),
> > > +                         DCSS_SCALER_DST_CHR_RES);
> > > +}
> > > +
> > > +#define max_downscale(ratio)           ((ratio) << 16)
> > > +#define max_upscale(ratio)             ((1 << 16) / (ratio))
> > > +
> > > +struct dcss_scaler_ratios {
> > > +       int downscale;
> > > +       int upscale;
> > > +};
> > > +
> > > +static const struct dcss_scaler_ratios dcss_scaler_ratios[] = {
> > > +       {max_downscale(3), max_upscale(8)},
> > > +       {max_downscale(5), max_upscale(8)},
> > > +       {max_downscale(5), max_upscale(8)},
> > > +};
> > > +
> > > +static void dcss_scaler_fractions_set(struct dcss_scaler_ch *ch,
> > > +                                     int src_xres, int src_yres,
> > > +                                     int dst_xres, int dst_yres,
> > > +                                     u32 src_format, u32 dst_format,
> > > +                                     enum chroma_location src_chroma_loc)
> > > +{
> > > +       int src_c_xres, src_c_yres, dst_c_xres, dst_c_yres;
> > > +       u32 l_vinc, l_hinc, c_vinc, c_hinc;
> > > +       u32 c_vstart, c_hstart;
> > > +
> > > +       src_c_xres = src_xres;
> > > +       src_c_yres = src_yres;
> > > +       dst_c_xres = dst_xres;
> > > +       dst_c_yres = dst_yres;
> > > +
> > > +       c_vstart = 0;
> > > +       c_hstart = 0;
> > > +
> > > +       /* adjustments for source chroma location */
> > > +       if (src_format == BUF_FMT_YUV420) {
> > > +               /* vertical input chroma position adjustment */
> > > +               switch (src_chroma_loc) {
> > > +               case PSC_LOC_HORZ_0_VERT_1_OVER_4:
> > > +               case PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_4:
> > > +                       /*
> > > +                        * move chroma up to first luma line
> > > +                        * (1/4 chroma input line spacing)
> > > +                        */
> > > +                       c_vstart -= (1 << (PSC_PHASE_FRACTION_BITS - 2));
> > > +                       break;
> > > +               case PSC_LOC_HORZ_0_VERT_1_OVER_2:
> > > +               case PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_2:
> > > +                       /*
> > > +                        * move chroma up to first luma line
> > > +                        * (1/2 chroma input line spacing)
> > > +                        */
> > > +                       c_vstart -= (1 << (PSC_PHASE_FRACTION_BITS - 1));
> > > +                       break;
> > > +               default:
> > > +                       break;
> > > +               }
> > > +               /* horizontal input chroma position adjustment */
> > > +               switch (src_chroma_loc) {
> > > +               case PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_4:
> > > +               case PSC_LOC_HORZ_1_OVER_4_VERT_0:
> > > +               case PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_2:
> > > +                       /* move chroma left 1/4 chroma input sample spacing */
> > > +                       c_hstart -= (1 << (PSC_PHASE_FRACTION_BITS - 2));
> > > +                       break;
> > > +               default:
> > > +                       break;
> > > +               }
> > > +       }
> > > +
> > > +       /* adjustments to chroma resolution */
> > > +       if (src_format == BUF_FMT_YUV420) {
> > > +               src_c_xres >>= 1;
> > > +               src_c_yres >>= 1;
> > > +       } else if (src_format == BUF_FMT_YUV422) {
> > > +               src_c_xres >>= 1;
> > > +       }
> > > +
> > > +       if (dst_format == BUF_FMT_YUV422)
> > > +               dst_c_xres >>= 1;
> > > +
> > > +       l_vinc = ((src_yres << 13) + (dst_yres >> 1)) / dst_yres;
> > > +       c_vinc = ((src_c_yres << 13) + (dst_c_yres >> 1)) / dst_c_yres;
> > > +       l_hinc = ((src_xres << 13) + (dst_xres >> 1)) / dst_xres;
> > > +       c_hinc = ((src_c_xres << 13) + (dst_c_xres >> 1)) / dst_c_xres;
> > > +
> > > +       /* save chroma start phase */
> > > +       ch->c_vstart = c_vstart;
> > > +       ch->c_hstart = c_hstart;
> > > +
> > > +       dcss_scaler_write(ch, 0, DCSS_SCALER_V_LUM_START);
> > > +       dcss_scaler_write(ch, l_vinc, DCSS_SCALER_V_LUM_INC);
> > > +
> > > +       dcss_scaler_write(ch, 0, DCSS_SCALER_H_LUM_START);
> > > +       dcss_scaler_write(ch, l_hinc, DCSS_SCALER_H_LUM_INC);
> > > +
> > > +       dcss_scaler_write(ch, c_vstart, DCSS_SCALER_V_CHR_START);
> > > +       dcss_scaler_write(ch, c_vinc, DCSS_SCALER_V_CHR_INC);
> > > +
> > > +       dcss_scaler_write(ch, c_hstart, DCSS_SCALER_H_CHR_START);
> > > +       dcss_scaler_write(ch, c_hinc, DCSS_SCALER_H_CHR_INC);
> > > +}
> > > +
> > > +int dcss_scaler_get_min_max_ratios(struct dcss_scaler *scl, int ch_num,
> > > +                                  int *min, int *max)
> > > +{
> > > +       *min = dcss_scaler_ratios[ch_num].upscale;
> > > +       *max = dcss_scaler_ratios[ch_num].downscale;
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +static void dcss_scaler_program_5_coef_set(struct dcss_scaler_ch *ch,
> > > +                                          int base_addr,
> > > +                                          int coef[][PSC_NUM_TAPS])
> > > +{
> > > +       int i, phase;
> > > +
> > > +       for (i = 0; i < PSC_STORED_PHASES; i++) {
> > > +               dcss_scaler_write(ch, ((coef[i][1] & 0xfff) << 16 |
> > > +                                      (coef[i][2] & 0xfff) << 4  |
> > > +                                      (coef[i][3] & 0xf00) >> 8),
> > > +                                 base_addr + i * sizeof(u32));
> > > +               dcss_scaler_write(ch, ((coef[i][3] & 0x0ff) << 20 |
> > > +                                      (coef[i][4] & 0xfff) << 8  |
> > > +                                      (coef[i][5] & 0xff0) >> 4),
> > > +                                 base_addr + 0x40 + i * sizeof(u32));
> > > +               dcss_scaler_write(ch, ((coef[i][5] & 0x00f) << 24),
> > > +                                 base_addr + 0x80 + i * sizeof(u32));
> > > +       }
> > > +
> > > +       /* reverse both phase and tap orderings */
> > > +       for (phase = (PSC_NUM_PHASES >> 1) - 1;
> > > +                       i < PSC_NUM_PHASES; i++, phase--) {
> > > +               dcss_scaler_write(ch, ((coef[phase][5] & 0xfff) << 16 |
> > > +                                      (coef[phase][4] & 0xfff) << 4  |
> > > +                                      (coef[phase][3] & 0xf00) >> 8),
> > > +                                 base_addr + i * sizeof(u32));
> > > +               dcss_scaler_write(ch, ((coef[phase][3] & 0x0ff) << 20 |
> > > +                                      (coef[phase][2] & 0xfff) << 8  |
> > > +                                      (coef[phase][1] & 0xff0) >> 4),
> > > +                                 base_addr + 0x40 + i * sizeof(u32));
> > > +               dcss_scaler_write(ch, ((coef[phase][1] & 0x00f) << 24),
> > > +                                 base_addr + 0x80 + i * sizeof(u32));
> > > +       }
> > > +}
> > > +
> > > +static void dcss_scaler_program_7_coef_set(struct dcss_scaler_ch *ch,
> > > +                                          int base_addr,
> > > +                                          int coef[][PSC_NUM_TAPS])
> > > +{
> > > +       int i, phase;
> > > +
> > > +       for (i = 0; i < PSC_STORED_PHASES; i++) {
> > > +               dcss_scaler_write(ch, ((coef[i][0] & 0xfff) << 16 |
> > > +                                      (coef[i][1] & 0xfff) << 4  |
> > > +                                      (coef[i][2] & 0xf00) >> 8),
> > > +                                 base_addr + i * sizeof(u32));
> > > +               dcss_scaler_write(ch, ((coef[i][2] & 0x0ff) << 20 |
> > > +                                      (coef[i][3] & 0xfff) << 8  |
> > > +                                      (coef[i][4] & 0xff0) >> 4),
> > > +                                 base_addr + 0x40 + i * sizeof(u32));
> > > +               dcss_scaler_write(ch, ((coef[i][4] & 0x00f) << 24 |
> > > +                                      (coef[i][5] & 0xfff) << 12 |
> > > +                                      (coef[i][6] & 0xfff)),
> > > +                                 base_addr + 0x80 + i * sizeof(u32));
> > > +       }
> > > +
> > > +       /* reverse both phase and tap orderings */
> > > +       for (phase = (PSC_NUM_PHASES >> 1) - 1;
> > > +                       i < PSC_NUM_PHASES; i++, phase--) {
> > > +               dcss_scaler_write(ch, ((coef[phase][6] & 0xfff) << 16 |
> > > +                                      (coef[phase][5] & 0xfff) << 4  |
> > > +                                      (coef[phase][4] & 0xf00) >> 8),
> > > +                                 base_addr + i * sizeof(u32));
> > > +               dcss_scaler_write(ch, ((coef[phase][4] & 0x0ff) << 20 |
> > > +                                      (coef[phase][3] & 0xfff) << 8  |
> > > +                                      (coef[phase][2] & 0xff0) >> 4),
> > > +                                 base_addr + 0x40 + i * sizeof(u32));
> > > +               dcss_scaler_write(ch, ((coef[phase][2] & 0x00f) << 24 |
> > > +                                      (coef[phase][1] & 0xfff) << 12 |
> > > +                                      (coef[phase][0] & 0xfff)),
> > > +                                 base_addr + 0x80 + i * sizeof(u32));
> > > +       }
> > > +}
> > > +
> > > +static void dcss_scaler_yuv_coef_set(struct dcss_scaler_ch *ch,
> > > +                                    enum buffer_format src_format,
> > > +                                    enum buffer_format dst_format,
> > > +                                    bool use_5_taps,
> > > +                                    int src_xres, int src_yres, int dst_xres,
> > > +                                    int dst_yres)
> > > +{
> > > +       int coef[PSC_STORED_PHASES][PSC_NUM_TAPS];
> > > +       bool program_5_taps = use_5_taps ||
> > > +                             (dst_format == BUF_FMT_YUV422 &&
> > > +                              src_format == BUF_FMT_ARGB8888_YUV444);
> > > +
> > > +       /* horizontal luma */
> > > +       dcss_scaler_filter_design(src_xres, dst_xres, false,
> > > +                                 src_xres == dst_xres, coef);
> > > +       dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_HLUM, coef);
> > > +
> > > +       /* vertical luma */
> > > +       dcss_scaler_filter_design(src_yres, dst_yres, program_5_taps,
> > > +                                 src_yres == dst_yres, coef);
> > > +
> > > +       if (program_5_taps)
> > > +               dcss_scaler_program_5_coef_set(ch, DCSS_SCALER_COEF_VLUM, coef);
> > > +       else
> > > +               dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_VLUM, coef);
> > > +
> > > +       /* adjust chroma resolution */
> > > +       if (src_format != BUF_FMT_ARGB8888_YUV444)
> > > +               src_xres >>= 1;
> > > +       if (src_format == BUF_FMT_YUV420)
> > > +               src_yres >>= 1;
> > > +       if (dst_format != BUF_FMT_ARGB8888_YUV444)
> > > +               dst_xres >>= 1;
> > > +       if (dst_format == BUF_FMT_YUV420) /* should not happen */
> > > +               dst_yres >>= 1;
> > > +
> > > +       /* horizontal chroma */
> > > +       dcss_scaler_filter_design(src_xres, dst_xres, false,
> > > +                                 (src_xres == dst_xres) && (ch->c_hstart == 0),
> > > +                                 coef);
> > > +
> > > +       dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_HCHR, coef);
> > > +
> > > +       /* vertical chroma */
> > > +       dcss_scaler_filter_design(src_yres, dst_yres, program_5_taps,
> > > +                                 (src_yres == dst_yres) && (ch->c_vstart == 0),
> > > +                                 coef);
> > > +       if (program_5_taps)
> > > +               dcss_scaler_program_5_coef_set(ch, DCSS_SCALER_COEF_VCHR, coef);
> > > +       else
> > > +               dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_VCHR, coef);
> > > +}
> > > +
> > > +static void dcss_scaler_rgb_coef_set(struct dcss_scaler_ch *ch,
> > > +                                    int src_xres, int src_yres, int dst_xres,
> > > +                                    int dst_yres)
> > > +{
> > > +       int coef[PSC_STORED_PHASES][PSC_NUM_TAPS];
> > > +
> > > +       /* horizontal RGB */
> > > +       dcss_scaler_filter_design(src_xres, dst_xres, false,
> > > +                                 src_xres == dst_xres, coef);
> > > +       dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_HLUM, coef);
> > > +
> > > +       /* vertical RGB */
> > > +       dcss_scaler_filter_design(src_yres, dst_yres, false,
> > > +                                 src_yres == dst_yres, coef);
> > > +       dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_VLUM, coef);
> > > +}
> > > +
> > > +static void dcss_scaler_set_rgb10_order(struct dcss_scaler_ch *ch,
> > > +                                       const struct drm_format_info *format)
> > > +{
> > > +       u32 a2r10g10b10_format;
> > > +
> > > +       if (format->is_yuv)
> > > +               return;
> > > +
> > > +       ch->sdata_ctrl &= ~A2R10G10B10_FORMAT_MASK;
> > > +
> > > +       if (format->depth != 30)
> > > +               return;
> > > +
> > > +       switch (format->format) {
> > > +       case DRM_FORMAT_ARGB2101010:
> > > +       case DRM_FORMAT_XRGB2101010:
> > > +               a2r10g10b10_format = 0;
> > > +               break;
> > > +
> > > +       case DRM_FORMAT_ABGR2101010:
> > > +       case DRM_FORMAT_XBGR2101010:
> > > +               a2r10g10b10_format = 5;
> > > +               break;
> > > +
> > > +       case DRM_FORMAT_RGBA1010102:
> > > +       case DRM_FORMAT_RGBX1010102:
> > > +               a2r10g10b10_format = 6;
> > > +               break;
> > > +
> > > +       case DRM_FORMAT_BGRA1010102:
> > > +       case DRM_FORMAT_BGRX1010102:
> > > +               a2r10g10b10_format = 11;
> > > +               break;
> > > +
> > > +       default:
> > > +               a2r10g10b10_format = 0;
> > > +               break;
> > > +       }
> > > +
> > > +       ch->sdata_ctrl |= a2r10g10b10_format << A2R10G10B10_FORMAT_POS;
> > > +}
> > > +
> > > +void dcss_scaler_setup(struct dcss_scaler *scl, int ch_num,
> > > +                      const struct drm_format_info *format,
> > > +                      int src_xres, int src_yres, int dst_xres, int dst_yres,
> > > +                      u32 vrefresh_hz)
> > > +{
> > > +       struct dcss_scaler_ch *ch = &scl->ch[ch_num];
> > > +       unsigned int pixel_depth = 0;
> > > +       bool rtr_8line_en = false;
> > > +       bool use_5_taps = false;
> > > +       enum buffer_format src_format = BUF_FMT_ARGB8888_YUV444;
> > > +       enum buffer_format dst_format = BUF_FMT_ARGB8888_YUV444;
> > > +       u32 pix_format = format->format;
> > > +
> > > +       if (format->is_yuv) {
> > > +               dcss_scaler_yuv_enable(ch, true);
> > > +
> > > +               if (pix_format == DRM_FORMAT_NV12 ||
> > > +                   pix_format == DRM_FORMAT_NV21 ||
> > > +                   pix_format == DRM_FORMAT_P010) {
> > > +                       rtr_8line_en = true;
> > > +                       src_format = BUF_FMT_YUV420;
> > > +               } else if (pix_format == DRM_FORMAT_UYVY ||
> > > +                          pix_format == DRM_FORMAT_VYUY ||
> > > +                          pix_format == DRM_FORMAT_YUYV ||
> > > +                          pix_format == DRM_FORMAT_YVYU) {
> > > +                       src_format = BUF_FMT_YUV422;
> > > +               }
> > > +
> > > +               use_5_taps = !rtr_8line_en;
> > > +               if (pix_format == DRM_FORMAT_P010)
> > > +                       pixel_depth = 30;
> > > +
> > > +       } else {
> > > +               dcss_scaler_yuv_enable(ch, false);
> > > +
> > > +               pixel_depth = format->depth;
> > > +       }
> > > +
> > > +       dcss_scaler_fractions_set(ch, src_xres, src_yres, dst_xres,
> > > +                                 dst_yres, src_format, dst_format,
> > > +                                 PSC_LOC_HORZ_0_VERT_1_OVER_4);
> > > +
> > > +       if (format->is_yuv)
> > > +               dcss_scaler_yuv_coef_set(ch, src_format, dst_format,
> > > +                                        use_5_taps, src_xres, src_yres,
> > > +                                        dst_xres, dst_yres);
> > > +       else
> > > +               dcss_scaler_rgb_coef_set(ch, src_xres, src_yres,
> > > +                                        dst_xres, dst_yres);
> > > +
> > > +       dcss_scaler_rtr_8lines_enable(ch, rtr_8line_en);
> > > +       dcss_scaler_bit_depth_set(ch, pixel_depth);
> > > +       dcss_scaler_set_rgb10_order(ch, format);
> > > +       dcss_scaler_format_set(ch, src_format, dst_format);
> > > +       dcss_scaler_res_set(ch, src_xres, src_yres, dst_xres, dst_yres,
> > > +                           pix_format, dst_format);
> > > +}
> > > +
> > > +/* This function will be called from interrupt context. */
> > > +void dcss_scaler_write_sclctrl(struct dcss_scaler *scl)
> > > +{
> > > +       int chnum;
> > > +
> > > +       for (chnum = 0; chnum < 3; chnum++) {
> > > +               struct dcss_scaler_ch *ch = &scl->ch[chnum];
> > > +
> > > +               if (ch->scaler_ctrl_chgd) {
> > > +                       dcss_ctxld_write_irqsafe(scl->ctxld, scl->ctx_id,
> > > +                                                ch->scaler_ctrl,
> > > +                                                ch->base_ofs +
> > > +                                                DCSS_SCALER_CTRL);
> > > +                       ch->scaler_ctrl_chgd = false;
> > > +               }
> > > +       }
> > > +}
> > > diff --git a/drivers/gpu/drm/imx/dcss/dcss-ss.c b/drivers/gpu/drm/imx/dcss/dcss-ss.c
> > > new file mode 100644
> > > index 00000000..65a05c2
> > > --- /dev/null
> > > +++ b/drivers/gpu/drm/imx/dcss/dcss-ss.c
> > > @@ -0,0 +1,179 @@
> > > +// SPDX-License-Identifier: GPL-2.0
> > > +/*
> > > + * Copyright 2019 NXP.
> > > + */
> > > +
> > > +#include <linux/device.h>
> > > +
> > > +#include "dcss-dev.h"
> > > +
> > > +#define DCSS_SS_SYS_CTRL                       0x00
> > > +#define   RUN_EN                               BIT(0)
> > > +#define DCSS_SS_DISPLAY                                0x10
> > > +#define   LRC_X_POS                            0
> > > +#define   LRC_X_MASK                           GENMASK(12, 0)
> > > +#define   LRC_Y_POS                            16
> > > +#define   LRC_Y_MASK                           GENMASK(28, 16)
> > > +#define DCSS_SS_HSYNC                          0x20
> > > +#define DCSS_SS_VSYNC                          0x30
> > > +#define   SYNC_START_POS                       0
> > > +#define   SYNC_START_MASK                      GENMASK(12, 0)
> > > +#define   SYNC_END_POS                         16
> > > +#define   SYNC_END_MASK                                GENMASK(28, 16)
> > > +#define   SYNC_POL                             BIT(31)
> > > +#define DCSS_SS_DE_ULC                         0x40
> > > +#define   ULC_X_POS                            0
> > > +#define   ULC_X_MASK                           GENMASK(12, 0)
> > > +#define   ULC_Y_POS                            16
> > > +#define   ULC_Y_MASK                           GENMASK(28, 16)
> > > +#define   ULC_POL                              BIT(31)
> > > +#define DCSS_SS_DE_LRC                         0x50
> > > +#define DCSS_SS_MODE                           0x60
> > > +#define   PIPE_MODE_POS                                0
> > > +#define   PIPE_MODE_MASK                       GENMASK(1, 0)
> > > +#define DCSS_SS_COEFF                          0x70
> > > +#define   HORIZ_A_POS                          0
> > > +#define   HORIZ_A_MASK                         GENMASK(3, 0)
> > > +#define   HORIZ_B_POS                          4
> > > +#define   HORIZ_B_MASK                         GENMASK(7, 4)
> > > +#define   HORIZ_C_POS                          8
> > > +#define   HORIZ_C_MASK                         GENMASK(11, 8)
> > > +#define   HORIZ_H_NORM_POS                     12
> > > +#define   HORIZ_H_NORM_MASK                    GENMASK(14, 12)
> > > +#define   VERT_A_POS                           16
> > > +#define   VERT_A_MASK                          GENMASK(19, 16)
> > > +#define   VERT_B_POS                           20
> > > +#define   VERT_B_MASK                          GENMASK(23, 20)
> > > +#define   VERT_C_POS                           24
> > > +#define   VERT_C_MASK                          GENMASK(27, 24)
> > > +#define   VERT_H_NORM_POS                      28
> > > +#define   VERT_H_NORM_MASK                     GENMASK(30, 28)
> > > +#define DCSS_SS_CLIP_CB                                0x80
> > > +#define DCSS_SS_CLIP_CR                                0x90
> > > +#define   CLIP_MIN_POS                         0
> > > +#define   CLIP_MIN_MASK                                GENMASK(9, 0)
> > > +#define   CLIP_MAX_POS                         0
> > > +#define   CLIP_MAX_MASK                                GENMASK(23, 16)
> > > +#define DCSS_SS_INTER_MODE                     0xA0
> > > +#define   INT_EN                               BIT(0)
> > > +#define   VSYNC_SHIFT                          BIT(1)
> > > +
> > > +struct dcss_ss {
> > > +       struct device *dev;
> > > +       void __iomem *base_reg;
> > > +       u32 base_ofs;
> > > +
> > > +       struct dcss_ctxld *ctxld;
> > > +       u32 ctx_id;
> > > +
> > > +       bool in_use;
> > > +};
> > > +
> > > +static void dcss_ss_write(struct dcss_ss *ss, u32 val, u32 ofs)
> > > +{
> > > +       if (!ss->in_use)
> > > +               dcss_writel(val, ss->base_reg + ofs);
> > > +
> > > +       dcss_ctxld_write(ss->ctxld, ss->ctx_id, val,
> > > +                        ss->base_ofs + ofs);
> > > +}
> > > +
> > > +int dcss_ss_init(struct dcss_dev *dcss, unsigned long ss_base)
> > > +{
> > > +       struct dcss_ss *ss;
> > > +
> > > +       ss = devm_kzalloc(dcss->dev, sizeof(*ss), GFP_KERNEL);
> > > +       if (!ss)
> > > +               return -ENOMEM;
> > > +
> > > +       dcss->ss = ss;
> > > +       ss->dev = dcss->dev;
> > > +       ss->ctxld = dcss->ctxld;
> > > +
> > > +       ss->base_reg = devm_ioremap(dcss->dev, ss_base, SZ_4K);
> > > +       if (!ss->base_reg) {
> > > +               dev_err(dcss->dev, "ss: unable to remap ss base\n");
> > > +               devm_kfree(ss->dev, ss);
> > > +               return -ENOMEM;
> > > +       }
> > > +
> > > +       ss->base_ofs = ss_base;
> > > +       ss->ctx_id = CTX_SB_HP;
> > > +
> > > +       return 0;
> > > +}
> > > +
> > > +void dcss_ss_exit(struct dcss_ss *ss)
> > > +{
> > > +       /* stop SS */
> > > +       dcss_writel(0, ss->base_reg + DCSS_SS_SYS_CTRL);
> > > +
> > > +       if (ss->base_reg)
> > > +               devm_iounmap(ss->dev, ss->base_reg);
> > > +
> > > +       devm_kfree(ss->dev, ss);
> > > +}
> > > +
> > > +void dcss_ss_subsam_set(struct dcss_ss *ss)
> > > +{
> > > +       dcss_ss_write(ss, 0x41614161, DCSS_SS_COEFF);
> > > +       dcss_ss_write(ss, 0, DCSS_SS_MODE);
> > > +       dcss_ss_write(ss, 0x03ff0000, DCSS_SS_CLIP_CB);
> > > +       dcss_ss_write(ss, 0x03ff0000, DCSS_SS_CLIP_CR);
> > > +}
> > > +
> > > +void dcss_ss_sync_set(struct dcss_ss *ss, struct videomode *vm,
> > > +                     bool phsync, bool pvsync)
> > > +{
> > > +       u16 lrc_x, lrc_y;
> > > +       u16 hsync_start, hsync_end;
> > > +       u16 vsync_start, vsync_end;
> > > +       u16 de_ulc_x, de_ulc_y;
> > > +       u16 de_lrc_x, de_lrc_y;
> > > +
> > > +       lrc_x = vm->hfront_porch + vm->hback_porch + vm->hsync_len +
> > > +               vm->hactive - 1;
> > > +       lrc_y = vm->vfront_porch + vm->vback_porch + vm->vsync_len +
> > > +               vm->vactive - 1;
> > > +
> > > +       dcss_ss_write(ss, (lrc_y << LRC_Y_POS) | lrc_x, DCSS_SS_DISPLAY);
> > > +
> > > +       hsync_start = vm->hfront_porch + vm->hback_porch + vm->hsync_len +
> > > +                     vm->hactive - 1;
> > > +       hsync_end = vm->hsync_len - 1;
> > > +
> > > +       dcss_ss_write(ss, (phsync ? SYNC_POL : 0) |
> > > +                     ((u32)hsync_end << SYNC_END_POS) | hsync_start,
> > > +                     DCSS_SS_HSYNC);
> > > +
> > > +       vsync_start = vm->vfront_porch - 1;
> > > +       vsync_end = vm->vfront_porch + vm->vsync_len - 1;
> > > +
> > > +       dcss_ss_write(ss, (pvsync ? SYNC_POL : 0) |
> > > +                     ((u32)vsync_end << SYNC_END_POS) | vsync_start,
> > > +                     DCSS_SS_VSYNC);
> > > +
> > > +       de_ulc_x = vm->hsync_len + vm->hback_porch - 1;
> > > +       de_ulc_y = vm->vsync_len + vm->vfront_porch + vm->vback_porch;
> > > +
> > > +       dcss_ss_write(ss, SYNC_POL | ((u32)de_ulc_y << ULC_Y_POS) | de_ulc_x,
> > > +                     DCSS_SS_DE_ULC);
> > > +
> > > +       de_lrc_x = vm->hsync_len + vm->hback_porch + vm->hactive - 1;
> > > +       de_lrc_y = vm->vsync_len + vm->vfront_porch + vm->vback_porch +
> > > +                  vm->vactive - 1;
> > > +
> > > +       dcss_ss_write(ss, (de_lrc_y << LRC_Y_POS) | de_lrc_x, DCSS_SS_DE_LRC);
> > > +}
> > > +
> > > +void dcss_ss_enable(struct dcss_ss *ss)
> > > +{
> > > +       dcss_ss_write(ss, RUN_EN, DCSS_SS_SYS_CTRL);
> > > +       ss->in_use = true;
> > > +}
> > > +
> > > +void dcss_ss_disable(struct dcss_ss *ss)
> > > +{
> > > +       dcss_ss_write(ss, 0, DCSS_SS_SYS_CTRL);
> > > +       ss->in_use = false;
> > > +}
> >
> > > --
> > > 2.7.4
> > >
> > > _______________________________________________
> > > dri-devel mailing list
> > > dri-devel@lists.freedesktop.org
> > > https://eur01.safelinks.protection.outlook.com/?url=https%3A%2F%2Flists.freedesktop.org%2Fmailman%2Flistinfo%2Fdri-devel&amp;data=02%7C01%7Claurentiu.palcu%40nxp.com%7C94b752dadd2e413c70d008d740a32979%7C686ea1d3bc2b4c6fa92cd99c5c301635%7C0%7C0%7C637048941849367464&amp;sdata=eLdnYtMSu7o86geKr2wwIlfReLX9EmnGDQXNSuBGebU%3D&amp;reserved=0
diff mbox series

Patch

diff --git a/drivers/gpu/drm/imx/Kconfig b/drivers/gpu/drm/imx/Kconfig
index 207bf74..6231048 100644
--- a/drivers/gpu/drm/imx/Kconfig
+++ b/drivers/gpu/drm/imx/Kconfig
@@ -39,3 +39,5 @@  config DRM_IMX_HDMI
 	depends on DRM_IMX
 	help
 	  Choose this if you want to use HDMI on i.MX6.
+
+source "drivers/gpu/drm/imx/dcss/Kconfig"
diff --git a/drivers/gpu/drm/imx/Makefile b/drivers/gpu/drm/imx/Makefile
index 21cdcc2..b644def 100644
--- a/drivers/gpu/drm/imx/Makefile
+++ b/drivers/gpu/drm/imx/Makefile
@@ -9,3 +9,4 @@  obj-$(CONFIG_DRM_IMX_TVE) += imx-tve.o
 obj-$(CONFIG_DRM_IMX_LDB) += imx-ldb.o
 
 obj-$(CONFIG_DRM_IMX_HDMI) += dw_hdmi-imx.o
+obj-$(CONFIG_DRM_IMX_DCSS) += dcss/
diff --git a/drivers/gpu/drm/imx/dcss/Kconfig b/drivers/gpu/drm/imx/dcss/Kconfig
new file mode 100644
index 00000000..6399c12
--- /dev/null
+++ b/drivers/gpu/drm/imx/dcss/Kconfig
@@ -0,0 +1,7 @@ 
+config DRM_IMX_DCSS
+	tristate "i.MX8MQ DCSS"
+	select RESET_CONTROLLER
+	select IMX_IRQSTEER
+	help
+	  Choose this if you have a NXP i.MX8MQ based system and want to use the
+	  Display Controller Subsystem. This option enables DCSS support.
diff --git a/drivers/gpu/drm/imx/dcss/Makefile b/drivers/gpu/drm/imx/dcss/Makefile
new file mode 100644
index 00000000..8c7c8da
--- /dev/null
+++ b/drivers/gpu/drm/imx/dcss/Makefile
@@ -0,0 +1,6 @@ 
+imx-dcss-objs := dcss-drv.o dcss-dev.o dcss-blkctl.o dcss-ctxld.o dcss-dtg.o \
+				 dcss-ss.o dcss-dpr.o dcss-scaler.o dcss-kms.o dcss-crtc.o \
+				 dcss-plane.o
+
+obj-$(CONFIG_DRM_IMX_DCSS) += imx-dcss.o
+
diff --git a/drivers/gpu/drm/imx/dcss/dcss-blkctl.c b/drivers/gpu/drm/imx/dcss/dcss-blkctl.c
new file mode 100644
index 00000000..ee7ffa1
--- /dev/null
+++ b/drivers/gpu/drm/imx/dcss/dcss-blkctl.c
@@ -0,0 +1,75 @@ 
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright 2019 NXP.
+ */
+
+#include <linux/device.h>
+#include <linux/of.h>
+
+#include "dcss-dev.h"
+
+#define DCSS_BLKCTL_RESET_CTRL		0x00
+#define   B_CLK_RESETN			BIT(0)
+#define   APB_CLK_RESETN		BIT(1)
+#define   P_CLK_RESETN			BIT(2)
+#define   RTR_CLK_RESETN		BIT(3)
+#define DCSS_BLKCTL_CONTROL0		0x10
+#define   HDMI_MIPI_CLK_SEL		BIT(0)
+#define   DISPMIX_REFCLK_SEL_POS	4
+#define   DISPMIX_REFCLK_SEL_MASK	GENMASK(5, 4)
+#define   DISPMIX_PIXCLK_SEL		BIT(8)
+#define   HDMI_SRC_SECURE_EN		BIT(16)
+
+struct dcss_blkctl {
+	struct device *dev;
+	void __iomem *base_reg;
+
+	bool hdmi_output;
+};
+
+void dcss_blkctl_cfg(struct dcss_blkctl *blkctl)
+{
+	if (blkctl->hdmi_output)
+		dcss_writel(0, blkctl->base_reg + DCSS_BLKCTL_CONTROL0);
+	else
+		dcss_writel(DISPMIX_PIXCLK_SEL,
+			    blkctl->base_reg + DCSS_BLKCTL_CONTROL0);
+
+	dcss_set(B_CLK_RESETN | APB_CLK_RESETN | P_CLK_RESETN | RTR_CLK_RESETN,
+		 blkctl->base_reg + DCSS_BLKCTL_RESET_CTRL);
+}
+
+int dcss_blkctl_init(struct dcss_dev *dcss, unsigned long blkctl_base)
+{
+	struct dcss_blkctl *blkctl;
+
+	blkctl = devm_kzalloc(dcss->dev, sizeof(*blkctl), GFP_KERNEL);
+	if (!blkctl)
+		return -ENOMEM;
+
+	blkctl->base_reg = devm_ioremap(dcss->dev, blkctl_base, SZ_4K);
+	if (!blkctl->base_reg) {
+		dev_err(dcss->dev, "unable to remap BLK CTRL base\n");
+		devm_kfree(dcss->dev, blkctl);
+		return -ENOMEM;
+	}
+
+	dcss->blkctl = blkctl;
+	blkctl->dev = dcss->dev;
+	blkctl->hdmi_output = dcss->hdmi_output;
+
+	dcss_blkctl_cfg(blkctl);
+
+	return 0;
+}
+
+void dcss_blkctl_exit(struct dcss_blkctl *blkctl)
+{
+	dcss_clr(P_CLK_RESETN | RTR_CLK_RESETN,
+		 blkctl->base_reg + DCSS_BLKCTL_RESET_CTRL);
+
+	if (blkctl->base_reg)
+		devm_iounmap(blkctl->dev, blkctl->base_reg);
+
+	devm_kfree(blkctl->dev, blkctl);
+}
diff --git a/drivers/gpu/drm/imx/dcss/dcss-crtc.c b/drivers/gpu/drm/imx/dcss/dcss-crtc.c
new file mode 100644
index 00000000..6abb40c
--- /dev/null
+++ b/drivers/gpu/drm/imx/dcss/dcss-crtc.c
@@ -0,0 +1,223 @@ 
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright 2019 NXP.
+ */
+
+#include <drm/drmP.h>
+#include <drm/drm_atomic_helper.h>
+#include <linux/pm_runtime.h>
+
+#include "dcss-dev.h"
+#include "dcss-kms.h"
+
+static int dcss_enable_vblank(struct drm_crtc *crtc)
+{
+	struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
+						   base);
+	struct dcss_dev *dcss = crtc->dev->dev_private;
+
+	if (dcss_crtc->irq_enabled)
+		return 0;
+
+	dcss_crtc->irq_enabled = true;
+
+	dcss_dtg_vblank_irq_enable(dcss->dtg, true);
+
+	dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, true);
+
+	enable_irq(dcss_crtc->irq);
+
+	return 0;
+}
+
+static void dcss_disable_vblank(struct drm_crtc *crtc)
+{
+	struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
+						   base);
+	struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
+
+	disable_irq_nosync(dcss_crtc->irq);
+
+	dcss_dtg_vblank_irq_enable(dcss->dtg, false);
+
+	dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, false);
+
+	dcss_crtc->irq_enabled = false;
+}
+
+static const struct drm_crtc_funcs dcss_crtc_funcs = {
+	.set_config = drm_atomic_helper_set_config,
+	.destroy = drm_crtc_cleanup,
+	.page_flip = drm_atomic_helper_page_flip,
+	.reset = drm_atomic_helper_crtc_reset,
+	.atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
+	.atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
+	.enable_vblank = dcss_enable_vblank,
+	.disable_vblank = dcss_disable_vblank,
+};
+
+static void dcss_crtc_atomic_begin(struct drm_crtc *crtc,
+				   struct drm_crtc_state *old_crtc_state)
+{
+	drm_crtc_vblank_on(crtc);
+
+	spin_lock_irq(&crtc->dev->event_lock);
+	if (crtc->state->event) {
+		WARN_ON(drm_crtc_vblank_get(crtc));
+		drm_crtc_arm_vblank_event(crtc, crtc->state->event);
+		crtc->state->event = NULL;
+	}
+	spin_unlock_irq(&crtc->dev->event_lock);
+}
+
+static void dcss_crtc_atomic_flush(struct drm_crtc *crtc,
+				   struct drm_crtc_state *old_crtc_state)
+{
+	struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
+						   base);
+	struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
+
+	if (dcss_dtg_is_enabled(dcss->dtg))
+		dcss_ctxld_enable(dcss->ctxld);
+}
+
+static void dcss_crtc_atomic_enable(struct drm_crtc *crtc,
+				    struct drm_crtc_state *old_crtc_state)
+{
+	struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
+						   base);
+	struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
+	struct drm_display_mode *mode = &crtc->state->adjusted_mode;
+	struct videomode vm;
+
+	drm_display_mode_to_videomode(mode, &vm);
+
+	pm_runtime_get_sync(dcss->dev);
+
+	dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, true);
+
+	vm.pixelclock = mode->crtc_clock * 1000;
+
+	dcss_dtg_sync_set(dcss->dtg, &vm);
+
+	dcss_ss_subsam_set(dcss->ss);
+	dcss_ss_sync_set(dcss->ss, &vm, mode->flags & DRM_MODE_FLAG_PHSYNC,
+			 mode->flags & DRM_MODE_FLAG_PVSYNC);
+
+	dcss_dtg_css_set(dcss->dtg);
+
+	dcss_ss_enable(dcss->ss);
+	dcss_dtg_enable(dcss->dtg, true, NULL);
+	dcss_ctxld_enable(dcss->ctxld);
+
+	reinit_completion(&dcss_crtc->en_completion);
+	wait_for_completion_timeout(&dcss_crtc->en_completion,
+				    msecs_to_jiffies(500));
+}
+
+static void dcss_crtc_atomic_disable(struct drm_crtc *crtc,
+				     struct drm_crtc_state *old_crtc_state)
+{
+	struct dcss_crtc *dcss_crtc = container_of(crtc, struct dcss_crtc,
+						   base);
+	struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
+
+	drm_atomic_helper_disable_planes_on_crtc(old_crtc_state, false);
+
+	spin_lock_irq(&crtc->dev->event_lock);
+	if (crtc->state->event) {
+		drm_crtc_send_vblank_event(crtc, crtc->state->event);
+		crtc->state->event = NULL;
+	}
+	spin_unlock_irq(&crtc->dev->event_lock);
+
+	dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, true);
+
+	dcss_ss_disable(dcss->ss);
+	dcss_dtg_enable(dcss->dtg, false, &dcss_crtc->dis_completion);
+	dcss_ctxld_enable(dcss->ctxld);
+
+	reinit_completion(&dcss_crtc->dis_completion);
+	wait_for_completion_timeout(&dcss_crtc->dis_completion,
+				    msecs_to_jiffies(100));
+
+	drm_crtc_vblank_off(crtc);
+
+	dcss_dtg_ctxld_kick_irq_enable(dcss->dtg, false);
+
+	pm_runtime_put_sync(dcss->dev);
+}
+
+static const struct drm_crtc_helper_funcs dcss_helper_funcs = {
+	.atomic_begin = dcss_crtc_atomic_begin,
+	.atomic_flush = dcss_crtc_atomic_flush,
+	.atomic_enable = dcss_crtc_atomic_enable,
+	.atomic_disable = dcss_crtc_atomic_disable,
+};
+
+static irqreturn_t dcss_crtc_irq_handler(int irq, void *dev_id)
+{
+	struct dcss_crtc *dcss_crtc = dev_id;
+	struct dcss_dev *dcss = dcss_crtc->base.dev->dev_private;
+
+	if (!dcss_dtg_vblank_irq_valid(dcss->dtg))
+		return IRQ_HANDLED;
+
+	complete(&dcss_crtc->en_completion);
+
+	if (dcss_ctxld_is_flushed(dcss->ctxld))
+		drm_crtc_handle_vblank(&dcss_crtc->base);
+
+	dcss_dtg_vblank_irq_clear(dcss->dtg);
+
+	return IRQ_HANDLED;
+}
+
+int dcss_crtc_init(struct dcss_crtc *crtc, struct drm_device *drm)
+{
+	struct dcss_dev *dcss = drm->dev_private;
+	struct platform_device *pdev = to_platform_device(dcss->dev);
+	int ret;
+
+	crtc->plane[0] = dcss_plane_init(drm, drm_crtc_mask(&crtc->base),
+					 DRM_PLANE_TYPE_PRIMARY, 0);
+	if (IS_ERR(crtc->plane[0]))
+		return PTR_ERR(crtc->plane[0]);
+
+	crtc->base.port = dcss->of_port;
+
+	drm_crtc_helper_add(&crtc->base, &dcss_helper_funcs);
+	ret = drm_crtc_init_with_planes(drm, &crtc->base, &crtc->plane[0]->base,
+					NULL, &dcss_crtc_funcs, NULL);
+	if (ret) {
+		dev_err(dcss->dev, "failed to init crtc\n");
+		return ret;
+	}
+
+	crtc->irq = platform_get_irq_byname(pdev, "vblank");
+	if (crtc->irq < 0) {
+		dev_err(dcss->dev, "unable to get vblank interrupt\n");
+		return crtc->irq;
+	}
+
+	init_completion(&crtc->en_completion);
+	init_completion(&crtc->dis_completion);
+
+	ret = devm_request_irq(dcss->dev, crtc->irq, dcss_crtc_irq_handler,
+			       IRQF_TRIGGER_RISING, "dcss_drm", crtc);
+	if (ret) {
+		dev_err(dcss->dev, "irq request failed with %d.\n", ret);
+		return ret;
+	}
+
+	disable_irq(crtc->irq);
+
+	return 0;
+}
+
+void dcss_crtc_deinit(struct dcss_crtc *crtc, struct drm_device *drm)
+{
+	struct dcss_dev *dcss = drm->dev_private;
+
+	devm_free_irq(dcss->dev, crtc->irq, crtc);
+}
diff --git a/drivers/gpu/drm/imx/dcss/dcss-ctxld.c b/drivers/gpu/drm/imx/dcss/dcss-ctxld.c
new file mode 100644
index 00000000..4fe35b2b
--- /dev/null
+++ b/drivers/gpu/drm/imx/dcss/dcss-ctxld.c
@@ -0,0 +1,447 @@ 
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright 2019 NXP.
+ */
+
+#include <linux/delay.h>
+#include <linux/dma-mapping.h>
+#include <linux/interrupt.h>
+#include <linux/platform_device.h>
+
+#include "dcss-dev.h"
+
+#define DCSS_CTXLD_DEVNAME		"dcss_ctxld"
+
+#define DCSS_CTXLD_CONTROL_STATUS	0x0
+#define   CTXLD_ENABLE			BIT(0)
+#define   ARB_SEL			BIT(1)
+#define   RD_ERR_EN			BIT(2)
+#define   DB_COMP_EN			BIT(3)
+#define   SB_HP_COMP_EN			BIT(4)
+#define   SB_LP_COMP_EN			BIT(5)
+#define   DB_PEND_SB_REC_EN		BIT(6)
+#define   SB_PEND_DISP_ACTIVE_EN	BIT(7)
+#define   AHB_ERR_EN			BIT(8)
+#define   RD_ERR			BIT(16)
+#define   DB_COMP			BIT(17)
+#define   SB_HP_COMP			BIT(18)
+#define   SB_LP_COMP			BIT(19)
+#define   DB_PEND_SB_REC		BIT(20)
+#define   SB_PEND_DISP_ACTIVE		BIT(21)
+#define   AHB_ERR			BIT(22)
+#define DCSS_CTXLD_DB_BASE_ADDR		0x10
+#define DCSS_CTXLD_DB_COUNT		0x14
+#define DCSS_CTXLD_SB_BASE_ADDR		0x18
+#define DCSS_CTXLD_SB_COUNT		0x1C
+#define   SB_HP_COUNT_POS		0
+#define   SB_HP_COUNT_MASK		0xffff
+#define   SB_LP_COUNT_POS		16
+#define   SB_LP_COUNT_MASK		0xffff0000
+#define DCSS_AHB_ERR_ADDR		0x20
+
+#define CTXLD_IRQ_NAME			"ctx_ld"
+#define CTXLD_IRQ_COMPLETION		(DB_COMP | SB_HP_COMP | SB_LP_COMP)
+#define CTXLD_IRQ_ERROR			(RD_ERR | DB_PEND_SB_REC | AHB_ERR)
+
+/* The following sizes are in context loader entries, 8 bytes each. */
+#define CTXLD_DB_CTX_ENTRIES		1024	/* max 65536 */
+#define CTXLD_SB_LP_CTX_ENTRIES		10240	/* max 65536 */
+#define CTXLD_SB_HP_CTX_ENTRIES		20000	/* max 65536 */
+#define CTXLD_SB_CTX_ENTRIES		(CTXLD_SB_LP_CTX_ENTRIES + \
+					 CTXLD_SB_HP_CTX_ENTRIES)
+
+/* Sizes, in entries, of the DB, SB_HP and SB_LP context regions. */
+static u16 dcss_ctxld_ctx_size[3] = {
+	CTXLD_DB_CTX_ENTRIES,
+	CTXLD_SB_HP_CTX_ENTRIES,
+	CTXLD_SB_LP_CTX_ENTRIES
+};
+
+/* this represents an entry in the context loader map */
+struct dcss_ctxld_item {
+	u32 val;
+	u32 ofs;
+};
+
+#define CTX_ITEM_SIZE			sizeof(struct dcss_ctxld_item)
+
+struct dcss_ctxld {
+	struct device *dev;
+	void __iomem *ctxld_reg;
+	int irq;
+	bool irq_en;
+
+	struct dcss_ctxld_item *db[2];
+	struct dcss_ctxld_item *sb_hp[2];
+	struct dcss_ctxld_item *sb_lp[2];
+
+	dma_addr_t db_paddr[2];
+	dma_addr_t sb_paddr[2];
+
+	u16 ctx_size[2][3]; /* holds the sizes of DB, SB_HP and SB_LP ctx */
+	u8 current_ctx;
+
+	bool in_use;
+	bool armed;
+
+	spinlock_t lock; /* protects concurent access to private data */
+
+	void (*dtg_disable_cb)(void *data);
+	void *dtg_disable_data;
+};
+
+static int __dcss_ctxld_enable(struct dcss_ctxld *ctxld);
+
+static irqreturn_t dcss_ctxld_irq_handler(int irq, void *data)
+{
+	struct dcss_ctxld *ctxld = data;
+	u32 irq_status;
+
+	irq_status = dcss_readl(ctxld->ctxld_reg + DCSS_CTXLD_CONTROL_STATUS);
+
+	if (irq_status & CTXLD_IRQ_COMPLETION &&
+	    !(irq_status & CTXLD_ENABLE) && ctxld->in_use) {
+		ctxld->in_use = false;
+
+		if (ctxld->dtg_disable_cb) {
+			ctxld->dtg_disable_cb(ctxld->dtg_disable_data);
+			ctxld->dtg_disable_cb = NULL;
+			ctxld->dtg_disable_data = NULL;
+		}
+	} else if (irq_status & CTXLD_IRQ_ERROR) {
+		/*
+		 * Except for throwing an error message and clearing the status
+		 * register, there's not much we can do here.
+		 */
+		dev_err(ctxld->dev, "ctxld: error encountered: %08x\n",
+			irq_status);
+		dev_err(ctxld->dev, "ctxld: db=%d, sb_hp=%d, sb_lp=%d\n",
+			ctxld->ctx_size[ctxld->current_ctx ^ 1][CTX_DB],
+			ctxld->ctx_size[ctxld->current_ctx ^ 1][CTX_SB_HP],
+			ctxld->ctx_size[ctxld->current_ctx ^ 1][CTX_SB_LP]);
+	}
+
+	dcss_clr(irq_status & (CTXLD_IRQ_ERROR | CTXLD_IRQ_COMPLETION),
+		 ctxld->ctxld_reg + DCSS_CTXLD_CONTROL_STATUS);
+
+	return IRQ_HANDLED;
+}
+
+static int dcss_ctxld_irq_config(struct dcss_ctxld *ctxld,
+				 struct platform_device *pdev)
+{
+	int ret;
+
+	ctxld->irq = platform_get_irq_byname(pdev, CTXLD_IRQ_NAME);
+	if (ctxld->irq < 0) {
+		dev_err(ctxld->dev, "ctxld: can't get irq number\n");
+		return ctxld->irq;
+	}
+
+	ret = devm_request_irq(ctxld->dev, ctxld->irq,
+			       dcss_ctxld_irq_handler,
+			       IRQF_ONESHOT | IRQF_TRIGGER_HIGH,
+			       DCSS_CTXLD_DEVNAME, ctxld);
+	if (ret) {
+		dev_err(ctxld->dev, "ctxld: irq request failed.\n");
+		return ret;
+	}
+
+	ctxld->irq_en = true;
+
+	return 0;
+}
+
+void dcss_ctxld_hw_cfg(struct dcss_ctxld *ctxld)
+{
+	dcss_writel(RD_ERR_EN | SB_HP_COMP_EN |
+		    DB_PEND_SB_REC_EN | AHB_ERR_EN | RD_ERR | AHB_ERR,
+		    ctxld->ctxld_reg + DCSS_CTXLD_CONTROL_STATUS);
+}
+
+static void dcss_ctxld_free_ctx(struct dcss_ctxld *ctxld)
+{
+	struct dcss_ctxld_item *ctx;
+	int i;
+
+	for (i = 0; i < 2; i++) {
+		if (ctxld->db[i]) {
+			dmam_free_coherent(ctxld->dev,
+					   CTXLD_DB_CTX_ENTRIES * sizeof(*ctx),
+					   ctxld->db[i], ctxld->db_paddr[i]);
+			ctxld->db[i] = NULL;
+			ctxld->db_paddr[i] = 0;
+		}
+
+		if (ctxld->sb_hp[i]) {
+			dmam_free_coherent(ctxld->dev,
+					   CTXLD_SB_CTX_ENTRIES * sizeof(*ctx),
+					   ctxld->sb_hp[i], ctxld->sb_paddr[i]);
+			ctxld->sb_hp[i] = NULL;
+			ctxld->sb_paddr[i] = 0;
+		}
+	}
+}
+
+static int dcss_ctxld_alloc_ctx(struct dcss_ctxld *ctxld)
+{
+	struct dcss_ctxld_item *ctx;
+	int i;
+	dma_addr_t dma_handle;
+
+	for (i = 0; i < 2; i++) {
+		ctx = dmam_alloc_coherent(ctxld->dev,
+					  CTXLD_DB_CTX_ENTRIES * sizeof(*ctx),
+					  &dma_handle, GFP_KERNEL);
+		if (!ctx)
+			return -ENOMEM;
+
+		ctxld->db[i] = ctx;
+		ctxld->db_paddr[i] = dma_handle;
+
+		ctx = dmam_alloc_coherent(ctxld->dev,
+					  CTXLD_SB_CTX_ENTRIES * sizeof(*ctx),
+					  &dma_handle, GFP_KERNEL);
+		if (!ctx)
+			return -ENOMEM;
+
+		ctxld->sb_hp[i] = ctx;
+		ctxld->sb_lp[i] = ctx + CTXLD_SB_HP_CTX_ENTRIES;
+
+		ctxld->sb_paddr[i] = dma_handle;
+	}
+
+	return 0;
+}
+
+int dcss_ctxld_init(struct dcss_dev *dcss, unsigned long ctxld_base)
+{
+	struct dcss_ctxld *ctxld;
+	int ret;
+
+	ctxld = devm_kzalloc(dcss->dev, sizeof(struct dcss_ctxld),
+			     GFP_KERNEL);
+	if (!ctxld)
+		return -ENOMEM;
+
+	dcss->ctxld = ctxld;
+	ctxld->dev = dcss->dev;
+
+	spin_lock_init(&ctxld->lock);
+
+	ret = dcss_ctxld_alloc_ctx(ctxld);
+	if (ret) {
+		dev_err(dcss->dev, "ctxld: cannot allocate context memory.\n");
+		goto err;
+	}
+
+	ctxld->ctxld_reg = devm_ioremap(dcss->dev, ctxld_base, SZ_4K);
+	if (!ctxld->ctxld_reg) {
+		dev_err(dcss->dev, "ctxld: unable to remap ctxld base\n");
+		ret = -ENOMEM;
+		goto err;
+	}
+
+	ret = dcss_ctxld_irq_config(ctxld, to_platform_device(dcss->dev));
+	if (ret)
+		goto err_irq;
+
+	dcss_ctxld_hw_cfg(ctxld);
+
+	return 0;
+
+err_irq:
+	devm_iounmap(ctxld->dev, ctxld->ctxld_reg);
+
+err:
+	dcss_ctxld_free_ctx(ctxld);
+	devm_kfree(ctxld->dev, ctxld);
+
+	return ret;
+}
+
+void dcss_ctxld_exit(struct dcss_ctxld *ctxld)
+{
+	devm_free_irq(ctxld->dev, ctxld->irq, ctxld);
+
+	if (ctxld->ctxld_reg)
+		devm_iounmap(ctxld->dev, ctxld->ctxld_reg);
+
+	dcss_ctxld_free_ctx(ctxld);
+	devm_kfree(ctxld->dev, ctxld);
+}
+
+static int __dcss_ctxld_enable(struct dcss_ctxld *ctxld)
+{
+	int curr_ctx = ctxld->current_ctx;
+	u32 db_base, sb_base, sb_count;
+	u32 sb_hp_cnt, sb_lp_cnt, db_cnt;
+	struct dcss_dev *dcss = dcss_drv_dev_to_dcss(ctxld->dev);
+
+	dcss_dpr_write_sysctrl(dcss->dpr);
+
+	dcss_scaler_write_sclctrl(dcss->scaler);
+
+	sb_hp_cnt = ctxld->ctx_size[curr_ctx][CTX_SB_HP];
+	sb_lp_cnt = ctxld->ctx_size[curr_ctx][CTX_SB_LP];
+	db_cnt = ctxld->ctx_size[curr_ctx][CTX_DB];
+
+	/* make sure SB_LP context area comes after SB_HP */
+	if (sb_lp_cnt &&
+	    ctxld->sb_lp[curr_ctx] != ctxld->sb_hp[curr_ctx] + sb_hp_cnt) {
+		struct dcss_ctxld_item *sb_lp_adjusted;
+
+		sb_lp_adjusted = ctxld->sb_hp[curr_ctx] + sb_hp_cnt;
+
+		memcpy(sb_lp_adjusted, ctxld->sb_lp[curr_ctx],
+		       sb_lp_cnt * CTX_ITEM_SIZE);
+	}
+
+	db_base = db_cnt ? ctxld->db_paddr[curr_ctx] : 0;
+
+	dcss_writel(db_base, ctxld->ctxld_reg + DCSS_CTXLD_DB_BASE_ADDR);
+	dcss_writel(db_cnt, ctxld->ctxld_reg + DCSS_CTXLD_DB_COUNT);
+
+	if (sb_hp_cnt)
+		sb_count = ((sb_hp_cnt << SB_HP_COUNT_POS) & SB_HP_COUNT_MASK) |
+			   ((sb_lp_cnt << SB_LP_COUNT_POS) & SB_LP_COUNT_MASK);
+	else
+		sb_count = (sb_lp_cnt << SB_HP_COUNT_POS) & SB_HP_COUNT_MASK;
+
+	sb_base = sb_count ? ctxld->sb_paddr[curr_ctx] : 0;
+
+	dcss_writel(sb_base, ctxld->ctxld_reg + DCSS_CTXLD_SB_BASE_ADDR);
+	dcss_writel(sb_count, ctxld->ctxld_reg + DCSS_CTXLD_SB_COUNT);
+
+	/* enable the context loader */
+	dcss_set(CTXLD_ENABLE, ctxld->ctxld_reg + DCSS_CTXLD_CONTROL_STATUS);
+
+	ctxld->in_use = true;
+
+	/*
+	 * Toggle the current context to the alternate one so that any updates
+	 * in the modules' settings take place there.
+	 */
+	ctxld->current_ctx ^= 1;
+
+	ctxld->ctx_size[ctxld->current_ctx][CTX_DB] = 0;
+	ctxld->ctx_size[ctxld->current_ctx][CTX_SB_HP] = 0;
+	ctxld->ctx_size[ctxld->current_ctx][CTX_SB_LP] = 0;
+
+	return 0;
+}
+
+int dcss_ctxld_enable(struct dcss_ctxld *ctxld)
+{
+	unsigned long flags;
+
+	spin_lock_irqsave(&ctxld->lock, flags);
+	ctxld->armed = true;
+	spin_unlock_irqrestore(&ctxld->lock, flags);
+
+	return 0;
+}
+
+void dcss_ctxld_kick(struct dcss_ctxld *ctxld)
+{
+	unsigned long flags;
+
+	spin_lock_irqsave(&ctxld->lock, flags);
+	if (ctxld->armed && !ctxld->in_use) {
+		ctxld->armed = false;
+		__dcss_ctxld_enable(ctxld);
+	}
+	spin_unlock_irqrestore(&ctxld->lock, flags);
+}
+
+void dcss_ctxld_write_irqsafe(struct dcss_ctxld *ctxld, u32 ctx_id, u32 val,
+			      u32 reg_ofs)
+{
+	int curr_ctx = ctxld->current_ctx;
+	struct dcss_ctxld_item *ctx[] = {
+		[CTX_DB] = ctxld->db[curr_ctx],
+		[CTX_SB_HP] = ctxld->sb_hp[curr_ctx],
+		[CTX_SB_LP] = ctxld->sb_lp[curr_ctx]
+	};
+	int item_idx = ctxld->ctx_size[curr_ctx][ctx_id];
+
+	if (item_idx + 1 > dcss_ctxld_ctx_size[ctx_id]) {
+		WARN_ON(1);
+		return;
+	}
+
+	ctx[ctx_id][item_idx].val = val;
+	ctx[ctx_id][item_idx].ofs = reg_ofs;
+	ctxld->ctx_size[curr_ctx][ctx_id] += 1;
+}
+
+void dcss_ctxld_write(struct dcss_ctxld *ctxld, u32 ctx_id,
+		      u32 val, u32 reg_ofs)
+{
+	unsigned long flags;
+
+	spin_lock_irqsave(&ctxld->lock, flags);
+	dcss_ctxld_write_irqsafe(ctxld, ctx_id, val, reg_ofs);
+	spin_unlock_irqrestore(&ctxld->lock, flags);
+}
+
+bool dcss_ctxld_is_flushed(struct dcss_ctxld *ctxld)
+{
+	return ctxld->ctx_size[ctxld->current_ctx][CTX_DB] == 0 &&
+		ctxld->ctx_size[ctxld->current_ctx][CTX_SB_HP] == 0 &&
+		ctxld->ctx_size[ctxld->current_ctx][CTX_SB_LP] == 0;
+}
+
+int dcss_ctxld_resume(struct dcss_ctxld *ctxld)
+{
+	dcss_ctxld_hw_cfg(ctxld);
+
+	if (!ctxld->irq_en) {
+		enable_irq(ctxld->irq);
+		ctxld->irq_en = true;
+	}
+
+	return 0;
+}
+
+int dcss_ctxld_suspend(struct dcss_ctxld *ctxld)
+{
+	int ret = 0;
+	int wait_time_ms = 0;
+	unsigned long flags;
+
+	dcss_ctxld_kick(ctxld);
+
+	while (ctxld->in_use && wait_time_ms < 500) {
+		msleep(20);
+		wait_time_ms += 20;
+	}
+
+	if (wait_time_ms > 500)
+		return -ETIMEDOUT;
+
+	spin_lock_irqsave(&ctxld->lock, flags);
+
+	if (ctxld->irq_en) {
+		disable_irq_nosync(ctxld->irq);
+		ctxld->irq_en = false;
+	}
+
+	/* reset context region and sizes */
+	ctxld->current_ctx = 0;
+	ctxld->ctx_size[0][CTX_DB] = 0;
+	ctxld->ctx_size[0][CTX_SB_HP] = 0;
+	ctxld->ctx_size[0][CTX_SB_LP] = 0;
+
+	spin_unlock_irqrestore(&ctxld->lock, flags);
+
+	return ret;
+}
+
+void dcss_ctxld_register_dtg_disable_cb(struct dcss_ctxld *ctxld,
+					void (*cb)(void *),
+					void *data)
+{
+	ctxld->dtg_disable_cb = cb;
+	ctxld->dtg_disable_data = data;
+}
diff --git a/drivers/gpu/drm/imx/dcss/dcss-dev.c b/drivers/gpu/drm/imx/dcss/dcss-dev.c
new file mode 100644
index 00000000..265bf3c
--- /dev/null
+++ b/drivers/gpu/drm/imx/dcss/dcss-dev.c
@@ -0,0 +1,286 @@ 
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright 2019 NXP.
+ */
+
+#include <linux/clk.h>
+#include <linux/of_device.h>
+#include <linux/of_graph.h>
+#include <linux/pm_runtime.h>
+#include <drm/drm_modeset_helper.h>
+
+#include "dcss-dev.h"
+
+static void dcss_clocks_enable(struct dcss_dev *dcss)
+{
+	if (dcss->clks_on)
+		return;
+
+	clk_prepare_enable(dcss->axi_clk);
+	clk_prepare_enable(dcss->apb_clk);
+	clk_prepare_enable(dcss->rtrm_clk);
+	clk_prepare_enable(dcss->dtrc_clk);
+	clk_prepare_enable(dcss->pix_clk);
+
+	dcss->clks_on = true;
+}
+
+static void dcss_clocks_disable(struct dcss_dev *dcss)
+{
+	if (!dcss->clks_on)
+		return;
+
+	clk_disable_unprepare(dcss->pix_clk);
+	clk_disable_unprepare(dcss->dtrc_clk);
+	clk_disable_unprepare(dcss->rtrm_clk);
+	clk_disable_unprepare(dcss->apb_clk);
+	clk_disable_unprepare(dcss->axi_clk);
+
+	dcss->clks_on = false;
+}
+
+static int dcss_submodules_init(struct dcss_dev *dcss)
+{
+	int ret = 0;
+	u32 base_addr = dcss->start_addr;
+	const struct dcss_type_data *devtype = dcss->devtype;
+
+	dcss_clocks_enable(dcss);
+
+	ret = dcss_blkctl_init(dcss, base_addr + devtype->blkctl_ofs);
+	if (ret)
+		return ret;
+
+	ret = dcss_ctxld_init(dcss, base_addr + devtype->ctxld_ofs);
+	if (ret)
+		goto ctxld_err;
+
+	ret = dcss_dtg_init(dcss, base_addr + devtype->dtg_ofs);
+	if (ret)
+		goto dtg_err;
+
+	ret = dcss_ss_init(dcss, base_addr + devtype->ss_ofs);
+	if (ret)
+		goto ss_err;
+
+	ret = dcss_dpr_init(dcss, base_addr + devtype->dpr_ofs);
+	if (ret)
+		goto dpr_err;
+
+	ret = dcss_scaler_init(dcss, base_addr + devtype->scaler_ofs);
+	if (ret)
+		goto scaler_err;
+
+	return 0;
+
+scaler_err:
+	dcss_dpr_exit(dcss->dpr);
+
+dpr_err:
+	dcss_ss_exit(dcss->ss);
+
+ss_err:
+	dcss_dtg_exit(dcss->dtg);
+
+dtg_err:
+	dcss_ctxld_exit(dcss->ctxld);
+
+ctxld_err:
+	dcss_blkctl_exit(dcss->blkctl);
+
+	dcss_clocks_disable(dcss);
+
+	return ret;
+}
+
+static void dcss_submodules_stop(struct dcss_dev *dcss)
+{
+	dcss_clocks_enable(dcss);
+	dcss_scaler_exit(dcss->scaler);
+	dcss_dpr_exit(dcss->dpr);
+	dcss_ss_exit(dcss->ss);
+	dcss_dtg_exit(dcss->dtg);
+	dcss_ctxld_exit(dcss->ctxld);
+	dcss_blkctl_exit(dcss->blkctl);
+	dcss_clocks_disable(dcss);
+}
+
+static int dcss_clks_init(struct dcss_dev *dcss)
+{
+	int i;
+	struct {
+		const char *id;
+		struct clk **clk;
+	} clks[] = {
+		{"apb",   &dcss->apb_clk},
+		{"axi",   &dcss->axi_clk},
+		{"pix",   &dcss->pix_clk},
+		{"rtrm",  &dcss->rtrm_clk},
+		{"dtrc",  &dcss->dtrc_clk},
+	};
+
+	for (i = 0; i < ARRAY_SIZE(clks); i++) {
+		*clks[i].clk = devm_clk_get(dcss->dev, clks[i].id);
+		if (IS_ERR(*clks[i].clk)) {
+			dev_err(dcss->dev, "failed to get %s clock\n",
+				clks[i].id);
+			return PTR_ERR(*clks[i].clk);
+		}
+	}
+
+	dcss->clks_on = false;
+
+	return 0;
+}
+
+static void dcss_clks_release(struct dcss_dev *dcss)
+{
+	devm_clk_put(dcss->dev, dcss->dtrc_clk);
+	devm_clk_put(dcss->dev, dcss->rtrm_clk);
+	devm_clk_put(dcss->dev, dcss->pix_clk);
+	devm_clk_put(dcss->dev, dcss->axi_clk);
+	devm_clk_put(dcss->dev, dcss->apb_clk);
+}
+
+struct dcss_dev *dcss_dev_create(struct device *dev, bool hdmi_output)
+{
+	struct platform_device *pdev = to_platform_device(dev);
+	int ret;
+	struct resource *res;
+	struct dcss_dev *dcss;
+	const struct dcss_type_data *devtype;
+
+	devtype = of_device_get_match_data(dev);
+	if (!devtype) {
+		dev_err(dev, "no device match found\n");
+		return ERR_PTR(-ENODEV);
+	}
+
+	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+	if (!res) {
+		dev_err(dev, "cannot get memory resource\n");
+		return ERR_PTR(-EINVAL);
+	}
+
+	dcss = devm_kzalloc(dev, sizeof(struct dcss_dev), GFP_KERNEL);
+	if (!dcss)
+		return ERR_PTR(-ENOMEM);
+
+	dcss->dev = dev;
+	dcss->devtype = devtype;
+	dcss->hdmi_output = hdmi_output;
+
+	ret = dcss_clks_init(dcss);
+	if (ret) {
+		dev_err(dev, "clocks initialization failed\n");
+		goto err;
+	}
+
+	dcss->of_port = of_graph_get_port_by_id(dev->of_node, 0);
+	if (!dcss->of_port) {
+		dev_err(dev, "no port@0 node in %s\n", dev->of_node->full_name);
+		ret = -ENODEV;
+		goto clks_err;
+	}
+
+	dcss->start_addr = res->start;
+
+	ret = dcss_submodules_init(dcss);
+	if (ret) {
+		dev_err(dev, "submodules initialization failed\n");
+		goto clks_err;
+	}
+
+	pm_runtime_enable(dev);
+
+	return dcss;
+
+clks_err:
+	dcss_clks_release(dcss);
+
+err:
+	devm_kfree(dcss->dev, dcss);
+
+	return ERR_PTR(ret);
+}
+
+void dcss_dev_destroy(struct dcss_dev *dcss)
+{
+	pm_runtime_disable(dcss->dev);
+
+	dcss_submodules_stop(dcss);
+
+	dcss_clks_release(dcss);
+
+	devm_kfree(dcss->dev, dcss);
+}
+
+#ifdef CONFIG_PM_SLEEP
+int dcss_dev_suspend(struct device *dev)
+{
+	struct dcss_dev *dcss = dcss_drv_dev_to_dcss(dev);
+	int ret;
+
+	drm_mode_config_helper_suspend(dcss_drv_dev_to_drm(dev));
+
+	if (pm_runtime_suspended(dev))
+		return 0;
+
+	ret = dcss_ctxld_suspend(dcss->ctxld);
+	if (ret)
+		return ret;
+
+	dcss_clocks_disable(dcss);
+
+	return 0;
+}
+
+int dcss_dev_resume(struct device *dev)
+{
+	struct dcss_dev *dcss = dcss_drv_dev_to_dcss(dev);
+
+	if (pm_runtime_suspended(dev)) {
+		drm_mode_config_helper_resume(dcss_drv_dev_to_drm(dev));
+		return 0;
+	}
+
+	dcss_clocks_enable(dcss);
+
+	dcss_blkctl_cfg(dcss->blkctl);
+
+	dcss_ctxld_resume(dcss->ctxld);
+
+	drm_mode_config_helper_resume(dcss_drv_dev_to_drm(dev));
+
+	return 0;
+}
+#endif /* CONFIG_PM_SLEEP */
+
+#ifdef CONFIG_PM
+int dcss_dev_runtime_suspend(struct device *dev)
+{
+	struct dcss_dev *dcss = dcss_drv_dev_to_dcss(dev);
+	int ret;
+
+	ret = dcss_ctxld_suspend(dcss->ctxld);
+	if (ret)
+		return ret;
+
+	dcss_clocks_disable(dcss);
+
+	return 0;
+}
+
+int dcss_dev_runtime_resume(struct device *dev)
+{
+	struct dcss_dev *dcss = dcss_drv_dev_to_dcss(dev);
+
+	dcss_clocks_enable(dcss);
+
+	dcss_blkctl_cfg(dcss->blkctl);
+
+	dcss_ctxld_resume(dcss->ctxld);
+
+	return 0;
+}
+#endif /* CONFIG_PM */
diff --git a/drivers/gpu/drm/imx/dcss/dcss-dev.h b/drivers/gpu/drm/imx/dcss/dcss-dev.h
new file mode 100644
index 00000000..15c5de3
--- /dev/null
+++ b/drivers/gpu/drm/imx/dcss/dcss-dev.h
@@ -0,0 +1,195 @@ 
+/* SPDX-License-Identifier: GPL-2.0 */
+/*
+ * Copyright 2019 NXP.
+ */
+
+#ifndef __DCSS_PRV_H__
+#define __DCSS_PRV_H__
+
+#include <drm/drm_fourcc.h>
+#include <linux/io.h>
+#include <video/videomode.h>
+
+#define SET			0x04
+#define CLR			0x08
+#define TGL			0x0C
+
+#define dcss_writel(v, c)	writel((v), (c))
+#define dcss_readl(c)		readl(c)
+#define dcss_set(v, c)		writel((v), (c) + SET)
+#define dcss_clr(v, c)		writel((v), (c) + CLR)
+#define dcss_toggle(v, c)	writel((v), (c) + TGL)
+
+static inline void dcss_update(u32 v, u32 m, void __iomem *c)
+{
+	writel((readl(c) & ~(m)) | (v), (c));
+}
+
+#define DCSS_DBG_REG(reg)	{.name = #reg, .ofs = reg}
+
+enum {
+	DCSS_IMX8MQ = 0,
+};
+
+struct dcss_type_data {
+	const char *name;
+	u32 blkctl_ofs;
+	u32 ctxld_ofs;
+	u32 rdsrc_ofs;
+	u32 wrscl_ofs;
+	u32 dtg_ofs;
+	u32 scaler_ofs;
+	u32 ss_ofs;
+	u32 dpr_ofs;
+	u32 dtrc_ofs;
+	u32 dec400d_ofs;
+	u32 hdr10_ofs;
+};
+
+struct dcss_debug_reg {
+	char *name;
+	u32 ofs;
+};
+
+enum dcss_ctxld_ctx_type {
+	CTX_DB,
+	CTX_SB_HP, /* high-priority */
+	CTX_SB_LP, /* low-priority  */
+};
+
+struct dcss_dev {
+	struct device *dev;
+	const struct dcss_type_data *devtype;
+	struct device_node *of_port;
+
+	u32 start_addr;
+
+	struct dcss_blkctl *blkctl;
+	struct dcss_ctxld *ctxld;
+	struct dcss_dpr *dpr;
+	struct dcss_dtg *dtg;
+	struct dcss_ss *ss;
+	struct dcss_hdr10 *hdr10;
+	struct dcss_scaler *scaler;
+	struct dcss_dtrc *dtrc;
+	struct dcss_dec400d *dec400d;
+	struct dcss_wrscl *wrscl;
+	struct dcss_rdsrc *rdsrc;
+
+	struct clk *apb_clk;
+	struct clk *axi_clk;
+	struct clk *pix_clk;
+	struct clk *rtrm_clk;
+	struct clk *dtrc_clk;
+	struct clk *pll_src_clk;
+	struct clk *pll_phy_ref_clk;
+
+	void (*dcss_disable_callback)(void *data);
+
+	bool clks_on;
+	bool hdmi_output;
+};
+
+enum dcss_color_space {
+	DCSS_COLORSPACE_RGB,
+	DCSS_COLORSPACE_YUV,
+	DCSS_COLORSPACE_UNKNOWN,
+};
+
+struct dcss_dev *dcss_drv_dev_to_dcss(struct device *dev);
+struct drm_device *dcss_drv_dev_to_drm(struct device *dev);
+struct dcss_dev *dcss_dev_create(struct device *dev, bool mipi_output);
+void dcss_dev_destroy(struct dcss_dev *dcss);
+int dcss_dev_runtime_suspend(struct device *dev);
+int dcss_dev_runtime_resume(struct device *dev);
+int dcss_dev_suspend(struct device *dev);
+int dcss_dev_resume(struct device *dev);
+
+/* BLKCTL */
+int dcss_blkctl_init(struct dcss_dev *dcss, unsigned long blkctl_base);
+void dcss_blkctl_cfg(struct dcss_blkctl *blkctl);
+void dcss_blkctl_exit(struct dcss_blkctl *blkctl);
+
+/* CTXLD */
+int dcss_ctxld_init(struct dcss_dev *dcss, unsigned long ctxld_base);
+void dcss_ctxld_exit(struct dcss_ctxld *ctxld);
+void dcss_ctxld_write(struct dcss_ctxld *ctxld, u32 ctx_id,
+		      u32 val, u32 reg_idx);
+int dcss_ctxld_resume(struct dcss_ctxld *dcss_ctxld);
+int dcss_ctxld_suspend(struct dcss_ctxld *dcss_ctxld);
+void dcss_ctxld_write_irqsafe(struct dcss_ctxld *ctlxd, u32 ctx_id, u32 val,
+			      u32 reg_ofs);
+void dcss_ctxld_kick(struct dcss_ctxld *ctxld);
+bool dcss_ctxld_is_flushed(struct dcss_ctxld *ctxld);
+int dcss_ctxld_enable(struct dcss_ctxld *ctxld);
+void dcss_ctxld_register_dtg_disable_cb(struct dcss_ctxld *ctxld,
+					void (*cb)(void *),
+					void *data);
+
+/* DPR */
+enum dcss_tile_type {
+	TILE_LINEAR = 0,
+	TILE_GPU_STANDARD,
+	TILE_GPU_SUPER,
+	TILE_VPU_YUV420,
+	TILE_VPU_VP9,
+};
+
+enum dcss_pix_size {
+	PIX_SIZE_8,
+	PIX_SIZE_16,
+	PIX_SIZE_32,
+};
+
+int dcss_dpr_init(struct dcss_dev *dcss, unsigned long dpr_base);
+void dcss_dpr_exit(struct dcss_dpr *dpr);
+void dcss_dpr_write_sysctrl(struct dcss_dpr *dpr);
+void dcss_dpr_set_res(struct dcss_dpr *dpr, int ch_num, u32 xres, u32 yres);
+void dcss_dpr_addr_set(struct dcss_dpr *dpr, int ch_num, u32 luma_base_addr,
+		       u32 chroma_base_addr, u16 pitch);
+void dcss_dpr_enable(struct dcss_dpr *dpr, int ch_num, bool en);
+void dcss_dpr_format_set(struct dcss_dpr *dpr, int ch_num,
+			 const struct drm_format_info *format, u64 modifier);
+void dcss_dpr_set_rotation(struct dcss_dpr *dpr, int ch_num, u32 rotation);
+
+/* DTG */
+int dcss_dtg_init(struct dcss_dev *dcss, unsigned long dtg_base);
+void dcss_dtg_exit(struct dcss_dtg *dtg);
+bool dcss_dtg_vblank_irq_valid(struct dcss_dtg *dtg);
+void dcss_dtg_vblank_irq_enable(struct dcss_dtg *dtg, bool en);
+void dcss_dtg_vblank_irq_clear(struct dcss_dtg *dtg);
+void dcss_dtg_sync_set(struct dcss_dtg *dtg, struct videomode *vm);
+void dcss_dtg_css_set(struct dcss_dtg *dtg);
+void dcss_dtg_enable(struct dcss_dtg *dtg, bool en,
+		     struct completion *dis_completion);
+bool dcss_dtg_is_enabled(struct dcss_dtg *dtg);
+void dcss_dtg_ctxld_kick_irq_enable(struct dcss_dtg *dtg, bool en);
+bool dcss_dtg_global_alpha_changed(struct dcss_dtg *dtg, int ch_num, int alpha);
+void dcss_dtg_plane_alpha_set(struct dcss_dtg *dtg, int ch_num,
+			      const struct drm_format_info *format, int alpha);
+void dcss_dtg_plane_pos_set(struct dcss_dtg *dtg, int ch_num,
+			    int px, int py, int pw, int ph);
+void dcss_dtg_ch_enable(struct dcss_dtg *dtg, int ch_num, bool en);
+
+/* SUBSAM */
+int dcss_ss_init(struct dcss_dev *dcss, unsigned long subsam_base);
+void dcss_ss_exit(struct dcss_ss *ss);
+void dcss_ss_enable(struct dcss_ss *ss);
+void dcss_ss_disable(struct dcss_ss *ss);
+void dcss_ss_subsam_set(struct dcss_ss *ss);
+void dcss_ss_sync_set(struct dcss_ss *ss, struct videomode *vm,
+		      bool phsync, bool pvsync);
+
+/* SCALER */
+int dcss_scaler_init(struct dcss_dev *dcss, unsigned long scaler_base);
+void dcss_scaler_exit(struct dcss_scaler *scl);
+void dcss_scaler_setup(struct dcss_scaler *scl, int ch_num,
+		       const struct drm_format_info *format,
+		       int src_xres, int src_yres, int dst_xres, int dst_yres,
+		       u32 vrefresh_hz);
+void dcss_scaler_ch_enable(struct dcss_scaler *scl, int ch_num, bool en);
+int dcss_scaler_get_min_max_ratios(struct dcss_scaler *scl, int ch_num,
+				   int *min, int *max);
+void dcss_scaler_write_sclctrl(struct dcss_scaler *scl);
+
+#endif /* __DCSS_PRV_H__ */
diff --git a/drivers/gpu/drm/imx/dcss/dcss-dpr.c b/drivers/gpu/drm/imx/dcss/dcss-dpr.c
new file mode 100644
index 00000000..dbc7169
--- /dev/null
+++ b/drivers/gpu/drm/imx/dcss/dcss-dpr.c
@@ -0,0 +1,552 @@ 
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright 2019 NXP.
+ */
+
+#include <linux/device.h>
+
+#include "dcss-dev.h"
+
+#define DCSS_DPR_SYSTEM_CTRL0			0x000
+#define   RUN_EN				BIT(0)
+#define   SOFT_RESET				BIT(1)
+#define   REPEAT_EN				BIT(2)
+#define   SHADOW_LOAD_EN			BIT(3)
+#define   SW_SHADOW_LOAD_SEL			BIT(4)
+#define   BCMD2AXI_MSTR_ID_CTRL			BIT(16)
+#define DCSS_DPR_IRQ_MASK			0x020
+#define DCSS_DPR_IRQ_MASK_STATUS		0x030
+#define DCSS_DPR_IRQ_NONMASK_STATUS		0x040
+#define   IRQ_DPR_CTRL_DONE			BIT(0)
+#define   IRQ_DPR_RUN				BIT(1)
+#define   IRQ_DPR_SHADOW_LOADED			BIT(2)
+#define   IRQ_AXI_READ_ERR			BIT(3)
+#define   DPR2RTR_YRGB_FIFO_OVFL		BIT(4)
+#define   DPR2RTR_UV_FIFO_OVFL			BIT(5)
+#define   DPR2RTR_FIFO_LD_BUF_RDY_YRGB_ERR	BIT(6)
+#define   DPR2RTR_FIFO_LD_BUF_RDY_UV_ERR	BIT(7)
+#define DCSS_DPR_MODE_CTRL0			0x050
+#define   RTR_3BUF_EN				BIT(0)
+#define   RTR_4LINE_BUF_EN			BIT(1)
+#define   TILE_TYPE_POS				2
+#define   TILE_TYPE_MASK			GENMASK(4, 2)
+#define   YUV_EN				BIT(6)
+#define   COMP_2PLANE_EN			BIT(7)
+#define   PIX_SIZE_POS				8
+#define   PIX_SIZE_MASK				GENMASK(9, 8)
+#define   PIX_LUMA_UV_SWAP			BIT(10)
+#define   PIX_UV_SWAP				BIT(11)
+#define   B_COMP_SEL_POS			12
+#define   B_COMP_SEL_MASK			GENMASK(13, 12)
+#define   G_COMP_SEL_POS			14
+#define   G_COMP_SEL_MASK			GENMASK(15, 14)
+#define   R_COMP_SEL_POS			16
+#define   R_COMP_SEL_MASK			GENMASK(17, 16)
+#define   A_COMP_SEL_POS			18
+#define   A_COMP_SEL_MASK			GENMASK(19, 18)
+#define DCSS_DPR_FRAME_CTRL0			0x070
+#define   HFLIP_EN				BIT(0)
+#define   VFLIP_EN				BIT(1)
+#define   ROT_ENC_POS				2
+#define   ROT_ENC_MASK				GENMASK(3, 2)
+#define   ROT_FLIP_ORDER_EN			BIT(4)
+#define   PITCH_POS				16
+#define   PITCH_MASK				GENMASK(31, 16)
+#define DCSS_DPR_FRAME_1P_CTRL0			0x090
+#define DCSS_DPR_FRAME_1P_PIX_X_CTRL		0x0A0
+#define DCSS_DPR_FRAME_1P_PIX_Y_CTRL		0x0B0
+#define DCSS_DPR_FRAME_1P_BASE_ADDR		0x0C0
+#define DCSS_DPR_FRAME_2P_CTRL0			0x0E0
+#define DCSS_DPR_FRAME_2P_PIX_X_CTRL		0x0F0
+#define DCSS_DPR_FRAME_2P_PIX_Y_CTRL		0x100
+#define DCSS_DPR_FRAME_2P_BASE_ADDR		0x110
+#define DCSS_DPR_STATUS_CTRL0			0x130
+#define   STATUS_MUX_SEL_MASK			GENMASK(2, 0)
+#define   STATUS_SRC_SEL_POS			16
+#define   STATUS_SRC_SEL_MASK			GENMASK(18, 16)
+#define DCSS_DPR_STATUS_CTRL1			0x140
+#define DCSS_DPR_RTRAM_CTRL0			0x200
+#define   NUM_ROWS_ACTIVE			BIT(0)
+#define   THRES_HIGH_POS			1
+#define   THRES_HIGH_MASK			GENMASK(3, 1)
+#define   THRES_LOW_POS				4
+#define   THRES_LOW_MASK			GENMASK(6, 4)
+#define   ABORT_SEL				BIT(7)
+
+struct dcss_dpr_ch {
+	struct dcss_dpr *dpr;
+	void __iomem *base_reg;
+	u32 base_ofs;
+
+	struct drm_format_info format;
+	enum dcss_pix_size pix_size;
+	enum dcss_tile_type tile;
+	bool rtram_4line_en;
+	bool rtram_3buf_en;
+
+	u32 frame_ctrl;
+	u32 mode_ctrl;
+	u32 sys_ctrl;
+	u32 rtram_ctrl;
+
+	bool sys_ctrl_chgd;
+
+	u32 pitch;
+
+	int ch_num;
+	int irq;
+};
+
+struct dcss_dpr {
+	struct device *dev;
+	struct dcss_ctxld *ctxld;
+	u32  ctx_id;
+
+	struct dcss_dpr_ch ch[3];
+};
+
+static void dcss_dpr_write(struct dcss_dpr_ch *ch, u32 val, u32 ofs)
+{
+	struct dcss_dpr *dpr = ch->dpr;
+
+	dcss_ctxld_write(dpr->ctxld, dpr->ctx_id, val, ch->base_ofs + ofs);
+}
+
+static int dcss_dpr_ch_init_all(struct dcss_dpr *dpr, unsigned long dpr_base)
+{
+	struct dcss_dpr_ch *ch;
+	int i;
+
+	for (i = 0; i < 3; i++) {
+		ch = &dpr->ch[i];
+
+		ch->base_ofs = dpr_base + i * 0x1000;
+
+		ch->base_reg = devm_ioremap(dpr->dev, ch->base_ofs, SZ_4K);
+		if (!ch->base_reg) {
+			dev_err(dpr->dev, "dpr: unable to remap ch %d base\n",
+				i);
+			return -ENOMEM;
+		}
+
+		ch->dpr = dpr;
+		ch->ch_num = i;
+	}
+
+	return 0;
+}
+
+int dcss_dpr_init(struct dcss_dev *dcss, unsigned long dpr_base)
+{
+	struct dcss_dpr *dpr;
+
+	dpr = devm_kzalloc(dcss->dev, sizeof(struct dcss_dpr), GFP_KERNEL);
+	if (!dpr)
+		return -ENOMEM;
+
+	dcss->dpr = dpr;
+	dpr->dev = dcss->dev;
+	dpr->ctxld = dcss->ctxld;
+	dpr->ctx_id = CTX_SB_HP;
+
+	if (dcss_dpr_ch_init_all(dpr, dpr_base)) {
+		int i;
+
+		for (i = 0; i < 3; i++) {
+			if (dpr->ch[i].base_reg)
+				devm_iounmap(dpr->dev, dpr->ch[i].base_reg);
+		}
+
+		devm_kfree(dpr->dev, dpr);
+
+		return -ENOMEM;
+	}
+
+	return 0;
+}
+
+void dcss_dpr_exit(struct dcss_dpr *dpr)
+{
+	int ch_no;
+
+	/* stop DPR on all channels */
+	for (ch_no = 0; ch_no < 3; ch_no++) {
+		struct dcss_dpr_ch *ch = &dpr->ch[ch_no];
+
+		dcss_writel(0, ch->base_reg + DCSS_DPR_SYSTEM_CTRL0);
+
+		if (ch->base_reg)
+			devm_iounmap(dpr->dev, ch->base_reg);
+	}
+
+	devm_kfree(dpr->dev, dpr);
+}
+
+static u32 dcss_dpr_x_pix_wide_adjust(struct dcss_dpr_ch *ch, u32 pix_wide,
+				      u32 pix_format)
+{
+	u8 pix_in_64byte_map[3][5] = {
+		/* LIN, GPU_STD, GPU_SUP, VPU_YUV420, VPU_VP9 */
+		{   64,       8,       8,          8,     16}, /* PIX_SIZE_8  */
+		{   32,       8,       8,          8,      8}, /* PIX_SIZE_16 */
+		{   16,       4,       4,          8,      8}, /* PIX_SIZE_32 */
+	};
+	u32 offset;
+	u32 div_64byte_mod, pix_in_64byte;
+
+	pix_in_64byte = pix_in_64byte_map[ch->pix_size][ch->tile];
+
+	if (pix_format == DRM_FORMAT_P010)
+		pix_wide = pix_wide * 10 / 8;
+
+	div_64byte_mod = pix_wide % pix_in_64byte;
+	offset = (div_64byte_mod == 0) ? 0 : (pix_in_64byte - div_64byte_mod);
+
+	return pix_wide + offset;
+}
+
+static u32 dcss_dpr_y_pix_high_adjust(struct dcss_dpr_ch *ch, u32 pix_high,
+				      u32 pix_format)
+{
+	u8 num_rows_buf = ch->rtram_4line_en ? 4 : 8;
+	u32 offset, pix_y_mod;
+
+	pix_y_mod = pix_high % num_rows_buf;
+	offset = pix_y_mod ? (num_rows_buf - pix_y_mod) : 0;
+
+	return pix_high + offset;
+}
+
+void dcss_dpr_set_res(struct dcss_dpr *dpr, int ch_num, u32 xres, u32 yres)
+{
+	struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
+	u32 pix_format = ch->format.format;
+	u32 gap = DCSS_DPR_FRAME_2P_BASE_ADDR - DCSS_DPR_FRAME_1P_BASE_ADDR;
+	int plane, max_planes = 1;
+	u32 pix_x_wide, pix_y_high;
+
+	if (pix_format == DRM_FORMAT_NV12 ||
+	    pix_format == DRM_FORMAT_NV21)
+		max_planes = 2;
+
+	for (plane = 0; plane < max_planes; plane++) {
+		yres = plane == 1 ? yres >> 1 : yres;
+
+		pix_x_wide = dcss_dpr_x_pix_wide_adjust(ch, xres, pix_format);
+		pix_y_high = dcss_dpr_y_pix_high_adjust(ch, yres, pix_format);
+
+		if (plane == 0)
+			ch->pitch = pix_x_wide;
+
+		dcss_dpr_write(ch, pix_x_wide,
+			       DCSS_DPR_FRAME_1P_PIX_X_CTRL + plane * gap);
+		dcss_dpr_write(ch, pix_y_high,
+			       DCSS_DPR_FRAME_1P_PIX_Y_CTRL + plane * gap);
+
+		dcss_dpr_write(ch, 2, DCSS_DPR_FRAME_1P_CTRL0 + plane * gap);
+	}
+}
+
+void dcss_dpr_addr_set(struct dcss_dpr *dpr, int ch_num, u32 luma_base_addr,
+		       u32 chroma_base_addr, u16 pitch)
+{
+	struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
+
+	dcss_dpr_write(ch, luma_base_addr, DCSS_DPR_FRAME_1P_BASE_ADDR);
+
+	dcss_dpr_write(ch, chroma_base_addr, DCSS_DPR_FRAME_2P_BASE_ADDR);
+
+	ch->frame_ctrl &= ~PITCH_MASK;
+	ch->frame_ctrl |= (((u32)pitch << PITCH_POS) & PITCH_MASK);
+}
+
+static void dcss_dpr_argb_comp_sel(struct dcss_dpr_ch *ch, int a_sel, int r_sel,
+				   int g_sel, int b_sel)
+{
+	u32 sel;
+
+	sel = ((a_sel << A_COMP_SEL_POS) & A_COMP_SEL_MASK) |
+	      ((r_sel << R_COMP_SEL_POS) & R_COMP_SEL_MASK) |
+	      ((g_sel << G_COMP_SEL_POS) & G_COMP_SEL_MASK) |
+	      ((b_sel << B_COMP_SEL_POS) & B_COMP_SEL_MASK);
+
+	ch->mode_ctrl &= ~(A_COMP_SEL_MASK | R_COMP_SEL_MASK |
+			   G_COMP_SEL_MASK | B_COMP_SEL_MASK);
+	ch->mode_ctrl |= sel;
+}
+
+static void dcss_dpr_pix_size_set(struct dcss_dpr_ch *ch,
+				  const struct drm_format_info *format)
+{
+	u32 val;
+
+	switch (format->format) {
+	case DRM_FORMAT_NV12:
+	case DRM_FORMAT_NV21:
+		val = 0;
+		break;
+
+	case DRM_FORMAT_UYVY:
+	case DRM_FORMAT_VYUY:
+	case DRM_FORMAT_YUYV:
+	case DRM_FORMAT_YVYU:
+		val = 1;
+		break;
+
+	default:
+		val = 2;
+		break;
+	}
+
+	ch->pix_size = val;
+
+	ch->mode_ctrl &= ~PIX_SIZE_MASK;
+	ch->mode_ctrl |= ((val << PIX_SIZE_POS) & PIX_SIZE_MASK);
+}
+
+static void dcss_dpr_uv_swap(struct dcss_dpr_ch *ch, bool swap)
+{
+	ch->mode_ctrl &= ~PIX_UV_SWAP;
+	ch->mode_ctrl |= (swap ? PIX_UV_SWAP : 0);
+}
+
+static void dcss_dpr_y_uv_swap(struct dcss_dpr_ch *ch, bool swap)
+{
+	ch->mode_ctrl &= ~PIX_LUMA_UV_SWAP;
+	ch->mode_ctrl |= (swap ? PIX_LUMA_UV_SWAP : 0);
+}
+
+static void dcss_dpr_2plane_en(struct dcss_dpr_ch *ch, bool en)
+{
+	ch->mode_ctrl &= ~COMP_2PLANE_EN;
+	ch->mode_ctrl |= (en ? COMP_2PLANE_EN : 0);
+}
+
+static void dcss_dpr_yuv_en(struct dcss_dpr_ch *ch, bool en)
+{
+	ch->mode_ctrl &= ~YUV_EN;
+	ch->mode_ctrl |= (en ? YUV_EN : 0);
+}
+
+void dcss_dpr_enable(struct dcss_dpr *dpr, int ch_num, bool en)
+{
+	struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
+	u32 sys_ctrl;
+
+	sys_ctrl = (en ? REPEAT_EN | RUN_EN : 0);
+
+	if (en) {
+		dcss_dpr_write(ch, ch->mode_ctrl, DCSS_DPR_MODE_CTRL0);
+		dcss_dpr_write(ch, ch->frame_ctrl, DCSS_DPR_FRAME_CTRL0);
+		dcss_dpr_write(ch, ch->rtram_ctrl, DCSS_DPR_RTRAM_CTRL0);
+	}
+
+	if (ch->sys_ctrl != sys_ctrl)
+		ch->sys_ctrl_chgd = true;
+
+	ch->sys_ctrl = sys_ctrl;
+}
+
+struct rgb_comp_sel {
+	u32 drm_format;
+	int a_sel;
+	int r_sel;
+	int g_sel;
+	int b_sel;
+};
+
+static struct rgb_comp_sel comp_sel_map[] = {
+	{DRM_FORMAT_ARGB8888, 3, 2, 1, 0},
+	{DRM_FORMAT_XRGB8888, 3, 2, 1, 0},
+	{DRM_FORMAT_ABGR8888, 3, 0, 1, 2},
+	{DRM_FORMAT_XBGR8888, 3, 0, 1, 2},
+	{DRM_FORMAT_RGBA8888, 0, 3, 2, 1},
+	{DRM_FORMAT_RGBX8888, 0, 3, 2, 1},
+	{DRM_FORMAT_BGRA8888, 0, 1, 2, 3},
+	{DRM_FORMAT_BGRX8888, 0, 1, 2, 3},
+};
+
+static int to_comp_sel(u32 pix_fmt, int *a_sel, int *r_sel, int *g_sel,
+		       int *b_sel)
+{
+	int i;
+
+	for (i = 0; i < ARRAY_SIZE(comp_sel_map); i++) {
+		if (comp_sel_map[i].drm_format == pix_fmt) {
+			*a_sel = comp_sel_map[i].a_sel;
+			*r_sel = comp_sel_map[i].r_sel;
+			*g_sel = comp_sel_map[i].g_sel;
+			*b_sel = comp_sel_map[i].b_sel;
+
+			return 0;
+		}
+	}
+
+	return -1;
+}
+
+static void dcss_dpr_rtram_set(struct dcss_dpr_ch *ch, u32 pix_format)
+{
+	u32 val, mask;
+
+	switch (pix_format) {
+	case DRM_FORMAT_NV21:
+	case DRM_FORMAT_NV12:
+	case DRM_FORMAT_P010:
+		ch->rtram_3buf_en = true;
+		ch->rtram_4line_en = false;
+		break;
+
+	default:
+		ch->rtram_3buf_en = true;
+		ch->rtram_4line_en = true;
+		break;
+	}
+
+	val = (ch->rtram_4line_en ? RTR_4LINE_BUF_EN : 0);
+	val |= (ch->rtram_3buf_en ? RTR_3BUF_EN : 0);
+	mask = RTR_4LINE_BUF_EN | RTR_3BUF_EN;
+
+	ch->mode_ctrl &= ~mask;
+	ch->mode_ctrl |= (val & mask);
+
+	val = (ch->rtram_4line_en ? 0 : NUM_ROWS_ACTIVE);
+	val |= (3 << THRES_LOW_POS) & THRES_LOW_MASK;
+	val |= (4 << THRES_HIGH_POS) & THRES_HIGH_MASK;
+	mask = THRES_LOW_MASK | THRES_HIGH_MASK | NUM_ROWS_ACTIVE;
+
+	ch->rtram_ctrl &= ~mask;
+	ch->rtram_ctrl |= (val & mask);
+}
+
+static void dcss_dpr_setup_components(struct dcss_dpr_ch *ch,
+				      const struct drm_format_info *format)
+{
+	int a_sel, r_sel, g_sel, b_sel;
+	bool uv_swap, y_uv_swap;
+
+	switch (format->format) {
+	case DRM_FORMAT_YVYU:
+		uv_swap = true;
+		y_uv_swap = true;
+		break;
+
+	case DRM_FORMAT_VYUY:
+	case DRM_FORMAT_NV21:
+		uv_swap = true;
+		y_uv_swap = false;
+		break;
+
+	case DRM_FORMAT_YUYV:
+		uv_swap = false;
+		y_uv_swap = true;
+		break;
+
+	default:
+		uv_swap = false;
+		y_uv_swap = false;
+		break;
+	}
+
+	dcss_dpr_uv_swap(ch, uv_swap);
+
+	dcss_dpr_y_uv_swap(ch, y_uv_swap);
+
+	if (!format->is_yuv) {
+		if (!to_comp_sel(format->format, &a_sel, &r_sel,
+				 &g_sel, &b_sel)) {
+			dcss_dpr_argb_comp_sel(ch, a_sel, r_sel, g_sel, b_sel);
+		} else {
+			dcss_dpr_argb_comp_sel(ch, 3, 2, 1, 0);
+		}
+	} else {
+		dcss_dpr_argb_comp_sel(ch, 0, 0, 0, 0);
+	}
+}
+
+static void dcss_dpr_tile_set(struct dcss_dpr_ch *ch, uint64_t modifier)
+{
+	switch (ch->ch_num) {
+	case 0:
+		switch (modifier) {
+		case DRM_FORMAT_MOD_LINEAR:
+			ch->tile = TILE_LINEAR;
+			break;
+		case DRM_FORMAT_MOD_VIVANTE_TILED:
+			ch->tile = TILE_GPU_STANDARD;
+			break;
+		case DRM_FORMAT_MOD_VIVANTE_SUPER_TILED:
+			ch->tile = TILE_GPU_SUPER;
+			break;
+		default:
+			WARN_ON(1);
+			break;
+		}
+		break;
+	case 1:
+	case 2:
+		ch->tile = TILE_LINEAR;
+		break;
+	default:
+		WARN_ON(1);
+		return;
+	}
+
+	ch->mode_ctrl &= ~TILE_TYPE_MASK;
+	ch->mode_ctrl |= ((ch->tile << TILE_TYPE_POS) & TILE_TYPE_MASK);
+}
+
+void dcss_dpr_format_set(struct dcss_dpr *dpr, int ch_num,
+			 const struct drm_format_info *format, u64 modifier)
+{
+	struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
+
+	ch->format = *format;
+
+	dcss_dpr_yuv_en(ch, format->is_yuv);
+
+	dcss_dpr_pix_size_set(ch, format);
+
+	dcss_dpr_setup_components(ch, format);
+
+	dcss_dpr_2plane_en(ch, format->num_planes == 2);
+
+	dcss_dpr_rtram_set(ch, format->format);
+
+	dcss_dpr_tile_set(ch, modifier);
+}
+
+/* This function will be called from interrupt context. */
+void dcss_dpr_write_sysctrl(struct dcss_dpr *dpr)
+{
+	int chnum;
+
+	for (chnum = 0; chnum < 3; chnum++) {
+		struct dcss_dpr_ch *ch = &dpr->ch[chnum];
+
+		if (ch->sys_ctrl_chgd) {
+			dcss_ctxld_write_irqsafe(dpr->ctxld, dpr->ctx_id,
+						 ch->sys_ctrl,
+						 ch->base_ofs +
+						 DCSS_DPR_SYSTEM_CTRL0);
+			ch->sys_ctrl_chgd = false;
+		}
+	}
+}
+
+void dcss_dpr_set_rotation(struct dcss_dpr *dpr, int ch_num, u32 rotation)
+{
+	struct dcss_dpr_ch *ch = &dpr->ch[ch_num];
+
+	ch->frame_ctrl &= ~(HFLIP_EN | VFLIP_EN | ROT_ENC_MASK);
+
+	ch->frame_ctrl |= rotation & DRM_MODE_REFLECT_X ? HFLIP_EN : 0;
+	ch->frame_ctrl |= rotation & DRM_MODE_REFLECT_Y ? VFLIP_EN : 0;
+
+	if (rotation & DRM_MODE_ROTATE_90)
+		ch->frame_ctrl |= 1 << ROT_ENC_POS;
+	else if (rotation & DRM_MODE_ROTATE_180)
+		ch->frame_ctrl |= 2 << ROT_ENC_POS;
+	else if (rotation & DRM_MODE_ROTATE_270)
+		ch->frame_ctrl |= 3 << ROT_ENC_POS;
+}
diff --git a/drivers/gpu/drm/imx/dcss/dcss-drv.c b/drivers/gpu/drm/imx/dcss/dcss-drv.c
new file mode 100644
index 00000000..7ea131d
--- /dev/null
+++ b/drivers/gpu/drm/imx/dcss/dcss-drv.c
@@ -0,0 +1,182 @@ 
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright 2019 NXP.
+ */
+
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/platform_device.h>
+#include <linux/component.h>
+#include <drm/drm_of.h>
+#include <drm/drmP.h>
+
+#include "dcss-dev.h"
+#include "dcss-kms.h"
+
+struct dcss_drv {
+	struct dcss_dev *dcss;
+	struct dcss_kms_dev *kms;
+
+	bool is_componentized;
+};
+
+struct dcss_dev *dcss_drv_dev_to_dcss(struct device *dev)
+{
+	struct dcss_drv *mdrv = dev_get_drvdata(dev);
+
+	return mdrv ? mdrv->dcss : NULL;
+}
+
+struct drm_device *dcss_drv_dev_to_drm(struct device *dev)
+{
+	struct dcss_drv *mdrv = dev_get_drvdata(dev);
+
+	return mdrv ? &mdrv->kms->base : NULL;
+}
+
+static int dcss_drv_init(struct device *dev, bool componentized)
+{
+	struct dcss_drv *mdrv;
+	int err = 0;
+
+	mdrv = devm_kzalloc(dev, sizeof(*mdrv), GFP_KERNEL);
+	if (!mdrv)
+		return -ENOMEM;
+
+	mdrv->is_componentized = componentized;
+
+	mdrv->dcss = dcss_dev_create(dev, componentized);
+	if (IS_ERR(mdrv->dcss)) {
+		err = PTR_ERR(mdrv->dcss);
+		goto err;
+	}
+
+	dev_set_drvdata(dev, mdrv);
+
+	mdrv->kms = dcss_kms_attach(mdrv->dcss, componentized);
+	if (IS_ERR(mdrv->kms)) {
+		err = PTR_ERR(mdrv->kms);
+		goto dcss_shutoff;
+	}
+
+	return 0;
+
+dcss_shutoff:
+	dcss_dev_destroy(mdrv->dcss);
+
+	dev_set_drvdata(dev, NULL);
+
+err:
+	devm_kfree(dev, mdrv);
+	return err;
+}
+
+static void dcss_drv_deinit(struct device *dev, bool componentized)
+{
+	struct dcss_drv *mdrv = dev_get_drvdata(dev);
+
+	if (!mdrv)
+		return;
+
+	dcss_kms_detach(mdrv->kms, componentized);
+	dcss_dev_destroy(mdrv->dcss);
+
+	dev_set_drvdata(dev, NULL);
+}
+
+static int dcss_drv_bind(struct device *dev)
+{
+	return dcss_drv_init(dev, true);
+}
+
+static void dcss_drv_unbind(struct device *dev)
+{
+	return dcss_drv_deinit(dev, true);
+}
+
+static const struct component_master_ops dcss_master_ops = {
+	.bind	= dcss_drv_bind,
+	.unbind	= dcss_drv_unbind,
+};
+
+static int compare_of(struct device *dev, void *data)
+{
+	return dev->of_node == data;
+}
+
+static int dcss_drv_platform_probe(struct platform_device *pdev)
+{
+	struct device *dev = &pdev->dev;
+	struct component_match *match = NULL;
+	struct device_node *remote;
+
+	if (!dev->of_node)
+		return -ENODEV;
+
+	remote = of_graph_get_remote_node(dev->of_node, 0, 0);
+	if (!remote)
+		return -ENODEV;
+
+	if (of_device_is_compatible(remote, "fsl,imx8mq-nwl-dsi")) {
+		of_node_put(remote);
+		return dcss_drv_init(dev, false);
+	}
+
+	drm_of_component_match_add(dev, &match, compare_of, remote);
+	of_node_put(remote);
+
+	return component_master_add_with_match(dev, &dcss_master_ops, match);
+}
+
+static int dcss_drv_platform_remove(struct platform_device *pdev)
+{
+	struct dcss_drv *mdrv = dev_get_drvdata(&pdev->dev);
+
+	if (mdrv->is_componentized)
+		component_master_del(&pdev->dev, &dcss_master_ops);
+	else
+		dcss_drv_deinit(&pdev->dev, false);
+
+	return 0;
+}
+
+static struct dcss_type_data dcss_types[] = {
+	[DCSS_IMX8MQ] = {
+		.name = "DCSS_IMX8MQ",
+		.blkctl_ofs = 0x2F000,
+		.ctxld_ofs = 0x23000,
+		.dtg_ofs = 0x20000,
+		.scaler_ofs = 0x1C000,
+		.ss_ofs = 0x1B000,
+		.dpr_ofs = 0x18000,
+	},
+};
+
+static const struct of_device_id dcss_of_match[] = {
+	{ .compatible = "nxp,imx8mq-dcss", .data = &dcss_types[DCSS_IMX8MQ], },
+	{},
+};
+
+MODULE_DEVICE_TABLE(of, dcss_of_match);
+
+static const struct dev_pm_ops dcss_dev_pm = {
+	SET_SYSTEM_SLEEP_PM_OPS(dcss_dev_suspend, dcss_dev_resume)
+	SET_RUNTIME_PM_OPS(dcss_dev_runtime_suspend,
+			   dcss_dev_runtime_resume, NULL)
+};
+
+static struct platform_driver dcss_platform_driver = {
+	.probe	= dcss_drv_platform_probe,
+	.remove	= dcss_drv_platform_remove,
+	.driver	= {
+		.name = "imx-dcss",
+		.of_match_table	= dcss_of_match,
+		.pm = &dcss_dev_pm,
+	},
+};
+
+module_platform_driver(dcss_platform_driver);
+
+MODULE_AUTHOR("Laurentiu Palcu <laurentiu.palcu@nxp.com>");
+MODULE_DESCRIPTION("DCSS driver for i.MX8MQ");
+MODULE_LICENSE("GPL v2");
diff --git a/drivers/gpu/drm/imx/dcss/dcss-dtg.c b/drivers/gpu/drm/imx/dcss/dcss-dtg.c
new file mode 100644
index 00000000..c83b3bb
--- /dev/null
+++ b/drivers/gpu/drm/imx/dcss/dcss-dtg.c
@@ -0,0 +1,438 @@ 
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright 2019 NXP.
+ */
+
+#include <linux/clk.h>
+#include <linux/delay.h>
+#include <linux/interrupt.h>
+#include <linux/of.h>
+#include <linux/platform_device.h>
+
+#include "dcss-dev.h"
+
+#define DCSS_DTG_TC_CONTROL_STATUS			0x00
+#define   CH3_EN					BIT(0)
+#define   CH2_EN					BIT(1)
+#define   CH1_EN					BIT(2)
+#define   OVL_DATA_MODE					BIT(3)
+#define   BLENDER_VIDEO_ALPHA_SEL			BIT(7)
+#define   DTG_START					BIT(8)
+#define   DBY_MODE_EN					BIT(9)
+#define   CH1_ALPHA_SEL					BIT(10)
+#define   CSS_PIX_COMP_SWAP_POS				12
+#define   CSS_PIX_COMP_SWAP_MASK			GENMASK(14, 12)
+#define   DEFAULT_FG_ALPHA_POS				24
+#define   DEFAULT_FG_ALPHA_MASK				GENMASK(31, 24)
+#define DCSS_DTG_TC_DTG					0x04
+#define DCSS_DTG_TC_DISP_TOP				0x08
+#define DCSS_DTG_TC_DISP_BOT				0x0C
+#define DCSS_DTG_TC_CH1_TOP				0x10
+#define DCSS_DTG_TC_CH1_BOT				0x14
+#define DCSS_DTG_TC_CH2_TOP				0x18
+#define DCSS_DTG_TC_CH2_BOT				0x1C
+#define DCSS_DTG_TC_CH3_TOP				0x20
+#define DCSS_DTG_TC_CH3_BOT				0x24
+#define   TC_X_POS					0
+#define   TC_X_MASK					GENMASK(12, 0)
+#define   TC_Y_POS					16
+#define   TC_Y_MASK					GENMASK(28, 16)
+#define DCSS_DTG_TC_CTXLD				0x28
+#define   TC_CTXLD_DB_Y_POS				0
+#define   TC_CTXLD_DB_Y_MASK				GENMASK(12, 0)
+#define   TC_CTXLD_SB_Y_POS				16
+#define   TC_CTXLD_SB_Y_MASK				GENMASK(28, 16)
+#define DCSS_DTG_TC_CH1_BKRND				0x2C
+#define DCSS_DTG_TC_CH2_BKRND				0x30
+#define   BKRND_R_Y_COMP_POS				20
+#define   BKRND_R_Y_COMP_MASK				GENMASK(29, 20)
+#define   BKRND_G_U_COMP_POS				10
+#define   BKRND_G_U_COMP_MASK				GENMASK(19, 10)
+#define   BKRND_B_V_COMP_POS				0
+#define   BKRND_B_V_COMP_MASK				GENMASK(9, 0)
+#define DCSS_DTG_BLENDER_DBY_RANGEINV			0x38
+#define DCSS_DTG_BLENDER_DBY_RANGEMIN			0x3C
+#define DCSS_DTG_BLENDER_DBY_BDP			0x40
+#define DCSS_DTG_BLENDER_BKRND_I			0x44
+#define DCSS_DTG_BLENDER_BKRND_P			0x48
+#define DCSS_DTG_BLENDER_BKRND_T			0x4C
+#define DCSS_DTG_LINE0_INT				0x50
+#define DCSS_DTG_LINE1_INT				0x54
+#define DCSS_DTG_BG_ALPHA_DEFAULT			0x58
+#define DCSS_DTG_INT_STATUS				0x5C
+#define DCSS_DTG_INT_CONTROL				0x60
+#define DCSS_DTG_TC_CH3_BKRND				0x64
+#define DCSS_DTG_INT_MASK				0x68
+#define   LINE0_IRQ					BIT(0)
+#define   LINE1_IRQ					BIT(1)
+#define   LINE2_IRQ					BIT(2)
+#define   LINE3_IRQ					BIT(3)
+#define DCSS_DTG_LINE2_INT				0x6C
+#define DCSS_DTG_LINE3_INT				0x70
+#define DCSS_DTG_DBY_OL					0x74
+#define DCSS_DTG_DBY_BL					0x78
+#define DCSS_DTG_DBY_EL					0x7C
+
+struct dcss_dtg {
+	struct device *dev;
+	struct dcss_ctxld *ctxld;
+	void __iomem *base_reg;
+	u32 base_ofs;
+
+	u32 ctx_id;
+
+	bool in_use;
+
+	u32 dis_ulc_x;
+	u32 dis_ulc_y;
+
+	u32 control_status;
+	u32 alpha;
+
+	int ctxld_kick_irq;
+	bool ctxld_kick_irq_en;
+
+	struct clk *pix_clk;
+	struct clk *pll_src_clk;
+	struct clk *pll_phy_ref_clk;
+
+	/*
+	 * This will be passed on by DRM CRTC so that we can signal when DTG has
+	 * been successfully stopped. Otherwise, any modesetting while DTG is
+	 * still ON may result in unpredictable behavior.
+	 */
+	struct completion *dis_completion;
+};
+
+static void dcss_dtg_write(struct dcss_dtg *dtg, u32 val, u32 ofs)
+{
+	if (!dtg->in_use)
+		dcss_writel(val, dtg->base_reg + ofs);
+
+	dcss_ctxld_write(dtg->ctxld, dtg->ctx_id, val, dtg->base_ofs + ofs);
+}
+
+static irqreturn_t dcss_dtg_irq_handler(int irq, void *data)
+{
+	struct dcss_dtg *dtg = data;
+	u32 status;
+
+	status = dcss_readl(dtg->base_reg + DCSS_DTG_INT_STATUS);
+
+	if (!(status & LINE0_IRQ))
+		return IRQ_HANDLED;
+
+	dcss_ctxld_kick(dtg->ctxld);
+
+	dcss_writel(status & LINE0_IRQ, dtg->base_reg + DCSS_DTG_INT_CONTROL);
+
+	return IRQ_HANDLED;
+}
+
+static int dcss_dtg_irq_config(struct dcss_dtg *dtg,
+			       struct platform_device *pdev)
+{
+	int ret;
+
+	dtg->ctxld_kick_irq = platform_get_irq_byname(pdev, "ctxld_kick");
+	if (dtg->ctxld_kick_irq < 0) {
+		dev_err(dtg->dev, "dtg: can't get line2 irq number\n");
+		return dtg->ctxld_kick_irq;
+	}
+
+	ret = devm_request_irq(dtg->dev, dtg->ctxld_kick_irq,
+			       dcss_dtg_irq_handler,
+			       IRQF_TRIGGER_HIGH,
+			       "dcss_ctxld_kick", dtg);
+	if (ret) {
+		dev_err(dtg->dev, "dtg: irq request failed.\n");
+		return ret;
+	}
+
+	disable_irq(dtg->ctxld_kick_irq);
+
+	dtg->ctxld_kick_irq_en = false;
+
+	dcss_update(LINE0_IRQ, LINE0_IRQ, dtg->base_reg + DCSS_DTG_INT_MASK);
+
+	return 0;
+}
+
+int dcss_dtg_init(struct dcss_dev *dcss, unsigned long dtg_base)
+{
+	int ret = 0;
+	struct dcss_dtg *dtg;
+
+	dtg = devm_kzalloc(dcss->dev, sizeof(*dtg), GFP_KERNEL);
+	if (!dtg)
+		return -ENOMEM;
+
+	dcss->dtg = dtg;
+	dtg->dev = dcss->dev;
+	dtg->ctxld = dcss->ctxld;
+
+	dtg->base_reg = devm_ioremap(dcss->dev, dtg_base, SZ_4K);
+	if (!dtg->base_reg) {
+		dev_err(dcss->dev, "dtg: unable to remap dtg base\n");
+		ret = -ENOMEM;
+		goto err_ioremap;
+	}
+
+	dtg->base_ofs = dtg_base;
+	dtg->ctx_id = CTX_DB;
+
+	dtg->pix_clk = dcss->pix_clk;
+	dtg->pll_src_clk = dcss->pll_src_clk;
+	dtg->pll_phy_ref_clk = dcss->pll_phy_ref_clk;
+
+	dtg->alpha = 255;
+
+	dtg->control_status |= OVL_DATA_MODE | BLENDER_VIDEO_ALPHA_SEL |
+		((dtg->alpha << DEFAULT_FG_ALPHA_POS) & DEFAULT_FG_ALPHA_MASK);
+
+	ret = dcss_dtg_irq_config(dtg, to_platform_device(dcss->dev));
+	if (ret)
+		goto err_irq;
+
+	return 0;
+
+err_irq:
+	devm_iounmap(dtg->dev, dtg->base_reg);
+
+err_ioremap:
+	devm_kfree(dtg->dev, dtg);
+
+	return ret;
+}
+
+void dcss_dtg_exit(struct dcss_dtg *dtg)
+{
+	/* stop DTG */
+	dcss_writel(DTG_START, dtg->base_reg + DCSS_DTG_TC_CONTROL_STATUS);
+
+	devm_free_irq(dtg->dev, dtg->ctxld_kick_irq, dtg);
+
+	if (dtg->base_reg)
+		devm_iounmap(dtg->dev, dtg->base_reg);
+
+	devm_kfree(dtg->dev, dtg);
+}
+
+void dcss_dtg_sync_set(struct dcss_dtg *dtg, struct videomode *vm)
+{
+	u16 dtg_lrc_x, dtg_lrc_y;
+	u16 dis_ulc_x, dis_ulc_y;
+	u16 dis_lrc_x, dis_lrc_y;
+	u32 sb_ctxld_trig, db_ctxld_trig;
+	u32 pixclock = vm->pixelclock;
+	u32 actual_clk;
+
+	dtg_lrc_x = vm->hfront_porch + vm->hback_porch + vm->hsync_len +
+		    vm->hactive - 1;
+	dtg_lrc_y = vm->vfront_porch + vm->vback_porch + vm->vsync_len +
+		    vm->vactive - 1;
+	dis_ulc_x = vm->hsync_len + vm->hback_porch - 1;
+	dis_ulc_y = vm->vsync_len + vm->vfront_porch + vm->vback_porch - 1;
+	dis_lrc_x = vm->hsync_len + vm->hback_porch + vm->hactive - 1;
+	dis_lrc_y = vm->vsync_len + vm->vfront_porch + vm->vback_porch +
+		    vm->vactive - 1;
+
+	clk_disable_unprepare(dtg->pix_clk);
+	clk_set_rate(dtg->pix_clk, vm->pixelclock);
+	clk_prepare_enable(dtg->pix_clk);
+
+	actual_clk = clk_get_rate(dtg->pix_clk);
+	if (pixclock != actual_clk) {
+		dev_info(dtg->dev,
+			 "Pixel clock set to %u kHz instead of %u kHz.\n",
+			 (actual_clk / 1000), (pixclock / 1000));
+	}
+
+	msleep(50);
+
+	dcss_dtg_write(dtg, ((dtg_lrc_y << TC_Y_POS) | dtg_lrc_x),
+		       DCSS_DTG_TC_DTG);
+	dcss_dtg_write(dtg, ((dis_ulc_y << TC_Y_POS) | dis_ulc_x),
+		       DCSS_DTG_TC_DISP_TOP);
+	dcss_dtg_write(dtg, ((dis_lrc_y << TC_Y_POS) | dis_lrc_x),
+		       DCSS_DTG_TC_DISP_BOT);
+
+	dtg->dis_ulc_x = dis_ulc_x;
+	dtg->dis_ulc_y = dis_ulc_y;
+
+	sb_ctxld_trig = ((0 * dis_lrc_y / 100) << TC_CTXLD_SB_Y_POS) &
+							TC_CTXLD_SB_Y_MASK;
+	db_ctxld_trig = ((99 * dis_lrc_y / 100) << TC_CTXLD_DB_Y_POS) &
+							TC_CTXLD_DB_Y_MASK;
+
+	dcss_dtg_write(dtg, sb_ctxld_trig | db_ctxld_trig, DCSS_DTG_TC_CTXLD);
+
+	/* vblank trigger */
+	dcss_dtg_write(dtg, 0, DCSS_DTG_LINE1_INT);
+
+	/* CTXLD trigger */
+	dcss_dtg_write(dtg, ((90 * dis_lrc_y) / 100) << 16, DCSS_DTG_LINE0_INT);
+}
+
+void dcss_dtg_plane_pos_set(struct dcss_dtg *dtg, int ch_num,
+			    int px, int py, int pw, int ph)
+{
+	u16 p_ulc_x, p_ulc_y;
+	u16 p_lrc_x, p_lrc_y;
+
+	p_ulc_x = dtg->dis_ulc_x + px;
+	p_ulc_y = dtg->dis_ulc_y + py;
+	p_lrc_x = p_ulc_x + pw;
+	p_lrc_y = p_ulc_y + ph;
+
+	if (!px && !py && !pw && !ph) {
+		dcss_dtg_write(dtg, 0, DCSS_DTG_TC_CH1_TOP + 0x8 * ch_num);
+		dcss_dtg_write(dtg, 0, DCSS_DTG_TC_CH1_BOT + 0x8 * ch_num);
+	} else {
+		dcss_dtg_write(dtg, ((p_ulc_y << TC_Y_POS) | p_ulc_x),
+			       DCSS_DTG_TC_CH1_TOP + 0x8 * ch_num);
+		dcss_dtg_write(dtg, ((p_lrc_y << TC_Y_POS) | p_lrc_x),
+			       DCSS_DTG_TC_CH1_BOT + 0x8 * ch_num);
+	}
+}
+
+bool dcss_dtg_global_alpha_changed(struct dcss_dtg *dtg, int ch_num, int alpha)
+{
+	if (ch_num)
+		return false;
+
+	return alpha != dtg->alpha;
+}
+
+void dcss_dtg_plane_alpha_set(struct dcss_dtg *dtg, int ch_num,
+			      const struct drm_format_info *format, int alpha)
+{
+	u32 alpha_val;
+
+	/* we care about alpha only when channel 0 is concerned */
+	if (ch_num)
+		return;
+
+	alpha_val = (alpha << DEFAULT_FG_ALPHA_POS) & DEFAULT_FG_ALPHA_MASK;
+
+	/*
+	 * Use global alpha if pixel format does not have alpha channel or the
+	 * user explicitly chose to use global alpha (i.e. alpha is not OPAQUE).
+	 */
+	if (!format->has_alpha || alpha != 255) {
+		dtg->control_status &= ~(CH1_ALPHA_SEL | DEFAULT_FG_ALPHA_MASK);
+		dtg->control_status |= alpha_val;
+	} else { /* use per-pixel alpha otherwise */
+		dtg->control_status |= CH1_ALPHA_SEL;
+	}
+
+	dtg->alpha = alpha;
+}
+
+void dcss_dtg_css_set(struct dcss_dtg *dtg)
+{
+	dtg->control_status |=
+			(0x5 << CSS_PIX_COMP_SWAP_POS) & CSS_PIX_COMP_SWAP_MASK;
+}
+
+static void dcss_dtg_disable_callback(void *data)
+{
+	struct dcss_dtg *dtg = data;
+
+	dtg->control_status &= ~DTG_START;
+
+	dcss_writel(dtg->control_status,
+		    dtg->base_reg + DCSS_DTG_TC_CONTROL_STATUS);
+
+	dtg->in_use = false;
+
+	complete(dtg->dis_completion);
+}
+
+void dcss_dtg_enable(struct dcss_dtg *dtg, bool en,
+		     struct completion *dis_completion)
+{
+	if (!en) {
+		dtg->dis_completion = dis_completion;
+		dcss_ctxld_register_dtg_disable_cb(dtg->ctxld,
+						   dcss_dtg_disable_callback,
+						   dtg);
+		return;
+	}
+
+	dtg->dis_completion = NULL;
+
+	dtg->control_status |= DTG_START;
+
+	dcss_dtg_write(dtg, dtg->control_status, DCSS_DTG_TC_CONTROL_STATUS);
+
+	dtg->in_use = true;
+}
+
+bool dcss_dtg_is_enabled(struct dcss_dtg *dtg)
+{
+	return dtg->in_use;
+}
+
+void dcss_dtg_ch_enable(struct dcss_dtg *dtg, int ch_num, bool en)
+{
+	u32 ch_en_map[] = {CH1_EN, CH2_EN, CH3_EN};
+	u32 control_status;
+
+	control_status = dtg->control_status & ~ch_en_map[ch_num];
+	control_status |= en ? ch_en_map[ch_num] : 0;
+
+	if (dtg->control_status != control_status)
+		dcss_dtg_write(dtg, control_status, DCSS_DTG_TC_CONTROL_STATUS);
+
+	dtg->control_status = control_status;
+}
+
+void dcss_dtg_vblank_irq_enable(struct dcss_dtg *dtg, bool en)
+{
+	u32 status;
+
+	dcss_update(LINE1_IRQ, LINE1_IRQ, dtg->base_reg + DCSS_DTG_INT_MASK);
+
+	if (en) {
+		status = dcss_readl(dtg->base_reg + DCSS_DTG_INT_STATUS);
+		dcss_writel(status & LINE1_IRQ,
+			    dtg->base_reg + DCSS_DTG_INT_CONTROL);
+	}
+}
+
+void dcss_dtg_ctxld_kick_irq_enable(struct dcss_dtg *dtg, bool en)
+{
+	u32 status;
+
+	if (en) {
+		status = dcss_readl(dtg->base_reg + DCSS_DTG_INT_STATUS);
+
+		if (!dtg->ctxld_kick_irq_en) {
+			dcss_writel(status & LINE0_IRQ,
+				    dtg->base_reg + DCSS_DTG_INT_CONTROL);
+			enable_irq(dtg->ctxld_kick_irq);
+			dtg->ctxld_kick_irq_en = true;
+			return;
+		}
+
+		return;
+	}
+
+	if (!dtg->ctxld_kick_irq_en)
+		return;
+
+	disable_irq_nosync(dtg->ctxld_kick_irq);
+	dtg->ctxld_kick_irq_en = false;
+}
+
+void dcss_dtg_vblank_irq_clear(struct dcss_dtg *dtg)
+{
+	dcss_update(LINE1_IRQ, LINE1_IRQ, dtg->base_reg + DCSS_DTG_INT_CONTROL);
+}
+
+bool dcss_dtg_vblank_irq_valid(struct dcss_dtg *dtg)
+{
+	return !!(dcss_readl(dtg->base_reg + DCSS_DTG_INT_STATUS) & LINE1_IRQ);
+}
+
diff --git a/drivers/gpu/drm/imx/dcss/dcss-kms.c b/drivers/gpu/drm/imx/dcss/dcss-kms.c
new file mode 100644
index 00000000..d3bc889
--- /dev/null
+++ b/drivers/gpu/drm/imx/dcss/dcss-kms.c
@@ -0,0 +1,321 @@ 
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright 2019 NXP.
+ */
+
+#include <drm/drm_atomic.h>
+#include <drm/drm_atomic_helper.h>
+#include <drm/drm_fb_helper.h>
+#include <drm/drm_gem_cma_helper.h>
+#include <drm/drm_gem_framebuffer_helper.h>
+#include <drm/drm_of.h>
+#include <drm/drm_probe_helper.h>
+#include <drm/drmP.h>
+#include <linux/component.h>
+
+#include "dcss-dev.h"
+#include "dcss-kms.h"
+
+DEFINE_DRM_GEM_CMA_FOPS(dcss_cma_fops);
+
+struct dcss_drm_commit {
+	struct work_struct work;
+	struct drm_device *drm;
+	struct drm_atomic_state *state;
+};
+
+static void dcss_drm_atomic_commit_tail(struct dcss_drm_commit *commit)
+{
+	struct drm_atomic_state *state = commit->state;
+	struct drm_device *drm = commit->drm;
+	struct dcss_kms_dev *kms = container_of(drm, struct dcss_kms_dev, base);
+
+	drm_atomic_helper_wait_for_fences(drm, state, false);
+
+	drm_atomic_helper_wait_for_dependencies(state);
+
+	drm_atomic_helper_commit_modeset_disables(drm, state);
+
+	drm_atomic_helper_commit_modeset_enables(drm, state);
+
+	drm_atomic_helper_commit_planes(drm, state,
+					DRM_PLANE_COMMIT_ACTIVE_ONLY);
+
+	drm_atomic_helper_commit_hw_done(state);
+
+	drm_atomic_helper_wait_for_vblanks(drm, state);
+
+	drm_atomic_helper_cleanup_planes(drm, state);
+
+	drm_atomic_helper_commit_cleanup_done(state);
+
+	drm_atomic_state_put(state);
+
+	spin_lock(&kms->commit.wait.lock);
+	kms->commit.pending = false;
+	wake_up_all_locked(&kms->commit.wait);
+	spin_unlock(&kms->commit.wait.lock);
+
+	kfree(commit);
+}
+
+static void dcss_commit_work(struct work_struct *work)
+{
+	struct dcss_drm_commit *commit = container_of(work,
+						      struct dcss_drm_commit,
+						      work);
+
+	dcss_drm_atomic_commit_tail(commit);
+}
+
+static int dcss_drm_atomic_commit(struct drm_device *drm,
+				  struct drm_atomic_state *state,
+				  bool nonblock)
+{
+	int ret;
+	struct dcss_kms_dev *kms = container_of(drm, struct dcss_kms_dev, base);
+	struct dcss_drm_commit *commit;
+
+	if (state->async_update) {
+		ret = drm_atomic_helper_prepare_planes(drm, state);
+		if (ret)
+			return ret;
+
+		drm_atomic_helper_async_commit(drm, state);
+		drm_atomic_helper_cleanup_planes(drm, state);
+
+		return 0;
+	}
+
+	commit = kzalloc(sizeof(*commit), GFP_KERNEL);
+	if (!commit)
+		return -ENOMEM;
+
+	commit->drm = drm;
+	commit->state = state;
+
+	ret = drm_atomic_helper_setup_commit(state, nonblock);
+	if (ret)
+		goto err_free;
+
+	INIT_WORK(&commit->work, dcss_commit_work);
+
+	ret = drm_atomic_helper_prepare_planes(drm, state);
+	if (ret)
+		goto err_free;
+
+	if (!nonblock) {
+		ret = drm_atomic_helper_wait_for_fences(drm, state, true);
+		if (ret)
+			goto err;
+	}
+
+	spin_lock(&kms->commit.wait.lock);
+	ret = wait_event_interruptible_locked(kms->commit.wait,
+					      !kms->commit.pending);
+	if (ret == 0)
+		kms->commit.pending = true;
+	spin_unlock(&kms->commit.wait.lock);
+
+	if (ret)
+		goto err;
+
+	ret = drm_atomic_helper_swap_state(state, true);
+	if (ret)
+		goto err;
+
+	drm_atomic_state_get(state);
+	if (nonblock)
+		queue_work(kms->commit_wq, &commit->work);
+	else
+		dcss_drm_atomic_commit_tail(commit);
+
+	return 0;
+
+err:
+	drm_atomic_helper_cleanup_planes(drm, state);
+
+err_free:
+	kfree(commit);
+	return ret;
+}
+
+const struct drm_mode_config_funcs dcss_drm_mode_config_funcs = {
+	.fb_create = drm_gem_fb_create,
+	.output_poll_changed = drm_fb_helper_output_poll_changed,
+	.atomic_check = drm_atomic_helper_check,
+	.atomic_commit = dcss_drm_atomic_commit,
+};
+
+static struct drm_driver dcss_kms_driver = {
+	.driver_features	= DRIVER_MODESET | DRIVER_GEM | DRIVER_ATOMIC,
+	.gem_free_object_unlocked = drm_gem_cma_free_object,
+	.gem_vm_ops		= &drm_gem_cma_vm_ops,
+	.dumb_create		= drm_gem_cma_dumb_create,
+
+	.prime_handle_to_fd	= drm_gem_prime_handle_to_fd,
+	.prime_fd_to_handle	= drm_gem_prime_fd_to_handle,
+	.gem_prime_import	= drm_gem_prime_import,
+	.gem_prime_export	= drm_gem_prime_export,
+	.gem_prime_get_sg_table	= drm_gem_cma_prime_get_sg_table,
+	.gem_prime_import_sg_table = drm_gem_cma_prime_import_sg_table,
+	.gem_prime_vmap		= drm_gem_cma_prime_vmap,
+	.gem_prime_vunmap	= drm_gem_cma_prime_vunmap,
+	.gem_prime_mmap		= drm_gem_cma_prime_mmap,
+	.fops			= &dcss_cma_fops,
+	.name			= "imx-dcss",
+	.desc			= "i.MX8MQ Display Subsystem",
+	.date			= "20190917",
+	.major			= 1,
+	.minor			= 0,
+	.patchlevel		= 0,
+};
+
+static const struct drm_mode_config_helper_funcs dcss_mode_config_helpers = {
+	.atomic_commit_tail = drm_atomic_helper_commit_tail_rpm,
+};
+
+static void dcss_kms_mode_config_init(struct dcss_kms_dev *kms)
+{
+	struct drm_mode_config *config = &kms->base.mode_config;
+
+	drm_mode_config_init(&kms->base);
+
+	config->min_width = 1;
+	config->min_height = 1;
+	config->max_width = 4096;
+	config->max_height = 4096;
+	config->allow_fb_modifiers = true;
+	config->normalize_zpos = true;
+
+	config->funcs = &dcss_drm_mode_config_funcs;
+	config->helper_private = &dcss_mode_config_helpers;
+}
+
+static const struct drm_encoder_funcs dcss_kms_simple_encoder_funcs = {
+	.destroy = drm_encoder_cleanup,
+};
+
+static int dcss_kms_setup_encoder(struct dcss_kms_dev *kms)
+{
+	struct drm_device *ddev = &kms->base;
+	struct drm_encoder *encoder = &kms->encoder;
+	struct drm_crtc *crtc = (struct drm_crtc *)&kms->crtc;
+	struct drm_panel *panel;
+	struct drm_bridge *bridge;
+	int ret;
+
+	ret = drm_of_find_panel_or_bridge(ddev->dev->of_node, 0, 0,
+					  &panel, &bridge);
+	if (ret)
+		return ret;
+
+	if (!bridge) {
+		dev_err(ddev->dev, "No bridge found %d.\n", ret);
+		return -ENODEV;
+	}
+
+	encoder->possible_crtcs = drm_crtc_mask(crtc);
+
+	ret = drm_encoder_init(&kms->base, encoder,
+			       &dcss_kms_simple_encoder_funcs,
+			       DRM_MODE_ENCODER_NONE, NULL);
+	if (ret) {
+		dev_err(ddev->dev, "Failed initializing encoder %d.\n", ret);
+		return ret;
+	}
+
+	return drm_bridge_attach(encoder, bridge, NULL);
+}
+
+struct dcss_kms_dev *dcss_kms_attach(struct dcss_dev *dcss, bool componentized)
+{
+	struct dcss_kms_dev *kms = kzalloc(sizeof(*kms), GFP_KERNEL);
+	struct drm_device *drm;
+	struct dcss_crtc *crtc;
+	int ret;
+
+	if (!kms)
+		return ERR_PTR(-ENOMEM);
+
+	drm = &kms->base;
+	crtc = &kms->crtc;
+	ret = drm_dev_init(drm, &dcss_kms_driver, dcss->dev);
+	if (ret)
+		goto free_kms;
+
+	drm->dev_private = dcss;
+
+	dcss_kms_mode_config_init(kms);
+
+	ret = drm_vblank_init(drm, 1);
+	if (ret)
+		goto cleanup_mode_config;
+
+	drm->irq_enabled = true;
+
+	ret = dcss_crtc_init(crtc, drm);
+	if (ret)
+		goto cleanup_mode_config;
+
+	kms->commit_wq = alloc_ordered_workqueue("dcss_nonblock_commit_wq", 0);
+	if (!kms->commit_wq) {
+		ret = -ENOMEM;
+		goto cleanup_crtc;
+	}
+
+	init_waitqueue_head(&kms->commit.wait);
+
+	if (componentized)
+		ret = component_bind_all(dcss->dev, kms);
+	else
+		ret = dcss_kms_setup_encoder(kms);
+
+	if (ret)
+		goto cleanup_wq;
+
+	drm_mode_config_reset(drm);
+
+	drm_kms_helper_poll_init(drm);
+
+	ret = drm_dev_register(drm, 0);
+	if (ret)
+		goto cleanup_wq;
+
+	drm_fbdev_generic_setup(drm, 32);
+
+	return kms;
+
+cleanup_wq:
+	drm_kms_helper_poll_fini(drm);
+	destroy_workqueue(kms->commit_wq);
+
+cleanup_crtc:
+	dcss_crtc_deinit(crtc, drm);
+
+cleanup_mode_config:
+	drm_mode_config_cleanup(drm);
+
+free_kms:
+	kfree(kms);
+	return ERR_PTR(ret);
+}
+
+void dcss_kms_detach(struct dcss_kms_dev *kms, bool componentized)
+{
+	struct drm_device *drm = &kms->base;
+	struct dcss_dev *dcss = drm->dev_private;
+
+	drm_dev_unregister(drm);
+	drm_kms_helper_poll_fini(drm);
+	drm_atomic_helper_shutdown(drm);
+	drm_crtc_vblank_off(&kms->crtc.base);
+	drm->irq_enabled = false;
+	drm_mode_config_cleanup(drm);
+	destroy_workqueue(kms->commit_wq);
+	dcss_crtc_deinit(&kms->crtc, drm);
+	if (componentized)
+		component_unbind_all(dcss->dev, drm);
+	drm->dev_private = NULL;
+	drm_dev_put(drm);
+}
diff --git a/drivers/gpu/drm/imx/dcss/dcss-kms.h b/drivers/gpu/drm/imx/dcss/dcss-kms.h
new file mode 100644
index 00000000..6297005
--- /dev/null
+++ b/drivers/gpu/drm/imx/dcss/dcss-kms.h
@@ -0,0 +1,52 @@ 
+/* SPDX-License-Identifier: GPL-2.0 */
+/*
+ * Copyright 2019 NXP.
+ */
+
+#ifndef _DCSS_KMS_H_
+#define _DCSS_KMS_H_
+
+#include <drm/drm_encoder.h>
+
+struct dcss_plane {
+	struct drm_plane base;
+
+	int ch_num;
+};
+
+struct dcss_crtc {
+	struct drm_crtc		base;
+	struct drm_crtc_state	*state;
+
+	struct dcss_plane	*plane[3];
+
+	int			irq;
+	bool			irq_enabled;
+
+	struct completion en_completion;
+	struct completion dis_completion;
+};
+
+struct commit {
+	wait_queue_head_t wait;
+	bool pending;
+};
+
+struct dcss_kms_dev {
+	struct drm_device base;
+	struct dcss_crtc crtc;
+	struct drm_encoder encoder;
+	struct workqueue_struct *commit_wq;
+	struct commit commit;
+};
+
+struct dcss_kms_dev *dcss_kms_attach(struct dcss_dev *dcss, bool componentized);
+void dcss_kms_detach(struct dcss_kms_dev *kms, bool componentized);
+int dcss_crtc_init(struct dcss_crtc *crtc, struct drm_device *drm);
+void dcss_crtc_deinit(struct dcss_crtc *crtc, struct drm_device *drm);
+struct dcss_plane *dcss_plane_init(struct drm_device *drm,
+				   unsigned int possible_crtcs,
+				   enum drm_plane_type type,
+				   unsigned int zpos);
+
+#endif
diff --git a/drivers/gpu/drm/imx/dcss/dcss-plane.c b/drivers/gpu/drm/imx/dcss/dcss-plane.c
new file mode 100644
index 00000000..cb18c3e
--- /dev/null
+++ b/drivers/gpu/drm/imx/dcss/dcss-plane.c
@@ -0,0 +1,418 @@ 
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright 2019 NXP.
+ */
+
+#include <drm/drm_atomic.h>
+#include <drm/drm_atomic_helper.h>
+#include <drm/drm_fb_cma_helper.h>
+#include <drm/drm_gem_framebuffer_helper.h>
+#include <drm/drm_gem_cma_helper.h>
+
+#include "dcss-dev.h"
+#include "dcss-kms.h"
+
+static const u32 dcss_common_formats[] = {
+	/* RGB */
+	DRM_FORMAT_ARGB8888,
+	DRM_FORMAT_XRGB8888,
+	DRM_FORMAT_ABGR8888,
+	DRM_FORMAT_XBGR8888,
+	DRM_FORMAT_RGBA8888,
+	DRM_FORMAT_RGBX8888,
+	DRM_FORMAT_BGRA8888,
+	DRM_FORMAT_BGRX8888,
+	DRM_FORMAT_XRGB2101010,
+	DRM_FORMAT_XBGR2101010,
+	DRM_FORMAT_RGBX1010102,
+	DRM_FORMAT_BGRX1010102,
+	DRM_FORMAT_ARGB2101010,
+	DRM_FORMAT_ABGR2101010,
+	DRM_FORMAT_RGBA1010102,
+	DRM_FORMAT_BGRA1010102,
+
+	/* YUV444 */
+	DRM_FORMAT_AYUV,
+
+	/* YUV422 */
+	DRM_FORMAT_UYVY,
+	DRM_FORMAT_VYUY,
+	DRM_FORMAT_YUYV,
+	DRM_FORMAT_YVYU,
+
+	/* YUV420 */
+	DRM_FORMAT_NV12,
+	DRM_FORMAT_NV21,
+};
+
+static const u64 dcss_video_format_modifiers[] = {
+	DRM_FORMAT_MOD_LINEAR,
+	DRM_FORMAT_MOD_INVALID,
+};
+
+static const u64 dcss_graphics_format_modifiers[] = {
+	DRM_FORMAT_MOD_VIVANTE_TILED,
+	DRM_FORMAT_MOD_VIVANTE_SUPER_TILED,
+	DRM_FORMAT_MOD_LINEAR,
+	DRM_FORMAT_MOD_INVALID,
+};
+
+static inline struct dcss_plane *to_dcss_plane(struct drm_plane *p)
+{
+	return container_of(p, struct dcss_plane, base);
+}
+
+static inline bool dcss_plane_fb_is_linear(const struct drm_framebuffer *fb)
+{
+	return ((fb->flags & DRM_MODE_FB_MODIFIERS) == 0) ||
+	       ((fb->flags & DRM_MODE_FB_MODIFIERS) != 0 &&
+		fb->modifier == DRM_FORMAT_MOD_LINEAR);
+}
+
+static void dcss_plane_destroy(struct drm_plane *plane)
+{
+	struct dcss_plane *dcss_plane = container_of(plane, struct dcss_plane,
+						     base);
+
+	drm_plane_cleanup(plane);
+	kfree(dcss_plane);
+}
+
+static bool dcss_plane_format_mod_supported(struct drm_plane *plane,
+					    u32 format,
+					    u64 modifier)
+{
+	switch (plane->type) {
+	case DRM_PLANE_TYPE_PRIMARY:
+		switch (format) {
+		case DRM_FORMAT_ARGB8888:
+		case DRM_FORMAT_XRGB8888:
+		case DRM_FORMAT_ARGB2101010:
+			return modifier == DRM_FORMAT_MOD_LINEAR ||
+			       modifier == DRM_FORMAT_MOD_VIVANTE_TILED ||
+			       modifier == DRM_FORMAT_MOD_VIVANTE_SUPER_TILED;
+		default:
+			return modifier == DRM_FORMAT_MOD_LINEAR;
+		}
+		break;
+	case DRM_PLANE_TYPE_OVERLAY:
+		return modifier == DRM_FORMAT_MOD_LINEAR;
+	default:
+		return false;
+	}
+}
+
+static const struct drm_plane_funcs dcss_plane_funcs = {
+	.update_plane		= drm_atomic_helper_update_plane,
+	.disable_plane		= drm_atomic_helper_disable_plane,
+	.destroy		= dcss_plane_destroy,
+	.reset			= drm_atomic_helper_plane_reset,
+	.atomic_duplicate_state	= drm_atomic_helper_plane_duplicate_state,
+	.atomic_destroy_state	= drm_atomic_helper_plane_destroy_state,
+	.format_mod_supported	= dcss_plane_format_mod_supported,
+};
+
+static bool dcss_plane_can_rotate(const struct drm_format_info *format,
+				  bool mod_present, u64 modifier,
+				  unsigned int rotation)
+{
+	bool linear_format = !mod_present ||
+			     (mod_present && modifier == DRM_FORMAT_MOD_LINEAR);
+	u32 supported_rotation = DRM_MODE_ROTATE_0;
+
+	if (!format->is_yuv && linear_format)
+		supported_rotation = DRM_MODE_ROTATE_0 | DRM_MODE_ROTATE_180 |
+				     DRM_MODE_REFLECT_MASK;
+	else if (!format->is_yuv &&
+		 modifier == DRM_FORMAT_MOD_VIVANTE_TILED)
+		supported_rotation = DRM_MODE_ROTATE_MASK |
+				     DRM_MODE_REFLECT_MASK;
+	else if (format->is_yuv && linear_format &&
+		 (format->format == DRM_FORMAT_NV12 ||
+		  format->format == DRM_FORMAT_NV21))
+		supported_rotation = DRM_MODE_ROTATE_0 | DRM_MODE_ROTATE_180 |
+				     DRM_MODE_REFLECT_MASK;
+
+	return !!(rotation & supported_rotation);
+}
+
+static bool dcss_plane_is_source_size_allowed(u16 src_w, u16 src_h, u32 pix_fmt)
+{
+	if (src_w < 64 &&
+	    (pix_fmt == DRM_FORMAT_NV12 || pix_fmt == DRM_FORMAT_NV21))
+		return false;
+	else if (src_w < 32 &&
+		 (pix_fmt == DRM_FORMAT_UYVY || pix_fmt == DRM_FORMAT_VYUY ||
+		  pix_fmt == DRM_FORMAT_YUYV || pix_fmt == DRM_FORMAT_YVYU))
+		return false;
+
+	return src_w >= 16 && src_h >= 8;
+}
+
+static int dcss_plane_atomic_check(struct drm_plane *plane,
+				   struct drm_plane_state *state)
+{
+	struct dcss_plane *dcss_plane = to_dcss_plane(plane);
+	struct dcss_dev *dcss = plane->dev->dev_private;
+	struct drm_framebuffer *fb = state->fb;
+	bool is_primary_plane = plane->type == DRM_PLANE_TYPE_PRIMARY;
+	struct drm_gem_cma_object *cma_obj;
+	struct drm_crtc_state *crtc_state;
+	int hdisplay, vdisplay;
+	int min, max;
+	int ret;
+
+	if (!fb || !state->crtc)
+		return 0;
+
+	cma_obj = drm_fb_cma_get_gem_obj(fb, 0);
+	WARN_ON(!cma_obj);
+
+	crtc_state = drm_atomic_get_existing_crtc_state(state->state,
+							state->crtc);
+
+	hdisplay = crtc_state->adjusted_mode.hdisplay;
+	vdisplay = crtc_state->adjusted_mode.vdisplay;
+
+	if (!dcss_plane_is_source_size_allowed(state->src_w >> 16,
+					       state->src_h >> 16,
+					       fb->format->format)) {
+		DRM_DEBUG_KMS("Source plane size is not allowed!\n");
+		return -EINVAL;
+	}
+
+	dcss_scaler_get_min_max_ratios(dcss->scaler, dcss_plane->ch_num,
+				       &min, &max);
+
+	ret = drm_atomic_helper_check_plane_state(state, crtc_state,
+						  min, max, !is_primary_plane,
+						  false);
+	if (ret)
+		return ret;
+
+	if (!state->visible)
+		return 0;
+
+	if (!dcss_plane_can_rotate(fb->format,
+				   !!(fb->flags & DRM_MODE_FB_MODIFIERS),
+				   fb->modifier,
+				   state->rotation)) {
+		DRM_DEBUG_KMS("requested rotation is not allowed!\n");
+		return -EINVAL;
+	}
+
+	if ((state->crtc_x < 0 || state->crtc_y < 0 ||
+	     state->crtc_x + state->crtc_w > hdisplay ||
+	     state->crtc_y + state->crtc_h > vdisplay) &&
+	    !dcss_plane_fb_is_linear(fb)) {
+		DRM_DEBUG_KMS("requested cropping operation is not allowed!\n");
+		return -EINVAL;
+	}
+
+	if ((fb->flags & DRM_MODE_FB_MODIFIERS) &&
+	    !plane->funcs->format_mod_supported(plane,
+				fb->format->format,
+				fb->modifier)) {
+		DRM_DEBUG_KMS("Invalid modifier: %llx", fb->modifier);
+		return -EINVAL;
+	}
+
+	return 0;
+}
+
+static void dcss_plane_atomic_set_base(struct dcss_plane *dcss_plane)
+{
+	struct drm_plane *plane = &dcss_plane->base;
+	struct drm_plane_state *state = plane->state;
+	struct dcss_dev *dcss = plane->dev->dev_private;
+	struct drm_framebuffer *fb = state->fb;
+	const struct drm_format_info *format = fb->format;
+	struct drm_gem_cma_object *cma_obj = drm_fb_cma_get_gem_obj(fb, 0);
+	unsigned long p1_ba = 0, p2_ba = 0;
+
+	if (!format->is_yuv ||
+	    format->format == DRM_FORMAT_NV12 ||
+	    format->format == DRM_FORMAT_NV21)
+		p1_ba = cma_obj->paddr + fb->offsets[0] +
+			fb->pitches[0] * (state->src.y1 >> 16) +
+			format->char_per_block[0] * (state->src.x1 >> 16);
+	else if (format->format == DRM_FORMAT_UYVY ||
+		 format->format == DRM_FORMAT_VYUY ||
+		 format->format == DRM_FORMAT_YUYV ||
+		 format->format == DRM_FORMAT_YVYU)
+		p1_ba = cma_obj->paddr + fb->offsets[0] +
+			fb->pitches[0] * (state->src.y1 >> 16) +
+			2 * format->char_per_block[0] * (state->src.x1 >> 17);
+
+	if (format->format == DRM_FORMAT_NV12 ||
+	    format->format == DRM_FORMAT_NV21)
+		p2_ba = cma_obj->paddr + fb->offsets[1] +
+			(((fb->pitches[1] >> 1) * (state->src.y1 >> 17) +
+			(state->src.x1 >> 17)) << 1);
+
+	dcss_dpr_addr_set(dcss->dpr, dcss_plane->ch_num, p1_ba, p2_ba,
+			  fb->pitches[0]);
+}
+
+static bool dcss_plane_needs_setup(struct drm_plane_state *state,
+				   struct drm_plane_state *old_state)
+{
+	struct drm_framebuffer *fb = state->fb;
+	struct drm_framebuffer *old_fb = old_state->fb;
+
+	return state->crtc_x != old_state->crtc_x ||
+	       state->crtc_y != old_state->crtc_y ||
+	       state->crtc_w != old_state->crtc_w ||
+	       state->crtc_h != old_state->crtc_h ||
+	       state->src_x  != old_state->src_x  ||
+	       state->src_y  != old_state->src_y  ||
+	       state->src_w  != old_state->src_w  ||
+	       state->src_h  != old_state->src_h  ||
+	       fb->format->format != old_fb->format->format ||
+	       fb->modifier  != old_fb->modifier ||
+	       state->rotation != old_state->rotation;
+}
+
+static void dcss_plane_atomic_update(struct drm_plane *plane,
+				     struct drm_plane_state *old_state)
+{
+	struct drm_plane_state *state = plane->state;
+	struct dcss_plane *dcss_plane = to_dcss_plane(plane);
+	struct dcss_dev *dcss = plane->dev->dev_private;
+	struct drm_framebuffer *fb = state->fb;
+	u32 pixel_format;
+	struct drm_crtc_state *crtc_state;
+	bool modifiers_present;
+	u32 src_w, src_h, dst_w, dst_h;
+	struct drm_rect src, dst;
+	bool enable = true;
+
+	if (!fb || !state->crtc || !state->visible)
+		return;
+
+	pixel_format = state->fb->format->format;
+	crtc_state = state->crtc->state;
+	modifiers_present = !!(fb->flags & DRM_MODE_FB_MODIFIERS);
+
+	if (old_state->fb && !drm_atomic_crtc_needs_modeset(crtc_state) &&
+	    !dcss_plane_needs_setup(state, old_state)) {
+		dcss_plane_atomic_set_base(dcss_plane);
+		return;
+	}
+
+	src = plane->state->src;
+	dst = plane->state->dst;
+
+	/*
+	 * The width and height after clipping.
+	 */
+	src_w = drm_rect_width(&src) >> 16;
+	src_h = drm_rect_height(&src) >> 16;
+	dst_w = drm_rect_width(&dst);
+	dst_h = drm_rect_height(&dst);
+
+	if (plane->type == DRM_PLANE_TYPE_OVERLAY &&
+	    modifiers_present && fb->modifier == DRM_FORMAT_MOD_LINEAR)
+		modifiers_present = false;
+
+	dcss_dpr_format_set(dcss->dpr, dcss_plane->ch_num, state->fb->format,
+			    modifiers_present ? fb->modifier :
+						DRM_FORMAT_MOD_LINEAR);
+	dcss_dpr_set_res(dcss->dpr, dcss_plane->ch_num, src_w, src_h);
+	dcss_dpr_set_rotation(dcss->dpr, dcss_plane->ch_num,
+			      state->rotation);
+
+	dcss_plane_atomic_set_base(dcss_plane);
+
+	dcss_scaler_setup(dcss->scaler, dcss_plane->ch_num,
+			  state->fb->format, src_w, src_h,
+			  dst_w, dst_h,
+			  drm_mode_vrefresh(&crtc_state->mode));
+
+	dcss_dtg_plane_pos_set(dcss->dtg, dcss_plane->ch_num,
+			       dst.x1, dst.y1, dst_w, dst_h);
+	dcss_dtg_plane_alpha_set(dcss->dtg, dcss_plane->ch_num,
+				 fb->format, state->alpha >> 8);
+
+	if (!dcss_plane->ch_num && (state->alpha >> 8) == 0)
+		enable = false;
+
+	dcss_dpr_enable(dcss->dpr, dcss_plane->ch_num, enable);
+	dcss_scaler_ch_enable(dcss->scaler, dcss_plane->ch_num, enable);
+
+	if (!enable)
+		dcss_dtg_plane_pos_set(dcss->dtg, dcss_plane->ch_num,
+				       0, 0, 0, 0);
+
+	dcss_dtg_ch_enable(dcss->dtg, dcss_plane->ch_num, enable);
+}
+
+static void dcss_plane_atomic_disable(struct drm_plane *plane,
+				      struct drm_plane_state *old_state)
+{
+	struct dcss_plane *dcss_plane = to_dcss_plane(plane);
+	struct dcss_dev *dcss = plane->dev->dev_private;
+
+	dcss_dpr_enable(dcss->dpr, dcss_plane->ch_num, false);
+	dcss_scaler_ch_enable(dcss->scaler, dcss_plane->ch_num, false);
+	dcss_dtg_plane_pos_set(dcss->dtg, dcss_plane->ch_num, 0, 0, 0, 0);
+	dcss_dtg_ch_enable(dcss->dtg, dcss_plane->ch_num, false);
+}
+
+static const struct drm_plane_helper_funcs dcss_plane_helper_funcs = {
+	.prepare_fb = drm_gem_fb_prepare_fb,
+	.atomic_check = dcss_plane_atomic_check,
+	.atomic_update = dcss_plane_atomic_update,
+	.atomic_disable = dcss_plane_atomic_disable,
+};
+
+struct dcss_plane *dcss_plane_init(struct drm_device *drm,
+				   unsigned int possible_crtcs,
+				   enum drm_plane_type type,
+				   unsigned int zpos)
+{
+	struct dcss_plane *dcss_plane;
+	const u64 *format_modifiers = dcss_video_format_modifiers;
+	int ret;
+
+	if (zpos > 2)
+		return ERR_PTR(-EINVAL);
+
+	dcss_plane = kzalloc(sizeof(*dcss_plane), GFP_KERNEL);
+	if (!dcss_plane) {
+		DRM_ERROR("failed to allocate plane\n");
+		return ERR_PTR(-ENOMEM);
+	}
+
+	if (type == DRM_PLANE_TYPE_PRIMARY)
+		format_modifiers = dcss_graphics_format_modifiers;
+
+	ret = drm_universal_plane_init(drm, &dcss_plane->base, possible_crtcs,
+				       &dcss_plane_funcs, dcss_common_formats,
+				       ARRAY_SIZE(dcss_common_formats),
+				       format_modifiers, type, NULL);
+	if (ret) {
+		DRM_ERROR("failed to initialize plane\n");
+		kfree(dcss_plane);
+		return ERR_PTR(ret);
+	}
+
+	drm_plane_helper_add(&dcss_plane->base, &dcss_plane_helper_funcs);
+
+	ret = drm_plane_create_zpos_immutable_property(&dcss_plane->base, zpos);
+	if (ret)
+		return ERR_PTR(ret);
+
+	drm_plane_create_rotation_property(&dcss_plane->base,
+					   DRM_MODE_ROTATE_0,
+					   DRM_MODE_ROTATE_0   |
+					   DRM_MODE_ROTATE_90  |
+					   DRM_MODE_ROTATE_180 |
+					   DRM_MODE_ROTATE_270 |
+					   DRM_MODE_REFLECT_X  |
+					   DRM_MODE_REFLECT_Y);
+
+	dcss_plane->ch_num = zpos;
+
+	return dcss_plane;
+}
diff --git a/drivers/gpu/drm/imx/dcss/dcss-scaler.c b/drivers/gpu/drm/imx/dcss/dcss-scaler.c
new file mode 100644
index 00000000..3e317f4
--- /dev/null
+++ b/drivers/gpu/drm/imx/dcss/dcss-scaler.c
@@ -0,0 +1,830 @@ 
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright 2019 NXP.
+ *
+ * Scaling algorithms were contributed by Dzung Hoang <dzung.hoang@nxp.com>
+ */
+
+#include <linux/device.h>
+
+#include "dcss-dev.h"
+
+#define DCSS_SCALER_CTRL			0x00
+#define   SCALER_EN				BIT(0)
+#define   REPEAT_EN				BIT(4)
+#define   SCALE2MEM_EN				BIT(8)
+#define   MEM2OFIFO_EN				BIT(12)
+#define DCSS_SCALER_OFIFO_CTRL			0x04
+#define   OFIFO_LOW_THRES_POS			0
+#define   OFIFO_LOW_THRES_MASK			GENMASK(9, 0)
+#define   OFIFO_HIGH_THRES_POS			16
+#define   OFIFO_HIGH_THRES_MASK			GENMASK(25, 16)
+#define   UNDERRUN_DETECT_CLR			BIT(26)
+#define   LOW_THRES_DETECT_CLR			BIT(27)
+#define   HIGH_THRES_DETECT_CLR			BIT(28)
+#define   UNDERRUN_DETECT_EN			BIT(29)
+#define   LOW_THRES_DETECT_EN			BIT(30)
+#define   HIGH_THRES_DETECT_EN			BIT(31)
+#define DCSS_SCALER_SDATA_CTRL			0x08
+#define   YUV_EN				BIT(0)
+#define   RTRAM_8LINES				BIT(1)
+#define   Y_UV_BYTE_SWAP			BIT(4)
+#define   A2R10G10B10_FORMAT_POS		8
+#define   A2R10G10B10_FORMAT_MASK		GENMASK(11, 8)
+#define DCSS_SCALER_BIT_DEPTH			0x0C
+#define   LUM_BIT_DEPTH_POS			0
+#define   LUM_BIT_DEPTH_MASK			GENMASK(1, 0)
+#define   CHR_BIT_DEPTH_POS			4
+#define   CHR_BIT_DEPTH_MASK			GENMASK(5, 4)
+#define DCSS_SCALER_SRC_FORMAT			0x10
+#define DCSS_SCALER_DST_FORMAT			0x14
+#define   FORMAT_MASK				GENMASK(1, 0)
+#define DCSS_SCALER_SRC_LUM_RES			0x18
+#define DCSS_SCALER_SRC_CHR_RES			0x1C
+#define DCSS_SCALER_DST_LUM_RES			0x20
+#define DCSS_SCALER_DST_CHR_RES			0x24
+#define   WIDTH_POS				0
+#define   WIDTH_MASK				GENMASK(11, 0)
+#define   HEIGHT_POS				16
+#define   HEIGHT_MASK				GENMASK(27, 16)
+#define DCSS_SCALER_V_LUM_START			0x48
+#define   V_START_MASK				GENMASK(15, 0)
+#define DCSS_SCALER_V_LUM_INC			0x4C
+#define   V_INC_MASK				GENMASK(15, 0)
+#define DCSS_SCALER_H_LUM_START			0x50
+#define   H_START_MASK				GENMASK(18, 0)
+#define DCSS_SCALER_H_LUM_INC			0x54
+#define   H_INC_MASK				GENMASK(15, 0)
+#define DCSS_SCALER_V_CHR_START			0x58
+#define DCSS_SCALER_V_CHR_INC			0x5C
+#define DCSS_SCALER_H_CHR_START			0x60
+#define DCSS_SCALER_H_CHR_INC			0x64
+#define DCSS_SCALER_COEF_VLUM			0x80
+#define DCSS_SCALER_COEF_HLUM			0x140
+#define DCSS_SCALER_COEF_VCHR			0x200
+#define DCSS_SCALER_COEF_HCHR			0x300
+
+struct dcss_scaler_ch {
+	void __iomem *base_reg;
+	u32 base_ofs;
+	struct dcss_scaler *scl;
+
+	u32 sdata_ctrl;
+	u32 scaler_ctrl;
+
+	bool scaler_ctrl_chgd;
+
+	u32 c_vstart;
+	u32 c_hstart;
+};
+
+struct dcss_scaler {
+	struct device *dev;
+
+	struct dcss_ctxld *ctxld;
+	u32 ctx_id;
+
+	struct dcss_scaler_ch ch[3];
+};
+
+/* scaler coefficients generator */
+#define PSC_FRAC_BITS 30
+#define PSC_FRAC_SCALE BIT(PSC_FRAC_BITS)
+#define PSC_BITS_FOR_PHASE 4
+#define PSC_NUM_PHASES 16
+#define PSC_STORED_PHASES (PSC_NUM_PHASES / 2 + 1)
+#define PSC_NUM_TAPS 7
+#define PSC_NUM_TAPS_RGBA 5
+#define PSC_COEFF_PRECISION 10
+#define PSC_PHASE_FRACTION_BITS 13
+#define PSC_PHASE_MASK (PSC_NUM_PHASES - 1)
+#define PSC_Q_FRACTION 19
+#define PSC_Q_ROUND_OFFSET (1 << (PSC_Q_FRACTION - 1))
+
+/**
+ * mult_q() - Performs fixed-point multiplication.
+ * @A: multiplier
+ * @B: multiplicand
+ */
+static int mult_q(int A, int B)
+{
+	int result;
+	s64 temp;
+
+	temp = (int64_t)A * (int64_t)B;
+	temp += PSC_Q_ROUND_OFFSET;
+	result = (int)(temp >> PSC_Q_FRACTION);
+	return result;
+}
+
+/**
+ * div_q() - Performs fixed-point division.
+ * @A: dividend
+ * @B: divisor
+ */
+static int div_q(int A, int B)
+{
+	int result;
+	s64 temp;
+
+	temp = (int64_t)A << PSC_Q_FRACTION;
+	if ((temp >= 0 && B >= 0) || (temp < 0 && B < 0))
+		temp += B / 2;
+	else
+		temp -= B / 2;
+
+	result = (int)(temp / B);
+	return result;
+}
+
+/**
+ * exp_approx_q() - Compute approximation to exp(x) function using Taylor
+ *		    series.
+ * @x: fixed-point argument of exp function
+ */
+static int exp_approx_q(int x)
+{
+	int sum = 1 << PSC_Q_FRACTION;
+	int term = 1 << PSC_Q_FRACTION;
+
+	term = mult_q(term, div_q(x, 1 << PSC_Q_FRACTION));
+	sum += term;
+	term = mult_q(term, div_q(x, 2 << PSC_Q_FRACTION));
+	sum += term;
+	term = mult_q(term, div_q(x, 3 << PSC_Q_FRACTION));
+	sum += term;
+	term = mult_q(term, div_q(x, 4 << PSC_Q_FRACTION));
+	sum += term;
+
+	return sum;
+}
+
+/**
+ * dcss_scaler_gaussian_filter() - Generate gaussian prototype filter.
+ * @fc_q: fixed-point cutoff frequency normalized to range [0, 1]
+ * @use_5_taps: indicates whether to use 5 taps or 7 taps
+ * @coef: output filter coefficients
+ */
+static void dcss_scaler_gaussian_filter(int fc_q, bool use_5_taps,
+					bool phase0_identity,
+					int coef[][PSC_NUM_TAPS])
+{
+	int sigma_q, g0_q, g1_q, g2_q;
+	int tap_cnt1, tap_cnt2, tap_idx, phase_cnt;
+	int mid;
+	int phase;
+	int i;
+	int taps;
+
+	if (use_5_taps)
+		for (phase = 0; phase < PSC_STORED_PHASES; phase++) {
+			coef[phase][0] = 0;
+			coef[phase][PSC_NUM_TAPS - 1] = 0;
+		}
+
+	/* seed coefficient scanner */
+	taps = use_5_taps ? PSC_NUM_TAPS_RGBA : PSC_NUM_TAPS;
+	mid = (PSC_NUM_PHASES * taps) / 2 - 1;
+	phase_cnt = (PSC_NUM_PHASES * (PSC_NUM_TAPS + 1)) / 2;
+	tap_cnt1 = (PSC_NUM_PHASES * PSC_NUM_TAPS) / 2;
+	tap_cnt2 = (PSC_NUM_PHASES * PSC_NUM_TAPS) / 2;
+
+	/* seed gaussian filter generator */
+	sigma_q = div_q(PSC_Q_ROUND_OFFSET, fc_q);
+	g0_q = 1 << PSC_Q_FRACTION;
+	g1_q = exp_approx_q(div_q(-PSC_Q_ROUND_OFFSET,
+				  mult_q(sigma_q, sigma_q)));
+	g2_q = mult_q(g1_q, g1_q);
+	coef[phase_cnt & PSC_PHASE_MASK][tap_cnt1 >> PSC_BITS_FOR_PHASE] = g0_q;
+
+	for (i = 0; i < mid; i++) {
+		phase_cnt++;
+		tap_cnt1--;
+		tap_cnt2++;
+
+		g0_q = mult_q(g0_q, g1_q);
+		g1_q = mult_q(g1_q, g2_q);
+
+		if ((phase_cnt & PSC_PHASE_MASK) <= 8) {
+			tap_idx = tap_cnt1 >> PSC_BITS_FOR_PHASE;
+			coef[phase_cnt & PSC_PHASE_MASK][tap_idx] = g0_q;
+		}
+		if (((-phase_cnt) & PSC_PHASE_MASK) <= 8) {
+			tap_idx = tap_cnt2 >> PSC_BITS_FOR_PHASE;
+			coef[(-phase_cnt) & PSC_PHASE_MASK][tap_idx] = g0_q;
+		}
+	}
+
+	phase_cnt++;
+	tap_cnt1--;
+	coef[phase_cnt & PSC_PHASE_MASK][tap_cnt1 >> PSC_BITS_FOR_PHASE] = 0;
+
+	/* override phase 0 with identity filter if specified */
+	if (phase0_identity)
+		for (i = 0; i < PSC_NUM_TAPS; i++)
+			coef[0][i] = i == (PSC_NUM_TAPS >> 1) ?
+						(1 << PSC_COEFF_PRECISION) : 0;
+
+	/* normalize coef */
+	for (phase = 0; phase < PSC_STORED_PHASES; phase++) {
+		int sum = 0;
+		s64 ll_temp;
+
+		for (i = 0; i < PSC_NUM_TAPS; i++)
+			sum += coef[phase][i];
+		for (i = 0; i < PSC_NUM_TAPS; i++) {
+			ll_temp = coef[phase][i];
+			ll_temp <<= PSC_COEFF_PRECISION;
+			ll_temp += sum >> 1;
+			ll_temp /= sum;
+			coef[phase][i] = (int)ll_temp;
+		}
+	}
+}
+
+/**
+ * dcss_scaler_filter_design() - Compute filter coefficients using
+ *				 Gaussian filter.
+ * @src_length: length of input
+ * @dst_length: length of output
+ * @use_5_taps: 0 for 7 taps per phase, 1 for 5 taps
+ * @coef: output coefficients
+ */
+static void dcss_scaler_filter_design(int src_length, int dst_length,
+				      bool use_5_taps, bool phase0_identity,
+				      int coef[][PSC_NUM_TAPS])
+{
+	int fc_q;
+
+	/* compute cutoff frequency */
+	if (dst_length >= src_length)
+		fc_q = div_q(1, PSC_NUM_PHASES);
+	else
+		fc_q = div_q(dst_length, src_length * PSC_NUM_PHASES);
+
+	/* compute gaussian filter coefficients */
+	dcss_scaler_gaussian_filter(fc_q, use_5_taps, phase0_identity, coef);
+}
+
+static void dcss_scaler_write(struct dcss_scaler_ch *ch, u32 val, u32 ofs)
+{
+	struct dcss_scaler *scl = ch->scl;
+
+	dcss_ctxld_write(scl->ctxld, scl->ctx_id, val, ch->base_ofs + ofs);
+}
+
+static int dcss_scaler_ch_init_all(struct dcss_scaler *scl,
+				   unsigned long scaler_base)
+{
+	struct dcss_scaler_ch *ch;
+	int i;
+
+	for (i = 0; i < 3; i++) {
+		ch = &scl->ch[i];
+
+		ch->base_ofs = scaler_base + i * 0x400;
+
+		ch->base_reg = devm_ioremap(scl->dev, ch->base_ofs, SZ_4K);
+		if (!ch->base_reg) {
+			dev_err(scl->dev, "scaler: unable to remap ch base\n");
+			return -ENOMEM;
+		}
+
+		ch->scl = scl;
+	}
+
+	return 0;
+}
+
+int dcss_scaler_init(struct dcss_dev *dcss, unsigned long scaler_base)
+{
+	struct dcss_scaler *scaler;
+
+	scaler = devm_kzalloc(dcss->dev, sizeof(*scaler), GFP_KERNEL);
+	if (!scaler)
+		return -ENOMEM;
+
+	dcss->scaler = scaler;
+	scaler->dev = dcss->dev;
+	scaler->ctxld = dcss->ctxld;
+	scaler->ctx_id = CTX_SB_HP;
+
+	if (dcss_scaler_ch_init_all(scaler, scaler_base)) {
+		int i;
+
+		for (i = 0; i < 3; i++) {
+			if (scaler->ch[i].base_reg)
+				devm_iounmap(scaler->dev,
+					     scaler->ch[i].base_reg);
+		}
+
+		devm_kfree(scaler->dev, scaler);
+
+		return -ENOMEM;
+	}
+
+	return 0;
+}
+
+void dcss_scaler_exit(struct dcss_scaler *scl)
+{
+	int ch_no;
+
+	for (ch_no = 0; ch_no < 3; ch_no++) {
+		struct dcss_scaler_ch *ch = &scl->ch[ch_no];
+
+		dcss_writel(0, ch->base_reg + DCSS_SCALER_CTRL);
+
+		if (ch->base_reg)
+			devm_iounmap(scl->dev, ch->base_reg);
+	}
+
+	devm_kfree(scl->dev, scl);
+}
+
+void dcss_scaler_ch_enable(struct dcss_scaler *scl, int ch_num, bool en)
+{
+	struct dcss_scaler_ch *ch = &scl->ch[ch_num];
+	u32 scaler_ctrl;
+
+	scaler_ctrl = en ? SCALER_EN | REPEAT_EN : 0;
+
+	if (en)
+		dcss_scaler_write(ch, ch->sdata_ctrl, DCSS_SCALER_SDATA_CTRL);
+
+	if (ch->scaler_ctrl != scaler_ctrl)
+		ch->scaler_ctrl_chgd = true;
+
+	ch->scaler_ctrl = scaler_ctrl;
+}
+
+static void dcss_scaler_yuv_enable(struct dcss_scaler_ch *ch, bool en)
+{
+	ch->sdata_ctrl &= ~YUV_EN;
+	ch->sdata_ctrl |= en ? YUV_EN : 0;
+}
+
+static void dcss_scaler_rtr_8lines_enable(struct dcss_scaler_ch *ch, bool en)
+{
+	ch->sdata_ctrl &= ~RTRAM_8LINES;
+	ch->sdata_ctrl |= en ? RTRAM_8LINES : 0;
+}
+
+static void dcss_scaler_bit_depth_set(struct dcss_scaler_ch *ch, int depth)
+{
+	u32 val;
+
+	val = depth == 30 ? 2 : 0;
+
+	dcss_scaler_write(ch,
+			  ((val << CHR_BIT_DEPTH_POS) & CHR_BIT_DEPTH_MASK) |
+			  ((val << LUM_BIT_DEPTH_POS) & LUM_BIT_DEPTH_MASK),
+			  DCSS_SCALER_BIT_DEPTH);
+}
+
+enum buffer_format {
+	BUF_FMT_YUV420,
+	BUF_FMT_YUV422,
+	BUF_FMT_ARGB8888_YUV444,
+};
+
+enum chroma_location {
+	PSC_LOC_HORZ_0_VERT_1_OVER_4 = 0,
+	PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_4 = 1,
+	PSC_LOC_HORZ_0_VERT_0 = 2,
+	PSC_LOC_HORZ_1_OVER_4_VERT_0 = 3,
+	PSC_LOC_HORZ_0_VERT_1_OVER_2 = 4,
+	PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_2 = 5
+};
+
+static void dcss_scaler_format_set(struct dcss_scaler_ch *ch,
+				   enum buffer_format src_fmt,
+				   enum buffer_format dst_fmt)
+{
+	dcss_scaler_write(ch, src_fmt, DCSS_SCALER_SRC_FORMAT);
+	dcss_scaler_write(ch, dst_fmt, DCSS_SCALER_DST_FORMAT);
+}
+
+static void dcss_scaler_res_set(struct dcss_scaler_ch *ch,
+				int src_xres, int src_yres,
+				int dst_xres, int dst_yres,
+				u32 pix_format, enum buffer_format dst_format)
+{
+	u32 lsrc_xres, lsrc_yres, csrc_xres, csrc_yres;
+	u32 ldst_xres, ldst_yres, cdst_xres, cdst_yres;
+	bool src_is_444 = true;
+
+	lsrc_xres = src_xres;
+	csrc_xres = src_xres;
+	lsrc_yres = src_yres;
+	csrc_yres = src_yres;
+	ldst_xres = dst_xres;
+	cdst_xres = dst_xres;
+	ldst_yres = dst_yres;
+	cdst_yres = dst_yres;
+
+	if (pix_format == DRM_FORMAT_UYVY || pix_format == DRM_FORMAT_VYUY ||
+	    pix_format == DRM_FORMAT_YUYV || pix_format == DRM_FORMAT_YVYU) {
+		csrc_xres >>= 1;
+		src_is_444 = false;
+	} else if (pix_format == DRM_FORMAT_NV12 ||
+		   pix_format == DRM_FORMAT_NV21) {
+		csrc_xres >>= 1;
+		csrc_yres >>= 1;
+		src_is_444 = false;
+	}
+
+	if (dst_format == BUF_FMT_YUV422)
+		cdst_xres >>= 1;
+
+	/* for 4:4:4 to 4:2:2 conversion, source height should be 1 less */
+	if (src_is_444 && dst_format == BUF_FMT_YUV422) {
+		lsrc_yres--;
+		csrc_yres--;
+	}
+
+	dcss_scaler_write(ch, (((lsrc_yres - 1) << HEIGHT_POS) & HEIGHT_MASK) |
+			       (((lsrc_xres - 1) << WIDTH_POS) & WIDTH_MASK),
+			  DCSS_SCALER_SRC_LUM_RES);
+	dcss_scaler_write(ch, (((csrc_yres - 1) << HEIGHT_POS) & HEIGHT_MASK) |
+			       (((csrc_xres - 1) << WIDTH_POS) & WIDTH_MASK),
+			  DCSS_SCALER_SRC_CHR_RES);
+	dcss_scaler_write(ch, (((ldst_yres - 1) << HEIGHT_POS) & HEIGHT_MASK) |
+			       (((ldst_xres - 1) << WIDTH_POS) & WIDTH_MASK),
+			  DCSS_SCALER_DST_LUM_RES);
+	dcss_scaler_write(ch, (((cdst_yres - 1) << HEIGHT_POS) & HEIGHT_MASK) |
+			       (((cdst_xres - 1) << WIDTH_POS) & WIDTH_MASK),
+			  DCSS_SCALER_DST_CHR_RES);
+}
+
+#define max_downscale(ratio)		((ratio) << 16)
+#define max_upscale(ratio)		((1 << 16) / (ratio))
+
+struct dcss_scaler_ratios {
+	int downscale;
+	int upscale;
+};
+
+static const struct dcss_scaler_ratios dcss_scaler_ratios[] = {
+	{max_downscale(3), max_upscale(8)},
+	{max_downscale(5), max_upscale(8)},
+	{max_downscale(5), max_upscale(8)},
+};
+
+static void dcss_scaler_fractions_set(struct dcss_scaler_ch *ch,
+				      int src_xres, int src_yres,
+				      int dst_xres, int dst_yres,
+				      u32 src_format, u32 dst_format,
+				      enum chroma_location src_chroma_loc)
+{
+	int src_c_xres, src_c_yres, dst_c_xres, dst_c_yres;
+	u32 l_vinc, l_hinc, c_vinc, c_hinc;
+	u32 c_vstart, c_hstart;
+
+	src_c_xres = src_xres;
+	src_c_yres = src_yres;
+	dst_c_xres = dst_xres;
+	dst_c_yres = dst_yres;
+
+	c_vstart = 0;
+	c_hstart = 0;
+
+	/* adjustments for source chroma location */
+	if (src_format == BUF_FMT_YUV420) {
+		/* vertical input chroma position adjustment */
+		switch (src_chroma_loc) {
+		case PSC_LOC_HORZ_0_VERT_1_OVER_4:
+		case PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_4:
+			/*
+			 * move chroma up to first luma line
+			 * (1/4 chroma input line spacing)
+			 */
+			c_vstart -= (1 << (PSC_PHASE_FRACTION_BITS - 2));
+			break;
+		case PSC_LOC_HORZ_0_VERT_1_OVER_2:
+		case PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_2:
+			/*
+			 * move chroma up to first luma line
+			 * (1/2 chroma input line spacing)
+			 */
+			c_vstart -= (1 << (PSC_PHASE_FRACTION_BITS - 1));
+			break;
+		default:
+			break;
+		}
+		/* horizontal input chroma position adjustment */
+		switch (src_chroma_loc) {
+		case PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_4:
+		case PSC_LOC_HORZ_1_OVER_4_VERT_0:
+		case PSC_LOC_HORZ_1_OVER_4_VERT_1_OVER_2:
+			/* move chroma left 1/4 chroma input sample spacing */
+			c_hstart -= (1 << (PSC_PHASE_FRACTION_BITS - 2));
+			break;
+		default:
+			break;
+		}
+	}
+
+	/* adjustments to chroma resolution */
+	if (src_format == BUF_FMT_YUV420) {
+		src_c_xres >>= 1;
+		src_c_yres >>= 1;
+	} else if (src_format == BUF_FMT_YUV422) {
+		src_c_xres >>= 1;
+	}
+
+	if (dst_format == BUF_FMT_YUV422)
+		dst_c_xres >>= 1;
+
+	l_vinc = ((src_yres << 13) + (dst_yres >> 1)) / dst_yres;
+	c_vinc = ((src_c_yres << 13) + (dst_c_yres >> 1)) / dst_c_yres;
+	l_hinc = ((src_xres << 13) + (dst_xres >> 1)) / dst_xres;
+	c_hinc = ((src_c_xres << 13) + (dst_c_xres >> 1)) / dst_c_xres;
+
+	/* save chroma start phase */
+	ch->c_vstart = c_vstart;
+	ch->c_hstart = c_hstart;
+
+	dcss_scaler_write(ch, 0, DCSS_SCALER_V_LUM_START);
+	dcss_scaler_write(ch, l_vinc, DCSS_SCALER_V_LUM_INC);
+
+	dcss_scaler_write(ch, 0, DCSS_SCALER_H_LUM_START);
+	dcss_scaler_write(ch, l_hinc, DCSS_SCALER_H_LUM_INC);
+
+	dcss_scaler_write(ch, c_vstart, DCSS_SCALER_V_CHR_START);
+	dcss_scaler_write(ch, c_vinc, DCSS_SCALER_V_CHR_INC);
+
+	dcss_scaler_write(ch, c_hstart, DCSS_SCALER_H_CHR_START);
+	dcss_scaler_write(ch, c_hinc, DCSS_SCALER_H_CHR_INC);
+}
+
+int dcss_scaler_get_min_max_ratios(struct dcss_scaler *scl, int ch_num,
+				   int *min, int *max)
+{
+	*min = dcss_scaler_ratios[ch_num].upscale;
+	*max = dcss_scaler_ratios[ch_num].downscale;
+
+	return 0;
+}
+
+static void dcss_scaler_program_5_coef_set(struct dcss_scaler_ch *ch,
+					   int base_addr,
+					   int coef[][PSC_NUM_TAPS])
+{
+	int i, phase;
+
+	for (i = 0; i < PSC_STORED_PHASES; i++) {
+		dcss_scaler_write(ch, ((coef[i][1] & 0xfff) << 16 |
+				       (coef[i][2] & 0xfff) << 4  |
+				       (coef[i][3] & 0xf00) >> 8),
+				  base_addr + i * sizeof(u32));
+		dcss_scaler_write(ch, ((coef[i][3] & 0x0ff) << 20 |
+				       (coef[i][4] & 0xfff) << 8  |
+				       (coef[i][5] & 0xff0) >> 4),
+				  base_addr + 0x40 + i * sizeof(u32));
+		dcss_scaler_write(ch, ((coef[i][5] & 0x00f) << 24),
+				  base_addr + 0x80 + i * sizeof(u32));
+	}
+
+	/* reverse both phase and tap orderings */
+	for (phase = (PSC_NUM_PHASES >> 1) - 1;
+			i < PSC_NUM_PHASES; i++, phase--) {
+		dcss_scaler_write(ch, ((coef[phase][5] & 0xfff) << 16 |
+				       (coef[phase][4] & 0xfff) << 4  |
+				       (coef[phase][3] & 0xf00) >> 8),
+				  base_addr + i * sizeof(u32));
+		dcss_scaler_write(ch, ((coef[phase][3] & 0x0ff) << 20 |
+				       (coef[phase][2] & 0xfff) << 8  |
+				       (coef[phase][1] & 0xff0) >> 4),
+				  base_addr + 0x40 + i * sizeof(u32));
+		dcss_scaler_write(ch, ((coef[phase][1] & 0x00f) << 24),
+				  base_addr + 0x80 + i * sizeof(u32));
+	}
+}
+
+static void dcss_scaler_program_7_coef_set(struct dcss_scaler_ch *ch,
+					   int base_addr,
+					   int coef[][PSC_NUM_TAPS])
+{
+	int i, phase;
+
+	for (i = 0; i < PSC_STORED_PHASES; i++) {
+		dcss_scaler_write(ch, ((coef[i][0] & 0xfff) << 16 |
+				       (coef[i][1] & 0xfff) << 4  |
+				       (coef[i][2] & 0xf00) >> 8),
+				  base_addr + i * sizeof(u32));
+		dcss_scaler_write(ch, ((coef[i][2] & 0x0ff) << 20 |
+				       (coef[i][3] & 0xfff) << 8  |
+				       (coef[i][4] & 0xff0) >> 4),
+				  base_addr + 0x40 + i * sizeof(u32));
+		dcss_scaler_write(ch, ((coef[i][4] & 0x00f) << 24 |
+				       (coef[i][5] & 0xfff) << 12 |
+				       (coef[i][6] & 0xfff)),
+				  base_addr + 0x80 + i * sizeof(u32));
+	}
+
+	/* reverse both phase and tap orderings */
+	for (phase = (PSC_NUM_PHASES >> 1) - 1;
+			i < PSC_NUM_PHASES; i++, phase--) {
+		dcss_scaler_write(ch, ((coef[phase][6] & 0xfff) << 16 |
+				       (coef[phase][5] & 0xfff) << 4  |
+				       (coef[phase][4] & 0xf00) >> 8),
+				  base_addr + i * sizeof(u32));
+		dcss_scaler_write(ch, ((coef[phase][4] & 0x0ff) << 20 |
+				       (coef[phase][3] & 0xfff) << 8  |
+				       (coef[phase][2] & 0xff0) >> 4),
+				  base_addr + 0x40 + i * sizeof(u32));
+		dcss_scaler_write(ch, ((coef[phase][2] & 0x00f) << 24 |
+				       (coef[phase][1] & 0xfff) << 12 |
+				       (coef[phase][0] & 0xfff)),
+				  base_addr + 0x80 + i * sizeof(u32));
+	}
+}
+
+static void dcss_scaler_yuv_coef_set(struct dcss_scaler_ch *ch,
+				     enum buffer_format src_format,
+				     enum buffer_format dst_format,
+				     bool use_5_taps,
+				     int src_xres, int src_yres, int dst_xres,
+				     int dst_yres)
+{
+	int coef[PSC_STORED_PHASES][PSC_NUM_TAPS];
+	bool program_5_taps = use_5_taps ||
+			      (dst_format == BUF_FMT_YUV422 &&
+			       src_format == BUF_FMT_ARGB8888_YUV444);
+
+	/* horizontal luma */
+	dcss_scaler_filter_design(src_xres, dst_xres, false,
+				  src_xres == dst_xres, coef);
+	dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_HLUM, coef);
+
+	/* vertical luma */
+	dcss_scaler_filter_design(src_yres, dst_yres, program_5_taps,
+				  src_yres == dst_yres, coef);
+
+	if (program_5_taps)
+		dcss_scaler_program_5_coef_set(ch, DCSS_SCALER_COEF_VLUM, coef);
+	else
+		dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_VLUM, coef);
+
+	/* adjust chroma resolution */
+	if (src_format != BUF_FMT_ARGB8888_YUV444)
+		src_xres >>= 1;
+	if (src_format == BUF_FMT_YUV420)
+		src_yres >>= 1;
+	if (dst_format != BUF_FMT_ARGB8888_YUV444)
+		dst_xres >>= 1;
+	if (dst_format == BUF_FMT_YUV420) /* should not happen */
+		dst_yres >>= 1;
+
+	/* horizontal chroma */
+	dcss_scaler_filter_design(src_xres, dst_xres, false,
+				  (src_xres == dst_xres) && (ch->c_hstart == 0),
+				  coef);
+
+	dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_HCHR, coef);
+
+	/* vertical chroma */
+	dcss_scaler_filter_design(src_yres, dst_yres, program_5_taps,
+				  (src_yres == dst_yres) && (ch->c_vstart == 0),
+				  coef);
+	if (program_5_taps)
+		dcss_scaler_program_5_coef_set(ch, DCSS_SCALER_COEF_VCHR, coef);
+	else
+		dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_VCHR, coef);
+}
+
+static void dcss_scaler_rgb_coef_set(struct dcss_scaler_ch *ch,
+				     int src_xres, int src_yres, int dst_xres,
+				     int dst_yres)
+{
+	int coef[PSC_STORED_PHASES][PSC_NUM_TAPS];
+
+	/* horizontal RGB */
+	dcss_scaler_filter_design(src_xres, dst_xres, false,
+				  src_xres == dst_xres, coef);
+	dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_HLUM, coef);
+
+	/* vertical RGB */
+	dcss_scaler_filter_design(src_yres, dst_yres, false,
+				  src_yres == dst_yres, coef);
+	dcss_scaler_program_7_coef_set(ch, DCSS_SCALER_COEF_VLUM, coef);
+}
+
+static void dcss_scaler_set_rgb10_order(struct dcss_scaler_ch *ch,
+					const struct drm_format_info *format)
+{
+	u32 a2r10g10b10_format;
+
+	if (format->is_yuv)
+		return;
+
+	ch->sdata_ctrl &= ~A2R10G10B10_FORMAT_MASK;
+
+	if (format->depth != 30)
+		return;
+
+	switch (format->format) {
+	case DRM_FORMAT_ARGB2101010:
+	case DRM_FORMAT_XRGB2101010:
+		a2r10g10b10_format = 0;
+		break;
+
+	case DRM_FORMAT_ABGR2101010:
+	case DRM_FORMAT_XBGR2101010:
+		a2r10g10b10_format = 5;
+		break;
+
+	case DRM_FORMAT_RGBA1010102:
+	case DRM_FORMAT_RGBX1010102:
+		a2r10g10b10_format = 6;
+		break;
+
+	case DRM_FORMAT_BGRA1010102:
+	case DRM_FORMAT_BGRX1010102:
+		a2r10g10b10_format = 11;
+		break;
+
+	default:
+		a2r10g10b10_format = 0;
+		break;
+	}
+
+	ch->sdata_ctrl |= a2r10g10b10_format << A2R10G10B10_FORMAT_POS;
+}
+
+void dcss_scaler_setup(struct dcss_scaler *scl, int ch_num,
+		       const struct drm_format_info *format,
+		       int src_xres, int src_yres, int dst_xres, int dst_yres,
+		       u32 vrefresh_hz)
+{
+	struct dcss_scaler_ch *ch = &scl->ch[ch_num];
+	unsigned int pixel_depth = 0;
+	bool rtr_8line_en = false;
+	bool use_5_taps = false;
+	enum buffer_format src_format = BUF_FMT_ARGB8888_YUV444;
+	enum buffer_format dst_format = BUF_FMT_ARGB8888_YUV444;
+	u32 pix_format = format->format;
+
+	if (format->is_yuv) {
+		dcss_scaler_yuv_enable(ch, true);
+
+		if (pix_format == DRM_FORMAT_NV12 ||
+		    pix_format == DRM_FORMAT_NV21 ||
+		    pix_format == DRM_FORMAT_P010) {
+			rtr_8line_en = true;
+			src_format = BUF_FMT_YUV420;
+		} else if (pix_format == DRM_FORMAT_UYVY ||
+			   pix_format == DRM_FORMAT_VYUY ||
+			   pix_format == DRM_FORMAT_YUYV ||
+			   pix_format == DRM_FORMAT_YVYU) {
+			src_format = BUF_FMT_YUV422;
+		}
+
+		use_5_taps = !rtr_8line_en;
+		if (pix_format == DRM_FORMAT_P010)
+			pixel_depth = 30;
+
+	} else {
+		dcss_scaler_yuv_enable(ch, false);
+
+		pixel_depth = format->depth;
+	}
+
+	dcss_scaler_fractions_set(ch, src_xres, src_yres, dst_xres,
+				  dst_yres, src_format, dst_format,
+				  PSC_LOC_HORZ_0_VERT_1_OVER_4);
+
+	if (format->is_yuv)
+		dcss_scaler_yuv_coef_set(ch, src_format, dst_format,
+					 use_5_taps, src_xres, src_yres,
+					 dst_xres, dst_yres);
+	else
+		dcss_scaler_rgb_coef_set(ch, src_xres, src_yres,
+					 dst_xres, dst_yres);
+
+	dcss_scaler_rtr_8lines_enable(ch, rtr_8line_en);
+	dcss_scaler_bit_depth_set(ch, pixel_depth);
+	dcss_scaler_set_rgb10_order(ch, format);
+	dcss_scaler_format_set(ch, src_format, dst_format);
+	dcss_scaler_res_set(ch, src_xres, src_yres, dst_xres, dst_yres,
+			    pix_format, dst_format);
+}
+
+/* This function will be called from interrupt context. */
+void dcss_scaler_write_sclctrl(struct dcss_scaler *scl)
+{
+	int chnum;
+
+	for (chnum = 0; chnum < 3; chnum++) {
+		struct dcss_scaler_ch *ch = &scl->ch[chnum];
+
+		if (ch->scaler_ctrl_chgd) {
+			dcss_ctxld_write_irqsafe(scl->ctxld, scl->ctx_id,
+						 ch->scaler_ctrl,
+						 ch->base_ofs +
+						 DCSS_SCALER_CTRL);
+			ch->scaler_ctrl_chgd = false;
+		}
+	}
+}
diff --git a/drivers/gpu/drm/imx/dcss/dcss-ss.c b/drivers/gpu/drm/imx/dcss/dcss-ss.c
new file mode 100644
index 00000000..65a05c2
--- /dev/null
+++ b/drivers/gpu/drm/imx/dcss/dcss-ss.c
@@ -0,0 +1,179 @@ 
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Copyright 2019 NXP.
+ */
+
+#include <linux/device.h>
+
+#include "dcss-dev.h"
+
+#define DCSS_SS_SYS_CTRL			0x00
+#define   RUN_EN				BIT(0)
+#define DCSS_SS_DISPLAY				0x10
+#define   LRC_X_POS				0
+#define   LRC_X_MASK				GENMASK(12, 0)
+#define   LRC_Y_POS				16
+#define   LRC_Y_MASK				GENMASK(28, 16)
+#define DCSS_SS_HSYNC				0x20
+#define DCSS_SS_VSYNC				0x30
+#define   SYNC_START_POS			0
+#define   SYNC_START_MASK			GENMASK(12, 0)
+#define   SYNC_END_POS				16
+#define   SYNC_END_MASK				GENMASK(28, 16)
+#define   SYNC_POL				BIT(31)
+#define DCSS_SS_DE_ULC				0x40
+#define   ULC_X_POS				0
+#define   ULC_X_MASK				GENMASK(12, 0)
+#define   ULC_Y_POS				16
+#define   ULC_Y_MASK				GENMASK(28, 16)
+#define   ULC_POL				BIT(31)
+#define DCSS_SS_DE_LRC				0x50
+#define DCSS_SS_MODE				0x60
+#define   PIPE_MODE_POS				0
+#define   PIPE_MODE_MASK			GENMASK(1, 0)
+#define DCSS_SS_COEFF				0x70
+#define   HORIZ_A_POS				0
+#define   HORIZ_A_MASK				GENMASK(3, 0)
+#define   HORIZ_B_POS				4
+#define   HORIZ_B_MASK				GENMASK(7, 4)
+#define   HORIZ_C_POS				8
+#define   HORIZ_C_MASK				GENMASK(11, 8)
+#define   HORIZ_H_NORM_POS			12
+#define   HORIZ_H_NORM_MASK			GENMASK(14, 12)
+#define   VERT_A_POS				16
+#define   VERT_A_MASK				GENMASK(19, 16)
+#define   VERT_B_POS				20
+#define   VERT_B_MASK				GENMASK(23, 20)
+#define   VERT_C_POS				24
+#define   VERT_C_MASK				GENMASK(27, 24)
+#define   VERT_H_NORM_POS			28
+#define   VERT_H_NORM_MASK			GENMASK(30, 28)
+#define DCSS_SS_CLIP_CB				0x80
+#define DCSS_SS_CLIP_CR				0x90
+#define   CLIP_MIN_POS				0
+#define   CLIP_MIN_MASK				GENMASK(9, 0)
+#define   CLIP_MAX_POS				0
+#define   CLIP_MAX_MASK				GENMASK(23, 16)
+#define DCSS_SS_INTER_MODE			0xA0
+#define   INT_EN				BIT(0)
+#define   VSYNC_SHIFT				BIT(1)
+
+struct dcss_ss {
+	struct device *dev;
+	void __iomem *base_reg;
+	u32 base_ofs;
+
+	struct dcss_ctxld *ctxld;
+	u32 ctx_id;
+
+	bool in_use;
+};
+
+static void dcss_ss_write(struct dcss_ss *ss, u32 val, u32 ofs)
+{
+	if (!ss->in_use)
+		dcss_writel(val, ss->base_reg + ofs);
+
+	dcss_ctxld_write(ss->ctxld, ss->ctx_id, val,
+			 ss->base_ofs + ofs);
+}
+
+int dcss_ss_init(struct dcss_dev *dcss, unsigned long ss_base)
+{
+	struct dcss_ss *ss;
+
+	ss = devm_kzalloc(dcss->dev, sizeof(*ss), GFP_KERNEL);
+	if (!ss)
+		return -ENOMEM;
+
+	dcss->ss = ss;
+	ss->dev = dcss->dev;
+	ss->ctxld = dcss->ctxld;
+
+	ss->base_reg = devm_ioremap(dcss->dev, ss_base, SZ_4K);
+	if (!ss->base_reg) {
+		dev_err(dcss->dev, "ss: unable to remap ss base\n");
+		devm_kfree(ss->dev, ss);
+		return -ENOMEM;
+	}
+
+	ss->base_ofs = ss_base;
+	ss->ctx_id = CTX_SB_HP;
+
+	return 0;
+}
+
+void dcss_ss_exit(struct dcss_ss *ss)
+{
+	/* stop SS */
+	dcss_writel(0, ss->base_reg + DCSS_SS_SYS_CTRL);
+
+	if (ss->base_reg)
+		devm_iounmap(ss->dev, ss->base_reg);
+
+	devm_kfree(ss->dev, ss);
+}
+
+void dcss_ss_subsam_set(struct dcss_ss *ss)
+{
+	dcss_ss_write(ss, 0x41614161, DCSS_SS_COEFF);
+	dcss_ss_write(ss, 0, DCSS_SS_MODE);
+	dcss_ss_write(ss, 0x03ff0000, DCSS_SS_CLIP_CB);
+	dcss_ss_write(ss, 0x03ff0000, DCSS_SS_CLIP_CR);
+}
+
+void dcss_ss_sync_set(struct dcss_ss *ss, struct videomode *vm,
+		      bool phsync, bool pvsync)
+{
+	u16 lrc_x, lrc_y;
+	u16 hsync_start, hsync_end;
+	u16 vsync_start, vsync_end;
+	u16 de_ulc_x, de_ulc_y;
+	u16 de_lrc_x, de_lrc_y;
+
+	lrc_x = vm->hfront_porch + vm->hback_porch + vm->hsync_len +
+		vm->hactive - 1;
+	lrc_y = vm->vfront_porch + vm->vback_porch + vm->vsync_len +
+		vm->vactive - 1;
+
+	dcss_ss_write(ss, (lrc_y << LRC_Y_POS) | lrc_x, DCSS_SS_DISPLAY);
+
+	hsync_start = vm->hfront_porch + vm->hback_porch + vm->hsync_len +
+		      vm->hactive - 1;
+	hsync_end = vm->hsync_len - 1;
+
+	dcss_ss_write(ss, (phsync ? SYNC_POL : 0) |
+		      ((u32)hsync_end << SYNC_END_POS) | hsync_start,
+		      DCSS_SS_HSYNC);
+
+	vsync_start = vm->vfront_porch - 1;
+	vsync_end = vm->vfront_porch + vm->vsync_len - 1;
+
+	dcss_ss_write(ss, (pvsync ? SYNC_POL : 0) |
+		      ((u32)vsync_end << SYNC_END_POS) | vsync_start,
+		      DCSS_SS_VSYNC);
+
+	de_ulc_x = vm->hsync_len + vm->hback_porch - 1;
+	de_ulc_y = vm->vsync_len + vm->vfront_porch + vm->vback_porch;
+
+	dcss_ss_write(ss, SYNC_POL | ((u32)de_ulc_y << ULC_Y_POS) | de_ulc_x,
+		      DCSS_SS_DE_ULC);
+
+	de_lrc_x = vm->hsync_len + vm->hback_porch + vm->hactive - 1;
+	de_lrc_y = vm->vsync_len + vm->vfront_porch + vm->vback_porch +
+		   vm->vactive - 1;
+
+	dcss_ss_write(ss, (de_lrc_y << LRC_Y_POS) | de_lrc_x, DCSS_SS_DE_LRC);
+}
+
+void dcss_ss_enable(struct dcss_ss *ss)
+{
+	dcss_ss_write(ss, RUN_EN, DCSS_SS_SYS_CTRL);
+	ss->in_use = true;
+}
+
+void dcss_ss_disable(struct dcss_ss *ss)
+{
+	dcss_ss_write(ss, 0, DCSS_SS_SYS_CTRL);
+	ss->in_use = false;
+}