Loading...
Note: File does not exist in v4.6.
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_dma_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_dma_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
28enum mcde_fifo {
29 MCDE_FIFO_A,
30 MCDE_FIFO_B,
31 /* TODO: implement FIFO C0 and FIFO C1 */
32};
33
34enum mcde_channel {
35 MCDE_CHANNEL_0 = 0,
36 MCDE_CHANNEL_1,
37 MCDE_CHANNEL_2,
38 MCDE_CHANNEL_3,
39};
40
41enum 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
54enum 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
63enum 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
74void 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
146void 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
159static 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_dma_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
196static 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
338static 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
490static 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
630static 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
748static 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
844static 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
870static 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 */
915static 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
958static 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
973static 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
1070static 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
1151static 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
1300static 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
1338static 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
1372static 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
1383static 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_dma_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
1445static 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
1464static 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
1476static 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
1485int 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}
1522EXPORT_SYMBOL_GPL(mcde_display_init);