[PATCH] drm/stm: ltdc: add support of horizontal & vertical mirroring
Philippe CORNU
philippe.cornu at foss.st.com
Mon Jun 27 07:12:54 PDT 2022
On 6/3/22 15:45, Yannick Fertre wrote:
> Support of vertical & horizontal mirroring features thanks to
> the plane rotation property.
>
> Signed-off-by: Yannick Fertre <yannick.fertre at foss.st.com>
> ---
> drivers/gpu/drm/stm/ltdc.c | 163 ++++++++++++++++++++++++-------------
> drivers/gpu/drm/stm/ltdc.h | 1 +
> 2 files changed, 108 insertions(+), 56 deletions(-)
>
> diff --git a/drivers/gpu/drm/stm/ltdc.c b/drivers/gpu/drm/stm/ltdc.c
> index 00a6bc1b1d7c..ff2075dd9474 100644
> --- a/drivers/gpu/drm/stm/ltdc.c
> +++ b/drivers/gpu/drm/stm/ltdc.c
> @@ -180,6 +180,7 @@
> #define LXCR_LEN BIT(0) /* Layer ENable */
> #define LXCR_COLKEN BIT(1) /* Color Keying Enable */
> #define LXCR_CLUTEN BIT(4) /* Color Look-Up Table ENable */
> +#define LXCR_HMEN BIT(8) /* Horizontal Mirroring ENable */
>
> #define LXWHPCR_WHSTPOS GENMASK(11, 0) /* Window Horizontal StarT POSition */
> #define LXWHPCR_WHSPPOS GENMASK(27, 16) /* Window Horizontal StoP POSition */
> @@ -197,7 +198,7 @@
> #define LXBFCR_BOR GENMASK(18, 16) /* Blending ORder */
>
> #define LXCFBLR_CFBLL GENMASK(12, 0) /* Color Frame Buffer Line Length */
> -#define LXCFBLR_CFBP GENMASK(28, 16) /* Color Frame Buffer Pitch in bytes */
> +#define LXCFBLR_CFBP GENMASK(31, 16) /* Color Frame Buffer Pitch in bytes */
>
> #define LXCFBLNR_CFBLN GENMASK(10, 0) /* Color Frame Buffer Line Number */
>
> @@ -1237,7 +1238,8 @@ static void ltdc_plane_atomic_update(struct drm_plane *plane,
> u32 y0 = newstate->crtc_y;
> u32 y1 = newstate->crtc_y + newstate->crtc_h - 1;
> u32 src_x, src_y, src_w, src_h;
> - u32 val, pitch_in_bytes, line_length, line_number, paddr, ahbp, avbp, bpcr;
> + u32 val, pitch_in_bytes, line_length, line_number, ahbp, avbp, bpcr;
> + u32 paddr, paddr1, paddr2;
> enum ltdc_pix_fmt pf;
>
> if (!newstate->crtc || !fb) {
> @@ -1289,13 +1291,6 @@ static void ltdc_plane_atomic_update(struct drm_plane *plane,
> }
> regmap_write_bits(ldev->regmap, LTDC_L1PFCR + lofs, LXPFCR_PF, val);
>
> - /* Configures the color frame buffer pitch in bytes & line length */
> - pitch_in_bytes = fb->pitches[0];
> - line_length = fb->format->cpp[0] *
> - (x1 - x0 + 1) + (ldev->caps.bus_width >> 3) - 1;
> - val = ((pitch_in_bytes << 16) | line_length);
> - regmap_write_bits(ldev->regmap, LTDC_L1CFBLR + lofs, LXCFBLR_CFBLL | LXCFBLR_CFBP, val);
> -
> /* Specifies the constant alpha value */
> val = newstate->alpha >> 8;
> regmap_write_bits(ldev->regmap, LTDC_L1CACR + lofs, LXCACR_CONSTA, val);
> @@ -1319,76 +1314,115 @@ static void ltdc_plane_atomic_update(struct drm_plane *plane,
> LXBFCR_BF2 | LXBFCR_BF1, val);
> }
>
> - /* Configures the frame buffer line number */
> - line_number = y1 - y0 + 1;
> - regmap_write_bits(ldev->regmap, LTDC_L1CFBLNR + lofs, LXCFBLNR_CFBLN, line_number);
> -
> /* Sets the FB address */
> paddr = (u32)drm_fb_cma_get_gem_addr(fb, newstate, 0);
>
> + if (newstate->rotation & DRM_MODE_REFLECT_X)
> + paddr += (fb->format->cpp[0] * (x1 - x0 + 1)) - 1;
> +
> + if (newstate->rotation & DRM_MODE_REFLECT_Y)
> + paddr += (fb->pitches[0] * (y1 - y0));
> +
> DRM_DEBUG_DRIVER("fb: phys 0x%08x", paddr);
> regmap_write(ldev->regmap, LTDC_L1CFBAR + lofs, paddr);
>
> + /* Configures the color frame buffer pitch in bytes & line length */
> + line_length = fb->format->cpp[0] *
> + (x1 - x0 + 1) + (ldev->caps.bus_width >> 3) - 1;
> +
> + if (newstate->rotation & DRM_MODE_REFLECT_Y)
> + /* Compute negative value (signed on 16 bits) for the picth */
> + pitch_in_bytes = 0x10000 - fb->pitches[0];
> + else
> + pitch_in_bytes = fb->pitches[0];
> +
> + val = (pitch_in_bytes << 16) | line_length;
> + regmap_write_bits(ldev->regmap, LTDC_L1CFBLR + lofs, LXCFBLR_CFBLL | LXCFBLR_CFBP, val);
> +
> + /* Configures the frame buffer line number */
> + line_number = y1 - y0 + 1;
> + regmap_write_bits(ldev->regmap, LTDC_L1CFBLNR + lofs, LXCFBLNR_CFBLN, line_number);
> +
> if (ldev->caps.ycbcr_input) {
> if (fb->format->is_yuv) {
> switch (fb->format->format) {
> case DRM_FORMAT_NV12:
> case DRM_FORMAT_NV21:
> - /* Configure the auxiliary frame buffer address 0 & 1 */
> - paddr = (u32)drm_fb_cma_get_gem_addr(fb, newstate, 1);
> - regmap_write(ldev->regmap, LTDC_L1AFBA0R + lofs, paddr);
> - regmap_write(ldev->regmap, LTDC_L1AFBA1R + lofs, paddr + 1);
> + /* Configure the auxiliary frame buffer address 0 */
> + paddr1 = (u32)drm_fb_cma_get_gem_addr(fb, newstate, 1);
> +
> + if (newstate->rotation & DRM_MODE_REFLECT_X)
> + paddr1 += ((fb->format->cpp[1] * (x1 - x0 + 1)) >> 1) - 1;
>
> - /* Configure the buffer length */
> - val = ((pitch_in_bytes << 16) | line_length);
> - regmap_write(ldev->regmap, LTDC_L1AFBLR + lofs, val);
> + if (newstate->rotation & DRM_MODE_REFLECT_Y)
> + paddr1 += (fb->pitches[1] * (y1 - y0 - 1)) >> 1;
>
> - /* Configure the frame buffer line number */
> - val = (line_number >> 1);
> - regmap_write(ldev->regmap, LTDC_L1AFBLNR + lofs, val);
> + regmap_write(ldev->regmap, LTDC_L1AFBA0R + lofs, paddr1);
> break;
> case DRM_FORMAT_YUV420:
> - /* Configure the auxiliary frame buffer address 0 */
> - paddr = (u32)drm_fb_cma_get_gem_addr(fb, newstate, 1);
> - regmap_write(ldev->regmap, LTDC_L1AFBA0R + lofs, paddr);
> -
> - /* Configure the auxiliary frame buffer address 1 */
> - paddr = (u32)drm_fb_cma_get_gem_addr(fb, newstate, 2);
> - regmap_write(ldev->regmap, LTDC_L1AFBA1R + lofs, paddr);
> + /* Configure the auxiliary frame buffer address 0 & 1 */
> + paddr1 = (u32)drm_fb_cma_get_gem_addr(fb, newstate, 1);
> + paddr2 = (u32)drm_fb_cma_get_gem_addr(fb, newstate, 2);
>
> - line_length = ((fb->format->cpp[0] * (x1 - x0 + 1)) >> 1) +
> - (ldev->caps.bus_width >> 3) - 1;
> + if (newstate->rotation & DRM_MODE_REFLECT_X) {
> + paddr1 += ((fb->format->cpp[1] * (x1 - x0 + 1)) >> 1) - 1;
> + paddr2 += ((fb->format->cpp[2] * (x1 - x0 + 1)) >> 1) - 1;
> + }
>
> - /* Configure the buffer length */
> - val = (((pitch_in_bytes >> 1) << 16) | line_length);
> - regmap_write(ldev->regmap, LTDC_L1AFBLR + lofs, val);
> + if (newstate->rotation & DRM_MODE_REFLECT_Y) {
> + paddr1 += (fb->pitches[1] * (y1 - y0 - 1)) >> 1;
> + paddr2 += (fb->pitches[2] * (y1 - y0 - 1)) >> 1;
> + }
>
> - /* Configure the frame buffer line number */
> - val = (line_number >> 1);
> - regmap_write(ldev->regmap, LTDC_L1AFBLNR + lofs, val);
> + regmap_write(ldev->regmap, LTDC_L1AFBA0R + lofs, paddr1);
> + regmap_write(ldev->regmap, LTDC_L1AFBA1R + lofs, paddr2);
> break;
> case DRM_FORMAT_YVU420:
> - /* Configure the auxiliary frame buffer address 0 */
> - paddr = (u32)drm_fb_cma_get_gem_addr(fb, newstate, 2);
> - regmap_write(ldev->regmap, LTDC_L1AFBA0R + lofs, paddr);
> -
> - /* Configure the auxiliary frame buffer address 1 */
> - paddr = (u32)drm_fb_cma_get_gem_addr(fb, newstate, 1);
> - regmap_write(ldev->regmap, LTDC_L1AFBA1R + lofs, paddr);
> + /* Configure the auxiliary frame buffer address 0 & 1 */
> + paddr1 = (u32)drm_fb_cma_get_gem_addr(fb, newstate, 2);
> + paddr2 = (u32)drm_fb_cma_get_gem_addr(fb, newstate, 1);
>
> - line_length = ((fb->format->cpp[0] * (x1 - x0 + 1)) >> 1) +
> - (ldev->caps.bus_width >> 3) - 1;
> + if (newstate->rotation & DRM_MODE_REFLECT_X) {
> + paddr1 += ((fb->format->cpp[1] * (x1 - x0 + 1)) >> 1) - 1;
> + paddr2 += ((fb->format->cpp[2] * (x1 - x0 + 1)) >> 1) - 1;
> + }
>
> - /* Configure the buffer length */
> - val = (((pitch_in_bytes >> 1) << 16) | line_length);
> - regmap_write(ldev->regmap, LTDC_L1AFBLR + lofs, val);
> + if (newstate->rotation & DRM_MODE_REFLECT_Y) {
> + paddr1 += (fb->pitches[1] * (y1 - y0 - 1)) >> 1;
> + paddr2 += (fb->pitches[2] * (y1 - y0 - 1)) >> 1;
> + }
>
> - /* Configure the frame buffer line number */
> - val = (line_number >> 1);
> - regmap_write(ldev->regmap, LTDC_L1AFBLNR + lofs, val);
> + regmap_write(ldev->regmap, LTDC_L1AFBA0R + lofs, paddr1);
> + regmap_write(ldev->regmap, LTDC_L1AFBA1R + lofs, paddr2);
> break;
> }
>
> + /*
> + * Set the length and the number of lines of the auxiliary
> + * buffers if the framebuffer contains more than one plane.
> + */
> + if (fb->format->num_planes > 1) {
> + if (newstate->rotation & DRM_MODE_REFLECT_Y)
> + /*
> + * Compute negative value (signed on 16 bits)
> + * for the picth
> + */
> + pitch_in_bytes = 0x10000 - fb->pitches[1];
> + else
> + pitch_in_bytes = fb->pitches[1];
> +
> + line_length = ((fb->format->cpp[1] * (x1 - x0 + 1)) >> 1) +
> + (ldev->caps.bus_width >> 3) - 1;
> +
> + /* Configure the auxiliary buffer length */
> + val = (pitch_in_bytes << 16) | line_length;
> + regmap_write(ldev->regmap, LTDC_L1AFBLR + lofs, val);
> +
> + /* Configure the auxiliary frame buffer line number */
> + val = line_number >> 1;
> + regmap_write(ldev->regmap, LTDC_L1AFBLNR + lofs, val);
> + }
> +
> /* Configure YCbC conversion coefficient */
> ltdc_set_ycbcr_coeffs(plane);
>
> @@ -1403,7 +1437,12 @@ static void ltdc_plane_atomic_update(struct drm_plane *plane,
> /* Enable layer and CLUT if needed */
> val = fb->format->format == DRM_FORMAT_C8 ? LXCR_CLUTEN : 0;
> val |= LXCR_LEN;
> - regmap_write_bits(ldev->regmap, LTDC_L1CR + lofs, LXCR_LEN | LXCR_CLUTEN, val);
> +
> + /* Enable horizontal mirroring if requested */
> + if (newstate->rotation & DRM_MODE_REFLECT_X)
> + val |= LXCR_HMEN;
> +
> + regmap_write_bits(ldev->regmap, LTDC_L1CR + lofs, LXCR_LEN | LXCR_CLUTEN | LXCR_HMEN, val);
>
> /* Commit shadow registers = update plane at next vblank */
> if (ldev->caps.plane_reg_shadow)
> @@ -1432,8 +1471,8 @@ static void ltdc_plane_atomic_disable(struct drm_plane *plane,
> struct ltdc_device *ldev = plane_to_ltdc(plane);
> u32 lofs = plane->index * LAY_OFS;
>
> - /* disable layer */
> - regmap_write_bits(ldev->regmap, LTDC_L1CR + lofs, LXCR_LEN, 0);
> + /* Disable layer */
> + regmap_write_bits(ldev->regmap, LTDC_L1CR + lofs, LXCR_LEN | LXCR_CLUTEN | LXCR_HMEN, 0);
>
> /* Commit shadow registers = update plane at next vblank */
> if (ldev->caps.plane_reg_shadow)
> @@ -1577,6 +1616,7 @@ static int ltdc_crtc_init(struct drm_device *ddev, struct drm_crtc *crtc)
> {
> struct ltdc_device *ldev = ddev->dev_private;
> struct drm_plane *primary, *overlay;
> + int supported_rotations = DRM_MODE_ROTATE_0 | DRM_MODE_REFLECT_X | DRM_MODE_REFLECT_Y;
> unsigned int i;
> int ret;
>
> @@ -1591,6 +1631,10 @@ static int ltdc_crtc_init(struct drm_device *ddev, struct drm_crtc *crtc)
> else
> drm_plane_create_zpos_immutable_property(primary, 0);
>
> + if (ldev->caps.plane_rotation)
> + drm_plane_create_rotation_property(primary, DRM_MODE_ROTATE_0,
> + supported_rotations);
> +
> /* Init CRTC according to its hardware features */
> if (ldev->caps.crc)
> ret = drm_crtc_init_with_planes(ddev, crtc, primary, NULL,
> @@ -1622,6 +1666,10 @@ static int ltdc_crtc_init(struct drm_device *ddev, struct drm_crtc *crtc)
> drm_plane_create_zpos_property(overlay, i, 0, ldev->caps.nb_layers - 1);
> else
> drm_plane_create_zpos_immutable_property(overlay, i);
> +
> + if (ldev->caps.plane_rotation)
> + drm_plane_create_rotation_property(overlay, DRM_MODE_ROTATE_0,
> + supported_rotations);
> }
>
> return 0;
> @@ -1752,6 +1800,7 @@ static int ltdc_get_caps(struct drm_device *ddev)
> ldev->caps.plane_reg_shadow = false;
> ldev->caps.crc = false;
> ldev->caps.dynamic_zorder = false;
> + ldev->caps.plane_rotation = false;
> break;
> case HWVER_20101:
> ldev->caps.layer_ofs = LAY_OFS_0;
> @@ -1768,6 +1817,7 @@ static int ltdc_get_caps(struct drm_device *ddev)
> ldev->caps.plane_reg_shadow = false;
> ldev->caps.crc = false;
> ldev->caps.dynamic_zorder = false;
> + ldev->caps.plane_rotation = false;
> break;
> case HWVER_40100:
> ldev->caps.layer_ofs = LAY_OFS_1;
> @@ -1784,6 +1834,7 @@ static int ltdc_get_caps(struct drm_device *ddev)
> ldev->caps.plane_reg_shadow = true;
> ldev->caps.crc = true;
> ldev->caps.dynamic_zorder = true;
> + ldev->caps.plane_rotation = true;
> break;
> default:
> return -ENODEV;
> diff --git a/drivers/gpu/drm/stm/ltdc.h b/drivers/gpu/drm/stm/ltdc.h
> index 4855898bd4c0..15139980d8ea 100644
> --- a/drivers/gpu/drm/stm/ltdc.h
> +++ b/drivers/gpu/drm/stm/ltdc.h
> @@ -29,6 +29,7 @@ struct ltdc_caps {
> bool plane_reg_shadow; /* plane shadow registers ability */
> bool crc; /* cyclic redundancy check supported */
> bool dynamic_zorder; /* dynamic z-order */
> + bool plane_rotation; /* plane rotation */
> };
>
> #define LTDC_MAX_LAYER 4
Dear Yannick,
Many thanks for your patch,
Applied on drm-misc-next.
Have a good day
Philippe :-)
More information about the linux-arm-kernel
mailing list