diff -Nur a/fbdev.c b/fbdev.c
--- a/fbdev.c	1970-01-01 01:00:00.000000000 +0100
+++ b/fbdev.c	2011-04-29 17:04:03.000000000 +0200
@@ -0,0 +1,1062 @@
+/*
+ * fbdev -- Frame buffer device test application
+ *
+ * Copyright (C) 2011 Laurent Pinchart <laurent.pinchart@ideasonboard.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * 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.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ */
+
+#include <errno.h>
+#include <fcntl.h>
+#include <getopt.h>
+#include <stdbool.h>
+#include <stdint.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <time.h>
+#include <unistd.h>
+
+#include <sys/ioctl.h>
+#include <sys/mman.h>
+#include <sys/time.h>
+
+#include <linux/fb.h>
+
+#define ARRAY_SIZE(a)	(sizeof(a)/sizeof((a)[0]))
+
+struct device {
+	int fd;
+	void *mem;
+
+	struct fb_fix_screeninfo fix_info;
+	struct fb_var_screeninfo var_info;
+};
+
+enum fb_fill_mode {
+	FB_FILL_NONE = 0,
+	FB_FILL_DISPLAY = 1,
+	FB_FILL_VIRTUAL = 2,
+};
+
+/* -----------------------------------------------------------------------------
+ * FB information display
+ */
+
+struct fb_value_name {
+	unsigned int value;
+	const char *name;
+};
+
+static const struct fb_value_name fb_type_names[] = {
+	{ FB_TYPE_PACKED_PIXELS, "Packed Pixels" },
+	{ FB_TYPE_PLANES, "Non Interleaved Planes" },
+	{ FB_TYPE_INTERLEAVED_PLANES, "Interleaved Planes" },
+	{ FB_TYPE_TEXT, "Text/Attributes" },
+	{ FB_TYPE_VGA_PLANES, "EGA/VGA Planes" },
+};
+
+static const struct fb_value_name fb_visual_names[] = {
+	{ FB_VISUAL_MONO01, "Monochrome (white 0, black 1)" },
+	{ FB_VISUAL_MONO10, "Monochrome (white 1, black 0)" },
+	{ FB_VISUAL_TRUECOLOR, "True Color" },
+	{ FB_VISUAL_PSEUDOCOLOR, "Pseudo Color" },
+	{ FB_VISUAL_DIRECTCOLOR, "Direct Color" },
+	{ FB_VISUAL_STATIC_PSEUDOCOLOR, "Pseudo Color (read-only)" },
+};
+
+static const struct fb_value_name fb_accel_names[] = {
+	{ FB_ACCEL_NONE, "no hardware accelerator" },
+	{ FB_ACCEL_ATARIBLITT, "Atari Blitter" },
+	{ FB_ACCEL_AMIGABLITT, "Amiga Blitter" },
+	{ FB_ACCEL_S3_TRIO64, "Cybervision64 (S3 Trio64)" },
+	{ FB_ACCEL_NCR_77C32BLT, "RetinaZ3 (NCR 77C32BLT)" },
+	{ FB_ACCEL_S3_VIRGE, "Cybervision64/3D (S3 ViRGE)" },
+	{ FB_ACCEL_ATI_MACH64GX, "ATI Mach 64GX family" },
+	{ FB_ACCEL_DEC_TGA, "DEC 21030 TGA" },
+	{ FB_ACCEL_ATI_MACH64CT, "ATI Mach 64CT family" },
+	{ FB_ACCEL_ATI_MACH64VT, "ATI Mach 64CT family VT class" },
+	{ FB_ACCEL_ATI_MACH64GT, "ATI Mach 64CT family GT class" },
+	{ FB_ACCEL_SUN_CREATOR, "Sun Creator/Creator3D" },
+	{ FB_ACCEL_SUN_CGSIX, "Sun cg6" },
+	{ FB_ACCEL_SUN_LEO, "Sun leo/zx" },
+	{ FB_ACCEL_IMS_TWINTURBO, "IMS Twin Turbo" },
+	{ FB_ACCEL_3DLABS_PERMEDIA2, "3Dlabs Permedia 2" },
+	{ FB_ACCEL_MATROX_MGA2064W, "Matrox MGA2064W (Millenium)" },
+	{ FB_ACCEL_MATROX_MGA1064SG, "Matrox MGA1064SG (Mystique)" },
+	{ FB_ACCEL_MATROX_MGA2164W, "Matrox MGA2164W (Millenium II)" },
+	{ FB_ACCEL_MATROX_MGA2164W_AGP, "Matrox MGA2164W (Millenium II)" },
+	{ FB_ACCEL_MATROX_MGAG100, "Matrox G100 (Productiva G100)" },
+	{ FB_ACCEL_MATROX_MGAG200, "Matrox G200 (Myst, Mill, ...)" },
+	{ FB_ACCEL_SUN_CG14, "Sun cgfourteen" },
+	{ FB_ACCEL_SUN_BWTWO, "Sun bwtwo" },
+	{ FB_ACCEL_SUN_CGTHREE, "Sun cgthree" },
+	{ FB_ACCEL_SUN_TCX, "Sun tcx" },
+	{ FB_ACCEL_MATROX_MGAG400, "Matrox G400" },
+	{ FB_ACCEL_NV3, "nVidia RIVA 128" },
+	{ FB_ACCEL_NV4, "nVidia RIVA TNT" },
+	{ FB_ACCEL_NV5, "nVidia RIVA TNT2" },
+	{ FB_ACCEL_CT_6555x, "C&T 6555x" },
+	{ FB_ACCEL_3DFX_BANSHEE, "3Dfx Banshee" },
+	{ FB_ACCEL_ATI_RAGE128, "ATI Rage128 family" },
+	{ FB_ACCEL_IGS_CYBER2000, "CyberPro 2000" },
+	{ FB_ACCEL_IGS_CYBER2010, "CyberPro 2010" },
+	{ FB_ACCEL_IGS_CYBER5000, "CyberPro 5000" },
+	{ FB_ACCEL_SIS_GLAMOUR, "SiS 300/630/540" },
+	{ FB_ACCEL_3DLABS_PERMEDIA3, "3Dlabs Permedia 3" },
+	{ FB_ACCEL_ATI_RADEON, "ATI Radeon family" },
+	{ FB_ACCEL_I810, "Intel 810/815" },
+	{ FB_ACCEL_SIS_GLAMOUR_2, "SiS 315, 650, 740" },
+	{ FB_ACCEL_SIS_XABRE, "SiS 330 (\"Xabre\")" },
+	{ FB_ACCEL_I830, "Intel 830M/845G/85x/865G" },
+	{ FB_ACCEL_NV_10, "nVidia Arch 10" },
+	{ FB_ACCEL_NV_20, "nVidia Arch 20" },
+	{ FB_ACCEL_NV_30, "nVidia Arch 30" },
+	{ FB_ACCEL_NV_40, "nVidia Arch 40" },
+	{ FB_ACCEL_XGI_VOLARI_V, "XGI Volari V3XT, V5, V8" },
+	{ FB_ACCEL_XGI_VOLARI_Z, "XGI Volari Z7" },
+	{ FB_ACCEL_OMAP1610, "TI OMAP16xx" },
+	{ FB_ACCEL_TRIDENT_TGUI, "Trident TGUI" },
+	{ FB_ACCEL_TRIDENT_3DIMAGE, "Trident 3DImage" },
+	{ FB_ACCEL_TRIDENT_BLADE3D, "Trident Blade3D" },
+	{ FB_ACCEL_TRIDENT_BLADEXP, "Trident BladeXP" },
+	{ FB_ACCEL_CIRRUS_ALPINE, "Cirrus Logic 543x/544x/5480" },
+	{ FB_ACCEL_NEOMAGIC_NM2070, "NeoMagic NM2070" },
+	{ FB_ACCEL_NEOMAGIC_NM2090, "NeoMagic NM2090" },
+	{ FB_ACCEL_NEOMAGIC_NM2093, "NeoMagic NM2093" },
+	{ FB_ACCEL_NEOMAGIC_NM2097, "NeoMagic NM2097" },
+	{ FB_ACCEL_NEOMAGIC_NM2160, "NeoMagic NM2160" },
+	{ FB_ACCEL_NEOMAGIC_NM2200, "NeoMagic NM2200" },
+	{ FB_ACCEL_NEOMAGIC_NM2230, "NeoMagic NM2230" },
+	{ FB_ACCEL_NEOMAGIC_NM2360, "NeoMagic NM2360" },
+	{ FB_ACCEL_NEOMAGIC_NM2380, "NeoMagic NM2380" },
+	{ FB_ACCEL_SAVAGE4, "S3 Savage4" },
+	{ FB_ACCEL_SAVAGE3D, "S3 Savage3D" },
+	{ FB_ACCEL_SAVAGE3D_MV, "S3 Savage3D-MV" },
+	{ FB_ACCEL_SAVAGE2000, "S3 Savage2000" },
+	{ FB_ACCEL_SAVAGE_MX_MV, "S3 Savage/MX-MV" },
+	{ FB_ACCEL_SAVAGE_MX, "S3 Savage/MX" },
+	{ FB_ACCEL_SAVAGE_IX_MV, "S3 Savage/IX-MV" },
+	{ FB_ACCEL_SAVAGE_IX, "S3 Savage/IX" },
+	{ FB_ACCEL_PROSAVAGE_PM, "S3 ProSavage PM133" },
+	{ FB_ACCEL_PROSAVAGE_KM, "S3 ProSavage KM133" },
+	{ FB_ACCEL_S3TWISTER_P, "S3 Twister" },
+	{ FB_ACCEL_S3TWISTER_K, "S3 TwisterK" },
+	{ FB_ACCEL_SUPERSAVAGE, "S3 Supersavage" },
+	{ FB_ACCEL_PROSAVAGE_DDR, "S3 ProSavage DDR" },
+	{ FB_ACCEL_PROSAVAGE_DDRK, "S3 ProSavage DDR-K" },
+};
+
+static const char *fb_value_name(const struct fb_value_name *names,
+				 unsigned int size, unsigned int value)
+{
+	unsigned int i;
+
+	for (i = 0; i < size; ++i) {
+		if (names[i].value == value)
+			return names[i].name;
+	}
+
+	return "Unknown";
+}
+
+static const char *fb_type_name(unsigned int type)
+{
+	return fb_value_name(fb_type_names, ARRAY_SIZE(fb_type_names), type);
+}
+
+static const char *fb_visual_name(unsigned int visual)
+{
+	return fb_value_name(fb_visual_names, ARRAY_SIZE(fb_visual_names), visual);
+}
+
+static const char *fb_accel_name(unsigned int accel)
+{
+	return fb_value_name(fb_accel_names, ARRAY_SIZE(fb_accel_names), accel);
+}
+
+/*
+ * fb_print_fix - Print fixed screen information
+ * @dev: FB device
+ * @var: fixed screen information
+ */
+static void fb_print_fix(struct device *dev __attribute__((__unused__)),
+			 struct fb_fix_screeninfo *fix)
+{
+	printf("--- Fixed screen info ---\n");
+	printf(" Type:\t\t%s\n", fb_type_name(fix->type));
+	printf(" Visual:\t%s\n", fb_visual_name(fix->visual));
+	printf(" Chip/card:\t%s\n", fb_accel_name(fix->accel));
+
+	printf(" Memory:\t%u bytes @0x%08lx\n", fix->smem_len,
+		fix->smem_start);
+
+	if (fix->xpanstep == 0)
+		printf(" X Pan:\t\tUnsupported\n");
+	else
+		printf(" X Pan Step:\t%u\n", fix->xpanstep);
+
+	if (fix->ypanstep == 0)
+		printf(" Y Pan:\t\tUnsupported\n");
+	else
+		printf(" Y Pan Step:\t%u\n", fix->ypanstep);
+
+	printf(" Line Length:\t%u bytes\n", fix->line_length);
+}
+
+/*
+ * fb_print_var - Print fixed screen information
+ * @dev: FB device
+ * @var: variable screen information
+ */
+static void fb_print_var(struct device *dev, struct fb_var_screeninfo *var)
+{
+	unsigned int i;
+
+	printf("--- Variable screen info ---\n");
+	printf(" Resolution:\t\t%ux%u\n", var->xres, var->yres);
+	printf(" Virtual Resolution:\t%ux%u\n", var->xres_virtual,
+		var->yres_virtual);
+	printf(" X/Y Offset:\t\t(%u,%u)\n", var->xoffset, var->yoffset);
+	printf(" Size:\t\t\t%umm x %umm\n", var->width, var->height);
+
+	if (dev->fix_info.visual == FB_VISUAL_TRUECOLOR) {
+		printf(" Pixel organization:\t");
+		for (i = var->bits_per_pixel - 1; i < var->bits_per_pixel; --i) {
+			if (var->red.offset <= i && var->red.offset + var->red.length > i)
+				printf("R");
+			else if (var->green.offset <= i && var->green.offset + var->green.length > i)
+				printf("G");
+			else if (var->blue.offset <= i && var->blue.offset + var->green.length > i)
+				printf("B");
+			else if (var->transp.offset <= i && var->transp.offset + var->transp.length > i)
+				printf("A");
+		}
+		printf("\n  (%u bits per pixel)\t", var->bits_per_pixel);
+		for (i = var->bits_per_pixel - 1; i < var->bits_per_pixel; --i) {
+			if (var->red.offset <= i &&
+			    var->red.offset + var->red.length > i)
+				printf("%u", var->red.msb_right ?
+					var->red.offset + var->red.length - 1 - i :
+					i - var->red.offset);
+			else if (var->green.offset <= i &&
+				 var->green.offset + var->green.length > i)
+				printf("%u", var->green.msb_right ?
+					var->green.offset + var->green.length - 1 - i :
+					i - var->green.offset);
+			else if (var->blue.offset <= i &&
+				 var->blue.offset + var->green.length > i)
+				printf("%u", var->blue.msb_right ?
+					var->blue.offset + var->blue.length - 1 - i :
+					i - var->blue.offset);
+			else if (var->transp.offset <= i &&
+				 var->transp.offset + var->transp.length > i)
+				printf("%u", var->transp.msb_right ?
+					var->transp.offset + var->transp.length - 1 - i :
+					i - var->transp.offset);
+		}
+		printf("\n");
+	}
+}
+
+/* -----------------------------------------------------------------------------
+ * Memory mapping
+ */
+
+/*
+ * fb_map_memory - Map the frame buffer memory to userspace
+ * @dev: FB device
+ */
+static int fb_map_memory(struct device *dev)
+{
+	void *mem;
+
+	mem = mmap(NULL, dev->fix_info.smem_len, PROT_READ | PROT_WRITE,
+		   MAP_SHARED, dev->fd, 0);
+	if (mem == MAP_FAILED) {
+		printf("Error: FB memory map failed: %s (%d)\n",
+			strerror(errno), errno);
+		return -1;
+	}
+
+	dev->mem = mem;
+	return 0;
+}
+
+/*
+ * fb_unmap_memory - Unmap the frame buffer memory from userspace
+ * @dev: FB device
+ */
+static void fb_unmap_memory(struct device *dev)
+{
+	if (dev->mem == MAP_FAILED)
+		return;
+
+	munmap(dev->mem, dev->fix_info.smem_len);
+}
+
+/* -----------------------------------------------------------------------------
+ * Open/close
+ */
+
+/*
+ * fb_open - Open a frame buffer device
+ * @dev: FB device
+ * @devname: FB device node name and path
+ *
+ * Open the FB devide referenced by devname. Retrieve fixed and variable screen
+ * information, map the frame buffer memory and fill the dev structure.
+ */
+static int fb_open(struct device *dev, const char *devname)
+{
+	int ret;
+
+	memset(dev, 0, sizeof *dev);
+	dev->fd = -1;
+	dev->mem = MAP_FAILED;
+
+	dev->fd = open(devname, O_RDWR);
+	if (dev->fd < 0) {
+		printf("Error opening device %s: %d.\n", devname, errno);
+		return dev->fd;
+	}
+
+	ret = ioctl(dev->fd, FBIOGET_FSCREENINFO, &dev->fix_info);
+	if (ret < 0) {
+		printf("Error opening device %s: unable to get fixed screen "
+			"info.\n", devname);
+		close(dev->fd);
+		return ret;
+	}
+
+	ret = ioctl(dev->fd, FBIOGET_VSCREENINFO, &dev->var_info);
+	if (ret < 0) {
+		printf("Error opening device %s: unable to get variable screen "
+			"info.\n", devname);
+		close(dev->fd);
+		return ret;
+	}
+
+	printf("Device %s opened: %s\n\n", devname, dev->fix_info.id);
+	fb_print_fix(dev, &dev->fix_info);
+	printf("\n");
+	fb_print_var(dev, &dev->var_info);
+	printf("\n");
+
+	ret = fb_map_memory(dev);
+	if (ret < 0) {
+		close(dev->fd);
+		return ret;
+	}
+
+	printf("FB memory mapped at %p\n", dev->mem);
+	return 0;
+}
+
+/*
+ * fb_close - Close a frame buffer device
+ * @dev: FB device
+ *
+ * Close a frame buffer device previously opened by fb_open().
+ */
+static void fb_close(struct device *dev)
+{
+	fb_unmap_memory(dev);
+	close(dev->fd);
+}
+
+/* -----------------------------------------------------------------------------
+ * Blanking and sync
+ */
+
+/*
+ * fb_blank - Control screen blanking
+ * @dev: FB device
+ * @blank: Blanking state
+ *
+ * Set the frame buffer screen blanking state. Acceptable values for the blank
+ * parameter are
+ *
+ * FB_BLANK_UNBLANK		Blanking off, screen active
+ * FB_BLANK_NORMAL		Blanked, HSync on,  VSync on
+ * FB_BLANK_VSYNC_SUSPEND	Blanked, HSync on,  VSync off
+ * FB_BLANK_HSYNC_SUSPEND	Blanked, HSync off, VSync on
+ * FB_BLANK_POWERDOWN		Blanked, HSync off, VSync off
+ */
+static int fb_blank(struct device *dev, int blank)
+{
+	int ret;
+
+	ret = ioctl(dev->fd, FBIOBLANK, blank);
+	if (ret < 0) {
+		printf("Error: blank failed: %s (%d)\n", strerror(errno), errno);
+		return ret;
+	}
+
+	return 0;
+}
+
+/*
+ * fb_wait_for_vsync - Wait for vsync
+ * @dev: FB device
+ * @screen: Screen number
+ *
+ * Unblank the screen to make sure vsync events are generated and wait for 1000
+ * 1000 vsync events on the given screen. Print the average refresh rate when
+ * done.
+ */
+static int fb_wait_for_vsync(struct device *dev, unsigned int screen)
+{
+	struct timespec start, end;
+	unsigned int i;
+	double fps;
+	int ret;
+
+	/* Can't wait for vsync if the displayed is blanked. */
+	fb_blank(dev, FB_BLANK_UNBLANK);
+
+	printf("waiting for 1000 vsync events... ");
+	fflush(stdout);
+
+	clock_gettime(CLOCK_MONOTONIC, &start);
+
+	for (i = 0; i < 1000; ++i) {
+		ret = ioctl(dev->fd, FBIO_WAITFORVSYNC, &screen);
+		if (ret < 0) {
+			printf("\nError: wait for vsync failed: %s (%d)\n",
+				strerror(errno), errno);
+			return ret;
+		}
+	}
+
+	clock_gettime(CLOCK_MONOTONIC, &end);
+
+	end.tv_sec -= start.tv_sec;
+	end.tv_nsec -= start.tv_nsec;
+	if (end.tv_nsec < 0) {
+		end.tv_sec--;
+		end.tv_nsec += 1000000000;
+	}
+
+	fps = i / (end.tv_sec + end.tv_nsec / 1000000000.);
+
+	printf("done\n");
+	printf("%u vsync interrupts in %lu.%06lu s, %f Hz\n",
+		i, end.tv_sec, end.tv_nsec / 1000, fps);
+
+	return 0;
+}
+
+/* -----------------------------------------------------------------------------
+ * Resolution and pan
+ */
+
+/*
+ * fb_set_format - Set the frame buffer pixel format
+ * @dev: FB device
+ * @bpp: Bits per pixel
+ */
+static int fb_set_format(struct device *dev, unsigned int bpp)
+{
+	struct fb_var_screeninfo var_info;
+	int ret;
+
+	var_info = dev->var_info;
+
+	var_info.bits_per_pixel = bpp;
+	var_info.activate = FB_ACTIVATE_NOW;
+
+	ret = ioctl(dev->fd, FBIOPUT_VSCREENINFO, &var_info);
+	if (ret < 0) {
+		printf("Error: set format failed: %s (%d)\n",
+			strerror(errno), errno);
+		return ret;
+	}
+
+	dev->var_info = var_info;
+
+	printf("Format set to %u bits per pixel\n\n",
+		var_info.bits_per_pixel);
+
+	fb_print_var(dev, &var_info);
+
+	return 0;
+}
+
+/*
+ * fb_set_resolution - Set the frame buffer real and virtual resolutions
+ * @dev: FB device
+ * @xres: Horizontal resolution
+ * @yres: Vertical resolution
+ * @xres_virtual: Horizontal virtual resolution
+ * @yres_virtual: Vertical virtual resolution
+ *
+ * Modify the real and virtual resolutions of the frame buffer to (xres, yres)
+ * and (xres_virtual, yres_virtual). The real or virtual resolution can be kept
+ * unchanged by setting its value to (-1, -1).
+ */
+static int fb_set_resolution(struct device *dev, int xres, int yres,
+			     int xres_virtual, int yres_virtual)
+{
+	struct fb_var_screeninfo var_info;
+	int ret;
+
+	var_info = dev->var_info;
+
+	if (xres != -1 && yres != -1 ) {
+		var_info.xres = xres;
+		var_info.yres = yres;
+	}
+
+	if (xres_virtual != -1 && yres_virtual != -1 ) {
+		var_info.xres_virtual = xres_virtual;
+		var_info.yres_virtual = yres_virtual;
+	}
+
+	printf("Setting resolution to %ux%u (virtual %ux%u)\n",
+		var_info.xres, var_info.yres,
+		var_info.xres_virtual, var_info.yres_virtual);
+
+	var_info.bits_per_pixel = 16;
+	var_info.activate = FB_ACTIVATE_NOW;
+
+	ret = ioctl(dev->fd, FBIOPUT_VSCREENINFO, &var_info);
+	if (ret < 0) {
+		printf("Error: set resolution failed: %s (%d)\n",
+			strerror(errno), errno);
+		return ret;
+	}
+
+	dev->var_info = var_info;
+
+	printf("Resolution set to %ux%u (virtual %ux%u)\n\n",
+		var_info.xres, var_info.yres,
+		var_info.xres_virtual, var_info.yres_virtual);
+
+	fb_print_var(dev, &var_info);
+
+	return 0;
+}
+
+/*
+ * fb_pan - Pan the display
+ * @dev: FB device
+ * @x: Horizontal offset
+ * @y: Vertical offset
+ *
+ * Pan the display to set the virtual point (x, y) on the top left corner of the
+ * screen.
+ */
+static int fb_pan(struct device *dev, unsigned int x, unsigned int y)
+{
+	struct fb_var_screeninfo var_info;
+	int ret;
+
+	memset(&var_info, 0, sizeof var_info);
+	var_info.xoffset = x;
+	var_info.yoffset = y;
+
+	ret = ioctl(dev->fd, FBIOPAN_DISPLAY, &var_info);
+	if (ret < 0) {
+		printf("Error: pan failed: %s (%d)\n", strerror(errno), errno);
+		return ret;
+	}
+
+	dev->var_info.xoffset = var_info.xoffset;
+	dev->var_info.yoffset = var_info.yoffset;
+
+	return 0;
+}
+
+/* -----------------------------------------------------------------------------
+ * Test pattern
+ */
+
+#define FB_MAKE_COLOR(var, r, g, b) \
+	((((r) >> (8 - (var)->red.length)) << (var)->red.offset) | \
+	 (((g) >> (8 - (var)->green.length)) << (var)->green.offset) | \
+	 (((b) >> (8 - (var)->blue.length)) << (var)->blue.offset))
+
+static void
+fb_fill_rgb16(struct device *dev, unsigned int xoffset, unsigned int yoffset,
+	      unsigned int xres, unsigned int yres)
+{
+	const uint16_t colors_top[] = {
+		FB_MAKE_COLOR(&dev->var_info, 192, 192, 192),	/* grey */
+		FB_MAKE_COLOR(&dev->var_info, 192, 192, 0),	/* yellow */
+		FB_MAKE_COLOR(&dev->var_info, 0, 192, 192),	/* cyan */
+		FB_MAKE_COLOR(&dev->var_info, 0, 192, 0),	/* green */
+		FB_MAKE_COLOR(&dev->var_info, 192, 0, 192),	/* magenta */
+		FB_MAKE_COLOR(&dev->var_info, 192, 0, 0),	/* red */
+		FB_MAKE_COLOR(&dev->var_info, 0, 0, 192),	/* blue */
+	};
+	const uint16_t colors_middle[] = {
+		FB_MAKE_COLOR(&dev->var_info, 0, 0, 192),	/* blue */
+		FB_MAKE_COLOR(&dev->var_info, 19, 19, 19),	/* black */
+		FB_MAKE_COLOR(&dev->var_info, 192, 0, 192),	/* magenta */
+		FB_MAKE_COLOR(&dev->var_info, 19, 19, 19),	/* black */
+		FB_MAKE_COLOR(&dev->var_info, 0, 192, 192),	/* cyan */
+		FB_MAKE_COLOR(&dev->var_info, 19, 19, 19),	/* black */
+		FB_MAKE_COLOR(&dev->var_info, 192, 192, 192),	/* grey */
+	};
+	const uint16_t colors_bottom[] = {
+		FB_MAKE_COLOR(&dev->var_info, 0, 33, 76),	/* in-phase */
+		FB_MAKE_COLOR(&dev->var_info, 255, 255, 255),	/* super white */
+		FB_MAKE_COLOR(&dev->var_info, 50, 0, 106),	/* quadrature */
+		FB_MAKE_COLOR(&dev->var_info, 19, 19, 19),	/* black */
+		FB_MAKE_COLOR(&dev->var_info, 9, 9, 9),		/* 3.5% */
+		FB_MAKE_COLOR(&dev->var_info, 19, 19, 19),	/* 7.5% */
+		FB_MAKE_COLOR(&dev->var_info, 29, 29, 29),	/* 11.5% */
+		FB_MAKE_COLOR(&dev->var_info, 19, 19, 19),	/* black */
+	};
+	void *mem = dev->mem + dev->fix_info.line_length * yoffset
+		  + xoffset * dev->var_info.bits_per_pixel / 8;
+	unsigned int x;
+	unsigned int y;
+
+	for (y = 0; y < yres * 6 / 9; ++y) {
+		for (x = 0; x < xres; ++x)
+			((uint16_t *)mem)[x] = colors_top[x * 7 / xres];
+		mem += dev->fix_info.line_length;
+	}
+
+	for (; y < yres * 7 / 9; ++y) {
+		for (x = 0; x < xres; ++x)
+			((uint16_t *)mem)[x] = colors_middle[x * 7 / xres];
+		mem += dev->fix_info.line_length;
+	}
+
+	for (; y < yres; ++y) {
+		for (x = 0; x < xres * 5 / 7; ++x)
+			((uint16_t *)mem)[x] =
+				colors_bottom[x * 4 / (xres * 5 / 7)];
+		for (; x < xres * 6 / 7; ++x)
+			((uint16_t *)mem)[x] =
+				colors_bottom[(x - xres * 5 / 7) * 3
+					      / (xres / 7) + 4];
+		for (; x < xres; ++x)
+			((uint16_t *)mem)[x] = colors_bottom[7];
+		mem += dev->fix_info.line_length;
+	}
+}
+
+struct fb_color24 {
+	unsigned int value:24;
+} __attribute__((__packed__));
+
+#define FB_MAKE_COLOR24(var, r, g, b) \
+	{ .value = FB_MAKE_COLOR(var, r, g, b) }
+
+static void
+fb_fill_rgb24(struct device *dev, unsigned int xoffset, unsigned int yoffset,
+	      unsigned int xres, unsigned int yres)
+{
+	const struct fb_color24 colors_top[] = {
+		FB_MAKE_COLOR24(&dev->var_info, 192, 192, 192),	/* grey */
+		FB_MAKE_COLOR24(&dev->var_info, 192, 192, 0),	/* yellow */
+		FB_MAKE_COLOR24(&dev->var_info, 0, 192, 192),	/* cyan */
+		FB_MAKE_COLOR24(&dev->var_info, 0, 192, 0),	/* green */
+		FB_MAKE_COLOR24(&dev->var_info, 192, 0, 192),	/* magenta */
+		FB_MAKE_COLOR24(&dev->var_info, 192, 0, 0),	/* red */
+		FB_MAKE_COLOR24(&dev->var_info, 0, 0, 192),	/* blue */
+	};
+	const struct fb_color24 colors_middle[] = {
+		FB_MAKE_COLOR24(&dev->var_info, 0, 0, 192),	/* blue */
+		FB_MAKE_COLOR24(&dev->var_info, 19, 19, 19),	/* black */
+		FB_MAKE_COLOR24(&dev->var_info, 192, 0, 192),	/* magenta */
+		FB_MAKE_COLOR24(&dev->var_info, 19, 19, 19),	/* black */
+		FB_MAKE_COLOR24(&dev->var_info, 0, 192, 192),	/* cyan */
+		FB_MAKE_COLOR24(&dev->var_info, 19, 19, 19),	/* black */
+		FB_MAKE_COLOR24(&dev->var_info, 192, 192, 192),	/* grey */
+	};
+	const struct fb_color24 colors_bottom[] = {
+		FB_MAKE_COLOR24(&dev->var_info, 0, 33, 76),	/* in-phase */
+		FB_MAKE_COLOR24(&dev->var_info, 255, 255, 255),	/* super white */
+		FB_MAKE_COLOR24(&dev->var_info, 50, 0, 106),	/* quadrature */
+		FB_MAKE_COLOR24(&dev->var_info, 19, 19, 19),	/* black */
+		FB_MAKE_COLOR24(&dev->var_info, 9, 9, 9),	/* 3.5% */
+		FB_MAKE_COLOR24(&dev->var_info, 19, 19, 19),	/* 7.5% */
+		FB_MAKE_COLOR24(&dev->var_info, 29, 29, 29),	/* 11.5% */
+		FB_MAKE_COLOR24(&dev->var_info, 19, 19, 19),	/* black */
+	};
+	void *mem = dev->mem + dev->fix_info.line_length * yoffset
+		  + xoffset * dev->var_info.bits_per_pixel / 8;
+	unsigned int x;
+	unsigned int y;
+
+	for (y = 0; y < yres * 6 / 9; ++y) {
+		for (x = 0; x < xres; ++x)
+			((struct fb_color24 *)mem)[x] =
+				colors_top[x * 7 / xres];
+		mem += dev->fix_info.line_length;
+	}
+
+	for (; y < yres * 7 / 9; ++y) {
+		for (x = 0; x < xres; ++x)
+			((struct fb_color24 *)mem)[x] =
+				colors_middle[x * 7 / xres];
+		mem += dev->fix_info.line_length;
+	}
+
+	for (; y < yres; ++y) {
+		for (x = 0; x < xres * 5 / 7; ++x)
+			((struct fb_color24 *)mem)[x] =
+				colors_bottom[x * 4 / (xres * 5 / 7)];
+		for (; x < xres * 6 / 7; ++x)
+			((struct fb_color24 *)mem)[x] =
+				colors_bottom[(x - xres * 5 / 7) * 3
+					      / (xres / 7) + 4];
+		for (; x < xres; ++x)
+			((struct fb_color24 *)mem)[x] = colors_bottom[7];
+		mem += dev->fix_info.line_length;
+	}
+}
+
+static void
+fb_fill_rgb32(struct device *dev, unsigned int xoffset, unsigned int yoffset,
+	      unsigned int xres, unsigned int yres)
+{
+	const uint32_t colors_top[] = {
+		FB_MAKE_COLOR(&dev->var_info, 192, 192, 192),	/* grey */
+		FB_MAKE_COLOR(&dev->var_info, 192, 192, 0),	/* yellow */
+		FB_MAKE_COLOR(&dev->var_info, 0, 192, 192),	/* cyan */
+		FB_MAKE_COLOR(&dev->var_info, 0, 192, 0),	/* green */
+		FB_MAKE_COLOR(&dev->var_info, 192, 0, 192),	/* magenta */
+		FB_MAKE_COLOR(&dev->var_info, 192, 0, 0),	/* red */
+		FB_MAKE_COLOR(&dev->var_info, 0, 0, 192),	/* blue */
+	};
+	const uint32_t colors_middle[] = {
+		FB_MAKE_COLOR(&dev->var_info, 0, 0, 192),	/* blue */
+		FB_MAKE_COLOR(&dev->var_info, 19, 19, 19),	/* black */
+		FB_MAKE_COLOR(&dev->var_info, 192, 0, 192),	/* magenta */
+		FB_MAKE_COLOR(&dev->var_info, 19, 19, 19),	/* black */
+		FB_MAKE_COLOR(&dev->var_info, 0, 192, 192),	/* cyan */
+		FB_MAKE_COLOR(&dev->var_info, 19, 19, 19),	/* black */
+		FB_MAKE_COLOR(&dev->var_info, 192, 192, 192),	/* grey */
+	};
+	const uint32_t colors_bottom[] = {
+		FB_MAKE_COLOR(&dev->var_info, 0, 33, 76),	/* in-phase */
+		FB_MAKE_COLOR(&dev->var_info, 255, 255, 255),	/* super white */
+		FB_MAKE_COLOR(&dev->var_info, 50, 0, 106),	/* quadrature */
+		FB_MAKE_COLOR(&dev->var_info, 19, 19, 19),	/* black */
+		FB_MAKE_COLOR(&dev->var_info, 9, 9, 9),		/* 3.5% */
+		FB_MAKE_COLOR(&dev->var_info, 19, 19, 19),	/* 7.5% */
+		FB_MAKE_COLOR(&dev->var_info, 29, 29, 29),	/* 11.5% */
+		FB_MAKE_COLOR(&dev->var_info, 19, 19, 19),	/* black */
+	};
+	void *mem = dev->mem + dev->fix_info.line_length * yoffset
+		  + xoffset * dev->var_info.bits_per_pixel / 8;
+	unsigned int x;
+	unsigned int y;
+
+	for (y = 0; y < yres * 6 / 9; ++y) {
+		for (x = 0; x < xres; ++x)
+			((uint32_t *)mem)[x] = colors_top[x * 7 / xres];
+		mem += dev->fix_info.line_length;
+	}
+
+	for (; y < yres * 7 / 9; ++y) {
+		for (x = 0; x < xres; ++x)
+			((uint32_t *)mem)[x] = colors_middle[x * 7 / xres];
+		mem += dev->fix_info.line_length;
+	}
+
+	for (; y < yres; ++y) {
+		for (x = 0; x < xres * 5 / 7; ++x)
+			((uint32_t *)mem)[x] =
+				colors_bottom[x * 4 / (xres * 5 / 7)];
+		for (; x < xres * 6 / 7; ++x)
+			((uint32_t *)mem)[x] =
+				colors_bottom[(x - xres * 5 / 7) * 3
+					      / (xres / 7) + 4];
+		for (; x < xres; ++x)
+			((uint32_t *)mem)[x] = colors_bottom[7];
+		mem += dev->fix_info.line_length;
+	}
+}
+
+/*
+ * fb_fill - Fill the frame buffer with an SMPTE test pattern
+ * @dev: FB device
+ * @mode: Fill mode
+ *
+ * Fill the display (when mode is FB_FILL_DISPLAY) or virtual frame buffer area
+ * (when mode is FB_FILL_VIRTUAL) with an SMPTE color bars pattern. Only RGB16,
+ * RGB24 and RGB32 on true color visuals are supported.
+ */
+static void fb_fill(struct device *dev, enum fb_fill_mode mode)
+{
+	unsigned int xoffset, yoffset;
+	unsigned int xres, yres;
+
+	if (dev->fix_info.visual != FB_VISUAL_TRUECOLOR) {
+		printf("Error: test pattern is only supported for true color "
+			"visuals.\n");
+		return;
+	}
+
+	printf("Filling frame buffer with SMPTE test pattern\n");
+
+	if (mode == FB_FILL_DISPLAY) {
+		xoffset = dev->var_info.xoffset;
+		yoffset = dev->var_info.yoffset;
+		xres = dev->var_info.xres;
+		yres = dev->var_info.yres;
+	} else {
+		xoffset = 0;
+		yoffset = 0;
+		xres = dev->var_info.xres_virtual;
+		yres = dev->var_info.yres_virtual;
+	}
+
+	switch (dev->var_info.bits_per_pixel) {
+	case 16:
+		return fb_fill_rgb16(dev, xoffset, yoffset, xres, yres);
+	case 24:
+		return fb_fill_rgb24(dev, xoffset, yoffset, xres, yres);
+	case 32:
+		return fb_fill_rgb32(dev, xoffset, yoffset, xres, yres);
+	default:
+		printf("Error: display depth %u bpp not supported.\n",
+			dev->var_info.bits_per_pixel);
+		break;
+	}
+}
+
+/* -----------------------------------------------------------------------------
+ * Main
+ */
+
+static void usage(const char *argv0)
+{
+	printf("Usage: %s [options] device\n", argv0);
+	printf("Supported options:\n");
+	printf("-b, --blank mode		Set blanking mode\n");
+	printf("-f, --fill[=mode]		Fill the frame buffer with a test pattern\n");
+	printf("-F, --format bpp		Set the number of bits per pixel\n");
+	printf("-h, --help			Show this help screen\n");
+	printf("-p, --pan x,y			Pan the display to position (x,y)\n");
+	printf("-r, --resolution wxh		Set the display resolution to width x height\n");
+	printf("-v, --virtual wxh		Set the display virtual resolution to width x height\n");
+	printf("-w, --wait-vsync[=screen]	Wait for VSync on the given screen\n");
+	printf("\n");
+	printf("Support fill modes are:\n");
+	printf("display		Fill the displayed frame buffer only\n");
+	printf("virtual		Fill the whole virtual frame buffer\n");
+	printf("Supported blanking modes are:\n");
+	printf(" off		Blanking off, screen active\n");
+	printf(" on		Blanked, HSync on,  VSync on\n");
+	printf(" vsync		Blanked, HSync on,  VSync off\n");
+	printf(" hsync		Blanked, HSync off, VSync on\n");
+	printf(" powerdown	Blanked, HSync off, VSync off\n");
+}
+
+static struct option opts[] = {
+	{"blank", 1, 0, 'b'},
+	{"fill", 2, 0, 'f'},
+	{"format", 1, 0, 'F'},
+	{"help", 0, 0, 'h'},
+	{"pan", 1, 0, 'p'},
+	{"resolution", 1, 0, 'r'},
+	{"virtual", 1, 0, 'v'},
+	{"wait-vsync", 2, 0, 'w'},
+	{0, 0, 0, 0}
+};
+
+static int fb_blank_parse(const char *arg, int *value)
+{
+	static const struct fb_value_name names[] = {
+		{ FB_BLANK_UNBLANK, "off" },
+		{ FB_BLANK_NORMAL, "on" },
+		{ FB_BLANK_VSYNC_SUSPEND, "vsync" },
+		{ FB_BLANK_HSYNC_SUSPEND, "hsync" },
+		{ FB_BLANK_POWERDOWN, "powerdown" },
+	};
+	unsigned int i;
+
+	for (i = 0; i < ARRAY_SIZE(names); ++i) {
+		if (strcmp(names[i].name, arg) == 0) {
+			*value = names[i].value;
+			return 0;
+		}
+	}
+
+	return -1;
+}
+
+static int fb_point_parse(const char *arg, unsigned int *x, unsigned int *y)
+{
+	unsigned long value;
+	char *endptr;
+
+	value = strtoul(arg, &endptr, 10);
+	if (endptr == arg || *endptr != ',')
+		return -1;
+	*x = value;
+	arg = endptr + 1;
+
+	value = strtoul(arg, &endptr, 10);
+	if (endptr == arg || *endptr != '\0')
+		return -1;
+	*y = value;
+
+	return 0;
+}
+
+static int fb_size_parse(const char *arg, int *x, int *y)
+{
+	unsigned long value;
+	char *endptr;
+
+	value = strtoul(arg, &endptr, 10);
+	if (endptr == arg || *endptr != 'x')
+		return -1;
+	*x = value;
+	arg = endptr + 1;
+
+	value = strtoul(arg, &endptr, 10);
+	if (endptr == arg || *endptr != '\0')
+		return -1;
+	*y = value;
+
+	return 0;
+}
+
+int main(int argc, char *argv[])
+{
+	struct device dev;
+	int ret;
+
+	/* Options parsing. */
+	bool do_blank = false;
+	int blank = 0;
+
+	enum fb_fill_mode fill_mode = FB_FILL_NONE;
+
+	bool do_format = false;
+	unsigned int bpp = 0;
+
+	bool do_pan = false;
+	unsigned int pan_x = 0;
+	unsigned int pan_y = 0;
+
+	bool do_resolution = false;
+	int xres = -1;
+	int yres = -1;
+	int xres_virtual = -1;
+	int yres_virtual = -1;
+
+	bool do_wait_for_vsync = false;
+	unsigned int screen = 0;
+
+	int c;
+
+	opterr = 0;
+	while ((c = getopt_long(argc, argv, "b:f::F:hp:r:v:w::", opts, NULL)) != -1) {
+
+		switch (c) {
+		case 'b':
+			do_blank = true;
+			if (fb_blank_parse(optarg, &blank) < 0) {
+				printf("Invalid blanking mode `%s'\n", optarg);
+				printf("Run %s -h for help.\n", argv[0]);
+				return 1;
+			}
+			break;
+		case 'f':
+			if (optarg == NULL)
+				fill_mode = FB_FILL_DISPLAY;
+			else if (strcmp(optarg, "display") == 0)
+				fill_mode = FB_FILL_DISPLAY;
+			else if (strcmp(optarg, "virtual") == 0)
+				fill_mode = FB_FILL_VIRTUAL;
+			else {
+				printf("Invalid fill mode `%s'\n", optarg);
+				printf("Run %s -h for help.\n", argv[0]);
+				return 1;
+			}
+			break;
+		case 'F':
+			do_format = true;
+			bpp = atoi(optarg);
+			break;
+		case 'h':
+			usage(argv[0]);
+			return 0;
+		case 'p':
+			do_pan = true;
+			if (fb_point_parse(optarg, &pan_x, &pan_y) < 0) {
+				printf("Invalid pan point `%s'\n", optarg);
+				printf("Run %s -h for help.\n", argv[0]);
+				return 1;
+			}
+			break;
+		case 'r':
+			do_resolution = true;
+			if (fb_size_parse(optarg, &xres, &yres) < 0) {
+				printf("Invalid resolution `%s'\n", optarg);
+				printf("Run %s -h for help.\n", argv[0]);
+				return 1;
+			}
+			break;
+		case 'v':
+			do_resolution = true;
+			if (fb_size_parse(optarg, &xres_virtual, &yres_virtual) < 0) {
+				printf("Invalid virtual resolution `%s'\n", optarg);
+				printf("Run %s -h for help.\n", argv[0]);
+				return 1;
+			}
+			break;
+		case 'w':
+			do_wait_for_vsync = true;
+			if (optarg)
+				screen = atoi(optarg);
+			break;
+		default:
+			printf("Invalid option -%c\n", c);
+			printf("Run %s -h for help.\n", argv[0]);
+			return 1;
+		}
+	}
+
+	if (optind >= argc) {
+		usage(argv[0]);
+		return 1;
+	}
+
+	ret = fb_open(&dev, argv[optind]);
+	if (ret < 0)
+		return 1;
+
+	if (do_blank)
+		fb_blank(&dev, blank);
+
+	if (do_format)
+		fb_set_format(&dev, bpp);
+
+	if (do_resolution)
+		fb_set_resolution(&dev, xres, yres, xres_virtual, yres_virtual);
+
+	if (fill_mode != FB_FILL_NONE)
+		fb_fill(&dev, fill_mode);
+
+	if (do_pan)
+		fb_pan(&dev, pan_x, pan_y);
+
+	if (do_wait_for_vsync)
+		fb_wait_for_vsync(&dev, screen);
+
+	fb_close(&dev);
+	return 0;
+}
