M7350/kernel/drivers/video/adf/adf_fbdev.c

/*
 * Copyright (C) 2013 Google, Inc.
 *
 * This software is licensed under the terms of the GNU General Public
 * License version 2, as published by the Free Software Foundation, and
 * may be copied, distributed, and modified under those terms.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 */

#include <linux/vmalloc.h>

#include <video/adf.h>
#include <video/adf_client.h>
#include <video/adf_fbdev.h>
#include <video/adf_format.h>

#include "adf.h"

struct adf_fbdev_format {
	u32 fourcc;
	u32 bpp;
	u32 r_length;
	u32 g_length;
	u32 b_length;
	u32 a_length;
	u32 r_offset;
	u32 g_offset;
	u32 b_offset;
	u32 a_offset;
};

static const struct adf_fbdev_format format_table[] = {
	{DRM_FORMAT_RGB332, 8, 3, 3, 2, 0, 5, 2, 0, 0},
	{DRM_FORMAT_BGR233, 8, 3, 3, 2, 0, 0, 3, 5, 0},

	{DRM_FORMAT_XRGB4444, 16, 4, 4, 4, 0, 8, 4, 0, 0},
	{DRM_FORMAT_XBGR4444, 16, 4, 4, 4, 0, 0, 4, 8, 0},
	{DRM_FORMAT_RGBX4444, 16, 4, 4, 4, 0, 12, 8, 4, 0},
	{DRM_FORMAT_BGRX4444, 16, 4, 4, 4, 0, 0, 4, 8, 0},

	{DRM_FORMAT_ARGB4444, 16, 4, 4, 4, 4, 8, 4, 0, 12},
	{DRM_FORMAT_ABGR4444, 16, 4, 4, 4, 4, 0, 4, 8, 12},
	{DRM_FORMAT_RGBA4444, 16, 4, 4, 4, 4, 12, 8, 4, 0},
	{DRM_FORMAT_BGRA4444, 16, 4, 4, 4, 4, 0, 4, 8, 0},

	{DRM_FORMAT_XRGB1555, 16, 5, 5, 5, 0, 10, 5, 0, 0},
	{DRM_FORMAT_XBGR1555, 16, 5, 5, 5, 0, 0, 5, 10, 0},
	{DRM_FORMAT_RGBX5551, 16, 5, 5, 5, 0, 11, 6, 1, 0},
	{DRM_FORMAT_BGRX5551, 16, 5, 5, 5, 0, 1, 6, 11, 0},

	{DRM_FORMAT_ARGB1555, 16, 5, 5, 5, 1, 10, 5, 0, 15},
	{DRM_FORMAT_ABGR1555, 16, 5, 5, 5, 1, 0, 5, 10, 15},
	{DRM_FORMAT_RGBA5551, 16, 5, 5, 5, 1, 11, 6, 1, 0},
	{DRM_FORMAT_BGRA5551, 16, 5, 5, 5, 1, 1, 6, 11, 0},

	{DRM_FORMAT_RGB565, 16, 5, 6, 5, 0, 11, 5, 0, 0},
	{DRM_FORMAT_BGR565, 16, 5, 6, 5, 0, 0, 5, 11, 0},

	{DRM_FORMAT_RGB888, 24, 8, 8, 8, 0, 16, 8, 0, 0},
	{DRM_FORMAT_BGR888, 24, 8, 8, 8, 0, 0, 8, 16, 0},

	{DRM_FORMAT_XRGB8888, 32, 8, 8, 8, 0, 16, 8, 0, 0},
	{DRM_FORMAT_XBGR8888, 32, 8, 8, 8, 0, 0, 8, 16, 0},
	{DRM_FORMAT_RGBX8888, 32, 8, 8, 8, 0, 24, 16, 8, 0},
	{DRM_FORMAT_BGRX8888, 32, 8, 8, 8, 0, 8, 16, 24, 0},

	{DRM_FORMAT_ARGB8888, 32, 8, 8, 8, 8, 16, 8, 0, 24},
	{DRM_FORMAT_ABGR8888, 32, 8, 8, 8, 8, 0, 8, 16, 24},
	{DRM_FORMAT_RGBA8888, 32, 8, 8, 8, 8, 24, 16, 8, 0},
	{DRM_FORMAT_BGRA8888, 32, 8, 8, 8, 8, 8, 16, 24, 0},

	{DRM_FORMAT_XRGB2101010, 32, 10, 10, 10, 0, 20, 10, 0, 0},
	{DRM_FORMAT_XBGR2101010, 32, 10, 10, 10, 0, 0, 10, 20, 0},
	{DRM_FORMAT_RGBX1010102, 32, 10, 10, 10, 0, 22, 12, 2, 0},
	{DRM_FORMAT_BGRX1010102, 32, 10, 10, 10, 0, 2, 12, 22, 0},

	{DRM_FORMAT_ARGB2101010, 32, 10, 10, 10, 2, 20, 10, 0, 30},
	{DRM_FORMAT_ABGR2101010, 32, 10, 10, 10, 2, 0, 10, 20, 30},
	{DRM_FORMAT_RGBA1010102, 32, 10, 10, 10, 2, 22, 12, 2, 0},
	{DRM_FORMAT_BGRA1010102, 32, 10, 10, 10, 2, 2, 12, 22, 0},
};

