1f9a23481SNeil Armstrong // SPDX-License-Identifier: GPL-2.0+
2f9a23481SNeil Armstrong /*
3f9a23481SNeil Armstrong * Copyright (C) 2018 BayLibre, SAS
4f9a23481SNeil Armstrong * Author: Neil Armstrong <narmstrong@baylibre.com>
5f9a23481SNeil Armstrong * Copyright (C) 2015 Amlogic, Inc. All rights reserved.
6f9a23481SNeil Armstrong */
7f9a23481SNeil Armstrong
8f9a23481SNeil Armstrong #include <linux/bitfield.h>
966620f48SSam Ravnborg
10f9a23481SNeil Armstrong #include <drm/drm_atomic.h>
11f9a23481SNeil Armstrong #include <drm/drm_atomic_helper.h>
1290bb087fSVille Syrjälä #include <drm/drm_blend.h>
1366620f48SSam Ravnborg #include <drm/drm_device.h>
146bcfe8eaSDanilo Krummrich #include <drm/drm_fb_dma_helper.h>
15820c1707SThomas Zimmermann #include <drm/drm_fourcc.h>
16720cf96dSVille Syrjälä #include <drm/drm_framebuffer.h>
17820c1707SThomas Zimmermann #include <drm/drm_gem_atomic_helper.h>
184a83c26aSDanilo Krummrich #include <drm/drm_gem_dma_helper.h>
19f9a23481SNeil Armstrong
20f9a23481SNeil Armstrong #include "meson_overlay.h"
21f9a23481SNeil Armstrong #include "meson_registers.h"
2266620f48SSam Ravnborg #include "meson_viu.h"
2366620f48SSam Ravnborg #include "meson_vpp.h"
24f9a23481SNeil Armstrong
25f9a23481SNeil Armstrong /* VD1_IF0_GEN_REG */
26f9a23481SNeil Armstrong #define VD_URGENT_CHROMA BIT(28)
27f9a23481SNeil Armstrong #define VD_URGENT_LUMA BIT(27)
28f9a23481SNeil Armstrong #define VD_HOLD_LINES(lines) FIELD_PREP(GENMASK(24, 19), lines)
29f9a23481SNeil Armstrong #define VD_DEMUX_MODE_RGB BIT(16)
30f9a23481SNeil Armstrong #define VD_BYTES_PER_PIXEL(val) FIELD_PREP(GENMASK(15, 14), val)
31f9a23481SNeil Armstrong #define VD_CHRO_RPT_LASTL_CTRL BIT(6)
32f9a23481SNeil Armstrong #define VD_LITTLE_ENDIAN BIT(4)
33f9a23481SNeil Armstrong #define VD_SEPARATE_EN BIT(1)
34f9a23481SNeil Armstrong #define VD_ENABLE BIT(0)
35f9a23481SNeil Armstrong
36f9a23481SNeil Armstrong /* VD1_IF0_CANVAS0 */
37f9a23481SNeil Armstrong #define CANVAS_ADDR2(addr) FIELD_PREP(GENMASK(23, 16), addr)
38f9a23481SNeil Armstrong #define CANVAS_ADDR1(addr) FIELD_PREP(GENMASK(15, 8), addr)
39f9a23481SNeil Armstrong #define CANVAS_ADDR0(addr) FIELD_PREP(GENMASK(7, 0), addr)
40f9a23481SNeil Armstrong
41f9a23481SNeil Armstrong /* VD1_IF0_LUMA_X0 VD1_IF0_CHROMA_X0 */
42f9a23481SNeil Armstrong #define VD_X_START(value) FIELD_PREP(GENMASK(14, 0), value)
43f9a23481SNeil Armstrong #define VD_X_END(value) FIELD_PREP(GENMASK(30, 16), value)
44f9a23481SNeil Armstrong
45f9a23481SNeil Armstrong /* VD1_IF0_LUMA_Y0 VD1_IF0_CHROMA_Y0 */
46f9a23481SNeil Armstrong #define VD_Y_START(value) FIELD_PREP(GENMASK(12, 0), value)
47f9a23481SNeil Armstrong #define VD_Y_END(value) FIELD_PREP(GENMASK(28, 16), value)
48f9a23481SNeil Armstrong
49f9a23481SNeil Armstrong /* VD1_IF0_GEN_REG2 */
50f9a23481SNeil Armstrong #define VD_COLOR_MAP(value) FIELD_PREP(GENMASK(1, 0), value)
51f9a23481SNeil Armstrong
52f9a23481SNeil Armstrong /* VIU_VD1_FMT_CTRL */
53f9a23481SNeil Armstrong #define VD_HORZ_Y_C_RATIO(value) FIELD_PREP(GENMASK(22, 21), value)
54f9a23481SNeil Armstrong #define VD_HORZ_FMT_EN BIT(20)
55f9a23481SNeil Armstrong #define VD_VERT_RPT_LINE0 BIT(16)
56f9a23481SNeil Armstrong #define VD_VERT_INITIAL_PHASE(value) FIELD_PREP(GENMASK(11, 8), value)
57f9a23481SNeil Armstrong #define VD_VERT_PHASE_STEP(value) FIELD_PREP(GENMASK(7, 1), value)
58f9a23481SNeil Armstrong #define VD_VERT_FMT_EN BIT(0)
59f9a23481SNeil Armstrong
60f9a23481SNeil Armstrong /* VPP_POSTBLEND_VD1_H_START_END */
61f9a23481SNeil Armstrong #define VD_H_END(value) FIELD_PREP(GENMASK(11, 0), value)
6208fbd8a5SNeil Armstrong #define VD_H_START(value) FIELD_PREP(GENMASK(27, 16), \
6308fbd8a5SNeil Armstrong ((value) & GENMASK(13, 0)))
64f9a23481SNeil Armstrong
65f9a23481SNeil Armstrong /* VPP_POSTBLEND_VD1_V_START_END */
66f9a23481SNeil Armstrong #define VD_V_END(value) FIELD_PREP(GENMASK(11, 0), value)
67f9a23481SNeil Armstrong #define VD_V_START(value) FIELD_PREP(GENMASK(27, 16), value)
68f9a23481SNeil Armstrong
69f9a23481SNeil Armstrong /* VPP_BLEND_VD2_V_START_END */
70f9a23481SNeil Armstrong #define VD2_V_END(value) FIELD_PREP(GENMASK(11, 0), value)
71f9a23481SNeil Armstrong #define VD2_V_START(value) FIELD_PREP(GENMASK(27, 16), value)
72f9a23481SNeil Armstrong
73f9a23481SNeil Armstrong /* VIU_VD1_FMT_W */
74f9a23481SNeil Armstrong #define VD_V_WIDTH(value) FIELD_PREP(GENMASK(11, 0), value)
75f9a23481SNeil Armstrong #define VD_H_WIDTH(value) FIELD_PREP(GENMASK(27, 16), value)
76f9a23481SNeil Armstrong
77f9a23481SNeil Armstrong /* VPP_HSC_REGION12_STARTP VPP_HSC_REGION34_STARTP */
78f9a23481SNeil Armstrong #define VD_REGION24_START(value) FIELD_PREP(GENMASK(11, 0), value)
79f9a23481SNeil Armstrong #define VD_REGION13_END(value) FIELD_PREP(GENMASK(27, 16), value)
80f9a23481SNeil Armstrong
81e860785dSNeil Armstrong /* AFBC_ENABLE */
82e860785dSNeil Armstrong #define AFBC_DEC_ENABLE BIT(8)
83e860785dSNeil Armstrong #define AFBC_FRM_START BIT(0)
84e860785dSNeil Armstrong
85e860785dSNeil Armstrong /* AFBC_MODE */
86e860785dSNeil Armstrong #define AFBC_HORZ_SKIP_UV(value) FIELD_PREP(GENMASK(1, 0), value)
87e860785dSNeil Armstrong #define AFBC_VERT_SKIP_UV(value) FIELD_PREP(GENMASK(3, 2), value)
88e860785dSNeil Armstrong #define AFBC_HORZ_SKIP_Y(value) FIELD_PREP(GENMASK(5, 4), value)
89e860785dSNeil Armstrong #define AFBC_VERT_SKIP_Y(value) FIELD_PREP(GENMASK(7, 6), value)
90e860785dSNeil Armstrong #define AFBC_COMPBITS_YUV(value) FIELD_PREP(GENMASK(13, 8), value)
91e860785dSNeil Armstrong #define AFBC_COMPBITS_8BIT 0
92e860785dSNeil Armstrong #define AFBC_COMPBITS_10BIT (2 | (2 << 2) | (2 << 4))
93e860785dSNeil Armstrong #define AFBC_BURST_LEN(value) FIELD_PREP(GENMASK(15, 14), value)
94e860785dSNeil Armstrong #define AFBC_HOLD_LINE_NUM(value) FIELD_PREP(GENMASK(22, 16), value)
95e860785dSNeil Armstrong #define AFBC_MIF_URGENT(value) FIELD_PREP(GENMASK(25, 24), value)
96e860785dSNeil Armstrong #define AFBC_REV_MODE(value) FIELD_PREP(GENMASK(27, 26), value)
97e860785dSNeil Armstrong #define AFBC_BLK_MEM_MODE BIT(28)
98e860785dSNeil Armstrong #define AFBC_SCATTER_MODE BIT(29)
99e860785dSNeil Armstrong #define AFBC_SOFT_RESET BIT(31)
100e860785dSNeil Armstrong
101e860785dSNeil Armstrong /* AFBC_SIZE_IN */
102e860785dSNeil Armstrong #define AFBC_HSIZE_IN(value) FIELD_PREP(GENMASK(28, 16), value)
103e860785dSNeil Armstrong #define AFBC_VSIZE_IN(value) FIELD_PREP(GENMASK(12, 0), value)
104e860785dSNeil Armstrong
105e860785dSNeil Armstrong /* AFBC_DEC_DEF_COLOR */
106e860785dSNeil Armstrong #define AFBC_DEF_COLOR_Y(value) FIELD_PREP(GENMASK(29, 20), value)
107e860785dSNeil Armstrong #define AFBC_DEF_COLOR_U(value) FIELD_PREP(GENMASK(19, 10), value)
108e860785dSNeil Armstrong #define AFBC_DEF_COLOR_V(value) FIELD_PREP(GENMASK(9, 0), value)
109e860785dSNeil Armstrong
110e860785dSNeil Armstrong /* AFBC_CONV_CTRL */
111e860785dSNeil Armstrong #define AFBC_CONV_LBUF_LEN(value) FIELD_PREP(GENMASK(11, 0), value)
112e860785dSNeil Armstrong
113e860785dSNeil Armstrong /* AFBC_LBUF_DEPTH */
114e860785dSNeil Armstrong #define AFBC_DEC_LBUF_DEPTH(value) FIELD_PREP(GENMASK(27, 16), value)
115e860785dSNeil Armstrong #define AFBC_MIF_LBUF_DEPTH(value) FIELD_PREP(GENMASK(11, 0), value)
116e860785dSNeil Armstrong
117e860785dSNeil Armstrong /* AFBC_OUT_XSCOPE/AFBC_SIZE_OUT */
118e860785dSNeil Armstrong #define AFBC_HSIZE_OUT(value) FIELD_PREP(GENMASK(28, 16), value)
119e860785dSNeil Armstrong #define AFBC_VSIZE_OUT(value) FIELD_PREP(GENMASK(12, 0), value)
120e860785dSNeil Armstrong #define AFBC_OUT_HORZ_BGN(value) FIELD_PREP(GENMASK(28, 16), value)
121e860785dSNeil Armstrong #define AFBC_OUT_HORZ_END(value) FIELD_PREP(GENMASK(12, 0), value)
122e860785dSNeil Armstrong
123e860785dSNeil Armstrong /* AFBC_OUT_YSCOPE */
124e860785dSNeil Armstrong #define AFBC_OUT_VERT_BGN(value) FIELD_PREP(GENMASK(28, 16), value)
125e860785dSNeil Armstrong #define AFBC_OUT_VERT_END(value) FIELD_PREP(GENMASK(12, 0), value)
126e860785dSNeil Armstrong
127e860785dSNeil Armstrong /* AFBC_VD_CFMT_CTRL */
128e860785dSNeil Armstrong #define AFBC_HORZ_RPT_PIXEL0 BIT(23)
129e860785dSNeil Armstrong #define AFBC_HORZ_Y_C_RATIO(value) FIELD_PREP(GENMASK(22, 21), value)
130e860785dSNeil Armstrong #define AFBC_HORZ_FMT_EN BIT(20)
131e860785dSNeil Armstrong #define AFBC_VERT_RPT_LINE0 BIT(16)
132e860785dSNeil Armstrong #define AFBC_VERT_INITIAL_PHASE(value) FIELD_PREP(GENMASK(11, 8), value)
133e860785dSNeil Armstrong #define AFBC_VERT_PHASE_STEP(value) FIELD_PREP(GENMASK(7, 1), value)
134e860785dSNeil Armstrong #define AFBC_VERT_FMT_EN BIT(0)
135e860785dSNeil Armstrong
136e860785dSNeil Armstrong /* AFBC_VD_CFMT_W */
137e860785dSNeil Armstrong #define AFBC_VD_V_WIDTH(value) FIELD_PREP(GENMASK(11, 0), value)
138e860785dSNeil Armstrong #define AFBC_VD_H_WIDTH(value) FIELD_PREP(GENMASK(27, 16), value)
139e860785dSNeil Armstrong
140e860785dSNeil Armstrong /* AFBC_MIF_HOR_SCOPE */
141e860785dSNeil Armstrong #define AFBC_MIF_BLK_BGN_H(value) FIELD_PREP(GENMASK(25, 16), value)
142e860785dSNeil Armstrong #define AFBC_MIF_BLK_END_H(value) FIELD_PREP(GENMASK(9, 0), value)
143e860785dSNeil Armstrong
144e860785dSNeil Armstrong /* AFBC_MIF_VER_SCOPE */
145e860785dSNeil Armstrong #define AFBC_MIF_BLK_BGN_V(value) FIELD_PREP(GENMASK(27, 16), value)
146e860785dSNeil Armstrong #define AFBC_MIF_BLK_END_V(value) FIELD_PREP(GENMASK(11, 0), value)
147e860785dSNeil Armstrong
148e860785dSNeil Armstrong /* AFBC_PIXEL_HOR_SCOPE */
14908fbd8a5SNeil Armstrong #define AFBC_DEC_PIXEL_BGN_H(value) FIELD_PREP(GENMASK(28, 16), \
15008fbd8a5SNeil Armstrong ((value) & GENMASK(12, 0)))
151e860785dSNeil Armstrong #define AFBC_DEC_PIXEL_END_H(value) FIELD_PREP(GENMASK(12, 0), value)
152e860785dSNeil Armstrong
153e860785dSNeil Armstrong /* AFBC_PIXEL_VER_SCOPE */
154e860785dSNeil Armstrong #define AFBC_DEC_PIXEL_BGN_V(value) FIELD_PREP(GENMASK(28, 16), value)
155e860785dSNeil Armstrong #define AFBC_DEC_PIXEL_END_V(value) FIELD_PREP(GENMASK(12, 0), value)
156e860785dSNeil Armstrong
157e860785dSNeil Armstrong /* AFBC_VD_CFMT_H */
158e860785dSNeil Armstrong #define AFBC_VD_HEIGHT(value) FIELD_PREP(GENMASK(12, 0), value)
159e860785dSNeil Armstrong
160f9a23481SNeil Armstrong struct meson_overlay {
161f9a23481SNeil Armstrong struct drm_plane base;
162f9a23481SNeil Armstrong struct meson_drm *priv;
163f9a23481SNeil Armstrong };
164f9a23481SNeil Armstrong #define to_meson_overlay(x) container_of(x, struct meson_overlay, base)
165f9a23481SNeil Armstrong
166f9a23481SNeil Armstrong #define FRAC_16_16(mult, div) (((mult) << 16) / (div))
167f9a23481SNeil Armstrong
meson_overlay_atomic_check(struct drm_plane * plane,struct drm_atomic_state * state)168f9a23481SNeil Armstrong static int meson_overlay_atomic_check(struct drm_plane *plane,
1697c11b99aSMaxime Ripard struct drm_atomic_state *state)
170f9a23481SNeil Armstrong {
1717c11b99aSMaxime Ripard struct drm_plane_state *new_plane_state = drm_atomic_get_new_plane_state(state,
1727c11b99aSMaxime Ripard plane);
173f9a23481SNeil Armstrong struct drm_crtc_state *crtc_state;
174f9a23481SNeil Armstrong
175ba5c1649SMaxime Ripard if (!new_plane_state->crtc)
176f9a23481SNeil Armstrong return 0;
177f9a23481SNeil Armstrong
178dec92020SMaxime Ripard crtc_state = drm_atomic_get_crtc_state(state,
179ba5c1649SMaxime Ripard new_plane_state->crtc);
180f9a23481SNeil Armstrong if (IS_ERR(crtc_state))
181f9a23481SNeil Armstrong return PTR_ERR(crtc_state);
182f9a23481SNeil Armstrong
183ba5c1649SMaxime Ripard return drm_atomic_helper_check_plane_state(new_plane_state,
184ba5c1649SMaxime Ripard crtc_state,
185f9a23481SNeil Armstrong FRAC_16_16(1, 5),
186f9a23481SNeil Armstrong FRAC_16_16(5, 1),
187f9a23481SNeil Armstrong true, true);
188f9a23481SNeil Armstrong }
189f9a23481SNeil Armstrong
190f9a23481SNeil Armstrong /* Takes a fixed 16.16 number and converts it to integer. */
fixed16_to_int(int64_t value)191f9a23481SNeil Armstrong static inline int64_t fixed16_to_int(int64_t value)
192f9a23481SNeil Armstrong {
193f9a23481SNeil Armstrong return value >> 16;
194f9a23481SNeil Armstrong }
195f9a23481SNeil Armstrong
196f9a23481SNeil Armstrong static const uint8_t skip_tab[6] = {
197f9a23481SNeil Armstrong 0x24, 0x04, 0x68, 0x48, 0x28, 0x08,
198f9a23481SNeil Armstrong };
199f9a23481SNeil Armstrong
meson_overlay_get_vertical_phase(unsigned int ratio_y,int * phase,int * repeat,bool interlace)200f9a23481SNeil Armstrong static void meson_overlay_get_vertical_phase(unsigned int ratio_y, int *phase,
201f9a23481SNeil Armstrong int *repeat, bool interlace)
202f9a23481SNeil Armstrong {
203f9a23481SNeil Armstrong int offset_in = 0;
204f9a23481SNeil Armstrong int offset_out = 0;
205f9a23481SNeil Armstrong int repeat_skip = 0;
206f9a23481SNeil Armstrong
207f9a23481SNeil Armstrong if (!interlace && ratio_y > (1 << 18))
208f9a23481SNeil Armstrong offset_out = (1 * ratio_y) >> 10;
209f9a23481SNeil Armstrong
210f9a23481SNeil Armstrong while ((offset_in + (4 << 8)) <= offset_out) {
211f9a23481SNeil Armstrong repeat_skip++;
212f9a23481SNeil Armstrong offset_in += 4 << 8;
213f9a23481SNeil Armstrong }
214f9a23481SNeil Armstrong
215f9a23481SNeil Armstrong *phase = (offset_out - offset_in) >> 2;
216f9a23481SNeil Armstrong
217f9a23481SNeil Armstrong if (*phase > 0x100)
218f9a23481SNeil Armstrong repeat_skip++;
219f9a23481SNeil Armstrong
220f9a23481SNeil Armstrong *phase = *phase & 0xff;
221f9a23481SNeil Armstrong
222f9a23481SNeil Armstrong if (repeat_skip > 5)
223f9a23481SNeil Armstrong repeat_skip = 5;
224f9a23481SNeil Armstrong
225f9a23481SNeil Armstrong *repeat = skip_tab[repeat_skip];
226f9a23481SNeil Armstrong }
227f9a23481SNeil Armstrong
meson_overlay_setup_scaler_params(struct meson_drm * priv,struct drm_plane * plane,bool interlace_mode)228f9a23481SNeil Armstrong static void meson_overlay_setup_scaler_params(struct meson_drm *priv,
229f9a23481SNeil Armstrong struct drm_plane *plane,
230f9a23481SNeil Armstrong bool interlace_mode)
231f9a23481SNeil Armstrong {
232f9a23481SNeil Armstrong struct drm_crtc_state *crtc_state = priv->crtc->state;
233f9a23481SNeil Armstrong int video_top, video_left, video_width, video_height;
234f9a23481SNeil Armstrong struct drm_plane_state *state = plane->state;
235f9a23481SNeil Armstrong unsigned int vd_start_lines, vd_end_lines;
236f9a23481SNeil Armstrong unsigned int hd_start_lines, hd_end_lines;
237f9a23481SNeil Armstrong unsigned int crtc_height, crtc_width;
238f9a23481SNeil Armstrong unsigned int vsc_startp, vsc_endp;
239f9a23481SNeil Armstrong unsigned int hsc_startp, hsc_endp;
240f9a23481SNeil Armstrong unsigned int crop_top, crop_left;
241f9a23481SNeil Armstrong int vphase, vphase_repeat_skip;
242f9a23481SNeil Armstrong unsigned int ratio_x, ratio_y;
243f9a23481SNeil Armstrong int temp_height, temp_width;
244f9a23481SNeil Armstrong unsigned int w_in, h_in;
245e860785dSNeil Armstrong int afbc_left, afbc_right;
246e860785dSNeil Armstrong int afbc_top_src, afbc_bottom_src;
247e860785dSNeil Armstrong int afbc_top, afbc_bottom;
248f9a23481SNeil Armstrong int temp, start, end;
249f9a23481SNeil Armstrong
250f9a23481SNeil Armstrong if (!crtc_state) {
251f9a23481SNeil Armstrong DRM_ERROR("Invalid crtc_state\n");
252f9a23481SNeil Armstrong return;
253f9a23481SNeil Armstrong }
254f9a23481SNeil Armstrong
255f9a23481SNeil Armstrong crtc_height = crtc_state->mode.vdisplay;
256f9a23481SNeil Armstrong crtc_width = crtc_state->mode.hdisplay;
257f9a23481SNeil Armstrong
258f9a23481SNeil Armstrong w_in = fixed16_to_int(state->src_w);
259f9a23481SNeil Armstrong h_in = fixed16_to_int(state->src_h);
260e860785dSNeil Armstrong crop_top = fixed16_to_int(state->src_y);
261f9a23481SNeil Armstrong crop_left = fixed16_to_int(state->src_x);
262f9a23481SNeil Armstrong
263f9a23481SNeil Armstrong video_top = state->crtc_y;
264f9a23481SNeil Armstrong video_left = state->crtc_x;
265f9a23481SNeil Armstrong video_width = state->crtc_w;
266f9a23481SNeil Armstrong video_height = state->crtc_h;
267f9a23481SNeil Armstrong
268f9a23481SNeil Armstrong DRM_DEBUG("crtc_width %d crtc_height %d interlace %d\n",
269f9a23481SNeil Armstrong crtc_width, crtc_height, interlace_mode);
270f9a23481SNeil Armstrong DRM_DEBUG("w_in %d h_in %d crop_top %d crop_left %d\n",
271f9a23481SNeil Armstrong w_in, h_in, crop_top, crop_left);
272f9a23481SNeil Armstrong DRM_DEBUG("video top %d left %d width %d height %d\n",
273f9a23481SNeil Armstrong video_top, video_left, video_width, video_height);
274f9a23481SNeil Armstrong
275f9a23481SNeil Armstrong ratio_x = (w_in << 18) / video_width;
276f9a23481SNeil Armstrong ratio_y = (h_in << 18) / video_height;
277f9a23481SNeil Armstrong
278f9a23481SNeil Armstrong if (ratio_x * video_width < (w_in << 18))
279f9a23481SNeil Armstrong ratio_x++;
280f9a23481SNeil Armstrong
281f9a23481SNeil Armstrong DRM_DEBUG("ratio x 0x%x y 0x%x\n", ratio_x, ratio_y);
282f9a23481SNeil Armstrong
283f9a23481SNeil Armstrong meson_overlay_get_vertical_phase(ratio_y, &vphase, &vphase_repeat_skip,
284f9a23481SNeil Armstrong interlace_mode);
285f9a23481SNeil Armstrong
286f9a23481SNeil Armstrong DRM_DEBUG("vphase 0x%x skip %d\n", vphase, vphase_repeat_skip);
287f9a23481SNeil Armstrong
288f9a23481SNeil Armstrong /* Vertical */
289f9a23481SNeil Armstrong
290f9a23481SNeil Armstrong start = video_top + video_height / 2 - ((h_in << 17) / ratio_y);
291f9a23481SNeil Armstrong end = (h_in << 18) / ratio_y + start - 1;
292f9a23481SNeil Armstrong
293f9a23481SNeil Armstrong if (video_top < 0 && start < 0)
294f9a23481SNeil Armstrong vd_start_lines = (-(start) * ratio_y) >> 18;
295f9a23481SNeil Armstrong else if (start < video_top)
296f9a23481SNeil Armstrong vd_start_lines = ((video_top - start) * ratio_y) >> 18;
297f9a23481SNeil Armstrong else
298f9a23481SNeil Armstrong vd_start_lines = 0;
299f9a23481SNeil Armstrong
300f9a23481SNeil Armstrong if (video_top < 0)
301f9a23481SNeil Armstrong temp_height = min_t(unsigned int,
302f9a23481SNeil Armstrong video_top + video_height - 1,
303f9a23481SNeil Armstrong crtc_height - 1);
304f9a23481SNeil Armstrong else
305f9a23481SNeil Armstrong temp_height = min_t(unsigned int,
306f9a23481SNeil Armstrong video_top + video_height - 1,
307f9a23481SNeil Armstrong crtc_height - 1) - video_top + 1;
308f9a23481SNeil Armstrong
309f9a23481SNeil Armstrong temp = vd_start_lines + (temp_height * ratio_y >> 18);
310f9a23481SNeil Armstrong vd_end_lines = (temp <= (h_in - 1)) ? temp : (h_in - 1);
311f9a23481SNeil Armstrong
312f9a23481SNeil Armstrong vd_start_lines += crop_left;
313f9a23481SNeil Armstrong vd_end_lines += crop_left;
314f9a23481SNeil Armstrong
315f9a23481SNeil Armstrong /*
316f9a23481SNeil Armstrong * TOFIX: Input frames are handled and scaled like progressive frames,
317f9a23481SNeil Armstrong * proper handling of interlaced field input frames need to be figured
318f9a23481SNeil Armstrong * out using the proper framebuffer flags set by userspace.
319f9a23481SNeil Armstrong */
320f9a23481SNeil Armstrong if (interlace_mode) {
321f9a23481SNeil Armstrong start >>= 1;
322f9a23481SNeil Armstrong end >>= 1;
323f9a23481SNeil Armstrong }
324f9a23481SNeil Armstrong
325f9a23481SNeil Armstrong vsc_startp = max_t(int, start,
326f9a23481SNeil Armstrong max_t(int, 0, video_top));
327f9a23481SNeil Armstrong vsc_endp = min_t(int, end,
328f9a23481SNeil Armstrong min_t(int, crtc_height - 1,
329f9a23481SNeil Armstrong video_top + video_height - 1));
330f9a23481SNeil Armstrong
331f9a23481SNeil Armstrong DRM_DEBUG("vsc startp %d endp %d start_lines %d end_lines %d\n",
332f9a23481SNeil Armstrong vsc_startp, vsc_endp, vd_start_lines, vd_end_lines);
333f9a23481SNeil Armstrong
334e860785dSNeil Armstrong afbc_top = round_down(vd_start_lines, 4);
335e860785dSNeil Armstrong afbc_bottom = round_up(vd_end_lines + 1, 4);
336e860785dSNeil Armstrong afbc_top_src = 0;
337e860785dSNeil Armstrong afbc_bottom_src = round_up(h_in + 1, 4);
338e860785dSNeil Armstrong
339e860785dSNeil Armstrong DRM_DEBUG("afbc top %d (src %d) bottom %d (src %d)\n",
340e860785dSNeil Armstrong afbc_top, afbc_top_src, afbc_bottom, afbc_bottom_src);
341e860785dSNeil Armstrong
342f9a23481SNeil Armstrong /* Horizontal */
343f9a23481SNeil Armstrong
344f9a23481SNeil Armstrong start = video_left + video_width / 2 - ((w_in << 17) / ratio_x);
345f9a23481SNeil Armstrong end = (w_in << 18) / ratio_x + start - 1;
346f9a23481SNeil Armstrong
347f9a23481SNeil Armstrong if (video_left < 0 && start < 0)
348f9a23481SNeil Armstrong hd_start_lines = (-(start) * ratio_x) >> 18;
349f9a23481SNeil Armstrong else if (start < video_left)
350f9a23481SNeil Armstrong hd_start_lines = ((video_left - start) * ratio_x) >> 18;
351f9a23481SNeil Armstrong else
352f9a23481SNeil Armstrong hd_start_lines = 0;
353f9a23481SNeil Armstrong
354f9a23481SNeil Armstrong if (video_left < 0)
355f9a23481SNeil Armstrong temp_width = min_t(unsigned int,
356f9a23481SNeil Armstrong video_left + video_width - 1,
357f9a23481SNeil Armstrong crtc_width - 1);
358f9a23481SNeil Armstrong else
359f9a23481SNeil Armstrong temp_width = min_t(unsigned int,
360f9a23481SNeil Armstrong video_left + video_width - 1,
361f9a23481SNeil Armstrong crtc_width - 1) - video_left + 1;
362f9a23481SNeil Armstrong
363f9a23481SNeil Armstrong temp = hd_start_lines + (temp_width * ratio_x >> 18);
364f9a23481SNeil Armstrong hd_end_lines = (temp <= (w_in - 1)) ? temp : (w_in - 1);
365f9a23481SNeil Armstrong
366f9a23481SNeil Armstrong priv->viu.vpp_line_in_length = hd_end_lines - hd_start_lines + 1;
367f9a23481SNeil Armstrong hsc_startp = max_t(int, start, max_t(int, 0, video_left));
368f9a23481SNeil Armstrong hsc_endp = min_t(int, end, min_t(int, crtc_width - 1,
369f9a23481SNeil Armstrong video_left + video_width - 1));
370f9a23481SNeil Armstrong
371f9a23481SNeil Armstrong hd_start_lines += crop_top;
372f9a23481SNeil Armstrong hd_end_lines += crop_top;
373f9a23481SNeil Armstrong
374f9a23481SNeil Armstrong DRM_DEBUG("hsc startp %d endp %d start_lines %d end_lines %d\n",
375f9a23481SNeil Armstrong hsc_startp, hsc_endp, hd_start_lines, hd_end_lines);
376f9a23481SNeil Armstrong
377e860785dSNeil Armstrong if (hd_start_lines > 0 || (hd_end_lines < w_in)) {
378e860785dSNeil Armstrong afbc_left = 0;
379e860785dSNeil Armstrong afbc_right = round_up(w_in, 32);
380e860785dSNeil Armstrong } else {
381e860785dSNeil Armstrong afbc_left = round_down(hd_start_lines, 32);
382e860785dSNeil Armstrong afbc_right = round_up(hd_end_lines + 1, 32);
383e860785dSNeil Armstrong }
384e860785dSNeil Armstrong
385e860785dSNeil Armstrong DRM_DEBUG("afbc left %d right %d\n", afbc_left, afbc_right);
386e860785dSNeil Armstrong
387f9a23481SNeil Armstrong priv->viu.vpp_vsc_start_phase_step = ratio_y << 6;
388f9a23481SNeil Armstrong
389f9a23481SNeil Armstrong priv->viu.vpp_vsc_ini_phase = vphase << 8;
390f9a23481SNeil Armstrong priv->viu.vpp_vsc_phase_ctrl = (1 << 13) | (4 << 8) |
391f9a23481SNeil Armstrong vphase_repeat_skip;
392f9a23481SNeil Armstrong
393f9a23481SNeil Armstrong priv->viu.vd1_if0_luma_x0 = VD_X_START(hd_start_lines) |
394f9a23481SNeil Armstrong VD_X_END(hd_end_lines);
395f9a23481SNeil Armstrong priv->viu.vd1_if0_chroma_x0 = VD_X_START(hd_start_lines >> 1) |
396f9a23481SNeil Armstrong VD_X_END(hd_end_lines >> 1);
397f9a23481SNeil Armstrong
398f9a23481SNeil Armstrong priv->viu.viu_vd1_fmt_w =
399f9a23481SNeil Armstrong VD_H_WIDTH(hd_end_lines - hd_start_lines + 1) |
400f9a23481SNeil Armstrong VD_V_WIDTH(hd_end_lines/2 - hd_start_lines/2 + 1);
401f9a23481SNeil Armstrong
402e860785dSNeil Armstrong priv->viu.vd1_afbc_vd_cfmt_w =
403e860785dSNeil Armstrong AFBC_VD_H_WIDTH(afbc_right - afbc_left) |
404e860785dSNeil Armstrong AFBC_VD_V_WIDTH(afbc_right / 2 - afbc_left / 2);
405e860785dSNeil Armstrong
406e860785dSNeil Armstrong priv->viu.vd1_afbc_vd_cfmt_h =
407e860785dSNeil Armstrong AFBC_VD_HEIGHT((afbc_bottom - afbc_top) / 2);
408e860785dSNeil Armstrong
409e860785dSNeil Armstrong priv->viu.vd1_afbc_mif_hor_scope = AFBC_MIF_BLK_BGN_H(afbc_left / 32) |
410e860785dSNeil Armstrong AFBC_MIF_BLK_END_H((afbc_right / 32) - 1);
411e860785dSNeil Armstrong
412e860785dSNeil Armstrong priv->viu.vd1_afbc_mif_ver_scope = AFBC_MIF_BLK_BGN_V(afbc_top / 4) |
413e860785dSNeil Armstrong AFBC_MIF_BLK_END_H((afbc_bottom / 4) - 1);
414e860785dSNeil Armstrong
415e860785dSNeil Armstrong priv->viu.vd1_afbc_size_out =
416e860785dSNeil Armstrong AFBC_HSIZE_OUT(afbc_right - afbc_left) |
417e860785dSNeil Armstrong AFBC_VSIZE_OUT(afbc_bottom - afbc_top);
418e860785dSNeil Armstrong
419e860785dSNeil Armstrong priv->viu.vd1_afbc_pixel_hor_scope =
420e860785dSNeil Armstrong AFBC_DEC_PIXEL_BGN_H(hd_start_lines - afbc_left) |
421e860785dSNeil Armstrong AFBC_DEC_PIXEL_END_H(hd_end_lines - afbc_left);
422e860785dSNeil Armstrong
423e860785dSNeil Armstrong priv->viu.vd1_afbc_pixel_ver_scope =
424e860785dSNeil Armstrong AFBC_DEC_PIXEL_BGN_V(vd_start_lines - afbc_top) |
425e860785dSNeil Armstrong AFBC_DEC_PIXEL_END_V(vd_end_lines - afbc_top);
426e860785dSNeil Armstrong
427e860785dSNeil Armstrong priv->viu.vd1_afbc_size_in =
428e860785dSNeil Armstrong AFBC_HSIZE_IN(afbc_right - afbc_left) |
429e860785dSNeil Armstrong AFBC_VSIZE_IN(afbc_bottom_src - afbc_top_src);
430e860785dSNeil Armstrong
431f9a23481SNeil Armstrong priv->viu.vd1_if0_luma_y0 = VD_Y_START(vd_start_lines) |
432f9a23481SNeil Armstrong VD_Y_END(vd_end_lines);
433f9a23481SNeil Armstrong
434f9a23481SNeil Armstrong priv->viu.vd1_if0_chroma_y0 = VD_Y_START(vd_start_lines >> 1) |
435f9a23481SNeil Armstrong VD_Y_END(vd_end_lines >> 1);
436f9a23481SNeil Armstrong
437f9a23481SNeil Armstrong priv->viu.vpp_pic_in_height = h_in;
438f9a23481SNeil Armstrong
439f9a23481SNeil Armstrong priv->viu.vpp_postblend_vd1_h_start_end = VD_H_START(hsc_startp) |
440f9a23481SNeil Armstrong VD_H_END(hsc_endp);
441f9a23481SNeil Armstrong priv->viu.vpp_blend_vd2_h_start_end = VD_H_START(hd_start_lines) |
442f9a23481SNeil Armstrong VD_H_END(hd_end_lines);
443f9a23481SNeil Armstrong priv->viu.vpp_hsc_region12_startp = VD_REGION13_END(0) |
444f9a23481SNeil Armstrong VD_REGION24_START(hsc_startp);
445f9a23481SNeil Armstrong priv->viu.vpp_hsc_region34_startp =
446f9a23481SNeil Armstrong VD_REGION13_END(hsc_startp) |
447f9a23481SNeil Armstrong VD_REGION24_START(hsc_endp - hsc_startp);
448f9a23481SNeil Armstrong priv->viu.vpp_hsc_region4_endp = hsc_endp - hsc_startp;
449f9a23481SNeil Armstrong priv->viu.vpp_hsc_start_phase_step = ratio_x << 6;
450f9a23481SNeil Armstrong priv->viu.vpp_hsc_region1_phase_slope = 0;
451f9a23481SNeil Armstrong priv->viu.vpp_hsc_region3_phase_slope = 0;
452f9a23481SNeil Armstrong priv->viu.vpp_hsc_phase_ctrl = (1 << 21) | (4 << 16);
453f9a23481SNeil Armstrong
454f9a23481SNeil Armstrong priv->viu.vpp_line_in_length = hd_end_lines - hd_start_lines + 1;
455f9a23481SNeil Armstrong priv->viu.vpp_preblend_h_size = hd_end_lines - hd_start_lines + 1;
456f9a23481SNeil Armstrong
457f9a23481SNeil Armstrong priv->viu.vpp_postblend_vd1_v_start_end = VD_V_START(vsc_startp) |
458f9a23481SNeil Armstrong VD_V_END(vsc_endp);
459f9a23481SNeil Armstrong priv->viu.vpp_blend_vd2_v_start_end =
460f9a23481SNeil Armstrong VD2_V_START((vd_end_lines + 1) >> 1) |
461f9a23481SNeil Armstrong VD2_V_END(vd_end_lines);
462f9a23481SNeil Armstrong
463f9a23481SNeil Armstrong priv->viu.vpp_vsc_region12_startp = 0;
464f9a23481SNeil Armstrong priv->viu.vpp_vsc_region34_startp =
465f9a23481SNeil Armstrong VD_REGION13_END(vsc_endp - vsc_startp) |
466f9a23481SNeil Armstrong VD_REGION24_START(vsc_endp - vsc_startp);
467f9a23481SNeil Armstrong priv->viu.vpp_vsc_region4_endp = vsc_endp - vsc_startp;
468f9a23481SNeil Armstrong priv->viu.vpp_vsc_start_phase_step = ratio_y << 6;
469f9a23481SNeil Armstrong }
470f9a23481SNeil Armstrong
meson_overlay_atomic_update(struct drm_plane * plane,struct drm_atomic_state * state)471f9a23481SNeil Armstrong static void meson_overlay_atomic_update(struct drm_plane *plane,
472977697e2SMaxime Ripard struct drm_atomic_state *state)
473f9a23481SNeil Armstrong {
474f9a23481SNeil Armstrong struct meson_overlay *meson_overlay = to_meson_overlay(plane);
47537418bf1SMaxime Ripard struct drm_plane_state *new_state = drm_atomic_get_new_plane_state(state,
47637418bf1SMaxime Ripard plane);
47741016fe1SMaxime Ripard struct drm_framebuffer *fb = new_state->fb;
478f9a23481SNeil Armstrong struct meson_drm *priv = meson_overlay->priv;
4794a83c26aSDanilo Krummrich struct drm_gem_dma_object *gem;
480f9a23481SNeil Armstrong unsigned long flags;
481f9a23481SNeil Armstrong bool interlace_mode;
482f9a23481SNeil Armstrong
483f9a23481SNeil Armstrong DRM_DEBUG_DRIVER("\n");
484f9a23481SNeil Armstrong
48541016fe1SMaxime Ripard interlace_mode = new_state->crtc->mode.flags & DRM_MODE_FLAG_INTERLACE;
486f9a23481SNeil Armstrong
487f9a23481SNeil Armstrong spin_lock_irqsave(&priv->drm->event_lock, flags);
488f9a23481SNeil Armstrong
489e860785dSNeil Armstrong if ((fb->modifier & DRM_FORMAT_MOD_AMLOGIC_FBC(0, 0)) ==
490e860785dSNeil Armstrong DRM_FORMAT_MOD_AMLOGIC_FBC(0, 0)) {
491e860785dSNeil Armstrong priv->viu.vd1_afbc = true;
492e860785dSNeil Armstrong
493e860785dSNeil Armstrong priv->viu.vd1_afbc_mode = AFBC_MIF_URGENT(3) |
494e860785dSNeil Armstrong AFBC_HOLD_LINE_NUM(8) |
495e860785dSNeil Armstrong AFBC_BURST_LEN(2);
496e860785dSNeil Armstrong
497376b1391SNeil Armstrong if (fb->modifier & DRM_FORMAT_MOD_AMLOGIC_FBC(0,
498376b1391SNeil Armstrong AMLOGIC_FBC_OPTION_MEM_SAVING))
499376b1391SNeil Armstrong priv->viu.vd1_afbc_mode |= AFBC_BLK_MEM_MODE;
500376b1391SNeil Armstrong
501be26a04bSNeil Armstrong if ((fb->modifier & __fourcc_mod_amlogic_layout_mask) ==
502be26a04bSNeil Armstrong AMLOGIC_FBC_LAYOUT_SCATTER)
503be26a04bSNeil Armstrong priv->viu.vd1_afbc_mode |= AFBC_SCATTER_MODE;
504be26a04bSNeil Armstrong
505e860785dSNeil Armstrong priv->viu.vd1_afbc_en = 0x1600 | AFBC_DEC_ENABLE;
506e860785dSNeil Armstrong
507e860785dSNeil Armstrong priv->viu.vd1_afbc_conv_ctrl = AFBC_CONV_LBUF_LEN(256);
508e860785dSNeil Armstrong
509e860785dSNeil Armstrong priv->viu.vd1_afbc_dec_def_color = AFBC_DEF_COLOR_Y(1023);
510e860785dSNeil Armstrong
511e860785dSNeil Armstrong /* 420: horizontal / 2, vertical / 4 */
512e860785dSNeil Armstrong priv->viu.vd1_afbc_vd_cfmt_ctrl = AFBC_HORZ_RPT_PIXEL0 |
513e860785dSNeil Armstrong AFBC_HORZ_Y_C_RATIO(1) |
514e860785dSNeil Armstrong AFBC_HORZ_FMT_EN |
515e860785dSNeil Armstrong AFBC_VERT_RPT_LINE0 |
516e860785dSNeil Armstrong AFBC_VERT_INITIAL_PHASE(12) |
517e860785dSNeil Armstrong AFBC_VERT_PHASE_STEP(8) |
518e860785dSNeil Armstrong AFBC_VERT_FMT_EN;
519e860785dSNeil Armstrong
520e860785dSNeil Armstrong switch (fb->format->format) {
521e860785dSNeil Armstrong /* AFBC Only formats */
522e860785dSNeil Armstrong case DRM_FORMAT_YUV420_10BIT:
523e860785dSNeil Armstrong priv->viu.vd1_afbc_mode |=
524e860785dSNeil Armstrong AFBC_COMPBITS_YUV(AFBC_COMPBITS_10BIT);
525e860785dSNeil Armstrong priv->viu.vd1_afbc_dec_def_color |=
526e860785dSNeil Armstrong AFBC_DEF_COLOR_U(512) |
527e860785dSNeil Armstrong AFBC_DEF_COLOR_V(512);
528e860785dSNeil Armstrong break;
529e860785dSNeil Armstrong case DRM_FORMAT_YUV420_8BIT:
530e860785dSNeil Armstrong priv->viu.vd1_afbc_dec_def_color |=
531e860785dSNeil Armstrong AFBC_DEF_COLOR_U(128) |
532e860785dSNeil Armstrong AFBC_DEF_COLOR_V(128);
533e860785dSNeil Armstrong break;
534e860785dSNeil Armstrong }
535e860785dSNeil Armstrong
536e860785dSNeil Armstrong priv->viu.vd1_if0_gen_reg = 0;
537e860785dSNeil Armstrong priv->viu.vd1_if0_canvas0 = 0;
538e860785dSNeil Armstrong priv->viu.viu_vd1_fmt_ctrl = 0;
539e860785dSNeil Armstrong } else {
540e860785dSNeil Armstrong priv->viu.vd1_afbc = false;
541e860785dSNeil Armstrong
542f9a23481SNeil Armstrong priv->viu.vd1_if0_gen_reg = VD_URGENT_CHROMA |
543f9a23481SNeil Armstrong VD_URGENT_LUMA |
544f9a23481SNeil Armstrong VD_HOLD_LINES(9) |
545f9a23481SNeil Armstrong VD_CHRO_RPT_LASTL_CTRL |
546f9a23481SNeil Armstrong VD_ENABLE;
547e860785dSNeil Armstrong }
548f9a23481SNeil Armstrong
549f9a23481SNeil Armstrong /* Setup scaler params */
550f9a23481SNeil Armstrong meson_overlay_setup_scaler_params(priv, plane, interlace_mode);
551f9a23481SNeil Armstrong
552f9a23481SNeil Armstrong priv->viu.vd1_if0_repeat_loop = 0;
553f9a23481SNeil Armstrong priv->viu.vd1_if0_luma0_rpt_pat = interlace_mode ? 8 : 0;
554f9a23481SNeil Armstrong priv->viu.vd1_if0_chroma0_rpt_pat = interlace_mode ? 8 : 0;
555f9a23481SNeil Armstrong priv->viu.vd1_range_map_y = 0;
556f9a23481SNeil Armstrong priv->viu.vd1_range_map_cb = 0;
557f9a23481SNeil Armstrong priv->viu.vd1_range_map_cr = 0;
558f9a23481SNeil Armstrong
559f9a23481SNeil Armstrong /* Default values for RGB888/YUV444 */
560f9a23481SNeil Armstrong priv->viu.vd1_if0_gen_reg2 = 0;
561f9a23481SNeil Armstrong priv->viu.viu_vd1_fmt_ctrl = 0;
562f9a23481SNeil Armstrong
563e860785dSNeil Armstrong /* None will match for AFBC Only formats */
564f9a23481SNeil Armstrong switch (fb->format->format) {
565f9a23481SNeil Armstrong /* TOFIX DRM_FORMAT_RGB888 should be supported */
566f9a23481SNeil Armstrong case DRM_FORMAT_YUYV:
567f9a23481SNeil Armstrong priv->viu.vd1_if0_gen_reg |= VD_BYTES_PER_PIXEL(1);
568f9a23481SNeil Armstrong priv->viu.vd1_if0_canvas0 =
569f9a23481SNeil Armstrong CANVAS_ADDR2(priv->canvas_id_vd1_0) |
570f9a23481SNeil Armstrong CANVAS_ADDR1(priv->canvas_id_vd1_0) |
571f9a23481SNeil Armstrong CANVAS_ADDR0(priv->canvas_id_vd1_0);
572f9a23481SNeil Armstrong priv->viu.viu_vd1_fmt_ctrl = VD_HORZ_Y_C_RATIO(1) | /* /2 */
573f9a23481SNeil Armstrong VD_HORZ_FMT_EN |
574f9a23481SNeil Armstrong VD_VERT_RPT_LINE0 |
575f9a23481SNeil Armstrong VD_VERT_INITIAL_PHASE(12) |
576f9a23481SNeil Armstrong VD_VERT_PHASE_STEP(16) | /* /2 */
577f9a23481SNeil Armstrong VD_VERT_FMT_EN;
578f9a23481SNeil Armstrong break;
579f9a23481SNeil Armstrong case DRM_FORMAT_NV12:
580f9a23481SNeil Armstrong case DRM_FORMAT_NV21:
581f9a23481SNeil Armstrong priv->viu.vd1_if0_gen_reg |= VD_SEPARATE_EN;
582f9a23481SNeil Armstrong priv->viu.vd1_if0_canvas0 =
583f9a23481SNeil Armstrong CANVAS_ADDR2(priv->canvas_id_vd1_1) |
584f9a23481SNeil Armstrong CANVAS_ADDR1(priv->canvas_id_vd1_1) |
585f9a23481SNeil Armstrong CANVAS_ADDR0(priv->canvas_id_vd1_0);
586f9a23481SNeil Armstrong if (fb->format->format == DRM_FORMAT_NV12)
587f9a23481SNeil Armstrong priv->viu.vd1_if0_gen_reg2 = VD_COLOR_MAP(1);
588f9a23481SNeil Armstrong else
589f9a23481SNeil Armstrong priv->viu.vd1_if0_gen_reg2 = VD_COLOR_MAP(2);
590f9a23481SNeil Armstrong priv->viu.viu_vd1_fmt_ctrl = VD_HORZ_Y_C_RATIO(1) | /* /2 */
591f9a23481SNeil Armstrong VD_HORZ_FMT_EN |
592f9a23481SNeil Armstrong VD_VERT_RPT_LINE0 |
593f9a23481SNeil Armstrong VD_VERT_INITIAL_PHASE(12) |
594f9a23481SNeil Armstrong VD_VERT_PHASE_STEP(8) | /* /4 */
595f9a23481SNeil Armstrong VD_VERT_FMT_EN;
596f9a23481SNeil Armstrong break;
597f9a23481SNeil Armstrong case DRM_FORMAT_YUV444:
598f9a23481SNeil Armstrong case DRM_FORMAT_YUV422:
599f9a23481SNeil Armstrong case DRM_FORMAT_YUV420:
600f9a23481SNeil Armstrong case DRM_FORMAT_YUV411:
601f9a23481SNeil Armstrong case DRM_FORMAT_YUV410:
602f9a23481SNeil Armstrong priv->viu.vd1_if0_gen_reg |= VD_SEPARATE_EN;
603f9a23481SNeil Armstrong priv->viu.vd1_if0_canvas0 =
604f9a23481SNeil Armstrong CANVAS_ADDR2(priv->canvas_id_vd1_2) |
605f9a23481SNeil Armstrong CANVAS_ADDR1(priv->canvas_id_vd1_1) |
606f9a23481SNeil Armstrong CANVAS_ADDR0(priv->canvas_id_vd1_0);
607f9a23481SNeil Armstrong switch (fb->format->format) {
608f9a23481SNeil Armstrong case DRM_FORMAT_YUV422:
609f9a23481SNeil Armstrong priv->viu.viu_vd1_fmt_ctrl =
610f9a23481SNeil Armstrong VD_HORZ_Y_C_RATIO(1) | /* /2 */
611f9a23481SNeil Armstrong VD_HORZ_FMT_EN |
612f9a23481SNeil Armstrong VD_VERT_RPT_LINE0 |
613f9a23481SNeil Armstrong VD_VERT_INITIAL_PHASE(12) |
614f9a23481SNeil Armstrong VD_VERT_PHASE_STEP(16) | /* /2 */
615f9a23481SNeil Armstrong VD_VERT_FMT_EN;
616f9a23481SNeil Armstrong break;
617f9a23481SNeil Armstrong case DRM_FORMAT_YUV420:
618f9a23481SNeil Armstrong priv->viu.viu_vd1_fmt_ctrl =
619f9a23481SNeil Armstrong VD_HORZ_Y_C_RATIO(1) | /* /2 */
620f9a23481SNeil Armstrong VD_HORZ_FMT_EN |
621f9a23481SNeil Armstrong VD_VERT_RPT_LINE0 |
622f9a23481SNeil Armstrong VD_VERT_INITIAL_PHASE(12) |
623f9a23481SNeil Armstrong VD_VERT_PHASE_STEP(8) | /* /4 */
624f9a23481SNeil Armstrong VD_VERT_FMT_EN;
625f9a23481SNeil Armstrong break;
626f9a23481SNeil Armstrong case DRM_FORMAT_YUV411:
627f9a23481SNeil Armstrong priv->viu.viu_vd1_fmt_ctrl =
628f9a23481SNeil Armstrong VD_HORZ_Y_C_RATIO(2) | /* /4 */
629f9a23481SNeil Armstrong VD_HORZ_FMT_EN |
630f9a23481SNeil Armstrong VD_VERT_RPT_LINE0 |
631f9a23481SNeil Armstrong VD_VERT_INITIAL_PHASE(12) |
632f9a23481SNeil Armstrong VD_VERT_PHASE_STEP(16) | /* /2 */
633f9a23481SNeil Armstrong VD_VERT_FMT_EN;
634f9a23481SNeil Armstrong break;
635f9a23481SNeil Armstrong case DRM_FORMAT_YUV410:
636f9a23481SNeil Armstrong priv->viu.viu_vd1_fmt_ctrl =
637f9a23481SNeil Armstrong VD_HORZ_Y_C_RATIO(2) | /* /4 */
638f9a23481SNeil Armstrong VD_HORZ_FMT_EN |
639f9a23481SNeil Armstrong VD_VERT_RPT_LINE0 |
640f9a23481SNeil Armstrong VD_VERT_INITIAL_PHASE(12) |
641f9a23481SNeil Armstrong VD_VERT_PHASE_STEP(8) | /* /4 */
642f9a23481SNeil Armstrong VD_VERT_FMT_EN;
643f9a23481SNeil Armstrong break;
644f9a23481SNeil Armstrong }
645f9a23481SNeil Armstrong break;
646f9a23481SNeil Armstrong }
647f9a23481SNeil Armstrong
648f9a23481SNeil Armstrong /* Update Canvas with buffer address */
64905c452c1SMaxime Ripard priv->viu.vd1_planes = fb->format->num_planes;
650f9a23481SNeil Armstrong
651f9a23481SNeil Armstrong switch (priv->viu.vd1_planes) {
652f9a23481SNeil Armstrong case 3:
6536bcfe8eaSDanilo Krummrich gem = drm_fb_dma_get_gem_obj(fb, 2);
654*8c30eeccSDanilo Krummrich priv->viu.vd1_addr2 = gem->dma_addr + fb->offsets[2];
655f9a23481SNeil Armstrong priv->viu.vd1_stride2 = fb->pitches[2];
656f9a23481SNeil Armstrong priv->viu.vd1_height2 =
657bf39607cSMaxime Ripard drm_format_info_plane_height(fb->format,
658bf39607cSMaxime Ripard fb->height, 2);
659f9a23481SNeil Armstrong DRM_DEBUG("plane 2 addr 0x%x stride %d height %d\n",
660f9a23481SNeil Armstrong priv->viu.vd1_addr2,
661f9a23481SNeil Armstrong priv->viu.vd1_stride2,
662f9a23481SNeil Armstrong priv->viu.vd1_height2);
663df561f66SGustavo A. R. Silva fallthrough;
664f9a23481SNeil Armstrong case 2:
6656bcfe8eaSDanilo Krummrich gem = drm_fb_dma_get_gem_obj(fb, 1);
666*8c30eeccSDanilo Krummrich priv->viu.vd1_addr1 = gem->dma_addr + fb->offsets[1];
667f9a23481SNeil Armstrong priv->viu.vd1_stride1 = fb->pitches[1];
668f9a23481SNeil Armstrong priv->viu.vd1_height1 =
669bf39607cSMaxime Ripard drm_format_info_plane_height(fb->format,
670bf39607cSMaxime Ripard fb->height, 1);
671f9a23481SNeil Armstrong DRM_DEBUG("plane 1 addr 0x%x stride %d height %d\n",
672f9a23481SNeil Armstrong priv->viu.vd1_addr1,
673f9a23481SNeil Armstrong priv->viu.vd1_stride1,
674f9a23481SNeil Armstrong priv->viu.vd1_height1);
675df561f66SGustavo A. R. Silva fallthrough;
676f9a23481SNeil Armstrong case 1:
6776bcfe8eaSDanilo Krummrich gem = drm_fb_dma_get_gem_obj(fb, 0);
678*8c30eeccSDanilo Krummrich priv->viu.vd1_addr0 = gem->dma_addr + fb->offsets[0];
679f9a23481SNeil Armstrong priv->viu.vd1_stride0 = fb->pitches[0];
680f9a23481SNeil Armstrong priv->viu.vd1_height0 =
681bf39607cSMaxime Ripard drm_format_info_plane_height(fb->format,
682bf39607cSMaxime Ripard fb->height, 0);
683f9a23481SNeil Armstrong DRM_DEBUG("plane 0 addr 0x%x stride %d height %d\n",
684f9a23481SNeil Armstrong priv->viu.vd1_addr0,
685f9a23481SNeil Armstrong priv->viu.vd1_stride0,
686f9a23481SNeil Armstrong priv->viu.vd1_height0);
687f9a23481SNeil Armstrong }
688f9a23481SNeil Armstrong
689e860785dSNeil Armstrong if (priv->viu.vd1_afbc) {
690be26a04bSNeil Armstrong if (priv->viu.vd1_afbc_mode & AFBC_SCATTER_MODE) {
691be26a04bSNeil Armstrong /*
692be26a04bSNeil Armstrong * In Scatter mode, the header contains the physical
693be26a04bSNeil Armstrong * body content layout, thus the body content
694be26a04bSNeil Armstrong * size isn't needed.
695be26a04bSNeil Armstrong */
696be26a04bSNeil Armstrong priv->viu.vd1_afbc_head_addr = priv->viu.vd1_addr0 >> 4;
697be26a04bSNeil Armstrong priv->viu.vd1_afbc_body_addr = 0;
698be26a04bSNeil Armstrong } else {
699376b1391SNeil Armstrong /* Default mode is 4k per superblock */
700376b1391SNeil Armstrong unsigned long block_size = 4096;
701e860785dSNeil Armstrong unsigned long body_size;
702e860785dSNeil Armstrong
703376b1391SNeil Armstrong /* 8bit mem saving mode is 3072bytes per superblock */
704376b1391SNeil Armstrong if (priv->viu.vd1_afbc_mode & AFBC_BLK_MEM_MODE)
705376b1391SNeil Armstrong block_size = 3072;
706376b1391SNeil Armstrong
707e860785dSNeil Armstrong body_size = (ALIGN(priv->viu.vd1_stride0, 64) / 64) *
708e860785dSNeil Armstrong (ALIGN(priv->viu.vd1_height0, 32) / 32) *
709376b1391SNeil Armstrong block_size;
710e860785dSNeil Armstrong
711e860785dSNeil Armstrong priv->viu.vd1_afbc_body_addr = priv->viu.vd1_addr0 >> 4;
712e860785dSNeil Armstrong /* Header is after body content */
713e860785dSNeil Armstrong priv->viu.vd1_afbc_head_addr = (priv->viu.vd1_addr0 +
714e860785dSNeil Armstrong body_size) >> 4;
715e860785dSNeil Armstrong }
716be26a04bSNeil Armstrong }
717e860785dSNeil Armstrong
718f9a23481SNeil Armstrong priv->viu.vd1_enabled = true;
719f9a23481SNeil Armstrong
720f9a23481SNeil Armstrong spin_unlock_irqrestore(&priv->drm->event_lock, flags);
721f9a23481SNeil Armstrong
722f9a23481SNeil Armstrong DRM_DEBUG_DRIVER("\n");
723f9a23481SNeil Armstrong }
724f9a23481SNeil Armstrong
meson_overlay_atomic_disable(struct drm_plane * plane,struct drm_atomic_state * state)725f9a23481SNeil Armstrong static void meson_overlay_atomic_disable(struct drm_plane *plane,
726977697e2SMaxime Ripard struct drm_atomic_state *state)
727f9a23481SNeil Armstrong {
728f9a23481SNeil Armstrong struct meson_overlay *meson_overlay = to_meson_overlay(plane);
729f9a23481SNeil Armstrong struct meson_drm *priv = meson_overlay->priv;
730f9a23481SNeil Armstrong
731f9a23481SNeil Armstrong DRM_DEBUG_DRIVER("\n");
732f9a23481SNeil Armstrong
733f9a23481SNeil Armstrong priv->viu.vd1_enabled = false;
734f9a23481SNeil Armstrong
735f9a23481SNeil Armstrong /* Disable VD1 */
736528a25d0SJulien Masson if (meson_vpu_is_compatible(priv, VPU_COMPATIBLE_G12A)) {
73711c2d4c7SNeil Armstrong writel_relaxed(0, priv->io_base + _REG(VD1_BLEND_SRC_CTRL));
73811c2d4c7SNeil Armstrong writel_relaxed(0, priv->io_base + _REG(VD2_BLEND_SRC_CTRL));
73911c2d4c7SNeil Armstrong writel_relaxed(0, priv->io_base + _REG(VD1_IF0_GEN_REG + 0x17b0));
74011c2d4c7SNeil Armstrong writel_relaxed(0, priv->io_base + _REG(VD2_IF0_GEN_REG + 0x17b0));
74111c2d4c7SNeil Armstrong } else
742f9a23481SNeil Armstrong writel_bits_relaxed(VPP_VD1_POSTBLEND | VPP_VD1_PREBLEND, 0,
743f9a23481SNeil Armstrong priv->io_base + _REG(VPP_MISC));
744f9a23481SNeil Armstrong
745f9a23481SNeil Armstrong }
746f9a23481SNeil Armstrong
747f9a23481SNeil Armstrong static const struct drm_plane_helper_funcs meson_overlay_helper_funcs = {
748f9a23481SNeil Armstrong .atomic_check = meson_overlay_atomic_check,
749f9a23481SNeil Armstrong .atomic_disable = meson_overlay_atomic_disable,
750f9a23481SNeil Armstrong .atomic_update = meson_overlay_atomic_update,
751f9a23481SNeil Armstrong };
752f9a23481SNeil Armstrong
meson_overlay_format_mod_supported(struct drm_plane * plane,u32 format,u64 modifier)753e860785dSNeil Armstrong static bool meson_overlay_format_mod_supported(struct drm_plane *plane,
754e860785dSNeil Armstrong u32 format, u64 modifier)
755e860785dSNeil Armstrong {
756e860785dSNeil Armstrong if (modifier == DRM_FORMAT_MOD_LINEAR &&
757e860785dSNeil Armstrong format != DRM_FORMAT_YUV420_8BIT &&
758e860785dSNeil Armstrong format != DRM_FORMAT_YUV420_10BIT)
759e860785dSNeil Armstrong return true;
760e860785dSNeil Armstrong
761e860785dSNeil Armstrong if ((modifier & DRM_FORMAT_MOD_AMLOGIC_FBC(0, 0)) ==
762e860785dSNeil Armstrong DRM_FORMAT_MOD_AMLOGIC_FBC(0, 0)) {
763e860785dSNeil Armstrong unsigned int layout = modifier &
764e860785dSNeil Armstrong DRM_FORMAT_MOD_AMLOGIC_FBC(
765e860785dSNeil Armstrong __fourcc_mod_amlogic_layout_mask, 0);
766376b1391SNeil Armstrong unsigned int options =
767376b1391SNeil Armstrong (modifier >> __fourcc_mod_amlogic_options_shift) &
768376b1391SNeil Armstrong __fourcc_mod_amlogic_options_mask;
769e860785dSNeil Armstrong
770e860785dSNeil Armstrong if (format != DRM_FORMAT_YUV420_8BIT &&
771e860785dSNeil Armstrong format != DRM_FORMAT_YUV420_10BIT) {
772e860785dSNeil Armstrong DRM_DEBUG_KMS("%llx invalid format 0x%08x\n",
773e860785dSNeil Armstrong modifier, format);
774e860785dSNeil Armstrong return false;
775e860785dSNeil Armstrong }
776e860785dSNeil Armstrong
777be26a04bSNeil Armstrong if (layout != AMLOGIC_FBC_LAYOUT_BASIC &&
778be26a04bSNeil Armstrong layout != AMLOGIC_FBC_LAYOUT_SCATTER) {
779e860785dSNeil Armstrong DRM_DEBUG_KMS("%llx invalid layout %x\n",
780e860785dSNeil Armstrong modifier, layout);
781e860785dSNeil Armstrong return false;
782e860785dSNeil Armstrong }
783e860785dSNeil Armstrong
784376b1391SNeil Armstrong if (options &&
785376b1391SNeil Armstrong options != AMLOGIC_FBC_OPTION_MEM_SAVING) {
786376b1391SNeil Armstrong DRM_DEBUG_KMS("%llx invalid layout %x\n",
787376b1391SNeil Armstrong modifier, layout);
788376b1391SNeil Armstrong return false;
789376b1391SNeil Armstrong }
790376b1391SNeil Armstrong
791e860785dSNeil Armstrong return true;
792e860785dSNeil Armstrong }
793e860785dSNeil Armstrong
794e860785dSNeil Armstrong DRM_DEBUG_KMS("invalid modifier %llx for format 0x%08x\n",
795e860785dSNeil Armstrong modifier, format);
796e860785dSNeil Armstrong
797e860785dSNeil Armstrong return false;
798e860785dSNeil Armstrong }
799e860785dSNeil Armstrong
800f9a23481SNeil Armstrong static const struct drm_plane_funcs meson_overlay_funcs = {
801f9a23481SNeil Armstrong .update_plane = drm_atomic_helper_update_plane,
802f9a23481SNeil Armstrong .disable_plane = drm_atomic_helper_disable_plane,
803f9a23481SNeil Armstrong .destroy = drm_plane_cleanup,
804f9a23481SNeil Armstrong .reset = drm_atomic_helper_plane_reset,
805f9a23481SNeil Armstrong .atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state,
806f9a23481SNeil Armstrong .atomic_destroy_state = drm_atomic_helper_plane_destroy_state,
807e860785dSNeil Armstrong .format_mod_supported = meson_overlay_format_mod_supported,
808f9a23481SNeil Armstrong };
809f9a23481SNeil Armstrong
810f9a23481SNeil Armstrong static const uint32_t supported_drm_formats[] = {
811f9a23481SNeil Armstrong DRM_FORMAT_YUYV,
812f9a23481SNeil Armstrong DRM_FORMAT_NV12,
813f9a23481SNeil Armstrong DRM_FORMAT_NV21,
814f9a23481SNeil Armstrong DRM_FORMAT_YUV444,
815f9a23481SNeil Armstrong DRM_FORMAT_YUV422,
816f9a23481SNeil Armstrong DRM_FORMAT_YUV420,
817f9a23481SNeil Armstrong DRM_FORMAT_YUV411,
818f9a23481SNeil Armstrong DRM_FORMAT_YUV410,
819e860785dSNeil Armstrong DRM_FORMAT_YUV420_8BIT, /* Amlogic FBC Only */
820e860785dSNeil Armstrong DRM_FORMAT_YUV420_10BIT, /* Amlogic FBC Only */
821e860785dSNeil Armstrong };
822e860785dSNeil Armstrong
823e860785dSNeil Armstrong static const uint64_t format_modifiers[] = {
824be26a04bSNeil Armstrong DRM_FORMAT_MOD_AMLOGIC_FBC(AMLOGIC_FBC_LAYOUT_SCATTER,
825be26a04bSNeil Armstrong AMLOGIC_FBC_OPTION_MEM_SAVING),
826376b1391SNeil Armstrong DRM_FORMAT_MOD_AMLOGIC_FBC(AMLOGIC_FBC_LAYOUT_BASIC,
827376b1391SNeil Armstrong AMLOGIC_FBC_OPTION_MEM_SAVING),
828be26a04bSNeil Armstrong DRM_FORMAT_MOD_AMLOGIC_FBC(AMLOGIC_FBC_LAYOUT_SCATTER, 0),
829e860785dSNeil Armstrong DRM_FORMAT_MOD_AMLOGIC_FBC(AMLOGIC_FBC_LAYOUT_BASIC, 0),
830e860785dSNeil Armstrong DRM_FORMAT_MOD_LINEAR,
831e860785dSNeil Armstrong DRM_FORMAT_MOD_INVALID,
832f9a23481SNeil Armstrong };
833f9a23481SNeil Armstrong
meson_overlay_create(struct meson_drm * priv)834f9a23481SNeil Armstrong int meson_overlay_create(struct meson_drm *priv)
835f9a23481SNeil Armstrong {
836f9a23481SNeil Armstrong struct meson_overlay *meson_overlay;
837f9a23481SNeil Armstrong struct drm_plane *plane;
838f9a23481SNeil Armstrong
839f9a23481SNeil Armstrong DRM_DEBUG_DRIVER("\n");
840f9a23481SNeil Armstrong
841f9a23481SNeil Armstrong meson_overlay = devm_kzalloc(priv->drm->dev, sizeof(*meson_overlay),
842f9a23481SNeil Armstrong GFP_KERNEL);
843f9a23481SNeil Armstrong if (!meson_overlay)
844f9a23481SNeil Armstrong return -ENOMEM;
845f9a23481SNeil Armstrong
846f9a23481SNeil Armstrong meson_overlay->priv = priv;
847f9a23481SNeil Armstrong plane = &meson_overlay->base;
848f9a23481SNeil Armstrong
849f9a23481SNeil Armstrong drm_universal_plane_init(priv->drm, plane, 0xFF,
850f9a23481SNeil Armstrong &meson_overlay_funcs,
851f9a23481SNeil Armstrong supported_drm_formats,
852f9a23481SNeil Armstrong ARRAY_SIZE(supported_drm_formats),
853e860785dSNeil Armstrong format_modifiers,
854f9a23481SNeil Armstrong DRM_PLANE_TYPE_OVERLAY, "meson_overlay_plane");
855f9a23481SNeil Armstrong
856f9a23481SNeil Armstrong drm_plane_helper_add(plane, &meson_overlay_helper_funcs);
857f9a23481SNeil Armstrong
858fd311d88SNeil Armstrong /* For now, VD Overlay plane is always on the back */
859fd311d88SNeil Armstrong drm_plane_create_zpos_immutable_property(plane, 0);
860fd311d88SNeil Armstrong
861f9a23481SNeil Armstrong priv->overlay_plane = plane;
862f9a23481SNeil Armstrong
863f9a23481SNeil Armstrong DRM_DEBUG_DRIVER("\n");
864f9a23481SNeil Armstrong
865f9a23481SNeil Armstrong return 0;
866f9a23481SNeil Armstrong }
867