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