static u32 drm_fourcc_from_fb_var(struct fb_var_screeninfo *var)
{
	size_t i;
	for (i = 0; i < ARRAY_SIZE(format_table); i++) {
		const struct adf_fbdev_format *f = &format_table[i];
		if (var->red.length == f->r_length &&
			var->red.offset == f->r_offset &&
			var->green.length == f->g_length &&
			var->green.offset == f->g_offset &&
			var->blue.length == f->b_length &&
			var->blue.offset == f->b_offset &&
			var->transp.length == f->a_length &&
			(var->transp.length == 0 ||
					var->transp.offset == f->a_offset))
			return f->fourcc;
	}

	return 0;
}

static const struct adf_fbdev_format *fbdev_format_info(u32 format)
{
	size_t i;
	for (i = 0; i < ARRAY_SIZE(format_table); i++) {
		const struct adf_fbdev_format *f = &format_table[i];
		if (f->fourcc == format)
			return f;
	}

	BUG();
}

void adf_modeinfo_to_fb_videomode(const struct drm_mode_modeinfo *mode,
		struct fb_videomode *vmode)
{
	memset(vmode, 0, sizeof(*vmode));

	vmode->refresh = mode->vrefresh;

	vmode->xres = mode->hdisplay;
	vmode->yres = mode->vdisplay;

	vmode->pixclock = mode->clock ? KHZ2PICOS(mode->clock) : 0;
	vmode->left_margin = mode->htotal - mode->hsync_end;
	vmode->right_margin = mode->hsync_start - mode->hdisplay;
	vmode->upper_margin = mode->vtotal - mode->vsync_end;
	vmode->lower_margin = mode->vsync_start - mode->vdisplay;
	vmode->hsync_len = mode->hsync_end - mode->hsync_start;
	vmode->vsync_len = mode->vsync_end - mode->vsync_start;

	vmode->sync = 0;
	if (mode->flags & DRM_MODE_FLAG_PHSYNC)
		vmode->sync |= FB_SYNC_HOR_HIGH_ACT;
	if (mode->flags & DRM_MODE_FLAG_PVSYNC)
		vmode->sync |= FB_SYNC_VERT_HIGH_ACT;
	if (mode->flags & DRM_MODE_FLAG_PCSYNC)
		vmode->sync |= FB_SYNC_COMP_HIGH_ACT;
	if (mode->flags & DRM_MODE_FLAG_BCAST)
		vmode->sync |= FB_SYNC_BROADCAST;

