xref: /openbmc/linux/drivers/gpu/drm/qxl/qxl_display.c (revision 80ecbd24)
1 /*
2  * Copyright 2013 Red Hat Inc.
3  *
4  * Permission is hereby granted, free of charge, to any person obtaining a
5  * copy of this software and associated documentation files (the "Software"),
6  * to deal in the Software without restriction, including without limitation
7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8  * and/or sell copies of the Software, and to permit persons to whom the
9  * Software is furnished to do so, subject to the following conditions:
10  *
11  * The above copyright notice and this permission notice shall be included in
12  * all copies or substantial portions of the Software.
13  *
14  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
17  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20  * OTHER DEALINGS IN THE SOFTWARE.
21  *
22  * Authors: Dave Airlie
23  *          Alon Levy
24  */
25 
26 
27 #include "linux/crc32.h"
28 
29 #include "qxl_drv.h"
30 #include "qxl_object.h"
31 #include "drm_crtc_helper.h"
32 
33 static bool qxl_head_enabled(struct qxl_head *head)
34 {
35 	return head->width && head->height;
36 }
37 
38 void qxl_alloc_client_monitors_config(struct qxl_device *qdev, unsigned count)
39 {
40 	if (qdev->client_monitors_config &&
41 	    count > qdev->client_monitors_config->count) {
42 		kfree(qdev->client_monitors_config);
43 		qdev->client_monitors_config = NULL;
44 	}
45 	if (!qdev->client_monitors_config) {
46 		qdev->client_monitors_config = kzalloc(
47 				sizeof(struct qxl_monitors_config) +
48 				sizeof(struct qxl_head) * count, GFP_KERNEL);
49 		if (!qdev->client_monitors_config) {
50 			qxl_io_log(qdev,
51 				   "%s: allocation failure for %u heads\n",
52 				   __func__, count);
53 			return;
54 		}
55 	}
56 	qdev->client_monitors_config->count = count;
57 }
58 
59 static int qxl_display_copy_rom_client_monitors_config(struct qxl_device *qdev)
60 {
61 	int i;
62 	int num_monitors;
63 	uint32_t crc;
64 
65 	num_monitors = qdev->rom->client_monitors_config.count;
66 	crc = crc32(0, (const uint8_t *)&qdev->rom->client_monitors_config,
67 		  sizeof(qdev->rom->client_monitors_config));
68 	if (crc != qdev->rom->client_monitors_config_crc) {
69 		qxl_io_log(qdev, "crc mismatch: have %X (%d) != %X\n", crc,
70 			   sizeof(qdev->rom->client_monitors_config),
71 			   qdev->rom->client_monitors_config_crc);
72 		return 1;
73 	}
74 	if (num_monitors > qdev->monitors_config->max_allowed) {
75 		DRM_DEBUG_KMS("client monitors list will be truncated: %d < %d\n",
76 			      qdev->monitors_config->max_allowed, num_monitors);
77 		num_monitors = qdev->monitors_config->max_allowed;
78 	} else {
79 		num_monitors = qdev->rom->client_monitors_config.count;
80 	}
81 	qxl_alloc_client_monitors_config(qdev, num_monitors);
82 	/* we copy max from the client but it isn't used */
83 	qdev->client_monitors_config->max_allowed =
84 				qdev->monitors_config->max_allowed;
85 	for (i = 0 ; i < qdev->client_monitors_config->count ; ++i) {
86 		struct qxl_urect *c_rect =
87 			&qdev->rom->client_monitors_config.heads[i];
88 		struct qxl_head *client_head =
89 			&qdev->client_monitors_config->heads[i];
90 		client_head->x = c_rect->left;
91 		client_head->y = c_rect->top;
92 		client_head->width = c_rect->right - c_rect->left;
93 		client_head->height = c_rect->bottom - c_rect->top;
94 		client_head->surface_id = 0;
95 		client_head->id = i;
96 		client_head->flags = 0;
97 		DRM_DEBUG_KMS("read %dx%d+%d+%d\n", client_head->width, client_head->height,
98 			  client_head->x, client_head->y);
99 	}
100 	return 0;
101 }
102 
103 void qxl_display_read_client_monitors_config(struct qxl_device *qdev)
104 {
105 
106 	while (qxl_display_copy_rom_client_monitors_config(qdev)) {
107 		qxl_io_log(qdev, "failed crc check for client_monitors_config,"
108 				 " retrying\n");
109 	}
110 	drm_helper_hpd_irq_event(qdev->ddev);
111 }
112 
113 static int qxl_add_monitors_config_modes(struct drm_connector *connector)
114 {
115 	struct drm_device *dev = connector->dev;
116 	struct qxl_device *qdev = dev->dev_private;
117 	struct qxl_output *output = drm_connector_to_qxl_output(connector);
118 	int h = output->index;
119 	struct drm_display_mode *mode = NULL;
120 	struct qxl_head *head;
121 
122 	if (!qdev->client_monitors_config)
123 		return 0;
124 	head = &qdev->client_monitors_config->heads[h];
125 
126 	mode = drm_cvt_mode(dev, head->width, head->height, 60, false, false,
127 			    false);
128 	mode->type |= DRM_MODE_TYPE_PREFERRED;
129 	drm_mode_probed_add(connector, mode);
130 	return 1;
131 }
132 
133 static int qxl_add_common_modes(struct drm_connector *connector)
134 {
135 	struct drm_device *dev = connector->dev;
136 	struct drm_display_mode *mode = NULL;
137 	int i;
138 	struct mode_size {
139 		int w;
140 		int h;
141 	} common_modes[] = {
142 		{ 640,  480},
143 		{ 720,  480},
144 		{ 800,  600},
145 		{ 848,  480},
146 		{1024,  768},
147 		{1152,  768},
148 		{1280,  720},
149 		{1280,  800},
150 		{1280,  854},
151 		{1280,  960},
152 		{1280, 1024},
153 		{1440,  900},
154 		{1400, 1050},
155 		{1680, 1050},
156 		{1600, 1200},
157 		{1920, 1080},
158 		{1920, 1200}
159 	};
160 
161 	for (i = 0; i < ARRAY_SIZE(common_modes); i++) {
162 		if (common_modes[i].w < 320 || common_modes[i].h < 200)
163 			continue;
164 
165 		mode = drm_cvt_mode(dev, common_modes[i].w, common_modes[i].h,
166 				    60, false, false, false);
167 		if (common_modes[i].w == 1024 && common_modes[i].h == 768)
168 			mode->type |= DRM_MODE_TYPE_PREFERRED;
169 		drm_mode_probed_add(connector, mode);
170 	}
171 	return i - 1;
172 }
173 
174 static void qxl_crtc_destroy(struct drm_crtc *crtc)
175 {
176 	struct qxl_crtc *qxl_crtc = to_qxl_crtc(crtc);
177 
178 	drm_crtc_cleanup(crtc);
179 	kfree(qxl_crtc);
180 }
181 
182 static int
183 qxl_hide_cursor(struct qxl_device *qdev)
184 {
185 	struct qxl_release *release;
186 	struct qxl_cursor_cmd *cmd;
187 	int ret;
188 
189 	ret = qxl_alloc_release_reserved(qdev, sizeof(*cmd), QXL_RELEASE_CURSOR_CMD,
190 					 &release, NULL);
191 	if (ret)
192 		return ret;
193 
194 	ret = qxl_release_reserve_list(release, true);
195 	if (ret) {
196 		qxl_release_free(qdev, release);
197 		return ret;
198 	}
199 
200 	cmd = (struct qxl_cursor_cmd *)qxl_release_map(qdev, release);
201 	cmd->type = QXL_CURSOR_HIDE;
202 	qxl_release_unmap(qdev, release, &cmd->release_info);
203 
204 	qxl_push_cursor_ring_release(qdev, release, QXL_CMD_CURSOR, false);
205 	qxl_release_fence_buffer_objects(release);
206 	return 0;
207 }
208 
209 static int qxl_crtc_cursor_set2(struct drm_crtc *crtc,
210 				struct drm_file *file_priv,
211 				uint32_t handle,
212 				uint32_t width,
213 				uint32_t height, int32_t hot_x, int32_t hot_y)
214 {
215 	struct drm_device *dev = crtc->dev;
216 	struct qxl_device *qdev = dev->dev_private;
217 	struct qxl_crtc *qcrtc = to_qxl_crtc(crtc);
218 	struct drm_gem_object *obj;
219 	struct qxl_cursor *cursor;
220 	struct qxl_cursor_cmd *cmd;
221 	struct qxl_bo *cursor_bo, *user_bo;
222 	struct qxl_release *release;
223 	void *user_ptr;
224 
225 	int size = 64*64*4;
226 	int ret = 0;
227 	if (!handle)
228 		return qxl_hide_cursor(qdev);
229 
230 	obj = drm_gem_object_lookup(crtc->dev, file_priv, handle);
231 	if (!obj) {
232 		DRM_ERROR("cannot find cursor object\n");
233 		return -ENOENT;
234 	}
235 
236 	user_bo = gem_to_qxl_bo(obj);
237 
238 	ret = qxl_bo_reserve(user_bo, false);
239 	if (ret)
240 		goto out_unref;
241 
242 	ret = qxl_bo_pin(user_bo, QXL_GEM_DOMAIN_CPU, NULL);
243 	qxl_bo_unreserve(user_bo);
244 	if (ret)
245 		goto out_unref;
246 
247 	ret = qxl_bo_kmap(user_bo, &user_ptr);
248 	if (ret)
249 		goto out_unpin;
250 
251 	ret = qxl_alloc_release_reserved(qdev, sizeof(*cmd),
252 					 QXL_RELEASE_CURSOR_CMD,
253 					 &release, NULL);
254 	if (ret)
255 		goto out_kunmap;
256 
257 	ret = qxl_alloc_bo_reserved(qdev, release, sizeof(struct qxl_cursor) + size,
258 			   &cursor_bo);
259 	if (ret)
260 		goto out_free_release;
261 
262 	ret = qxl_release_reserve_list(release, false);
263 	if (ret)
264 		goto out_free_bo;
265 
266 	ret = qxl_bo_kmap(cursor_bo, (void **)&cursor);
267 	if (ret)
268 		goto out_backoff;
269 
270 	cursor->header.unique = 0;
271 	cursor->header.type = SPICE_CURSOR_TYPE_ALPHA;
272 	cursor->header.width = 64;
273 	cursor->header.height = 64;
274 	cursor->header.hot_spot_x = hot_x;
275 	cursor->header.hot_spot_y = hot_y;
276 	cursor->data_size = size;
277 	cursor->chunk.next_chunk = 0;
278 	cursor->chunk.prev_chunk = 0;
279 	cursor->chunk.data_size = size;
280 
281 	memcpy(cursor->chunk.data, user_ptr, size);
282 
283 	qxl_bo_kunmap(cursor_bo);
284 
285 	qxl_bo_kunmap(user_bo);
286 
287 	cmd = (struct qxl_cursor_cmd *)qxl_release_map(qdev, release);
288 	cmd->type = QXL_CURSOR_SET;
289 	cmd->u.set.position.x = qcrtc->cur_x;
290 	cmd->u.set.position.y = qcrtc->cur_y;
291 
292 	cmd->u.set.shape = qxl_bo_physical_address(qdev, cursor_bo, 0);
293 
294 	cmd->u.set.visible = 1;
295 	qxl_release_unmap(qdev, release, &cmd->release_info);
296 
297 	qxl_push_cursor_ring_release(qdev, release, QXL_CMD_CURSOR, false);
298 	qxl_release_fence_buffer_objects(release);
299 
300 	/* finish with the userspace bo */
301 	ret = qxl_bo_reserve(user_bo, false);
302 	if (!ret) {
303 		qxl_bo_unpin(user_bo);
304 		qxl_bo_unreserve(user_bo);
305 	}
306 	drm_gem_object_unreference_unlocked(obj);
307 
308 	qxl_bo_unref(&cursor_bo);
309 
310 	return ret;
311 
312 out_backoff:
313 	qxl_release_backoff_reserve_list(release);
314 out_free_bo:
315 	qxl_bo_unref(&cursor_bo);
316 out_free_release:
317 	qxl_release_free(qdev, release);
318 out_kunmap:
319 	qxl_bo_kunmap(user_bo);
320 out_unpin:
321 	qxl_bo_unpin(user_bo);
322 out_unref:
323 	drm_gem_object_unreference_unlocked(obj);
324 	return ret;
325 }
326 
327 static int qxl_crtc_cursor_move(struct drm_crtc *crtc,
328 				int x, int y)
329 {
330 	struct drm_device *dev = crtc->dev;
331 	struct qxl_device *qdev = dev->dev_private;
332 	struct qxl_crtc *qcrtc = to_qxl_crtc(crtc);
333 	struct qxl_release *release;
334 	struct qxl_cursor_cmd *cmd;
335 	int ret;
336 
337 	ret = qxl_alloc_release_reserved(qdev, sizeof(*cmd), QXL_RELEASE_CURSOR_CMD,
338 				   &release, NULL);
339 	if (ret)
340 		return ret;
341 
342 	ret = qxl_release_reserve_list(release, true);
343 	if (ret) {
344 		qxl_release_free(qdev, release);
345 		return ret;
346 	}
347 
348 	qcrtc->cur_x = x;
349 	qcrtc->cur_y = y;
350 
351 	cmd = (struct qxl_cursor_cmd *)qxl_release_map(qdev, release);
352 	cmd->type = QXL_CURSOR_MOVE;
353 	cmd->u.position.x = qcrtc->cur_x;
354 	cmd->u.position.y = qcrtc->cur_y;
355 	qxl_release_unmap(qdev, release, &cmd->release_info);
356 
357 	qxl_push_cursor_ring_release(qdev, release, QXL_CMD_CURSOR, false);
358 	qxl_release_fence_buffer_objects(release);
359 
360 	return 0;
361 }
362 
363 
364 static const struct drm_crtc_funcs qxl_crtc_funcs = {
365 	.cursor_set2 = qxl_crtc_cursor_set2,
366 	.cursor_move = qxl_crtc_cursor_move,
367 	.set_config = drm_crtc_helper_set_config,
368 	.destroy = qxl_crtc_destroy,
369 };
370 
371 static void qxl_user_framebuffer_destroy(struct drm_framebuffer *fb)
372 {
373 	struct qxl_framebuffer *qxl_fb = to_qxl_framebuffer(fb);
374 
375 	if (qxl_fb->obj)
376 		drm_gem_object_unreference_unlocked(qxl_fb->obj);
377 	drm_framebuffer_cleanup(fb);
378 	kfree(qxl_fb);
379 }
380 
381 static int qxl_framebuffer_surface_dirty(struct drm_framebuffer *fb,
382 					 struct drm_file *file_priv,
383 					 unsigned flags, unsigned color,
384 					 struct drm_clip_rect *clips,
385 					 unsigned num_clips)
386 {
387 	/* TODO: vmwgfx where this was cribbed from had locking. Why? */
388 	struct qxl_framebuffer *qxl_fb = to_qxl_framebuffer(fb);
389 	struct qxl_device *qdev = qxl_fb->base.dev->dev_private;
390 	struct drm_clip_rect norect;
391 	struct qxl_bo *qobj;
392 	int inc = 1;
393 
394 	qobj = gem_to_qxl_bo(qxl_fb->obj);
395 	/* if we aren't primary surface ignore this */
396 	if (!qobj->is_primary)
397 		return 0;
398 
399 	if (!num_clips) {
400 		num_clips = 1;
401 		clips = &norect;
402 		norect.x1 = norect.y1 = 0;
403 		norect.x2 = fb->width;
404 		norect.y2 = fb->height;
405 	} else if (flags & DRM_MODE_FB_DIRTY_ANNOTATE_COPY) {
406 		num_clips /= 2;
407 		inc = 2; /* skip source rects */
408 	}
409 
410 	qxl_draw_dirty_fb(qdev, qxl_fb, qobj, flags, color,
411 			  clips, num_clips, inc);
412 	return 0;
413 }
414 
415 static const struct drm_framebuffer_funcs qxl_fb_funcs = {
416 	.destroy = qxl_user_framebuffer_destroy,
417 	.dirty = qxl_framebuffer_surface_dirty,
418 /*	TODO?
419  *	.create_handle = qxl_user_framebuffer_create_handle, */
420 };
421 
422 int
423 qxl_framebuffer_init(struct drm_device *dev,
424 		     struct qxl_framebuffer *qfb,
425 		     struct drm_mode_fb_cmd2 *mode_cmd,
426 		     struct drm_gem_object *obj)
427 {
428 	int ret;
429 
430 	qfb->obj = obj;
431 	ret = drm_framebuffer_init(dev, &qfb->base, &qxl_fb_funcs);
432 	if (ret) {
433 		qfb->obj = NULL;
434 		return ret;
435 	}
436 	drm_helper_mode_fill_fb_struct(&qfb->base, mode_cmd);
437 	return 0;
438 }
439 
440 static void qxl_crtc_dpms(struct drm_crtc *crtc, int mode)
441 {
442 }
443 
444 static bool qxl_crtc_mode_fixup(struct drm_crtc *crtc,
445 				  const struct drm_display_mode *mode,
446 				  struct drm_display_mode *adjusted_mode)
447 {
448 	struct drm_device *dev = crtc->dev;
449 	struct qxl_device *qdev = dev->dev_private;
450 
451 	qxl_io_log(qdev, "%s: (%d,%d) => (%d,%d)\n",
452 		   __func__,
453 		   mode->hdisplay, mode->vdisplay,
454 		   adjusted_mode->hdisplay,
455 		   adjusted_mode->vdisplay);
456 	return true;
457 }
458 
459 void
460 qxl_send_monitors_config(struct qxl_device *qdev)
461 {
462 	int i;
463 
464 	BUG_ON(!qdev->ram_header->monitors_config);
465 
466 	if (qdev->monitors_config->count == 0) {
467 		qxl_io_log(qdev, "%s: 0 monitors??\n", __func__);
468 		return;
469 	}
470 	for (i = 0 ; i < qdev->monitors_config->count ; ++i) {
471 		struct qxl_head *head = &qdev->monitors_config->heads[i];
472 
473 		if (head->y > 8192 || head->x > 8192 ||
474 		    head->width > 8192 || head->height > 8192) {
475 			DRM_ERROR("head %d wrong: %dx%d+%d+%d\n",
476 				  i, head->width, head->height,
477 				  head->x, head->y);
478 			return;
479 		}
480 	}
481 	qxl_io_monitors_config(qdev);
482 }
483 
484 static void qxl_monitors_config_set(struct qxl_device *qdev,
485 				    int index,
486 				    unsigned x, unsigned y,
487 				    unsigned width, unsigned height,
488 				    unsigned surf_id)
489 {
490 	DRM_DEBUG_KMS("%d:%dx%d+%d+%d\n", index, width, height, x, y);
491 	qdev->monitors_config->heads[index].x = x;
492 	qdev->monitors_config->heads[index].y = y;
493 	qdev->monitors_config->heads[index].width = width;
494 	qdev->monitors_config->heads[index].height = height;
495 	qdev->monitors_config->heads[index].surface_id = surf_id;
496 
497 }
498 
499 static int qxl_crtc_mode_set(struct drm_crtc *crtc,
500 			       struct drm_display_mode *mode,
501 			       struct drm_display_mode *adjusted_mode,
502 			       int x, int y,
503 			       struct drm_framebuffer *old_fb)
504 {
505 	struct drm_device *dev = crtc->dev;
506 	struct qxl_device *qdev = dev->dev_private;
507 	struct qxl_mode *m = (void *)mode->private;
508 	struct qxl_framebuffer *qfb;
509 	struct qxl_bo *bo, *old_bo = NULL;
510 	struct qxl_crtc *qcrtc = to_qxl_crtc(crtc);
511 	uint32_t width, height, base_offset;
512 	bool recreate_primary = false;
513 	int ret;
514 	int surf_id;
515 	if (!crtc->fb) {
516 		DRM_DEBUG_KMS("No FB bound\n");
517 		return 0;
518 	}
519 
520 	if (old_fb) {
521 		qfb = to_qxl_framebuffer(old_fb);
522 		old_bo = gem_to_qxl_bo(qfb->obj);
523 	}
524 	qfb = to_qxl_framebuffer(crtc->fb);
525 	bo = gem_to_qxl_bo(qfb->obj);
526 	if (!m)
527 		/* and do we care? */
528 		DRM_DEBUG("%dx%d: not a native mode\n", x, y);
529 	else
530 		DRM_DEBUG("%dx%d: qxl id %d\n",
531 			  mode->hdisplay, mode->vdisplay, m->id);
532 	DRM_DEBUG("+%d+%d (%d,%d) => (%d,%d)\n",
533 		  x, y,
534 		  mode->hdisplay, mode->vdisplay,
535 		  adjusted_mode->hdisplay,
536 		  adjusted_mode->vdisplay);
537 
538 	if (qcrtc->index == 0)
539 		recreate_primary = true;
540 
541 	width = mode->hdisplay;
542 	height = mode->vdisplay;
543 	base_offset = 0;
544 
545 	ret = qxl_bo_reserve(bo, false);
546 	if (ret != 0)
547 		return ret;
548 	ret = qxl_bo_pin(bo, bo->type, NULL);
549 	if (ret != 0) {
550 		qxl_bo_unreserve(bo);
551 		return -EINVAL;
552 	}
553 	qxl_bo_unreserve(bo);
554 	if (recreate_primary) {
555 		qxl_io_destroy_primary(qdev);
556 		qxl_io_log(qdev,
557 			   "recreate primary: %dx%d (was %dx%d,%d,%d)\n",
558 			   width, height, bo->surf.width,
559 			   bo->surf.height, bo->surf.stride, bo->surf.format);
560 		qxl_io_create_primary(qdev, base_offset, bo);
561 		bo->is_primary = true;
562 		surf_id = 0;
563 	} else {
564 		surf_id = bo->surface_id;
565 	}
566 
567 	if (old_bo && old_bo != bo) {
568 		old_bo->is_primary = false;
569 		ret = qxl_bo_reserve(old_bo, false);
570 		qxl_bo_unpin(old_bo);
571 		qxl_bo_unreserve(old_bo);
572 	}
573 
574 	qxl_monitors_config_set(qdev, qcrtc->index, x, y,
575 				mode->hdisplay,
576 				mode->vdisplay, surf_id);
577 	return 0;
578 }
579 
580 static void qxl_crtc_prepare(struct drm_crtc *crtc)
581 {
582 	DRM_DEBUG("current: %dx%d+%d+%d (%d).\n",
583 		  crtc->mode.hdisplay, crtc->mode.vdisplay,
584 		  crtc->x, crtc->y, crtc->enabled);
585 }
586 
587 static void qxl_crtc_commit(struct drm_crtc *crtc)
588 {
589 	DRM_DEBUG("\n");
590 }
591 
592 static void qxl_crtc_disable(struct drm_crtc *crtc)
593 {
594 	struct qxl_crtc *qcrtc = to_qxl_crtc(crtc);
595 	struct drm_device *dev = crtc->dev;
596 	struct qxl_device *qdev = dev->dev_private;
597 	if (crtc->fb) {
598 		struct qxl_framebuffer *qfb = to_qxl_framebuffer(crtc->fb);
599 		struct qxl_bo *bo = gem_to_qxl_bo(qfb->obj);
600 		int ret;
601 		ret = qxl_bo_reserve(bo, false);
602 		qxl_bo_unpin(bo);
603 		qxl_bo_unreserve(bo);
604 		crtc->fb = NULL;
605 	}
606 
607 	qxl_monitors_config_set(qdev, qcrtc->index, 0, 0, 0, 0, 0);
608 
609 	qxl_send_monitors_config(qdev);
610 }
611 
612 static const struct drm_crtc_helper_funcs qxl_crtc_helper_funcs = {
613 	.dpms = qxl_crtc_dpms,
614 	.disable = qxl_crtc_disable,
615 	.mode_fixup = qxl_crtc_mode_fixup,
616 	.mode_set = qxl_crtc_mode_set,
617 	.prepare = qxl_crtc_prepare,
618 	.commit = qxl_crtc_commit,
619 };
620 
621 static int qdev_crtc_init(struct drm_device *dev, int crtc_id)
622 {
623 	struct qxl_crtc *qxl_crtc;
624 
625 	qxl_crtc = kzalloc(sizeof(struct qxl_crtc), GFP_KERNEL);
626 	if (!qxl_crtc)
627 		return -ENOMEM;
628 
629 	drm_crtc_init(dev, &qxl_crtc->base, &qxl_crtc_funcs);
630 	qxl_crtc->index = crtc_id;
631 	drm_mode_crtc_set_gamma_size(&qxl_crtc->base, 256);
632 	drm_crtc_helper_add(&qxl_crtc->base, &qxl_crtc_helper_funcs);
633 	return 0;
634 }
635 
636 static void qxl_enc_dpms(struct drm_encoder *encoder, int mode)
637 {
638 	DRM_DEBUG("\n");
639 }
640 
641 static bool qxl_enc_mode_fixup(struct drm_encoder *encoder,
642 			       const struct drm_display_mode *mode,
643 			       struct drm_display_mode *adjusted_mode)
644 {
645 	DRM_DEBUG("\n");
646 	return true;
647 }
648 
649 static void qxl_enc_prepare(struct drm_encoder *encoder)
650 {
651 	DRM_DEBUG("\n");
652 }
653 
654 static void qxl_write_monitors_config_for_encoder(struct qxl_device *qdev,
655 		struct drm_encoder *encoder)
656 {
657 	int i;
658 	struct qxl_output *output = drm_encoder_to_qxl_output(encoder);
659 	struct qxl_head *head;
660 	struct drm_display_mode *mode;
661 
662 	BUG_ON(!encoder);
663 	/* TODO: ugly, do better */
664 	i = output->index;
665 	if (!qdev->monitors_config ||
666 	    qdev->monitors_config->max_allowed <= i) {
667 		DRM_ERROR(
668 		"head number too large or missing monitors config: %p, %d",
669 		qdev->monitors_config,
670 		qdev->monitors_config ?
671 			qdev->monitors_config->max_allowed : -1);
672 		return;
673 	}
674 	if (!encoder->crtc) {
675 		DRM_ERROR("missing crtc on encoder %p\n", encoder);
676 		return;
677 	}
678 	if (i != 0)
679 		DRM_DEBUG("missing for multiple monitors: no head holes\n");
680 	head = &qdev->monitors_config->heads[i];
681 	head->id = i;
682 	if (encoder->crtc->enabled) {
683 		mode = &encoder->crtc->mode;
684 		head->width = mode->hdisplay;
685 		head->height = mode->vdisplay;
686 		head->x = encoder->crtc->x;
687 		head->y = encoder->crtc->y;
688 		if (qdev->monitors_config->count < i + 1)
689 			qdev->monitors_config->count = i + 1;
690 	} else {
691 		head->width = 0;
692 		head->height = 0;
693 		head->x = 0;
694 		head->y = 0;
695 	}
696 	DRM_DEBUG_KMS("setting head %d to +%d+%d %dx%d out of %d\n",
697 		      i, head->x, head->y, head->width, head->height, qdev->monitors_config->count);
698 	head->flags = 0;
699 	/* TODO - somewhere else to call this for multiple monitors
700 	 * (config_commit?) */
701 	qxl_send_monitors_config(qdev);
702 }
703 
704 static void qxl_enc_commit(struct drm_encoder *encoder)
705 {
706 	struct qxl_device *qdev = encoder->dev->dev_private;
707 
708 	qxl_write_monitors_config_for_encoder(qdev, encoder);
709 	DRM_DEBUG("\n");
710 }
711 
712 static void qxl_enc_mode_set(struct drm_encoder *encoder,
713 				struct drm_display_mode *mode,
714 				struct drm_display_mode *adjusted_mode)
715 {
716 	DRM_DEBUG("\n");
717 }
718 
719 static int qxl_conn_get_modes(struct drm_connector *connector)
720 {
721 	int ret = 0;
722 	struct qxl_device *qdev = connector->dev->dev_private;
723 
724 	DRM_DEBUG_KMS("monitors_config=%p\n", qdev->monitors_config);
725 	/* TODO: what should we do here? only show the configured modes for the
726 	 * device, or allow the full list, or both? */
727 	if (qdev->monitors_config && qdev->monitors_config->count) {
728 		ret = qxl_add_monitors_config_modes(connector);
729 		if (ret < 0)
730 			return ret;
731 	}
732 	ret += qxl_add_common_modes(connector);
733 	return ret;
734 }
735 
736 static int qxl_conn_mode_valid(struct drm_connector *connector,
737 			       struct drm_display_mode *mode)
738 {
739 	/* TODO: is this called for user defined modes? (xrandr --add-mode)
740 	 * TODO: check that the mode fits in the framebuffer */
741 	DRM_DEBUG("%s: %dx%d status=%d\n", mode->name, mode->hdisplay,
742 		  mode->vdisplay, mode->status);
743 	return MODE_OK;
744 }
745 
746 static struct drm_encoder *qxl_best_encoder(struct drm_connector *connector)
747 {
748 	struct qxl_output *qxl_output =
749 		drm_connector_to_qxl_output(connector);
750 
751 	DRM_DEBUG("\n");
752 	return &qxl_output->enc;
753 }
754 
755 
756 static const struct drm_encoder_helper_funcs qxl_enc_helper_funcs = {
757 	.dpms = qxl_enc_dpms,
758 	.mode_fixup = qxl_enc_mode_fixup,
759 	.prepare = qxl_enc_prepare,
760 	.mode_set = qxl_enc_mode_set,
761 	.commit = qxl_enc_commit,
762 };
763 
764 static const struct drm_connector_helper_funcs qxl_connector_helper_funcs = {
765 	.get_modes = qxl_conn_get_modes,
766 	.mode_valid = qxl_conn_mode_valid,
767 	.best_encoder = qxl_best_encoder,
768 };
769 
770 static void qxl_conn_save(struct drm_connector *connector)
771 {
772 	DRM_DEBUG("\n");
773 }
774 
775 static void qxl_conn_restore(struct drm_connector *connector)
776 {
777 	DRM_DEBUG("\n");
778 }
779 
780 static enum drm_connector_status qxl_conn_detect(
781 			struct drm_connector *connector,
782 			bool force)
783 {
784 	struct qxl_output *output =
785 		drm_connector_to_qxl_output(connector);
786 	struct drm_device *ddev = connector->dev;
787 	struct qxl_device *qdev = ddev->dev_private;
788 	int connected;
789 
790 	/* The first monitor is always connected */
791 	connected = (output->index == 0) ||
792 		    (qdev->client_monitors_config &&
793 		     qdev->client_monitors_config->count > output->index &&
794 		     qxl_head_enabled(&qdev->client_monitors_config->heads[output->index]));
795 
796 	DRM_DEBUG("\n");
797 	return connected ? connector_status_connected
798 			 : connector_status_disconnected;
799 }
800 
801 static int qxl_conn_set_property(struct drm_connector *connector,
802 				   struct drm_property *property,
803 				   uint64_t value)
804 {
805 	DRM_DEBUG("\n");
806 	return 0;
807 }
808 
809 static void qxl_conn_destroy(struct drm_connector *connector)
810 {
811 	struct qxl_output *qxl_output =
812 		drm_connector_to_qxl_output(connector);
813 
814 	drm_sysfs_connector_remove(connector);
815 	drm_connector_cleanup(connector);
816 	kfree(qxl_output);
817 }
818 
819 static const struct drm_connector_funcs qxl_connector_funcs = {
820 	.dpms = drm_helper_connector_dpms,
821 	.save = qxl_conn_save,
822 	.restore = qxl_conn_restore,
823 	.detect = qxl_conn_detect,
824 	.fill_modes = drm_helper_probe_single_connector_modes,
825 	.set_property = qxl_conn_set_property,
826 	.destroy = qxl_conn_destroy,
827 };
828 
829 static void qxl_enc_destroy(struct drm_encoder *encoder)
830 {
831 	drm_encoder_cleanup(encoder);
832 }
833 
834 static const struct drm_encoder_funcs qxl_enc_funcs = {
835 	.destroy = qxl_enc_destroy,
836 };
837 
838 static int qdev_output_init(struct drm_device *dev, int num_output)
839 {
840 	struct qxl_output *qxl_output;
841 	struct drm_connector *connector;
842 	struct drm_encoder *encoder;
843 
844 	qxl_output = kzalloc(sizeof(struct qxl_output), GFP_KERNEL);
845 	if (!qxl_output)
846 		return -ENOMEM;
847 
848 	qxl_output->index = num_output;
849 
850 	connector = &qxl_output->base;
851 	encoder = &qxl_output->enc;
852 	drm_connector_init(dev, &qxl_output->base,
853 			   &qxl_connector_funcs, DRM_MODE_CONNECTOR_VIRTUAL);
854 
855 	drm_encoder_init(dev, &qxl_output->enc, &qxl_enc_funcs,
856 			 DRM_MODE_ENCODER_VIRTUAL);
857 
858 	/* we get HPD via client monitors config */
859 	connector->polled = DRM_CONNECTOR_POLL_HPD;
860 	encoder->possible_crtcs = 1 << num_output;
861 	drm_mode_connector_attach_encoder(&qxl_output->base,
862 					  &qxl_output->enc);
863 	drm_encoder_helper_add(encoder, &qxl_enc_helper_funcs);
864 	drm_connector_helper_add(connector, &qxl_connector_helper_funcs);
865 
866 	drm_sysfs_connector_add(connector);
867 	return 0;
868 }
869 
870 static struct drm_framebuffer *
871 qxl_user_framebuffer_create(struct drm_device *dev,
872 			    struct drm_file *file_priv,
873 			    struct drm_mode_fb_cmd2 *mode_cmd)
874 {
875 	struct drm_gem_object *obj;
876 	struct qxl_framebuffer *qxl_fb;
877 	int ret;
878 
879 	obj = drm_gem_object_lookup(dev, file_priv, mode_cmd->handles[0]);
880 
881 	qxl_fb = kzalloc(sizeof(*qxl_fb), GFP_KERNEL);
882 	if (qxl_fb == NULL)
883 		return NULL;
884 
885 	ret = qxl_framebuffer_init(dev, qxl_fb, mode_cmd, obj);
886 	if (ret) {
887 		kfree(qxl_fb);
888 		drm_gem_object_unreference_unlocked(obj);
889 		return NULL;
890 	}
891 
892 	return &qxl_fb->base;
893 }
894 
895 static const struct drm_mode_config_funcs qxl_mode_funcs = {
896 	.fb_create = qxl_user_framebuffer_create,
897 };
898 
899 int qxl_create_monitors_object(struct qxl_device *qdev)
900 {
901 	int ret;
902 	struct drm_gem_object *gobj;
903 	int max_allowed = qxl_num_crtc;
904 	int monitors_config_size = sizeof(struct qxl_monitors_config) +
905 		max_allowed * sizeof(struct qxl_head);
906 
907 	ret = qxl_gem_object_create(qdev, monitors_config_size, 0,
908 				    QXL_GEM_DOMAIN_VRAM,
909 				    false, false, NULL, &gobj);
910 	if (ret) {
911 		DRM_ERROR("%s: failed to create gem ret=%d\n", __func__, ret);
912 		return -ENOMEM;
913 	}
914 	qdev->monitors_config_bo = gem_to_qxl_bo(gobj);
915 
916 	ret = qxl_bo_reserve(qdev->monitors_config_bo, false);
917 	if (ret)
918 		return ret;
919 
920 	ret = qxl_bo_pin(qdev->monitors_config_bo, QXL_GEM_DOMAIN_VRAM, NULL);
921 	if (ret) {
922 		qxl_bo_unreserve(qdev->monitors_config_bo);
923 		return ret;
924 	}
925 
926 	qxl_bo_unreserve(qdev->monitors_config_bo);
927 
928 	qxl_bo_kmap(qdev->monitors_config_bo, NULL);
929 
930 	qdev->monitors_config = qdev->monitors_config_bo->kptr;
931 	qdev->ram_header->monitors_config =
932 		qxl_bo_physical_address(qdev, qdev->monitors_config_bo, 0);
933 
934 	memset(qdev->monitors_config, 0, monitors_config_size);
935 	qdev->monitors_config->max_allowed = max_allowed;
936 	return 0;
937 }
938 
939 int qxl_destroy_monitors_object(struct qxl_device *qdev)
940 {
941 	int ret;
942 
943 	qdev->monitors_config = NULL;
944 	qdev->ram_header->monitors_config = 0;
945 
946 	qxl_bo_kunmap(qdev->monitors_config_bo);
947 	ret = qxl_bo_reserve(qdev->monitors_config_bo, false);
948 	if (ret)
949 		return ret;
950 
951 	qxl_bo_unpin(qdev->monitors_config_bo);
952 	qxl_bo_unreserve(qdev->monitors_config_bo);
953 
954 	qxl_bo_unref(&qdev->monitors_config_bo);
955 	return 0;
956 }
957 
958 int qxl_modeset_init(struct qxl_device *qdev)
959 {
960 	int i;
961 	int ret;
962 
963 	drm_mode_config_init(qdev->ddev);
964 
965 	ret = qxl_create_monitors_object(qdev);
966 	if (ret)
967 		return ret;
968 
969 	qdev->ddev->mode_config.funcs = (void *)&qxl_mode_funcs;
970 
971 	/* modes will be validated against the framebuffer size */
972 	qdev->ddev->mode_config.min_width = 320;
973 	qdev->ddev->mode_config.min_height = 200;
974 	qdev->ddev->mode_config.max_width = 8192;
975 	qdev->ddev->mode_config.max_height = 8192;
976 
977 	qdev->ddev->mode_config.fb_base = qdev->vram_base;
978 	for (i = 0 ; i < qxl_num_crtc; ++i) {
979 		qdev_crtc_init(qdev->ddev, i);
980 		qdev_output_init(qdev->ddev, i);
981 	}
982 
983 	qdev->mode_info.mode_config_initialized = true;
984 
985 	/* primary surface must be created by this point, to allow
986 	 * issuing command queue commands and having them read by
987 	 * spice server. */
988 	qxl_fbdev_init(qdev);
989 	return 0;
990 }
991 
992 void qxl_modeset_fini(struct qxl_device *qdev)
993 {
994 	qxl_fbdev_fini(qdev);
995 
996 	qxl_destroy_monitors_object(qdev);
997 	if (qdev->mode_info.mode_config_initialized) {
998 		drm_mode_config_cleanup(qdev->ddev);
999 		qdev->mode_info.mode_config_initialized = false;
1000 	}
1001 }
1002