vkms_writeback.c 3.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142
  1. // SPDX-License-Identifier: GPL-2.0+
  2. #include "vkms_drv.h"
  3. #include <drm/drm_fourcc.h>
  4. #include <drm/drm_writeback.h>
  5. #include <drm/drm_probe_helper.h>
  6. #include <drm/drm_atomic_helper.h>
  7. #include <drm/drm_gem_framebuffer_helper.h>
  8. static const u32 vkms_wb_formats[] = {
  9. DRM_FORMAT_XRGB8888,
  10. };
  11. static const struct drm_connector_funcs vkms_wb_connector_funcs = {
  12. .fill_modes = drm_helper_probe_single_connector_modes,
  13. .destroy = drm_connector_cleanup,
  14. .reset = drm_atomic_helper_connector_reset,
  15. .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
  16. .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
  17. };
  18. static int vkms_wb_encoder_atomic_check(struct drm_encoder *encoder,
  19. struct drm_crtc_state *crtc_state,
  20. struct drm_connector_state *conn_state)
  21. {
  22. struct drm_framebuffer *fb;
  23. const struct drm_display_mode *mode = &crtc_state->mode;
  24. if (!conn_state->writeback_job || !conn_state->writeback_job->fb)
  25. return 0;
  26. fb = conn_state->writeback_job->fb;
  27. if (fb->width != mode->hdisplay || fb->height != mode->vdisplay) {
  28. DRM_DEBUG_KMS("Invalid framebuffer size %ux%u\n",
  29. fb->width, fb->height);
  30. return -EINVAL;
  31. }
  32. if (fb->format->format != vkms_wb_formats[0]) {
  33. struct drm_format_name_buf format_name;
  34. DRM_DEBUG_KMS("Invalid pixel format %s\n",
  35. drm_get_format_name(fb->format->format,
  36. &format_name));
  37. return -EINVAL;
  38. }
  39. return 0;
  40. }
  41. static const struct drm_encoder_helper_funcs vkms_wb_encoder_helper_funcs = {
  42. .atomic_check = vkms_wb_encoder_atomic_check,
  43. };
  44. static int vkms_wb_connector_get_modes(struct drm_connector *connector)
  45. {
  46. struct drm_device *dev = connector->dev;
  47. return drm_add_modes_noedid(connector, dev->mode_config.max_width,
  48. dev->mode_config.max_height);
  49. }
  50. static int vkms_wb_prepare_job(struct drm_writeback_connector *wb_connector,
  51. struct drm_writeback_job *job)
  52. {
  53. struct vkms_gem_object *vkms_obj;
  54. struct drm_gem_object *gem_obj;
  55. int ret;
  56. if (!job->fb)
  57. return 0;
  58. gem_obj = drm_gem_fb_get_obj(job->fb, 0);
  59. ret = vkms_gem_vmap(gem_obj);
  60. if (ret) {
  61. DRM_ERROR("vmap failed: %d\n", ret);
  62. return ret;
  63. }
  64. vkms_obj = drm_gem_to_vkms_gem(gem_obj);
  65. job->priv = vkms_obj->vaddr;
  66. return 0;
  67. }
  68. static void vkms_wb_cleanup_job(struct drm_writeback_connector *connector,
  69. struct drm_writeback_job *job)
  70. {
  71. struct drm_gem_object *gem_obj;
  72. struct vkms_device *vkmsdev;
  73. if (!job->fb)
  74. return;
  75. gem_obj = drm_gem_fb_get_obj(job->fb, 0);
  76. vkms_gem_vunmap(gem_obj);
  77. vkmsdev = drm_device_to_vkms_device(gem_obj->dev);
  78. vkms_set_composer(&vkmsdev->output, false);
  79. }
  80. static void vkms_wb_atomic_commit(struct drm_connector *conn,
  81. struct drm_connector_state *state)
  82. {
  83. struct vkms_device *vkmsdev = drm_device_to_vkms_device(conn->dev);
  84. struct vkms_output *output = &vkmsdev->output;
  85. struct drm_writeback_connector *wb_conn = &output->wb_connector;
  86. struct drm_connector_state *conn_state = wb_conn->base.state;
  87. struct vkms_crtc_state *crtc_state = output->composer_state;
  88. if (!conn_state)
  89. return;
  90. vkms_set_composer(&vkmsdev->output, true);
  91. spin_lock_irq(&output->composer_lock);
  92. crtc_state->active_writeback = conn_state->writeback_job->priv;
  93. crtc_state->wb_pending = true;
  94. spin_unlock_irq(&output->composer_lock);
  95. drm_writeback_queue_job(wb_conn, state);
  96. }
  97. static const struct drm_connector_helper_funcs vkms_wb_conn_helper_funcs = {
  98. .get_modes = vkms_wb_connector_get_modes,
  99. .prepare_writeback_job = vkms_wb_prepare_job,
  100. .cleanup_writeback_job = vkms_wb_cleanup_job,
  101. .atomic_commit = vkms_wb_atomic_commit,
  102. };
  103. int vkms_enable_writeback_connector(struct vkms_device *vkmsdev)
  104. {
  105. struct drm_writeback_connector *wb = &vkmsdev->output.wb_connector;
  106. vkmsdev->output.wb_connector.encoder.possible_crtcs = 1;
  107. drm_connector_helper_add(&wb->base, &vkms_wb_conn_helper_funcs);
  108. return drm_writeback_connector_init(&vkmsdev->drm, wb,
  109. &vkms_wb_connector_funcs,
  110. &vkms_wb_encoder_helper_funcs,
  111. vkms_wb_formats,
  112. ARRAY_SIZE(vkms_wb_formats));
  113. }