	vmode->vmode = 0;
	if (mode->flags & DRM_MODE_FLAG_INTERLACE)
		vmode->vmode |= FB_VMODE_INTERLACED;
	if (mode->flags & DRM_MODE_FLAG_DBLSCAN)
		vmode->vmode |= FB_VMODE_DOUBLE;
}
EXPORT_SYMBOL(adf_modeinfo_to_fb_videomode);

void adf_modeinfo_from_fb_videomode(const struct fb_videomode *vmode,
		struct drm_mode_modeinfo *mode)
{
	memset(mode, 0, sizeof(*mode));

	mode->hdisplay = vmode->xres;
	mode->hsync_start = mode->hdisplay + vmode->right_margin;
	mode->hsync_end = mode->hsync_start + vmode->hsync_len;
	mode->htotal = mode->hsync_end + vmode->left_margin;

	mode->vdisplay = vmode->yres;
	mode->vsync_start = mode->vdisplay + vmode->lower_margin;
	mode->vsync_end = mode->vsync_start + vmode->vsync_len;
	mode->vtotal = mode->vsync_end + vmode->upper_margin;

	mode->clock = vmode->pixclock ? PICOS2KHZ(vmode->pixclock) : 0;

	mode->flags = 0;
	if (vmode->sync & FB_SYNC_HOR_HIGH_ACT)
		mode->flags |= DRM_MODE_FLAG_PHSYNC;
	if (vmode->sync & FB_SYNC_VERT_HIGH_ACT)
		mode->flags |= DRM_MODE_FLAG_PVSYNC;
	if (vmode->sync & FB_SYNC_COMP_HIGH_ACT)
		mode->flags |= DRM_MODE_FLAG_PCSYNC;
	if (vmode->sync & FB_SYNC_BROADCAST)
		mode->flags |= DRM_MODE_FLAG_BCAST;
	if (vmode->vmode & FB_VMODE_INTERLACED)
		mode->flags |= DRM_MODE_FLAG_INTERLACE;
	if (vmode->vmode & FB_VMODE_DOUBLE)
		mode->flags |= DRM_MODE_FLAG_DBLSCAN;

	if (vmode->refresh)
		mode->vrefresh = vmode->refresh;
	else
		adf_modeinfo_set_vrefresh(mode);

	if (vmode->name)
		strlcpy(mode->name, vmode->name, sizeof(mode->name));
	else
		adf_modeinfo_set_name(mode);
}
EXPORT_SYMBOL(adf_modeinfo_from_fb_videomode);

static int adf_fbdev_post(struct adf_fbdev *fbdev)
{
	struct adf_buffer buf;
	struct sync_fence *complete_fence;
	int ret = 0;

	memset(&buf, 0, sizeof(buf));
	buf.overlay_engine = fbdev->eng;
	buf.w = fbdev->info->var.xres;
	buf.h = fbdev->info->var.yres;
	buf.format = fbdev->format;
	buf.dma_bufs[0] = fbdev->dma_buf;
	buf.offset[0] = fbdev->offset +
			fbdev->info->var.yoffset * fbdev->pitch +
			fbdev->info->var.xoffset *
			(fbdev->info->var.bits_per_pixel / 8);
	buf.pitch[0] = fbdev->pitch;
	buf.n_planes = 1;

	complete_fence = adf_interface_simple_post(fbdev->intf, &buf);
	if (IS_ERR(complete_fence)) {
		ret = PTR_ERR(complete_fence);
		goto done;
	}

	sync_fence_put(complete_fence);
done:
	return ret;
}

