0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011 #include <drm/drm_atomic_helper.h>
0012 #include <drm/drm_drv.h>
0013 #include <drm/drm_fourcc.h>
0014 #include <drm/drm_probe_helper.h>
0015
0016 #include <video/videomode.h>
0017
0018 #include "xen_drm_front.h"
0019 #include "xen_drm_front_conn.h"
0020 #include "xen_drm_front_kms.h"
0021
0022 static struct xen_drm_front_drm_pipeline *
0023 to_xen_drm_pipeline(struct drm_connector *connector)
0024 {
0025 return container_of(connector, struct xen_drm_front_drm_pipeline, conn);
0026 }
0027
0028 static const u32 plane_formats[] = {
0029 DRM_FORMAT_RGB565,
0030 DRM_FORMAT_RGB888,
0031 DRM_FORMAT_XRGB8888,
0032 DRM_FORMAT_ARGB8888,
0033 DRM_FORMAT_XRGB4444,
0034 DRM_FORMAT_ARGB4444,
0035 DRM_FORMAT_XRGB1555,
0036 DRM_FORMAT_ARGB1555,
0037 DRM_FORMAT_YUYV,
0038 };
0039
0040 const u32 *xen_drm_front_conn_get_formats(int *format_count)
0041 {
0042 *format_count = ARRAY_SIZE(plane_formats);
0043 return plane_formats;
0044 }
0045
0046 static int connector_detect(struct drm_connector *connector,
0047 struct drm_modeset_acquire_ctx *ctx,
0048 bool force)
0049 {
0050 struct xen_drm_front_drm_pipeline *pipeline =
0051 to_xen_drm_pipeline(connector);
0052
0053 if (drm_dev_is_unplugged(connector->dev))
0054 pipeline->conn_connected = false;
0055
0056 return pipeline->conn_connected ? connector_status_connected :
0057 connector_status_disconnected;
0058 }
0059
0060 #define XEN_DRM_CRTC_VREFRESH_HZ 60
0061
0062 static int connector_get_modes(struct drm_connector *connector)
0063 {
0064 struct xen_drm_front_drm_pipeline *pipeline =
0065 to_xen_drm_pipeline(connector);
0066 struct drm_display_mode *mode;
0067 struct videomode videomode;
0068 int width, height;
0069
0070 mode = drm_mode_create(connector->dev);
0071 if (!mode)
0072 return 0;
0073
0074 memset(&videomode, 0, sizeof(videomode));
0075 videomode.hactive = pipeline->width;
0076 videomode.vactive = pipeline->height;
0077 width = videomode.hactive + videomode.hfront_porch +
0078 videomode.hback_porch + videomode.hsync_len;
0079 height = videomode.vactive + videomode.vfront_porch +
0080 videomode.vback_porch + videomode.vsync_len;
0081 videomode.pixelclock = width * height * XEN_DRM_CRTC_VREFRESH_HZ;
0082 mode->type = DRM_MODE_TYPE_PREFERRED | DRM_MODE_TYPE_DRIVER;
0083
0084 drm_display_mode_from_videomode(&videomode, mode);
0085 drm_mode_probed_add(connector, mode);
0086 return 1;
0087 }
0088
0089 static const struct drm_connector_helper_funcs connector_helper_funcs = {
0090 .get_modes = connector_get_modes,
0091 .detect_ctx = connector_detect,
0092 };
0093
0094 static const struct drm_connector_funcs connector_funcs = {
0095 .fill_modes = drm_helper_probe_single_connector_modes,
0096 .destroy = drm_connector_cleanup,
0097 .reset = drm_atomic_helper_connector_reset,
0098 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
0099 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
0100 };
0101
0102 int xen_drm_front_conn_init(struct xen_drm_front_drm_info *drm_info,
0103 struct drm_connector *connector)
0104 {
0105 struct xen_drm_front_drm_pipeline *pipeline =
0106 to_xen_drm_pipeline(connector);
0107
0108 drm_connector_helper_add(connector, &connector_helper_funcs);
0109
0110 pipeline->conn_connected = true;
0111
0112 connector->polled = DRM_CONNECTOR_POLL_CONNECT |
0113 DRM_CONNECTOR_POLL_DISCONNECT;
0114
0115 return drm_connector_init(drm_info->drm_dev, connector,
0116 &connector_funcs, DRM_MODE_CONNECTOR_VIRTUAL);
0117 }