Linux Audio

Check our new training course

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