fsl_dcu_drm_crtc.c 5.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * Copyright 2015 Freescale Semiconductor, Inc.
  4. *
  5. * Freescale DCU drm device driver
  6. */
  7. #include <linux/clk.h>
  8. #include <linux/regmap.h>
  9. #include <video/videomode.h>
  10. #include <drm/drm_atomic.h>
  11. #include <drm/drm_atomic_helper.h>
  12. #include <drm/drm_crtc.h>
  13. #include <drm/drm_probe_helper.h>
  14. #include <drm/drm_vblank.h>
  15. #include "fsl_dcu_drm_crtc.h"
  16. #include "fsl_dcu_drm_drv.h"
  17. #include "fsl_dcu_drm_plane.h"
  18. static void fsl_dcu_drm_crtc_atomic_flush(struct drm_crtc *crtc,
  19. struct drm_crtc_state *old_crtc_state)
  20. {
  21. struct drm_device *dev = crtc->dev;
  22. struct fsl_dcu_drm_device *fsl_dev = dev->dev_private;
  23. struct drm_pending_vblank_event *event = crtc->state->event;
  24. regmap_write(fsl_dev->regmap,
  25. DCU_UPDATE_MODE, DCU_UPDATE_MODE_READREG);
  26. if (event) {
  27. crtc->state->event = NULL;
  28. spin_lock_irq(&crtc->dev->event_lock);
  29. if (drm_crtc_vblank_get(crtc) == 0)
  30. drm_crtc_arm_vblank_event(crtc, event);
  31. else
  32. drm_crtc_send_vblank_event(crtc, event);
  33. spin_unlock_irq(&crtc->dev->event_lock);
  34. }
  35. }
  36. static void fsl_dcu_drm_crtc_atomic_disable(struct drm_crtc *crtc,
  37. struct drm_crtc_state *old_crtc_state)
  38. {
  39. struct drm_device *dev = crtc->dev;
  40. struct fsl_dcu_drm_device *fsl_dev = dev->dev_private;
  41. /* always disable planes on the CRTC */
  42. drm_atomic_helper_disable_planes_on_crtc(old_crtc_state, true);
  43. drm_crtc_vblank_off(crtc);
  44. regmap_update_bits(fsl_dev->regmap, DCU_DCU_MODE,
  45. DCU_MODE_DCU_MODE_MASK,
  46. DCU_MODE_DCU_MODE(DCU_MODE_OFF));
  47. regmap_write(fsl_dev->regmap, DCU_UPDATE_MODE,
  48. DCU_UPDATE_MODE_READREG);
  49. clk_disable_unprepare(fsl_dev->pix_clk);
  50. }
  51. static void fsl_dcu_drm_crtc_atomic_enable(struct drm_crtc *crtc,
  52. struct drm_crtc_state *old_state)
  53. {
  54. struct drm_device *dev = crtc->dev;
  55. struct fsl_dcu_drm_device *fsl_dev = dev->dev_private;
  56. clk_prepare_enable(fsl_dev->pix_clk);
  57. regmap_update_bits(fsl_dev->regmap, DCU_DCU_MODE,
  58. DCU_MODE_DCU_MODE_MASK,
  59. DCU_MODE_DCU_MODE(DCU_MODE_NORMAL));
  60. regmap_write(fsl_dev->regmap, DCU_UPDATE_MODE,
  61. DCU_UPDATE_MODE_READREG);
  62. drm_crtc_vblank_on(crtc);
  63. }
  64. static void fsl_dcu_drm_crtc_mode_set_nofb(struct drm_crtc *crtc)
  65. {
  66. struct drm_device *dev = crtc->dev;
  67. struct fsl_dcu_drm_device *fsl_dev = dev->dev_private;
  68. struct drm_connector *con = &fsl_dev->connector.base;
  69. struct drm_display_mode *mode = &crtc->state->mode;
  70. unsigned int pol = 0;
  71. struct videomode vm;
  72. clk_set_rate(fsl_dev->pix_clk, mode->clock * 1000);
  73. drm_display_mode_to_videomode(mode, &vm);
  74. /* INV_PXCK as default (most display sample data on rising edge) */
  75. if (!(con->display_info.bus_flags & DRM_BUS_FLAG_PIXDATA_DRIVE_POSEDGE))
  76. pol |= DCU_SYN_POL_INV_PXCK;
  77. if (vm.flags & DISPLAY_FLAGS_HSYNC_LOW)
  78. pol |= DCU_SYN_POL_INV_HS_LOW;
  79. if (vm.flags & DISPLAY_FLAGS_VSYNC_LOW)
  80. pol |= DCU_SYN_POL_INV_VS_LOW;
  81. regmap_write(fsl_dev->regmap, DCU_HSYN_PARA,
  82. DCU_HSYN_PARA_BP(vm.hback_porch) |
  83. DCU_HSYN_PARA_PW(vm.hsync_len) |
  84. DCU_HSYN_PARA_FP(vm.hfront_porch));
  85. regmap_write(fsl_dev->regmap, DCU_VSYN_PARA,
  86. DCU_VSYN_PARA_BP(vm.vback_porch) |
  87. DCU_VSYN_PARA_PW(vm.vsync_len) |
  88. DCU_VSYN_PARA_FP(vm.vfront_porch));
  89. regmap_write(fsl_dev->regmap, DCU_DISP_SIZE,
  90. DCU_DISP_SIZE_DELTA_Y(vm.vactive) |
  91. DCU_DISP_SIZE_DELTA_X(vm.hactive));
  92. regmap_write(fsl_dev->regmap, DCU_SYN_POL, pol);
  93. regmap_write(fsl_dev->regmap, DCU_BGND, DCU_BGND_R(0) |
  94. DCU_BGND_G(0) | DCU_BGND_B(0));
  95. regmap_write(fsl_dev->regmap, DCU_DCU_MODE,
  96. DCU_MODE_BLEND_ITER(1) | DCU_MODE_RASTER_EN);
  97. regmap_write(fsl_dev->regmap, DCU_THRESHOLD,
  98. DCU_THRESHOLD_LS_BF_VS(BF_VS_VAL) |
  99. DCU_THRESHOLD_OUT_BUF_HIGH(BUF_MAX_VAL) |
  100. DCU_THRESHOLD_OUT_BUF_LOW(BUF_MIN_VAL));
  101. return;
  102. }
  103. static const struct drm_crtc_helper_funcs fsl_dcu_drm_crtc_helper_funcs = {
  104. .atomic_disable = fsl_dcu_drm_crtc_atomic_disable,
  105. .atomic_flush = fsl_dcu_drm_crtc_atomic_flush,
  106. .atomic_enable = fsl_dcu_drm_crtc_atomic_enable,
  107. .mode_set_nofb = fsl_dcu_drm_crtc_mode_set_nofb,
  108. };
  109. static int fsl_dcu_drm_crtc_enable_vblank(struct drm_crtc *crtc)
  110. {
  111. struct drm_device *dev = crtc->dev;
  112. struct fsl_dcu_drm_device *fsl_dev = dev->dev_private;
  113. unsigned int value;
  114. regmap_read(fsl_dev->regmap, DCU_INT_MASK, &value);
  115. value &= ~DCU_INT_MASK_VBLANK;
  116. regmap_write(fsl_dev->regmap, DCU_INT_MASK, value);
  117. return 0;
  118. }
  119. static void fsl_dcu_drm_crtc_disable_vblank(struct drm_crtc *crtc)
  120. {
  121. struct drm_device *dev = crtc->dev;
  122. struct fsl_dcu_drm_device *fsl_dev = dev->dev_private;
  123. unsigned int value;
  124. regmap_read(fsl_dev->regmap, DCU_INT_MASK, &value);
  125. value |= DCU_INT_MASK_VBLANK;
  126. regmap_write(fsl_dev->regmap, DCU_INT_MASK, value);
  127. }
  128. static const struct drm_crtc_funcs fsl_dcu_drm_crtc_funcs = {
  129. .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
  130. .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
  131. .destroy = drm_crtc_cleanup,
  132. .page_flip = drm_atomic_helper_page_flip,
  133. .reset = drm_atomic_helper_crtc_reset,
  134. .set_config = drm_atomic_helper_set_config,
  135. .enable_vblank = fsl_dcu_drm_crtc_enable_vblank,
  136. .disable_vblank = fsl_dcu_drm_crtc_disable_vblank,
  137. };
  138. int fsl_dcu_drm_crtc_create(struct fsl_dcu_drm_device *fsl_dev)
  139. {
  140. struct drm_plane *primary;
  141. struct drm_crtc *crtc = &fsl_dev->crtc;
  142. int ret;
  143. fsl_dcu_drm_init_planes(fsl_dev->drm);
  144. primary = fsl_dcu_drm_primary_create_plane(fsl_dev->drm);
  145. if (!primary)
  146. return -ENOMEM;
  147. ret = drm_crtc_init_with_planes(fsl_dev->drm, crtc, primary, NULL,
  148. &fsl_dcu_drm_crtc_funcs, NULL);
  149. if (ret) {
  150. primary->funcs->destroy(primary);
  151. return ret;
  152. }
  153. drm_crtc_helper_add(crtc, &fsl_dcu_drm_crtc_helper_funcs);
  154. return 0;
  155. }