0001
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 }