Linux Audio

Check our new training course

Loading...
v3.1
  1/**************************************************************************
  2 *
  3 * Copyright © 2007 David Airlie
  4 * Copyright © 2009 VMware, Inc., Palo Alto, CA., USA
  5 * All Rights Reserved.
  6 *
  7 * Permission is hereby granted, free of charge, to any person obtaining a
  8 * copy of this software and associated documentation files (the
  9 * "Software"), to deal in the Software without restriction, including
 10 * without limitation the rights to use, copy, modify, merge, publish,
 11 * distribute, sub license, and/or sell copies of the Software, and to
 12 * permit persons to whom the Software is furnished to do so, subject to
 13 * the following conditions:
 14 *
 15 * The above copyright notice and this permission notice (including the
 16 * next paragraph) shall be included in all copies or substantial portions
 17 * of the Software.
 18 *
 19 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 20 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 21 * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
 22 * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
 23 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
 24 * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
 25 * USE OR OTHER DEALINGS IN THE SOFTWARE.
 26 *
 27 **************************************************************************/
 28
 29#include "drmP.h"
 
 
 30#include "vmwgfx_drv.h"
 
 31
 32#include "ttm/ttm_placement.h"
 33
 34#define VMW_DIRTY_DELAY (HZ / 30)
 35
 36struct vmw_fb_par {
 37	struct vmw_private *vmw_priv;
 38
 39	void *vmalloc;
 40
 
 41	struct vmw_dma_buffer *vmw_bo;
 42	struct ttm_bo_kmap_obj map;
 
 
 
 
 
 
 
 43
 44	u32 pseudo_palette[17];
 45
 46	unsigned depth;
 47	unsigned bpp;
 48
 49	unsigned max_width;
 50	unsigned max_height;
 51
 52	void *bo_ptr;
 53	unsigned bo_size;
 54	bool bo_iowrite;
 55
 56	struct {
 57		spinlock_t lock;
 58		bool active;
 59		unsigned x1;
 60		unsigned y1;
 61		unsigned x2;
 62		unsigned y2;
 63	} dirty;
 
 
 
 
 64};
 65
 66static int vmw_fb_setcolreg(unsigned regno, unsigned red, unsigned green,
 67			    unsigned blue, unsigned transp,
 68			    struct fb_info *info)
 69{
 70	struct vmw_fb_par *par = info->par;
 71	u32 *pal = par->pseudo_palette;
 72
 73	if (regno > 15) {
 74		DRM_ERROR("Bad regno %u.\n", regno);
 75		return 1;
 76	}
 77
 78	switch (par->depth) {
 79	case 24:
 80	case 32:
 81		pal[regno] = ((red & 0xff00) << 8) |
 82			      (green & 0xff00) |
 83			     ((blue  & 0xff00) >> 8);
 84		break;
 85	default:
 86		DRM_ERROR("Bad depth %u, bpp %u.\n", par->depth, par->bpp);
 
 87		return 1;
 88	}
 89
 90	return 0;
 91}
 92
 93static int vmw_fb_check_var(struct fb_var_screeninfo *var,
 94			    struct fb_info *info)
 95{
 96	int depth = var->bits_per_pixel;
 97	struct vmw_fb_par *par = info->par;
 98	struct vmw_private *vmw_priv = par->vmw_priv;
 99
100	switch (var->bits_per_pixel) {
101	case 32:
102		depth = (var->transp.length > 0) ? 32 : 24;
103		break;
104	default:
105		DRM_ERROR("Bad bpp %u.\n", var->bits_per_pixel);
106		return -EINVAL;
107	}
108
109	switch (depth) {
110	case 24:
111		var->red.offset = 16;
112		var->green.offset = 8;
113		var->blue.offset = 0;
114		var->red.length = 8;
115		var->green.length = 8;
116		var->blue.length = 8;
117		var->transp.length = 0;
118		var->transp.offset = 0;
119		break;
120	case 32:
121		var->red.offset = 16;
122		var->green.offset = 8;
123		var->blue.offset = 0;
124		var->red.length = 8;
125		var->green.length = 8;
126		var->blue.length = 8;
127		var->transp.length = 8;
128		var->transp.offset = 24;
129		break;
130	default:
131		DRM_ERROR("Bad depth %u.\n", depth);
132		return -EINVAL;
133	}
134
135	if (!(vmw_priv->capabilities & SVGA_CAP_DISPLAY_TOPOLOGY) &&
136	    (var->xoffset != 0 || var->yoffset != 0)) {
137		DRM_ERROR("Can not handle panning without display topology\n");
138		return -EINVAL;
139	}
140
141	if ((var->xoffset + var->xres) > par->max_width ||
142	    (var->yoffset + var->yres) > par->max_height) {
143		DRM_ERROR("Requested geom can not fit in framebuffer\n");
144		return -EINVAL;
145	}
146
147	if (!vmw_kms_validate_mode_vram(vmw_priv,
148					info->fix.line_length,
149					var->yoffset + var->yres)) {
150		DRM_ERROR("Requested geom can not fit in framebuffer\n");
151		return -EINVAL;
152	}
153
154	return 0;
155}
156
157static int vmw_fb_set_par(struct fb_info *info)
158{
159	struct vmw_fb_par *par = info->par;
160	struct vmw_private *vmw_priv = par->vmw_priv;
161
162	vmw_kms_write_svga(vmw_priv, info->var.xres, info->var.yres,
163			   info->fix.line_length,
164			   par->bpp, par->depth);
165	if (vmw_priv->capabilities & SVGA_CAP_DISPLAY_TOPOLOGY) {
166		/* TODO check if pitch and offset changes */
167		vmw_write(vmw_priv, SVGA_REG_NUM_GUEST_DISPLAYS, 1);
168		vmw_write(vmw_priv, SVGA_REG_DISPLAY_ID, 0);
169		vmw_write(vmw_priv, SVGA_REG_DISPLAY_IS_PRIMARY, true);
170		vmw_write(vmw_priv, SVGA_REG_DISPLAY_POSITION_X, info->var.xoffset);
171		vmw_write(vmw_priv, SVGA_REG_DISPLAY_POSITION_Y, info->var.yoffset);
172		vmw_write(vmw_priv, SVGA_REG_DISPLAY_WIDTH, info->var.xres);
173		vmw_write(vmw_priv, SVGA_REG_DISPLAY_HEIGHT, info->var.yres);
174		vmw_write(vmw_priv, SVGA_REG_DISPLAY_ID, SVGA_ID_INVALID);
175	}
176
177	/* This is really helpful since if this fails the user
178	 * can probably not see anything on the screen.
179	 */
180	WARN_ON(vmw_read(vmw_priv, SVGA_REG_FB_OFFSET) != 0);
181
182	return 0;
183}
184
185static int vmw_fb_pan_display(struct fb_var_screeninfo *var,
186			      struct fb_info *info)
187{
188	return 0;
189}
190
191static int vmw_fb_blank(int blank, struct fb_info *info)
192{
193	return 0;
194}
195
196/*
197 * Dirty code
198 */
199
200static void vmw_fb_dirty_flush(struct vmw_fb_par *par)
201{
 
 
202	struct vmw_private *vmw_priv = par->vmw_priv;
203	struct fb_info *info = vmw_priv->fb_info;
204	int stride = (info->fix.line_length / 4);
205	int *src = (int *)info->screen_base;
206	__le32 __iomem *vram_mem = par->bo_ptr;
207	unsigned long flags;
208	unsigned x, y, w, h;
209	int i, k;
210	struct {
211		uint32_t header;
212		SVGAFifoCmdUpdate body;
213	} *cmd;
214
215	if (vmw_priv->suspended)
216		return;
217
218	spin_lock_irqsave(&par->dirty.lock, flags);
 
 
 
 
 
219	if (!par->dirty.active) {
220		spin_unlock_irqrestore(&par->dirty.lock, flags);
221		return;
222	}
223	x = par->dirty.x1;
224	y = par->dirty.y1;
225	w = min(par->dirty.x2, info->var.xres) - x;
226	h = min(par->dirty.y2, info->var.yres) - y;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
227	par->dirty.x1 = par->dirty.x2 = 0;
228	par->dirty.y1 = par->dirty.y2 = 0;
229	spin_unlock_irqrestore(&par->dirty.lock, flags);
230
231	for (i = y * stride; i < info->fix.smem_len / 4; i += stride) {
232		for (k = i+x; k < i+x+w && k < info->fix.smem_len / 4; k++)
233			iowrite32(src[k], vram_mem + k);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
234	}
235
236#if 0
237	DRM_INFO("%s, (%u, %u) (%ux%u)\n", __func__, x, y, w, h);
238#endif
239
240	cmd = vmw_fifo_reserve(vmw_priv, sizeof(*cmd));
241	if (unlikely(cmd == NULL)) {
242		DRM_ERROR("Fifo reserve failed.\n");
243		return;
244	}
245
246	cmd->header = cpu_to_le32(SVGA_CMD_UPDATE);
247	cmd->body.x = cpu_to_le32(x);
248	cmd->body.y = cpu_to_le32(y);
249	cmd->body.width = cpu_to_le32(w);
250	cmd->body.height = cpu_to_le32(h);
251	vmw_fifo_commit(vmw_priv, sizeof(*cmd));
252}
253
254static void vmw_fb_dirty_mark(struct vmw_fb_par *par,
255			      unsigned x1, unsigned y1,
256			      unsigned width, unsigned height)
257{
258	struct fb_info *info = par->vmw_priv->fb_info;
259	unsigned long flags;
260	unsigned x2 = x1 + width;
261	unsigned y2 = y1 + height;
262
263	spin_lock_irqsave(&par->dirty.lock, flags);
264	if (par->dirty.x1 == par->dirty.x2) {
265		par->dirty.x1 = x1;
266		par->dirty.y1 = y1;
267		par->dirty.x2 = x2;
268		par->dirty.y2 = y2;
269		/* if we are active start the dirty work
270		 * we share the work with the defio system */
271		if (par->dirty.active)
272			schedule_delayed_work(&info->deferred_work, VMW_DIRTY_DELAY);
 
273	} else {
274		if (x1 < par->dirty.x1)
275			par->dirty.x1 = x1;
276		if (y1 < par->dirty.y1)
277			par->dirty.y1 = y1;
278		if (x2 > par->dirty.x2)
279			par->dirty.x2 = x2;
280		if (y2 > par->dirty.y2)
281			par->dirty.y2 = y2;
282	}
283	spin_unlock_irqrestore(&par->dirty.lock, flags);
284}
285
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
286static void vmw_deferred_io(struct fb_info *info,
287			    struct list_head *pagelist)
288{
289	struct vmw_fb_par *par = info->par;
290	unsigned long start, end, min, max;
291	unsigned long flags;
292	struct page *page;
293	int y1, y2;
294
295	min = ULONG_MAX;
296	max = 0;
297	list_for_each_entry(page, pagelist, lru) {
298		start = page->index << PAGE_SHIFT;
299		end = start + PAGE_SIZE - 1;
300		min = min(min, start);
301		max = max(max, end);
302	}
303
304	if (min < max) {
305		y1 = min / info->fix.line_length;
306		y2 = (max / info->fix.line_length) + 1;
307
308		spin_lock_irqsave(&par->dirty.lock, flags);
309		par->dirty.x1 = 0;
310		par->dirty.y1 = y1;
311		par->dirty.x2 = info->var.xres;
312		par->dirty.y2 = y2;
313		spin_unlock_irqrestore(&par->dirty.lock, flags);
314	}
315
316	vmw_fb_dirty_flush(par);
 
 
 
 
 
 
317};
318
319struct fb_deferred_io vmw_defio = {
320	.delay		= VMW_DIRTY_DELAY,
321	.deferred_io	= vmw_deferred_io,
322};
323
324/*
325 * Draw code
326 */
327
328static void vmw_fb_fillrect(struct fb_info *info, const struct fb_fillrect *rect)
329{
330	cfb_fillrect(info, rect);
331	vmw_fb_dirty_mark(info->par, rect->dx, rect->dy,
332			  rect->width, rect->height);
333}
334
335static void vmw_fb_copyarea(struct fb_info *info, const struct fb_copyarea *region)
336{
337	cfb_copyarea(info, region);
338	vmw_fb_dirty_mark(info->par, region->dx, region->dy,
339			  region->width, region->height);
340}
341
342static void vmw_fb_imageblit(struct fb_info *info, const struct fb_image *image)
343{
344	cfb_imageblit(info, image);
345	vmw_fb_dirty_mark(info->par, image->dx, image->dy,
346			  image->width, image->height);
347}
348
349/*
350 * Bring up code
351 */
352
353static struct fb_ops vmw_fb_ops = {
354	.owner = THIS_MODULE,
355	.fb_check_var = vmw_fb_check_var,
356	.fb_set_par = vmw_fb_set_par,
357	.fb_setcolreg = vmw_fb_setcolreg,
358	.fb_fillrect = vmw_fb_fillrect,
359	.fb_copyarea = vmw_fb_copyarea,
360	.fb_imageblit = vmw_fb_imageblit,
361	.fb_pan_display = vmw_fb_pan_display,
362	.fb_blank = vmw_fb_blank,
363};
364
365static int vmw_fb_create_bo(struct vmw_private *vmw_priv,
366			    size_t size, struct vmw_dma_buffer **out)
367{
368	struct vmw_dma_buffer *vmw_bo;
369	struct ttm_placement ne_placement = vmw_vram_ne_placement;
370	int ret;
371
372	ne_placement.lpfn = (size + PAGE_SIZE - 1) >> PAGE_SHIFT;
373
374	/* interuptable? */
375	ret = ttm_write_lock(&vmw_priv->fbdev_master.lock, false);
376	if (unlikely(ret != 0))
377		return ret;
378
379	vmw_bo = kmalloc(sizeof(*vmw_bo), GFP_KERNEL);
380	if (!vmw_bo)
 
381		goto err_unlock;
 
382
383	ret = vmw_dmabuf_init(vmw_priv, vmw_bo, size,
384			      &ne_placement,
385			      false,
386			      &vmw_dmabuf_bo_free);
387	if (unlikely(ret != 0))
388		goto err_unlock; /* init frees the buffer on failure */
389
390	*out = vmw_bo;
391
392	ttm_write_unlock(&vmw_priv->fbdev_master.lock);
393
394	return 0;
395
396err_unlock:
397	ttm_write_unlock(&vmw_priv->fbdev_master.lock);
398	return ret;
399}
400
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
401int vmw_fb_init(struct vmw_private *vmw_priv)
402{
403	struct device *device = &vmw_priv->dev->pdev->dev;
404	struct vmw_fb_par *par;
405	struct fb_info *info;
406	unsigned initial_width, initial_height;
407	unsigned fb_width, fb_height;
408	unsigned fb_bbp, fb_depth, fb_offset, fb_pitch, fb_size;
 
409	int ret;
410
411	/* XXX These shouldn't be hardcoded. */
412	initial_width = 800;
413	initial_height = 600;
414
415	fb_bbp = 32;
416	fb_depth = 24;
417
418	/* XXX As shouldn't these be as well. */
419	fb_width = min(vmw_priv->fb_max_width, (unsigned)2048);
420	fb_height = min(vmw_priv->fb_max_height, (unsigned)2048);
421
422	initial_width = min(fb_width, initial_width);
423	initial_height = min(fb_height, initial_height);
424
425	fb_pitch = fb_width * fb_bbp / 8;
426	fb_size = fb_pitch * fb_height;
427	fb_offset = vmw_read(vmw_priv, SVGA_REG_FB_OFFSET);
428
429	info = framebuffer_alloc(sizeof(*par), device);
430	if (!info)
431		return -ENOMEM;
432
433	/*
434	 * Par
435	 */
436	vmw_priv->fb_info = info;
437	par = info->par;
 
 
438	par->vmw_priv = vmw_priv;
439	par->depth = fb_depth;
440	par->bpp = fb_bbp;
441	par->vmalloc = NULL;
442	par->max_width = fb_width;
443	par->max_height = fb_height;
444
 
 
 
 
 
 
 
 
 
 
 
 
 
445	/*
446	 * Create buffers and alloc memory
447	 */
448	par->vmalloc = vmalloc(fb_size);
449	if (unlikely(par->vmalloc == NULL)) {
450		ret = -ENOMEM;
451		goto err_free;
452	}
453
454	ret = vmw_fb_create_bo(vmw_priv, fb_size, &par->vmw_bo);
455	if (unlikely(ret != 0))
456		goto err_free;
457
458	ret = ttm_bo_kmap(&par->vmw_bo->base,
459			  0,
460			  par->vmw_bo->base.num_pages,
461			  &par->map);
462	if (unlikely(ret != 0))
463		goto err_unref;
464	par->bo_ptr = ttm_kmap_obj_virtual(&par->map, &par->bo_iowrite);
465	par->bo_size = fb_size;
466
467	/*
468	 * Fixed and var
469	 */
470	strcpy(info->fix.id, "svgadrmfb");
471	info->fix.type = FB_TYPE_PACKED_PIXELS;
472	info->fix.visual = FB_VISUAL_TRUECOLOR;
473	info->fix.type_aux = 0;
474	info->fix.xpanstep = 1; /* doing it in hw */
475	info->fix.ypanstep = 1; /* doing it in hw */
476	info->fix.ywrapstep = 0;
477	info->fix.accel = FB_ACCEL_NONE;
478	info->fix.line_length = fb_pitch;
479
480	info->fix.smem_start = 0;
481	info->fix.smem_len = fb_size;
482
483	info->pseudo_palette = par->pseudo_palette;
484	info->screen_base = par->vmalloc;
485	info->screen_size = fb_size;
486
487	info->flags = FBINFO_DEFAULT;
488	info->fbops = &vmw_fb_ops;
489
490	/* 24 depth per default */
491	info->var.red.offset = 16;
492	info->var.green.offset = 8;
493	info->var.blue.offset = 0;
494	info->var.red.length = 8;
495	info->var.green.length = 8;
496	info->var.blue.length = 8;
497	info->var.transp.offset = 0;
498	info->var.transp.length = 0;
499
500	info->var.xres_virtual = fb_width;
501	info->var.yres_virtual = fb_height;
502	info->var.bits_per_pixel = par->bpp;
503	info->var.xoffset = 0;
504	info->var.yoffset = 0;
505	info->var.activate = FB_ACTIVATE_NOW;
506	info->var.height = -1;
507	info->var.width = -1;
508
509	info->var.xres = initial_width;
510	info->var.yres = initial_height;
511
512#if 0
513	info->pixmap.size = 64*1024;
514	info->pixmap.buf_align = 8;
515	info->pixmap.access_align = 32;
516	info->pixmap.flags = FB_PIXMAP_SYSTEM;
517	info->pixmap.scan_align = 1;
518#else
519	info->pixmap.size = 0;
520	info->pixmap.buf_align = 8;
521	info->pixmap.access_align = 32;
522	info->pixmap.flags = FB_PIXMAP_SYSTEM;
523	info->pixmap.scan_align = 1;
524#endif
525
526	info->apertures = alloc_apertures(1);
527	if (!info->apertures) {
528		ret = -ENOMEM;
529		goto err_aper;
530	}
531	info->apertures->ranges[0].base = vmw_priv->vram_start;
532	info->apertures->ranges[0].size = vmw_priv->vram_size;
533
534	/*
535	 * Dirty & Deferred IO
536	 */
537	par->dirty.x1 = par->dirty.x2 = 0;
538	par->dirty.y1 = par->dirty.y2 = 0;
539	par->dirty.active = true;
540	spin_lock_init(&par->dirty.lock);
 
541	info->fbdefio = &vmw_defio;
542	fb_deferred_io_init(info);
543
544	ret = register_framebuffer(info);
545	if (unlikely(ret != 0))
546		goto err_defio;
547
 
 
548	return 0;
549
550err_defio:
551	fb_deferred_io_cleanup(info);
552err_aper:
553	ttm_bo_kunmap(&par->map);
554err_unref:
555	ttm_bo_unref((struct ttm_buffer_object **)&par->vmw_bo);
556err_free:
557	vfree(par->vmalloc);
 
558	framebuffer_release(info);
559	vmw_priv->fb_info = NULL;
560
561	return ret;
562}
563
564int vmw_fb_close(struct vmw_private *vmw_priv)
565{
566	struct fb_info *info;
567	struct vmw_fb_par *par;
568	struct ttm_buffer_object *bo;
569
570	if (!vmw_priv->fb_info)
571		return 0;
572
573	info = vmw_priv->fb_info;
574	par = info->par;
575	bo = &par->vmw_bo->base;
576	par->vmw_bo = NULL;
577
578	/* ??? order */
579	fb_deferred_io_cleanup(info);
 
580	unregister_framebuffer(info);
581
582	ttm_bo_kunmap(&par->map);
583	ttm_bo_unref(&bo);
584
585	vfree(par->vmalloc);
586	framebuffer_release(info);
587
588	return 0;
589}
590
591int vmw_dmabuf_from_vram(struct vmw_private *vmw_priv,
592			 struct vmw_dma_buffer *vmw_bo)
593{
594	struct ttm_buffer_object *bo = &vmw_bo->base;
595	int ret = 0;
596
597	ret = ttm_bo_reserve(bo, false, false, false, 0);
598	if (unlikely(ret != 0))
599		return ret;
600
601	ret = ttm_bo_validate(bo, &vmw_sys_placement, false, false, false);
602	ttm_bo_unreserve(bo);
603
604	return ret;
605}
606
607int vmw_dmabuf_to_start_of_vram(struct vmw_private *vmw_priv,
608				struct vmw_dma_buffer *vmw_bo)
609{
610	struct ttm_buffer_object *bo = &vmw_bo->base;
611	struct ttm_placement ne_placement = vmw_vram_ne_placement;
612	int ret = 0;
613
614	ne_placement.lpfn = bo->num_pages;
615
616	/* interuptable? */
617	ret = ttm_write_lock(&vmw_priv->active_master->lock, false);
618	if (unlikely(ret != 0))
619		return ret;
620
621	ret = ttm_bo_reserve(bo, false, false, false, 0);
622	if (unlikely(ret != 0))
623		goto err_unlock;
624
625	if (bo->mem.mem_type == TTM_PL_VRAM &&
626	    bo->mem.start < bo->num_pages &&
627	    bo->mem.start > 0)
628		(void) ttm_bo_validate(bo, &vmw_sys_placement, false,
629				       false, false);
630
631	ret = ttm_bo_validate(bo, &ne_placement, false, false, false);
632
633	/* Could probably bug on */
634	WARN_ON(bo->offset != 0);
635
636	ttm_bo_unreserve(bo);
637err_unlock:
638	ttm_write_unlock(&vmw_priv->active_master->lock);
639
640	return ret;
641}
642
643int vmw_fb_off(struct vmw_private *vmw_priv)
644{
645	struct fb_info *info;
646	struct vmw_fb_par *par;
647	unsigned long flags;
648
649	if (!vmw_priv->fb_info)
650		return -EINVAL;
651
652	info = vmw_priv->fb_info;
653	par = info->par;
654
655	spin_lock_irqsave(&par->dirty.lock, flags);
656	par->dirty.active = false;
657	spin_unlock_irqrestore(&par->dirty.lock, flags);
658
659	flush_delayed_work_sync(&info->deferred_work);
660
661	par->bo_ptr = NULL;
662	ttm_bo_kunmap(&par->map);
663
664	vmw_dmabuf_from_vram(vmw_priv, par->vmw_bo);
 
 
665
666	return 0;
667}
668
669int vmw_fb_on(struct vmw_private *vmw_priv)
670{
671	struct fb_info *info;
672	struct vmw_fb_par *par;
673	unsigned long flags;
674	bool dummy;
675	int ret;
676
677	if (!vmw_priv->fb_info)
678		return -EINVAL;
679
680	info = vmw_priv->fb_info;
681	par = info->par;
682
683	/* we are already active */
684	if (par->bo_ptr != NULL)
685		return 0;
686
687	/* Make sure that all overlays are stoped when we take over */
688	vmw_overlay_stop_all(vmw_priv);
689
690	ret = vmw_dmabuf_to_start_of_vram(vmw_priv, par->vmw_bo);
691	if (unlikely(ret != 0)) {
692		DRM_ERROR("could not move buffer to start of VRAM\n");
693		goto err_no_buffer;
694	}
695
696	ret = ttm_bo_kmap(&par->vmw_bo->base,
697			  0,
698			  par->vmw_bo->base.num_pages,
699			  &par->map);
700	BUG_ON(ret != 0);
701	par->bo_ptr = ttm_kmap_obj_virtual(&par->map, &dummy);
702
703	spin_lock_irqsave(&par->dirty.lock, flags);
704	par->dirty.active = true;
705	spin_unlock_irqrestore(&par->dirty.lock, flags);
706
707err_no_buffer:
708	vmw_fb_set_par(info);
709
710	vmw_fb_dirty_mark(par, 0, 0, info->var.xres, info->var.yres);
711
712	/* If there already was stuff dirty we wont
713	 * schedule a new work, so lets do it now */
714	schedule_delayed_work(&info->deferred_work, 0);
715
716	return 0;
717}
v4.10.11
  1/**************************************************************************
  2 *
  3 * Copyright © 2007 David Airlie
  4 * Copyright © 2009-2015 VMware, Inc., Palo Alto, CA., USA
  5 * All Rights Reserved.
  6 *
  7 * Permission is hereby granted, free of charge, to any person obtaining a
  8 * copy of this software and associated documentation files (the
  9 * "Software"), to deal in the Software without restriction, including
 10 * without limitation the rights to use, copy, modify, merge, publish,
 11 * distribute, sub license, and/or sell copies of the Software, and to
 12 * permit persons to whom the Software is furnished to do so, subject to
 13 * the following conditions:
 14 *
 15 * The above copyright notice and this permission notice (including the
 16 * next paragraph) shall be included in all copies or substantial portions
 17 * of the Software.
 18 *
 19 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 20 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 21 * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
 22 * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
 23 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
 24 * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
 25 * USE OR OTHER DEALINGS IN THE SOFTWARE.
 26 *
 27 **************************************************************************/
 28
 29#include <linux/export.h>
 30
 31#include <drm/drmP.h>
 32#include "vmwgfx_drv.h"
 33#include "vmwgfx_kms.h"
 34
 35#include <drm/ttm/ttm_placement.h>
 36
 37#define VMW_DIRTY_DELAY (HZ / 30)
 38
 39struct vmw_fb_par {
 40	struct vmw_private *vmw_priv;
 41
 42	void *vmalloc;
 43
 44	struct mutex bo_mutex;
 45	struct vmw_dma_buffer *vmw_bo;
 46	struct ttm_bo_kmap_obj map;
 47	void *bo_ptr;
 48	unsigned bo_size;
 49	struct drm_framebuffer *set_fb;
 50	struct drm_display_mode *set_mode;
 51	u32 fb_x;
 52	u32 fb_y;
 53	bool bo_iowrite;
 54
 55	u32 pseudo_palette[17];
 56
 
 
 
 57	unsigned max_width;
 58	unsigned max_height;
 59
 
 
 
 
 60	struct {
 61		spinlock_t lock;
 62		bool active;
 63		unsigned x1;
 64		unsigned y1;
 65		unsigned x2;
 66		unsigned y2;
 67	} dirty;
 68
 69	struct drm_crtc *crtc;
 70	struct drm_connector *con;
 71	struct delayed_work local_work;
 72};
 73
 74static int vmw_fb_setcolreg(unsigned regno, unsigned red, unsigned green,
 75			    unsigned blue, unsigned transp,
 76			    struct fb_info *info)
 77{
 78	struct vmw_fb_par *par = info->par;
 79	u32 *pal = par->pseudo_palette;
 80
 81	if (regno > 15) {
 82		DRM_ERROR("Bad regno %u.\n", regno);
 83		return 1;
 84	}
 85
 86	switch (par->set_fb->depth) {
 87	case 24:
 88	case 32:
 89		pal[regno] = ((red & 0xff00) << 8) |
 90			      (green & 0xff00) |
 91			     ((blue  & 0xff00) >> 8);
 92		break;
 93	default:
 94		DRM_ERROR("Bad depth %u, bpp %u.\n", par->set_fb->depth,
 95			  par->set_fb->bits_per_pixel);
 96		return 1;
 97	}
 98
 99	return 0;
100}
101
102static int vmw_fb_check_var(struct fb_var_screeninfo *var,
103			    struct fb_info *info)
104{
105	int depth = var->bits_per_pixel;
106	struct vmw_fb_par *par = info->par;
107	struct vmw_private *vmw_priv = par->vmw_priv;
108
109	switch (var->bits_per_pixel) {
110	case 32:
111		depth = (var->transp.length > 0) ? 32 : 24;
112		break;
113	default:
114		DRM_ERROR("Bad bpp %u.\n", var->bits_per_pixel);
115		return -EINVAL;
116	}
117
118	switch (depth) {
119	case 24:
120		var->red.offset = 16;
121		var->green.offset = 8;
122		var->blue.offset = 0;
123		var->red.length = 8;
124		var->green.length = 8;
125		var->blue.length = 8;
126		var->transp.length = 0;
127		var->transp.offset = 0;
128		break;
129	case 32:
130		var->red.offset = 16;
131		var->green.offset = 8;
132		var->blue.offset = 0;
133		var->red.length = 8;
134		var->green.length = 8;
135		var->blue.length = 8;
136		var->transp.length = 8;
137		var->transp.offset = 24;
138		break;
139	default:
140		DRM_ERROR("Bad depth %u.\n", depth);
141		return -EINVAL;
142	}
143
 
 
 
 
 
 
144	if ((var->xoffset + var->xres) > par->max_width ||
145	    (var->yoffset + var->yres) > par->max_height) {
146		DRM_ERROR("Requested geom can not fit in framebuffer\n");
147		return -EINVAL;
148	}
149
150	if (!vmw_kms_validate_mode_vram(vmw_priv,
151					var->xres * var->bits_per_pixel/8,
152					var->yoffset + var->yres)) {
153		DRM_ERROR("Requested geom can not fit in framebuffer\n");
154		return -EINVAL;
155	}
156
157	return 0;
158}
159
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
160static int vmw_fb_blank(int blank, struct fb_info *info)
161{
162	return 0;
163}
164
165/*
166 * Dirty code
167 */
168
169static void vmw_fb_dirty_flush(struct work_struct *work)
170{
171	struct vmw_fb_par *par = container_of(work, struct vmw_fb_par,
172					      local_work.work);
173	struct vmw_private *vmw_priv = par->vmw_priv;
174	struct fb_info *info = vmw_priv->fb_info;
175	unsigned long irq_flags;
176	s32 dst_x1, dst_x2, dst_y1, dst_y2, w, h;
177	u32 cpp, max_x, max_y;
178	struct drm_clip_rect clip;
179	struct drm_framebuffer *cur_fb;
180	u8 *src_ptr, *dst_ptr;
 
 
 
 
181
182	if (vmw_priv->suspended)
183		return;
184
185	mutex_lock(&par->bo_mutex);
186	cur_fb = par->set_fb;
187	if (!cur_fb)
188		goto out_unlock;
189
190	spin_lock_irqsave(&par->dirty.lock, irq_flags);
191	if (!par->dirty.active) {
192		spin_unlock_irqrestore(&par->dirty.lock, irq_flags);
193		goto out_unlock;
194	}
195
196	/*
197	 * Handle panning when copying from vmalloc to framebuffer.
198	 * Clip dirty area to framebuffer.
199	 */
200	cpp = (cur_fb->bits_per_pixel + 7) / 8;
201	max_x = par->fb_x + cur_fb->width;
202	max_y = par->fb_y + cur_fb->height;
203
204	dst_x1 = par->dirty.x1 - par->fb_x;
205	dst_y1 = par->dirty.y1 - par->fb_y;
206	dst_x1 = max_t(s32, dst_x1, 0);
207	dst_y1 = max_t(s32, dst_y1, 0);
208
209	dst_x2 = par->dirty.x2 - par->fb_x;
210	dst_y2 = par->dirty.y2 - par->fb_y;
211	dst_x2 = min_t(s32, dst_x2, max_x);
212	dst_y2 = min_t(s32, dst_y2, max_y);
213	w = dst_x2 - dst_x1;
214	h = dst_y2 - dst_y1;
215	w = max_t(s32, 0, w);
216	h = max_t(s32, 0, h);
217
218	par->dirty.x1 = par->dirty.x2 = 0;
219	par->dirty.y1 = par->dirty.y2 = 0;
220	spin_unlock_irqrestore(&par->dirty.lock, irq_flags);
221
222	if (w && h) {
223		dst_ptr = (u8 *)par->bo_ptr  +
224			(dst_y1 * par->set_fb->pitches[0] + dst_x1 * cpp);
225		src_ptr = (u8 *)par->vmalloc +
226			((dst_y1 + par->fb_y) * info->fix.line_length +
227			 (dst_x1 + par->fb_x) * cpp);
228
229		while (h-- > 0) {
230			memcpy(dst_ptr, src_ptr, w*cpp);
231			dst_ptr += par->set_fb->pitches[0];
232			src_ptr += info->fix.line_length;
233		}
234
235		clip.x1 = dst_x1;
236		clip.x2 = dst_x2;
237		clip.y1 = dst_y1;
238		clip.y2 = dst_y2;
239
240		WARN_ON_ONCE(par->set_fb->funcs->dirty(cur_fb, NULL, 0, 0,
241						       &clip, 1));
242		vmw_fifo_flush(vmw_priv, false);
243	}
244out_unlock:
245	mutex_unlock(&par->bo_mutex);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
246}
247
248static void vmw_fb_dirty_mark(struct vmw_fb_par *par,
249			      unsigned x1, unsigned y1,
250			      unsigned width, unsigned height)
251{
 
252	unsigned long flags;
253	unsigned x2 = x1 + width;
254	unsigned y2 = y1 + height;
255
256	spin_lock_irqsave(&par->dirty.lock, flags);
257	if (par->dirty.x1 == par->dirty.x2) {
258		par->dirty.x1 = x1;
259		par->dirty.y1 = y1;
260		par->dirty.x2 = x2;
261		par->dirty.y2 = y2;
262		/* if we are active start the dirty work
263		 * we share the work with the defio system */
264		if (par->dirty.active)
265			schedule_delayed_work(&par->local_work,
266					      VMW_DIRTY_DELAY);
267	} else {
268		if (x1 < par->dirty.x1)
269			par->dirty.x1 = x1;
270		if (y1 < par->dirty.y1)
271			par->dirty.y1 = y1;
272		if (x2 > par->dirty.x2)
273			par->dirty.x2 = x2;
274		if (y2 > par->dirty.y2)
275			par->dirty.y2 = y2;
276	}
277	spin_unlock_irqrestore(&par->dirty.lock, flags);
278}
279
280static int vmw_fb_pan_display(struct fb_var_screeninfo *var,
281			      struct fb_info *info)
282{
283	struct vmw_fb_par *par = info->par;
284
285	if ((var->xoffset + var->xres) > var->xres_virtual ||
286	    (var->yoffset + var->yres) > var->yres_virtual) {
287		DRM_ERROR("Requested panning can not fit in framebuffer\n");
288		return -EINVAL;
289	}
290
291	mutex_lock(&par->bo_mutex);
292	par->fb_x = var->xoffset;
293	par->fb_y = var->yoffset;
294	if (par->set_fb)
295		vmw_fb_dirty_mark(par, par->fb_x, par->fb_y, par->set_fb->width,
296				  par->set_fb->height);
297	mutex_unlock(&par->bo_mutex);
298
299	return 0;
300}
301
302static void vmw_deferred_io(struct fb_info *info,
303			    struct list_head *pagelist)
304{
305	struct vmw_fb_par *par = info->par;
306	unsigned long start, end, min, max;
307	unsigned long flags;
308	struct page *page;
309	int y1, y2;
310
311	min = ULONG_MAX;
312	max = 0;
313	list_for_each_entry(page, pagelist, lru) {
314		start = page->index << PAGE_SHIFT;
315		end = start + PAGE_SIZE - 1;
316		min = min(min, start);
317		max = max(max, end);
318	}
319
320	if (min < max) {
321		y1 = min / info->fix.line_length;
322		y2 = (max / info->fix.line_length) + 1;
323
324		spin_lock_irqsave(&par->dirty.lock, flags);
325		par->dirty.x1 = 0;
326		par->dirty.y1 = y1;
327		par->dirty.x2 = info->var.xres;
328		par->dirty.y2 = y2;
329		spin_unlock_irqrestore(&par->dirty.lock, flags);
 
330
331		/*
332		 * Since we've already waited on this work once, try to
333		 * execute asap.
334		 */
335		cancel_delayed_work(&par->local_work);
336		schedule_delayed_work(&par->local_work, 0);
337	}
338};
339
340static struct fb_deferred_io vmw_defio = {
341	.delay		= VMW_DIRTY_DELAY,
342	.deferred_io	= vmw_deferred_io,
343};
344
345/*
346 * Draw code
347 */
348
349static void vmw_fb_fillrect(struct fb_info *info, const struct fb_fillrect *rect)
350{
351	cfb_fillrect(info, rect);
352	vmw_fb_dirty_mark(info->par, rect->dx, rect->dy,
353			  rect->width, rect->height);
354}
355
356static void vmw_fb_copyarea(struct fb_info *info, const struct fb_copyarea *region)
357{
358	cfb_copyarea(info, region);
359	vmw_fb_dirty_mark(info->par, region->dx, region->dy,
360			  region->width, region->height);
361}
362
363static void vmw_fb_imageblit(struct fb_info *info, const struct fb_image *image)
364{
365	cfb_imageblit(info, image);
366	vmw_fb_dirty_mark(info->par, image->dx, image->dy,
367			  image->width, image->height);
368}
369
370/*
371 * Bring up code
372 */
373
 
 
 
 
 
 
 
 
 
 
 
 
374static int vmw_fb_create_bo(struct vmw_private *vmw_priv,
375			    size_t size, struct vmw_dma_buffer **out)
376{
377	struct vmw_dma_buffer *vmw_bo;
 
378	int ret;
379
380	(void) ttm_write_lock(&vmw_priv->reservation_sem, false);
 
 
 
 
 
381
382	vmw_bo = kmalloc(sizeof(*vmw_bo), GFP_KERNEL);
383	if (!vmw_bo) {
384		ret = -ENOMEM;
385		goto err_unlock;
386	}
387
388	ret = vmw_dmabuf_init(vmw_priv, vmw_bo, size,
389			      &vmw_sys_placement,
390			      false,
391			      &vmw_dmabuf_bo_free);
392	if (unlikely(ret != 0))
393		goto err_unlock; /* init frees the buffer on failure */
394
395	*out = vmw_bo;
396	ttm_write_unlock(&vmw_priv->reservation_sem);
 
397
398	return 0;
399
400err_unlock:
401	ttm_write_unlock(&vmw_priv->reservation_sem);
402	return ret;
403}
404
405static int vmw_fb_compute_depth(struct fb_var_screeninfo *var,
406				int *depth)
407{
408	switch (var->bits_per_pixel) {
409	case 32:
410		*depth = (var->transp.length > 0) ? 32 : 24;
411		break;
412	default:
413		DRM_ERROR("Bad bpp %u.\n", var->bits_per_pixel);
414		return -EINVAL;
415	}
416
417	return 0;
418}
419
420static int vmw_fb_kms_detach(struct vmw_fb_par *par,
421			     bool detach_bo,
422			     bool unref_bo)
423{
424	struct drm_framebuffer *cur_fb = par->set_fb;
425	int ret;
426
427	/* Detach the KMS framebuffer from crtcs */
428	if (par->set_mode) {
429		struct drm_mode_set set;
430
431		set.crtc = par->crtc;
432		set.x = 0;
433		set.y = 0;
434		set.mode = NULL;
435		set.fb = NULL;
436		set.num_connectors = 1;
437		set.connectors = &par->con;
438		ret = drm_mode_set_config_internal(&set);
439		if (ret) {
440			DRM_ERROR("Could not unset a mode.\n");
441			return ret;
442		}
443		drm_mode_destroy(par->vmw_priv->dev, par->set_mode);
444		par->set_mode = NULL;
445	}
446
447	if (cur_fb) {
448		drm_framebuffer_unreference(cur_fb);
449		par->set_fb = NULL;
450	}
451
452	if (par->vmw_bo && detach_bo) {
453		if (par->bo_ptr) {
454			ttm_bo_kunmap(&par->map);
455			par->bo_ptr = NULL;
456		}
457		if (unref_bo)
458			vmw_dmabuf_unreference(&par->vmw_bo);
459		else
460			vmw_dmabuf_unpin(par->vmw_priv, par->vmw_bo, false);
461	}
462
463	return 0;
464}
465
466static int vmw_fb_kms_framebuffer(struct fb_info *info)
467{
468	struct drm_mode_fb_cmd2 mode_cmd;
469	struct vmw_fb_par *par = info->par;
470	struct fb_var_screeninfo *var = &info->var;
471	struct drm_framebuffer *cur_fb;
472	struct vmw_framebuffer *vfb;
473	int ret = 0, depth;
474	size_t new_bo_size;
475
476	ret = vmw_fb_compute_depth(var, &depth);
477	if (ret)
478		return ret;
479
480	mode_cmd.width = var->xres;
481	mode_cmd.height = var->yres;
482	mode_cmd.pitches[0] = ((var->bits_per_pixel + 7) / 8) * mode_cmd.width;
483	mode_cmd.pixel_format =
484		drm_mode_legacy_fb_format(var->bits_per_pixel, depth);
485
486	cur_fb = par->set_fb;
487	if (cur_fb && cur_fb->width == mode_cmd.width &&
488	    cur_fb->height == mode_cmd.height &&
489	    cur_fb->pixel_format == mode_cmd.pixel_format &&
490	    cur_fb->pitches[0] == mode_cmd.pitches[0])
491		return 0;
492
493	/* Need new buffer object ? */
494	new_bo_size = (size_t) mode_cmd.pitches[0] * (size_t) mode_cmd.height;
495	ret = vmw_fb_kms_detach(par,
496				par->bo_size < new_bo_size ||
497				par->bo_size > 2*new_bo_size,
498				true);
499	if (ret)
500		return ret;
501
502	if (!par->vmw_bo) {
503		ret = vmw_fb_create_bo(par->vmw_priv, new_bo_size,
504				       &par->vmw_bo);
505		if (ret) {
506			DRM_ERROR("Failed creating a buffer object for "
507				  "fbdev.\n");
508			return ret;
509		}
510		par->bo_size = new_bo_size;
511	}
512
513	vfb = vmw_kms_new_framebuffer(par->vmw_priv, par->vmw_bo, NULL,
514				      true, &mode_cmd);
515	if (IS_ERR(vfb))
516		return PTR_ERR(vfb);
517
518	par->set_fb = &vfb->base;
519
520	return 0;
521}
522
523static int vmw_fb_set_par(struct fb_info *info)
524{
525	struct vmw_fb_par *par = info->par;
526	struct vmw_private *vmw_priv = par->vmw_priv;
527	struct drm_mode_set set;
528	struct fb_var_screeninfo *var = &info->var;
529	struct drm_display_mode new_mode = { DRM_MODE("fb_mode",
530		DRM_MODE_TYPE_DRIVER,
531		0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
532		DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_PVSYNC)
533	};
534	struct drm_display_mode *old_mode;
535	struct drm_display_mode *mode;
536	int ret;
537
538	old_mode = par->set_mode;
539	mode = drm_mode_duplicate(vmw_priv->dev, &new_mode);
540	if (!mode) {
541		DRM_ERROR("Could not create new fb mode.\n");
542		return -ENOMEM;
543	}
544
545	mode->hdisplay = var->xres;
546	mode->vdisplay = var->yres;
547	vmw_guess_mode_timing(mode);
548
549	if (old_mode && drm_mode_equal(old_mode, mode)) {
550		drm_mode_destroy(vmw_priv->dev, mode);
551		mode = old_mode;
552		old_mode = NULL;
553	} else if (!vmw_kms_validate_mode_vram(vmw_priv,
554					mode->hdisplay *
555					DIV_ROUND_UP(var->bits_per_pixel, 8),
556					mode->vdisplay)) {
557		drm_mode_destroy(vmw_priv->dev, mode);
558		return -EINVAL;
559	}
560
561	mutex_lock(&par->bo_mutex);
562	drm_modeset_lock_all(vmw_priv->dev);
563	ret = vmw_fb_kms_framebuffer(info);
564	if (ret)
565		goto out_unlock;
566
567	par->fb_x = var->xoffset;
568	par->fb_y = var->yoffset;
569
570	set.crtc = par->crtc;
571	set.x = 0;
572	set.y = 0;
573	set.mode = mode;
574	set.fb = par->set_fb;
575	set.num_connectors = 1;
576	set.connectors = &par->con;
577
578	ret = drm_mode_set_config_internal(&set);
579	if (ret)
580		goto out_unlock;
581
582	if (!par->bo_ptr) {
583		struct vmw_framebuffer *vfb = vmw_framebuffer_to_vfb(set.fb);
584
585		/*
586		 * Pin before mapping. Since we don't know in what placement
587		 * to pin, call into KMS to do it for us.
588		 */
589		ret = vfb->pin(vfb);
590		if (ret) {
591			DRM_ERROR("Could not pin the fbdev framebuffer.\n");
592			goto out_unlock;
593		}
594
595		ret = ttm_bo_kmap(&par->vmw_bo->base, 0,
596				  par->vmw_bo->base.num_pages, &par->map);
597		if (ret) {
598			vfb->unpin(vfb);
599			DRM_ERROR("Could not map the fbdev framebuffer.\n");
600			goto out_unlock;
601		}
602
603		par->bo_ptr = ttm_kmap_obj_virtual(&par->map, &par->bo_iowrite);
604	}
605
606
607	vmw_fb_dirty_mark(par, par->fb_x, par->fb_y,
608			  par->set_fb->width, par->set_fb->height);
609
610	/* If there already was stuff dirty we wont
611	 * schedule a new work, so lets do it now */
612
613	schedule_delayed_work(&par->local_work, 0);
614
615out_unlock:
616	if (old_mode)
617		drm_mode_destroy(vmw_priv->dev, old_mode);
618	par->set_mode = mode;
619
620	drm_modeset_unlock_all(vmw_priv->dev);
621	mutex_unlock(&par->bo_mutex);
622
623	return ret;
624}
625
626
627static struct fb_ops vmw_fb_ops = {
628	.owner = THIS_MODULE,
629	.fb_check_var = vmw_fb_check_var,
630	.fb_set_par = vmw_fb_set_par,
631	.fb_setcolreg = vmw_fb_setcolreg,
632	.fb_fillrect = vmw_fb_fillrect,
633	.fb_copyarea = vmw_fb_copyarea,
634	.fb_imageblit = vmw_fb_imageblit,
635	.fb_pan_display = vmw_fb_pan_display,
636	.fb_blank = vmw_fb_blank,
637};
638
639int vmw_fb_init(struct vmw_private *vmw_priv)
640{
641	struct device *device = &vmw_priv->dev->pdev->dev;
642	struct vmw_fb_par *par;
643	struct fb_info *info;
 
644	unsigned fb_width, fb_height;
645	unsigned fb_bpp, fb_depth, fb_offset, fb_pitch, fb_size;
646	struct drm_display_mode *init_mode;
647	int ret;
648
649	fb_bpp = 32;
 
 
 
 
650	fb_depth = 24;
651
652	/* XXX As shouldn't these be as well. */
653	fb_width = min(vmw_priv->fb_max_width, (unsigned)2048);
654	fb_height = min(vmw_priv->fb_max_height, (unsigned)2048);
655
656	fb_pitch = fb_width * fb_bpp / 8;
 
 
 
657	fb_size = fb_pitch * fb_height;
658	fb_offset = vmw_read(vmw_priv, SVGA_REG_FB_OFFSET);
659
660	info = framebuffer_alloc(sizeof(*par), device);
661	if (!info)
662		return -ENOMEM;
663
664	/*
665	 * Par
666	 */
667	vmw_priv->fb_info = info;
668	par = info->par;
669	memset(par, 0, sizeof(*par));
670	INIT_DELAYED_WORK(&par->local_work, &vmw_fb_dirty_flush);
671	par->vmw_priv = vmw_priv;
 
 
672	par->vmalloc = NULL;
673	par->max_width = fb_width;
674	par->max_height = fb_height;
675
676	drm_modeset_lock_all(vmw_priv->dev);
677	ret = vmw_kms_fbdev_init_data(vmw_priv, 0, par->max_width,
678				      par->max_height, &par->con,
679				      &par->crtc, &init_mode);
680	if (ret) {
681		drm_modeset_unlock_all(vmw_priv->dev);
682		goto err_kms;
683	}
684
685	info->var.xres = init_mode->hdisplay;
686	info->var.yres = init_mode->vdisplay;
687	drm_modeset_unlock_all(vmw_priv->dev);
688
689	/*
690	 * Create buffers and alloc memory
691	 */
692	par->vmalloc = vzalloc(fb_size);
693	if (unlikely(par->vmalloc == NULL)) {
694		ret = -ENOMEM;
695		goto err_free;
696	}
697
 
 
 
 
 
 
 
 
 
 
 
 
 
698	/*
699	 * Fixed and var
700	 */
701	strcpy(info->fix.id, "svgadrmfb");
702	info->fix.type = FB_TYPE_PACKED_PIXELS;
703	info->fix.visual = FB_VISUAL_TRUECOLOR;
704	info->fix.type_aux = 0;
705	info->fix.xpanstep = 1; /* doing it in hw */
706	info->fix.ypanstep = 1; /* doing it in hw */
707	info->fix.ywrapstep = 0;
708	info->fix.accel = FB_ACCEL_NONE;
709	info->fix.line_length = fb_pitch;
710
711	info->fix.smem_start = 0;
712	info->fix.smem_len = fb_size;
713
714	info->pseudo_palette = par->pseudo_palette;
715	info->screen_base = (char __iomem *)par->vmalloc;
716	info->screen_size = fb_size;
717
718	info->flags = FBINFO_DEFAULT;
719	info->fbops = &vmw_fb_ops;
720
721	/* 24 depth per default */
722	info->var.red.offset = 16;
723	info->var.green.offset = 8;
724	info->var.blue.offset = 0;
725	info->var.red.length = 8;
726	info->var.green.length = 8;
727	info->var.blue.length = 8;
728	info->var.transp.offset = 0;
729	info->var.transp.length = 0;
730
731	info->var.xres_virtual = fb_width;
732	info->var.yres_virtual = fb_height;
733	info->var.bits_per_pixel = fb_bpp;
734	info->var.xoffset = 0;
735	info->var.yoffset = 0;
736	info->var.activate = FB_ACTIVATE_NOW;
737	info->var.height = -1;
738	info->var.width = -1;
739
740	/* Use default scratch pixmap (info->pixmap.flags = FB_PIXMAP_SYSTEM) */
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
741	info->apertures = alloc_apertures(1);
742	if (!info->apertures) {
743		ret = -ENOMEM;
744		goto err_aper;
745	}
746	info->apertures->ranges[0].base = vmw_priv->vram_start;
747	info->apertures->ranges[0].size = vmw_priv->vram_size;
748
749	/*
750	 * Dirty & Deferred IO
751	 */
752	par->dirty.x1 = par->dirty.x2 = 0;
753	par->dirty.y1 = par->dirty.y2 = 0;
754	par->dirty.active = true;
755	spin_lock_init(&par->dirty.lock);
756	mutex_init(&par->bo_mutex);
757	info->fbdefio = &vmw_defio;
758	fb_deferred_io_init(info);
759
760	ret = register_framebuffer(info);
761	if (unlikely(ret != 0))
762		goto err_defio;
763
764	vmw_fb_set_par(info);
765
766	return 0;
767
768err_defio:
769	fb_deferred_io_cleanup(info);
770err_aper:
 
 
 
771err_free:
772	vfree(par->vmalloc);
773err_kms:
774	framebuffer_release(info);
775	vmw_priv->fb_info = NULL;
776
777	return ret;
778}
779
780int vmw_fb_close(struct vmw_private *vmw_priv)
781{
782	struct fb_info *info;
783	struct vmw_fb_par *par;
 
784
785	if (!vmw_priv->fb_info)
786		return 0;
787
788	info = vmw_priv->fb_info;
789	par = info->par;
 
 
790
791	/* ??? order */
792	fb_deferred_io_cleanup(info);
793	cancel_delayed_work_sync(&par->local_work);
794	unregister_framebuffer(info);
795
796	(void) vmw_fb_kms_detach(par, true, true);
 
797
798	vfree(par->vmalloc);
799	framebuffer_release(info);
800
801	return 0;
802}
803
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
804int vmw_fb_off(struct vmw_private *vmw_priv)
805{
806	struct fb_info *info;
807	struct vmw_fb_par *par;
808	unsigned long flags;
809
810	if (!vmw_priv->fb_info)
811		return -EINVAL;
812
813	info = vmw_priv->fb_info;
814	par = info->par;
815
816	spin_lock_irqsave(&par->dirty.lock, flags);
817	par->dirty.active = false;
818	spin_unlock_irqrestore(&par->dirty.lock, flags);
819
820	flush_delayed_work(&info->deferred_work);
821	flush_delayed_work(&par->local_work);
 
 
822
823	mutex_lock(&par->bo_mutex);
824	(void) vmw_fb_kms_detach(par, true, false);
825	mutex_unlock(&par->bo_mutex);
826
827	return 0;
828}
829
830int vmw_fb_on(struct vmw_private *vmw_priv)
831{
832	struct fb_info *info;
833	struct vmw_fb_par *par;
834	unsigned long flags;
 
 
835
836	if (!vmw_priv->fb_info)
837		return -EINVAL;
838
839	info = vmw_priv->fb_info;
840	par = info->par;
841
842	vmw_fb_set_par(info);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
843	spin_lock_irqsave(&par->dirty.lock, flags);
844	par->dirty.active = true;
845	spin_unlock_irqrestore(&par->dirty.lock, flags);
846 
 
 
 
 
 
 
 
 
 
847	return 0;
848}