1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Copyright (C) 2018 Linus Walleij <linus.walleij@linaro.org>
4  * Parts of this file were based on the MCDE driver by Marcus Lorentzon
5  * (C) ST-Ericsson SA 2013
6  */
7 #include <linux/clk.h>
8 #include <linux/delay.h>
9 #include <linux/dma-buf.h>
10 #include <linux/regulator/consumer.h>
11 #include <linux/media-bus-format.h>
12 
13 #include <drm/drm_device.h>
14 #include <drm/drm_fb_cma_helper.h>
15 #include <drm/drm_fourcc.h>
16 #include <drm/drm_framebuffer.h>
17 #include <drm/drm_gem_atomic_helper.h>
18 #include <drm/drm_gem_cma_helper.h>
19 #include <drm/drm_mipi_dsi.h>
20 #include <drm/drm_simple_kms_helper.h>
21 #include <drm/drm_bridge.h>
22 #include <drm/drm_vblank.h>
23 #include <video/mipi_display.h>
24 
25 #include "mcde_drm.h"
26 #include "mcde_display_regs.h"
27 
28 enum mcde_fifo {
29 	MCDE_FIFO_A,
30 	MCDE_FIFO_B,
31 	/* TODO: implement FIFO C0 and FIFO C1 */
32 };
33 
34 enum mcde_channel {
35 	MCDE_CHANNEL_0 = 0,
36 	MCDE_CHANNEL_1,
37 	MCDE_CHANNEL_2,
38 	MCDE_CHANNEL_3,
39 };
40 
41 enum mcde_extsrc {
42 	MCDE_EXTSRC_0 = 0,
43 	MCDE_EXTSRC_1,
44 	MCDE_EXTSRC_2,
45 	MCDE_EXTSRC_3,
46 	MCDE_EXTSRC_4,
47 	MCDE_EXTSRC_5,
48 	MCDE_EXTSRC_6,
49 	MCDE_EXTSRC_7,
50 	MCDE_EXTSRC_8,
51 	MCDE_EXTSRC_9,
52 };
53 
54 enum mcde_overlay {
55 	MCDE_OVERLAY_0 = 0,
56 	MCDE_OVERLAY_1,
57 	MCDE_OVERLAY_2,
58 	MCDE_OVERLAY_3,
59 	MCDE_OVERLAY_4,
60 	MCDE_OVERLAY_5,
61 };
62 
63 enum mcde_formatter {
64 	MCDE_DSI_FORMATTER_0 = 0,
65 	MCDE_DSI_FORMATTER_1,
66 	MCDE_DSI_FORMATTER_2,
67 	MCDE_DSI_FORMATTER_3,
68 	MCDE_DSI_FORMATTER_4,
69 	MCDE_DSI_FORMATTER_5,
70 	MCDE_DPI_FORMATTER_0,
71 	MCDE_DPI_FORMATTER_1,
72 };
73 
74 void mcde_display_irq(struct mcde *mcde)
75 {
76 	u32 mispp, misovl, mischnl;
77 	bool vblank = false;
78 
79 	/* Handle display IRQs */
80 	mispp = readl(mcde->regs + MCDE_MISPP);
81 	misovl = readl(mcde->regs + MCDE_MISOVL);
82 	mischnl = readl(mcde->regs + MCDE_MISCHNL);
83 
84 	/*
85 	 * Handle IRQs from the DSI link. All IRQs from the DSI links
86 	 * are just latched onto the MCDE IRQ line, so we need to traverse
87 	 * any active DSI masters and check if an IRQ is originating from
88 	 * them.
89 	 *
90 	 * TODO: Currently only one DSI link is supported.
91 	 */
92 	if (!mcde->dpi_output && mcde_dsi_irq(mcde->mdsi)) {
93 		u32 val;
94 
95 		/*
96 		 * In oneshot mode we do not send continuous updates
97 		 * to the display, instead we only push out updates when
98 		 * the update function is called, then we disable the
99 		 * flow on the channel once we get the TE IRQ.
100 		 */
101 		if (mcde->flow_mode == MCDE_COMMAND_ONESHOT_FLOW) {
102 			spin_lock(&mcde->flow_lock);
103 			if (--mcde->flow_active == 0) {
104 				dev_dbg(mcde->dev, "TE0 IRQ\n");
105 				/* Disable FIFO A flow */
106 				val = readl(mcde->regs + MCDE_CRA0);
107 				val &= ~MCDE_CRX0_FLOEN;
108 				writel(val, mcde->regs + MCDE_CRA0);
109 			}
110 			spin_unlock(&mcde->flow_lock);
111 		}
112 	}
113 
114 	/* Vblank from one of the channels */
115 	if (mispp & MCDE_PP_VCMPA) {
116 		dev_dbg(mcde->dev, "chnl A vblank IRQ\n");
117 		vblank = true;
118 	}
119 	if (mispp & MCDE_PP_VCMPB) {
120 		dev_dbg(mcde->dev, "chnl B vblank IRQ\n");
121 		vblank = true;
122 	}
123 	if (mispp & MCDE_PP_VCMPC0)
124 		dev_dbg(mcde->dev, "chnl C0 vblank IRQ\n");
125 	if (mispp & MCDE_PP_VCMPC1)
126 		dev_dbg(mcde->dev, "chnl C1 vblank IRQ\n");
127 	if (mispp & MCDE_PP_VSCC0)
128 		dev_dbg(mcde->dev, "chnl C0 TE IRQ\n");
129 	if (mispp & MCDE_PP_VSCC1)
130 		dev_dbg(mcde->dev, "chnl C1 TE IRQ\n");
131 	writel(mispp, mcde->regs + MCDE_RISPP);
132 
133 	if (vblank)
134 		drm_crtc_handle_vblank(&mcde->pipe.crtc);
135 
136 	if (misovl)
137 		dev_info(mcde->dev, "some stray overlay IRQ %08x\n", misovl);
138 	writel(misovl, mcde->regs + MCDE_RISOVL);
139 
140 	if (mischnl)
141 		dev_info(mcde->dev, "some stray channel error IRQ %08x\n",
142 			 mischnl);
143 	writel(mischnl, mcde->regs + MCDE_RISCHNL);
144 }
145 
146 void mcde_display_disable_irqs(struct mcde *mcde)
147 {
148 	/* Disable all IRQs */
149 	writel(0, mcde->regs + MCDE_IMSCPP);
150 	writel(0, mcde->regs + MCDE_IMSCOVL);
151 	writel(0, mcde->regs + MCDE_IMSCCHNL);
152 
153 	/* Clear any pending IRQs */
154 	writel(0xFFFFFFFF, mcde->regs + MCDE_RISPP);
155 	writel(0xFFFFFFFF, mcde->regs + MCDE_RISOVL);
156 	writel(0xFFFFFFFF, mcde->regs + MCDE_RISCHNL);
157 }
158 
159 static int mcde_display_check(struct drm_simple_display_pipe *pipe,
160 			      struct drm_plane_state *pstate,
161 			      struct drm_crtc_state *cstate)
162 {
163 	const struct drm_display_mode *mode = &cstate->mode;
164 	struct drm_framebuffer *old_fb = pipe->plane.state->fb;
165 	struct drm_framebuffer *fb = pstate->fb;
166 
167 	if (fb) {
168 		u32 offset = drm_fb_cma_get_gem_addr(fb, pstate, 0);
169 
170 		/* FB base address must be dword aligned. */
171 		if (offset & 3) {
172 			DRM_DEBUG_KMS("FB not 32-bit aligned\n");
173 			return -EINVAL;
174 		}
175 
176 		/*
177 		 * There's no pitch register, the mode's hdisplay
178 		 * controls this.
179 		 */
180 		if (fb->pitches[0] != mode->hdisplay * fb->format->cpp[0]) {
181 			DRM_DEBUG_KMS("can't handle pitches\n");
182 			return -EINVAL;
183 		}
184 
185 		/*
186 		 * We can't change the FB format in a flicker-free
187 		 * manner (and only update it during CRTC enable).
188 		 */
189 		if (old_fb && old_fb->format != fb->format)
190 			cstate->mode_changed = true;
191 	}
192 
193 	return 0;
194 }
195 
196 static int mcde_configure_extsrc(struct mcde *mcde, enum mcde_extsrc src,
197 				 u32 format)
198 {
199 	u32 val;
200 	u32 conf;
201 	u32 cr;
202 
203 	switch (src) {
204 	case MCDE_EXTSRC_0:
205 		conf = MCDE_EXTSRC0CONF;
206 		cr = MCDE_EXTSRC0CR;
207 		break;
208 	case MCDE_EXTSRC_1:
209 		conf = MCDE_EXTSRC1CONF;
210 		cr = MCDE_EXTSRC1CR;
211 		break;
212 	case MCDE_EXTSRC_2:
213 		conf = MCDE_EXTSRC2CONF;
214 		cr = MCDE_EXTSRC2CR;
215 		break;
216 	case MCDE_EXTSRC_3:
217 		conf = MCDE_EXTSRC3CONF;
218 		cr = MCDE_EXTSRC3CR;
219 		break;
220 	case MCDE_EXTSRC_4:
221 		conf = MCDE_EXTSRC4CONF;
222 		cr = MCDE_EXTSRC4CR;
223 		break;
224 	case MCDE_EXTSRC_5:
225 		conf = MCDE_EXTSRC5CONF;
226 		cr = MCDE_EXTSRC5CR;
227 		break;
228 	case MCDE_EXTSRC_6:
229 		conf = MCDE_EXTSRC6CONF;
230 		cr = MCDE_EXTSRC6CR;
231 		break;
232 	case MCDE_EXTSRC_7:
233 		conf = MCDE_EXTSRC7CONF;
234 		cr = MCDE_EXTSRC7CR;
235 		break;
236 	case MCDE_EXTSRC_8:
237 		conf = MCDE_EXTSRC8CONF;
238 		cr = MCDE_EXTSRC8CR;
239 		break;
240 	case MCDE_EXTSRC_9:
241 		conf = MCDE_EXTSRC9CONF;
242 		cr = MCDE_EXTSRC9CR;
243 		break;
244 	}
245 
246 	/*
247 	 * Configure external source 0 one buffer (buffer 0)
248 	 * primary overlay ID 0.
249 	 * From mcde_hw.c ovly_update_registers() in the vendor tree
250 	 */
251 	val = 0 << MCDE_EXTSRCXCONF_BUF_ID_SHIFT;
252 	val |= 1 << MCDE_EXTSRCXCONF_BUF_NB_SHIFT;
253 	val |= 0 << MCDE_EXTSRCXCONF_PRI_OVLID_SHIFT;
254 
255 	switch (format) {
256 	case DRM_FORMAT_ARGB8888:
257 		val |= MCDE_EXTSRCXCONF_BPP_ARGB8888 <<
258 			MCDE_EXTSRCXCONF_BPP_SHIFT;
259 		break;
260 	case DRM_FORMAT_ABGR8888:
261 		val |= MCDE_EXTSRCXCONF_BPP_ARGB8888 <<
262 			MCDE_EXTSRCXCONF_BPP_SHIFT;
263 		val |= MCDE_EXTSRCXCONF_BGR;
264 		break;
265 	case DRM_FORMAT_XRGB8888:
266 		val |= MCDE_EXTSRCXCONF_BPP_XRGB8888 <<
267 			MCDE_EXTSRCXCONF_BPP_SHIFT;
268 		break;
269 	case DRM_FORMAT_XBGR8888:
270 		val |= MCDE_EXTSRCXCONF_BPP_XRGB8888 <<
271 			MCDE_EXTSRCXCONF_BPP_SHIFT;
272 		val |= MCDE_EXTSRCXCONF_BGR;
273 		break;
274 	case DRM_FORMAT_RGB888:
275 		val |= MCDE_EXTSRCXCONF_BPP_RGB888 <<
276 			MCDE_EXTSRCXCONF_BPP_SHIFT;
277 		break;
278 	case DRM_FORMAT_BGR888:
279 		val |= MCDE_EXTSRCXCONF_BPP_RGB888 <<
280 			MCDE_EXTSRCXCONF_BPP_SHIFT;
281 		val |= MCDE_EXTSRCXCONF_BGR;
282 		break;
283 	case DRM_FORMAT_ARGB4444:
284 		val |= MCDE_EXTSRCXCONF_BPP_ARGB4444 <<
285 			MCDE_EXTSRCXCONF_BPP_SHIFT;
286 		break;
287 	case DRM_FORMAT_ABGR4444:
288 		val |= MCDE_EXTSRCXCONF_BPP_ARGB4444 <<
289 			MCDE_EXTSRCXCONF_BPP_SHIFT;
290 		val |= MCDE_EXTSRCXCONF_BGR;
291 		break;
292 	case DRM_FORMAT_XRGB4444:
293 		val |= MCDE_EXTSRCXCONF_BPP_RGB444 <<
294 			MCDE_EXTSRCXCONF_BPP_SHIFT;
295 		break;
296 	case DRM_FORMAT_XBGR4444:
297 		val |= MCDE_EXTSRCXCONF_BPP_RGB444 <<
298 			MCDE_EXTSRCXCONF_BPP_SHIFT;
299 		val |= MCDE_EXTSRCXCONF_BGR;
300 		break;
301 	case DRM_FORMAT_XRGB1555:
302 		val |= MCDE_EXTSRCXCONF_BPP_IRGB1555 <<
303 			MCDE_EXTSRCXCONF_BPP_SHIFT;
304 		break;
305 	case DRM_FORMAT_XBGR1555:
306 		val |= MCDE_EXTSRCXCONF_BPP_IRGB1555 <<
307 			MCDE_EXTSRCXCONF_BPP_SHIFT;
308 		val |= MCDE_EXTSRCXCONF_BGR;
309 		break;
310 	case DRM_FORMAT_RGB565:
311 		val |= MCDE_EXTSRCXCONF_BPP_RGB565 <<
312 			MCDE_EXTSRCXCONF_BPP_SHIFT;
313 		break;
314 	case DRM_FORMAT_BGR565:
315 		val |= MCDE_EXTSRCXCONF_BPP_RGB565 <<
316 			MCDE_EXTSRCXCONF_BPP_SHIFT;
317 		val |= MCDE_EXTSRCXCONF_BGR;
318 		break;
319 	case DRM_FORMAT_YUV422:
320 		val |= MCDE_EXTSRCXCONF_BPP_YCBCR422 <<
321 			MCDE_EXTSRCXCONF_BPP_SHIFT;
322 		break;
323 	default:
324 		dev_err(mcde->dev, "Unknown pixel format 0x%08x\n",
325 			format);
326 		return -EINVAL;
327 	}
328 	writel(val, mcde->regs + conf);
329 
330 	/* Software select, primary */
331 	val = MCDE_EXTSRCXCR_SEL_MOD_SOFTWARE_SEL;
332 	val |= MCDE_EXTSRCXCR_MULTIOVL_CTRL_PRIMARY;
333 	writel(val, mcde->regs + cr);
334 
335 	return 0;
336 }
337 
338 static void mcde_configure_overlay(struct mcde *mcde, enum mcde_overlay ovl,
339 				   enum mcde_extsrc src,
340 				   enum mcde_channel ch,
341 				   const struct drm_display_mode *mode,
342 				   u32 format, int cpp)
343 {
344 	u32 val;
345 	u32 conf1;
346 	u32 conf2;
347 	u32 crop;
348 	u32 ljinc;
349 	u32 cr;
350 	u32 comp;
351 	u32 pixel_fetcher_watermark;
352 
353 	switch (ovl) {
354 	case MCDE_OVERLAY_0:
355 		conf1 = MCDE_OVL0CONF;
356 		conf2 = MCDE_OVL0CONF2;
357 		crop = MCDE_OVL0CROP;
358 		ljinc = MCDE_OVL0LJINC;
359 		cr = MCDE_OVL0CR;
360 		comp = MCDE_OVL0COMP;
361 		break;
362 	case MCDE_OVERLAY_1:
363 		conf1 = MCDE_OVL1CONF;
364 		conf2 = MCDE_OVL1CONF2;
365 		crop = MCDE_OVL1CROP;
366 		ljinc = MCDE_OVL1LJINC;
367 		cr = MCDE_OVL1CR;
368 		comp = MCDE_OVL1COMP;
369 		break;
370 	case MCDE_OVERLAY_2:
371 		conf1 = MCDE_OVL2CONF;
372 		conf2 = MCDE_OVL2CONF2;
373 		crop = MCDE_OVL2CROP;
374 		ljinc = MCDE_OVL2LJINC;
375 		cr = MCDE_OVL2CR;
376 		comp = MCDE_OVL2COMP;
377 		break;
378 	case MCDE_OVERLAY_3:
379 		conf1 = MCDE_OVL3CONF;
380 		conf2 = MCDE_OVL3CONF2;
381 		crop = MCDE_OVL3CROP;
382 		ljinc = MCDE_OVL3LJINC;
383 		cr = MCDE_OVL3CR;
384 		comp = MCDE_OVL3COMP;
385 		break;
386 	case MCDE_OVERLAY_4:
387 		conf1 = MCDE_OVL4CONF;
388 		conf2 = MCDE_OVL4CONF2;
389 		crop = MCDE_OVL4CROP;
390 		ljinc = MCDE_OVL4LJINC;
391 		cr = MCDE_OVL4CR;
392 		comp = MCDE_OVL4COMP;
393 		break;
394 	case MCDE_OVERLAY_5:
395 		conf1 = MCDE_OVL5CONF;
396 		conf2 = MCDE_OVL5CONF2;
397 		crop = MCDE_OVL5CROP;
398 		ljinc = MCDE_OVL5LJINC;
399 		cr = MCDE_OVL5CR;
400 		comp = MCDE_OVL5COMP;
401 		break;
402 	}
403 
404 	val = mode->hdisplay << MCDE_OVLXCONF_PPL_SHIFT;
405 	val |= mode->vdisplay << MCDE_OVLXCONF_LPF_SHIFT;
406 	/* Use external source 0 that we just configured */
407 	val |= src << MCDE_OVLXCONF_EXTSRC_ID_SHIFT;
408 	writel(val, mcde->regs + conf1);
409 
410 	val = MCDE_OVLXCONF2_BP_PER_PIXEL_ALPHA;
411 	val |= 0xff << MCDE_OVLXCONF2_ALPHAVALUE_SHIFT;
412 	/* OPQ: overlay is opaque */
413 	switch (format) {
414 	case DRM_FORMAT_ARGB8888:
415 	case DRM_FORMAT_ABGR8888:
416 	case DRM_FORMAT_ARGB4444:
417 	case DRM_FORMAT_ABGR4444:
418 	case DRM_FORMAT_XRGB1555:
419 	case DRM_FORMAT_XBGR1555:
420 		/* No OPQ */
421 		break;
422 	case DRM_FORMAT_XRGB8888:
423 	case DRM_FORMAT_XBGR8888:
424 	case DRM_FORMAT_RGB888:
425 	case DRM_FORMAT_BGR888:
426 	case DRM_FORMAT_RGB565:
427 	case DRM_FORMAT_BGR565:
428 	case DRM_FORMAT_YUV422:
429 		val |= MCDE_OVLXCONF2_OPQ;
430 		break;
431 	default:
432 		dev_err(mcde->dev, "Unknown pixel format 0x%08x\n",
433 			format);
434 		break;
435 	}
436 
437 	/*
438 	 * Pixel fetch watermark level is max 0x1FFF pixels.
439 	 * Two basic rules should be followed:
440 	 * 1. The value should be at least 256 bits.
441 	 * 2. The sum of all active overlays pixelfetch watermark level
442 	 *    multiplied with bits per pixel, should be lower than the
443 	 *    size of input_fifo_size in bits.
444 	 * 3. The value should be a multiple of a line (256 bits).
445 	 */
446 	switch (cpp) {
447 	case 2:
448 		pixel_fetcher_watermark = 128;
449 		break;
450 	case 3:
451 		pixel_fetcher_watermark = 96;
452 		break;
453 	case 4:
454 		pixel_fetcher_watermark = 48;
455 		break;
456 	default:
457 		pixel_fetcher_watermark = 48;
458 		break;
459 	}
460 	dev_dbg(mcde->dev, "pixel fetcher watermark level %d pixels\n",
461 		pixel_fetcher_watermark);
462 	val |= pixel_fetcher_watermark << MCDE_OVLXCONF2_PIXELFETCHERWATERMARKLEVEL_SHIFT;
463 	writel(val, mcde->regs + conf2);
464 
465 	/* Number of bytes to fetch per line */
466 	writel(mcde->stride, mcde->regs + ljinc);
467 	/* No cropping */
468 	writel(0, mcde->regs + crop);
469 
470 	/* Set up overlay control register */
471 	val = MCDE_OVLXCR_OVLEN;
472 	val |= MCDE_OVLXCR_COLCCTRL_DISABLED;
473 	val |= MCDE_OVLXCR_BURSTSIZE_8W <<
474 		MCDE_OVLXCR_BURSTSIZE_SHIFT;
475 	val |= MCDE_OVLXCR_MAXOUTSTANDING_8_REQ <<
476 		MCDE_OVLXCR_MAXOUTSTANDING_SHIFT;
477 	/* Not using rotation but set it up anyways */
478 	val |= MCDE_OVLXCR_ROTBURSTSIZE_8W <<
479 		MCDE_OVLXCR_ROTBURSTSIZE_SHIFT;
480 	writel(val, mcde->regs + cr);
481 
482 	/*
483 	 * Set up the overlay compositor to route the overlay out to
484 	 * the desired channel
485 	 */
486 	val = ch << MCDE_OVLXCOMP_CH_ID_SHIFT;
487 	writel(val, mcde->regs + comp);
488 }
489 
490 static void mcde_configure_channel(struct mcde *mcde, enum mcde_channel ch,
491 				   enum mcde_fifo fifo,
492 				   const struct drm_display_mode *mode)
493 {
494 	u32 val;
495 	u32 conf;
496 	u32 sync;
497 	u32 stat;
498 	u32 bgcol;
499 	u32 mux;
500 
501 	switch (ch) {
502 	case MCDE_CHANNEL_0:
503 		conf = MCDE_CHNL0CONF;
504 		sync = MCDE_CHNL0SYNCHMOD;
505 		stat = MCDE_CHNL0STAT;
506 		bgcol = MCDE_CHNL0BCKGNDCOL;
507 		mux = MCDE_CHNL0MUXING;
508 		break;
509 	case MCDE_CHANNEL_1:
510 		conf = MCDE_CHNL1CONF;
511 		sync = MCDE_CHNL1SYNCHMOD;
512 		stat = MCDE_CHNL1STAT;
513 		bgcol = MCDE_CHNL1BCKGNDCOL;
514 		mux = MCDE_CHNL1MUXING;
515 		break;
516 	case MCDE_CHANNEL_2:
517 		conf = MCDE_CHNL2CONF;
518 		sync = MCDE_CHNL2SYNCHMOD;
519 		stat = MCDE_CHNL2STAT;
520 		bgcol = MCDE_CHNL2BCKGNDCOL;
521 		mux = MCDE_CHNL2MUXING;
522 		break;
523 	case MCDE_CHANNEL_3:
524 		conf = MCDE_CHNL3CONF;
525 		sync = MCDE_CHNL3SYNCHMOD;
526 		stat = MCDE_CHNL3STAT;
527 		bgcol = MCDE_CHNL3BCKGNDCOL;
528 		mux = MCDE_CHNL3MUXING;
529 		return;
530 	}
531 
532 	/* Set up channel 0 sync (based on chnl_update_registers()) */
533 	switch (mcde->flow_mode) {
534 	case MCDE_COMMAND_ONESHOT_FLOW:
535 		/* Oneshot is achieved with software sync */
536 		val = MCDE_CHNLXSYNCHMOD_SRC_SYNCH_SOFTWARE
537 			<< MCDE_CHNLXSYNCHMOD_SRC_SYNCH_SHIFT;
538 		break;
539 	case MCDE_COMMAND_TE_FLOW:
540 		val = MCDE_CHNLXSYNCHMOD_SRC_SYNCH_HARDWARE
541 			<< MCDE_CHNLXSYNCHMOD_SRC_SYNCH_SHIFT;
542 		val |= MCDE_CHNLXSYNCHMOD_OUT_SYNCH_SRC_TE0
543 			<< MCDE_CHNLXSYNCHMOD_OUT_SYNCH_SRC_SHIFT;
544 		break;
545 	case MCDE_COMMAND_BTA_TE_FLOW:
546 		val = MCDE_CHNLXSYNCHMOD_SRC_SYNCH_HARDWARE
547 			<< MCDE_CHNLXSYNCHMOD_SRC_SYNCH_SHIFT;
548 		/*
549 		 * TODO:
550 		 * The vendor driver uses the formatter as sync source
551 		 * for BTA TE mode. Test to use TE if you have a panel
552 		 * that uses this mode.
553 		 */
554 		val |= MCDE_CHNLXSYNCHMOD_OUT_SYNCH_SRC_FORMATTER
555 			<< MCDE_CHNLXSYNCHMOD_OUT_SYNCH_SRC_SHIFT;
556 		break;
557 	case MCDE_VIDEO_TE_FLOW:
558 		val = MCDE_CHNLXSYNCHMOD_SRC_SYNCH_HARDWARE
559 			<< MCDE_CHNLXSYNCHMOD_SRC_SYNCH_SHIFT;
560 		val |= MCDE_CHNLXSYNCHMOD_OUT_SYNCH_SRC_TE0
561 			<< MCDE_CHNLXSYNCHMOD_OUT_SYNCH_SRC_SHIFT;
562 		break;
563 	case MCDE_VIDEO_FORMATTER_FLOW:
564 	case MCDE_DPI_FORMATTER_FLOW:
565 		val = MCDE_CHNLXSYNCHMOD_SRC_SYNCH_HARDWARE
566 			<< MCDE_CHNLXSYNCHMOD_SRC_SYNCH_SHIFT;
567 		val |= MCDE_CHNLXSYNCHMOD_OUT_SYNCH_SRC_FORMATTER
568 			<< MCDE_CHNLXSYNCHMOD_OUT_SYNCH_SRC_SHIFT;
569 		break;
570 	default:
571 		dev_err(mcde->dev, "unknown flow mode %d\n",
572 			mcde->flow_mode);
573 		return;
574 	}
575 
576 	writel(val, mcde->regs + sync);
577 
578 	/* Set up pixels per line and lines per frame */
579 	val = (mode->hdisplay - 1) << MCDE_CHNLXCONF_PPL_SHIFT;
580 	val |= (mode->vdisplay - 1) << MCDE_CHNLXCONF_LPF_SHIFT;
581 	writel(val, mcde->regs + conf);
582 
583 	/*
584 	 * Normalize color conversion:
585 	 * black background, OLED conversion disable on channel
586 	 */
587 	val = MCDE_CHNLXSTAT_CHNLBLBCKGND_EN |
588 		MCDE_CHNLXSTAT_CHNLRD;
589 	writel(val, mcde->regs + stat);
590 	writel(0, mcde->regs + bgcol);
591 
592 	/* Set up muxing: connect the channel to the desired FIFO */
593 	switch (fifo) {
594 	case MCDE_FIFO_A:
595 		writel(MCDE_CHNLXMUXING_FIFO_ID_FIFO_A,
596 		       mcde->regs + mux);
597 		break;
598 	case MCDE_FIFO_B:
599 		writel(MCDE_CHNLXMUXING_FIFO_ID_FIFO_B,
600 		       mcde->regs + mux);
601 		break;
602 	}
603 
604 	/*
605 	 * If using DPI configure the sync event.
606 	 * TODO: this is for LCD only, it does not cover TV out.
607 	 */
608 	if (mcde->dpi_output) {
609 		u32 stripwidth;
610 
611 		stripwidth = 0xF000 / (mode->vdisplay * 4);
612 		dev_info(mcde->dev, "stripwidth: %d\n", stripwidth);
613 
614 		val = MCDE_SYNCHCONF_HWREQVEVENT_ACTIVE_VIDEO |
615 			(mode->hdisplay - 1 - stripwidth) << MCDE_SYNCHCONF_HWREQVCNT_SHIFT |
616 			MCDE_SYNCHCONF_SWINTVEVENT_ACTIVE_VIDEO |
617 			(mode->hdisplay - 1 - stripwidth) << MCDE_SYNCHCONF_SWINTVCNT_SHIFT;
618 
619 		switch (fifo) {
620 		case MCDE_FIFO_A:
621 			writel(val, mcde->regs + MCDE_SYNCHCONFA);
622 			break;
623 		case MCDE_FIFO_B:
624 			writel(val, mcde->regs + MCDE_SYNCHCONFB);
625 			break;
626 		}
627 	}
628 }
629 
630 static void mcde_configure_fifo(struct mcde *mcde, enum mcde_fifo fifo,
631 				enum mcde_formatter fmt,
632 				int fifo_wtrmrk)
633 {
634 	u32 val;
635 	u32 ctrl;
636 	u32 cr0, cr1;
637 
638 	switch (fifo) {
639 	case MCDE_FIFO_A:
640 		ctrl = MCDE_CTRLA;
641 		cr0 = MCDE_CRA0;
642 		cr1 = MCDE_CRA1;
643 		break;
644 	case MCDE_FIFO_B:
645 		ctrl = MCDE_CTRLB;
646 		cr0 = MCDE_CRB0;
647 		cr1 = MCDE_CRB1;
648 		break;
649 	}
650 
651 	val = fifo_wtrmrk << MCDE_CTRLX_FIFOWTRMRK_SHIFT;
652 
653 	/*
654 	 * Select the formatter to use for this FIFO
655 	 *
656 	 * The register definitions imply that different IDs should be used
657 	 * by the DSI formatters depending on if they are in VID or CMD
658 	 * mode, and the manual says they are dedicated but identical.
659 	 * The vendor code uses them as it seems fit.
660 	 */
661 	switch (fmt) {
662 	case MCDE_DSI_FORMATTER_0:
663 		val |= MCDE_CTRLX_FORMTYPE_DSI << MCDE_CTRLX_FORMTYPE_SHIFT;
664 		val |= MCDE_CTRLX_FORMID_DSI0VID << MCDE_CTRLX_FORMID_SHIFT;
665 		break;
666 	case MCDE_DSI_FORMATTER_1:
667 		val |= MCDE_CTRLX_FORMTYPE_DSI << MCDE_CTRLX_FORMTYPE_SHIFT;
668 		val |= MCDE_CTRLX_FORMID_DSI0CMD << MCDE_CTRLX_FORMID_SHIFT;
669 		break;
670 	case MCDE_DSI_FORMATTER_2:
671 		val |= MCDE_CTRLX_FORMTYPE_DSI << MCDE_CTRLX_FORMTYPE_SHIFT;
672 		val |= MCDE_CTRLX_FORMID_DSI1VID << MCDE_CTRLX_FORMID_SHIFT;
673 		break;
674 	case MCDE_DSI_FORMATTER_3:
675 		val |= MCDE_CTRLX_FORMTYPE_DSI << MCDE_CTRLX_FORMTYPE_SHIFT;
676 		val |= MCDE_CTRLX_FORMID_DSI1CMD << MCDE_CTRLX_FORMID_SHIFT;
677 		break;
678 	case MCDE_DSI_FORMATTER_4:
679 		val |= MCDE_CTRLX_FORMTYPE_DSI << MCDE_CTRLX_FORMTYPE_SHIFT;
680 		val |= MCDE_CTRLX_FORMID_DSI2VID << MCDE_CTRLX_FORMID_SHIFT;
681 		break;
682 	case MCDE_DSI_FORMATTER_5:
683 		val |= MCDE_CTRLX_FORMTYPE_DSI << MCDE_CTRLX_FORMTYPE_SHIFT;
684 		val |= MCDE_CTRLX_FORMID_DSI2CMD << MCDE_CTRLX_FORMID_SHIFT;
685 		break;
686 	case MCDE_DPI_FORMATTER_0:
687 		val |= MCDE_CTRLX_FORMTYPE_DPITV << MCDE_CTRLX_FORMTYPE_SHIFT;
688 		val |= MCDE_CTRLX_FORMID_DPIA << MCDE_CTRLX_FORMID_SHIFT;
689 		break;
690 	case MCDE_DPI_FORMATTER_1:
691 		val |= MCDE_CTRLX_FORMTYPE_DPITV << MCDE_CTRLX_FORMTYPE_SHIFT;
692 		val |= MCDE_CTRLX_FORMID_DPIB << MCDE_CTRLX_FORMID_SHIFT;
693 		break;
694 	}
695 	writel(val, mcde->regs + ctrl);
696 
697 	/* Blend source with Alpha 0xff on FIFO */
698 	val = MCDE_CRX0_BLENDEN |
699 		0xff << MCDE_CRX0_ALPHABLEND_SHIFT;
700 	writel(val, mcde->regs + cr0);
701 
702 	spin_lock(&mcde->fifo_crx1_lock);
703 	val = readl(mcde->regs + cr1);
704 	/*
705 	 * Set-up from mcde_fmtr_dsi.c, fmtr_dsi_enable_video()
706 	 * FIXME: a different clock needs to be selected for TV out.
707 	 */
708 	if (mcde->dpi_output) {
709 		struct drm_connector *connector = drm_panel_bridge_connector(mcde->bridge);
710 		u32 bus_format;
711 
712 		/* Assume RGB888 24 bit if we have no further info */
713 		if (!connector->display_info.num_bus_formats) {
714 			dev_info(mcde->dev, "panel does not specify bus format, assume RGB888\n");
715 			bus_format = MEDIA_BUS_FMT_RGB888_1X24;
716 		} else {
717 			bus_format = connector->display_info.bus_formats[0];
718 		}
719 
720 		/*
721 		 * Set up the CDWIN and OUTBPP for the LCD
722 		 *
723 		 * FIXME: fill this in if you know the correspondance between the MIPI
724 		 * DPI specification and the media bus formats.
725 		 */
726 		val &= ~MCDE_CRX1_CDWIN_MASK;
727 		val &= ~MCDE_CRX1_OUTBPP_MASK;
728 		switch (bus_format) {
729 		case MEDIA_BUS_FMT_RGB888_1X24:
730 			val |= MCDE_CRX1_CDWIN_24BPP << MCDE_CRX1_CDWIN_SHIFT;
731 			val |= MCDE_CRX1_OUTBPP_24BPP << MCDE_CRX1_OUTBPP_SHIFT;
732 			break;
733 		default:
734 			dev_err(mcde->dev, "unknown bus format, assume RGB888\n");
735 			val |= MCDE_CRX1_CDWIN_24BPP << MCDE_CRX1_CDWIN_SHIFT;
736 			val |= MCDE_CRX1_OUTBPP_24BPP << MCDE_CRX1_OUTBPP_SHIFT;
737 			break;
738 		}
739 	} else {
740 		/* Use the MCDE clock for DSI */
741 		val &= ~MCDE_CRX1_CLKSEL_MASK;
742 		val |= MCDE_CRX1_CLKSEL_MCDECLK << MCDE_CRX1_CLKSEL_SHIFT;
743 	}
744 	writel(val, mcde->regs + cr1);
745 	spin_unlock(&mcde->fifo_crx1_lock);
746 };
747 
748 static void mcde_configure_dsi_formatter(struct mcde *mcde,
749 					 enum mcde_formatter fmt,
750 					 u32 formatter_frame,
751 					 int pkt_size)
752 {
753 	u32 val;
754 	u32 conf0;
755 	u32 frame;
756 	u32 pkt;
757 	u32 sync;
758 	u32 cmdw;
759 	u32 delay0, delay1;
760 
761 	switch (fmt) {
762 	case MCDE_DSI_FORMATTER_0:
763 		conf0 = MCDE_DSIVID0CONF0;
764 		frame = MCDE_DSIVID0FRAME;
765 		pkt = MCDE_DSIVID0PKT;
766 		sync = MCDE_DSIVID0SYNC;
767 		cmdw = MCDE_DSIVID0CMDW;
768 		delay0 = MCDE_DSIVID0DELAY0;
769 		delay1 = MCDE_DSIVID0DELAY1;
770 		break;
771 	case MCDE_DSI_FORMATTER_1:
772 		conf0 = MCDE_DSIVID1CONF0;
773 		frame = MCDE_DSIVID1FRAME;
774 		pkt = MCDE_DSIVID1PKT;
775 		sync = MCDE_DSIVID1SYNC;
776 		cmdw = MCDE_DSIVID1CMDW;
777 		delay0 = MCDE_DSIVID1DELAY0;
778 		delay1 = MCDE_DSIVID1DELAY1;
779 		break;
780 	case MCDE_DSI_FORMATTER_2:
781 		conf0 = MCDE_DSIVID2CONF0;
782 		frame = MCDE_DSIVID2FRAME;
783 		pkt = MCDE_DSIVID2PKT;
784 		sync = MCDE_DSIVID2SYNC;
785 		cmdw = MCDE_DSIVID2CMDW;
786 		delay0 = MCDE_DSIVID2DELAY0;
787 		delay1 = MCDE_DSIVID2DELAY1;
788 		break;
789 	default:
790 		dev_err(mcde->dev, "tried to configure a non-DSI formatter as DSI\n");
791 		return;
792 	}
793 
794 	/*
795 	 * Enable formatter
796 	 * 8 bit commands and DCS commands (notgen = not generic)
797 	 */
798 	val = MCDE_DSICONF0_CMD8 | MCDE_DSICONF0_DCSVID_NOTGEN;
799 	if (mcde->mdsi->mode_flags & MIPI_DSI_MODE_VIDEO)
800 		val |= MCDE_DSICONF0_VID_MODE_VID;
801 	switch (mcde->mdsi->format) {
802 	case MIPI_DSI_FMT_RGB888:
803 		val |= MCDE_DSICONF0_PACKING_RGB888 <<
804 			MCDE_DSICONF0_PACKING_SHIFT;
805 		break;
806 	case MIPI_DSI_FMT_RGB666:
807 		val |= MCDE_DSICONF0_PACKING_RGB666 <<
808 			MCDE_DSICONF0_PACKING_SHIFT;
809 		break;
810 	case MIPI_DSI_FMT_RGB666_PACKED:
811 		dev_err(mcde->dev,
812 			"we cannot handle the packed RGB666 format\n");
813 		val |= MCDE_DSICONF0_PACKING_RGB666 <<
814 			MCDE_DSICONF0_PACKING_SHIFT;
815 		break;
816 	case MIPI_DSI_FMT_RGB565:
817 		val |= MCDE_DSICONF0_PACKING_RGB565 <<
818 			MCDE_DSICONF0_PACKING_SHIFT;
819 		break;
820 	default:
821 		dev_err(mcde->dev, "unknown DSI format\n");
822 		return;
823 	}
824 	writel(val, mcde->regs + conf0);
825 
826 	writel(formatter_frame, mcde->regs + frame);
827 	writel(pkt_size, mcde->regs + pkt);
828 	writel(0, mcde->regs + sync);
829 	/* Define the MIPI command: we want to write into display memory */
830 	val = MIPI_DCS_WRITE_MEMORY_CONTINUE <<
831 		MCDE_DSIVIDXCMDW_CMDW_CONTINUE_SHIFT;
832 	val |= MIPI_DCS_WRITE_MEMORY_START <<
833 		MCDE_DSIVIDXCMDW_CMDW_START_SHIFT;
834 	writel(val, mcde->regs + cmdw);
835 
836 	/*
837 	 * FIXME: the vendor driver has some hack around this value in
838 	 * CMD mode with autotrig.
839 	 */
840 	writel(0, mcde->regs + delay0);
841 	writel(0, mcde->regs + delay1);
842 }
843 
844 static void mcde_enable_fifo(struct mcde *mcde, enum mcde_fifo fifo)
845 {
846 	u32 val;
847 	u32 cr;
848 
849 	switch (fifo) {
850 	case MCDE_FIFO_A:
851 		cr = MCDE_CRA0;
852 		break;
853 	case MCDE_FIFO_B:
854 		cr = MCDE_CRB0;
855 		break;
856 	default:
857 		dev_err(mcde->dev, "cannot enable FIFO %c\n",
858 			'A' + fifo);
859 		return;
860 	}
861 
862 	spin_lock(&mcde->flow_lock);
863 	val = readl(mcde->regs + cr);
864 	val |= MCDE_CRX0_FLOEN;
865 	writel(val, mcde->regs + cr);
866 	mcde->flow_active++;
867 	spin_unlock(&mcde->flow_lock);
868 }
869 
870 static void mcde_disable_fifo(struct mcde *mcde, enum mcde_fifo fifo,
871 			      bool wait_for_drain)
872 {
873 	int timeout = 100;
874 	u32 val;
875 	u32 cr;
876 
877 	switch (fifo) {
878 	case MCDE_FIFO_A:
879 		cr = MCDE_CRA0;
880 		break;
881 	case MCDE_FIFO_B:
882 		cr = MCDE_CRB0;
883 		break;
884 	default:
885 		dev_err(mcde->dev, "cannot disable FIFO %c\n",
886 			'A' + fifo);
887 		return;
888 	}
889 
890 	spin_lock(&mcde->flow_lock);
891 	val = readl(mcde->regs + cr);
892 	val &= ~MCDE_CRX0_FLOEN;
893 	writel(val, mcde->regs + cr);
894 	mcde->flow_active = 0;
895 	spin_unlock(&mcde->flow_lock);
896 
897 	if (!wait_for_drain)
898 		return;
899 
900 	/* Check that we really drained and stopped the flow */
901 	while (readl(mcde->regs + cr) & MCDE_CRX0_FLOEN) {
902 		usleep_range(1000, 1500);
903 		if (!--timeout) {
904 			dev_err(mcde->dev,
905 				"FIFO timeout while clearing FIFO %c\n",
906 				'A' + fifo);
907 			return;
908 		}
909 	}
910 }
911 
912 /*
913  * This drains a pipe i.e. a FIFO connected to a certain channel
914  */
915 static void mcde_drain_pipe(struct mcde *mcde, enum mcde_fifo fifo,
916 			    enum mcde_channel ch)
917 {
918 	u32 val;
919 	u32 ctrl;
920 	u32 synsw;
921 
922 	switch (fifo) {
923 	case MCDE_FIFO_A:
924 		ctrl = MCDE_CTRLA;
925 		break;
926 	case MCDE_FIFO_B:
927 		ctrl = MCDE_CTRLB;
928 		break;
929 	}
930 
931 	switch (ch) {
932 	case MCDE_CHANNEL_0:
933 		synsw = MCDE_CHNL0SYNCHSW;
934 		break;
935 	case MCDE_CHANNEL_1:
936 		synsw = MCDE_CHNL1SYNCHSW;
937 		break;
938 	case MCDE_CHANNEL_2:
939 		synsw = MCDE_CHNL2SYNCHSW;
940 		break;
941 	case MCDE_CHANNEL_3:
942 		synsw = MCDE_CHNL3SYNCHSW;
943 		return;
944 	}
945 
946 	val = readl(mcde->regs + ctrl);
947 	if (!(val & MCDE_CTRLX_FIFOEMPTY)) {
948 		dev_err(mcde->dev, "Channel A FIFO not empty (handover)\n");
949 		/* Attempt to clear the FIFO */
950 		mcde_enable_fifo(mcde, fifo);
951 		/* Trigger a software sync out on respective channel (0-3) */
952 		writel(MCDE_CHNLXSYNCHSW_SW_TRIG, mcde->regs + synsw);
953 		/* Disable FIFO A flow again */
954 		mcde_disable_fifo(mcde, fifo, true);
955 	}
956 }
957 
958 static int mcde_dsi_get_pkt_div(int ppl, int fifo_size)
959 {
960 	/*
961 	 * DSI command mode line packets should be split into an even number of
962 	 * packets smaller than or equal to the fifo size.
963 	 */
964 	int div;
965 	const int max_div = DIV_ROUND_UP(MCDE_MAX_WIDTH, fifo_size);
966 
967 	for (div = 1; div < max_div; div++)
968 		if (ppl % div == 0 && ppl / div <= fifo_size)
969 			return div;
970 	return 1;
971 }
972 
973 static void mcde_setup_dpi(struct mcde *mcde, const struct drm_display_mode *mode,
974 			   int *fifo_wtrmrk_lvl)
975 {
976 	struct drm_connector *connector = drm_panel_bridge_connector(mcde->bridge);
977 	u32 hsw, hfp, hbp;
978 	u32 vsw, vfp, vbp;
979 	u32 val;
980 
981 	/* FIXME: we only support LCD, implement TV out */
982 	hsw = mode->hsync_end - mode->hsync_start;
983 	hfp = mode->hsync_start - mode->hdisplay;
984 	hbp = mode->htotal - mode->hsync_end;
985 	vsw = mode->vsync_end - mode->vsync_start;
986 	vfp = mode->vsync_start - mode->vdisplay;
987 	vbp = mode->vtotal - mode->vsync_end;
988 
989 	dev_info(mcde->dev, "output on DPI LCD from channel A\n");
990 	/* Display actual values */
991 	dev_info(mcde->dev, "HSW: %d, HFP: %d, HBP: %d, VSW: %d, VFP: %d, VBP: %d\n",
992 		 hsw, hfp, hbp, vsw, vfp, vbp);
993 
994 	/*
995 	 * The pixel fetcher is 128 64-bit words deep = 1024 bytes.
996 	 * One overlay of 32bpp (4 cpp) assumed, fetch 160 pixels.
997 	 * 160 * 4 = 640 bytes.
998 	 */
999 	*fifo_wtrmrk_lvl = 640;
1000 
1001 	/* Set up the main control, watermark level at 7 */
1002 	val = 7 << MCDE_CONF0_IFIFOCTRLWTRMRKLVL_SHIFT;
1003 
1004 	/*
1005 	 * This sets up the internal silicon muxing of the DPI
1006 	 * lines. This is how the silicon connects out to the
1007 	 * external pins, then the pins need to be further
1008 	 * configured into "alternate functions" using pin control
1009 	 * to actually get the signals out.
1010 	 *
1011 	 * FIXME: this is hardcoded to the only setting found in
1012 	 * the wild. If we need to use different settings for
1013 	 * different DPI displays, make this parameterizable from
1014 	 * the device tree.
1015 	 */
1016 	/* 24 bits DPI: connect Ch A LSB to D[0:7] */
1017 	val |= 0 << MCDE_CONF0_OUTMUX0_SHIFT;
1018 	/* 24 bits DPI: connect Ch A MID to D[8:15] */
1019 	val |= 1 << MCDE_CONF0_OUTMUX1_SHIFT;
1020 	/* Don't care about this muxing */
1021 	val |= 0 << MCDE_CONF0_OUTMUX2_SHIFT;
1022 	/* Don't care about this muxing */
1023 	val |= 0 << MCDE_CONF0_OUTMUX3_SHIFT;
1024 	/* 24 bits DPI: connect Ch A MSB to D[32:39] */
1025 	val |= 2 << MCDE_CONF0_OUTMUX4_SHIFT;
1026 	/* Syncmux bits zero: DPI channel A */
1027 	writel(val, mcde->regs + MCDE_CONF0);
1028 
1029 	/* This hammers us into LCD mode */
1030 	writel(0, mcde->regs + MCDE_TVCRA);
1031 
1032 	/* Front porch and sync width */
1033 	val = (vsw << MCDE_TVBL1_BEL1_SHIFT);
1034 	val |= (vfp << MCDE_TVBL1_BSL1_SHIFT);
1035 	writel(val, mcde->regs + MCDE_TVBL1A);
1036 	/* The vendor driver sets the same value into TVBL2A */
1037 	writel(val, mcde->regs + MCDE_TVBL2A);
1038 
1039 	/* Vertical back porch */
1040 	val = (vbp << MCDE_TVDVO_DVO1_SHIFT);
1041 	/* The vendor drivers sets the same value into TVDVOA */
1042 	val |= (vbp << MCDE_TVDVO_DVO2_SHIFT);
1043 	writel(val, mcde->regs + MCDE_TVDVOA);
1044 
1045 	/* Horizontal back porch, as 0 = 1 cycle we need to subtract 1 */
1046 	writel((hbp - 1), mcde->regs + MCDE_TVTIM1A);
1047 
1048 	/* Horizongal sync width and horizonal front porch, 0 = 1 cycle */
1049 	val = ((hsw - 1) << MCDE_TVLBALW_LBW_SHIFT);
1050 	val |= ((hfp - 1) << MCDE_TVLBALW_ALW_SHIFT);
1051 	writel(val, mcde->regs + MCDE_TVLBALWA);
1052 
1053 	/* Blank some TV registers we don't use */
1054 	writel(0, mcde->regs + MCDE_TVISLA);
1055 	writel(0, mcde->regs + MCDE_TVBLUA);
1056 
1057 	/* Set up sync inversion etc */
1058 	val = 0;
1059 	if (mode->flags & DRM_MODE_FLAG_NHSYNC)
1060 		val |= MCDE_LCDTIM1B_IHS;
1061 	if (mode->flags & DRM_MODE_FLAG_NVSYNC)
1062 		val |= MCDE_LCDTIM1B_IVS;
1063 	if (connector->display_info.bus_flags & DRM_BUS_FLAG_DE_LOW)
1064 		val |= MCDE_LCDTIM1B_IOE;
1065 	if (connector->display_info.bus_flags & DRM_BUS_FLAG_PIXDATA_DRIVE_NEGEDGE)
1066 		val |= MCDE_LCDTIM1B_IPC;
1067 	writel(val, mcde->regs + MCDE_LCDTIM1A);
1068 }
1069 
1070 static void mcde_setup_dsi(struct mcde *mcde, const struct drm_display_mode *mode,
1071 			   int cpp, int *fifo_wtrmrk_lvl, int *dsi_formatter_frame,
1072 			   int *dsi_pkt_size)
1073 {
1074 	u32 formatter_ppl = mode->hdisplay; /* pixels per line */
1075 	u32 formatter_lpf = mode->vdisplay; /* lines per frame */
1076 	int formatter_frame;
1077 	int formatter_cpp;
1078 	int fifo_wtrmrk;
1079 	u32 pkt_div;
1080 	int pkt_size;
1081 	u32 val;
1082 
1083 	dev_info(mcde->dev, "output in %s mode, format %dbpp\n",
1084 		 (mcde->mdsi->mode_flags & MIPI_DSI_MODE_VIDEO) ?
1085 		 "VIDEO" : "CMD",
1086 		 mipi_dsi_pixel_format_to_bpp(mcde->mdsi->format));
1087 	formatter_cpp =
1088 		mipi_dsi_pixel_format_to_bpp(mcde->mdsi->format) / 8;
1089 	dev_info(mcde->dev, "Overlay CPP: %d bytes, DSI formatter CPP %d bytes\n",
1090 		 cpp, formatter_cpp);
1091 
1092 	/* Set up the main control, watermark level at 7 */
1093 	val = 7 << MCDE_CONF0_IFIFOCTRLWTRMRKLVL_SHIFT;
1094 
1095 	/*
1096 	 * This is the internal silicon muxing of the DPI
1097 	 * (parallell display) lines. Since we are not using
1098 	 * this at all (we are using DSI) these are just
1099 	 * dummy values from the vendor tree.
1100 	 */
1101 	val |= 3 << MCDE_CONF0_OUTMUX0_SHIFT;
1102 	val |= 3 << MCDE_CONF0_OUTMUX1_SHIFT;
1103 	val |= 0 << MCDE_CONF0_OUTMUX2_SHIFT;
1104 	val |= 4 << MCDE_CONF0_OUTMUX3_SHIFT;
1105 	val |= 5 << MCDE_CONF0_OUTMUX4_SHIFT;
1106 	writel(val, mcde->regs + MCDE_CONF0);
1107 
1108 	/* Calculations from mcde_fmtr_dsi.c, fmtr_dsi_enable_video() */
1109 
1110 	/*
1111 	 * Set up FIFO A watermark level:
1112 	 * 128 for LCD 32bpp video mode
1113 	 * 48  for LCD 32bpp command mode
1114 	 * 128 for LCD 16bpp video mode
1115 	 * 64  for LCD 16bpp command mode
1116 	 * 128 for HDMI 32bpp
1117 	 * 192 for HDMI 16bpp
1118 	 */
1119 	fifo_wtrmrk = mode->hdisplay;
1120 	if (mcde->mdsi->mode_flags & MIPI_DSI_MODE_VIDEO) {
1121 		fifo_wtrmrk = min(fifo_wtrmrk, 128);
1122 		pkt_div = 1;
1123 	} else {
1124 		fifo_wtrmrk = min(fifo_wtrmrk, 48);
1125 		/* The FIFO is 640 entries deep on this v3 hardware */
1126 		pkt_div = mcde_dsi_get_pkt_div(mode->hdisplay, 640);
1127 	}
1128 	dev_dbg(mcde->dev, "FIFO watermark after flooring: %d bytes\n",
1129 		fifo_wtrmrk);
1130 	dev_dbg(mcde->dev, "Packet divisor: %d bytes\n", pkt_div);
1131 
1132 	/* NOTE: pkt_div is 1 for video mode */
1133 	pkt_size = (formatter_ppl * formatter_cpp) / pkt_div;
1134 	/* Commands CMD8 need one extra byte */
1135 	if (!(mcde->mdsi->mode_flags & MIPI_DSI_MODE_VIDEO))
1136 		pkt_size++;
1137 
1138 	dev_dbg(mcde->dev, "DSI packet size: %d * %d bytes per line\n",
1139 		pkt_size, pkt_div);
1140 	dev_dbg(mcde->dev, "Overlay frame size: %u bytes\n",
1141 		mode->hdisplay * mode->vdisplay * cpp);
1142 	/* NOTE: pkt_div is 1 for video mode */
1143 	formatter_frame = pkt_size * pkt_div * formatter_lpf;
1144 	dev_dbg(mcde->dev, "Formatter frame size: %u bytes\n", formatter_frame);
1145 
1146 	*fifo_wtrmrk_lvl = fifo_wtrmrk;
1147 	*dsi_pkt_size = pkt_size;
1148 	*dsi_formatter_frame = formatter_frame;
1149 }
1150 
1151 static void mcde_display_enable(struct drm_simple_display_pipe *pipe,
1152 				struct drm_crtc_state *cstate,
1153 				struct drm_plane_state *plane_state)
1154 {
1155 	struct drm_crtc *crtc = &pipe->crtc;
1156 	struct drm_plane *plane = &pipe->plane;
1157 	struct drm_device *drm = crtc->dev;
1158 	struct mcde *mcde = to_mcde(drm);
1159 	const struct drm_display_mode *mode = &cstate->mode;
1160 	struct drm_framebuffer *fb = plane->state->fb;
1161 	u32 format = fb->format->format;
1162 	int dsi_pkt_size;
1163 	int fifo_wtrmrk;
1164 	int cpp = fb->format->cpp[0];
1165 	u32 dsi_formatter_frame;
1166 	u32 val;
1167 	int ret;
1168 
1169 	/* This powers up the entire MCDE block and the DSI hardware */
1170 	ret = regulator_enable(mcde->epod);
1171 	if (ret) {
1172 		dev_err(drm->dev, "can't re-enable EPOD regulator\n");
1173 		return;
1174 	}
1175 
1176 	dev_info(drm->dev, "enable MCDE, %d x %d format %p4cc\n",
1177 		 mode->hdisplay, mode->vdisplay, &format);
1178 
1179 
1180 	/* Clear any pending interrupts */
1181 	mcde_display_disable_irqs(mcde);
1182 	writel(0, mcde->regs + MCDE_IMSCERR);
1183 	writel(0xFFFFFFFF, mcde->regs + MCDE_RISERR);
1184 
1185 	if (mcde->dpi_output)
1186 		mcde_setup_dpi(mcde, mode, &fifo_wtrmrk);
1187 	else
1188 		mcde_setup_dsi(mcde, mode, cpp, &fifo_wtrmrk,
1189 			       &dsi_formatter_frame, &dsi_pkt_size);
1190 
1191 	mcde->stride = mode->hdisplay * cpp;
1192 	dev_dbg(drm->dev, "Overlay line stride: %u bytes\n",
1193 		 mcde->stride);
1194 
1195 	/* Drain the FIFO A + channel 0 pipe so we have a clean slate */
1196 	mcde_drain_pipe(mcde, MCDE_FIFO_A, MCDE_CHANNEL_0);
1197 
1198 	/*
1199 	 * We set up our display pipeline:
1200 	 * EXTSRC 0 -> OVERLAY 0 -> CHANNEL 0 -> FIFO A -> DSI FORMATTER 0
1201 	 *
1202 	 * First configure the external source (memory) on external source 0
1203 	 * using the desired bitstream/bitmap format
1204 	 */
1205 	mcde_configure_extsrc(mcde, MCDE_EXTSRC_0, format);
1206 
1207 	/*
1208 	 * Configure overlay 0 according to format and mode and take input
1209 	 * from external source 0 and route the output of this overlay to
1210 	 * channel 0
1211 	 */
1212 	mcde_configure_overlay(mcde, MCDE_OVERLAY_0, MCDE_EXTSRC_0,
1213 			       MCDE_CHANNEL_0, mode, format, cpp);
1214 
1215 	/*
1216 	 * Configure pixel-per-line and line-per-frame for channel 0 and then
1217 	 * route channel 0 to FIFO A
1218 	 */
1219 	mcde_configure_channel(mcde, MCDE_CHANNEL_0, MCDE_FIFO_A, mode);
1220 
1221 	if (mcde->dpi_output) {
1222 		unsigned long lcd_freq;
1223 
1224 		/* Configure FIFO A to use DPI formatter 0 */
1225 		mcde_configure_fifo(mcde, MCDE_FIFO_A, MCDE_DPI_FORMATTER_0,
1226 				    fifo_wtrmrk);
1227 
1228 		/* Set up and enable the LCD clock */
1229 		lcd_freq = clk_round_rate(mcde->fifoa_clk, mode->clock * 1000);
1230 		ret = clk_set_rate(mcde->fifoa_clk, lcd_freq);
1231 		if (ret)
1232 			dev_err(mcde->dev, "failed to set LCD clock rate %lu Hz\n",
1233 				lcd_freq);
1234 		ret = clk_prepare_enable(mcde->fifoa_clk);
1235 		if (ret) {
1236 			dev_err(mcde->dev, "failed to enable FIFO A DPI clock\n");
1237 			return;
1238 		}
1239 		dev_info(mcde->dev, "LCD FIFO A clk rate %lu Hz\n",
1240 			 clk_get_rate(mcde->fifoa_clk));
1241 	} else {
1242 		/* Configure FIFO A to use DSI formatter 0 */
1243 		mcde_configure_fifo(mcde, MCDE_FIFO_A, MCDE_DSI_FORMATTER_0,
1244 				    fifo_wtrmrk);
1245 
1246 		/*
1247 		 * This brings up the DSI bridge which is tightly connected
1248 		 * to the MCDE DSI formatter.
1249 		 */
1250 		mcde_dsi_enable(mcde->bridge);
1251 
1252 		/* Configure the DSI formatter 0 for the DSI panel output */
1253 		mcde_configure_dsi_formatter(mcde, MCDE_DSI_FORMATTER_0,
1254 					     dsi_formatter_frame, dsi_pkt_size);
1255 	}
1256 
1257 	switch (mcde->flow_mode) {
1258 	case MCDE_COMMAND_TE_FLOW:
1259 	case MCDE_COMMAND_BTA_TE_FLOW:
1260 	case MCDE_VIDEO_TE_FLOW:
1261 		/* We are using TE in some combination */
1262 		if (mode->flags & DRM_MODE_FLAG_NVSYNC)
1263 			val = MCDE_VSCRC_VSPOL;
1264 		else
1265 			val = 0;
1266 		writel(val, mcde->regs + MCDE_VSCRC0);
1267 		/* Enable VSYNC capture on TE0 */
1268 		val = readl(mcde->regs + MCDE_CRC);
1269 		val |= MCDE_CRC_SYCEN0;
1270 		writel(val, mcde->regs + MCDE_CRC);
1271 		break;
1272 	default:
1273 		/* No TE capture */
1274 		break;
1275 	}
1276 
1277 	drm_crtc_vblank_on(crtc);
1278 
1279 	/*
1280 	 * If we're using oneshot mode we don't start the flow
1281 	 * until each time the display is given an update, and
1282 	 * then we disable it immediately after. For all other
1283 	 * modes (command or video) we start the FIFO flow
1284 	 * right here. This is necessary for the hardware to
1285 	 * behave right.
1286 	 */
1287 	if (mcde->flow_mode != MCDE_COMMAND_ONESHOT_FLOW) {
1288 		mcde_enable_fifo(mcde, MCDE_FIFO_A);
1289 		dev_dbg(mcde->dev, "started MCDE video FIFO flow\n");
1290 	}
1291 
1292 	/* Enable MCDE with automatic clock gating */
1293 	val = readl(mcde->regs + MCDE_CR);
1294 	val |= MCDE_CR_MCDEEN | MCDE_CR_AUTOCLKG_EN;
1295 	writel(val, mcde->regs + MCDE_CR);
1296 
1297 	dev_info(drm->dev, "MCDE display is enabled\n");
1298 }
1299 
1300 static void mcde_display_disable(struct drm_simple_display_pipe *pipe)
1301 {
1302 	struct drm_crtc *crtc = &pipe->crtc;
1303 	struct drm_device *drm = crtc->dev;
1304 	struct mcde *mcde = to_mcde(drm);
1305 	struct drm_pending_vblank_event *event;
1306 	int ret;
1307 
1308 	drm_crtc_vblank_off(crtc);
1309 
1310 	/* Disable FIFO A flow */
1311 	mcde_disable_fifo(mcde, MCDE_FIFO_A, true);
1312 
1313 	if (mcde->dpi_output) {
1314 		clk_disable_unprepare(mcde->fifoa_clk);
1315 	} else {
1316 		/* This disables the DSI bridge */
1317 		mcde_dsi_disable(mcde->bridge);
1318 	}
1319 
1320 	event = crtc->state->event;
1321 	if (event) {
1322 		crtc->state->event = NULL;
1323 
1324 		spin_lock_irq(&crtc->dev->event_lock);
1325 		drm_crtc_send_vblank_event(crtc, event);
1326 		spin_unlock_irq(&crtc->dev->event_lock);
1327 	}
1328 
1329 	ret = regulator_disable(mcde->epod);
1330 	if (ret)
1331 		dev_err(drm->dev, "can't disable EPOD regulator\n");
1332 	/* Make sure we are powered down (before we may power up again) */
1333 	usleep_range(50000, 70000);
1334 
1335 	dev_info(drm->dev, "MCDE display is disabled\n");
1336 }
1337 
1338 static void mcde_start_flow(struct mcde *mcde)
1339 {
1340 	/* Request a TE ACK only in TE+BTA mode */
1341 	if (mcde->flow_mode == MCDE_COMMAND_BTA_TE_FLOW)
1342 		mcde_dsi_te_request(mcde->mdsi);
1343 
1344 	/* Enable FIFO A flow */
1345 	mcde_enable_fifo(mcde, MCDE_FIFO_A);
1346 
1347 	/*
1348 	 * If oneshot mode is enabled, the flow will be disabled
1349 	 * when the TE0 IRQ arrives in the interrupt handler. Otherwise
1350 	 * updates are continuously streamed to the display after this
1351 	 * point.
1352 	 */
1353 
1354 	if (mcde->flow_mode == MCDE_COMMAND_ONESHOT_FLOW) {
1355 		/* Trigger a software sync out on channel 0 */
1356 		writel(MCDE_CHNLXSYNCHSW_SW_TRIG,
1357 		       mcde->regs + MCDE_CHNL0SYNCHSW);
1358 
1359 		/*
1360 		 * Disable FIFO A flow again: since we are using TE sync we
1361 		 * need to wait for the FIFO to drain before we continue
1362 		 * so repeated calls to this function will not cause a mess
1363 		 * in the hardware by pushing updates will updates are going
1364 		 * on already.
1365 		 */
1366 		mcde_disable_fifo(mcde, MCDE_FIFO_A, true);
1367 	}
1368 
1369 	dev_dbg(mcde->dev, "started MCDE FIFO flow\n");
1370 }
1371 
1372 static void mcde_set_extsrc(struct mcde *mcde, u32 buffer_address)
1373 {
1374 	/* Write bitmap base address to register */
1375 	writel(buffer_address, mcde->regs + MCDE_EXTSRCXA0);
1376 	/*
1377 	 * Base address for next line this is probably only used
1378 	 * in interlace modes.
1379 	 */
1380 	writel(buffer_address + mcde->stride, mcde->regs + MCDE_EXTSRCXA1);
1381 }
1382 
1383 static void mcde_display_update(struct drm_simple_display_pipe *pipe,
1384 				struct drm_plane_state *old_pstate)
1385 {
1386 	struct drm_crtc *crtc = &pipe->crtc;
1387 	struct drm_device *drm = crtc->dev;
1388 	struct mcde *mcde = to_mcde(drm);
1389 	struct drm_pending_vblank_event *event = crtc->state->event;
1390 	struct drm_plane *plane = &pipe->plane;
1391 	struct drm_plane_state *pstate = plane->state;
1392 	struct drm_framebuffer *fb = pstate->fb;
1393 
1394 	/*
1395 	 * Handle any pending event first, we need to arm the vblank
1396 	 * interrupt before sending any update to the display so we don't
1397 	 * miss the interrupt.
1398 	 */
1399 	if (event) {
1400 		crtc->state->event = NULL;
1401 
1402 		spin_lock_irq(&crtc->dev->event_lock);
1403 		/*
1404 		 * Hardware must be on before we can arm any vblank event,
1405 		 * this is not a scanout controller where there is always
1406 		 * some periodic update going on, it is completely frozen
1407 		 * until we get an update. If MCDE output isn't yet enabled,
1408 		 * we just send a vblank dummy event back.
1409 		 */
1410 		if (crtc->state->active && drm_crtc_vblank_get(crtc) == 0) {
1411 			dev_dbg(mcde->dev, "arm vblank event\n");
1412 			drm_crtc_arm_vblank_event(crtc, event);
1413 		} else {
1414 			dev_dbg(mcde->dev, "insert fake vblank event\n");
1415 			drm_crtc_send_vblank_event(crtc, event);
1416 		}
1417 
1418 		spin_unlock_irq(&crtc->dev->event_lock);
1419 	}
1420 
1421 	/*
1422 	 * We do not start sending framebuffer updates before the
1423 	 * display is enabled. Update events will however be dispatched
1424 	 * from the DRM core before the display is enabled.
1425 	 */
1426 	if (fb) {
1427 		mcde_set_extsrc(mcde, drm_fb_cma_get_gem_addr(fb, pstate, 0));
1428 		dev_info_once(mcde->dev, "first update of display contents\n");
1429 		/*
1430 		 * Usually the flow is already active, unless we are in
1431 		 * oneshot mode, then we need to kick the flow right here.
1432 		 */
1433 		if (mcde->flow_active == 0)
1434 			mcde_start_flow(mcde);
1435 	} else {
1436 		/*
1437 		 * If an update is receieved before the MCDE is enabled
1438 		 * (before mcde_display_enable() is called) we can't really
1439 		 * do much with that buffer.
1440 		 */
1441 		dev_info(mcde->dev, "ignored a display update\n");
1442 	}
1443 }
1444 
1445 static int mcde_display_enable_vblank(struct drm_simple_display_pipe *pipe)
1446 {
1447 	struct drm_crtc *crtc = &pipe->crtc;
1448 	struct drm_device *drm = crtc->dev;
1449 	struct mcde *mcde = to_mcde(drm);
1450 	u32 val;
1451 
1452 	/* Enable all VBLANK IRQs */
1453 	val = MCDE_PP_VCMPA |
1454 		MCDE_PP_VCMPB |
1455 		MCDE_PP_VSCC0 |
1456 		MCDE_PP_VSCC1 |
1457 		MCDE_PP_VCMPC0 |
1458 		MCDE_PP_VCMPC1;
1459 	writel(val, mcde->regs + MCDE_IMSCPP);
1460 
1461 	return 0;
1462 }
1463 
1464 static void mcde_display_disable_vblank(struct drm_simple_display_pipe *pipe)
1465 {
1466 	struct drm_crtc *crtc = &pipe->crtc;
1467 	struct drm_device *drm = crtc->dev;
1468 	struct mcde *mcde = to_mcde(drm);
1469 
1470 	/* Disable all VBLANK IRQs */
1471 	writel(0, mcde->regs + MCDE_IMSCPP);
1472 	/* Clear any pending IRQs */
1473 	writel(0xFFFFFFFF, mcde->regs + MCDE_RISPP);
1474 }
1475 
1476 static struct drm_simple_display_pipe_funcs mcde_display_funcs = {
1477 	.check = mcde_display_check,
1478 	.enable = mcde_display_enable,
1479 	.disable = mcde_display_disable,
1480 	.update = mcde_display_update,
1481 	.enable_vblank = mcde_display_enable_vblank,
1482 	.disable_vblank = mcde_display_disable_vblank,
1483 };
1484 
1485 int mcde_display_init(struct drm_device *drm)
1486 {
1487 	struct mcde *mcde = to_mcde(drm);
1488 	int ret;
1489 	static const u32 formats[] = {
1490 		DRM_FORMAT_ARGB8888,
1491 		DRM_FORMAT_ABGR8888,
1492 		DRM_FORMAT_XRGB8888,
1493 		DRM_FORMAT_XBGR8888,
1494 		DRM_FORMAT_RGB888,
1495 		DRM_FORMAT_BGR888,
1496 		DRM_FORMAT_ARGB4444,
1497 		DRM_FORMAT_ABGR4444,
1498 		DRM_FORMAT_XRGB4444,
1499 		DRM_FORMAT_XBGR4444,
1500 		/* These are actually IRGB1555 so intensity bit is lost */
1501 		DRM_FORMAT_XRGB1555,
1502 		DRM_FORMAT_XBGR1555,
1503 		DRM_FORMAT_RGB565,
1504 		DRM_FORMAT_BGR565,
1505 		DRM_FORMAT_YUV422,
1506 	};
1507 
1508 	ret = mcde_init_clock_divider(mcde);
1509 	if (ret)
1510 		return ret;
1511 
1512 	ret = drm_simple_display_pipe_init(drm, &mcde->pipe,
1513 					   &mcde_display_funcs,
1514 					   formats, ARRAY_SIZE(formats),
1515 					   NULL,
1516 					   mcde->connector);
1517 	if (ret)
1518 		return ret;
1519 
1520 	return 0;
1521 }
1522 EXPORT_SYMBOL_GPL(mcde_display_init);
1523