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#include <linux/crc32.h>
27#include <linux/delay.h>
28#include <linux/dma-buf-map.h>
29
30#include <drm/drm_drv.h>
31#include <drm/drm_atomic.h>
32#include <drm/drm_atomic_helper.h>
33#include <drm/drm_gem_framebuffer_helper.h>
34#include <drm/drm_plane_helper.h>
35#include <drm/drm_probe_helper.h>
36#include <drm/drm_simple_kms_helper.h>
37
38#include "qxl_drv.h"
39#include "qxl_object.h"
40
41static bool qxl_head_enabled(struct qxl_head *head)
42{
43 return head->width && head->height;
44}
45
46static int qxl_alloc_client_monitors_config(struct qxl_device *qdev,
47 unsigned int count)
48{
49 if (qdev->client_monitors_config &&
50 count > qdev->client_monitors_config->count) {
51 kfree(qdev->client_monitors_config);
52 qdev->client_monitors_config = NULL;
53 }
54 if (!qdev->client_monitors_config) {
55 qdev->client_monitors_config = kzalloc(
56 struct_size(qdev->client_monitors_config,
57 heads, count), GFP_KERNEL);
58 if (!qdev->client_monitors_config)
59 return -ENOMEM;
60 }
61 qdev->client_monitors_config->count = count;
62 return 0;
63}
64
65enum {
66 MONITORS_CONFIG_MODIFIED,
67 MONITORS_CONFIG_UNCHANGED,
68 MONITORS_CONFIG_BAD_CRC,
69 MONITORS_CONFIG_ERROR,
70};
71
72static int qxl_display_copy_rom_client_monitors_config(struct qxl_device *qdev)
73{
74 int i;
75 int num_monitors;
76 uint32_t crc;
77 int status = MONITORS_CONFIG_UNCHANGED;
78
79 num_monitors = qdev->rom->client_monitors_config.count;
80 crc = crc32(0, (const uint8_t *)&qdev->rom->client_monitors_config,
81 sizeof(qdev->rom->client_monitors_config));
82 if (crc != qdev->rom->client_monitors_config_crc)
83 return MONITORS_CONFIG_BAD_CRC;
84 if (!num_monitors) {
85 DRM_DEBUG_KMS("no client monitors configured\n");
86 return status;
87 }
88 if (num_monitors > qxl_num_crtc) {
89 DRM_DEBUG_KMS("client monitors list will be truncated: %d < %d\n",
90 qxl_num_crtc, num_monitors);
91 num_monitors = qxl_num_crtc;
92 } else {
93 num_monitors = qdev->rom->client_monitors_config.count;
94 }
95 if (qdev->client_monitors_config
96 && (num_monitors != qdev->client_monitors_config->count)) {
97 status = MONITORS_CONFIG_MODIFIED;
98 }
99 if (qxl_alloc_client_monitors_config(qdev, num_monitors)) {
100 status = MONITORS_CONFIG_ERROR;
101 return status;
102 }
103
104 qdev->client_monitors_config->max_allowed = qxl_num_crtc;
105 for (i = 0 ; i < qdev->client_monitors_config->count ; ++i) {
106 struct qxl_urect *c_rect =
107 &qdev->rom->client_monitors_config.heads[i];
108 struct qxl_head *client_head =
109 &qdev->client_monitors_config->heads[i];
110 if (client_head->x != c_rect->left) {
111 client_head->x = c_rect->left;
112 status = MONITORS_CONFIG_MODIFIED;
113 }
114 if (client_head->y != c_rect->top) {
115 client_head->y = c_rect->top;
116 status = MONITORS_CONFIG_MODIFIED;
117 }
118 if (client_head->width != c_rect->right - c_rect->left) {
119 client_head->width = c_rect->right - c_rect->left;
120 status = MONITORS_CONFIG_MODIFIED;
121 }
122 if (client_head->height != c_rect->bottom - c_rect->top) {
123 client_head->height = c_rect->bottom - c_rect->top;
124 status = MONITORS_CONFIG_MODIFIED;
125 }
126 if (client_head->surface_id != 0) {
127 client_head->surface_id = 0;
128 status = MONITORS_CONFIG_MODIFIED;
129 }
130 if (client_head->id != i) {
131 client_head->id = i;
132 status = MONITORS_CONFIG_MODIFIED;
133 }
134 if (client_head->flags != 0) {
135 client_head->flags = 0;
136 status = MONITORS_CONFIG_MODIFIED;
137 }
138 DRM_DEBUG_KMS("read %dx%d+%d+%d\n", client_head->width, client_head->height,
139 client_head->x, client_head->y);
140 }
141
142 return status;
143}
144
145static void qxl_update_offset_props(struct qxl_device *qdev)
146{
147 struct drm_device *dev = &qdev->ddev;
148 struct drm_connector *connector;
149 struct qxl_output *output;
150 struct qxl_head *head;
151
152 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
153 output = drm_connector_to_qxl_output(connector);
154
155 head = &qdev->client_monitors_config->heads[output->index];
156
157 drm_object_property_set_value(&connector->base,
158 dev->mode_config.suggested_x_property, head->x);
159 drm_object_property_set_value(&connector->base,
160 dev->mode_config.suggested_y_property, head->y);
161 }
162}
163
164void qxl_display_read_client_monitors_config(struct qxl_device *qdev)
165{
166 struct drm_device *dev = &qdev->ddev;
167 struct drm_modeset_acquire_ctx ctx;
168 int status, retries, ret;
169
170 for (retries = 0; retries < 10; retries++) {
171 status = qxl_display_copy_rom_client_monitors_config(qdev);
172 if (status != MONITORS_CONFIG_BAD_CRC)
173 break;
174 udelay(5);
175 }
176 if (status == MONITORS_CONFIG_ERROR) {
177 DRM_DEBUG_KMS("ignoring client monitors config: error");
178 return;
179 }
180 if (status == MONITORS_CONFIG_BAD_CRC) {
181 DRM_DEBUG_KMS("ignoring client monitors config: bad crc");
182 return;
183 }
184 if (status == MONITORS_CONFIG_UNCHANGED) {
185 DRM_DEBUG_KMS("ignoring client monitors config: unchanged");
186 return;
187 }
188
189 DRM_MODESET_LOCK_ALL_BEGIN(dev, ctx, DRM_MODESET_ACQUIRE_INTERRUPTIBLE, ret);
190 qxl_update_offset_props(qdev);
191 DRM_MODESET_LOCK_ALL_END(dev, ctx, ret);
192 if (!drm_helper_hpd_irq_event(dev)) {
193
194
195 drm_kms_helper_hotplug_event(dev);
196 }
197}
198
199static int qxl_check_mode(struct qxl_device *qdev,
200 unsigned int width,
201 unsigned int height)
202{
203 unsigned int stride;
204 unsigned int size;
205
206 if (check_mul_overflow(width, 4u, &stride))
207 return -EINVAL;
208 if (check_mul_overflow(stride, height, &size))
209 return -EINVAL;
210 if (size > qdev->vram_size)
211 return -ENOMEM;
212 return 0;
213}
214
215static int qxl_check_framebuffer(struct qxl_device *qdev,
216 struct qxl_bo *bo)
217{
218 return qxl_check_mode(qdev, bo->surf.width, bo->surf.height);
219}
220
221static int qxl_add_mode(struct drm_connector *connector,
222 unsigned int width,
223 unsigned int height,
224 bool preferred)
225{
226 struct drm_device *dev = connector->dev;
227 struct qxl_device *qdev = to_qxl(dev);
228 struct drm_display_mode *mode = NULL;
229 int rc;
230
231 rc = qxl_check_mode(qdev, width, height);
232 if (rc != 0)
233 return 0;
234
235 mode = drm_cvt_mode(dev, width, height, 60, false, false, false);
236 if (preferred)
237 mode->type |= DRM_MODE_TYPE_PREFERRED;
238 mode->hdisplay = width;
239 mode->vdisplay = height;
240 drm_mode_set_name(mode);
241 drm_mode_probed_add(connector, mode);
242 return 1;
243}
244
245static int qxl_add_monitors_config_modes(struct drm_connector *connector)
246{
247 struct drm_device *dev = connector->dev;
248 struct qxl_device *qdev = to_qxl(dev);
249 struct qxl_output *output = drm_connector_to_qxl_output(connector);
250 int h = output->index;
251 struct qxl_head *head;
252
253 if (!qdev->monitors_config)
254 return 0;
255 if (h >= qxl_num_crtc)
256 return 0;
257 if (!qdev->client_monitors_config)
258 return 0;
259 if (h >= qdev->client_monitors_config->count)
260 return 0;
261
262 head = &qdev->client_monitors_config->heads[h];
263 DRM_DEBUG_KMS("head %d is %dx%d\n", h, head->width, head->height);
264
265 return qxl_add_mode(connector, head->width, head->height, true);
266}
267
268static struct mode_size {
269 int w;
270 int h;
271} extra_modes[] = {
272 { 720, 480},
273 {1152, 768},
274 {1280, 854},
275};
276
277static int qxl_add_extra_modes(struct drm_connector *connector)
278{
279 int i, ret = 0;
280
281 for (i = 0; i < ARRAY_SIZE(extra_modes); i++)
282 ret += qxl_add_mode(connector,
283 extra_modes[i].w,
284 extra_modes[i].h,
285 false);
286 return ret;
287}
288
289static void qxl_send_monitors_config(struct qxl_device *qdev)
290{
291 int i;
292
293 BUG_ON(!qdev->ram_header->monitors_config);
294
295 if (qdev->monitors_config->count == 0)
296 return;
297
298 for (i = 0 ; i < qdev->monitors_config->count ; ++i) {
299 struct qxl_head *head = &qdev->monitors_config->heads[i];
300
301 if (head->y > 8192 || head->x > 8192 ||
302 head->width > 8192 || head->height > 8192) {
303 DRM_ERROR("head %d wrong: %dx%d+%d+%d\n",
304 i, head->width, head->height,
305 head->x, head->y);
306 return;
307 }
308 }
309 qxl_io_monitors_config(qdev);
310}
311
312static void qxl_crtc_update_monitors_config(struct drm_crtc *crtc,
313 const char *reason)
314{
315 struct drm_device *dev = crtc->dev;
316 struct qxl_device *qdev = to_qxl(dev);
317 struct qxl_crtc *qcrtc = to_qxl_crtc(crtc);
318 struct qxl_head head;
319 int oldcount, i = qcrtc->index;
320
321 if (!qdev->primary_bo) {
322 DRM_DEBUG_KMS("no primary surface, skip (%s)\n", reason);
323 return;
324 }
325
326 if (!qdev->monitors_config || qxl_num_crtc <= i)
327 return;
328
329 head.id = i;
330 head.flags = 0;
331 head.surface_id = 0;
332 oldcount = qdev->monitors_config->count;
333 if (crtc->state->active) {
334 struct drm_display_mode *mode = &crtc->mode;
335
336 head.width = mode->hdisplay;
337 head.height = mode->vdisplay;
338 head.x = crtc->x;
339 head.y = crtc->y;
340 if (qdev->monitors_config->count < i + 1)
341 qdev->monitors_config->count = i + 1;
342 if (qdev->primary_bo == qdev->dumb_shadow_bo)
343 head.x += qdev->dumb_heads[i].x;
344 } else if (i > 0) {
345 head.width = 0;
346 head.height = 0;
347 head.x = 0;
348 head.y = 0;
349 if (qdev->monitors_config->count == i + 1)
350 qdev->monitors_config->count = i;
351 } else {
352 DRM_DEBUG_KMS("inactive head 0, skip (%s)\n", reason);
353 return;
354 }
355
356 if (head.width == qdev->monitors_config->heads[i].width &&
357 head.height == qdev->monitors_config->heads[i].height &&
358 head.x == qdev->monitors_config->heads[i].x &&
359 head.y == qdev->monitors_config->heads[i].y &&
360 oldcount == qdev->monitors_config->count)
361 return;
362
363 DRM_DEBUG_KMS("head %d, %dx%d, at +%d+%d, %s (%s)\n",
364 i, head.width, head.height, head.x, head.y,
365 crtc->state->active ? "on" : "off", reason);
366 if (oldcount != qdev->monitors_config->count)
367 DRM_DEBUG_KMS("active heads %d -> %d (%d total)\n",
368 oldcount, qdev->monitors_config->count,
369 qxl_num_crtc);
370
371 qdev->monitors_config->heads[i] = head;
372 qdev->monitors_config->max_allowed = qxl_num_crtc;
373 qxl_send_monitors_config(qdev);
374}
375
376static void qxl_crtc_atomic_flush(struct drm_crtc *crtc,
377 struct drm_atomic_state *state)
378{
379 qxl_crtc_update_monitors_config(crtc, "flush");
380}
381
382static void qxl_crtc_destroy(struct drm_crtc *crtc)
383{
384 struct qxl_crtc *qxl_crtc = to_qxl_crtc(crtc);
385
386 qxl_bo_unref(&qxl_crtc->cursor_bo);
387 drm_crtc_cleanup(crtc);
388 kfree(qxl_crtc);
389}
390
391static const struct drm_crtc_funcs qxl_crtc_funcs = {
392 .set_config = drm_atomic_helper_set_config,
393 .destroy = qxl_crtc_destroy,
394 .page_flip = drm_atomic_helper_page_flip,
395 .reset = drm_atomic_helper_crtc_reset,
396 .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
397 .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
398};
399
400static int qxl_framebuffer_surface_dirty(struct drm_framebuffer *fb,
401 struct drm_file *file_priv,
402 unsigned int flags, unsigned int color,
403 struct drm_clip_rect *clips,
404 unsigned int num_clips)
405{
406
407 struct qxl_device *qdev = to_qxl(fb->dev);
408 struct drm_clip_rect norect;
409 struct qxl_bo *qobj;
410 struct drm_modeset_acquire_ctx ctx;
411 bool is_primary;
412 int inc = 1, ret;
413
414 DRM_MODESET_LOCK_ALL_BEGIN(fb->dev, ctx, DRM_MODESET_ACQUIRE_INTERRUPTIBLE, ret);
415
416 qobj = gem_to_qxl_bo(fb->obj[0]);
417
418 is_primary = qobj->shadow ? qobj->shadow->is_primary : qobj->is_primary;
419 if (!is_primary)
420 goto out_lock_end;
421
422 if (!num_clips) {
423 num_clips = 1;
424 clips = &norect;
425 norect.x1 = norect.y1 = 0;
426 norect.x2 = fb->width;
427 norect.y2 = fb->height;
428 } else if (flags & DRM_MODE_FB_DIRTY_ANNOTATE_COPY) {
429 num_clips /= 2;
430 inc = 2;
431 }
432
433 qxl_draw_dirty_fb(qdev, fb, qobj, flags, color,
434 clips, num_clips, inc, 0);
435
436out_lock_end:
437 DRM_MODESET_LOCK_ALL_END(fb->dev, ctx, ret);
438
439 return 0;
440}
441
442static const struct drm_framebuffer_funcs qxl_fb_funcs = {
443 .destroy = drm_gem_fb_destroy,
444 .dirty = qxl_framebuffer_surface_dirty,
445 .create_handle = drm_gem_fb_create_handle,
446};
447
448static void qxl_crtc_atomic_enable(struct drm_crtc *crtc,
449 struct drm_atomic_state *state)
450{
451 qxl_crtc_update_monitors_config(crtc, "enable");
452}
453
454static void qxl_crtc_atomic_disable(struct drm_crtc *crtc,
455 struct drm_atomic_state *state)
456{
457 qxl_crtc_update_monitors_config(crtc, "disable");
458}
459
460static const struct drm_crtc_helper_funcs qxl_crtc_helper_funcs = {
461 .atomic_flush = qxl_crtc_atomic_flush,
462 .atomic_enable = qxl_crtc_atomic_enable,
463 .atomic_disable = qxl_crtc_atomic_disable,
464};
465
466static int qxl_primary_atomic_check(struct drm_plane *plane,
467 struct drm_atomic_state *state)
468{
469 struct drm_plane_state *new_plane_state = drm_atomic_get_new_plane_state(state,
470 plane);
471 struct qxl_device *qdev = to_qxl(plane->dev);
472 struct qxl_bo *bo;
473
474 if (!new_plane_state->crtc || !new_plane_state->fb)
475 return 0;
476
477 bo = gem_to_qxl_bo(new_plane_state->fb->obj[0]);
478
479 return qxl_check_framebuffer(qdev, bo);
480}
481
482static int qxl_primary_apply_cursor(struct qxl_device *qdev,
483 struct drm_plane_state *plane_state)
484{
485 struct drm_framebuffer *fb = plane_state->fb;
486 struct qxl_crtc *qcrtc = to_qxl_crtc(plane_state->crtc);
487 struct qxl_cursor_cmd *cmd;
488 struct qxl_release *release;
489 int ret = 0;
490
491 if (!qcrtc->cursor_bo)
492 return 0;
493
494 ret = qxl_alloc_release_reserved(qdev, sizeof(*cmd),
495 QXL_RELEASE_CURSOR_CMD,
496 &release, NULL);
497 if (ret)
498 return ret;
499
500 ret = qxl_release_list_add(release, qcrtc->cursor_bo);
501 if (ret)
502 goto out_free_release;
503
504 ret = qxl_release_reserve_list(release, false);
505 if (ret)
506 goto out_free_release;
507
508 cmd = (struct qxl_cursor_cmd *)qxl_release_map(qdev, release);
509 cmd->type = QXL_CURSOR_SET;
510 cmd->u.set.position.x = plane_state->crtc_x + fb->hot_x;
511 cmd->u.set.position.y = plane_state->crtc_y + fb->hot_y;
512
513 cmd->u.set.shape = qxl_bo_physical_address(qdev, qcrtc->cursor_bo, 0);
514
515 cmd->u.set.visible = 1;
516 qxl_release_unmap(qdev, release, &cmd->release_info);
517
518 qxl_release_fence_buffer_objects(release);
519 qxl_push_cursor_ring_release(qdev, release, QXL_CMD_CURSOR, false);
520
521 return ret;
522
523out_free_release:
524 qxl_release_free(qdev, release);
525 return ret;
526}
527
528static int qxl_primary_move_cursor(struct qxl_device *qdev,
529 struct drm_plane_state *plane_state)
530{
531 struct drm_framebuffer *fb = plane_state->fb;
532 struct qxl_crtc *qcrtc = to_qxl_crtc(plane_state->crtc);
533 struct qxl_cursor_cmd *cmd;
534 struct qxl_release *release;
535 int ret = 0;
536
537 if (!qcrtc->cursor_bo)
538 return 0;
539
540 ret = qxl_alloc_release_reserved(qdev, sizeof(*cmd),
541 QXL_RELEASE_CURSOR_CMD,
542 &release, NULL);
543 if (ret)
544 return ret;
545
546 ret = qxl_release_reserve_list(release, true);
547 if (ret) {
548 qxl_release_free(qdev, release);
549 return ret;
550 }
551
552 cmd = (struct qxl_cursor_cmd *)qxl_release_map(qdev, release);
553 cmd->type = QXL_CURSOR_MOVE;
554 cmd->u.position.x = plane_state->crtc_x + fb->hot_x;
555 cmd->u.position.y = plane_state->crtc_y + fb->hot_y;
556 qxl_release_unmap(qdev, release, &cmd->release_info);
557
558 qxl_release_fence_buffer_objects(release);
559 qxl_push_cursor_ring_release(qdev, release, QXL_CMD_CURSOR, false);
560 return ret;
561}
562
563static struct qxl_bo *qxl_create_cursor(struct qxl_device *qdev,
564 struct qxl_bo *user_bo,
565 int hot_x, int hot_y)
566{
567 static const u32 size = 64 * 64 * 4;
568 struct qxl_bo *cursor_bo;
569 struct dma_buf_map cursor_map;
570 struct dma_buf_map user_map;
571 struct qxl_cursor cursor;
572 int ret;
573
574 if (!user_bo)
575 return NULL;
576
577 ret = qxl_bo_create(qdev, sizeof(struct qxl_cursor) + size,
578 false, true, QXL_GEM_DOMAIN_VRAM, 1,
579 NULL, &cursor_bo);
580 if (ret)
581 goto err;
582
583 ret = qxl_bo_vmap(cursor_bo, &cursor_map);
584 if (ret)
585 goto err_unref;
586
587 ret = qxl_bo_vmap(user_bo, &user_map);
588 if (ret)
589 goto err_unmap;
590
591 cursor.header.unique = 0;
592 cursor.header.type = SPICE_CURSOR_TYPE_ALPHA;
593 cursor.header.width = 64;
594 cursor.header.height = 64;
595 cursor.header.hot_spot_x = hot_x;
596 cursor.header.hot_spot_y = hot_y;
597 cursor.data_size = size;
598 cursor.chunk.next_chunk = 0;
599 cursor.chunk.prev_chunk = 0;
600 cursor.chunk.data_size = size;
601 if (cursor_map.is_iomem) {
602 memcpy_toio(cursor_map.vaddr_iomem,
603 &cursor, sizeof(cursor));
604 memcpy_toio(cursor_map.vaddr_iomem + sizeof(cursor),
605 user_map.vaddr, size);
606 } else {
607 memcpy(cursor_map.vaddr,
608 &cursor, sizeof(cursor));
609 memcpy(cursor_map.vaddr + sizeof(cursor),
610 user_map.vaddr, size);
611 }
612
613 qxl_bo_vunmap(user_bo);
614 qxl_bo_vunmap(cursor_bo);
615 return cursor_bo;
616
617err_unmap:
618 qxl_bo_vunmap(cursor_bo);
619err_unref:
620 qxl_bo_unpin(cursor_bo);
621 qxl_bo_unref(&cursor_bo);
622err:
623 return NULL;
624}
625
626static void qxl_free_cursor(struct qxl_bo *cursor_bo)
627{
628 if (!cursor_bo)
629 return;
630
631 qxl_bo_unpin(cursor_bo);
632 qxl_bo_unref(&cursor_bo);
633}
634
635static void qxl_primary_atomic_update(struct drm_plane *plane,
636 struct drm_atomic_state *state)
637{
638 struct drm_plane_state *new_state = drm_atomic_get_new_plane_state(state,
639 plane);
640 struct qxl_device *qdev = to_qxl(plane->dev);
641 struct qxl_bo *bo = gem_to_qxl_bo(new_state->fb->obj[0]);
642 struct qxl_bo *primary;
643 struct drm_clip_rect norect = {
644 .x1 = 0,
645 .y1 = 0,
646 .x2 = new_state->fb->width,
647 .y2 = new_state->fb->height
648 };
649 uint32_t dumb_shadow_offset = 0;
650
651 primary = bo->shadow ? bo->shadow : bo;
652
653 if (!primary->is_primary) {
654 if (qdev->primary_bo)
655 qxl_io_destroy_primary(qdev);
656 qxl_io_create_primary(qdev, primary);
657 qxl_primary_apply_cursor(qdev, plane->state);
658 }
659
660 if (bo->is_dumb)
661 dumb_shadow_offset =
662 qdev->dumb_heads[new_state->crtc->index].x;
663
664 qxl_draw_dirty_fb(qdev, new_state->fb, bo, 0, 0, &norect, 1, 1,
665 dumb_shadow_offset);
666}
667
668static void qxl_primary_atomic_disable(struct drm_plane *plane,
669 struct drm_atomic_state *state)
670{
671 struct drm_plane_state *old_state = drm_atomic_get_old_plane_state(state,
672 plane);
673 struct qxl_device *qdev = to_qxl(plane->dev);
674
675 if (old_state->fb) {
676 struct qxl_bo *bo = gem_to_qxl_bo(old_state->fb->obj[0]);
677
678 if (bo->shadow)
679 bo = bo->shadow;
680 if (bo->is_primary)
681 qxl_io_destroy_primary(qdev);
682 }
683}
684
685static void qxl_cursor_atomic_update(struct drm_plane *plane,
686 struct drm_atomic_state *state)
687{
688 struct drm_plane_state *old_state = drm_atomic_get_old_plane_state(state,
689 plane);
690 struct drm_plane_state *new_state = drm_atomic_get_new_plane_state(state,
691 plane);
692 struct qxl_device *qdev = to_qxl(plane->dev);
693 struct drm_framebuffer *fb = new_state->fb;
694
695 if (fb != old_state->fb) {
696 qxl_primary_apply_cursor(qdev, new_state);
697 } else {
698 qxl_primary_move_cursor(qdev, new_state);
699 }
700}
701
702static void qxl_cursor_atomic_disable(struct drm_plane *plane,
703 struct drm_atomic_state *state)
704{
705 struct drm_plane_state *old_state = drm_atomic_get_old_plane_state(state,
706 plane);
707 struct qxl_device *qdev = to_qxl(plane->dev);
708 struct qxl_crtc *qcrtc;
709 struct qxl_release *release;
710 struct qxl_cursor_cmd *cmd;
711 int ret;
712
713 ret = qxl_alloc_release_reserved(qdev, sizeof(*cmd),
714 QXL_RELEASE_CURSOR_CMD,
715 &release, NULL);
716 if (ret)
717 return;
718
719 ret = qxl_release_reserve_list(release, true);
720 if (ret) {
721 qxl_release_free(qdev, release);
722 return;
723 }
724
725 cmd = (struct qxl_cursor_cmd *)qxl_release_map(qdev, release);
726 cmd->type = QXL_CURSOR_HIDE;
727 qxl_release_unmap(qdev, release, &cmd->release_info);
728
729 qxl_release_fence_buffer_objects(release);
730 qxl_push_cursor_ring_release(qdev, release, QXL_CMD_CURSOR, false);
731
732 qcrtc = to_qxl_crtc(old_state->crtc);
733 qxl_free_cursor(qcrtc->cursor_bo);
734 qcrtc->cursor_bo = NULL;
735}
736
737static void qxl_update_dumb_head(struct qxl_device *qdev,
738 int index, struct qxl_bo *bo)
739{
740 uint32_t width, height;
741
742 if (index >= qdev->monitors_config->max_allowed)
743 return;
744
745 if (bo && bo->is_dumb) {
746 width = bo->surf.width;
747 height = bo->surf.height;
748 } else {
749 width = 0;
750 height = 0;
751 }
752
753 if (qdev->dumb_heads[index].width == width &&
754 qdev->dumb_heads[index].height == height)
755 return;
756
757 DRM_DEBUG("#%d: %dx%d -> %dx%d\n", index,
758 qdev->dumb_heads[index].width,
759 qdev->dumb_heads[index].height,
760 width, height);
761 qdev->dumb_heads[index].width = width;
762 qdev->dumb_heads[index].height = height;
763}
764
765static void qxl_calc_dumb_shadow(struct qxl_device *qdev,
766 struct qxl_surface *surf)
767{
768 struct qxl_head *head;
769 int i;
770
771 memset(surf, 0, sizeof(*surf));
772 for (i = 0; i < qdev->monitors_config->max_allowed; i++) {
773 head = qdev->dumb_heads + i;
774 head->x = surf->width;
775 surf->width += head->width;
776 if (surf->height < head->height)
777 surf->height = head->height;
778 }
779 if (surf->width < 64)
780 surf->width = 64;
781 if (surf->height < 64)
782 surf->height = 64;
783 surf->format = SPICE_SURFACE_FMT_32_xRGB;
784 surf->stride = surf->width * 4;
785
786 if (!qdev->dumb_shadow_bo ||
787 qdev->dumb_shadow_bo->surf.width != surf->width ||
788 qdev->dumb_shadow_bo->surf.height != surf->height)
789 DRM_DEBUG("%dx%d\n", surf->width, surf->height);
790}
791
792static void qxl_prepare_shadow(struct qxl_device *qdev, struct qxl_bo *user_bo,
793 int crtc_index)
794{
795 struct qxl_surface surf;
796
797 qxl_update_dumb_head(qdev, crtc_index,
798 user_bo);
799 qxl_calc_dumb_shadow(qdev, &surf);
800 if (!qdev->dumb_shadow_bo ||
801 qdev->dumb_shadow_bo->surf.width != surf.width ||
802 qdev->dumb_shadow_bo->surf.height != surf.height) {
803 if (qdev->dumb_shadow_bo) {
804 qxl_bo_unpin(qdev->dumb_shadow_bo);
805 drm_gem_object_put
806 (&qdev->dumb_shadow_bo->tbo.base);
807 qdev->dumb_shadow_bo = NULL;
808 }
809 qxl_bo_create(qdev, surf.height * surf.stride,
810 true, true, QXL_GEM_DOMAIN_SURFACE, 0,
811 &surf, &qdev->dumb_shadow_bo);
812 }
813 if (user_bo->shadow != qdev->dumb_shadow_bo) {
814 if (user_bo->shadow) {
815 qxl_bo_unpin(user_bo->shadow);
816 drm_gem_object_put
817 (&user_bo->shadow->tbo.base);
818 user_bo->shadow = NULL;
819 }
820 drm_gem_object_get(&qdev->dumb_shadow_bo->tbo.base);
821 user_bo->shadow = qdev->dumb_shadow_bo;
822 qxl_bo_pin(user_bo->shadow);
823 }
824}
825
826static int qxl_plane_prepare_fb(struct drm_plane *plane,
827 struct drm_plane_state *new_state)
828{
829 struct qxl_device *qdev = to_qxl(plane->dev);
830 struct drm_gem_object *obj;
831 struct qxl_bo *user_bo;
832
833 if (!new_state->fb)
834 return 0;
835
836 obj = new_state->fb->obj[0];
837 user_bo = gem_to_qxl_bo(obj);
838
839 if (plane->type == DRM_PLANE_TYPE_PRIMARY &&
840 user_bo->is_dumb) {
841 qxl_prepare_shadow(qdev, user_bo, new_state->crtc->index);
842 }
843
844 if (plane->type == DRM_PLANE_TYPE_CURSOR &&
845 plane->state->fb != new_state->fb) {
846 struct qxl_crtc *qcrtc = to_qxl_crtc(new_state->crtc);
847 struct qxl_bo *old_cursor_bo = qcrtc->cursor_bo;
848
849 qcrtc->cursor_bo = qxl_create_cursor(qdev, user_bo,
850 new_state->fb->hot_x,
851 new_state->fb->hot_y);
852 qxl_free_cursor(old_cursor_bo);
853 }
854
855 return qxl_bo_pin(user_bo);
856}
857
858static void qxl_plane_cleanup_fb(struct drm_plane *plane,
859 struct drm_plane_state *old_state)
860{
861 struct drm_gem_object *obj;
862 struct qxl_bo *user_bo;
863
864 if (!old_state->fb) {
865
866
867
868
869 return;
870 }
871
872 obj = old_state->fb->obj[0];
873 user_bo = gem_to_qxl_bo(obj);
874 qxl_bo_unpin(user_bo);
875
876 if (old_state->fb != plane->state->fb && user_bo->shadow) {
877 qxl_bo_unpin(user_bo->shadow);
878 drm_gem_object_put(&user_bo->shadow->tbo.base);
879 user_bo->shadow = NULL;
880 }
881}
882
883static const uint32_t qxl_cursor_plane_formats[] = {
884 DRM_FORMAT_ARGB8888,
885};
886
887static const struct drm_plane_helper_funcs qxl_cursor_helper_funcs = {
888 .atomic_update = qxl_cursor_atomic_update,
889 .atomic_disable = qxl_cursor_atomic_disable,
890 .prepare_fb = qxl_plane_prepare_fb,
891 .cleanup_fb = qxl_plane_cleanup_fb,
892};
893
894static const struct drm_plane_funcs qxl_cursor_plane_funcs = {
895 .update_plane = drm_atomic_helper_update_plane,
896 .disable_plane = drm_atomic_helper_disable_plane,
897 .destroy = drm_primary_helper_destroy,
898 .reset = drm_atomic_helper_plane_reset,
899 .atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state,
900 .atomic_destroy_state = drm_atomic_helper_plane_destroy_state,
901};
902
903static const uint32_t qxl_primary_plane_formats[] = {
904 DRM_FORMAT_XRGB8888,
905 DRM_FORMAT_ARGB8888,
906};
907
908static const struct drm_plane_helper_funcs primary_helper_funcs = {
909 .atomic_check = qxl_primary_atomic_check,
910 .atomic_update = qxl_primary_atomic_update,
911 .atomic_disable = qxl_primary_atomic_disable,
912 .prepare_fb = qxl_plane_prepare_fb,
913 .cleanup_fb = qxl_plane_cleanup_fb,
914};
915
916static const struct drm_plane_funcs qxl_primary_plane_funcs = {
917 .update_plane = drm_atomic_helper_update_plane,
918 .disable_plane = drm_atomic_helper_disable_plane,
919 .destroy = drm_primary_helper_destroy,
920 .reset = drm_atomic_helper_plane_reset,
921 .atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state,
922 .atomic_destroy_state = drm_atomic_helper_plane_destroy_state,
923};
924
925static struct drm_plane *qxl_create_plane(struct qxl_device *qdev,
926 unsigned int possible_crtcs,
927 enum drm_plane_type type)
928{
929 const struct drm_plane_helper_funcs *helper_funcs = NULL;
930 struct drm_plane *plane;
931 const struct drm_plane_funcs *funcs;
932 const uint32_t *formats;
933 int num_formats;
934 int err;
935
936 if (type == DRM_PLANE_TYPE_PRIMARY) {
937 funcs = &qxl_primary_plane_funcs;
938 formats = qxl_primary_plane_formats;
939 num_formats = ARRAY_SIZE(qxl_primary_plane_formats);
940 helper_funcs = &primary_helper_funcs;
941 } else if (type == DRM_PLANE_TYPE_CURSOR) {
942 funcs = &qxl_cursor_plane_funcs;
943 formats = qxl_cursor_plane_formats;
944 helper_funcs = &qxl_cursor_helper_funcs;
945 num_formats = ARRAY_SIZE(qxl_cursor_plane_formats);
946 } else {
947 return ERR_PTR(-EINVAL);
948 }
949
950 plane = kzalloc(sizeof(*plane), GFP_KERNEL);
951 if (!plane)
952 return ERR_PTR(-ENOMEM);
953
954 err = drm_universal_plane_init(&qdev->ddev, plane, possible_crtcs,
955 funcs, formats, num_formats,
956 NULL, type, NULL);
957 if (err)
958 goto free_plane;
959
960 drm_plane_helper_add(plane, helper_funcs);
961
962 return plane;
963
964free_plane:
965 kfree(plane);
966 return ERR_PTR(-EINVAL);
967}
968
969static int qdev_crtc_init(struct drm_device *dev, int crtc_id)
970{
971 struct qxl_crtc *qxl_crtc;
972 struct drm_plane *primary, *cursor;
973 struct qxl_device *qdev = to_qxl(dev);
974 int r;
975
976 qxl_crtc = kzalloc(sizeof(struct qxl_crtc), GFP_KERNEL);
977 if (!qxl_crtc)
978 return -ENOMEM;
979
980 primary = qxl_create_plane(qdev, 1 << crtc_id, DRM_PLANE_TYPE_PRIMARY);
981 if (IS_ERR(primary)) {
982 r = -ENOMEM;
983 goto free_mem;
984 }
985
986 cursor = qxl_create_plane(qdev, 1 << crtc_id, DRM_PLANE_TYPE_CURSOR);
987 if (IS_ERR(cursor)) {
988 r = -ENOMEM;
989 goto clean_primary;
990 }
991
992 r = drm_crtc_init_with_planes(dev, &qxl_crtc->base, primary, cursor,
993 &qxl_crtc_funcs, NULL);
994 if (r)
995 goto clean_cursor;
996
997 qxl_crtc->index = crtc_id;
998 drm_crtc_helper_add(&qxl_crtc->base, &qxl_crtc_helper_funcs);
999 return 0;
1000
1001clean_cursor:
1002 drm_plane_cleanup(cursor);
1003 kfree(cursor);
1004clean_primary:
1005 drm_plane_cleanup(primary);
1006 kfree(primary);
1007free_mem:
1008 kfree(qxl_crtc);
1009 return r;
1010}
1011
1012static int qxl_conn_get_modes(struct drm_connector *connector)
1013{
1014 struct drm_device *dev = connector->dev;
1015 struct qxl_device *qdev = to_qxl(dev);
1016 struct qxl_output *output = drm_connector_to_qxl_output(connector);
1017 unsigned int pwidth = 1024;
1018 unsigned int pheight = 768;
1019 int ret = 0;
1020
1021 if (qdev->client_monitors_config) {
1022 struct qxl_head *head;
1023 head = &qdev->client_monitors_config->heads[output->index];
1024 if (head->width)
1025 pwidth = head->width;
1026 if (head->height)
1027 pheight = head->height;
1028 }
1029
1030 ret += drm_add_modes_noedid(connector, 8192, 8192);
1031 ret += qxl_add_extra_modes(connector);
1032 ret += qxl_add_monitors_config_modes(connector);
1033 drm_set_preferred_mode(connector, pwidth, pheight);
1034 return ret;
1035}
1036
1037static enum drm_mode_status qxl_conn_mode_valid(struct drm_connector *connector,
1038 struct drm_display_mode *mode)
1039{
1040 struct drm_device *ddev = connector->dev;
1041 struct qxl_device *qdev = to_qxl(ddev);
1042
1043 if (qxl_check_mode(qdev, mode->hdisplay, mode->vdisplay) != 0)
1044 return MODE_BAD;
1045
1046 return MODE_OK;
1047}
1048
1049static struct drm_encoder *qxl_best_encoder(struct drm_connector *connector)
1050{
1051 struct qxl_output *qxl_output =
1052 drm_connector_to_qxl_output(connector);
1053
1054 DRM_DEBUG("\n");
1055 return &qxl_output->enc;
1056}
1057
1058static const struct drm_connector_helper_funcs qxl_connector_helper_funcs = {
1059 .get_modes = qxl_conn_get_modes,
1060 .mode_valid = qxl_conn_mode_valid,
1061 .best_encoder = qxl_best_encoder,
1062};
1063
1064static enum drm_connector_status qxl_conn_detect(
1065 struct drm_connector *connector,
1066 bool force)
1067{
1068 struct qxl_output *output =
1069 drm_connector_to_qxl_output(connector);
1070 struct drm_device *ddev = connector->dev;
1071 struct qxl_device *qdev = to_qxl(ddev);
1072 bool connected = false;
1073
1074
1075 if (!qdev->client_monitors_config) {
1076 if (output->index == 0)
1077 connected = true;
1078 } else
1079 connected = qdev->client_monitors_config->count > output->index &&
1080 qxl_head_enabled(&qdev->client_monitors_config->heads[output->index]);
1081
1082 DRM_DEBUG("#%d connected: %d\n", output->index, connected);
1083
1084 return connected ? connector_status_connected
1085 : connector_status_disconnected;
1086}
1087
1088static void qxl_conn_destroy(struct drm_connector *connector)
1089{
1090 struct qxl_output *qxl_output =
1091 drm_connector_to_qxl_output(connector);
1092
1093 drm_connector_unregister(connector);
1094 drm_connector_cleanup(connector);
1095 kfree(qxl_output);
1096}
1097
1098static const struct drm_connector_funcs qxl_connector_funcs = {
1099 .detect = qxl_conn_detect,
1100 .fill_modes = drm_helper_probe_single_connector_modes,
1101 .destroy = qxl_conn_destroy,
1102 .reset = drm_atomic_helper_connector_reset,
1103 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
1104 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
1105};
1106
1107static int qxl_mode_create_hotplug_mode_update_property(struct qxl_device *qdev)
1108{
1109 if (qdev->hotplug_mode_update_property)
1110 return 0;
1111
1112 qdev->hotplug_mode_update_property =
1113 drm_property_create_range(&qdev->ddev, DRM_MODE_PROP_IMMUTABLE,
1114 "hotplug_mode_update", 0, 1);
1115
1116 return 0;
1117}
1118
1119static int qdev_output_init(struct drm_device *dev, int num_output)
1120{
1121 struct qxl_device *qdev = to_qxl(dev);
1122 struct qxl_output *qxl_output;
1123 struct drm_connector *connector;
1124 struct drm_encoder *encoder;
1125 int ret;
1126
1127 qxl_output = kzalloc(sizeof(struct qxl_output), GFP_KERNEL);
1128 if (!qxl_output)
1129 return -ENOMEM;
1130
1131 qxl_output->index = num_output;
1132
1133 connector = &qxl_output->base;
1134 encoder = &qxl_output->enc;
1135 drm_connector_init(dev, &qxl_output->base,
1136 &qxl_connector_funcs, DRM_MODE_CONNECTOR_VIRTUAL);
1137
1138 ret = drm_simple_encoder_init(dev, &qxl_output->enc,
1139 DRM_MODE_ENCODER_VIRTUAL);
1140 if (ret) {
1141 drm_err(dev, "drm_simple_encoder_init() failed, error %d\n",
1142 ret);
1143 goto err_drm_connector_cleanup;
1144 }
1145
1146
1147 connector->polled = DRM_CONNECTOR_POLL_HPD;
1148 encoder->possible_crtcs = 1 << num_output;
1149 drm_connector_attach_encoder(&qxl_output->base,
1150 &qxl_output->enc);
1151 drm_connector_helper_add(connector, &qxl_connector_helper_funcs);
1152
1153 drm_object_attach_property(&connector->base,
1154 qdev->hotplug_mode_update_property, 0);
1155 drm_object_attach_property(&connector->base,
1156 dev->mode_config.suggested_x_property, 0);
1157 drm_object_attach_property(&connector->base,
1158 dev->mode_config.suggested_y_property, 0);
1159 return 0;
1160
1161err_drm_connector_cleanup:
1162 drm_connector_cleanup(&qxl_output->base);
1163 kfree(qxl_output);
1164 return ret;
1165}
1166
1167static struct drm_framebuffer *
1168qxl_user_framebuffer_create(struct drm_device *dev,
1169 struct drm_file *file_priv,
1170 const struct drm_mode_fb_cmd2 *mode_cmd)
1171{
1172 return drm_gem_fb_create_with_funcs(dev, file_priv, mode_cmd,
1173 &qxl_fb_funcs);
1174}
1175
1176static const struct drm_mode_config_funcs qxl_mode_funcs = {
1177 .fb_create = qxl_user_framebuffer_create,
1178 .atomic_check = drm_atomic_helper_check,
1179 .atomic_commit = drm_atomic_helper_commit,
1180};
1181
1182int qxl_create_monitors_object(struct qxl_device *qdev)
1183{
1184 int ret;
1185 struct drm_gem_object *gobj;
1186 struct dma_buf_map map;
1187 int monitors_config_size = sizeof(struct qxl_monitors_config) +
1188 qxl_num_crtc * sizeof(struct qxl_head);
1189
1190 ret = qxl_gem_object_create(qdev, monitors_config_size, 0,
1191 QXL_GEM_DOMAIN_VRAM,
1192 false, false, NULL, &gobj);
1193 if (ret) {
1194 DRM_ERROR("%s: failed to create gem ret=%d\n", __func__, ret);
1195 return -ENOMEM;
1196 }
1197 qdev->monitors_config_bo = gem_to_qxl_bo(gobj);
1198
1199 ret = qxl_bo_vmap(qdev->monitors_config_bo, &map);
1200 if (ret)
1201 return ret;
1202
1203 qdev->monitors_config = qdev->monitors_config_bo->kptr;
1204 qdev->ram_header->monitors_config =
1205 qxl_bo_physical_address(qdev, qdev->monitors_config_bo, 0);
1206
1207 memset(qdev->monitors_config, 0, monitors_config_size);
1208 qdev->dumb_heads = kcalloc(qxl_num_crtc, sizeof(qdev->dumb_heads[0]),
1209 GFP_KERNEL);
1210 if (!qdev->dumb_heads) {
1211 qxl_destroy_monitors_object(qdev);
1212 return -ENOMEM;
1213 }
1214 return 0;
1215}
1216
1217int qxl_destroy_monitors_object(struct qxl_device *qdev)
1218{
1219 int ret;
1220
1221 if (!qdev->monitors_config_bo)
1222 return 0;
1223
1224 qdev->monitors_config = NULL;
1225 qdev->ram_header->monitors_config = 0;
1226
1227 ret = qxl_bo_vunmap(qdev->monitors_config_bo);
1228 if (ret)
1229 return ret;
1230
1231 qxl_bo_unref(&qdev->monitors_config_bo);
1232 return 0;
1233}
1234
1235int qxl_modeset_init(struct qxl_device *qdev)
1236{
1237 int i;
1238 int ret;
1239
1240 ret = drmm_mode_config_init(&qdev->ddev);
1241 if (ret)
1242 return ret;
1243
1244 ret = qxl_create_monitors_object(qdev);
1245 if (ret)
1246 return ret;
1247
1248 qdev->ddev.mode_config.funcs = (void *)&qxl_mode_funcs;
1249
1250
1251 qdev->ddev.mode_config.min_width = 0;
1252 qdev->ddev.mode_config.min_height = 0;
1253 qdev->ddev.mode_config.max_width = 8192;
1254 qdev->ddev.mode_config.max_height = 8192;
1255
1256 qdev->ddev.mode_config.fb_base = qdev->vram_base;
1257
1258 drm_mode_create_suggested_offset_properties(&qdev->ddev);
1259 qxl_mode_create_hotplug_mode_update_property(qdev);
1260
1261 for (i = 0 ; i < qxl_num_crtc; ++i) {
1262 qdev_crtc_init(&qdev->ddev, i);
1263 qdev_output_init(&qdev->ddev, i);
1264 }
1265
1266 qxl_display_read_client_monitors_config(qdev);
1267
1268 drm_mode_config_reset(&qdev->ddev);
1269 return 0;
1270}
1271
1272void qxl_modeset_fini(struct qxl_device *qdev)
1273{
1274 if (qdev->dumb_shadow_bo) {
1275 qxl_bo_unpin(qdev->dumb_shadow_bo);
1276 drm_gem_object_put(&qdev->dumb_shadow_bo->tbo.base);
1277 qdev->dumb_shadow_bo = NULL;
1278 }
1279 qxl_destroy_monitors_object(qdev);
1280}
1281
