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
hyperv_blit_to_vram_rect(struct drm_framebuffer * fb,const struct iosys_map * vmap,struct drm_rect * rect)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
hyperv_connector_get_modes(struct drm_connector * connector)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
hyperv_conn_init(struct hyperv_drm_device * hv)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
hyperv_check_size(struct hyperv_drm_device * hv,int w,int h,struct drm_framebuffer * fb)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
hyperv_crtc_helper_atomic_enable(struct drm_crtc * crtc,struct drm_atomic_state * state)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
hyperv_plane_atomic_check(struct drm_plane * plane,struct drm_atomic_state * state)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
hyperv_plane_atomic_update(struct drm_plane * plane,struct drm_atomic_state * state)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
hyperv_plane_get_scanout_buffer(struct drm_plane * plane,struct drm_scanout_buffer * sb)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
hyperv_plane_panic_flush(struct drm_plane * plane)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
hyperv_pipe_init(struct hyperv_drm_device * hv)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
hyperv_mode_valid(struct drm_device * dev,const struct drm_display_mode * mode)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
hyperv_mode_config_init(struct hyperv_drm_device * hv)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