1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28#include "virtgpu_drv.h"
29#include <drm/drm_crtc_helper.h>
30#include <drm/drm_atomic_helper.h>
31
32#define XRES_MIN 32
33#define YRES_MIN 32
34
35#define XRES_DEF 1024
36#define YRES_DEF 768
37
38#define XRES_MAX 8192
39#define YRES_MAX 8192
40
41static const struct drm_crtc_funcs virtio_gpu_crtc_funcs = {
42 .set_config = drm_atomic_helper_set_config,
43 .destroy = drm_crtc_cleanup,
44
45 .page_flip = drm_atomic_helper_page_flip,
46 .reset = drm_atomic_helper_crtc_reset,
47 .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
48 .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
49};
50
51static void virtio_gpu_user_framebuffer_destroy(struct drm_framebuffer *fb)
52{
53 struct virtio_gpu_framebuffer *virtio_gpu_fb
54 = to_virtio_gpu_framebuffer(fb);
55
56 drm_gem_object_unreference_unlocked(virtio_gpu_fb->obj);
57 drm_framebuffer_cleanup(fb);
58 kfree(virtio_gpu_fb);
59}
60
61static int
62virtio_gpu_framebuffer_surface_dirty(struct drm_framebuffer *fb,
63 struct drm_file *file_priv,
64 unsigned flags, unsigned color,
65 struct drm_clip_rect *clips,
66 unsigned num_clips)
67{
68 struct virtio_gpu_framebuffer *virtio_gpu_fb
69 = to_virtio_gpu_framebuffer(fb);
70
71 return virtio_gpu_surface_dirty(virtio_gpu_fb, clips, num_clips);
72}
73
74static const struct drm_framebuffer_funcs virtio_gpu_fb_funcs = {
75 .destroy = virtio_gpu_user_framebuffer_destroy,
76 .dirty = virtio_gpu_framebuffer_surface_dirty,
77};
78
79int
80virtio_gpu_framebuffer_init(struct drm_device *dev,
81 struct virtio_gpu_framebuffer *vgfb,
82 const struct drm_mode_fb_cmd2 *mode_cmd,
83 struct drm_gem_object *obj)
84{
85 int ret;
86 struct virtio_gpu_object *bo;
87 vgfb->obj = obj;
88
89 bo = gem_to_virtio_gpu_obj(obj);
90
91 drm_helper_mode_fill_fb_struct(dev, &vgfb->base, mode_cmd);
92
93 ret = drm_framebuffer_init(dev, &vgfb->base, &virtio_gpu_fb_funcs);
94 if (ret) {
95 vgfb->obj = NULL;
96 return ret;
97 }
98
99 spin_lock_init(&vgfb->dirty_lock);
100 vgfb->x1 = vgfb->y1 = INT_MAX;
101 vgfb->x2 = vgfb->y2 = 0;
102 return 0;
103}
104
105static void virtio_gpu_crtc_mode_set_nofb(struct drm_crtc *crtc)
106{
107 struct drm_device *dev = crtc->dev;
108 struct virtio_gpu_device *vgdev = dev->dev_private;
109 struct virtio_gpu_output *output = drm_crtc_to_virtio_gpu_output(crtc);
110
111 virtio_gpu_cmd_set_scanout(vgdev, output->index, 0,
112 crtc->mode.hdisplay,
113 crtc->mode.vdisplay, 0, 0);
114}
115
116static void virtio_gpu_crtc_enable(struct drm_crtc *crtc)
117{
118}
119
120static void virtio_gpu_crtc_disable(struct drm_crtc *crtc)
121{
122 struct drm_device *dev = crtc->dev;
123 struct virtio_gpu_device *vgdev = dev->dev_private;
124 struct virtio_gpu_output *output = drm_crtc_to_virtio_gpu_output(crtc);
125
126 virtio_gpu_cmd_set_scanout(vgdev, output->index, 0, 0, 0, 0, 0);
127}
128
129static int virtio_gpu_crtc_atomic_check(struct drm_crtc *crtc,
130 struct drm_crtc_state *state)
131{
132 return 0;
133}
134
135static void virtio_gpu_crtc_atomic_flush(struct drm_crtc *crtc,
136 struct drm_crtc_state *old_state)
137{
138 unsigned long flags;
139
140 spin_lock_irqsave(&crtc->dev->event_lock, flags);
141 if (crtc->state->event)
142 drm_crtc_send_vblank_event(crtc, crtc->state->event);
143 crtc->state->event = NULL;
144 spin_unlock_irqrestore(&crtc->dev->event_lock, flags);
145}
146
147static const struct drm_crtc_helper_funcs virtio_gpu_crtc_helper_funcs = {
148 .enable = virtio_gpu_crtc_enable,
149 .disable = virtio_gpu_crtc_disable,
150 .mode_set_nofb = virtio_gpu_crtc_mode_set_nofb,
151 .atomic_check = virtio_gpu_crtc_atomic_check,
152 .atomic_flush = virtio_gpu_crtc_atomic_flush,
153};
154
155static void virtio_gpu_enc_mode_set(struct drm_encoder *encoder,
156 struct drm_display_mode *mode,
157 struct drm_display_mode *adjusted_mode)
158{
159}
160
161static void virtio_gpu_enc_enable(struct drm_encoder *encoder)
162{
163}
164
165static void virtio_gpu_enc_disable(struct drm_encoder *encoder)
166{
167}
168
169static int virtio_gpu_conn_get_modes(struct drm_connector *connector)
170{
171 struct virtio_gpu_output *output =
172 drm_connector_to_virtio_gpu_output(connector);
173 struct drm_display_mode *mode = NULL;
174 int count, width, height;
175
176 width = le32_to_cpu(output->info.r.width);
177 height = le32_to_cpu(output->info.r.height);
178 count = drm_add_modes_noedid(connector, XRES_MAX, YRES_MAX);
179
180 if (width == 0 || height == 0) {
181 width = XRES_DEF;
182 height = YRES_DEF;
183 drm_set_preferred_mode(connector, XRES_DEF, YRES_DEF);
184 } else {
185 DRM_DEBUG("add mode: %dx%d\n", width, height);
186 mode = drm_cvt_mode(connector->dev, width, height, 60,
187 false, false, false);
188 mode->type |= DRM_MODE_TYPE_PREFERRED;
189 drm_mode_probed_add(connector, mode);
190 count++;
191 }
192
193 return count;
194}
195
196static int virtio_gpu_conn_mode_valid(struct drm_connector *connector,
197 struct drm_display_mode *mode)
198{
199 struct virtio_gpu_output *output =
200 drm_connector_to_virtio_gpu_output(connector);
201 int width, height;
202
203 width = le32_to_cpu(output->info.r.width);
204 height = le32_to_cpu(output->info.r.height);
205
206 if (!(mode->type & DRM_MODE_TYPE_PREFERRED))
207 return MODE_OK;
208 if (mode->hdisplay == XRES_DEF && mode->vdisplay == YRES_DEF)
209 return MODE_OK;
210 if (mode->hdisplay <= width && mode->hdisplay >= width - 16 &&
211 mode->vdisplay <= height && mode->vdisplay >= height - 16)
212 return MODE_OK;
213
214 DRM_DEBUG("del mode: %dx%d\n", mode->hdisplay, mode->vdisplay);
215 return MODE_BAD;
216}
217
218static const struct drm_encoder_helper_funcs virtio_gpu_enc_helper_funcs = {
219 .mode_set = virtio_gpu_enc_mode_set,
220 .enable = virtio_gpu_enc_enable,
221 .disable = virtio_gpu_enc_disable,
222};
223
224static const struct drm_connector_helper_funcs virtio_gpu_conn_helper_funcs = {
225 .get_modes = virtio_gpu_conn_get_modes,
226 .mode_valid = virtio_gpu_conn_mode_valid,
227};
228
229static enum drm_connector_status virtio_gpu_conn_detect(
230 struct drm_connector *connector,
231 bool force)
232{
233 struct virtio_gpu_output *output =
234 drm_connector_to_virtio_gpu_output(connector);
235
236 if (output->info.enabled)
237 return connector_status_connected;
238 else
239 return connector_status_disconnected;
240}
241
242static void virtio_gpu_conn_destroy(struct drm_connector *connector)
243{
244 struct virtio_gpu_output *virtio_gpu_output =
245 drm_connector_to_virtio_gpu_output(connector);
246
247 drm_connector_unregister(connector);
248 drm_connector_cleanup(connector);
249 kfree(virtio_gpu_output);
250}
251
252static const struct drm_connector_funcs virtio_gpu_connector_funcs = {
253 .dpms = drm_atomic_helper_connector_dpms,
254 .detect = virtio_gpu_conn_detect,
255 .fill_modes = drm_helper_probe_single_connector_modes,
256 .destroy = virtio_gpu_conn_destroy,
257 .reset = drm_atomic_helper_connector_reset,
258 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
259 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
260};
261
262static const struct drm_encoder_funcs virtio_gpu_enc_funcs = {
263 .destroy = drm_encoder_cleanup,
264};
265
266static int vgdev_output_init(struct virtio_gpu_device *vgdev, int index)
267{
268 struct drm_device *dev = vgdev->ddev;
269 struct virtio_gpu_output *output = vgdev->outputs + index;
270 struct drm_connector *connector = &output->conn;
271 struct drm_encoder *encoder = &output->enc;
272 struct drm_crtc *crtc = &output->crtc;
273 struct drm_plane *primary, *cursor;
274
275 output->index = index;
276 if (index == 0) {
277 output->info.enabled = cpu_to_le32(true);
278 output->info.r.width = cpu_to_le32(XRES_DEF);
279 output->info.r.height = cpu_to_le32(YRES_DEF);
280 }
281
282 primary = virtio_gpu_plane_init(vgdev, DRM_PLANE_TYPE_PRIMARY, index);
283 if (IS_ERR(primary))
284 return PTR_ERR(primary);
285 cursor = virtio_gpu_plane_init(vgdev, DRM_PLANE_TYPE_CURSOR, index);
286 if (IS_ERR(cursor))
287 return PTR_ERR(cursor);
288 drm_crtc_init_with_planes(dev, crtc, primary, cursor,
289 &virtio_gpu_crtc_funcs, NULL);
290 drm_crtc_helper_add(crtc, &virtio_gpu_crtc_helper_funcs);
291 primary->crtc = crtc;
292 cursor->crtc = crtc;
293
294 drm_connector_init(dev, connector, &virtio_gpu_connector_funcs,
295 DRM_MODE_CONNECTOR_VIRTUAL);
296 drm_connector_helper_add(connector, &virtio_gpu_conn_helper_funcs);
297
298 drm_encoder_init(dev, encoder, &virtio_gpu_enc_funcs,
299 DRM_MODE_ENCODER_VIRTUAL, NULL);
300 drm_encoder_helper_add(encoder, &virtio_gpu_enc_helper_funcs);
301 encoder->possible_crtcs = 1 << index;
302
303 drm_mode_connector_attach_encoder(connector, encoder);
304 drm_connector_register(connector);
305 return 0;
306}
307
308static struct drm_framebuffer *
309virtio_gpu_user_framebuffer_create(struct drm_device *dev,
310 struct drm_file *file_priv,
311 const struct drm_mode_fb_cmd2 *mode_cmd)
312{
313 struct drm_gem_object *obj = NULL;
314 struct virtio_gpu_framebuffer *virtio_gpu_fb;
315 int ret;
316
317
318 obj = drm_gem_object_lookup(file_priv, mode_cmd->handles[0]);
319 if (!obj)
320 return ERR_PTR(-EINVAL);
321
322 virtio_gpu_fb = kzalloc(sizeof(*virtio_gpu_fb), GFP_KERNEL);
323 if (virtio_gpu_fb == NULL)
324 return ERR_PTR(-ENOMEM);
325
326 ret = virtio_gpu_framebuffer_init(dev, virtio_gpu_fb, mode_cmd, obj);
327 if (ret) {
328 kfree(virtio_gpu_fb);
329 drm_gem_object_unreference_unlocked(obj);
330 return NULL;
331 }
332
333 return &virtio_gpu_fb->base;
334}
335
336static void vgdev_atomic_commit_tail(struct drm_atomic_state *state)
337{
338 struct drm_device *dev = state->dev;
339
340 drm_atomic_helper_commit_modeset_disables(dev, state);
341 drm_atomic_helper_commit_modeset_enables(dev, state);
342 drm_atomic_helper_commit_planes(dev, state, 0);
343
344 drm_atomic_helper_commit_hw_done(state);
345
346 drm_atomic_helper_wait_for_vblanks(dev, state);
347 drm_atomic_helper_cleanup_planes(dev, state);
348}
349
350static const struct drm_mode_config_helper_funcs virtio_mode_config_helpers = {
351 .atomic_commit_tail = vgdev_atomic_commit_tail,
352};
353
354static const struct drm_mode_config_funcs virtio_gpu_mode_funcs = {
355 .fb_create = virtio_gpu_user_framebuffer_create,
356 .atomic_check = drm_atomic_helper_check,
357 .atomic_commit = drm_atomic_helper_commit,
358};
359
360int virtio_gpu_modeset_init(struct virtio_gpu_device *vgdev)
361{
362 int i;
363
364 drm_mode_config_init(vgdev->ddev);
365 vgdev->ddev->mode_config.funcs = &virtio_gpu_mode_funcs;
366 vgdev->ddev->mode_config.helper_private = &virtio_mode_config_helpers;
367
368
369 vgdev->ddev->mode_config.min_width = XRES_MIN;
370 vgdev->ddev->mode_config.min_height = YRES_MIN;
371 vgdev->ddev->mode_config.max_width = XRES_MAX;
372 vgdev->ddev->mode_config.max_height = YRES_MAX;
373
374 for (i = 0 ; i < vgdev->num_scanouts; ++i)
375 vgdev_output_init(vgdev, i);
376
377 drm_mode_config_reset(vgdev->ddev);
378 return 0;
379}
380
381void virtio_gpu_modeset_fini(struct virtio_gpu_device *vgdev)
382{
383 virtio_gpu_fbdev_fini(vgdev);
384 drm_mode_config_cleanup(vgdev->ddev);
385}
386
