xref: /linux/drivers/gpu/drm/vmwgfx/vmwgfx_scrn.c (revision 5e4e38446a62a4f50d77b0dd11d4b379dee08988)
1 /**************************************************************************
2  *
3  * Copyright © 2011-2015 VMware, Inc., Palo Alto, CA., USA
4  * All Rights Reserved.
5  *
6  * Permission is hereby granted, free of charge, to any person obtaining a
7  * copy of this software and associated documentation files (the
8  * "Software"), to deal in the Software without restriction, including
9  * without limitation the rights to use, copy, modify, merge, publish,
10  * distribute, sub license, and/or sell copies of the Software, and to
11  * permit persons to whom the Software is furnished to do so, subject to
12  * the following conditions:
13  *
14  * The above copyright notice and this permission notice (including the
15  * next paragraph) shall be included in all copies or substantial portions
16  * of the Software.
17  *
18  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
19  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
20  * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
21  * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
22  * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
23  * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
24  * USE OR OTHER DEALINGS IN THE SOFTWARE.
25  *
26  **************************************************************************/
27 
28 #include "vmwgfx_kms.h"
29 #include <drm/drm_plane_helper.h>
30 
31 
32 #define vmw_crtc_to_sou(x) \
33 	container_of(x, struct vmw_screen_object_unit, base.crtc)
34 #define vmw_encoder_to_sou(x) \
35 	container_of(x, struct vmw_screen_object_unit, base.encoder)
36 #define vmw_connector_to_sou(x) \
37 	container_of(x, struct vmw_screen_object_unit, base.connector)
38 
39 /**
40  * struct vmw_kms_sou_surface_dirty - Closure structure for
41  * blit surface to screen command.
42  * @base: The base type we derive from. Used by vmw_kms_helper_dirty().
43  * @left: Left side of bounding box.
44  * @right: Right side of bounding box.
45  * @top: Top side of bounding box.
46  * @bottom: Bottom side of bounding box.
47  * @dst_x: Difference between source clip rects and framebuffer coordinates.
48  * @dst_y: Difference between source clip rects and framebuffer coordinates.
49  * @sid: Surface id of surface to copy from.
50  */
51 struct vmw_kms_sou_surface_dirty {
52 	struct vmw_kms_dirty base;
53 	s32 left, right, top, bottom;
54 	s32 dst_x, dst_y;
55 	u32 sid;
56 };
57 
58 /*
59  * SVGA commands that are used by this code. Please see the device headers
60  * for explanation.
61  */
62 struct vmw_kms_sou_readback_blit {
63 	uint32 header;
64 	SVGAFifoCmdBlitScreenToGMRFB body;
65 };
66 
67 struct vmw_kms_sou_dmabuf_blit {
68 	uint32 header;
69 	SVGAFifoCmdBlitGMRFBToScreen body;
70 };
71 
72 struct vmw_kms_sou_dirty_cmd {
73 	SVGA3dCmdHeader header;
74 	SVGA3dCmdBlitSurfaceToScreen body;
75 };
76 
77 
78 /*
79  * Other structs.
80  */
81 
82 struct vmw_screen_object_display {
83 	unsigned num_implicit;
84 
85 	struct vmw_framebuffer *implicit_fb;
86 	SVGAFifoCmdDefineGMRFB cur;
87 	struct vmw_dma_buffer *pinned_gmrfb;
88 };
89 
90 /**
91  * Display unit using screen objects.
92  */
93 struct vmw_screen_object_unit {
94 	struct vmw_display_unit base;
95 
96 	unsigned long buffer_size; /**< Size of allocated buffer */
97 	struct vmw_dma_buffer *buffer; /**< Backing store buffer */
98 
99 	bool defined;
100 	bool active_implicit;
101 };
102 
103 static void vmw_sou_destroy(struct vmw_screen_object_unit *sou)
104 {
105 	vmw_du_cleanup(&sou->base);
106 	kfree(sou);
107 }
108 
109 
110 /*
111  * Screen Object Display Unit CRTC functions
112  */
113 
114 static void vmw_sou_crtc_destroy(struct drm_crtc *crtc)
115 {
116 	vmw_sou_destroy(vmw_crtc_to_sou(crtc));
117 }
118 
119 static void vmw_sou_del_active(struct vmw_private *vmw_priv,
120 			       struct vmw_screen_object_unit *sou)
121 {
122 	struct vmw_screen_object_display *ld = vmw_priv->sou_priv;
123 
124 	if (sou->active_implicit) {
125 		if (--(ld->num_implicit) == 0)
126 			ld->implicit_fb = NULL;
127 		sou->active_implicit = false;
128 	}
129 }
130 
131 static void vmw_sou_add_active(struct vmw_private *vmw_priv,
132 			       struct vmw_screen_object_unit *sou,
133 			       struct vmw_framebuffer *vfb)
134 {
135 	struct vmw_screen_object_display *ld = vmw_priv->sou_priv;
136 
137 	BUG_ON(!ld->num_implicit && ld->implicit_fb);
138 
139 	if (!sou->active_implicit && sou->base.is_implicit) {
140 		ld->implicit_fb = vfb;
141 		sou->active_implicit = true;
142 		ld->num_implicit++;
143 	}
144 }
145 
146 /**
147  * Send the fifo command to create a screen.
148  */
149 static int vmw_sou_fifo_create(struct vmw_private *dev_priv,
150 			       struct vmw_screen_object_unit *sou,
151 			       uint32_t x, uint32_t y,
152 			       struct drm_display_mode *mode)
153 {
154 	size_t fifo_size;
155 
156 	struct {
157 		struct {
158 			uint32_t cmdType;
159 		} header;
160 		SVGAScreenObject obj;
161 	} *cmd;
162 
163 	BUG_ON(!sou->buffer);
164 
165 	fifo_size = sizeof(*cmd);
166 	cmd = vmw_fifo_reserve(dev_priv, fifo_size);
167 	/* The hardware has hung, nothing we can do about it here. */
168 	if (unlikely(cmd == NULL)) {
169 		DRM_ERROR("Fifo reserve failed.\n");
170 		return -ENOMEM;
171 	}
172 
173 	memset(cmd, 0, fifo_size);
174 	cmd->header.cmdType = SVGA_CMD_DEFINE_SCREEN;
175 	cmd->obj.structSize = sizeof(SVGAScreenObject);
176 	cmd->obj.id = sou->base.unit;
177 	cmd->obj.flags = SVGA_SCREEN_HAS_ROOT |
178 		(sou->base.unit == 0 ? SVGA_SCREEN_IS_PRIMARY : 0);
179 	cmd->obj.size.width = mode->hdisplay;
180 	cmd->obj.size.height = mode->vdisplay;
181 	if (sou->base.is_implicit) {
182 		cmd->obj.root.x = x;
183 		cmd->obj.root.y = y;
184 	} else {
185 		cmd->obj.root.x = sou->base.gui_x;
186 		cmd->obj.root.y = sou->base.gui_y;
187 	}
188 
189 	/* Ok to assume that buffer is pinned in vram */
190 	vmw_bo_get_guest_ptr(&sou->buffer->base, &cmd->obj.backingStore.ptr);
191 	cmd->obj.backingStore.pitch = mode->hdisplay * 4;
192 
193 	vmw_fifo_commit(dev_priv, fifo_size);
194 
195 	sou->defined = true;
196 
197 	return 0;
198 }
199 
200 /**
201  * Send the fifo command to destroy a screen.
202  */
203 static int vmw_sou_fifo_destroy(struct vmw_private *dev_priv,
204 				struct vmw_screen_object_unit *sou)
205 {
206 	size_t fifo_size;
207 	int ret;
208 
209 	struct {
210 		struct {
211 			uint32_t cmdType;
212 		} header;
213 		SVGAFifoCmdDestroyScreen body;
214 	} *cmd;
215 
216 	/* no need to do anything */
217 	if (unlikely(!sou->defined))
218 		return 0;
219 
220 	fifo_size = sizeof(*cmd);
221 	cmd = vmw_fifo_reserve(dev_priv, fifo_size);
222 	/* the hardware has hung, nothing we can do about it here */
223 	if (unlikely(cmd == NULL)) {
224 		DRM_ERROR("Fifo reserve failed.\n");
225 		return -ENOMEM;
226 	}
227 
228 	memset(cmd, 0, fifo_size);
229 	cmd->header.cmdType = SVGA_CMD_DESTROY_SCREEN;
230 	cmd->body.screenId = sou->base.unit;
231 
232 	vmw_fifo_commit(dev_priv, fifo_size);
233 
234 	/* Force sync */
235 	ret = vmw_fallback_wait(dev_priv, false, true, 0, false, 3*HZ);
236 	if (unlikely(ret != 0))
237 		DRM_ERROR("Failed to sync with HW");
238 	else
239 		sou->defined = false;
240 
241 	return ret;
242 }
243 
244 /**
245  * Free the backing store.
246  */
247 static void vmw_sou_backing_free(struct vmw_private *dev_priv,
248 				 struct vmw_screen_object_unit *sou)
249 {
250 	vmw_dmabuf_unreference(&sou->buffer);
251 	sou->buffer_size = 0;
252 }
253 
254 /**
255  * Allocate the backing store for the buffer.
256  */
257 static int vmw_sou_backing_alloc(struct vmw_private *dev_priv,
258 				 struct vmw_screen_object_unit *sou,
259 				 unsigned long size)
260 {
261 	int ret;
262 
263 	if (sou->buffer_size == size)
264 		return 0;
265 
266 	if (sou->buffer)
267 		vmw_sou_backing_free(dev_priv, sou);
268 
269 	sou->buffer = kzalloc(sizeof(*sou->buffer), GFP_KERNEL);
270 	if (unlikely(sou->buffer == NULL))
271 		return -ENOMEM;
272 
273 	/* After we have alloced the backing store might not be able to
274 	 * resume the overlays, this is preferred to failing to alloc.
275 	 */
276 	vmw_overlay_pause_all(dev_priv);
277 	ret = vmw_dmabuf_init(dev_priv, sou->buffer, size,
278 			      &vmw_vram_ne_placement,
279 			      false, &vmw_dmabuf_bo_free);
280 	vmw_overlay_resume_all(dev_priv);
281 
282 	if (unlikely(ret != 0))
283 		sou->buffer = NULL; /* vmw_dmabuf_init frees on error */
284 	else
285 		sou->buffer_size = size;
286 
287 	return ret;
288 }
289 
290 static int vmw_sou_crtc_set_config(struct drm_mode_set *set)
291 {
292 	struct vmw_private *dev_priv;
293 	struct vmw_screen_object_unit *sou;
294 	struct drm_connector *connector;
295 	struct drm_display_mode *mode;
296 	struct drm_encoder *encoder;
297 	struct vmw_framebuffer *vfb;
298 	struct drm_framebuffer *fb;
299 	struct drm_crtc *crtc;
300 	int ret = 0;
301 
302 	if (!set)
303 		return -EINVAL;
304 
305 	if (!set->crtc)
306 		return -EINVAL;
307 
308 	/* get the sou */
309 	crtc = set->crtc;
310 	sou = vmw_crtc_to_sou(crtc);
311 	vfb = set->fb ? vmw_framebuffer_to_vfb(set->fb) : NULL;
312 	dev_priv = vmw_priv(crtc->dev);
313 
314 	if (set->num_connectors > 1) {
315 		DRM_ERROR("Too many connectors\n");
316 		return -EINVAL;
317 	}
318 
319 	if (set->num_connectors == 1 &&
320 	    set->connectors[0] != &sou->base.connector) {
321 		DRM_ERROR("Connector doesn't match %p %p\n",
322 			set->connectors[0], &sou->base.connector);
323 		return -EINVAL;
324 	}
325 
326 	/* sou only supports one fb active at the time */
327 	if (sou->base.is_implicit &&
328 	    dev_priv->sou_priv->implicit_fb && vfb &&
329 	    !(dev_priv->sou_priv->num_implicit == 1 &&
330 	      sou->active_implicit) &&
331 	    dev_priv->sou_priv->implicit_fb != vfb) {
332 		DRM_ERROR("Multiple framebuffers not supported\n");
333 		return -EINVAL;
334 	}
335 
336 	/* since they always map one to one these are safe */
337 	connector = &sou->base.connector;
338 	encoder = &sou->base.encoder;
339 
340 	/* should we turn the crtc off */
341 	if (set->num_connectors == 0 || !set->mode || !set->fb) {
342 		ret = vmw_sou_fifo_destroy(dev_priv, sou);
343 		/* the hardware has hung don't do anything more */
344 		if (unlikely(ret != 0))
345 			return ret;
346 
347 		connector->encoder = NULL;
348 		encoder->crtc = NULL;
349 		crtc->primary->fb = NULL;
350 		crtc->x = 0;
351 		crtc->y = 0;
352 		crtc->enabled = false;
353 
354 		vmw_sou_del_active(dev_priv, sou);
355 
356 		vmw_sou_backing_free(dev_priv, sou);
357 
358 		return 0;
359 	}
360 
361 
362 	/* we now know we want to set a mode */
363 	mode = set->mode;
364 	fb = set->fb;
365 
366 	if (set->x + mode->hdisplay > fb->width ||
367 	    set->y + mode->vdisplay > fb->height) {
368 		DRM_ERROR("set outside of framebuffer\n");
369 		return -EINVAL;
370 	}
371 
372 	vmw_svga_enable(dev_priv);
373 
374 	if (mode->hdisplay != crtc->mode.hdisplay ||
375 	    mode->vdisplay != crtc->mode.vdisplay) {
376 		/* no need to check if depth is different, because backing
377 		 * store depth is forced to 4 by the device.
378 		 */
379 
380 		ret = vmw_sou_fifo_destroy(dev_priv, sou);
381 		/* the hardware has hung don't do anything more */
382 		if (unlikely(ret != 0))
383 			return ret;
384 
385 		vmw_sou_backing_free(dev_priv, sou);
386 	}
387 
388 	if (!sou->buffer) {
389 		/* forced to depth 4 by the device */
390 		size_t size = mode->hdisplay * mode->vdisplay * 4;
391 		ret = vmw_sou_backing_alloc(dev_priv, sou, size);
392 		if (unlikely(ret != 0))
393 			return ret;
394 	}
395 
396 	ret = vmw_sou_fifo_create(dev_priv, sou, set->x, set->y, mode);
397 	if (unlikely(ret != 0)) {
398 		/*
399 		 * We are in a bit of a situation here, the hardware has
400 		 * hung and we may or may not have a buffer hanging of
401 		 * the screen object, best thing to do is not do anything
402 		 * if we where defined, if not just turn the crtc of.
403 		 * Not what userspace wants but it needs to htfu.
404 		 */
405 		if (sou->defined)
406 			return ret;
407 
408 		connector->encoder = NULL;
409 		encoder->crtc = NULL;
410 		crtc->primary->fb = NULL;
411 		crtc->x = 0;
412 		crtc->y = 0;
413 		crtc->enabled = false;
414 
415 		return ret;
416 	}
417 
418 	vmw_sou_add_active(dev_priv, sou, vfb);
419 
420 	connector->encoder = encoder;
421 	encoder->crtc = crtc;
422 	crtc->mode = *mode;
423 	crtc->primary->fb = fb;
424 	crtc->x = set->x;
425 	crtc->y = set->y;
426 	crtc->enabled = true;
427 
428 	return 0;
429 }
430 
431 /**
432  * Returns if this unit can be page flipped.
433  * Must be called with the mode_config mutex held.
434  */
435 static bool vmw_sou_screen_object_flippable(struct vmw_private *dev_priv,
436 					    struct drm_crtc *crtc)
437 {
438 	struct vmw_screen_object_unit *sou = vmw_crtc_to_sou(crtc);
439 
440 	if (!sou->base.is_implicit)
441 		return true;
442 
443 	if (dev_priv->sou_priv->num_implicit != 1)
444 		return false;
445 
446 	return true;
447 }
448 
449 /**
450  * Update the implicit fb to the current fb of this crtc.
451  * Must be called with the mode_config mutex held.
452  */
453 static void vmw_sou_update_implicit_fb(struct vmw_private *dev_priv,
454 				       struct drm_crtc *crtc)
455 {
456 	struct vmw_screen_object_unit *sou = vmw_crtc_to_sou(crtc);
457 
458 	BUG_ON(!sou->base.is_implicit);
459 
460 	dev_priv->sou_priv->implicit_fb =
461 		vmw_framebuffer_to_vfb(sou->base.crtc.primary->fb);
462 }
463 
464 static int vmw_sou_crtc_page_flip(struct drm_crtc *crtc,
465 				  struct drm_framebuffer *fb,
466 				  struct drm_pending_vblank_event *event,
467 				  uint32_t flags)
468 {
469 	struct vmw_private *dev_priv = vmw_priv(crtc->dev);
470 	struct drm_framebuffer *old_fb = crtc->primary->fb;
471 	struct vmw_framebuffer *vfb = vmw_framebuffer_to_vfb(fb);
472 	struct vmw_fence_obj *fence = NULL;
473 	struct drm_clip_rect clips;
474 	int ret;
475 
476 	/* require ScreenObject support for page flipping */
477 	if (!dev_priv->sou_priv)
478 		return -ENOSYS;
479 
480 	if (!vmw_sou_screen_object_flippable(dev_priv, crtc))
481 		return -EINVAL;
482 
483 	crtc->primary->fb = fb;
484 
485 	/* do a full screen dirty update */
486 	clips.x1 = clips.y1 = 0;
487 	clips.x2 = fb->width;
488 	clips.y2 = fb->height;
489 
490 	if (vfb->dmabuf)
491 		ret = vmw_kms_sou_do_dmabuf_dirty(dev_priv, vfb,
492 						  &clips, 1, 1,
493 						  true, &fence);
494 	else
495 		ret = vmw_kms_sou_do_surface_dirty(dev_priv, vfb,
496 						   &clips, NULL, NULL,
497 						   0, 0, 1, 1, &fence);
498 
499 
500 	if (ret != 0)
501 		goto out_no_fence;
502 	if (!fence) {
503 		ret = -EINVAL;
504 		goto out_no_fence;
505 	}
506 
507 	if (event) {
508 		struct drm_file *file_priv = event->base.file_priv;
509 
510 		ret = vmw_event_fence_action_queue(file_priv, fence,
511 						   &event->base,
512 						   &event->event.tv_sec,
513 						   &event->event.tv_usec,
514 						   true);
515 	}
516 
517 	/*
518 	 * No need to hold on to this now. The only cleanup
519 	 * we need to do if we fail is unref the fence.
520 	 */
521 	vmw_fence_obj_unreference(&fence);
522 
523 	if (vmw_crtc_to_du(crtc)->is_implicit)
524 		vmw_sou_update_implicit_fb(dev_priv, crtc);
525 
526 	return ret;
527 
528 out_no_fence:
529 	crtc->primary->fb = old_fb;
530 	return ret;
531 }
532 
533 static const struct drm_crtc_funcs vmw_screen_object_crtc_funcs = {
534 	.cursor_set2 = vmw_du_crtc_cursor_set2,
535 	.cursor_move = vmw_du_crtc_cursor_move,
536 	.gamma_set = vmw_du_crtc_gamma_set,
537 	.destroy = vmw_sou_crtc_destroy,
538 	.set_config = vmw_sou_crtc_set_config,
539 	.page_flip = vmw_sou_crtc_page_flip,
540 };
541 
542 /*
543  * Screen Object Display Unit encoder functions
544  */
545 
546 static void vmw_sou_encoder_destroy(struct drm_encoder *encoder)
547 {
548 	vmw_sou_destroy(vmw_encoder_to_sou(encoder));
549 }
550 
551 static const struct drm_encoder_funcs vmw_screen_object_encoder_funcs = {
552 	.destroy = vmw_sou_encoder_destroy,
553 };
554 
555 /*
556  * Screen Object Display Unit connector functions
557  */
558 
559 static void vmw_sou_connector_destroy(struct drm_connector *connector)
560 {
561 	vmw_sou_destroy(vmw_connector_to_sou(connector));
562 }
563 
564 static const struct drm_connector_funcs vmw_sou_connector_funcs = {
565 	.dpms = vmw_du_connector_dpms,
566 	.detect = vmw_du_connector_detect,
567 	.fill_modes = vmw_du_connector_fill_modes,
568 	.set_property = vmw_du_connector_set_property,
569 	.destroy = vmw_sou_connector_destroy,
570 };
571 
572 static int vmw_sou_init(struct vmw_private *dev_priv, unsigned unit)
573 {
574 	struct vmw_screen_object_unit *sou;
575 	struct drm_device *dev = dev_priv->dev;
576 	struct drm_connector *connector;
577 	struct drm_encoder *encoder;
578 	struct drm_crtc *crtc;
579 
580 	sou = kzalloc(sizeof(*sou), GFP_KERNEL);
581 	if (!sou)
582 		return -ENOMEM;
583 
584 	sou->base.unit = unit;
585 	crtc = &sou->base.crtc;
586 	encoder = &sou->base.encoder;
587 	connector = &sou->base.connector;
588 
589 	sou->active_implicit = false;
590 
591 	sou->base.pref_active = (unit == 0);
592 	sou->base.pref_width = dev_priv->initial_width;
593 	sou->base.pref_height = dev_priv->initial_height;
594 	sou->base.pref_mode = NULL;
595 	sou->base.is_implicit = true;
596 
597 	drm_connector_init(dev, connector, &vmw_sou_connector_funcs,
598 			   DRM_MODE_CONNECTOR_VIRTUAL);
599 	connector->status = vmw_du_connector_detect(connector, true);
600 
601 	drm_encoder_init(dev, encoder, &vmw_screen_object_encoder_funcs,
602 			 DRM_MODE_ENCODER_VIRTUAL, NULL);
603 	drm_mode_connector_attach_encoder(connector, encoder);
604 	encoder->possible_crtcs = (1 << unit);
605 	encoder->possible_clones = 0;
606 
607 	(void) drm_connector_register(connector);
608 
609 	drm_crtc_init(dev, crtc, &vmw_screen_object_crtc_funcs);
610 
611 	drm_mode_crtc_set_gamma_size(crtc, 256);
612 
613 	drm_object_attach_property(&connector->base,
614 				      dev->mode_config.dirty_info_property,
615 				      1);
616 
617 	return 0;
618 }
619 
620 int vmw_kms_sou_init_display(struct vmw_private *dev_priv)
621 {
622 	struct drm_device *dev = dev_priv->dev;
623 	int i, ret;
624 
625 	if (dev_priv->sou_priv) {
626 		DRM_INFO("sou system already on\n");
627 		return -EINVAL;
628 	}
629 
630 	if (!(dev_priv->capabilities & SVGA_CAP_SCREEN_OBJECT_2)) {
631 		DRM_INFO("Not using screen objects,"
632 			 " missing cap SCREEN_OBJECT_2\n");
633 		return -ENOSYS;
634 	}
635 
636 	ret = -ENOMEM;
637 	dev_priv->sou_priv = kmalloc(sizeof(*dev_priv->sou_priv), GFP_KERNEL);
638 	if (unlikely(!dev_priv->sou_priv))
639 		goto err_no_mem;
640 
641 	dev_priv->sou_priv->num_implicit = 0;
642 	dev_priv->sou_priv->implicit_fb = NULL;
643 
644 	ret = drm_vblank_init(dev, VMWGFX_NUM_DISPLAY_UNITS);
645 	if (unlikely(ret != 0))
646 		goto err_free;
647 
648 	ret = drm_mode_create_dirty_info_property(dev);
649 	if (unlikely(ret != 0))
650 		goto err_vblank_cleanup;
651 
652 	for (i = 0; i < VMWGFX_NUM_DISPLAY_UNITS; ++i)
653 		vmw_sou_init(dev_priv, i);
654 
655 	dev_priv->active_display_unit = vmw_du_screen_object;
656 
657 	DRM_INFO("Screen Objects Display Unit initialized\n");
658 
659 	return 0;
660 
661 err_vblank_cleanup:
662 	drm_vblank_cleanup(dev);
663 err_free:
664 	kfree(dev_priv->sou_priv);
665 	dev_priv->sou_priv = NULL;
666 err_no_mem:
667 	return ret;
668 }
669 
670 int vmw_kms_sou_close_display(struct vmw_private *dev_priv)
671 {
672 	struct drm_device *dev = dev_priv->dev;
673 
674 	if (!dev_priv->sou_priv)
675 		return -ENOSYS;
676 
677 	drm_vblank_cleanup(dev);
678 
679 	kfree(dev_priv->sou_priv);
680 
681 	return 0;
682 }
683 
684 static int do_dmabuf_define_gmrfb(struct vmw_private *dev_priv,
685 				  struct vmw_framebuffer *framebuffer)
686 {
687 	struct vmw_dma_buffer *buf =
688 		container_of(framebuffer, struct vmw_framebuffer_dmabuf,
689 			     base)->buffer;
690 	int depth = framebuffer->base.depth;
691 	struct {
692 		uint32_t header;
693 		SVGAFifoCmdDefineGMRFB body;
694 	} *cmd;
695 
696 	/* Emulate RGBA support, contrary to svga_reg.h this is not
697 	 * supported by hosts. This is only a problem if we are reading
698 	 * this value later and expecting what we uploaded back.
699 	 */
700 	if (depth == 32)
701 		depth = 24;
702 
703 	cmd = vmw_fifo_reserve(dev_priv, sizeof(*cmd));
704 	if (!cmd) {
705 		DRM_ERROR("Out of fifo space for dirty framebuffer command.\n");
706 		return -ENOMEM;
707 	}
708 
709 	cmd->header = SVGA_CMD_DEFINE_GMRFB;
710 	cmd->body.format.bitsPerPixel = framebuffer->base.bits_per_pixel;
711 	cmd->body.format.colorDepth = depth;
712 	cmd->body.format.reserved = 0;
713 	cmd->body.bytesPerLine = framebuffer->base.pitches[0];
714 	/* Buffer is reserved in vram or GMR */
715 	vmw_bo_get_guest_ptr(&buf->base, &cmd->body.ptr);
716 	vmw_fifo_commit(dev_priv, sizeof(*cmd));
717 
718 	return 0;
719 }
720 
721 /**
722  * vmw_sou_surface_fifo_commit - Callback to fill in and submit a
723  * blit surface to screen command.
724  *
725  * @dirty: The closure structure.
726  *
727  * Fills in the missing fields in the command, and translates the cliprects
728  * to match the destination bounding box encoded.
729  */
730 static void vmw_sou_surface_fifo_commit(struct vmw_kms_dirty *dirty)
731 {
732 	struct vmw_kms_sou_surface_dirty *sdirty =
733 		container_of(dirty, typeof(*sdirty), base);
734 	struct vmw_kms_sou_dirty_cmd *cmd = dirty->cmd;
735 	s32 trans_x = dirty->unit->crtc.x - sdirty->dst_x;
736 	s32 trans_y = dirty->unit->crtc.y - sdirty->dst_y;
737 	size_t region_size = dirty->num_hits * sizeof(SVGASignedRect);
738 	SVGASignedRect *blit = (SVGASignedRect *) &cmd[1];
739 	int i;
740 
741 	cmd->header.id = SVGA_3D_CMD_BLIT_SURFACE_TO_SCREEN;
742 	cmd->header.size = sizeof(cmd->body) + region_size;
743 
744 	/*
745 	 * Use the destination bounding box to specify destination - and
746 	 * source bounding regions.
747 	 */
748 	cmd->body.destRect.left = sdirty->left;
749 	cmd->body.destRect.right = sdirty->right;
750 	cmd->body.destRect.top = sdirty->top;
751 	cmd->body.destRect.bottom = sdirty->bottom;
752 
753 	cmd->body.srcRect.left = sdirty->left + trans_x;
754 	cmd->body.srcRect.right = sdirty->right + trans_x;
755 	cmd->body.srcRect.top = sdirty->top + trans_y;
756 	cmd->body.srcRect.bottom = sdirty->bottom + trans_y;
757 
758 	cmd->body.srcImage.sid = sdirty->sid;
759 	cmd->body.destScreenId = dirty->unit->unit;
760 
761 	/* Blits are relative to the destination rect. Translate. */
762 	for (i = 0; i < dirty->num_hits; ++i, ++blit) {
763 		blit->left -= sdirty->left;
764 		blit->right -= sdirty->left;
765 		blit->top -= sdirty->top;
766 		blit->bottom -= sdirty->top;
767 	}
768 
769 	vmw_fifo_commit(dirty->dev_priv, region_size + sizeof(*cmd));
770 
771 	sdirty->left = sdirty->top = S32_MAX;
772 	sdirty->right = sdirty->bottom = S32_MIN;
773 }
774 
775 /**
776  * vmw_sou_surface_clip - Callback to encode a blit surface to screen cliprect.
777  *
778  * @dirty: The closure structure
779  *
780  * Encodes a SVGASignedRect cliprect and updates the bounding box of the
781  * BLIT_SURFACE_TO_SCREEN command.
782  */
783 static void vmw_sou_surface_clip(struct vmw_kms_dirty *dirty)
784 {
785 	struct vmw_kms_sou_surface_dirty *sdirty =
786 		container_of(dirty, typeof(*sdirty), base);
787 	struct vmw_kms_sou_dirty_cmd *cmd = dirty->cmd;
788 	SVGASignedRect *blit = (SVGASignedRect *) &cmd[1];
789 
790 	/* Destination rect. */
791 	blit += dirty->num_hits;
792 	blit->left = dirty->unit_x1;
793 	blit->top = dirty->unit_y1;
794 	blit->right = dirty->unit_x2;
795 	blit->bottom = dirty->unit_y2;
796 
797 	/* Destination bounding box */
798 	sdirty->left = min_t(s32, sdirty->left, dirty->unit_x1);
799 	sdirty->top = min_t(s32, sdirty->top, dirty->unit_y1);
800 	sdirty->right = max_t(s32, sdirty->right, dirty->unit_x2);
801 	sdirty->bottom = max_t(s32, sdirty->bottom, dirty->unit_y2);
802 
803 	dirty->num_hits++;
804 }
805 
806 /**
807  * vmw_kms_sou_do_surface_dirty - Dirty part of a surface backed framebuffer
808  *
809  * @dev_priv: Pointer to the device private structure.
810  * @framebuffer: Pointer to the surface-buffer backed framebuffer.
811  * @clips: Array of clip rects. Either @clips or @vclips must be NULL.
812  * @vclips: Alternate array of clip rects. Either @clips or @vclips must
813  * be NULL.
814  * @srf: Pointer to surface to blit from. If NULL, the surface attached
815  * to @framebuffer will be used.
816  * @dest_x: X coordinate offset to align @srf with framebuffer coordinates.
817  * @dest_y: Y coordinate offset to align @srf with framebuffer coordinates.
818  * @num_clips: Number of clip rects in @clips.
819  * @inc: Increment to use when looping over @clips.
820  * @out_fence: If non-NULL, will return a ref-counted pointer to a
821  * struct vmw_fence_obj. The returned fence pointer may be NULL in which
822  * case the device has already synchronized.
823  *
824  * Returns 0 on success, negative error code on failure. -ERESTARTSYS if
825  * interrupted.
826  */
827 int vmw_kms_sou_do_surface_dirty(struct vmw_private *dev_priv,
828 				 struct vmw_framebuffer *framebuffer,
829 				 struct drm_clip_rect *clips,
830 				 struct drm_vmw_rect *vclips,
831 				 struct vmw_resource *srf,
832 				 s32 dest_x,
833 				 s32 dest_y,
834 				 unsigned num_clips, int inc,
835 				 struct vmw_fence_obj **out_fence)
836 {
837 	struct vmw_framebuffer_surface *vfbs =
838 		container_of(framebuffer, typeof(*vfbs), base);
839 	struct vmw_kms_sou_surface_dirty sdirty;
840 	int ret;
841 
842 	if (!srf)
843 		srf = &vfbs->surface->res;
844 
845 	ret = vmw_kms_helper_resource_prepare(srf, true);
846 	if (ret)
847 		return ret;
848 
849 	sdirty.base.fifo_commit = vmw_sou_surface_fifo_commit;
850 	sdirty.base.clip = vmw_sou_surface_clip;
851 	sdirty.base.dev_priv = dev_priv;
852 	sdirty.base.fifo_reserve_size = sizeof(struct vmw_kms_sou_dirty_cmd) +
853 	  sizeof(SVGASignedRect) * num_clips;
854 
855 	sdirty.sid = srf->id;
856 	sdirty.left = sdirty.top = S32_MAX;
857 	sdirty.right = sdirty.bottom = S32_MIN;
858 	sdirty.dst_x = dest_x;
859 	sdirty.dst_y = dest_y;
860 
861 	ret = vmw_kms_helper_dirty(dev_priv, framebuffer, clips, vclips,
862 				   dest_x, dest_y, num_clips, inc,
863 				   &sdirty.base);
864 	vmw_kms_helper_resource_finish(srf, out_fence);
865 
866 	return ret;
867 }
868 
869 /**
870  * vmw_sou_dmabuf_fifo_commit - Callback to submit a set of readback clips.
871  *
872  * @dirty: The closure structure.
873  *
874  * Commits a previously built command buffer of readback clips.
875  */
876 static void vmw_sou_dmabuf_fifo_commit(struct vmw_kms_dirty *dirty)
877 {
878 	vmw_fifo_commit(dirty->dev_priv,
879 			sizeof(struct vmw_kms_sou_dmabuf_blit) *
880 			dirty->num_hits);
881 }
882 
883 /**
884  * vmw_sou_dmabuf_clip - Callback to encode a readback cliprect.
885  *
886  * @dirty: The closure structure
887  *
888  * Encodes a BLIT_GMRFB_TO_SCREEN cliprect.
889  */
890 static void vmw_sou_dmabuf_clip(struct vmw_kms_dirty *dirty)
891 {
892 	struct vmw_kms_sou_dmabuf_blit *blit = dirty->cmd;
893 
894 	blit += dirty->num_hits;
895 	blit->header = SVGA_CMD_BLIT_GMRFB_TO_SCREEN;
896 	blit->body.destScreenId = dirty->unit->unit;
897 	blit->body.srcOrigin.x = dirty->fb_x;
898 	blit->body.srcOrigin.y = dirty->fb_y;
899 	blit->body.destRect.left = dirty->unit_x1;
900 	blit->body.destRect.top = dirty->unit_y1;
901 	blit->body.destRect.right = dirty->unit_x2;
902 	blit->body.destRect.bottom = dirty->unit_y2;
903 	dirty->num_hits++;
904 }
905 
906 /**
907  * vmw_kms_do_dmabuf_dirty - Dirty part of a dma-buffer backed framebuffer
908  *
909  * @dev_priv: Pointer to the device private structure.
910  * @framebuffer: Pointer to the dma-buffer backed framebuffer.
911  * @clips: Array of clip rects.
912  * @num_clips: Number of clip rects in @clips.
913  * @increment: Increment to use when looping over @clips.
914  * @interruptible: Whether to perform waits interruptible if possible.
915  * @out_fence: If non-NULL, will return a ref-counted pointer to a
916  * struct vmw_fence_obj. The returned fence pointer may be NULL in which
917  * case the device has already synchronized.
918  *
919  * Returns 0 on success, negative error code on failure. -ERESTARTSYS if
920  * interrupted.
921  */
922 int vmw_kms_sou_do_dmabuf_dirty(struct vmw_private *dev_priv,
923 				struct vmw_framebuffer *framebuffer,
924 				struct drm_clip_rect *clips,
925 				unsigned num_clips, int increment,
926 				bool interruptible,
927 				struct vmw_fence_obj **out_fence)
928 {
929 	struct vmw_dma_buffer *buf =
930 		container_of(framebuffer, struct vmw_framebuffer_dmabuf,
931 			     base)->buffer;
932 	struct vmw_kms_dirty dirty;
933 	int ret;
934 
935 	ret = vmw_kms_helper_buffer_prepare(dev_priv, buf, interruptible,
936 					    false);
937 	if (ret)
938 		return ret;
939 
940 	ret = do_dmabuf_define_gmrfb(dev_priv, framebuffer);
941 	if (unlikely(ret != 0))
942 		goto out_revert;
943 
944 	dirty.fifo_commit = vmw_sou_dmabuf_fifo_commit;
945 	dirty.clip = vmw_sou_dmabuf_clip;
946 	dirty.fifo_reserve_size = sizeof(struct vmw_kms_sou_dmabuf_blit) *
947 		num_clips;
948 	ret = vmw_kms_helper_dirty(dev_priv, framebuffer, clips, NULL,
949 				   0, 0, num_clips, increment, &dirty);
950 	vmw_kms_helper_buffer_finish(dev_priv, NULL, buf, out_fence, NULL);
951 
952 	return ret;
953 
954 out_revert:
955 	vmw_kms_helper_buffer_revert(buf);
956 
957 	return ret;
958 }
959 
960 
961 /**
962  * vmw_sou_readback_fifo_commit - Callback to submit a set of readback clips.
963  *
964  * @dirty: The closure structure.
965  *
966  * Commits a previously built command buffer of readback clips.
967  */
968 static void vmw_sou_readback_fifo_commit(struct vmw_kms_dirty *dirty)
969 {
970 	vmw_fifo_commit(dirty->dev_priv,
971 			sizeof(struct vmw_kms_sou_readback_blit) *
972 			dirty->num_hits);
973 }
974 
975 /**
976  * vmw_sou_readback_clip - Callback to encode a readback cliprect.
977  *
978  * @dirty: The closure structure
979  *
980  * Encodes a BLIT_SCREEN_TO_GMRFB cliprect.
981  */
982 static void vmw_sou_readback_clip(struct vmw_kms_dirty *dirty)
983 {
984 	struct vmw_kms_sou_readback_blit *blit = dirty->cmd;
985 
986 	blit += dirty->num_hits;
987 	blit->header = SVGA_CMD_BLIT_SCREEN_TO_GMRFB;
988 	blit->body.srcScreenId = dirty->unit->unit;
989 	blit->body.destOrigin.x = dirty->fb_x;
990 	blit->body.destOrigin.y = dirty->fb_y;
991 	blit->body.srcRect.left = dirty->unit_x1;
992 	blit->body.srcRect.top = dirty->unit_y1;
993 	blit->body.srcRect.right = dirty->unit_x2;
994 	blit->body.srcRect.bottom = dirty->unit_y2;
995 	dirty->num_hits++;
996 }
997 
998 /**
999  * vmw_kms_sou_readback - Perform a readback from the screen object system to
1000  * a dma-buffer backed framebuffer.
1001  *
1002  * @dev_priv: Pointer to the device private structure.
1003  * @file_priv: Pointer to a struct drm_file identifying the caller.
1004  * Must be set to NULL if @user_fence_rep is NULL.
1005  * @vfb: Pointer to the dma-buffer backed framebuffer.
1006  * @user_fence_rep: User-space provided structure for fence information.
1007  * Must be set to non-NULL if @file_priv is non-NULL.
1008  * @vclips: Array of clip rects.
1009  * @num_clips: Number of clip rects in @vclips.
1010  *
1011  * Returns 0 on success, negative error code on failure. -ERESTARTSYS if
1012  * interrupted.
1013  */
1014 int vmw_kms_sou_readback(struct vmw_private *dev_priv,
1015 			 struct drm_file *file_priv,
1016 			 struct vmw_framebuffer *vfb,
1017 			 struct drm_vmw_fence_rep __user *user_fence_rep,
1018 			 struct drm_vmw_rect *vclips,
1019 			 uint32_t num_clips)
1020 {
1021 	struct vmw_dma_buffer *buf =
1022 		container_of(vfb, struct vmw_framebuffer_dmabuf, base)->buffer;
1023 	struct vmw_kms_dirty dirty;
1024 	int ret;
1025 
1026 	ret = vmw_kms_helper_buffer_prepare(dev_priv, buf, true, false);
1027 	if (ret)
1028 		return ret;
1029 
1030 	ret = do_dmabuf_define_gmrfb(dev_priv, vfb);
1031 	if (unlikely(ret != 0))
1032 		goto out_revert;
1033 
1034 	dirty.fifo_commit = vmw_sou_readback_fifo_commit;
1035 	dirty.clip = vmw_sou_readback_clip;
1036 	dirty.fifo_reserve_size = sizeof(struct vmw_kms_sou_readback_blit) *
1037 		num_clips;
1038 	ret = vmw_kms_helper_dirty(dev_priv, vfb, NULL, vclips,
1039 				   0, 0, num_clips, 1, &dirty);
1040 	vmw_kms_helper_buffer_finish(dev_priv, file_priv, buf, NULL,
1041 				     user_fence_rep);
1042 
1043 	return ret;
1044 
1045 out_revert:
1046 	vmw_kms_helper_buffer_revert(buf);
1047 
1048 	return ret;
1049 }
1050