1 /* $NetBSD: virtgpu_display.c,v 1.3 2021/12/18 23:45:45 riastradh Exp $ */
2
3 /*
4 * Copyright (C) 2015 Red Hat, Inc.
5 * All Rights Reserved.
6 *
7 * Authors:
8 * Dave Airlie
9 * Alon Levy
10 *
11 * Permission is hereby granted, free of charge, to any person obtaining a
12 * copy of this software and associated documentation files (the "Software"),
13 * to deal in the Software without restriction, including without limitation
14 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
15 * and/or sell copies of the Software, and to permit persons to whom the
16 * Software is furnished to do so, subject to the following conditions:
17 *
18 * The above copyright notice and this permission notice shall be included in
19 * all copies or substantial portions of the Software.
20 *
21 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
22 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
23 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
24 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
25 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
26 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
27 * OTHER DEALINGS IN THE SOFTWARE.
28 */
29
30 #include <sys/cdefs.h>
31 __KERNEL_RCSID(0, "$NetBSD: virtgpu_display.c,v 1.3 2021/12/18 23:45:45 riastradh Exp $");
32
33 #include <drm/drm_atomic_helper.h>
34 #include <drm/drm_damage_helper.h>
35 #include <drm/drm_fourcc.h>
36 #include <drm/drm_gem_framebuffer_helper.h>
37 #include <drm/drm_probe_helper.h>
38 #include <drm/drm_vblank.h>
39
40 #include "virtgpu_drv.h"
41
42 #define XRES_MIN 32
43 #define YRES_MIN 32
44
45 #define XRES_DEF 1024
46 #define YRES_DEF 768
47
48 #define XRES_MAX 8192
49 #define YRES_MAX 8192
50
51 #define drm_connector_to_virtio_gpu_output(x) \
52 container_of(x, struct virtio_gpu_output, conn)
53
54 static const struct drm_crtc_funcs virtio_gpu_crtc_funcs = {
55 .set_config = drm_atomic_helper_set_config,
56 .destroy = drm_crtc_cleanup,
57
58 .page_flip = drm_atomic_helper_page_flip,
59 .reset = drm_atomic_helper_crtc_reset,
60 .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
61 .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
62 };
63
64 static const struct drm_framebuffer_funcs virtio_gpu_fb_funcs = {
65 .create_handle = drm_gem_fb_create_handle,
66 .destroy = drm_gem_fb_destroy,
67 .dirty = drm_atomic_helper_dirtyfb,
68 };
69
70 static int
virtio_gpu_framebuffer_init(struct drm_device * dev,struct virtio_gpu_framebuffer * vgfb,const struct drm_mode_fb_cmd2 * mode_cmd,struct drm_gem_object * obj)71 virtio_gpu_framebuffer_init(struct drm_device *dev,
72 struct virtio_gpu_framebuffer *vgfb,
73 const struct drm_mode_fb_cmd2 *mode_cmd,
74 struct drm_gem_object *obj)
75 {
76 int ret;
77
78 vgfb->base.obj[0] = obj;
79
80 drm_helper_mode_fill_fb_struct(dev, &vgfb->base, mode_cmd);
81
82 ret = drm_framebuffer_init(dev, &vgfb->base, &virtio_gpu_fb_funcs);
83 if (ret) {
84 vgfb->base.obj[0] = NULL;
85 return ret;
86 }
87 return 0;
88 }
89
virtio_gpu_crtc_mode_set_nofb(struct drm_crtc * crtc)90 static void virtio_gpu_crtc_mode_set_nofb(struct drm_crtc *crtc)
91 {
92 struct drm_device *dev = crtc->dev;
93 struct virtio_gpu_device *vgdev = dev->dev_private;
94 struct virtio_gpu_output *output = drm_crtc_to_virtio_gpu_output(crtc);
95
96 virtio_gpu_cmd_set_scanout(vgdev, output->index, 0,
97 crtc->mode.hdisplay,
98 crtc->mode.vdisplay, 0, 0);
99 }
100
virtio_gpu_crtc_atomic_enable(struct drm_crtc * crtc,struct drm_crtc_state * old_state)101 static void virtio_gpu_crtc_atomic_enable(struct drm_crtc *crtc,
102 struct drm_crtc_state *old_state)
103 {
104 struct virtio_gpu_output *output = drm_crtc_to_virtio_gpu_output(crtc);
105
106 output->enabled = true;
107 }
108
virtio_gpu_crtc_atomic_disable(struct drm_crtc * crtc,struct drm_crtc_state * old_state)109 static void virtio_gpu_crtc_atomic_disable(struct drm_crtc *crtc,
110 struct drm_crtc_state *old_state)
111 {
112 struct drm_device *dev = crtc->dev;
113 struct virtio_gpu_device *vgdev = dev->dev_private;
114 struct virtio_gpu_output *output = drm_crtc_to_virtio_gpu_output(crtc);
115
116 virtio_gpu_cmd_set_scanout(vgdev, output->index, 0, 0, 0, 0, 0);
117 output->enabled = false;
118 }
119
virtio_gpu_crtc_atomic_check(struct drm_crtc * crtc,struct drm_crtc_state * state)120 static int virtio_gpu_crtc_atomic_check(struct drm_crtc *crtc,
121 struct drm_crtc_state *state)
122 {
123 return 0;
124 }
125
virtio_gpu_crtc_atomic_flush(struct drm_crtc * crtc,struct drm_crtc_state * old_state)126 static void virtio_gpu_crtc_atomic_flush(struct drm_crtc *crtc,
127 struct drm_crtc_state *old_state)
128 {
129 unsigned long flags;
130
131 spin_lock_irqsave(&crtc->dev->event_lock, flags);
132 if (crtc->state->event)
133 drm_crtc_send_vblank_event(crtc, crtc->state->event);
134 crtc->state->event = NULL;
135 spin_unlock_irqrestore(&crtc->dev->event_lock, flags);
136 }
137
138 static const struct drm_crtc_helper_funcs virtio_gpu_crtc_helper_funcs = {
139 .mode_set_nofb = virtio_gpu_crtc_mode_set_nofb,
140 .atomic_check = virtio_gpu_crtc_atomic_check,
141 .atomic_flush = virtio_gpu_crtc_atomic_flush,
142 .atomic_enable = virtio_gpu_crtc_atomic_enable,
143 .atomic_disable = virtio_gpu_crtc_atomic_disable,
144 };
145
virtio_gpu_enc_mode_set(struct drm_encoder * encoder,struct drm_display_mode * mode,struct drm_display_mode * adjusted_mode)146 static void virtio_gpu_enc_mode_set(struct drm_encoder *encoder,
147 struct drm_display_mode *mode,
148 struct drm_display_mode *adjusted_mode)
149 {
150 }
151
virtio_gpu_enc_enable(struct drm_encoder * encoder)152 static void virtio_gpu_enc_enable(struct drm_encoder *encoder)
153 {
154 }
155
virtio_gpu_enc_disable(struct drm_encoder * encoder)156 static void virtio_gpu_enc_disable(struct drm_encoder *encoder)
157 {
158 }
159
virtio_gpu_conn_get_modes(struct drm_connector * connector)160 static int virtio_gpu_conn_get_modes(struct drm_connector *connector)
161 {
162 struct virtio_gpu_output *output =
163 drm_connector_to_virtio_gpu_output(connector);
164 struct drm_display_mode *mode = NULL;
165 int count, width, height;
166
167 if (output->edid) {
168 count = drm_add_edid_modes(connector, output->edid);
169 if (count)
170 return count;
171 }
172
173 width = le32_to_cpu(output->info.r.width);
174 height = le32_to_cpu(output->info.r.height);
175 count = drm_add_modes_noedid(connector, XRES_MAX, YRES_MAX);
176
177 if (width == 0 || height == 0) {
178 width = XRES_DEF;
179 height = YRES_DEF;
180 drm_set_preferred_mode(connector, XRES_DEF, YRES_DEF);
181 } else {
182 DRM_DEBUG("add mode: %dx%d\n", width, height);
183 mode = drm_cvt_mode(connector->dev, width, height, 60,
184 false, false, false);
185 mode->type |= DRM_MODE_TYPE_PREFERRED;
186 drm_mode_probed_add(connector, mode);
187 count++;
188 }
189
190 return count;
191 }
192
virtio_gpu_conn_mode_valid(struct drm_connector * connector,struct drm_display_mode * mode)193 static enum drm_mode_status virtio_gpu_conn_mode_valid(struct drm_connector *connector,
194 struct drm_display_mode *mode)
195 {
196 struct virtio_gpu_output *output =
197 drm_connector_to_virtio_gpu_output(connector);
198 int width, height;
199
200 width = le32_to_cpu(output->info.r.width);
201 height = le32_to_cpu(output->info.r.height);
202
203 if (!(mode->type & DRM_MODE_TYPE_PREFERRED))
204 return MODE_OK;
205 if (mode->hdisplay == XRES_DEF && mode->vdisplay == YRES_DEF)
206 return MODE_OK;
207 if (mode->hdisplay <= width && mode->hdisplay >= width - 16 &&
208 mode->vdisplay <= height && mode->vdisplay >= height - 16)
209 return MODE_OK;
210
211 DRM_DEBUG("del mode: %dx%d\n", mode->hdisplay, mode->vdisplay);
212 return MODE_BAD;
213 }
214
215 static const struct drm_encoder_helper_funcs virtio_gpu_enc_helper_funcs = {
216 .mode_set = virtio_gpu_enc_mode_set,
217 .enable = virtio_gpu_enc_enable,
218 .disable = virtio_gpu_enc_disable,
219 };
220
221 static const struct drm_connector_helper_funcs virtio_gpu_conn_helper_funcs = {
222 .get_modes = virtio_gpu_conn_get_modes,
223 .mode_valid = virtio_gpu_conn_mode_valid,
224 };
225
virtio_gpu_conn_detect(struct drm_connector * connector,bool force)226 static enum drm_connector_status virtio_gpu_conn_detect(
227 struct drm_connector *connector,
228 bool force)
229 {
230 struct virtio_gpu_output *output =
231 drm_connector_to_virtio_gpu_output(connector);
232
233 if (output->info.enabled)
234 return connector_status_connected;
235 else
236 return connector_status_disconnected;
237 }
238
virtio_gpu_conn_destroy(struct drm_connector * connector)239 static void virtio_gpu_conn_destroy(struct drm_connector *connector)
240 {
241 drm_connector_unregister(connector);
242 drm_connector_cleanup(connector);
243 }
244
245 static const struct drm_connector_funcs virtio_gpu_connector_funcs = {
246 .detect = virtio_gpu_conn_detect,
247 .fill_modes = drm_helper_probe_single_connector_modes,
248 .destroy = virtio_gpu_conn_destroy,
249 .reset = drm_atomic_helper_connector_reset,
250 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
251 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
252 };
253
254 static const struct drm_encoder_funcs virtio_gpu_enc_funcs = {
255 .destroy = drm_encoder_cleanup,
256 };
257
vgdev_output_init(struct virtio_gpu_device * vgdev,int index)258 static int vgdev_output_init(struct virtio_gpu_device *vgdev, int index)
259 {
260 struct drm_device *dev = vgdev->ddev;
261 struct virtio_gpu_output *output = vgdev->outputs + index;
262 struct drm_connector *connector = &output->conn;
263 struct drm_encoder *encoder = &output->enc;
264 struct drm_crtc *crtc = &output->crtc;
265 struct drm_plane *primary, *cursor;
266
267 output->index = index;
268 if (index == 0) {
269 output->info.enabled = cpu_to_le32(true);
270 output->info.r.width = cpu_to_le32(XRES_DEF);
271 output->info.r.height = cpu_to_le32(YRES_DEF);
272 }
273
274 primary = virtio_gpu_plane_init(vgdev, DRM_PLANE_TYPE_PRIMARY, index);
275 if (IS_ERR(primary))
276 return PTR_ERR(primary);
277 cursor = virtio_gpu_plane_init(vgdev, DRM_PLANE_TYPE_CURSOR, index);
278 if (IS_ERR(cursor))
279 return PTR_ERR(cursor);
280 drm_crtc_init_with_planes(dev, crtc, primary, cursor,
281 &virtio_gpu_crtc_funcs, NULL);
282 drm_crtc_helper_add(crtc, &virtio_gpu_crtc_helper_funcs);
283
284 drm_connector_init(dev, connector, &virtio_gpu_connector_funcs,
285 DRM_MODE_CONNECTOR_VIRTUAL);
286 drm_connector_helper_add(connector, &virtio_gpu_conn_helper_funcs);
287 if (vgdev->has_edid)
288 drm_connector_attach_edid_property(connector);
289
290 drm_encoder_init(dev, encoder, &virtio_gpu_enc_funcs,
291 DRM_MODE_ENCODER_VIRTUAL, NULL);
292 drm_encoder_helper_add(encoder, &virtio_gpu_enc_helper_funcs);
293 encoder->possible_crtcs = 1 << index;
294
295 drm_connector_attach_encoder(connector, encoder);
296 drm_connector_register(connector);
297 return 0;
298 }
299
300 static struct drm_framebuffer *
virtio_gpu_user_framebuffer_create(struct drm_device * dev,struct drm_file * file_priv,const struct drm_mode_fb_cmd2 * mode_cmd)301 virtio_gpu_user_framebuffer_create(struct drm_device *dev,
302 struct drm_file *file_priv,
303 const struct drm_mode_fb_cmd2 *mode_cmd)
304 {
305 struct drm_gem_object *obj = NULL;
306 struct virtio_gpu_framebuffer *virtio_gpu_fb;
307 int ret;
308
309 if (mode_cmd->pixel_format != DRM_FORMAT_HOST_XRGB8888 &&
310 mode_cmd->pixel_format != DRM_FORMAT_HOST_ARGB8888)
311 return ERR_PTR(-ENOENT);
312
313 /* lookup object associated with res handle */
314 obj = drm_gem_object_lookup(file_priv, mode_cmd->handles[0]);
315 if (!obj)
316 return ERR_PTR(-EINVAL);
317
318 virtio_gpu_fb = kzalloc(sizeof(*virtio_gpu_fb), GFP_KERNEL);
319 if (virtio_gpu_fb == NULL)
320 return ERR_PTR(-ENOMEM);
321
322 ret = virtio_gpu_framebuffer_init(dev, virtio_gpu_fb, mode_cmd, obj);
323 if (ret) {
324 kfree(virtio_gpu_fb);
325 drm_gem_object_put_unlocked(obj);
326 return NULL;
327 }
328
329 return &virtio_gpu_fb->base;
330 }
331
vgdev_atomic_commit_tail(struct drm_atomic_state * state)332 static void vgdev_atomic_commit_tail(struct drm_atomic_state *state)
333 {
334 struct drm_device *dev = state->dev;
335
336 drm_atomic_helper_commit_modeset_disables(dev, state);
337 drm_atomic_helper_commit_modeset_enables(dev, state);
338 drm_atomic_helper_commit_planes(dev, state, 0);
339
340 drm_atomic_helper_commit_hw_done(state);
341
342 drm_atomic_helper_wait_for_vblanks(dev, state);
343 drm_atomic_helper_cleanup_planes(dev, state);
344 }
345
346 static const struct drm_mode_config_helper_funcs virtio_mode_config_helpers = {
347 .atomic_commit_tail = vgdev_atomic_commit_tail,
348 };
349
350 static const struct drm_mode_config_funcs virtio_gpu_mode_funcs = {
351 .fb_create = virtio_gpu_user_framebuffer_create,
352 .atomic_check = drm_atomic_helper_check,
353 .atomic_commit = drm_atomic_helper_commit,
354 };
355
virtio_gpu_modeset_init(struct virtio_gpu_device * vgdev)356 void virtio_gpu_modeset_init(struct virtio_gpu_device *vgdev)
357 {
358 int i;
359
360 drm_mode_config_init(vgdev->ddev);
361 vgdev->ddev->mode_config.quirk_addfb_prefer_host_byte_order = true;
362 vgdev->ddev->mode_config.funcs = &virtio_gpu_mode_funcs;
363 vgdev->ddev->mode_config.helper_private = &virtio_mode_config_helpers;
364
365 /* modes will be validated against the framebuffer size */
366 vgdev->ddev->mode_config.min_width = XRES_MIN;
367 vgdev->ddev->mode_config.min_height = YRES_MIN;
368 vgdev->ddev->mode_config.max_width = XRES_MAX;
369 vgdev->ddev->mode_config.max_height = YRES_MAX;
370
371 for (i = 0 ; i < vgdev->num_scanouts; ++i)
372 vgdev_output_init(vgdev, i);
373
374 drm_mode_config_reset(vgdev->ddev);
375 }
376
virtio_gpu_modeset_fini(struct virtio_gpu_device * vgdev)377 void virtio_gpu_modeset_fini(struct virtio_gpu_device *vgdev)
378 {
379 int i;
380
381 for (i = 0 ; i < vgdev->num_scanouts; ++i)
382 kfree(vgdev->outputs[i].edid);
383 drm_atomic_helper_shutdown(vgdev->ddev);
384 drm_mode_config_cleanup(vgdev->ddev);
385 }
386