drivers/gpu/drm/vkms/vkms_output.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2
   3 #include "vkms_drv.h"
   4 #include <drm/drm_atomic_helper.h>
   5 #include <drm/drm_edid.h>
   6 #include <drm/drm_probe_helper.h>
   7 #include <drm/drm_simple_kms_helper.h>
   8
   9 static void vkms_connector_destroy(struct drm_connector *connector)
  10 {
  11         drm_connector_cleanup(connector);
  12 }
  13
  14 static const struct drm_connector_funcs vkms_connector_funcs = {
  15         .fill_modes = drm_helper_probe_single_connector_modes,
  16         .destroy = vkms_connector_destroy,
  17         .reset = drm_atomic_helper_connector_reset,
  18         .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
  19         .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
  20 };
  21
  22 static int vkms_conn_get_modes(struct drm_connector *connector)
  23 {
  24         int count;
  25
  26         count = drm_add_modes_noedid(connector, XRES_MAX, YRES_MAX);
  27         drm_set_preferred_mode(connector, XRES_DEF, YRES_DEF);
  28
  29         return count;
  30 }
  31
  32 static const struct drm_connector_helper_funcs vkms_conn_helper_funcs = {
  33         .get_modes    = vkms_conn_get_modes,
  34 };
  35
  36 static int vkms_add_overlay_plane(struct vkms_device *vkmsdev, int index,
  37                                   struct drm_crtc *crtc)
  38 {
  39         struct vkms_plane *overlay;
  40
  41         overlay = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_OVERLAY, index);
  42         if (IS_ERR(overlay))
  43                 return PTR_ERR(overlay);
  44
  45         if (!overlay->base.possible_crtcs)
  46                 overlay->base.possible_crtcs = drm_crtc_mask(crtc);
  47
  48         return 0;
  49 }
  50
  51 int vkms_output_init(struct vkms_device *vkmsdev, int index)
  52 {
  53         struct vkms_output *output = &vkmsdev->output;
  54         struct drm_device *dev = &vkmsdev->drm;
  55         struct drm_connector *connector = &output->connector;
  56         struct drm_encoder *encoder = &output->encoder;
  57         struct drm_crtc *crtc = &output->crtc;
  58         struct vkms_plane *primary, *cursor = NULL;
  59         int ret;
  60         int writeback;
  61         unsigned int n;
  62
  63         primary = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_PRIMARY, index);
  64         if (IS_ERR(primary))
  65                 return PTR_ERR(primary);
  66
  67         if (vkmsdev->config->overlay) {
  68                 for (n = 0; n < NUM_OVERLAY_PLANES; n++) {
  69                         ret = vkms_add_overlay_plane(vkmsdev, index, crtc);
  70                         if (ret)
  71                                 return ret;
  72                 }
  73         }
  74
  75         if (vkmsdev->config->cursor) {
  76                 cursor = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_CURSOR, index);
  77                 if (IS_ERR(cursor))
  78                         return PTR_ERR(cursor);
  79         }
  80
  81         ret = vkms_crtc_init(dev, crtc, &primary->base, &cursor->base);
  82         if (ret)
  83                 return ret;
  84
  85         ret = drm_connector_init(dev, connector, &vkms_connector_funcs,
  86                                  DRM_MODE_CONNECTOR_VIRTUAL);
  87         if (ret) {
  88                 DRM_ERROR("Failed to init connector\n");
  89                 goto err_connector;
  90         }
  91
  92         drm_connector_helper_add(connector, &vkms_conn_helper_funcs);
  93
  94         ret = drm_simple_encoder_init(dev, encoder, DRM_MODE_ENCODER_VIRTUAL);
  95         if (ret) {
  96                 DRM_ERROR("Failed to init encoder\n");
  97                 goto err_encoder;
  98         }
  99         encoder->possible_crtcs = 1;
 100
 101         ret = drm_connector_attach_encoder(connector, encoder);
 102         if (ret) {
 103                 DRM_ERROR("Failed to attach connector to encoder\n");
 104                 goto err_attach;
 105         }
 106
 107         if (vkmsdev->config->writeback) {
 108                 writeback = vkms_enable_writeback_connector(vkmsdev);
 109                 if (writeback)
 110                         DRM_ERROR("Failed to init writeback connector\n");
 111         }
 112
 113         drm_mode_config_reset(dev);
 114
 115         return 0;
 116
 117 err_attach:
 118         drm_encoder_cleanup(encoder);
 119
 120 err_encoder:
 121         drm_connector_cleanup(connector);
 122
 123 err_connector:
 124         drm_crtc_cleanup(crtc);
 125
 126         return ret;
 127 }