===================================================================
--- /dev/null
+++ linux-2.6.27/drivers/input/misc/cy3218-btns.c
-@@ -0,0 +1,195 @@
+@@ -0,0 +1,301 @@
+/*
+ * CAPSENSE Interface driver
+ *
+ *
-+ * Copyright (C) 2007, CenoSYS (www.cenosys.com).
++ * Copyright (C) 2008, CenoSYS (www.cenosys.com).
+ *
+ * Guillaume Ligneul <guillaume.ligneul@gmail.com>
+ * Jeremy Lainé <jeremy.laine@bolloretelecom.eu>
++ * 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/ioport.h>
+#include <linux/module.h>
+#include <linux/i2c.h>
++#include <linux/leds.h>
+
+static int capsense_attach_adapter(struct i2c_adapter *adapter);
+static int capsense_detach_client(struct i2c_client *client);
+
+#define CAPSENSE_NAME "Capsense"
++
+/* i2c configuration */
+#define CAPSENSE_I2C_ADDR 0x25
+// To debug (may be add in include/linux/i2c-id.h)
+#define I2C_DRIVERID_CAPSENSE 98
++
+#define BUTTONS_POLL_INTERVAL 30 /* msec */
-+#define CAP_STATE_GP0 0x88
-+#define CAP_STATE_GP1 0x89
++
++#define CAP_OUTPUT_PORT(port) (0x04+(port))
++#define CAP_OP_SEL(port,bit) (0x1C+(25*(port))+(5*(bit)))
++#define CAP_READ_STATUS(port) (0x88+(port))
++
+#define MASK0 0x10
+#define MASK1 0x4
+#define MASK2 0x8
+#define MASK3 0x1
+
++#define CAP_NLEDS 5
+
+static int poll_interval = BUTTONS_POLL_INTERVAL;
+module_param_named(poll, poll_interval, uint, 0);
+ .detach_client = &capsense_detach_client,
+};
+
++struct cy3218_led {
++ struct led_classdev cdev;
++ struct cy3218 *capsense;
++ int port;
++ unsigned char mask;
++};
++
+struct cy3218 {
+ struct input_polled_dev *ipdev;
+ struct i2c_client client;
+ unsigned char key_state;
++ struct cy3218_led leds[CAP_NLEDS];
++ unsigned char led_state[2];
++ struct mutex mutex;
+};
+
-+unsigned short keymap[] = {
++static unsigned short keymap[] = {
+ // GP0
+ KEY_F1,
+ KEY_ENTER,
+ KEY_UP,
+};
+
++struct cy3218_ledmap {
++ char *name;
++ int port, bit;
++};
++
++static struct cy3218_ledmap ledmap[CAP_NLEDS] = {
++ { "capsense:blue:back", 0, 1 },
++ { "capsense:blue:info", 1, 0 },
++ { "capsense:blue:down", 1, 1 },
++ { "capsense:blue:ok", 1, 2 },
++ { "capsense:blue:up", 1, 3 },
++};
++
+static void handle_buttons(struct input_polled_dev *dev)
+{
+ struct cy3218 *capsense = dev->private;
+ u8 changed;
+ int i;
+
++ mutex_lock(&capsense->mutex);
++
+ // read status
-+ port_value = i2c_smbus_read_byte_data(&capsense->client, CAP_STATE_GP0);
++ port_value = i2c_smbus_read_byte_data(&capsense->client, CAP_READ_STATUS(0));
+ if (port_value & MASK0) new_state |= 0x01;
+ if (port_value & MASK1) new_state |= 0x02;
+ if (port_value & MASK2) new_state |= 0x04;
+ if (port_value & MASK3) new_state |= 0x08;
+
-+ port_value = i2c_smbus_read_byte_data(&capsense->client, CAP_STATE_GP1);
++ port_value = i2c_smbus_read_byte_data(&capsense->client, CAP_READ_STATUS(1));
+ if (port_value & MASK0) new_state |= 0x10;
+
++ mutex_unlock(&capsense->mutex);
++
+ // update keyboard state
+ changed = capsense->key_state ^ new_state;
+ for (i = 0; i < ARRAY_SIZE(keymap); i++)
+ input_sync(dev->input);
+}
+
++
++static void
++capsense_led_set(struct led_classdev *led_cdev,
++ enum led_brightness value)
++{
++ struct cy3218_led *led = (struct cy3218_led *) led_cdev;
++ struct cy3218 *capsense = led->capsense;
++ int port = led->port;
++
++ if ( value )
++ capsense->led_state[port] |= led->mask;
++ else
++ capsense->led_state[port] &= ~led->mask;
++
++ mutex_lock(&capsense->mutex);
++ i2c_smbus_write_byte_data(&capsense->client, CAP_OUTPUT_PORT(port), capsense->led_state[port]);
++ mutex_unlock(&capsense->mutex);
++}
++
++static int
++capsense_led_init(struct cy3218 *capsense)
++{
++ int i;
++ int ret;
++
++ for (i = 0; i < CAP_NLEDS; i++) {
++ struct cy3218_led *led = &(capsense->leds[i]);
++
++ led->cdev.name = ledmap[i].name;
++ led->cdev.brightness_set = capsense_led_set;
++ led->capsense = capsense;
++ led->port = ledmap[i].port;
++ led->mask = (1 << ledmap[i].bit);
++
++ ret = led_classdev_register(&capsense->ipdev->input->dev, &led->cdev);
++ if ( ret < 0 )
++ return -1;
++
++ i2c_smbus_write_byte_data(&capsense->client, CAP_OP_SEL(led->port, ledmap[i].bit), 0x00);
++ }
++
++ /* Switch all leds off */
++ capsense->led_state[0] = 0x00;
++ i2c_smbus_write_byte_data(&capsense->client, CAP_OUTPUT_PORT(0), 0x00);
++
++ capsense->led_state[1] = 0x00;
++ i2c_smbus_write_byte_data(&capsense->client, CAP_OUTPUT_PORT(1), 0x00);
++
++ return 0;
++}
++
++
++static void
++capsense_led_exit(struct cy3218 *capsense)
++{
++ int i;
++
++ for (i = 0; i < CAP_NLEDS; i++) {
++ led_classdev_unregister(&capsense->leds[i].cdev);
++ }
++}
++
++
+static int
+capsense_probe(struct i2c_adapter *adapter, int addr, int kind)
+{
+ if (!capsense)
+ goto failout;
+
++ mutex_init(&capsense->mutex);
++
+ if (!i2c_check_functionality(adapter, I2C_FUNC_I2C)) {
+ goto failout;
+ }
+ if(rc)
+ goto out_polled;
+
++ if ( capsense_led_init(capsense) )
++ goto out_registered;
++
+ return 0;
+
++out_registered:
++ input_unregister_polled_device(ipdev);
+out_polled:
+ i2c_detach_client(&capsense->client);
+out_attach:
+{
+ struct cy3218 *capsense = i2c_get_clientdata(client);
+
++ capsense_led_exit(capsense);
+ input_unregister_polled_device(capsense->ipdev);
+ i2c_detach_client(&capsense->client);
+ input_free_polled_device(capsense->ipdev);
===================================================================
--- linux-2.6.27.orig/drivers/input/misc/Kconfig
+++ linux-2.6.27/drivers/input/misc/Kconfig
-@@ -207,4 +207,12 @@ config HP_SDC_RTC
+@@ -207,4 +207,13 @@ config HP_SDC_RTC
Say Y here if you want to support the built-in real time clock
of the HP SDC controller.
+config INPUT_CAPSENSE_BTNS
+ tristate "CAPSENSE CY3218 button interface"
+ select INPUT_POLLDEV
++ select LEDS_CLASS
+ help
+ To compile this driver as a module, choose M here: the
+ module will be called cy3218-btns.
-Index: linux-2.6.26-NEW/drivers/video/Kconfig
+Index: linux-2.6.27/drivers/video/Kconfig
===================================================================
---- linux-2.6.26-NEW.orig/drivers/video/Kconfig
-+++ linux-2.6.26-NEW/drivers/video/Kconfig
-@@ -480,6 +480,17 @@ config FB_ARC
+--- linux-2.6.27.orig/drivers/video/Kconfig
++++ linux-2.6.27/drivers/video/Kconfig
+@@ -480,6 +480,19 @@ 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.
+ select FB_SYS_COPYAREA
+ select FB_SYS_IMAGEBLIT
+ select FB_SYS_FOPS
++ select FB_BACKLIGHT
++ select LCD_CLASS_DEVICE
+ help
+ This enables support for the Nova 7506 Monochrome LCD board. The board
+ is based on the NT7506 lcd controller.
config FB_ATARI
bool "Atari native chipset support"
depends on (FB = y) && ATARI
-Index: linux-2.6.26-NEW/drivers/video/Makefile
+Index: linux-2.6.27/drivers/video/Makefile
===================================================================
---- linux-2.6.26-NEW.orig/drivers/video/Makefile
-+++ linux-2.6.26-NEW/drivers/video/Makefile
+--- linux-2.6.27.orig/drivers/video/Makefile
++++ linux-2.6.27/drivers/video/Makefile
@@ -13,8 +13,8 @@ fb-objs := $(f
obj-$(CONFIG_VT) += console/
obj-$(CONFIG_FB_CFB_FILLRECT) += cfbfillrect.o
obj-$(CONFIG_FB_CFB_COPYAREA) += cfbcopyarea.o
obj-$(CONFIG_FB_CFB_IMAGEBLIT) += cfbimgblt.o
-Index: linux-2.6.26-NEW/drivers/video/N7506fb.c
+Index: linux-2.6.27/drivers/video/N7506fb.c
===================================================================
--- /dev/null
-+++ linux-2.6.26-NEW/drivers/video/N7506fb.c
-@@ -0,0 +1,655 @@
++++ linux-2.6.27/drivers/video/N7506fb.c
+@@ -0,0 +1,728 @@
+/*
+ * linux/drivers/video/N7506fb.c -- FB driver for Nova NT7506 monochrome LCD board
+ *
-+ * Copyright (C) 2008, Alexandre Coffignal <alexandre.coffignal@cenosys.com>
++ * Copyright (C) 2008, CenoSYS (www.cenosys.com).
++ *
++ * Alexandre Coffignal <alexandre.coffignal@cenosys.com>
++ * Sylvain Giroudon <sylvain.giroudon@goobie.fr>
+ *
+ * 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
+#include <linux/interrupt.h>
+#include <linux/fb.h>
+#include <linux/init.h>
-+#include <linux/NT7506.h>
+#include <linux/platform_device.h>
++#include <linux/backlight.h>
++#include <linux/lcd.h>
++#include <linux/NT7506.h>
+
+#include <linux/uaccess.h>
+
++#define DRIVER_NAME "novafb"
++
+#define floor8(a) (a&(~0x07))
+#define floorXres(a,xres) (a&(~(xres - 1)))
+#define iceil8(a) (((int)((a+7)/8))*8)
+
+#define LINE_LENGTH (LCD_WIDTH/8) /* FB line size, 8 pixels per byte */
+
-+#define CONTRASTE 0xF
-+#define FRAME_PER_SECOND 5
++#define DEFAULT_CONTRAST 20
++#define DEFAULT_FPS 5
+
+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 _refresh;
-+static char _fps = FRAME_PER_SECOND;
-+static char _backlight=1;
++static char _refresh = 0;
++static char _fps = DEFAULT_FPS;
++static char _backlight = 1;
+
+struct novafb_par {
+ atomic_t ref_count;
-+ unsigned char cslut[9];
+ struct fb_info *info;
-+ unsigned int irq;
+ spinlock_t lock;
++ struct lcd_device *lcd_dev;
++ int contrast;
+};
+
+static struct fb_fix_screeninfo novafb_fix __initdata = {
-+ .id = "novafb",
++ .id = DRIVER_NAME,
+ .type = FB_TYPE_PACKED_PIXELS,
+ .visual = FB_VISUAL_MONO01,
+ .xpanstep = 1,
+};
+
+
++/*
++ * Low-level i/o primitives
++ */
++
+static void NT7506_init_lcd(char ael);
+
+static void NT7506_writeb_ctl(unsigned char value)
+ NT7506_writeb_ctl(NT_COL_LSB | (x & 0x0F) ); //Send low nibble
+}
+
-+/* main novafb functions */
++
++/*
++ * LCD device management
++ */
++
++static int
++novafb_lcd_get_contrast(struct lcd_device *lcd_dev)
++{
++ struct novafb_par *par = lcd_get_data(lcd_dev);
++ return par->contrast;
++}
++
++static int
++novafb_lcd_set_contrast(struct lcd_device *lcd_dev, int contrast)
++{
++ struct novafb_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 novafb_lcd_ops = {
++ .get_contrast = novafb_lcd_get_contrast,
++ .set_contrast = novafb_lcd_set_contrast,
++};
++
++static void
++novafb_lcd_init(struct novafb_par *par)
++{
++ struct fb_info *info = par->info;
++ struct lcd_device *lcd_dev;
++
++ lcd_dev = lcd_device_register(DRIVER_NAME, info->dev, par, &novafb_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
++novafb_lcd_exit(struct novafb_par *par)
++{
++ if ( par->lcd_dev ) {
++ lcd_device_unregister(par->lcd_dev);
++ par->lcd_dev = NULL;
++ }
++}
++
++
++/*
++ * Backlight device management
++ */
++
++static int
++novafb_bl_update_status(struct backlight_device *bd)
++{
++ _refresh = 0;
++
++ if (bd->props.power != FB_BLANK_UNBLANK ||
++ bd->props.fb_blank != FB_BLANK_UNBLANK)
++ _backlight = 0;
++ else
++ _backlight = bd->props.brightness;
++
++ _refresh = 1;
++
++ //printk(KERN_INFO DRIVER_NAME": backlight = %d\n", _backlight);
++ return 0;
++}
++
++static int
++novafb_bl_get_brightness(struct backlight_device *bd)
++{
++ return bd->props.brightness;
++}
++
++static struct backlight_ops novafb_bl_ops = {
++ .get_brightness = novafb_bl_get_brightness,
++ .update_status = novafb_bl_update_status,
++};
++
++
++static void
++novafb_bl_init(struct novafb_par *par)
++{
++ struct fb_info *info = par->info;
++ struct backlight_device *bd;
++
++ bd = backlight_device_register(DRIVER_NAME, info->dev, par, &novafb_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;
++ novafb_bl_update_status(bd);
++
++ printk(KERN_INFO DRIVER_NAME ": Backlight control initialized\n");
++}
++
++static void
++novafb_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 novafb_open(struct fb_info *info, int user)
+{
+static int novafb_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))
-+ {
++ 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 novafb_lcd_update(struct novafb_par *par, unsigned int dx,
-+ unsigned int dy, unsigned int w, unsigned int h)
++static void novafb_lcd_update(struct novafb_par *par)
+{
-+ int bit,x,y,xfb,yfb,i;
-+ char mask=0;
-+ char dest[LCD_WIDTH * LCD_NPAGES];
-+ char * src;
-+ char value;
-+ src = (unsigned char __force *) par->info->screen_base;
-+ for(i=0;i<sizeof(dest);i++)
-+ {
-+ dest[i]=0;
-+ }
++ unsigned char *src = (unsigned char __force *) par->info->screen_base;
++ unsigned char dest[LCD_WIDTH * LCD_NPAGES];
++ int x, y;
++
+ for (x = 0; x < LCD_WIDTH; x++) {
-+ xfb = x/8;
++ int xfb = x / 8;
+
+ for(y = 0; y < LCD_NPAGES; y++) {
-+ yfb = y*8;
++ int i = (y * LCD_WIDTH) + x;
++ int yfb = y * 8;
++ int bit;
++
++ dest[i] = 0;
+
-+ for(bit=0;bit<8;yfb++,bit++)
-+ {
-+ mask = (1<<(7-(x%8)));
-+ if(((src[yfb*LINE_LENGTH+xfb]&mask)))
-+ value=1;
-+ else
-+ value=0;
++ for (bit = 0; bit < 8; yfb++, bit++) {
++ int ifb = (yfb * LINE_LENGTH) + xfb;
++ unsigned char mask = (1 << (7-(x%8)));
++ unsigned char value = (src[ifb] & mask) ? 1:0;
+
-+ dest[y*LCD_WIDTH+x]+= (value<<bit);
++ dest[i] += (value<<bit);
+ }
+ }
+ }
+
-+ for (y = 0; y < LCD_NPAGES; y++)
-+ {
++ for (y = 0; y < LCD_NPAGES; y++) {
+ NT7506_set_yaddr(y);
+ NT7506_set_xaddr(0);
-+ for (x = 0; x < LCD_WIDTH; x++)
-+ {
++ for (x = 0; x < LCD_WIDTH; x++) {
+ NT7506_writeb_data(dest[y*LCD_WIDTH+x]);
+ NT7506_writeb_data(0x00);
+ }
+
+static void novafb_fillrect(struct fb_info *info, const struct fb_fillrect *rect)
+{
-+
-+// sys_fillrect(info, rect);
-+
++ sys_fillrect(info, rect);
+}
+
+
+static void novafb_copyarea(struct fb_info *info,
+ const struct fb_copyarea *area)
+{
-+// sys_copyarea(info, area);
++ sys_copyarea(info, area);
+}
+
+
+static void novafb_imageblit(struct fb_info *info, const struct fb_image *image)
+{
-+ struct novafb_par *par = info->par;
-+
-+ int xfb,yfb,i=0;
-+ char * src = (unsigned char __force *) par->info->screen_base;
-+
-+ for(yfb=image->dy;yfb<(image->height+image->dy);yfb++)
-+ {
-+ for(xfb=(image->dx)/8;xfb<(image->dx+image->width)/8;xfb++)
-+ {
-+ src[yfb*16+xfb]=image->data[i++];
-+ }
-+ }
-+
++ 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
+static ssize_t novafb_write(struct fb_info *info, const char __user *buf,
+ size_t count, loff_t *ppos)
+{
-+ unsigned long p;
-+ int err=-EINVAL;
-+ unsigned int fbmemlength ;
-+ struct novafb_par *par;
-+ unsigned int xres;
-+ p = *ppos;
-+ par = info->par;
-+ xres = info->var.xres;
-+ fbmemlength = (xres * info->var.yres)/8;
++ unsigned long p = *ppos;
++ unsigned int fbmemlength;
++ int err = 0;
+
-+ if (p > fbmemlength)
-+ {
-+ return -ENOSPC;
++ fbmemlength = (info->var.xres * info->var.yres)/8;
++
++ if ( p > fbmemlength ) {
++ return -EFBIG;
+ }
-+ err = 0;
-+ if ((count + p) > fbmemlength) {
++
++ if ( (count + p) > fbmemlength ) {
+ count = fbmemlength - p;
+ err = -ENOSPC;
+ }
+
-+ if (count) {
-+ char *base_addr;
-+ base_addr = (char __force *)info->screen_base;
-+ count -= copy_from_user(base_addr + p, buf, count);
-+ *ppos += count;
-+ err = -EFAULT;
++ if ( count ) {
++ char *base_addr = (char __force *) info->screen_base;
++ if ( copy_from_user(base_addr + p, buf, count) )
++ err = -EFAULT;
+ }
-+ if (count)
-+ {
-+ return count;
-+ }
-+ return err;
++
++ if ( !err )
++ *ppos += count;
++
++ return err ? err : count;
+}
+
++
+static int novafb_mmap(struct fb_info *info, struct vm_area_struct *vma)
+{
+ unsigned long off;
+static int novafb_ioctl(struct fb_info *info,
+ unsigned int cmd, unsigned long arg)
+{
-+ unsigned char contrast;
+ unsigned char frame_rate;
-+ unsigned char backlight;
-+ 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;
-+ }
-+ case FBIO_CONTRAST:
-+ {
-+ _refresh=0;
-+ if (get_user(contrast, (unsigned char *)arg))
-+ return -EFAULT;
-+ printk(KERN_INFO "fb%d: contrast=%d\n", info->node, contrast);
-+ NT7506_writeb_ctl(NT_ELEC_VOL); NT7506_writeb_ctl(contrast);
-+ _refresh=1;
-+ return 0;
-+ }
-+ case FBIO_BACKLIGHT:
-+ {
-+ _refresh=0;
-+ if (get_user(backlight, (unsigned char *)arg))
-+ return -EFAULT;
-+ if(backlight)
-+ {
-+ printk(KERN_INFO "fb%d: Backlight ON\n", info->node);
-+ _backlight=1;
-+ }
-+ else
-+ {
-+ printk(KERN_INFO "fb%d: Backlight OFF\n", info->node);
-+ _backlight=0;
-+ }
-+ _refresh=1;
-+ return 0;
-+
-+ }
+
++ 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;
++ default:
++ return -EINVAL;
+ }
-+
+}
+
++
+static struct fb_ops novafb_ops = {
+ .owner = THIS_MODULE,
+ .fb_open = novafb_open,
+ .fb_fillrect = novafb_fillrect,
+ .fb_copyarea = novafb_copyarea,
+ .fb_imageblit = novafb_imageblit,
-+ .fb_ioctl = novafb_ioctl,
-+ .fb_mmap =novafb_mmap,
++ .fb_ioctl = novafb_ioctl,
++ .fb_mmap = novafb_mmap,
+};
+
+
+{
+ struct novafb_par *par = info->par;
+ if ( _refresh ) {
-+ novafb_lcd_update(par, 0, 0, LCD_WIDTH, LCD_HEIGHT);
++ novafb_lcd_update(par);
+ }
+
+ fb_timer.expires = jiffies + (HZ/_fps);
+ add_timer(&fb_timer);
+}
+
-+static int
-+__init novafb_probe(struct platform_device *dev)
++static int __init
++novafb_probe(struct platform_device *dev)
+{
-+
+ int retval = -ENOMEM;
-+ char * src;
-+ int i;
-+
+ struct novafb_par *par;
+ static unsigned char *videomemory;
+ static int videomemorysize;
+
-+ NT7506_init_lcd(CONTRASTE);
++ NT7506_init_lcd(DEFAULT_CONTRAST);
+
-+ videomemorysize = (LCD_WIDTH * LINE_LENGTH) * 2;
++ videomemorysize = (LINE_LENGTH * LCD_HEIGHT) * 2;
+
+ if (!(videomemory = kmalloc(videomemorysize,GFP_ATOMIC)))
-+ return retval;
++ goto failout;
+ memset(videomemory, 0, videomemorysize);
+
+ info = framebuffer_alloc(sizeof(struct novafb_par), &dev->dev);
+
+ if (!info)
-+ goto err;
++ goto out_alloc;
+ info->screen_base = (char __iomem *)videomemory;
+ info->fbops = &novafb_ops;
+
+ info->var = novafb_var;
+ info->fix = novafb_fix;
-+ info->fix.smem_start=(unsigned long)videomemory;
-+ info->fix.smem_len = videomemorysize;
++ info->fix.smem_start = (unsigned long)videomemory;
++ info->fix.smem_len = videomemorysize;
+
+ par = info->par;
+ par->info = info;
-+ par->cslut[0] = 0x00;
-+ par->cslut[1] = 0x06;
-+ src = (unsigned char __force *) par->info->screen_base;
-+ for(i=0;i<videomemorysize;i++)
-+ {
-+ src[i]=0;
-+ }
++
+ info->flags = FBINFO_FLAG_DEFAULT;
+ spin_lock_init(&par->lock);
+ platform_set_drvdata(dev, info);
+ retval = register_framebuffer(info);
+ if (retval < 0)
-+ goto err1;
++ goto out_register;
+
+ init_timer(&fb_timer);
+ fb_timer.function = novafb_refresh;
+ printk(KERN_INFO
+ "fb%d: nova frame buffer device, using %dK of video memory\n",
+ info->node, videomemorysize >> 10);
++
++ /* Initialize backlight and contrast control (do not abort driver if it fails) */
++ novafb_bl_init(par);
++ novafb_lcd_init(par);
++
+ return 0;
-+err1:
++
++out_register:
+ framebuffer_release(info);
-+err:
++out_alloc:
+ vfree(videomemory);
++failout:
+ return retval;
+}
+
+ struct fb_info *info = platform_get_drvdata(dev);
+
+ if (info) {
++ novafb_lcd_exit(info->par);
++ novafb_bl_exit(info);
+ unregister_framebuffer(info);
+ vfree((void __force *)info->screen_base);
+ framebuffer_release(info);
+ .probe = novafb_probe,
+ .remove = novafb_remove,
+ .driver = {
-+ .name = "novafb",
++ .name = DRIVER_NAME,
+ },
+};
+
+ ret = platform_driver_register(&novafb_driver);
+
+ if (!ret) {
-+ novafb_device = platform_device_alloc("novafb", 0);
++ novafb_device = platform_device_alloc(DRIVER_NAME, 0);
+ if (novafb_device)
+ {
+ ret = platform_device_add(novafb_device);
+MODULE_AUTHOR("Alexandre Coffignal");
+MODULE_LICENSE("GPL");
+
-Index: linux-2.6.26-NEW/include/linux/NT7506.h
+Index: linux-2.6.27/include/linux/NT7506.h
===================================================================
--- /dev/null
-+++ linux-2.6.26-NEW/include/linux/NT7506.h
-@@ -0,0 +1,33 @@
++++ linux-2.6.27/include/linux/NT7506.h
+@@ -0,0 +1,31 @@
+
+/*
+ * (C) Copyright 2008
+#define __LINUX_NOVAFB_H__
+
+#define FBIO_FRAMERATE _IOR('f', 1, char)
-+#define FBIO_CONTRAST _IOR('f', 2, char)
-+#define FBIO_BACKLIGHT _IOR('f', 3, char)
+
+#endif
git.openpandora.org / openembedded.git / commitdiff