static const u16 vga_palette[][3] = {
	{0x0000, 0x0000, 0x0000},
	{0x0000, 0x0000, 0xAAAA},
	{0x0000, 0xAAAA, 0x0000},
	{0x0000, 0xAAAA, 0xAAAA},
	{0xAAAA, 0x0000, 0x0000},
	{0xAAAA, 0x0000, 0xAAAA},
	{0xAAAA, 0x5555, 0x0000},
	{0xAAAA, 0xAAAA, 0xAAAA},
	{0x5555, 0x5555, 0x5555},
	{0x5555, 0x5555, 0xFFFF},
	{0x5555, 0xFFFF, 0x5555},
	{0x5555, 0xFFFF, 0xFFFF},
	{0xFFFF, 0x5555, 0x5555},
	{0xFFFF, 0x5555, 0xFFFF},
	{0xFFFF, 0xFFFF, 0x5555},
	{0xFFFF, 0xFFFF, 0xFFFF},
};

static int adf_fb_alloc(struct adf_fbdev *fbdev)
{
	int ret;

	ret = adf_interface_simple_buffer_alloc(fbdev->intf,
			fbdev->default_xres_virtual,
			fbdev->default_yres_virtual,
			fbdev->default_format,
			&fbdev->dma_buf, &fbdev->offset, &fbdev->pitch);
	if (ret < 0) {
		dev_err(fbdev->info->dev, "allocating fb failed: %d\n", ret);
		return ret;
	}

	fbdev->vaddr = dma_buf_vmap(fbdev->dma_buf);
	if (!fbdev->vaddr) {
		ret = -ENOMEM;
		dev_err(fbdev->info->dev, "vmapping fb failed\n");
		goto err_vmap;
	}
	fbdev->info->fix.line_length = fbdev->pitch;
	fbdev->info->var.xres_virtual = fbdev->default_xres_virtual;
	fbdev->info->var.yres_virtual = fbdev->default_yres_virtual;
	fbdev->info->fix.smem_len = fbdev->dma_buf->size;
	fbdev->info->screen_base = fbdev->vaddr;

	return 0;

err_vmap:
	dma_buf_put(fbdev->dma_buf);
	return ret;
}

static void adf_fb_destroy(struct adf_fbdev *fbdev)
{
	dma_buf_vunmap(fbdev->dma_buf, fbdev->vaddr);
	dma_buf_put(fbdev->dma_buf);
}

static void adf_fbdev_set_format(struct adf_fbdev *fbdev, u32 format)
{
	size_t i;
	const struct adf_fbdev_format *info = fbdev_format_info(format);
	for (i = 0; i < ARRAY_SIZE(vga_palette); i++) {
		u16 r = vga_palette[i][0];
		u16 g = vga_palette[i][1];
		u16 b = vga_palette[i][2];

		r >>= (16 - info->r_length);
		g >>= (16 - info->g_length);
		b >>= (16 - info->b_length);

		fbdev->pseudo_palette[i] =
			(r << info->r_offset) |
			(g << info->g_offset) |
			(b << info->b_offset);

		if (info->a_length) {
			u16 a = BIT(info->a_length) - 1;
			fbdev->pseudo_palette[i] |= (a << info->a_offset);
		}
	}

	fbdev->info->var.bits_per_pixel = adf_format_bpp(format);
	fbdev->info->var.red.length = info->r_length;
	fbdev->info->var.red.offset = info->r_offset;
	fbdev->info->var.green.length = info->g_length;
	fbdev->info->var.green.offset = info->g_offset;
	fbdev->info->var.blue.length = info->b_length;
	fbdev->info->var.blue.offset = info->b_offset;
	fbdev->info->var.transp.length = info->a_length;
	fbdev->info->var.transp.offset = info->a_offset;
	fbdev->format = format;
}

