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