hyperv_drm_modeset.c (6369B)
1// SPDX-License-Identifier: GPL-2.0-only 2/* 3 * Copyright 2021 Microsoft 4 */ 5 6#include <linux/hyperv.h> 7 8#include <drm/drm_damage_helper.h> 9#include <drm/drm_drv.h> 10#include <drm/drm_fb_helper.h> 11#include <drm/drm_format_helper.h> 12#include <drm/drm_fourcc.h> 13#include <drm/drm_gem_atomic_helper.h> 14#include <drm/drm_gem_framebuffer_helper.h> 15#include <drm/drm_gem_shmem_helper.h> 16#include <drm/drm_probe_helper.h> 17#include <drm/drm_simple_kms_helper.h> 18 19#include "hyperv_drm.h" 20 21static int hyperv_blit_to_vram_rect(struct drm_framebuffer *fb, 22 const struct iosys_map *map, 23 struct drm_rect *rect) 24{ 25 struct hyperv_drm_device *hv = to_hv(fb->dev); 26 void __iomem *dst = hv->vram; 27 void *vmap = map->vaddr; /* TODO: Use mapping abstraction properly */ 28 int idx; 29 30 if (!drm_dev_enter(&hv->dev, &idx)) 31 return -ENODEV; 32 33 dst += drm_fb_clip_offset(fb->pitches[0], fb->format, rect); 34 drm_fb_memcpy_toio(dst, fb->pitches[0], vmap, fb, rect); 35 36 drm_dev_exit(idx); 37 38 return 0; 39} 40 41static int hyperv_blit_to_vram_fullscreen(struct drm_framebuffer *fb, 42 const struct iosys_map *map) 43{ 44 struct drm_rect fullscreen = { 45 .x1 = 0, 46 .x2 = fb->width, 47 .y1 = 0, 48 .y2 = fb->height, 49 }; 50 return hyperv_blit_to_vram_rect(fb, map, &fullscreen); 51} 52 53static int hyperv_connector_get_modes(struct drm_connector *connector) 54{ 55 struct hyperv_drm_device *hv = to_hv(connector->dev); 56 int count; 57 58 count = drm_add_modes_noedid(connector, 59 connector->dev->mode_config.max_width, 60 connector->dev->mode_config.max_height); 61 drm_set_preferred_mode(connector, hv->preferred_width, 62 hv->preferred_height); 63 64 return count; 65} 66 67static const struct drm_connector_helper_funcs hyperv_connector_helper_funcs = { 68 .get_modes = hyperv_connector_get_modes, 69}; 70 71static const struct drm_connector_funcs hyperv_connector_funcs = { 72 .fill_modes = drm_helper_probe_single_connector_modes, 73 .destroy = drm_connector_cleanup, 74 .reset = drm_atomic_helper_connector_reset, 75 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, 76 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, 77}; 78 79static inline int hyperv_conn_init(struct hyperv_drm_device *hv) 80{ 81 drm_connector_helper_add(&hv->connector, &hyperv_connector_helper_funcs); 82 return drm_connector_init(&hv->dev, &hv->connector, 83 &hyperv_connector_funcs, 84 DRM_MODE_CONNECTOR_VIRTUAL); 85} 86 87static int hyperv_check_size(struct hyperv_drm_device *hv, int w, int h, 88 struct drm_framebuffer *fb) 89{ 90 u32 pitch = w * (hv->screen_depth / 8); 91 92 if (fb) 93 pitch = fb->pitches[0]; 94 95 if (pitch * h > hv->fb_size) 96 return -EINVAL; 97 98 return 0; 99} 100 101static void hyperv_pipe_enable(struct drm_simple_display_pipe *pipe, 102 struct drm_crtc_state *crtc_state, 103 struct drm_plane_state *plane_state) 104{ 105 struct hyperv_drm_device *hv = to_hv(pipe->crtc.dev); 106 struct drm_shadow_plane_state *shadow_plane_state = to_drm_shadow_plane_state(plane_state); 107 108 hyperv_hide_hw_ptr(hv->hdev); 109 hyperv_update_situation(hv->hdev, 1, hv->screen_depth, 110 crtc_state->mode.hdisplay, 111 crtc_state->mode.vdisplay, 112 plane_state->fb->pitches[0]); 113 hyperv_blit_to_vram_fullscreen(plane_state->fb, &shadow_plane_state->data[0]); 114} 115 116static int hyperv_pipe_check(struct drm_simple_display_pipe *pipe, 117 struct drm_plane_state *plane_state, 118 struct drm_crtc_state *crtc_state) 119{ 120 struct hyperv_drm_device *hv = to_hv(pipe->crtc.dev); 121 struct drm_framebuffer *fb = plane_state->fb; 122 123 if (fb->format->format != DRM_FORMAT_XRGB8888) 124 return -EINVAL; 125 126 if (fb->pitches[0] * fb->height > hv->fb_size) { 127 drm_err(&hv->dev, "fb size requested by %s for %dX%d (pitch %d) greater than %ld\n", 128 current->comm, fb->width, fb->height, fb->pitches[0], hv->fb_size); 129 return -EINVAL; 130 } 131 132 return 0; 133} 134 135static void hyperv_pipe_update(struct drm_simple_display_pipe *pipe, 136 struct drm_plane_state *old_state) 137{ 138 struct hyperv_drm_device *hv = to_hv(pipe->crtc.dev); 139 struct drm_plane_state *state = pipe->plane.state; 140 struct drm_shadow_plane_state *shadow_plane_state = to_drm_shadow_plane_state(state); 141 struct drm_rect rect; 142 143 if (drm_atomic_helper_damage_merged(old_state, state, &rect)) { 144 hyperv_blit_to_vram_rect(state->fb, &shadow_plane_state->data[0], &rect); 145 hyperv_update_dirt(hv->hdev, &rect); 146 } 147} 148 149static const struct drm_simple_display_pipe_funcs hyperv_pipe_funcs = { 150 .enable = hyperv_pipe_enable, 151 .check = hyperv_pipe_check, 152 .update = hyperv_pipe_update, 153 DRM_GEM_SIMPLE_DISPLAY_PIPE_SHADOW_PLANE_FUNCS, 154}; 155 156static const uint32_t hyperv_formats[] = { 157 DRM_FORMAT_XRGB8888, 158}; 159 160static const uint64_t hyperv_modifiers[] = { 161 DRM_FORMAT_MOD_LINEAR, 162 DRM_FORMAT_MOD_INVALID 163}; 164 165static inline int hyperv_pipe_init(struct hyperv_drm_device *hv) 166{ 167 int ret; 168 169 ret = drm_simple_display_pipe_init(&hv->dev, 170 &hv->pipe, 171 &hyperv_pipe_funcs, 172 hyperv_formats, 173 ARRAY_SIZE(hyperv_formats), 174 hyperv_modifiers, 175 &hv->connector); 176 if (ret) 177 return ret; 178 179 drm_plane_enable_fb_damage_clips(&hv->pipe.plane); 180 181 return 0; 182} 183 184static enum drm_mode_status 185hyperv_mode_valid(struct drm_device *dev, 186 const struct drm_display_mode *mode) 187{ 188 struct hyperv_drm_device *hv = to_hv(dev); 189 190 if (hyperv_check_size(hv, mode->hdisplay, mode->vdisplay, NULL)) 191 return MODE_BAD; 192 193 return MODE_OK; 194} 195 196static const struct drm_mode_config_funcs hyperv_mode_config_funcs = { 197 .fb_create = drm_gem_fb_create_with_dirty, 198 .mode_valid = hyperv_mode_valid, 199 .atomic_check = drm_atomic_helper_check, 200 .atomic_commit = drm_atomic_helper_commit, 201}; 202 203int hyperv_mode_config_init(struct hyperv_drm_device *hv) 204{ 205 struct drm_device *dev = &hv->dev; 206 int ret; 207 208 ret = drmm_mode_config_init(dev); 209 if (ret) { 210 drm_err(dev, "Failed to initialized mode setting.\n"); 211 return ret; 212 } 213 214 dev->mode_config.min_width = 0; 215 dev->mode_config.min_height = 0; 216 dev->mode_config.max_width = hv->screen_width_max; 217 dev->mode_config.max_height = hv->screen_height_max; 218 219 dev->mode_config.preferred_depth = hv->screen_depth; 220 dev->mode_config.prefer_shadow = 0; 221 222 dev->mode_config.funcs = &hyperv_mode_config_funcs; 223 224 ret = hyperv_conn_init(hv); 225 if (ret) { 226 drm_err(dev, "Failed to initialized connector.\n"); 227 return ret; 228 } 229 230 ret = hyperv_pipe_init(hv); 231 if (ret) { 232 drm_err(dev, "Failed to initialized pipe.\n"); 233 return ret; 234 } 235 236 drm_mode_config_reset(dev); 237 238 return 0; 239}