sun4i_crtc.c 6.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * Copyright (C) 2015 Free Electrons
  4. * Copyright (C) 2015 NextThing Co
  5. *
  6. * Maxime Ripard <maxime.ripard@free-electrons.com>
  7. */
  8. #include <linux/clk-provider.h>
  9. #include <linux/ioport.h>
  10. #include <linux/of_address.h>
  11. #include <linux/of_graph.h>
  12. #include <linux/of_irq.h>
  13. #include <linux/regmap.h>
  14. #include <video/videomode.h>
  15. #include <drm/drm_atomic_helper.h>
  16. #include <drm/drm_crtc.h>
  17. #include <drm/drm_modes.h>
  18. #include <drm/drm_print.h>
  19. #include <drm/drm_probe_helper.h>
  20. #include <drm/drm_vblank.h>
  21. #include "sun4i_backend.h"
  22. #include "sun4i_crtc.h"
  23. #include "sun4i_drv.h"
  24. #include "sunxi_engine.h"
  25. #include "sun4i_tcon.h"
  26. /*
  27. * While this isn't really working in the DRM theory, in practice we
  28. * can only ever have one encoder per TCON since we have a mux in our
  29. * TCON.
  30. */
  31. static struct drm_encoder *sun4i_crtc_get_encoder(struct drm_crtc *crtc)
  32. {
  33. struct drm_encoder *encoder;
  34. drm_for_each_encoder(encoder, crtc->dev)
  35. if (encoder->crtc == crtc)
  36. return encoder;
  37. return NULL;
  38. }
  39. static int sun4i_crtc_atomic_check(struct drm_crtc *crtc,
  40. struct drm_crtc_state *state)
  41. {
  42. struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
  43. struct sunxi_engine *engine = scrtc->engine;
  44. int ret = 0;
  45. if (engine && engine->ops && engine->ops->atomic_check)
  46. ret = engine->ops->atomic_check(engine, state);
  47. return ret;
  48. }
  49. static void sun4i_crtc_atomic_begin(struct drm_crtc *crtc,
  50. struct drm_crtc_state *old_state)
  51. {
  52. struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
  53. struct drm_device *dev = crtc->dev;
  54. struct sunxi_engine *engine = scrtc->engine;
  55. unsigned long flags;
  56. if (crtc->state->event) {
  57. WARN_ON(drm_crtc_vblank_get(crtc) != 0);
  58. spin_lock_irqsave(&dev->event_lock, flags);
  59. scrtc->event = crtc->state->event;
  60. spin_unlock_irqrestore(&dev->event_lock, flags);
  61. crtc->state->event = NULL;
  62. }
  63. if (engine->ops->atomic_begin)
  64. engine->ops->atomic_begin(engine, old_state);
  65. }
  66. static void sun4i_crtc_atomic_flush(struct drm_crtc *crtc,
  67. struct drm_crtc_state *old_state)
  68. {
  69. struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
  70. struct drm_pending_vblank_event *event = crtc->state->event;
  71. DRM_DEBUG_DRIVER("Committing plane changes\n");
  72. sunxi_engine_commit(scrtc->engine);
  73. if (event) {
  74. crtc->state->event = NULL;
  75. spin_lock_irq(&crtc->dev->event_lock);
  76. if (drm_crtc_vblank_get(crtc) == 0)
  77. drm_crtc_arm_vblank_event(crtc, event);
  78. else
  79. drm_crtc_send_vblank_event(crtc, event);
  80. spin_unlock_irq(&crtc->dev->event_lock);
  81. }
  82. }
  83. static void sun4i_crtc_atomic_disable(struct drm_crtc *crtc,
  84. struct drm_crtc_state *old_state)
  85. {
  86. struct drm_encoder *encoder = sun4i_crtc_get_encoder(crtc);
  87. struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
  88. DRM_DEBUG_DRIVER("Disabling the CRTC\n");
  89. drm_crtc_vblank_off(crtc);
  90. sun4i_tcon_set_status(scrtc->tcon, encoder, false);
  91. if (crtc->state->event && !crtc->state->active) {
  92. spin_lock_irq(&crtc->dev->event_lock);
  93. drm_crtc_send_vblank_event(crtc, crtc->state->event);
  94. spin_unlock_irq(&crtc->dev->event_lock);
  95. crtc->state->event = NULL;
  96. }
  97. }
  98. static void sun4i_crtc_atomic_enable(struct drm_crtc *crtc,
  99. struct drm_crtc_state *old_state)
  100. {
  101. struct drm_encoder *encoder = sun4i_crtc_get_encoder(crtc);
  102. struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
  103. DRM_DEBUG_DRIVER("Enabling the CRTC\n");
  104. sun4i_tcon_set_status(scrtc->tcon, encoder, true);
  105. drm_crtc_vblank_on(crtc);
  106. }
  107. static void sun4i_crtc_mode_set_nofb(struct drm_crtc *crtc)
  108. {
  109. struct drm_display_mode *mode = &crtc->state->adjusted_mode;
  110. struct drm_encoder *encoder = sun4i_crtc_get_encoder(crtc);
  111. struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
  112. sun4i_tcon_mode_set(scrtc->tcon, encoder, mode);
  113. }
  114. static const struct drm_crtc_helper_funcs sun4i_crtc_helper_funcs = {
  115. .atomic_check = sun4i_crtc_atomic_check,
  116. .atomic_begin = sun4i_crtc_atomic_begin,
  117. .atomic_flush = sun4i_crtc_atomic_flush,
  118. .atomic_enable = sun4i_crtc_atomic_enable,
  119. .atomic_disable = sun4i_crtc_atomic_disable,
  120. .mode_set_nofb = sun4i_crtc_mode_set_nofb,
  121. };
  122. static int sun4i_crtc_enable_vblank(struct drm_crtc *crtc)
  123. {
  124. struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
  125. DRM_DEBUG_DRIVER("Enabling VBLANK on crtc %p\n", crtc);
  126. sun4i_tcon_enable_vblank(scrtc->tcon, true);
  127. return 0;
  128. }
  129. static void sun4i_crtc_disable_vblank(struct drm_crtc *crtc)
  130. {
  131. struct sun4i_crtc *scrtc = drm_crtc_to_sun4i_crtc(crtc);
  132. DRM_DEBUG_DRIVER("Disabling VBLANK on crtc %p\n", crtc);
  133. sun4i_tcon_enable_vblank(scrtc->tcon, false);
  134. }
  135. static const struct drm_crtc_funcs sun4i_crtc_funcs = {
  136. .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
  137. .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
  138. .destroy = drm_crtc_cleanup,
  139. .page_flip = drm_atomic_helper_page_flip,
  140. .reset = drm_atomic_helper_crtc_reset,
  141. .set_config = drm_atomic_helper_set_config,
  142. .enable_vblank = sun4i_crtc_enable_vblank,
  143. .disable_vblank = sun4i_crtc_disable_vblank,
  144. };
  145. struct sun4i_crtc *sun4i_crtc_init(struct drm_device *drm,
  146. struct sunxi_engine *engine,
  147. struct sun4i_tcon *tcon)
  148. {
  149. struct sun4i_crtc *scrtc;
  150. struct drm_plane **planes;
  151. struct drm_plane *primary = NULL, *cursor = NULL;
  152. int ret, i;
  153. scrtc = devm_kzalloc(drm->dev, sizeof(*scrtc), GFP_KERNEL);
  154. if (!scrtc)
  155. return ERR_PTR(-ENOMEM);
  156. scrtc->engine = engine;
  157. scrtc->tcon = tcon;
  158. /* Create our layers */
  159. planes = sunxi_engine_layers_init(drm, engine);
  160. if (IS_ERR(planes)) {
  161. dev_err(drm->dev, "Couldn't create the planes\n");
  162. return NULL;
  163. }
  164. /* find primary and cursor planes for drm_crtc_init_with_planes */
  165. for (i = 0; planes[i]; i++) {
  166. struct drm_plane *plane = planes[i];
  167. switch (plane->type) {
  168. case DRM_PLANE_TYPE_PRIMARY:
  169. primary = plane;
  170. break;
  171. case DRM_PLANE_TYPE_CURSOR:
  172. cursor = plane;
  173. break;
  174. default:
  175. break;
  176. }
  177. }
  178. ret = drm_crtc_init_with_planes(drm, &scrtc->crtc,
  179. primary,
  180. cursor,
  181. &sun4i_crtc_funcs,
  182. NULL);
  183. if (ret) {
  184. dev_err(drm->dev, "Couldn't init DRM CRTC\n");
  185. return ERR_PTR(ret);
  186. }
  187. drm_crtc_helper_add(&scrtc->crtc, &sun4i_crtc_helper_funcs);
  188. /* Set crtc.port to output port node of the tcon */
  189. scrtc->crtc.port = of_graph_get_port_by_id(scrtc->tcon->dev->of_node,
  190. 1);
  191. /* Set possible_crtcs to this crtc for overlay planes */
  192. for (i = 0; planes[i]; i++) {
  193. uint32_t possible_crtcs = drm_crtc_mask(&scrtc->crtc);
  194. struct drm_plane *plane = planes[i];
  195. if (plane->type == DRM_PLANE_TYPE_OVERLAY)
  196. plane->possible_crtcs = possible_crtcs;
  197. }
  198. return scrtc;
  199. }