path: root/recipes/linux/linux-2.6.27/boc01/013-090306-lcd.patch

Index: linux-2.6.27/drivers/video/Kconfig
===================================================================
--- linux-2.6.27.orig/drivers/video/Kconfig
+++ linux-2.6.27/drivers/video/Kconfig
@@ -480,6 +480,28 @@ config FB_ARC
 	  this driver, say Y or M; otherwise say N. You must specify the
 	  GPIO IO address to be used for setting control and data.
 
+config FB_NT7506
+	tristate "Novatek 7506 LCD board support"
+	depends on FB
+	select FB_SYS_FILLRECT
+	select FB_SYS_COPYAREA
+	select FB_SYS_IMAGEBLIT
+	select FB_SYS_FOPS
+	select FB_BACKLIGHT
+	select LCD_CLASS_DEVICE
+	help
+	  This is the frame buffer device driver for the Novatek 7506 Monochrome/Grayscale LCD board.
+	  The board is based on the NT7506 LCD controller.
+
+config FB_NT7506_GRAYSCALE
+	bool "Novatek 7506 Grayscale mode"
+	depends on FB_NT7506
+	default y
+	help
+	  This option switches the Monochrome/Grayscale mode for the Novatek 7506 LCD board.
+	  Say Y to enable 4-levels Grayscale mode (2 bpp).
+	  Say N to enable Monochrome mode (1 bpp).
+
 config FB_ATARI
 	bool "Atari native chipset support"
 	depends on (FB = y) && ATARI
Index: linux-2.6.27/drivers/video/Makefile
===================================================================
--- linux-2.6.27.orig/drivers/video/Makefile
+++ linux-2.6.27/drivers/video/Makefile
@@ -31,6 +31,7 @@ obj-$(CONFIG_FB_DEFERRED_IO)   += fb_def
 obj-$(CONFIG_FB_AMIGA)            += amifb.o c2p.o
 obj-$(CONFIG_FB_AM200EPD)         += am200epd.o
 obj-$(CONFIG_FB_ARC)              += arcfb.o
+obj-$(CONFIG_FB_NT7506)           += nt7506fb.o
 obj-$(CONFIG_FB_CLPS711X)         += clps711xfb.o
 obj-$(CONFIG_FB_CYBER2000)        += cyber2000fb.o
 obj-$(CONFIG_FB_PM2)              += pm2fb.o