static void adf_fbdev_fill_modelist(struct adf_fbdev *fbdev)
{
	struct drm_mode_modeinfo *modelist;
	struct fb_videomode fbmode;
	size_t n_modes, i;
	int ret = 0;

	n_modes = adf_interface_modelist(fbdev->intf, NULL, 0);
	modelist = kzalloc(sizeof(modelist[0]) * n_modes, GFP_KERNEL);
	if (!modelist) {
		dev_warn(fbdev->info->dev, "allocating new modelist failed; keeping old modelist\n");
		return;
	}
	adf_interface_modelist(fbdev->intf, modelist, n_modes);

	fb_destroy_modelist(&fbdev->info->modelist);

	for (i = 0; i < n_modes; i++) {
		adf_modeinfo_to_fb_videomode(&modelist[i], &fbmode);
		ret = fb_add_videomode(&fbmode, &fbdev->info->modelist);
		if (ret < 0)
			dev_warn(fbdev->info->dev, "adding mode %s to modelist failed: %d\n",
					modelist[i].name, ret);
	}

	kfree(modelist);
}

/**
 * adf_fbdev_open - default implementation of fbdev open op
 */
int adf_fbdev_open(struct fb_info *info, int user)
{
	struct adf_fbdev *fbdev = info->par;
	int ret;

	mutex_lock(&fbdev->refcount_lock);

	if (unlikely(fbdev->refcount == UINT_MAX)) {
		ret = -EMFILE;
		goto done;
	}

	if (!fbdev->refcount) {
		struct drm_mode_modeinfo mode;
		struct fb_videomode fbmode;
		struct adf_device *dev = adf_interface_parent(fbdev->intf);

		ret = adf_device_attach(dev, fbdev->eng, fbdev->intf);
		if (ret < 0 && ret != -EALREADY)
			goto done;

		ret = adf_fb_alloc(fbdev);
		if (ret < 0)
			goto done;

		adf_interface_current_mode(fbdev->intf, &mode);
		adf_modeinfo_to_fb_videomode(&mode, &fbmode);
		fb_videomode_to_var(&fbdev->info->var, &fbmode);

		adf_fbdev_set_format(fbdev, fbdev->default_format);
		adf_fbdev_fill_modelist(fbdev);
	}

	ret = adf_fbdev_post(fbdev);
	if (ret < 0) {
		if (!fbdev->refcount)
			adf_fb_destroy(fbdev);
		goto done;
	}

	fbdev->refcount++;
done:
	mutex_unlock(&fbdev->refcount_lock);
	return ret;
}
EXPORT_SYMBOL(adf_fbdev_open);

/**
 * adf_fbdev_release - default implementation of fbdev release op
 */
int adf_fbdev_release(struct fb_info *info, int user)
{
	struct adf_fbdev *fbdev = info->par;
	mutex_lock(&fbdev->refcount_lock);
	BUG_ON(!fbdev->refcount);
	fbdev->refcount--;
	if (!fbdev->refcount)
		adf_fb_destroy(fbdev);
	mutex_unlock(&fbdev->refcount_lock);
	return 0;
}
EXPORT_SYMBOL(adf_fbdev_release);

/**
 * adf_fbdev_check_var - default implementation of fbdev check_var op
 */
