Back to home page

OSCL-LXR

 
 

    


0001 // SPDX-License-Identifier: GPL-2.0+
0002 
0003 #include "vkms_drv.h"
0004 #include <drm/drm_atomic_helper.h>
0005 #include <drm/drm_edid.h>
0006 #include <drm/drm_probe_helper.h>
0007 #include <drm/drm_simple_kms_helper.h>
0008 
0009 static void vkms_connector_destroy(struct drm_connector *connector)
0010 {
0011     drm_connector_cleanup(connector);
0012 }
0013 
0014 static const struct drm_connector_funcs vkms_connector_funcs = {
0015     .fill_modes = drm_helper_probe_single_connector_modes,
0016     .destroy = vkms_connector_destroy,
0017     .reset = drm_atomic_helper_connector_reset,
0018     .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
0019     .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
0020 };
0021 
0022 static int vkms_conn_get_modes(struct drm_connector *connector)
0023 {
0024     int count;
0025 
0026     count = drm_add_modes_noedid(connector, XRES_MAX, YRES_MAX);
0027     drm_set_preferred_mode(connector, XRES_DEF, YRES_DEF);
0028 
0029     return count;
0030 }
0031 
0032 static const struct drm_connector_helper_funcs vkms_conn_helper_funcs = {
0033     .get_modes    = vkms_conn_get_modes,
0034 };
0035 
0036 static int vkms_add_overlay_plane(struct vkms_device *vkmsdev, int index,
0037                   struct drm_crtc *crtc)
0038 {
0039     struct vkms_plane *overlay;
0040 
0041     overlay = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_OVERLAY, index);
0042     if (IS_ERR(overlay))
0043         return PTR_ERR(overlay);
0044 
0045     if (!overlay->base.possible_crtcs)
0046         overlay->base.possible_crtcs = drm_crtc_mask(crtc);
0047 
0048     return 0;
0049 }
0050 
0051 int vkms_output_init(struct vkms_device *vkmsdev, int index)
0052 {
0053     struct vkms_output *output = &vkmsdev->output;
0054     struct drm_device *dev = &vkmsdev->drm;
0055     struct drm_connector *connector = &output->connector;
0056     struct drm_encoder *encoder = &output->encoder;
0057     struct drm_crtc *crtc = &output->crtc;
0058     struct vkms_plane *primary, *cursor = NULL;
0059     int ret;
0060     int writeback;
0061     unsigned int n;
0062 
0063     primary = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_PRIMARY, index);
0064     if (IS_ERR(primary))
0065         return PTR_ERR(primary);
0066 
0067     if (vkmsdev->config->overlay) {
0068         for (n = 0; n < NUM_OVERLAY_PLANES; n++) {
0069             ret = vkms_add_overlay_plane(vkmsdev, index, crtc);
0070             if (ret)
0071                 return ret;
0072         }
0073     }
0074 
0075     if (vkmsdev->config->cursor) {
0076         cursor = vkms_plane_init(vkmsdev, DRM_PLANE_TYPE_CURSOR, index);
0077         if (IS_ERR(cursor))
0078             return PTR_ERR(cursor);
0079     }
0080 
0081     ret = vkms_crtc_init(dev, crtc, &primary->base, &cursor->base);
0082     if (ret)
0083         return ret;
0084 
0085     ret = drm_connector_init(dev, connector, &vkms_connector_funcs,
0086                  DRM_MODE_CONNECTOR_VIRTUAL);
0087     if (ret) {
0088         DRM_ERROR("Failed to init connector\n");
0089         goto err_connector;
0090     }
0091 
0092     drm_connector_helper_add(connector, &vkms_conn_helper_funcs);
0093 
0094     ret = drm_simple_encoder_init(dev, encoder, DRM_MODE_ENCODER_VIRTUAL);
0095     if (ret) {
0096         DRM_ERROR("Failed to init encoder\n");
0097         goto err_encoder;
0098     }
0099     encoder->possible_crtcs = 1;
0100 
0101     ret = drm_connector_attach_encoder(connector, encoder);
0102     if (ret) {
0103         DRM_ERROR("Failed to attach connector to encoder\n");
0104         goto err_attach;
0105     }
0106 
0107     if (vkmsdev->config->writeback) {
0108         writeback = vkms_enable_writeback_connector(vkmsdev);
0109         if (writeback)
0110             DRM_ERROR("Failed to init writeback connector\n");
0111     }
0112 
0113     drm_mode_config_reset(dev);
0114 
0115     return 0;
0116 
0117 err_attach:
0118     drm_encoder_cleanup(encoder);
0119 
0120 err_encoder:
0121     drm_connector_cleanup(connector);
0122 
0123 err_connector:
0124     drm_crtc_cleanup(crtc);
0125 
0126     return ret;
0127 }