Index: linux-2.6.27/drivers/video/nt7506fb.c
===================================================================
--- /dev/null
+++ linux-2.6.27/drivers/video/nt7506fb.c
@@ -0,0 +1,880 @@
+/*
+ * linux/drivers/video/nt7506fb.c -- FB driver for NT7506 monochrome LCD board
+ *
+ * Copyright (C) 2008, CenoSYS (www.cenosys.com).
+ *
+ * Alexandre Coffignal <alexandre.coffignal@cenosys.com>
+ * Sylvain Giroudon <sylvain.giroudon@goobie.fr>
+ * Jeremy Laine <jeremy.laine@bolloretelecom.eu>
+ *
+ * This file is subject to the terms and conditions of the GNU General Public
+ * License. See the file COPYING in the main directory of this archive for
+ * more details.
+ *
+ * Layout is based on arcfb.c by Jaya Kumar
+ *
+ * This driver was written to be used with the Novatek NT7506 LCD board.
+ *
+ * Novatek uses a set of NT7506 chips that control individual 128x128 LCD
+ * matrices. The interface between the board and the host is TTL based GPIO.
+ *
+ * General notes:
+ * - User must set tuhold. It's in microseconds. According to the 108 spec,
+ *   the hold time is supposed to be at least 1 microsecond.
+ *
+ */
+
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/errno.h>
+#include <linux/string.h>
+#include <linux/mm.h>
+#include <linux/vmalloc.h>
+#include <linux/delay.h>
+#include <linux/timer.h>
+#include <linux/fb.h>
+#include <linux/init.h>
+#include <linux/platform_device.h>
+#include <linux/backlight.h>
+#include <linux/lcd.h>
+#include <linux/nt7506fb.h>
+
+#include <linux/uaccess.h>
+
+#define DRIVER_NAME "nt7506fb"
+
+//NT7506 Hardware
+#define LCD_RST		0x08
+#define LCD_RSTN	0x00
+#define LCD_BCKLIGH	0x04
+#define LCD_BCKLIGHN	0x00
+#define LCD_RS		0x02
+#define LCD_RSN		0x00
+#define LCD_ERD		0x01
+#define LCD_ERDN	0x00
+
+//Base address
+#define LCD_BASE	0xf0000000
+#define LCD_SIZE	0x2
+
+//NT7506 Instructions
+#define NT_ICON		0xA2
+#define NT_PAGE_ADDR 	0xB0
+#define NT_COL_MSB	0x10
+#define NT_COL_LSB	0x00
+#define NT_DISP		0xAE
+#define NT_START_LINE	0x40
+#define	NT_COM0		0x44
+#define	NT_DUTY		0x48
+#define DUTY_1_128	0x80
+#define NT_REV_DISP	0xA6
+#define NT_POWER	0x28
+#define VC		0x04
+#define VR		0x02
+#define VF		0x01
+#define	NT_DCDC		0x64
+#define	TIME6		0x03
+#define	NT_REG_RES	0x20
+#define	RES_7_2		0x07
+#define	NT_ELEC_VOL	0x81
+#define	NT_BIAS		0x50
+#define BIAS_1_11	0x06
+#define	NT_ADC_NOR	0xA0
+#define	NT_ADC_REV	0xA1
+#define	NT_SHL_NOR	0xC0
+#define	NT_SHL_REV	0xC8
+#define NT_SET_PWRSAVE  0xA8
+#define	NT_OSC		0xAB
+#define NT_RLS_PWRSAVE  0xE1
+#define NT_RESET	0xE2
+#define NT_DATA_DIR	0xe8
+#define NT_FRC_PWM	0x90
+#define PWM15		0x03
+
+#define ON		0x01
+#define OFF		0x00
+
+#define NT_GRAY_SCALE	0x88
+#define GRAY_WHITE_AB	0
+#define GRAY_WHITE_CD	1
+#define GRAY_LIGHT_AB	2
+#define GRAY_LIGHT_CD	3
+#define GRAY_DARK_AB	4
+#define GRAY_DARK_CD	5
+#define GRAY_BLACK_AB	6
+#define GRAY_BLACK_CD	7
+
+#define GRAY_INDEX_WHITE GRAY_WHITE_AB
+#define GRAY_INDEX_LIGHT GRAY_LIGHT_AB
+#define GRAY_INDEX_DARK  GRAY_DARK_AB
+#define GRAY_INDEX_BLACK GRAY_BLACK_AB
+
+#define GRAY_LEVEL_WHITE 0
+#define GRAY_LEVEL_LIGHT 5
+#define GRAY_LEVEL_DARK  10
+#define GRAY_LEVEL_BLACK 15
+#define GRAY_LEVEL_MAX 15
+
+#define GRAY_VALUE(level) (((level)<<4)+(level))
+
+// Geometric settings
+#define LCD_WIDTH	128
+#define LCD_HEIGHT	128
+#define LCD_NPAGES	(LCD_HEIGHT/8)    /* LCD pages of 8 vertical pixels */
+
+#define DEFAULT_CONTRAST	20
+#define DEFAULT_FPS	10
+
+static struct resource *lcd_mem = NULL;
+static void * _lcd_io = NULL;
+static unsigned long tuhold;
+struct fb_info *info;
+static struct timer_list fb_timer;
+static char _fps = DEFAULT_FPS;
+static char _backlight = 1;
+
+struct nt7506fb_par {
+	atomic_t ref_count;
+	struct fb_info *info;
+	spinlock_t lock;
+	struct lcd_device *lcd_dev;
+	int power;
+	int contrast;
+};
+
+static struct fb_fix_screeninfo nt7506fb_fix __initdata = {
+	.id =		DRIVER_NAME,
+	.type =		FB_TYPE_PACKED_PIXELS,
+#ifdef CONFIG_FB_NT7506_GRAYSCALE
+	.visual =	FB_VISUAL_STATIC_PSEUDOCOLOR,
+	.line_length =  LCD_WIDTH / 4,
+#else
+	.visual =	FB_VISUAL_MONO01,
+	.line_length =  LCD_WIDTH / 8,
+#endif
+	.xpanstep =	1,
+	.ypanstep =	1,
+	.ywrapstep =	0,
+	.accel =	FB_ACCEL_NONE,
+};
+
+static struct fb_var_screeninfo nt7506fb_var __initdata = {
+	.xres		= LCD_WIDTH,
+	.yres		= LCD_HEIGHT,
+	.xres_virtual	= LCD_WIDTH,
+	.yres_virtual	= LCD_HEIGHT,
+	.nonstd		= 1,
+#ifdef CONFIG_FB_NT7506_GRAYSCALE
+	.bits_per_pixel	= 2,
+	.grayscale	= 1,
+	.red		= { 0, 2, 0 },
+	.green		= { 0, 2, 0 },
+	.blue		= { 0, 2, 0 },
+	.transp		= { 0, 0, 0 },
+#else
+	.bits_per_pixel	= 1,
+#endif
+};
+
+
+/*
+ * Low-level i/o primitives
+ */
+
+static void NT7506_init_lcd(char ael);
+
+static void NT7506_writeb_ctl(unsigned char value)
+{
+	unsigned short svalue;
+	char bl = _backlight ? LCD_BCKLIGH : LCD_BCKLIGHN;
+
+	svalue=value<<8 | LCD_RSN | LCD_RST | LCD_ERDN | bl;
+	iowrite16(svalue, _lcd_io);
+	udelay(tuhold);
+	//The data on DB0/7 are latched at the falling edge of the E_RD signal
+	svalue=value<<8 | LCD_RSN | LCD_RST | LCD_ERD | bl;
+	iowrite16(svalue, _lcd_io);
+	udelay(tuhold);
+}
+
+static void NT7506_writeb_data(unsigned char value)
+{
+	unsigned short svalue;
+	char bl = _backlight ? LCD_BCKLIGH : LCD_BCKLIGHN;
+
+	svalue=value<<8|LCD_RS |LCD_RST | LCD_ERD | bl ;
+	iowrite16(svalue, _lcd_io);
+	udelay(tuhold);
+	//The data on DB0/7 are latched at the falling edge of the E_RD signal
+	svalue=value<<8|LCD_RS |LCD_RST | LCD_ERDN | bl;
+	iowrite16(svalue, _lcd_io);
+	udelay(tuhold);
+}
+
+static void NT7506_set_start_line(unsigned char y)
+{
+	NT7506_writeb_ctl(NT_START_LINE);
+	NT7506_writeb_ctl(y);
+}
+
+static void NT7506_set_yaddr(unsigned char y)
+{
+	NT7506_writeb_ctl(NT_PAGE_ADDR+y);
+}
+
+static void NT7506_set_xaddr(unsigned char x)
+{
+	NT7506_writeb_ctl(NT_COL_MSB | (x >> 0x04)); //Send high nibble
+	NT7506_writeb_ctl(NT_COL_LSB | (x & 0x0F) ); //Send low nibble
+}
+
+
+/*
+ * LCD device management
+ */
+
+static int
+nt7506fb_lcd_get_contrast(struct lcd_device *lcd_dev)
+{
+	struct nt7506fb_par *par = lcd_get_data(lcd_dev);
+	return par->contrast;
+}
+
+static int
+nt7506fb_lcd_set_contrast(struct lcd_device *lcd_dev, int contrast)
+{
+	struct nt7506fb_par *par = lcd_get_data(lcd_dev);
+
+	par->contrast = contrast;
+	NT7506_writeb_ctl(NT_ELEC_VOL);	NT7506_writeb_ctl(par->contrast);
+
+	//printk(KERN_INFO DRIVER_NAME": contrast = %d\n", par->contrast);
+	return 0;
+}
+
+static struct lcd_ops nt7506fb_lcd_ops = {
+	.get_contrast = nt7506fb_lcd_get_contrast,
+	.set_contrast = nt7506fb_lcd_set_contrast,
+};
+
+static void
+nt7506fb_lcd_init(struct nt7506fb_par *par)
+{
+	struct fb_info *info = par->info;
+	struct lcd_device *lcd_dev;
+
+	lcd_dev = lcd_device_register(DRIVER_NAME, info->dev, par, &nt7506fb_lcd_ops);
+	if (IS_ERR(lcd_dev)) {
+		par->lcd_dev = NULL;
+		printk(KERN_WARNING DRIVER_NAME ": LCD device registration failed\n");
+		return;
+	}
+
+	par->lcd_dev = lcd_dev;
+	lcd_dev->props.max_contrast = 255;
+	par->contrast = DEFAULT_CONTRAST;
+	printk(KERN_INFO DRIVER_NAME ": LCD contrast management initialized\n");
+}
+
+static void
+nt7506fb_lcd_exit(struct nt7506fb_par *par)
+{
+	if ( par->lcd_dev ) {
+		lcd_device_unregister(par->lcd_dev);
+		par->lcd_dev = NULL;
+	}
+}
+
+
+/*
+ * Backlight device management
+ */
+static void nt7506fb_start_timer(void);
+
+static int
+nt7506fb_bl_update_status(struct backlight_device *bd)
+{
+	struct nt7506fb_par *par = bl_get_data(bd);
+	int power_on = (bd->props.power != FB_BLANK_POWERDOWN);
+
+	_backlight = bd->props.brightness & power_on;
+
+	printk(KERN_INFO DRIVER_NAME ": backlight=%d power_on=%d\n", _backlight, power_on);
+
+	if ( bd->props.power != par->power ) {
+		par->power = bd->props.power;
+
+		if ( power_on ) {
+			/* Power LCD device on */
+			NT7506_writeb_ctl(NT_SET_PWRSAVE|OFF);
+			NT7506_writeb_ctl(NT_RLS_PWRSAVE);
+
+			/* Restart refresh timer */
+			if ( ! timer_pending(&fb_timer) )
+				nt7506fb_start_timer();
+		}
+		else {
+			/* Throttle refresh timer */
+			del_timer(&fb_timer);
+
+			/* Put LCD device in power save mode */
+			NT7506_writeb_ctl(NT_SET_PWRSAVE|ON);
+			NT7506_writeb_ctl(NT_RLS_PWRSAVE);
+		}
+	}
+
+	//printk(KERN_INFO DRIVER_NAME": backlight = %d\n", _backlight);
+	return 0;
+}
+
+static int
+nt7506fb_bl_get_brightness(struct backlight_device *bd)
+{
+	return bd->props.brightness;
+}
+
+static struct backlight_ops nt7506fb_bl_ops = {
+	.get_brightness = nt7506fb_bl_get_brightness,
+	.update_status	= nt7506fb_bl_update_status,
+};
+
+
+static void
+nt7506fb_bl_init(struct nt7506fb_par *par)
+{
+	struct fb_info *info = par->info;
+	struct backlight_device *bd;
+
+	bd = backlight_device_register(DRIVER_NAME, info->dev, par, &nt7506fb_bl_ops);
+	if (IS_ERR(bd)) {
+		info->bl_dev = NULL;
+		printk(KERN_WARNING DRIVER_NAME ": Backlight device registration failed\n");
+		return;
+	}
+
+	info->bl_dev = bd;
+	bd->props.max_brightness = 1;
+	bd->props.power = FB_BLANK_UNBLANK;
+	bd->props.brightness = 1;
+	par->power = bd->props.power;
+
+	nt7506fb_bl_update_status(bd);
+
+	printk(KERN_INFO DRIVER_NAME ": Backlight control initialized\n");
+}
+
+static void
+nt7506fb_bl_exit(struct fb_info *info)
+{
+	if ( info->bl_dev ) {
+		backlight_device_unregister(info->bl_dev);
+		info->bl_dev = NULL;
+	}
+}
+
+
+/*
+ * Main frame buffer operations
+ */
+
+static int nt7506fb_open(struct fb_info *info, int user)
+{
+	struct nt7506fb_par *par = info->par;
+	atomic_inc(&par->ref_count);
+	return 0;
+}
+
+static int nt7506fb_release(struct fb_info *info, int user)
+{
+	struct nt7506fb_par *par = info->par;
+	int count = atomic_read(&par->ref_count);
+	if (!count)
+		return -EINVAL;
+	atomic_dec(&par->ref_count);
+	return 0;
+}
+
+static int nt7506fb_pan_display(struct fb_var_screeninfo *var,
+				struct fb_info *info)
+{
+	if ( (var->vmode & FB_VMODE_YWRAP) &&
+	     (var->yoffset < LCD_HEIGHT) &&
+	     (info->var.yres <= LCD_HEIGHT) ) {
+		NT7506_set_start_line(var->yoffset);
+		info->var.yoffset = var->yoffset;
+		return 0;
+	}
+
+	return -EINVAL;
+}
+
+static void nt7506fb_lcd_update(struct nt7506fb_par *par)
+{
+	unsigned char *src = (unsigned char __force *) par->info->screen_base;
+	int line_length = par->info->fix.line_length;
+	int page, x, bit;
+	unsigned char plane1, plane2;
+	unsigned char *ptr;
+	unsigned char xshift;
+
+	if ( info->var.bits_per_pixel == 1 ) {
+
+		for (page = 0; page < LCD_NPAGES; page++) {
+			NT7506_set_yaddr(page);
+			NT7506_set_xaddr(0);
+			for (x = 0; x < LCD_WIDTH; x++) {
+				xshift = 7 - (x % 8);
+				plane1 = plane2 = 0;
+				ptr = src + (page * 8 * line_length + x / 8);
+				for (bit = 0; bit < 8; ptr += line_length, bit++) {
+					plane1 |= (((*ptr) >> xshift) & 1) << bit;
+				}
+				NT7506_writeb_data(plane1);
+				NT7506_writeb_data(plane2);
+			}
+		}
+
+	} else {
+
+		for (page = 0; page < LCD_NPAGES; page++) {
+			NT7506_set_yaddr(page);
+			NT7506_set_xaddr(0);
+			for (x = 0; x < LCD_WIDTH; x++) {
+				xshift = (3 - (x % 4)) << 1;
+				plane1 = plane2 = 0;
+				ptr = src + (page * 8 * line_length + x / 4);
+				for (bit = 0; bit < 8; ptr += line_length, bit++) {
+					plane1 |= (((*ptr) >> (xshift + 1)) & 1) << bit;
+					plane2 |= (((*ptr) >> xshift) & 1) << bit;
+				}
+				NT7506_writeb_data(plane1);
+				NT7506_writeb_data(plane2);
+			}
+		}
+
+	}
+}
+
+static void nt7506fb_fillrect(struct fb_info *info,  const struct fb_fillrect *rect)
+{
+	sys_fillrect(info, rect);
+}
+
+
+
+static void nt7506fb_copyarea(struct fb_info *info,
+			   const struct fb_copyarea *area)
+{
+	sys_copyarea(info, area);
+}
+
+
+static void nt7506fb_imageblit(struct fb_info *info, const struct fb_image *image)
+{
+	sys_imageblit(info, image);
+}
+
+
+/*
+ * this is the access path from userspace. they can seek and write to
+ * the fb. it's inefficient for them to do anything less than 128*8
+ * writes since we update the lcd in each write() anyway.
+ */
+static ssize_t nt7506fb_write(struct fb_info *info, const char __user *buf,
+			   size_t count, loff_t *ppos)
+{
+	unsigned long p = *ppos;
+	unsigned int fbmemlength;
+	int err = 0;
+
+	fbmemlength = (info->var.xres * info->var.yres) / (8 / info->var.bits_per_pixel);
+
+	if ( p > fbmemlength ) {
+		return -EFBIG;
+	}
+
+	if ( (count + p) > fbmemlength ) {
+		count = fbmemlength - p;
+		err = -ENOSPC;
+	}
+
+	if ( count ) {
+		char *base_addr = (char __force *) info->screen_base;
+		if ( copy_from_user(base_addr + p, buf, count) )
+			err = -EFAULT;
+	}
+
+	if ( !err )
+		*ppos += count;
+
+	return err ? err : count;
+}
+
+
+static int nt7506fb_mmap(struct fb_info *info, struct vm_area_struct *vma)
+{
+	unsigned long off;
+	unsigned long start;
+	u32 len;
+
+	if (vma->vm_end - vma->vm_start == 0)
+		return 0;
+	if (vma->vm_pgoff > (~0UL >> PAGE_SHIFT))
+		return -EINVAL;
+	off = vma->vm_pgoff << PAGE_SHIFT;
+	start = info->fix.smem_start;
+	len = info->fix.smem_len;
+	if (off >= len)
+	{
+		return -EINVAL;
+
+	}
+	if ((vma->vm_end - vma->vm_start + off) > len)
+	{
+			return -EINVAL;
+	}
+	off += start;
+	vma->vm_pgoff = off >> PAGE_SHIFT;
+	if (remap_pfn_range(vma, vma->vm_start, virt_to_phys((void *)info->fix.smem_start) >> PAGE_SHIFT,
+			info->fix.smem_len, vma->vm_page_prot))
+
+	{
+		return -EAGAIN;
+	}
+	return 0;
+
+}
+
+
+static int nt7506fb_ioctl(struct fb_info *info,
+			  unsigned int cmd, unsigned long arg)
+{
+	unsigned char frame_rate;
+
+	switch ( cmd ) {
+	case FBIO_FRAMERATE:
+		if (get_user(frame_rate, (unsigned char *)arg))
+			return -EFAULT;
+		printk(KERN_INFO "fb%d: framerate=%d Hz\n", info->node, frame_rate);
+		_fps = frame_rate;
+		return 0;
+
+	default:
+		return -EINVAL;
+	}
+}
+
+
+static struct fb_ops nt7506fb_ops = {
+	.owner		= THIS_MODULE,
+	.fb_open	= nt7506fb_open,
+	.fb_read        = fb_sys_read,
+	.fb_write	= nt7506fb_write,
+	.fb_release	= nt7506fb_release,
+	.fb_pan_display	= nt7506fb_pan_display,
+	.fb_fillrect	= nt7506fb_fillrect,
+	.fb_copyarea	= nt7506fb_copyarea,
+	.fb_imageblit	= nt7506fb_imageblit,
+	.fb_ioctl 	= nt7506fb_ioctl,
+	.fb_mmap	= nt7506fb_mmap,
+};
+
+
+static void
+nt7506fb_start_timer(void)
+{
+	fb_timer.expires = jiffies + (HZ/_fps);
+	add_timer(&fb_timer);
+}
+
+static void
+nt7506fb_refresh(unsigned long data)
+{
+	nt7506fb_lcd_update(info->par);
+	nt7506fb_start_timer();
+}
+
+/*
+ * Grayscale levels adjustment
+ */
+
+#ifdef CONFIG_FB_NT7506_GRAYSCALE
+
+static void nt7506fb_set_gray_level(unsigned char index, unsigned char level)
+{
+	NT7506_writeb_ctl(NT_GRAY_SCALE | index);
+	NT7506_writeb_ctl(GRAY_VALUE(level));
+	NT7506_writeb_ctl(NT_GRAY_SCALE | (index+1));
+	NT7506_writeb_ctl(GRAY_VALUE(level));
+}
+
+#ifdef CONFIG_PROC_FS
+#include "nt7506fb-procfs.c"
+#endif
+
+#endif
+
+
+/*
+ * Device driver intialisation
+ */
+
+static int __init
+nt7506fb_probe(struct platform_device *dev)
+{
+	int retval = -ENOMEM;
+	struct nt7506fb_par *par;
+	static unsigned char *videomemory;
+	static int videomemorysize;
+	int i;
+
+	NT7506_init_lcd(DEFAULT_CONTRAST);
+
+	videomemorysize = LCD_WIDTH * LCD_HEIGHT / 4;
+
+	if (!(videomemory = kmalloc(videomemorysize,GFP_ATOMIC)))
+		goto failout;
+	memset(videomemory, 0, videomemorysize);
+
+	info = framebuffer_alloc(sizeof(struct nt7506fb_par), &dev->dev);
+
+	if (!info)
+		goto out_alloc;
+	info->screen_base = (char __iomem *)videomemory;
+	info->fbops = &nt7506fb_ops;
+
+	info->var = nt7506fb_var;
+	info->fix = nt7506fb_fix;
+	info->fix.smem_start = (unsigned long)videomemory;
+	info->fix.smem_len = videomemorysize;
+
+	par = info->par;
+	par->info = info;
+
+	info->flags = FBINFO_FLAG_DEFAULT;
+	spin_lock_init(&par->lock);
+	platform_set_drvdata(dev, info);
+
+#ifdef CONFIG_FB_NT7506_GRAYSCALE
+	/* Allocate cmap */
+	retval = fb_alloc_cmap(&info->cmap, 4, 0);
+	if (retval < 0) {
+		printk(KERN_ERR "fb%d: Failed to allocate colormap\n", info->node);
+		goto out_register;
+	}
+
+	/* Set cmap */
+	for (i = 0; i < 4; i++)
+		info->cmap.red[i] = (((4*i)+1)*(0xFFFF))/16;
+	memcpy(info->cmap.green, info->cmap.red, sizeof(u16)*4);
+	memcpy(info->cmap.blue, info->cmap.red, sizeof(u16)*4);
+#endif
+
+	/* Register framebuffer */
+	retval = register_framebuffer(info);
+	if (retval < 0)
+		goto out_register;
+
+	setup_timer(&fb_timer, nt7506fb_refresh, (unsigned long) par);
+
+	printk(KERN_INFO
+	       "fb%d: nt7506 frame buffer device, using %dK of video memory\n",
+	       info->node, videomemorysize >> 10);
+
+	/* Create procfs entries for grayscale levels adjustment */
+#ifdef CONFIG_PROC_FS
+#ifdef CONFIG_FB_NT7506_GRAYSCALE
+	nt7506fb_proc_init(par);
+#endif
+#endif
+
+	/* Initialize backlight and contrast control (do not abort driver if it fails) */
+	nt7506fb_bl_init(par);
+	nt7506fb_lcd_init(par);
+
+	nt7506fb_start_timer();
+
+	return 0;
+
+out_register:
+	framebuffer_release(info);
+out_alloc:
+	vfree(videomemory);
+failout:
+	return retval;
+}
+
+static int nt7506fb_remove(struct platform_device *dev)
+{
+	struct fb_info *info = platform_get_drvdata(dev);
+
+	del_timer(&fb_timer);
+
+	if (info) {
+		nt7506fb_lcd_exit(info->par);
+		nt7506fb_bl_exit(info);
+		unregister_framebuffer(info);
+		vfree((void __force *)info->screen_base);
+		framebuffer_release(info);
+	}
+	return 0;
+}
+
+#ifdef CONFIG_PM
+static int nt7506fb_suspend(struct platform_device *dev, pm_message_t state)
+{
+	struct fb_info *info = platform_get_drvdata(dev);
+
+	printk(KERN_INFO DRIVER_NAME ": suspend\n");
+
+	info->bl_dev->props.power = FB_BLANK_POWERDOWN;
+	nt7506fb_bl_update_status(info->bl_dev);
+
+	return 0;
+}
+
+static int nt7506fb_resume(struct platform_device *dev)
+{
+	struct fb_info *info = platform_get_drvdata(dev);
+
+	printk(KERN_INFO DRIVER_NAME ": resume\n");
+
+	info->bl_dev->props.power = FB_BLANK_UNBLANK;
+	nt7506fb_bl_update_status(info->bl_dev);
+
+	return 0;
+}
+#else
+#define nt7506fb_suspend NULL
+#define nt7506fb_resume  NULL
+#endif
+
+
+static struct platform_driver nt7506fb_driver = {
+	.probe	= nt7506fb_probe,
+	.remove = nt7506fb_remove,
+	.suspend = nt7506fb_suspend,
+	.resume	 = nt7506fb_resume,
+	.driver	= {
+		.name	= DRIVER_NAME,
+	},
+};
+
+static struct platform_device *nt7506fb_device;
+
+static int __init nt7506fb_init(void)
+{
+	int ret;
+
+
+	if (!(lcd_mem = request_mem_region(LCD_BASE, LCD_SIZE, "mpc8313-lcd")))
+		return -ENOMEM;
+
+	if (!(_lcd_io = ioremap(LCD_BASE, LCD_SIZE)))
+	{
+		release_mem_region(LCD_BASE, LCD_SIZE);
+		lcd_mem = NULL;
+		return -ENOMEM;
+	}
+	ret = platform_driver_register(&nt7506fb_driver);
+
+	if (!ret) {
+		nt7506fb_device = platform_device_alloc(DRIVER_NAME, 0);
+		if (nt7506fb_device)
+		{
+			ret = platform_device_add(nt7506fb_device);
+		}
+		else
+		{
+			ret = -ENOMEM;
+		}
+		if (ret)
+		{
+			platform_device_put(nt7506fb_device);
+			platform_driver_unregister(&nt7506fb_driver);
+		}
+
+	}
+
+
+	return ret;
+
+}
+
+
+static void NT7506_init_lcd(char ael)
+{
+	/* this resets the lcd*/
+	char bl = _backlight ? LCD_BCKLIGH : LCD_BCKLIGHN;
+
+	iowrite16(LCD_RSTN | LCD_ERD | bl, _lcd_io);
+	udelay(100);
+	iowrite16(LCD_RST| LCD_ERD | bl, _lcd_io);
+	udelay(200);
+	/* Soft reset*/
+	NT7506_writeb_ctl(NT_RESET);
+	/* Disable ICON display*/
+	NT7506_writeb_ctl(NT_ICON|OFF);
+	/* Sets the duty ratio 1/128*/
+	NT7506_writeb_ctl(NT_DUTY);		NT7506_writeb_ctl(DUTY_1_128);
+	/* Sets reverse direction between RAM column address and segment driver*/
+	NT7506_writeb_ctl(NT_ADC_REV);
+	NT7506_writeb_ctl(NT_SHL_NOR);
+	/* Enales the built in Oscillator circuit.*/
+	NT7506_writeb_ctl(NT_OSC);
+	/* Set Initial row to 0*/
+	NT7506_writeb_ctl(NT_COM0);		NT7506_writeb_ctl(0);
+	/* Sets DC-DC*/
+	NT7506_writeb_ctl(NT_DCDC|TIME6);
+	/* Selects resistance ratio of the internal resistor*/
+	NT7506_writeb_ctl(NT_REG_RES|RES_7_2);
+	/* set Reference Voltage mode*/
+	NT7506_writeb_ctl(NT_ELEC_VOL);	NT7506_writeb_ctl(ael);
+	/* Selects LCD bias ratio*/
+	NT7506_writeb_ctl(NT_BIAS|BIAS_1_11);
+
+	NT7506_writeb_ctl(NT_DATA_DIR);	NT7506_writeb_ctl(0);
+	NT7506_writeb_ctl(NT_FRC_PWM|PWM15);
+
+#ifdef CONFIG_FB_NT7506_GRAYSCALE
+	/* Feed grayscale palette */
+	nt7506fb_set_gray_level(GRAY_INDEX_WHITE, GRAY_LEVEL_WHITE);
+	nt7506fb_set_gray_level(GRAY_INDEX_LIGHT, GRAY_LEVEL_LIGHT);
+	nt7506fb_set_gray_level(GRAY_INDEX_DARK,  GRAY_LEVEL_DARK);
+	nt7506fb_set_gray_level(GRAY_INDEX_BLACK, GRAY_LEVEL_BLACK);
+#endif
+
+	/* Select power circuit functions */
+	NT7506_writeb_ctl(NT_POWER|VC);
+	udelay(5000);
+	NT7506_writeb_ctl(NT_POWER|VC|VR);
+	udelay(5000);
+	NT7506_writeb_ctl(NT_POWER|VC|VR|VF);
+	udelay(5000);
+	/* Reverses the display status on LCD panel */
+	NT7506_writeb_ctl(NT_REV_DISP|OFF);
+	/* Forces the whole LCD points to be turned on regardless of the contents of the display data RAM*/
+	NT7506_writeb_ctl(NT_DISP|ON);
+	/* Set Initial Start Line Address */
+	NT7506_writeb_ctl(NT_START_LINE);	NT7506_writeb_ctl(0x00);
+}
+
+static void __exit nt7506fb_exit(void)
+{
+	if (lcd_mem)
+		release_mem_region(LCD_BASE, LCD_SIZE);
+	lcd_mem = NULL;
+	platform_device_unregister(nt7506fb_device);
+	platform_driver_unregister(&nt7506fb_driver);
+}
+
+module_param(tuhold, ulong, 0);
+MODULE_PARM_DESC(tuhold, "Time to hold between strobing data to NT7506 board");
+
+module_init(nt7506fb_init);
+module_exit(nt7506fb_exit);
+
+MODULE_DESCRIPTION("fbdev driver for Novatek NT7506 monochrome LCD board");
+MODULE_AUTHOR("Alexandre Coffignal");
+MODULE_LICENSE("GPL");
+
Index: linux-2.6.27/include/linux/nt7506fb.h
===================================================================
--- /dev/null
+++ linux-2.6.27/include/linux/nt7506fb.h
@@ -0,0 +1,31 @@
+
+/*
+ * (C) Copyright 2008
+ * Alexandre Coffignal, CénoSYS, alexandre.coffignal@cenosys.com
+ *
+ * See file CREDITS for list of people who contributed to this
+ * project.
+ *
+ * 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., 59 Temple Place, Suite 330, Boston,
+ * MA 02111-1307 USA
+ *
+ */
+
+#ifndef __LINUX_NT7506FB_H__
+#define __LINUX_NT7506FB_H__
+
+#define FBIO_FRAMERATE		_IOR('f', 1, char)
+
+#endif
Index: linux-2.6.27/drivers/video/nt7506fb-procfs.c
===================================================================
--- /dev/null
+++ linux-2.6.27/drivers/video/nt7506fb-procfs.c
@@ -0,0 +1,119 @@
+/*
+ * FB driver for NT7506 monochrome/grayscale LCD board
+ * Device setup using procfs
+ *
+ * Copyright (C) 2009, Goobie (www.goobie.fr).
+ *
+ * Sylvain Giroudon <sylvain.giroudon@goobie.fr>
+ *
+ * This software program is licensed subject to the GNU General Public License
+ * (GPL).Version 2,June 1991, available at http://www.fsf.org/copyleft/gpl.html
+ */
+
+#include <linux/proc_fs.h>
+#include <linux/uaccess.h>
+
+struct nt7506fb_proc_entry {
+	char *name;
+	unsigned char index;
+	unsigned char level;
+	struct nt7506fb_par *par;
+};
+
+static struct nt7506fb_proc_entry nt7506fb_proc_entries[] = {
+	{ "white", GRAY_INDEX_WHITE, GRAY_LEVEL_WHITE },
+	{ "light", GRAY_INDEX_LIGHT, GRAY_LEVEL_LIGHT },
+	{ "dark",  GRAY_INDEX_DARK,  GRAY_LEVEL_DARK  },
+	{ "black", GRAY_INDEX_BLACK, GRAY_LEVEL_BLACK },
+};
+
+static int nt7506fb_proc_read(char *page, char **start, off_t off, int count,
+			      int *eof, void *data)
+{
+	struct nt7506fb_proc_entry *entry = data;
+	int len;
+
+	len = sprintf(page, "%d\n", entry->level);
+
+	len -= off;
+	if ( len < count ) {
+		*eof = 1;
+		if ( len <= 0 )
+			return 0;
+	} else {
+		len = count;
+	}
+
+	*start = page + off;
+
+	return len;
+}
+
+
+static int nt7506fb_proc_write(struct file *file, const char *buf,
+			       unsigned long count, void *data)
+{
+	struct nt7506fb_proc_entry *entry = data;
+	char lbuf[count+1];
+
+	/* Only root can do this */
+	if ( !capable(CAP_SYS_ADMIN) )
+		return -EACCES;
+
+	memset(lbuf, 0, sizeof(lbuf));
+
+	if (copy_from_user(lbuf, buf, count))
+		return -EFAULT;
+
+	if ( sscanf(lbuf, "%hhi", &entry->level) == 1 ) {
+		if ( entry->level > GRAY_LEVEL_MAX )
+			entry->level = GRAY_LEVEL_MAX;
+
+		/* Set grayscale palette entry */
+		nt7506fb_set_gray_level(entry->index, entry->level);
+	}
+	else {
+		printk(KERN_INFO DRIVER_NAME ": [%s] Syntax error in expression\n", entry->name);
+		return -EINVAL;
+	}
+
+	return count;
+}
+
+
+static int nt7506fb_proc_init(struct nt7506fb_par *par)
+{
+	struct proc_dir_entry *root;
+	struct proc_dir_entry *ent;
+	int i;
+
+	/* Create nt7506fb proc directory */
+	printk(KERN_INFO DRIVER_NAME ": Creating setup entries in /proc/" DRIVER_NAME "/\n");
+
+	root = proc_mkdir(DRIVER_NAME, NULL);
+	if ( root == NULL ) {
+		printk(KERN_WARNING DRIVER_NAME ": Cannot create directory /proc/" DRIVER_NAME "\n");
+		return -1;
+	}
+
+	root->owner = THIS_MODULE;
+
+	/* Create gray level entries */
+	for (i = 0; i < ARRAY_SIZE(nt7506fb_proc_entries); i++) {
+		struct nt7506fb_proc_entry *entry = &nt7506fb_proc_entries[i];
+
+		entry->par = par;
+
+		ent = create_proc_entry(entry->name, S_IFREG|S_IWUSR, root);
+		if ( ent == NULL ) {
+			printk(KERN_WARNING DRIVER_NAME ": Cannot create entry /proc/" DRIVER_NAME "/%s\n", entry->name);
+			return -1;
+		}
+
+		ent->owner = THIS_MODULE;
+		ent->data = entry;
+		ent->write_proc = nt7506fb_proc_write;
+		ent->read_proc = nt7506fb_proc_read;
+	}
+	return 0;
+}