drm/meson: fix primary plane disabling
[platform/kernel/linux-starfive.git] / drivers / gpu / drm / meson / meson_crtc.c
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * Copyright (C) 2016 BayLibre, SAS
4  * Author: Neil Armstrong <narmstrong@baylibre.com>
5  * Copyright (C) 2015 Amlogic, Inc. All rights reserved.
6  * Copyright (C) 2014 Endless Mobile
7  *
8  * Written by:
9  *     Jasper St. Pierre <jstpierre@mecheye.net>
10  */
11
12 #include <linux/kernel.h>
13 #include <linux/module.h>
14 #include <linux/mutex.h>
15 #include <linux/platform_device.h>
16 #include <linux/bitfield.h>
17 #include <drm/drmP.h>
18 #include <drm/drm_atomic.h>
19 #include <drm/drm_atomic_helper.h>
20 #include <drm/drm_flip_work.h>
21 #include <drm/drm_probe_helper.h>
22
23 #include "meson_crtc.h"
24 #include "meson_plane.h"
25 #include "meson_venc.h"
26 #include "meson_vpp.h"
27 #include "meson_viu.h"
28 #include "meson_registers.h"
29
30 #define MESON_G12A_VIU_OFFSET   0x5ec0
31
32 /* CRTC definition */
33
34 struct meson_crtc {
35         struct drm_crtc base;
36         struct drm_pending_vblank_event *event;
37         struct meson_drm *priv;
38         void (*enable_osd1)(struct meson_drm *priv);
39         void (*enable_vd1)(struct meson_drm *priv);
40         unsigned int viu_offset;
41 };
42 #define to_meson_crtc(x) container_of(x, struct meson_crtc, base)
43
44 /* CRTC */
45
46 static int meson_crtc_enable_vblank(struct drm_crtc *crtc)
47 {
48         struct meson_crtc *meson_crtc = to_meson_crtc(crtc);
49         struct meson_drm *priv = meson_crtc->priv;
50
51         meson_venc_enable_vsync(priv);
52
53         return 0;
54 }
55
56 static void meson_crtc_disable_vblank(struct drm_crtc *crtc)
57 {
58         struct meson_crtc *meson_crtc = to_meson_crtc(crtc);
59         struct meson_drm *priv = meson_crtc->priv;
60
61         meson_venc_disable_vsync(priv);
62 }
63
64 static const struct drm_crtc_funcs meson_crtc_funcs = {
65         .atomic_destroy_state   = drm_atomic_helper_crtc_destroy_state,
66         .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
67         .destroy                = drm_crtc_cleanup,
68         .page_flip              = drm_atomic_helper_page_flip,
69         .reset                  = drm_atomic_helper_crtc_reset,
70         .set_config             = drm_atomic_helper_set_config,
71         .enable_vblank          = meson_crtc_enable_vblank,
72         .disable_vblank         = meson_crtc_disable_vblank,
73
74 };
75
76 static void meson_g12a_crtc_atomic_enable(struct drm_crtc *crtc,
77                                           struct drm_crtc_state *old_state)
78 {
79         struct meson_crtc *meson_crtc = to_meson_crtc(crtc);
80         struct drm_crtc_state *crtc_state = crtc->state;
81         struct meson_drm *priv = meson_crtc->priv;
82
83         DRM_DEBUG_DRIVER("\n");
84
85         if (!crtc_state) {
86                 DRM_ERROR("Invalid crtc_state\n");
87                 return;
88         }
89
90         /* VD1 Preblend vertical start/end */
91         writel(FIELD_PREP(GENMASK(11, 0), 2303),
92                priv->io_base + _REG(VPP_PREBLEND_VD1_V_START_END));
93
94         /* Setup Blender */
95         writel(crtc_state->mode.hdisplay |
96                crtc_state->mode.vdisplay << 16,
97                priv->io_base + _REG(VPP_POSTBLEND_H_SIZE));
98
99         writel_relaxed(0 << 16 |
100                         (crtc_state->mode.hdisplay - 1),
101                         priv->io_base + _REG(VPP_OSD1_BLD_H_SCOPE));
102         writel_relaxed(0 << 16 |
103                         (crtc_state->mode.vdisplay - 1),
104                         priv->io_base + _REG(VPP_OSD1_BLD_V_SCOPE));
105         writel_relaxed(crtc_state->mode.hdisplay << 16 |
106                         crtc_state->mode.vdisplay,
107                         priv->io_base + _REG(VPP_OUT_H_V_SIZE));
108
109         drm_crtc_vblank_on(crtc);
110 }
111
112 static void meson_crtc_atomic_enable(struct drm_crtc *crtc,
113                                      struct drm_crtc_state *old_state)
114 {
115         struct meson_crtc *meson_crtc = to_meson_crtc(crtc);
116         struct drm_crtc_state *crtc_state = crtc->state;
117         struct meson_drm *priv = meson_crtc->priv;
118
119         DRM_DEBUG_DRIVER("\n");
120
121         if (!crtc_state) {
122                 DRM_ERROR("Invalid crtc_state\n");
123                 return;
124         }
125
126         /* Enable VPP Postblend */
127         writel(crtc_state->mode.hdisplay,
128                priv->io_base + _REG(VPP_POSTBLEND_H_SIZE));
129
130         /* VD1 Preblend vertical start/end */
131         writel(FIELD_PREP(GENMASK(11, 0), 2303),
132                         priv->io_base + _REG(VPP_PREBLEND_VD1_V_START_END));
133
134         writel_bits_relaxed(VPP_POSTBLEND_ENABLE, VPP_POSTBLEND_ENABLE,
135                             priv->io_base + _REG(VPP_MISC));
136
137         drm_crtc_vblank_on(crtc);
138 }
139
140 static void meson_g12a_crtc_atomic_disable(struct drm_crtc *crtc,
141                                            struct drm_crtc_state *old_state)
142 {
143         struct meson_crtc *meson_crtc = to_meson_crtc(crtc);
144         struct meson_drm *priv = meson_crtc->priv;
145
146         DRM_DEBUG_DRIVER("\n");
147
148         drm_crtc_vblank_off(crtc);
149
150         priv->viu.osd1_enabled = false;
151         priv->viu.osd1_commit = false;
152
153         priv->viu.vd1_enabled = false;
154         priv->viu.vd1_commit = false;
155
156         if (crtc->state->event && !crtc->state->active) {
157                 spin_lock_irq(&crtc->dev->event_lock);
158                 drm_crtc_send_vblank_event(crtc, crtc->state->event);
159                 spin_unlock_irq(&crtc->dev->event_lock);
160
161                 crtc->state->event = NULL;
162         }
163 }
164
165 static void meson_crtc_atomic_disable(struct drm_crtc *crtc,
166                                       struct drm_crtc_state *old_state)
167 {
168         struct meson_crtc *meson_crtc = to_meson_crtc(crtc);
169         struct meson_drm *priv = meson_crtc->priv;
170
171         DRM_DEBUG_DRIVER("\n");
172
173         drm_crtc_vblank_off(crtc);
174
175         priv->viu.osd1_enabled = false;
176         priv->viu.osd1_commit = false;
177
178         priv->viu.vd1_enabled = false;
179         priv->viu.vd1_commit = false;
180
181         /* Disable VPP Postblend */
182         writel_bits_relaxed(VPP_OSD1_POSTBLEND | VPP_VD1_POSTBLEND |
183                             VPP_VD1_PREBLEND | VPP_POSTBLEND_ENABLE, 0,
184                             priv->io_base + _REG(VPP_MISC));
185
186         if (crtc->state->event && !crtc->state->active) {
187                 spin_lock_irq(&crtc->dev->event_lock);
188                 drm_crtc_send_vblank_event(crtc, crtc->state->event);
189                 spin_unlock_irq(&crtc->dev->event_lock);
190
191                 crtc->state->event = NULL;
192         }
193 }
194
195 static void meson_crtc_atomic_begin(struct drm_crtc *crtc,
196                                     struct drm_crtc_state *state)
197 {
198         struct meson_crtc *meson_crtc = to_meson_crtc(crtc);
199         unsigned long flags;
200
201         if (crtc->state->event) {
202                 WARN_ON(drm_crtc_vblank_get(crtc) != 0);
203
204                 spin_lock_irqsave(&crtc->dev->event_lock, flags);
205                 meson_crtc->event = crtc->state->event;
206                 spin_unlock_irqrestore(&crtc->dev->event_lock, flags);
207                 crtc->state->event = NULL;
208         }
209 }
210
211 static void meson_crtc_atomic_flush(struct drm_crtc *crtc,
212                                     struct drm_crtc_state *old_crtc_state)
213 {
214         struct meson_crtc *meson_crtc = to_meson_crtc(crtc);
215         struct meson_drm *priv = meson_crtc->priv;
216
217         priv->viu.osd1_commit = true;
218         priv->viu.vd1_commit = true;
219 }
220
221 static const struct drm_crtc_helper_funcs meson_crtc_helper_funcs = {
222         .atomic_begin   = meson_crtc_atomic_begin,
223         .atomic_flush   = meson_crtc_atomic_flush,
224         .atomic_enable  = meson_crtc_atomic_enable,
225         .atomic_disable = meson_crtc_atomic_disable,
226 };
227
228 static const struct drm_crtc_helper_funcs meson_g12a_crtc_helper_funcs = {
229         .atomic_begin   = meson_crtc_atomic_begin,
230         .atomic_flush   = meson_crtc_atomic_flush,
231         .atomic_enable  = meson_g12a_crtc_atomic_enable,
232         .atomic_disable = meson_g12a_crtc_atomic_disable,
233 };
234
235 static void meson_crtc_enable_osd1(struct meson_drm *priv)
236 {
237         writel_bits_relaxed(VPP_OSD1_POSTBLEND, VPP_OSD1_POSTBLEND,
238                             priv->io_base + _REG(VPP_MISC));
239 }
240
241 static void meson_g12a_crtc_enable_osd1(struct meson_drm *priv)
242 {
243         writel_relaxed(priv->viu.osd_blend_din0_scope_h,
244                        priv->io_base +
245                        _REG(VIU_OSD_BLEND_DIN0_SCOPE_H));
246         writel_relaxed(priv->viu.osd_blend_din0_scope_v,
247                        priv->io_base +
248                        _REG(VIU_OSD_BLEND_DIN0_SCOPE_V));
249         writel_relaxed(priv->viu.osb_blend0_size,
250                        priv->io_base +
251                        _REG(VIU_OSD_BLEND_BLEND0_SIZE));
252         writel_relaxed(priv->viu.osb_blend1_size,
253                        priv->io_base +
254                        _REG(VIU_OSD_BLEND_BLEND1_SIZE));
255 }
256
257 static void meson_crtc_enable_vd1(struct meson_drm *priv)
258 {
259         writel_bits_relaxed(VPP_VD1_PREBLEND | VPP_VD1_POSTBLEND |
260                             VPP_COLOR_MNG_ENABLE,
261                             VPP_VD1_PREBLEND | VPP_VD1_POSTBLEND |
262                             VPP_COLOR_MNG_ENABLE,
263                             priv->io_base + _REG(VPP_MISC));
264 }
265
266 static void meson_g12a_crtc_enable_vd1(struct meson_drm *priv)
267 {
268         writel_relaxed(((1 << 16) | /* post bld premult*/
269                         (1 << 8) | /* post src */
270                         (1 << 4) | /* pre bld premult*/
271                         (1 << 0)),
272                         priv->io_base + _REG(VD1_BLEND_SRC_CTRL));
273 }
274
275 void meson_crtc_irq(struct meson_drm *priv)
276 {
277         struct meson_crtc *meson_crtc = to_meson_crtc(priv->crtc);
278         unsigned long flags;
279
280         /* Update the OSD registers */
281         if (priv->viu.osd1_enabled && priv->viu.osd1_commit) {
282                 writel_relaxed(priv->viu.osd1_ctrl_stat,
283                                 priv->io_base + _REG(VIU_OSD1_CTRL_STAT));
284                 writel_relaxed(priv->viu.osd1_blk0_cfg[0],
285                                 priv->io_base + _REG(VIU_OSD1_BLK0_CFG_W0));
286                 writel_relaxed(priv->viu.osd1_blk0_cfg[1],
287                                 priv->io_base + _REG(VIU_OSD1_BLK0_CFG_W1));
288                 writel_relaxed(priv->viu.osd1_blk0_cfg[2],
289                                 priv->io_base + _REG(VIU_OSD1_BLK0_CFG_W2));
290                 writel_relaxed(priv->viu.osd1_blk0_cfg[3],
291                                 priv->io_base + _REG(VIU_OSD1_BLK0_CFG_W3));
292                 writel_relaxed(priv->viu.osd1_blk0_cfg[4],
293                                 priv->io_base + _REG(VIU_OSD1_BLK0_CFG_W4));
294                 writel_relaxed(priv->viu.osd_sc_ctrl0,
295                                 priv->io_base + _REG(VPP_OSD_SC_CTRL0));
296                 writel_relaxed(priv->viu.osd_sc_i_wh_m1,
297                                 priv->io_base + _REG(VPP_OSD_SCI_WH_M1));
298                 writel_relaxed(priv->viu.osd_sc_o_h_start_end,
299                                 priv->io_base + _REG(VPP_OSD_SCO_H_START_END));
300                 writel_relaxed(priv->viu.osd_sc_o_v_start_end,
301                                 priv->io_base + _REG(VPP_OSD_SCO_V_START_END));
302                 writel_relaxed(priv->viu.osd_sc_v_ini_phase,
303                                 priv->io_base + _REG(VPP_OSD_VSC_INI_PHASE));
304                 writel_relaxed(priv->viu.osd_sc_v_phase_step,
305                                 priv->io_base + _REG(VPP_OSD_VSC_PHASE_STEP));
306                 writel_relaxed(priv->viu.osd_sc_h_ini_phase,
307                                 priv->io_base + _REG(VPP_OSD_HSC_INI_PHASE));
308                 writel_relaxed(priv->viu.osd_sc_h_phase_step,
309                                 priv->io_base + _REG(VPP_OSD_HSC_PHASE_STEP));
310                 writel_relaxed(priv->viu.osd_sc_h_ctrl0,
311                                 priv->io_base + _REG(VPP_OSD_HSC_CTRL0));
312                 writel_relaxed(priv->viu.osd_sc_v_ctrl0,
313                                 priv->io_base + _REG(VPP_OSD_VSC_CTRL0));
314
315                 meson_canvas_config(priv->canvas, priv->canvas_id_osd1,
316                                 priv->viu.osd1_addr, priv->viu.osd1_stride,
317                                 priv->viu.osd1_height, MESON_CANVAS_WRAP_NONE,
318                                 MESON_CANVAS_BLKMODE_LINEAR, 0);
319
320                 /* Enable OSD1 */
321                 if (meson_crtc->enable_osd1)
322                         meson_crtc->enable_osd1(priv);
323
324                 priv->viu.osd1_commit = false;
325         }
326
327         /* Update the VD1 registers */
328         if (priv->viu.vd1_enabled && priv->viu.vd1_commit) {
329
330                 switch (priv->viu.vd1_planes) {
331                 case 3:
332                         meson_canvas_config(priv->canvas,
333                                             priv->canvas_id_vd1_2,
334                                             priv->viu.vd1_addr2,
335                                             priv->viu.vd1_stride2,
336                                             priv->viu.vd1_height2,
337                                             MESON_CANVAS_WRAP_NONE,
338                                             MESON_CANVAS_BLKMODE_LINEAR,
339                                             MESON_CANVAS_ENDIAN_SWAP64);
340                 /* fallthrough */
341                 case 2:
342                         meson_canvas_config(priv->canvas,
343                                             priv->canvas_id_vd1_1,
344                                             priv->viu.vd1_addr1,
345                                             priv->viu.vd1_stride1,
346                                             priv->viu.vd1_height1,
347                                             MESON_CANVAS_WRAP_NONE,
348                                             MESON_CANVAS_BLKMODE_LINEAR,
349                                             MESON_CANVAS_ENDIAN_SWAP64);
350                 /* fallthrough */
351                 case 1:
352                         meson_canvas_config(priv->canvas,
353                                             priv->canvas_id_vd1_0,
354                                             priv->viu.vd1_addr0,
355                                             priv->viu.vd1_stride0,
356                                             priv->viu.vd1_height0,
357                                             MESON_CANVAS_WRAP_NONE,
358                                             MESON_CANVAS_BLKMODE_LINEAR,
359                                             MESON_CANVAS_ENDIAN_SWAP64);
360                 };
361
362                 writel_relaxed(priv->viu.vd1_if0_gen_reg,
363                                 priv->io_base + meson_crtc->viu_offset +
364                                 _REG(VD1_IF0_GEN_REG));
365                 writel_relaxed(priv->viu.vd1_if0_gen_reg,
366                                 priv->io_base + meson_crtc->viu_offset +
367                                 _REG(VD2_IF0_GEN_REG));
368                 writel_relaxed(priv->viu.vd1_if0_gen_reg2,
369                                 priv->io_base + meson_crtc->viu_offset +
370                                 _REG(VD1_IF0_GEN_REG2));
371                 writel_relaxed(priv->viu.viu_vd1_fmt_ctrl,
372                                 priv->io_base + meson_crtc->viu_offset +
373                                 _REG(VIU_VD1_FMT_CTRL));
374                 writel_relaxed(priv->viu.viu_vd1_fmt_ctrl,
375                                 priv->io_base + meson_crtc->viu_offset +
376                                 _REG(VIU_VD2_FMT_CTRL));
377                 writel_relaxed(priv->viu.viu_vd1_fmt_w,
378                                 priv->io_base + meson_crtc->viu_offset +
379                                 _REG(VIU_VD1_FMT_W));
380                 writel_relaxed(priv->viu.viu_vd1_fmt_w,
381                                 priv->io_base + meson_crtc->viu_offset +
382                                 _REG(VIU_VD2_FMT_W));
383                 writel_relaxed(priv->viu.vd1_if0_canvas0,
384                                 priv->io_base + meson_crtc->viu_offset +
385                                 _REG(VD1_IF0_CANVAS0));
386                 writel_relaxed(priv->viu.vd1_if0_canvas0,
387                                 priv->io_base + meson_crtc->viu_offset +
388                                 _REG(VD1_IF0_CANVAS1));
389                 writel_relaxed(priv->viu.vd1_if0_canvas0,
390                                 priv->io_base + meson_crtc->viu_offset +
391                                 _REG(VD2_IF0_CANVAS0));
392                 writel_relaxed(priv->viu.vd1_if0_canvas0,
393                                 priv->io_base + meson_crtc->viu_offset +
394                                 _REG(VD2_IF0_CANVAS1));
395                 writel_relaxed(priv->viu.vd1_if0_luma_x0,
396                                 priv->io_base + meson_crtc->viu_offset +
397                                 _REG(VD1_IF0_LUMA_X0));
398                 writel_relaxed(priv->viu.vd1_if0_luma_x0,
399                                 priv->io_base + meson_crtc->viu_offset +
400                                 _REG(VD1_IF0_LUMA_X1));
401                 writel_relaxed(priv->viu.vd1_if0_luma_x0,
402                                 priv->io_base + meson_crtc->viu_offset +
403                                 _REG(VD2_IF0_LUMA_X0));
404                 writel_relaxed(priv->viu.vd1_if0_luma_x0,
405                                 priv->io_base + meson_crtc->viu_offset +
406                                 _REG(VD2_IF0_LUMA_X1));
407                 writel_relaxed(priv->viu.vd1_if0_luma_y0,
408                                 priv->io_base + meson_crtc->viu_offset +
409                                 _REG(VD1_IF0_LUMA_Y0));
410                 writel_relaxed(priv->viu.vd1_if0_luma_y0,
411                                 priv->io_base + meson_crtc->viu_offset +
412                                 _REG(VD1_IF0_LUMA_Y1));
413                 writel_relaxed(priv->viu.vd1_if0_luma_y0,
414                                 priv->io_base + meson_crtc->viu_offset +
415                                 _REG(VD2_IF0_LUMA_Y0));
416                 writel_relaxed(priv->viu.vd1_if0_luma_y0,
417                                 priv->io_base + meson_crtc->viu_offset +
418                                 _REG(VD2_IF0_LUMA_Y1));
419                 writel_relaxed(priv->viu.vd1_if0_chroma_x0,
420                                 priv->io_base + meson_crtc->viu_offset +
421                                 _REG(VD1_IF0_CHROMA_X0));
422                 writel_relaxed(priv->viu.vd1_if0_chroma_x0,
423                                 priv->io_base + meson_crtc->viu_offset +
424                                 _REG(VD1_IF0_CHROMA_X1));
425                 writel_relaxed(priv->viu.vd1_if0_chroma_x0,
426                                 priv->io_base + meson_crtc->viu_offset +
427                                 _REG(VD2_IF0_CHROMA_X0));
428                 writel_relaxed(priv->viu.vd1_if0_chroma_x0,
429                                 priv->io_base + meson_crtc->viu_offset +
430                                 _REG(VD2_IF0_CHROMA_X1));
431                 writel_relaxed(priv->viu.vd1_if0_chroma_y0,
432                                 priv->io_base + meson_crtc->viu_offset +
433                                 _REG(VD1_IF0_CHROMA_Y0));
434                 writel_relaxed(priv->viu.vd1_if0_chroma_y0,
435                                 priv->io_base + meson_crtc->viu_offset +
436                                 _REG(VD1_IF0_CHROMA_Y1));
437                 writel_relaxed(priv->viu.vd1_if0_chroma_y0,
438                                 priv->io_base + meson_crtc->viu_offset +
439                                 _REG(VD2_IF0_CHROMA_Y0));
440                 writel_relaxed(priv->viu.vd1_if0_chroma_y0,
441                                 priv->io_base + meson_crtc->viu_offset +
442                                 _REG(VD2_IF0_CHROMA_Y1));
443                 writel_relaxed(priv->viu.vd1_if0_repeat_loop,
444                                 priv->io_base + meson_crtc->viu_offset +
445                                 _REG(VD1_IF0_RPT_LOOP));
446                 writel_relaxed(priv->viu.vd1_if0_repeat_loop,
447                                 priv->io_base + meson_crtc->viu_offset +
448                                 _REG(VD2_IF0_RPT_LOOP));
449                 writel_relaxed(priv->viu.vd1_if0_luma0_rpt_pat,
450                                 priv->io_base + meson_crtc->viu_offset +
451                                 _REG(VD1_IF0_LUMA0_RPT_PAT));
452                 writel_relaxed(priv->viu.vd1_if0_luma0_rpt_pat,
453                                 priv->io_base + meson_crtc->viu_offset +
454                                 _REG(VD2_IF0_LUMA0_RPT_PAT));
455                 writel_relaxed(priv->viu.vd1_if0_luma0_rpt_pat,
456                                 priv->io_base + meson_crtc->viu_offset +
457                                 _REG(VD1_IF0_LUMA1_RPT_PAT));
458                 writel_relaxed(priv->viu.vd1_if0_luma0_rpt_pat,
459                                 priv->io_base + meson_crtc->viu_offset +
460                                 _REG(VD2_IF0_LUMA1_RPT_PAT));
461                 writel_relaxed(priv->viu.vd1_if0_chroma0_rpt_pat,
462                                 priv->io_base + meson_crtc->viu_offset +
463                                 _REG(VD1_IF0_CHROMA0_RPT_PAT));
464                 writel_relaxed(priv->viu.vd1_if0_chroma0_rpt_pat,
465                                 priv->io_base + meson_crtc->viu_offset +
466                                 _REG(VD2_IF0_CHROMA0_RPT_PAT));
467                 writel_relaxed(priv->viu.vd1_if0_chroma0_rpt_pat,
468                                 priv->io_base + meson_crtc->viu_offset +
469                                 _REG(VD1_IF0_CHROMA1_RPT_PAT));
470                 writel_relaxed(priv->viu.vd1_if0_chroma0_rpt_pat,
471                                 priv->io_base + meson_crtc->viu_offset +
472                                 _REG(VD2_IF0_CHROMA1_RPT_PAT));
473                 writel_relaxed(0, priv->io_base + meson_crtc->viu_offset +
474                                 _REG(VD1_IF0_LUMA_PSEL));
475                 writel_relaxed(0, priv->io_base + meson_crtc->viu_offset +
476                                 _REG(VD1_IF0_CHROMA_PSEL));
477                 writel_relaxed(0, priv->io_base + meson_crtc->viu_offset +
478                                 _REG(VD2_IF0_LUMA_PSEL));
479                 writel_relaxed(0, priv->io_base + meson_crtc->viu_offset +
480                                 _REG(VD2_IF0_CHROMA_PSEL));
481                 writel_relaxed(priv->viu.vd1_range_map_y,
482                                 priv->io_base + meson_crtc->viu_offset +
483                                 _REG(VD1_IF0_RANGE_MAP_Y));
484                 writel_relaxed(priv->viu.vd1_range_map_cb,
485                                 priv->io_base + meson_crtc->viu_offset +
486                                 _REG(VD1_IF0_RANGE_MAP_CB));
487                 writel_relaxed(priv->viu.vd1_range_map_cr,
488                                 priv->io_base + meson_crtc->viu_offset +
489                                 _REG(VD1_IF0_RANGE_MAP_CR));
490                 writel_relaxed(0x78404,
491                                 priv->io_base + _REG(VPP_SC_MISC));
492                 writel_relaxed(priv->viu.vpp_pic_in_height,
493                                 priv->io_base + _REG(VPP_PIC_IN_HEIGHT));
494                 writel_relaxed(priv->viu.vpp_postblend_vd1_h_start_end,
495                         priv->io_base + _REG(VPP_POSTBLEND_VD1_H_START_END));
496                 writel_relaxed(priv->viu.vpp_blend_vd2_h_start_end,
497                         priv->io_base + _REG(VPP_BLEND_VD2_H_START_END));
498                 writel_relaxed(priv->viu.vpp_postblend_vd1_v_start_end,
499                         priv->io_base + _REG(VPP_POSTBLEND_VD1_V_START_END));
500                 writel_relaxed(priv->viu.vpp_blend_vd2_v_start_end,
501                         priv->io_base + _REG(VPP_BLEND_VD2_V_START_END));
502                 writel_relaxed(priv->viu.vpp_hsc_region12_startp,
503                                 priv->io_base + _REG(VPP_HSC_REGION12_STARTP));
504                 writel_relaxed(priv->viu.vpp_hsc_region34_startp,
505                                 priv->io_base + _REG(VPP_HSC_REGION34_STARTP));
506                 writel_relaxed(priv->viu.vpp_hsc_region4_endp,
507                                 priv->io_base + _REG(VPP_HSC_REGION4_ENDP));
508                 writel_relaxed(priv->viu.vpp_hsc_start_phase_step,
509                                 priv->io_base + _REG(VPP_HSC_START_PHASE_STEP));
510                 writel_relaxed(priv->viu.vpp_hsc_region1_phase_slope,
511                         priv->io_base + _REG(VPP_HSC_REGION1_PHASE_SLOPE));
512                 writel_relaxed(priv->viu.vpp_hsc_region3_phase_slope,
513                         priv->io_base + _REG(VPP_HSC_REGION3_PHASE_SLOPE));
514                 writel_relaxed(priv->viu.vpp_line_in_length,
515                                 priv->io_base + _REG(VPP_LINE_IN_LENGTH));
516                 writel_relaxed(priv->viu.vpp_preblend_h_size,
517                                 priv->io_base + _REG(VPP_PREBLEND_H_SIZE));
518                 writel_relaxed(priv->viu.vpp_vsc_region12_startp,
519                                 priv->io_base + _REG(VPP_VSC_REGION12_STARTP));
520                 writel_relaxed(priv->viu.vpp_vsc_region34_startp,
521                                 priv->io_base + _REG(VPP_VSC_REGION34_STARTP));
522                 writel_relaxed(priv->viu.vpp_vsc_region4_endp,
523                                 priv->io_base + _REG(VPP_VSC_REGION4_ENDP));
524                 writel_relaxed(priv->viu.vpp_vsc_start_phase_step,
525                                 priv->io_base + _REG(VPP_VSC_START_PHASE_STEP));
526                 writel_relaxed(priv->viu.vpp_vsc_ini_phase,
527                                 priv->io_base + _REG(VPP_VSC_INI_PHASE));
528                 writel_relaxed(priv->viu.vpp_vsc_phase_ctrl,
529                                 priv->io_base + _REG(VPP_VSC_PHASE_CTRL));
530                 writel_relaxed(priv->viu.vpp_hsc_phase_ctrl,
531                                 priv->io_base + _REG(VPP_HSC_PHASE_CTRL));
532                 writel_relaxed(0x42, priv->io_base + _REG(VPP_SCALE_COEF_IDX));
533
534                 /* Enable VD1 */
535                 if (meson_crtc->enable_vd1)
536                         meson_crtc->enable_vd1(priv);
537
538                 priv->viu.vd1_commit = false;
539         }
540
541         drm_crtc_handle_vblank(priv->crtc);
542
543         spin_lock_irqsave(&priv->drm->event_lock, flags);
544         if (meson_crtc->event) {
545                 drm_crtc_send_vblank_event(priv->crtc, meson_crtc->event);
546                 drm_crtc_vblank_put(priv->crtc);
547                 meson_crtc->event = NULL;
548         }
549         spin_unlock_irqrestore(&priv->drm->event_lock, flags);
550 }
551
552 int meson_crtc_create(struct meson_drm *priv)
553 {
554         struct meson_crtc *meson_crtc;
555         struct drm_crtc *crtc;
556         int ret;
557
558         meson_crtc = devm_kzalloc(priv->drm->dev, sizeof(*meson_crtc),
559                                   GFP_KERNEL);
560         if (!meson_crtc)
561                 return -ENOMEM;
562
563         meson_crtc->priv = priv;
564         crtc = &meson_crtc->base;
565         ret = drm_crtc_init_with_planes(priv->drm, crtc,
566                                         priv->primary_plane, NULL,
567                                         &meson_crtc_funcs, "meson_crtc");
568         if (ret) {
569                 dev_err(priv->drm->dev, "Failed to init CRTC\n");
570                 return ret;
571         }
572
573         if (meson_vpu_is_compatible(priv, "amlogic,meson-g12a-vpu")) {
574                 meson_crtc->enable_osd1 = meson_g12a_crtc_enable_osd1;
575                 meson_crtc->enable_vd1 = meson_g12a_crtc_enable_vd1;
576                 meson_crtc->viu_offset = MESON_G12A_VIU_OFFSET;
577                 drm_crtc_helper_add(crtc, &meson_g12a_crtc_helper_funcs);
578         } else {
579                 meson_crtc->enable_osd1 = meson_crtc_enable_osd1;
580                 meson_crtc->enable_vd1 = meson_crtc_enable_vd1;
581                 drm_crtc_helper_add(crtc, &meson_crtc_helper_funcs);
582         }
583
584         priv->crtc = crtc;
585
586         return 0;
587 }