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_atomic.h> 9 #include <drm/drm_crtc_helper.h> 10 #include <drm/drm_damage_helper.h> 11 #include <drm/drm_drv.h> 12 #include <drm/drm_edid.h> 13 #include <drm/drm_format_helper.h> 14 #include <drm/drm_fourcc.h> 15 #include <drm/drm_framebuffer.h> 16 #include <drm/drm_gem_atomic_helper.h> 17 #include <drm/drm_gem_framebuffer_helper.h> 18 #include <drm/drm_gem_shmem_helper.h> 19 #include <drm/drm_probe_helper.h> 20 #include <drm/drm_panic.h> 21 #include <drm/drm_plane.h> 22 23 #include "hyperv_drm.h" 24 25 static int hyperv_blit_to_vram_rect(struct drm_framebuffer *fb, 26 const struct iosys_map *vmap, 27 struct drm_rect *rect) 28 { 29 struct hyperv_drm_device *hv = to_hv(fb->dev); 30 struct iosys_map dst = IOSYS_MAP_INIT_VADDR_IOMEM(hv->vram); 31 int idx; 32 33 if (!drm_dev_enter(&hv->dev, &idx)) 34 return -ENODEV; 35 36 iosys_map_incr(&dst, drm_fb_clip_offset(fb->pitches[0], fb->format, rect)); 37 drm_fb_memcpy(&dst, fb->pitches, vmap, fb, rect); 38 39 drm_dev_exit(idx); 40 41 return 0; 42 } 43 44 static int hyperv_connector_get_modes(struct drm_connector *connector) 45 { 46 struct hyperv_drm_device *hv = to_hv(connector->dev); 47 int count; 48 49 count = drm_add_modes_noedid(connector, 50 connector->dev->mode_config.max_width, 51 connector->dev->mode_config.max_height); 52 drm_set_preferred_mode(connector, hv->preferred_width, 53 hv->preferred_height); 54 55 return count; 56 } 57 58 static const struct drm_connector_helper_funcs hyperv_connector_helper_funcs = { 59 .get_modes = hyperv_connector_get_modes, 60 }; 61 62 static const struct drm_connector_funcs hyperv_connector_funcs = { 63 .fill_modes = drm_helper_probe_single_connector_modes, 64 .destroy = drm_connector_cleanup, 65 .reset = drm_atomic_helper_connector_reset, 66 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, 67 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, 68 }; 69 70 static inline int hyperv_conn_init(struct hyperv_drm_device *hv) 71 { 72 drm_connector_helper_add(&hv->connector, &hyperv_connector_helper_funcs); 73 return drm_connector_init(&hv->dev, &hv->connector, 74 &hyperv_connector_funcs, 75 DRM_MODE_CONNECTOR_VIRTUAL); 76 } 77 78 static int hyperv_check_size(struct hyperv_drm_device *hv, int w, int h, 79 struct drm_framebuffer *fb) 80 { 81 u32 pitch = w * (hv->screen_depth / 8); 82 83 if (fb) 84 pitch = fb->pitches[0]; 85 86 if (pitch * h > hv->fb_size) 87 return -EINVAL; 88 89 return 0; 90 } 91 92 static const uint32_t hyperv_formats[] = { 93 DRM_FORMAT_XRGB8888, 94 }; 95 96 static const uint64_t hyperv_modifiers[] = { 97 DRM_FORMAT_MOD_LINEAR, 98 DRM_FORMAT_MOD_INVALID 99 }; 100 101 static void hyperv_crtc_helper_atomic_enable(struct drm_crtc *crtc, 102 struct drm_atomic_state *state) 103 { 104 struct hyperv_drm_device *hv = to_hv(crtc->dev); 105 struct drm_plane *plane = &hv->plane; 106 struct drm_plane_state *plane_state = plane->state; 107 struct drm_crtc_state *crtc_state = crtc->state; 108 109 hyperv_hide_hw_ptr(hv->hdev); 110 hyperv_update_situation(hv->hdev, 1, hv->screen_depth, 111 crtc_state->mode.hdisplay, 112 crtc_state->mode.vdisplay, 113 plane_state->fb->pitches[0]); 114 } 115 116 static const struct drm_crtc_helper_funcs hyperv_crtc_helper_funcs = { 117 .atomic_check = drm_crtc_helper_atomic_check, 118 .atomic_enable = hyperv_crtc_helper_atomic_enable, 119 }; 120 121 static const struct drm_crtc_funcs hyperv_crtc_funcs = { 122 .reset = drm_atomic_helper_crtc_reset, 123 .destroy = drm_crtc_cleanup, 124 .set_config = drm_atomic_helper_set_config, 125 .page_flip = drm_atomic_helper_page_flip, 126 .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state, 127 .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state, 128 }; 129 130 static int hyperv_plane_atomic_check(struct drm_plane *plane, 131 struct drm_atomic_state *state) 132 { 133 struct drm_plane_state *plane_state = drm_atomic_get_new_plane_state(state, plane); 134 struct hyperv_drm_device *hv = to_hv(plane->dev); 135 struct drm_framebuffer *fb = plane_state->fb; 136 struct drm_crtc *crtc = plane_state->crtc; 137 struct drm_crtc_state *crtc_state = NULL; 138 int ret; 139 140 if (crtc) 141 crtc_state = drm_atomic_get_new_crtc_state(state, crtc); 142 143 ret = drm_atomic_helper_check_plane_state(plane_state, crtc_state, 144 DRM_PLANE_NO_SCALING, 145 DRM_PLANE_NO_SCALING, 146 false, false); 147 if (ret) 148 return ret; 149 150 if (!plane_state->visible) 151 return 0; 152 153 if (fb->pitches[0] * fb->height > hv->fb_size) { 154 drm_err(&hv->dev, "fb size requested by %s for %dX%d (pitch %d) greater than %ld\n", 155 current->comm, fb->width, fb->height, fb->pitches[0], hv->fb_size); 156 return -EINVAL; 157 } 158 159 return 0; 160 } 161 162 static void hyperv_plane_atomic_update(struct drm_plane *plane, 163 struct drm_atomic_state *state) 164 { 165 struct hyperv_drm_device *hv = to_hv(plane->dev); 166 struct drm_plane_state *old_state = drm_atomic_get_old_plane_state(state, plane); 167 struct drm_plane_state *new_state = drm_atomic_get_new_plane_state(state, plane); 168 struct drm_shadow_plane_state *shadow_plane_state = to_drm_shadow_plane_state(new_state); 169 struct drm_rect damage; 170 struct drm_rect dst_clip; 171 struct drm_atomic_helper_damage_iter iter; 172 173 drm_atomic_helper_damage_iter_init(&iter, old_state, new_state); 174 drm_atomic_for_each_plane_damage(&iter, &damage) { 175 dst_clip = new_state->dst; 176 177 if (!drm_rect_intersect(&dst_clip, &damage)) 178 continue; 179 180 hyperv_blit_to_vram_rect(new_state->fb, &shadow_plane_state->data[0], &damage); 181 hyperv_update_dirt(hv->hdev, &damage); 182 } 183 } 184 185 static int hyperv_plane_get_scanout_buffer(struct drm_plane *plane, 186 struct drm_scanout_buffer *sb) 187 { 188 struct hyperv_drm_device *hv = to_hv(plane->dev); 189 struct iosys_map map = IOSYS_MAP_INIT_VADDR_IOMEM(hv->vram); 190 191 if (plane->state && plane->state->fb) { 192 sb->format = plane->state->fb->format; 193 sb->width = plane->state->fb->width; 194 sb->height = plane->state->fb->height; 195 sb->pitch[0] = plane->state->fb->pitches[0]; 196 sb->map[0] = map; 197 return 0; 198 } 199 return -ENODEV; 200 } 201 202 static void hyperv_plane_panic_flush(struct drm_plane *plane) 203 { 204 struct hyperv_drm_device *hv = to_hv(plane->dev); 205 struct drm_rect rect; 206 207 if (!plane->state || !plane->state->fb) 208 return; 209 210 rect.x1 = 0; 211 rect.y1 = 0; 212 rect.x2 = plane->state->fb->width; 213 rect.y2 = plane->state->fb->height; 214 215 hyperv_update_dirt(hv->hdev, &rect); 216 } 217 218 static const struct drm_plane_helper_funcs hyperv_plane_helper_funcs = { 219 DRM_GEM_SHADOW_PLANE_HELPER_FUNCS, 220 .atomic_check = hyperv_plane_atomic_check, 221 .atomic_update = hyperv_plane_atomic_update, 222 .get_scanout_buffer = hyperv_plane_get_scanout_buffer, 223 .panic_flush = hyperv_plane_panic_flush, 224 }; 225 226 static const struct drm_plane_funcs hyperv_plane_funcs = { 227 .update_plane = drm_atomic_helper_update_plane, 228 .disable_plane = drm_atomic_helper_disable_plane, 229 .destroy = drm_plane_cleanup, 230 DRM_GEM_SHADOW_PLANE_FUNCS, 231 }; 232 233 static const struct drm_encoder_funcs hyperv_drm_simple_encoder_funcs_cleanup = { 234 .destroy = drm_encoder_cleanup, 235 }; 236 237 static inline int hyperv_pipe_init(struct hyperv_drm_device *hv) 238 { 239 struct drm_device *dev = &hv->dev; 240 struct drm_encoder *encoder = &hv->encoder; 241 struct drm_plane *plane = &hv->plane; 242 struct drm_crtc *crtc = &hv->crtc; 243 struct drm_connector *connector = &hv->connector; 244 int ret; 245 246 ret = drm_universal_plane_init(dev, plane, 0, 247 &hyperv_plane_funcs, 248 hyperv_formats, ARRAY_SIZE(hyperv_formats), 249 hyperv_modifiers, 250 DRM_PLANE_TYPE_PRIMARY, NULL); 251 if (ret) 252 return ret; 253 drm_plane_helper_add(plane, &hyperv_plane_helper_funcs); 254 drm_plane_enable_fb_damage_clips(plane); 255 256 ret = drm_crtc_init_with_planes(dev, crtc, plane, NULL, 257 &hyperv_crtc_funcs, NULL); 258 if (ret) 259 return ret; 260 drm_crtc_helper_add(crtc, &hyperv_crtc_helper_funcs); 261 262 encoder->possible_crtcs = drm_crtc_mask(crtc); 263 ret = drm_encoder_init(dev, encoder, 264 &hyperv_drm_simple_encoder_funcs_cleanup, 265 DRM_MODE_ENCODER_NONE, NULL); 266 if (ret) 267 return ret; 268 269 ret = hyperv_conn_init(hv); 270 if (ret) { 271 drm_err(dev, "Failed to initialized connector.\n"); 272 return ret; 273 } 274 275 return drm_connector_attach_encoder(connector, encoder); 276 } 277 278 static enum drm_mode_status 279 hyperv_mode_valid(struct drm_device *dev, 280 const struct drm_display_mode *mode) 281 { 282 struct hyperv_drm_device *hv = to_hv(dev); 283 284 if (hyperv_check_size(hv, mode->hdisplay, mode->vdisplay, NULL)) 285 return MODE_BAD; 286 287 return MODE_OK; 288 } 289 290 static const struct drm_mode_config_funcs hyperv_mode_config_funcs = { 291 .fb_create = drm_gem_fb_create_with_dirty, 292 .mode_valid = hyperv_mode_valid, 293 .atomic_check = drm_atomic_helper_check, 294 .atomic_commit = drm_atomic_helper_commit, 295 }; 296 297 int hyperv_mode_config_init(struct hyperv_drm_device *hv) 298 { 299 struct drm_device *dev = &hv->dev; 300 int ret; 301 302 ret = drmm_mode_config_init(dev); 303 if (ret) { 304 drm_err(dev, "Failed to initialized mode setting.\n"); 305 return ret; 306 } 307 308 dev->mode_config.min_width = 0; 309 dev->mode_config.min_height = 0; 310 dev->mode_config.max_width = hv->screen_width_max; 311 dev->mode_config.max_height = hv->screen_height_max; 312 313 dev->mode_config.preferred_depth = hv->screen_depth; 314 dev->mode_config.prefer_shadow = 0; 315 316 dev->mode_config.funcs = &hyperv_mode_config_funcs; 317 318 ret = hyperv_pipe_init(hv); 319 if (ret) { 320 drm_err(dev, "Failed to initialized pipe.\n"); 321 return ret; 322 } 323 324 drm_mode_config_reset(dev); 325 326 return 0; 327 } 328