int adf_fbdev_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
{
	struct adf_fbdev *fbdev = info->par;
	bool valid_format = true;
	u32 format = drm_fourcc_from_fb_var(var);
	u32 pitch = var->xres_virtual * var->bits_per_pixel / 8;

	if (!format) {
		dev_dbg(info->dev, "%s: unrecognized format\n", __func__);
		valid_format = false;
	}

	if (valid_format && var->grayscale) {
		dev_dbg(info->dev, "%s: grayscale modes not supported\n",
				__func__);
		valid_format = false;
	}

	if (valid_format && var->nonstd) {
		dev_dbg(info->dev, "%s: nonstandard formats not supported\n",
				__func__);
		valid_format = false;
	}

	if (valid_format && !adf_overlay_engine_supports_format(fbdev->eng,
			format)) {
		char format_str[ADF_FORMAT_STR_SIZE];
		adf_format_str(format, format_str);
		dev_dbg(info->dev, "%s: format %s not supported by overlay engine %s\n",
				__func__, format_str, fbdev->eng->base.name);
		valid_format = false;
	}

	if (valid_format && pitch > fbdev->pitch) {
		dev_dbg(info->dev, "%s: fb pitch too small for var (pitch = %u, xres_virtual = %u, bits_per_pixel = %u)\n",
				__func__, fbdev->pitch, var->xres_virtual,
				var->bits_per_pixel);
		valid_format = false;
	}

	if (valid_format && var->yres_virtual > fbdev->default_yres_virtual) {
		dev_dbg(info->dev, "%s: fb height too small for var (h = %u, yres_virtual = %u)\n",
				__func__, fbdev->default_yres_virtual,
				var->yres_virtual);
		valid_format = false;
	}

	if (valid_format) {
		var->activate = info->var.activate;
		var->height = info->var.height;
		var->width = info->var.width;
		var->accel_flags = info->var.accel_flags;
		var->rotate = info->var.rotate;
		var->colorspace = info->var.colorspace;
		/* userspace can't change these */
	} else {
		/* if any part of the format is invalid then fixing it up is
		   impractical, so save just the modesetting bits and
		   overwrite everything else */
		struct fb_videomode mode;
		fb_var_to_videomode(&mode, var);
		memcpy(var, &info->var, sizeof(*var));
		fb_videomode_to_var(var, &mode);
	}

	return 0;
}
EXPORT_SYMBOL(adf_fbdev_check_var);

/**
 * adf_fbdev_set_par - default implementation of fbdev set_par op
 */
int adf_fbdev_set_par(struct fb_info *info)
{
	struct adf_fbdev *fbdev = info->par;
	struct adf_interface *intf = fbdev->intf;
	struct fb_videomode vmode;
	struct drm_mode_modeinfo mode;
	int ret;
	u32 format = drm_fourcc_from_fb_var(&info->var);

	fb_var_to_videomode(&vmode, &info->var);
	adf_modeinfo_from_fb_videomode(&vmode, &mode);
	ret = adf_interface_set_mode(intf, &mode);
	if (ret < 0)
		return ret;

	ret = adf_fbdev_post(fbdev);
	if (ret < 0)
		return ret;

	if (format != fbdev->format)
		adf_fbdev_set_format(fbdev, format);

	return 0;
}
EXPORT_SYMBOL(adf_fbdev_set_par);

/**
 * adf_fbdev_blank - default implementation of fbdev blank op
 */
int adf_fbdev_blank(int blank, struct fb_info *info)
{
	struct adf_fbdev *fbdev = info->par;
	struct adf_interface *intf = fbdev->intf;
	u8 dpms_state;

	switch (blank) {
	case FB_BLANK_UNBLANK:
		dpms_state = DRM_MODE_DPMS_ON;
		break;
	case FB_BLANK_NORMAL:
		dpms_state = DRM_MODE_DPMS_STANDBY;
		break;
	case FB_BLANK_VSYNC_SUSPEND:
		dpms_state = DRM_MODE_DPMS_SUSPEND;
		break;
	case FB_BLANK_HSYNC_SUSPEND:
		dpms_state = DRM_MODE_DPMS_STANDBY;
		break;
	case FB_BLANK_POWERDOWN:
		dpms_state = DRM_MODE_DPMS_OFF;
		break;
	default:
		return -EINVAL;
	}

	return adf_interface_blank(intf, dpms_state);
}
EXPORT_SYMBOL(adf_fbdev_blank);

/**
 * adf_fbdev_pan_display - default implementation of fbdev pan_display op
 */
int adf_fbdev_pan_display(struct fb_var_screeninfo *var, struct fb_info *info)
{
	struct adf_fbdev *fbdev = info->par;
	return adf_fbdev_post(fbdev);
}
EXPORT_SYMBOL(adf_fbdev_pan_display);

/**
 * adf_fbdev_mmap - default implementation of fbdev mmap op
 */
