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