int adf_fbdev_mmap(struct fb_info *info, struct vm_area_struct *vma)
{
	struct adf_fbdev *fbdev = info->par;

	vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
	return dma_buf_mmap(fbdev->dma_buf, vma, 0);
}
EXPORT_SYMBOL(adf_fbdev_mmap);

/**
 * adf_fbdev_init - initialize helper to wrap ADF device in fbdev API
 *
 * @fbdev: the fbdev helper
 * @interface: the ADF interface that will display the framebuffer
 * @eng: the ADF overlay engine that will scan out the framebuffer
 * @xres_virtual: the virtual width of the framebuffer
 * @yres_virtual: the virtual height of the framebuffer
 * @format: the format of the framebuffer
 * @fbops: the device's fbdev ops
 * @fmt: formatting for the framebuffer identification string
 * @...: variable arguments
 *
 * @format must be a standard, non-indexed RGB format, i.e.,
 * adf_format_is_rgb(@format) && @format != @DRM_FORMAT_C8.
 *
 * Returns 0 on success or -errno on failure.
 */
int adf_fbdev_init(struct adf_fbdev *fbdev, struct adf_interface *interface,
		struct adf_overlay_engine *eng,
		u16 xres_virtual, u16 yres_virtual, u32 format,
		struct fb_ops *fbops, const char *fmt, ...)
{
	struct adf_device *parent = adf_interface_parent(interface);
	struct device *dev = &parent->base.dev;
	u16 width_mm, height_mm;
	va_list args;
	int ret;

	if (!adf_format_is_rgb(format) ||
			format == DRM_FORMAT_C8) {
		dev_err(dev, "fbdev helper does not support format %u\n",
				format);
		return -EINVAL;
	}

	memset(fbdev, 0, sizeof(*fbdev));
	fbdev->intf = interface;
	fbdev->eng = eng;
	fbdev->info = framebuffer_alloc(0, dev);
	if (!fbdev->info) {
		dev_err(dev, "allocating framebuffer device failed\n");
		return -ENOMEM;
	}
	mutex_init(&fbdev->refcount_lock);
	fbdev->default_xres_virtual = xres_virtual;
	fbdev->default_yres_virtual = yres_virtual;
	fbdev->default_format = format;

	fbdev->info->flags = FBINFO_FLAG_DEFAULT;
	ret = adf_interface_get_screen_size(interface, &width_mm, &height_mm);
	if (ret < 0) {
		width_mm = 0;
		height_mm = 0;
	}
	fbdev->info->var.width = width_mm;
	fbdev->info->var.height = height_mm;
	fbdev->info->var.activate = FB_ACTIVATE_VBL;
	va_start(args, fmt);
	vsnprintf(fbdev->info->fix.id, sizeof(fbdev->info->fix.id), fmt, args);
	va_end(args);
	fbdev->info->fix.type = FB_TYPE_PACKED_PIXELS;
	fbdev->info->fix.visual = FB_VISUAL_TRUECOLOR;
	fbdev->info->fix.xpanstep = 1;
	fbdev->info->fix.ypanstep = 1;
	INIT_LIST_HEAD(&fbdev->info->modelist);
	fbdev->info->fbops = fbops;
	fbdev->info->pseudo_palette = fbdev->pseudo_palette;
	fbdev->info->par = fbdev;

	ret = register_framebuffer(fbdev->info);
	if (ret < 0) {
		dev_err(dev, "registering framebuffer failed: %d\n", ret);
		return ret;
	}

	return 0;
}
EXPORT_SYMBOL(adf_fbdev_init);

/**
 * adf_fbdev_destroy - destroy helper to wrap ADF device in fbdev API
 *
 * @fbdev: the fbdev helper
 */
void adf_fbdev_destroy(struct adf_fbdev *fbdev)
{
	unregister_framebuffer(fbdev->info);
	BUG_ON(fbdev->refcount);
	mutex_destroy(&fbdev->refcount_lock);
	framebuffer_release(fbdev->info);
}
EXPORT_SYMBOL(adf_fbdev_destroy);